小型双轮差速底盘机器人实现寻迹功能

机器谱 2023-07-30 18:21

1. 功能说明

寻迹机器人是一种能够跟踪特定物体或线路的机器人。它们通常具有以下功能和特点:

① 传感器:寻迹机器人配备了用于感知环境的传感器,如摄像头、灰度传感器等。这些传感器可以探测地面上的标记、颜色、纹理或其他特定特征,以确定要跟踪的目标。

② 自主导航:寻迹机器人通常具备自主导航能力,可以根据目标物体的位置和运动轨迹进行移动和调整。它们可能使用轮式、履带或其他移动机构来在地面上移动。

③ 跟踪精度:寻迹机器人通常被设计为能够实时跟踪目标物体,并尽可能准确地保持距离和方向。一些高级寻迹机器人还可以通过预测目标物体的运动来提高跟踪的精度。

④ 应用场景:寻迹机器人可以应用于多种场景,如工业生产线上的零部件跟踪、物流仓库中的货物识别与追踪、安防领域中的行人监控等。它们在自动化、智能化和效率提升方面具有广泛的应用前景。

本文示例将实现R023样机小型双轮差速底盘机器人沿直线寻迹行走的一个功能。

样机方案-【R023】小型双轮差速底盘-寻迹与路口-机器人-智能小车-人工智能-灰度传感器-机器谱robotway-开源-图1

2. 结构装配

按照下图所示方式进行安装:

样机方案-【R023】小型双轮差速底盘-寻迹与路口-机器人-智能小车-人工智能-灰度传感器-机器谱robotway-开源-图2

3. 电子硬件

在这个示例中,我们采用了以下硬件,请大家参考:


按照下图所示方式进行电路连接:

样机方案-【R023】小型双轮差速底盘-寻迹与路口-机器人-智能小车-人工智能-灰度传感器-机器谱robotway-开源-图3

样机方案-【R023】小型双轮差速底盘-寻迹与路口-机器人-智能小车-人工智能-灰度传感器-机器谱robotway-开源-图4


4. 功能实现

编程环境:Arduino 1.8.19

① 下面提供一个控制轮子转动方向和速度的参考例程(Test1.ino):

																
/*------------------------------------------------------------------------------------
版权说明:Copyright 2023 Robottime(Beijing) Technology Co., Ltd. All Rights Reserved.
https://opensource.org/licenses/MIT
Distributed under MIT license.See file LICENSE for detail or copy at
by 机器谱 2023-07-14 https://www.robotway.com/
#include //调用舵机库
------------------------------*/
Servo myservo;//声明一个舵机类
void setup()//Arduino的设置函数
{
myservo.attach(4);//绑定控制舵机的引脚
}
void loop()//Arduino的循环函数
{
for(int i=0; i<180; i++){//通过调节i值控制舵机的运行参数 myservo.write(i);//输出控制舵机的运行参数 delay(500);//延时 } }

② 下面提供一个控制轮子前进、停止、左转、右转、左微调、右微调的参考例程(Test2.ino):

																
/*------------------------------------------------------------------------------------
版权说明:Copyright 2023 Robottime(Beijing) Technology Co., Ltd. All Rights Reserved.
https://opensource.org/licenses/MIT
Distributed under MIT license.See file LICENSE for detail or copy at
by 机器谱 2023-07-14 https://www.robotway.com/
#include
------------------------------*/
#define middle1 88//定义对应舵机的中间值,即停止转动的值
#define middle2 88//此值需要测量,各个舵机不一定相同
void setup()
Servo myservo[2];//定义一个舵机类数组
{
myservo[0].attach(4);
delay(1000);
myservo[1].attach(3);
}
void loop()
{
Right();
Left();//调用左转函数
void Left()//左转函数
delay(1000);
delay(1000);
Forwards();
delay(1000);
stop();
}
{
{
myservo[0].write(middle1);
myservo[1].write(middle2 + 20);
}
void Right()//右转函数
myservo[0].write(middle1 - 20);
myservo[0].write(middle1 - 20);
myservo[1].write(middle2);
}
}
void Forwards()//前进函数
{
myservo[1].write(middle2 + 20);
}
void stop()//后退函数
{
myservo[1].write(middle2);
myservo[0].write(middle1);

③ 下面提供一个将灰度传感器数据显示到LED点阵上的参考例程(Test3.ino):

																
/*------------------------------------------------------------------------------------
版权说明:Copyright 2023 Robottime(Beijing) Technology Co., Ltd. All Rights Reserved.
https://opensource.org/licenses/MIT
Distributed under MIT license.See file LICENSE for detail or copy at
by 机器谱 2023-07-14 https://www.robotway.com/
#include //调用点阵库函数
------------------------------*/
#include
LedControl lc=LedControl(12,11,13,1);//声明点阵类,并设置对应的引脚
int pin[3] = {A0, A4, A3};//设置传感器的对应的三个引脚
byte value;//声明传感器值变量
void setup()
{
/************************************************************************************
LedInit();//初始化点阵
}
具体解析:for循环中使用了位处理,这样的结果就是value的一个数据位对应一个传感器的状态,
此程序用到了for与switch的配合框架,可用于多传感器的实时处理,请细细体会!
传感器触发时返回值为0,因此value值与传感器触发的状态对应关系以A0触发为例:
此程序value的类型为byte,则可支持8个传感器,如果要使用更多传感器可定义int等。
所以这样做的好处就是当传感器的状态发生改变时程序可以快速的到达指定的处理方式
A0传感器触发-->二进制:00000110-->十六进制:0x06-->对应case 0x06;
{
**************************************************************************************/
void loop()
for(int i=0; i<3; i++){//通过循环检测,读取传感器的状态值 value |= (digitalRead(pin[i]) << i);//通过位处理得到结果值,digitalRead()用于读取数字值 } switch (value) {//根据结果值进行相应的事件处理 case 0x00://全部触发 LedOn(0);//点亮相应的点阵 LedOn(1); LedOn(2); break; case 0x01://触发右边两个 LedOn(1); LedOn(2); break; case 0x03://触发右边一个 LedOn(2); break; case 0x04://触发左边两个 LedOn(0); LedOn(1); break; case 0x05://触发中间一个 LedOn(1); break; case 0x06://触发左边一个 LedOn(0); break; default: ; } } void LedOn(int key)//根据参数点亮相应的点阵LED { lc.clearDisplay(0); for(int i=0; i<2; i++){ for(int j=3*key; j<3*key+2; j++){ lc.setLed(0, i, j, true); } } } void LedInit() //点阵初始化函数 { lc.shutdown(0,false); lc.setIntensity(0,8); lc.clearDisplay(0); }
value = 0;

④ 下面提供一个小车行走直线的参考例程(Test4.ino):

																
/*------------------------------------------------------------------------------------
版权说明:Copyright 2023 Robottime(Beijing) Technology Co., Ltd. All Rights Reserved.
https://opensource.org/licenses/MIT
Distributed under MIT license.See file LICENSE for detail or copy at
by 机器谱 2023-07-14 https://www.robotway.com/
#include
------------------------------*/
#define middle1 88
#define middle2 88
Servo myservo[2];
int pin[3] = {A0, A4, A3};
byte value;
byte value_his = 0;//记录上一次的传感器值
myservo[1].attach(3);
void setup()
{
myservo[0].attach(4);
}
for(int i=0; i<3; i++){ value |= (digitalRead(pin[i]) << i); } if(value == 0x07){//当传感器都没有触发时默认为上一次的值 value = value_his; } switch (value) { case 0x00://全部触发 Forwards(); break; case 0x01://触发右边两个 while(digitalRead(pin[1])){//通过while循环使小车回到跑道中间 Right(); } break; case 0x03://触发右边一个 while(digitalRead(pin[1])){ Right(); } break; case 0x04://触发左边两个 while(digitalRead(pin[1])){ Left(); } break; case 0x05://触发中间一个 Forwards(); break; case 0x06://触发左边一个 while(digitalRead(pin[1])){ Left(); } break; default: stop(); } value_his = value; } void Left() { myservo[0].write(middle1); myservo[1].write(middle2 + 20); } void Right() { myservo[0].write(middle1 - 20); myservo[1].write(middle2); } void Forwards() { myservo[0].write(middle1 - 20); myservo[1].write(middle2 + 20); } void stop() { myservo[0].write(middle1); myservo[1].write(middle2); }
void loop()
{
value = 0;

⑤ 下面提供一个小车识别十字路口的参考例程(Test5.ino):

																
/*------------------------------------------------------------------------------------
版权说明:Copyright 2023 Robottime(Beijing) Technology Co., Ltd. All Rights Reserved.
https://opensource.org/licenses/MIT
Distributed under MIT license.See file LICENSE for detail or copy at
by 机器谱 2023-07-14 https://www.robotway.com/
#include
------------------------------*/
#include
#define middle1 88
#define middle2 88
Servo myservo[2];
LedControl lc=LedControl(12,11,13,1);
int pin[3] = {A0, A4, A3};
byte value;
void setup()
byte value_his = 0;
int time[3];//用于记录传感器的触发时间
{
void loop()
LedInit();
myservo[0].attach(4);
myservo[1].attach(3);
for(int i=0; i<3; i++){ value |= (digitalRead(pin[i]) << i); if(!digitalRead(pin[i])){ time[i] = millis();//调用mills函数可以得到此时单片机的运行时间 } } if(TimeDeal()) { if(millis() > 1000){//用于排除刚开机时的误判
}
{
value = 0;
LedDis();//十字路口显示
}
}
if(value == 0x07){//当传感器都没有触发时默认为上一次的值
value = value_his;
}
while(digitalRead(pin[1])){
switch (value) {
case 0x00://全部触发
break;
Forwards();
while(digitalRead(pin[1])){
case 0x01://触发右边两个
Right();
}
case 0x03://触发右边一个
break;
}
Right();
break;
break;
case 0x04://触发左边两个
while(digitalRead(pin[1])){
Left();
}
while(digitalRead(pin[1])){
case 0x05://触发中间一个
Forwards();
case 0x06://触发左边一个
break;
break;
Left();
}
myservo[0].write(middle1);
default:
stop();
}
value_his = value;
lc.clearDisplay(0);
myservo[1].write(middle2 + 20);
}
void Left()
{ }
myservo[0].write(middle1 - 20);
void Right()
{
myservo[0].write(middle1 - 20);
myservo[1].write(middle2);
}
myservo[1].write(middle2 + 20);
void Forwards()
{ }
if((abs(time[1] - time[0]) < 100) && (abs(time[1] - time[2]) < 100)){//当中间传感器与另外两个传感器触发的时间小于100毫秒时判定为十字路口 return true; } else return false; } } void LedDis()//十字路口显示函数 { for(int i=3; i<5; i++){ for(int j=0; j<8; j++){ lc.setLed(0, i, j, true); } } for(int i=3; i<5; i++){ for(int j=0; j<8; j++){ lc.setLed(0, j, i, true); } } } void LedInit() { lc.shutdown(0,false); //start the 8*8 led lc.setIntensity(0,8); lc.clearDisplay(0); }
void stop()
{
myservo[0].write(middle1);
myservo[1].write(middle2);
}
bool TimeDeal()//十字路口识别函数
{
if(millis() > 500){

⑥ 下面提供一个小车实现寻迹的完整程序(TrackingCar.ino):

																
/*------------------------------------------------------------------------------------
版权说明:Copyright 2023 Robottime(Beijing) Technology Co., Ltd. All Rights Reserved.
https://opensource.org/licenses/MIT
Distributed under MIT license.See file LICENSE for detail or copy at
by 机器谱 2023-07-14 https://www.robotway.com/
#include
------------------------------*/
#include
#define middle1 88
#define middle2 88
LedControl lc=LedControl(12,11,13,1);
Servo myservo[2];
int time[3];
int pin[3] = {A0, A4, A3};
byte value;
int times = 0;
byte value_his = 0;
int flag = 0;
myservo[0].attach(4);
void setup()
{
LedInit();
Serial.begin(9600);//串口,用于调试
myservo[1].attach(3);
for(int i=0; i<3; i++){ value |= (digitalRead(pin[i]) << i); if(!digitalRead(pin[i])){ time[i] = millis(); } } if(TimeDeal()) { times++; Serial.print(times); } else { if(times > 1){
}
void loop()
{
Serial.println();
value = 0;
flag += 1;
while(1){
Serial.println(flag);
}
times = 0;
}
stop();
if(flag == 3){
} }
if(value == 0x07){
value = value_his;
}
switch (value) {
LedOn(0);
case 0x00://全部触发
LedOn(1);
while(digitalRead(pin[1])){
LedOn(2);
Forwards();
//delay(500);
break;
case 0x01://触发右边两个
LedOn(2);
LedOn(1);
Right();
Right();
}
case 0x03://触发右边一个
break;
while(digitalRead(pin[1])){
LedOn(2);
}
break;
break;
case 0x04://触发左边两个
LedOn(0);
while(digitalRead(pin[1])){
LedOn(1);
while(digitalRead(pin[1])){
Left();
}
case 0x05://触发中间一个
LedOn(1);
break;
Forwards();
LedOn(0);
case 0x06://触发左边一个
if((abs(time[1] - time[0]) < 100) && (abs(time[1] - time[2]) < 100)){ return true; } else return false; } } void Left() { myservo[0].write(middle1); myservo[1].write(middle2 + 20); } void Right() { myservo[0].write(middle1 - 20); myservo[1].write(middle2); } void Forwards() { myservo[0].write(middle1 - 20); myservo[1].write(middle2 + 20); } void stop() { myservo[0].write(middle1); myservo[1].write(middle2); } void LedOn(int key) { for(int i=0; i<2; i++){ for(int j=3*key; j<3*key+2; j++){ lc.setLed(0, i, j, true); } } } void LedInit() { lc.shutdown(0,false); //start the 8*8 led lc.setIntensity(0,8); lc.clearDisplay(0); }
Left();
}
default:
break;
stop();
}
value_his = value;
lc.clearDisplay(0);
}
bool TimeDeal()
{
if(millis() > 500){


5. 资料下载

资料内容:程序源代码

资料下载地址:小型双轮差速底盘-寻迹与路口

机器谱 机器人开源项目方案分享~
评论
  • 每日可见的315MHz和433MHz遥控模块,你能分清楚吗?众所周知,一套遥控设备主要由发射部分和接收部分组成,发射器可以将控制者的控制按键经过编码,调制到射频信号上面,然后经天线发射出无线信号。而接收器是将天线接收到的无线信号进行解码,从而得到与控制按键相对应的信号,然后再去控制相应的设备工作。当前,常见的遥控设备主要分为红外遥控与无线电遥控两大类,其主要区别为所采用的载波频率及其应用场景不一致。红外遥控设备所采用的射频信号频率一般为38kHz,通常应用在电视、投影仪等设备中;而无线电遥控设备
    华普微HOPERF 2025-01-06 15:29 131浏览
  •     为控制片内设备并且查询其工作状态,MCU内部总是有一组特殊功能寄存器(SFR,Special Function Register)。    使用Eclipse环境调试MCU程序时,可以利用 Peripheral Registers Viewer来查看SFR。这个小工具是怎样知道某个型号的MCU有怎样的寄存器定义呢?它使用一种描述性的文本文件——SVD文件。这个文件存储在下面红色字体的路径下。    例:南京沁恒  &n
    电子知识打边炉 2025-01-04 20:04 100浏览
  • 彼得·德鲁克被誉为“现代管理学之父”,他的管理思想影响了无数企业和管理者。然而,关于他的书籍分类,一种流行的说法令人感到困惑:德鲁克一生写了39本书,其中15本是关于管理的,而其中“专门写工商企业或为企业管理者写的”只有两本——《为成果而管理》和《创新与企业家精神》。这样的表述广为流传,但深入探讨后却发现并不完全准确。让我们一起重新审视这一说法,解析其中的矛盾与根源,进而重新认识德鲁克的管理思想及其著作的真正价值。从《创新与企业家精神》看德鲁克的视角《创新与企业家精神》通常被认为是一本专为企业管
    优思学院 2025-01-06 12:03 122浏览
  • 根据Global Info Research项目团队最新调研,预计2030年全球封闭式电机产值达到1425百万美元,2024-2030年期间年复合增长率CAGR为3.4%。 封闭式电机是一种电动机,其外壳设计为密闭结构,通常用于要求较高的防护等级的应用场合。封闭式电机可以有效防止外部灰尘、水分和其他污染物进入内部,从而保护电机的内部组件,延长其使用寿命。 环洋市场咨询机构出版的调研分析报告【全球封闭式电机行业总体规模、主要厂商及IPO上市调研报告,2025-2031】研究全球封闭式电机总体规
    GIRtina 2025-01-06 11:10 104浏览
  • By Toradex 秦海1). 简介嵌入式平台设备基于Yocto Linux 在开发后期量产前期,为了安全以及提高启动速度等考虑,希望将 ARM 处理器平台的 Debug Console 输出关闭,本文就基于 NXP i.MX8MP ARM 处理器平台来演示相关流程。 本文所示例的平台来自于 Toradex Verdin i.MX8MP 嵌入式平台。  2. 准备a). Verdin i.MX8MP ARM核心版配合Dahlia载板并
    hai.qin_651820742 2025-01-07 14:52 48浏览
  • 根据环洋市场咨询(Global Info Research)项目团队最新调研,预计2030年全球无人机锂电池产值达到2457百万美元,2024-2030年期间年复合增长率CAGR为9.6%。 无人机锂电池是无人机动力系统中存储并释放能量的部分。无人机使用的动力电池,大多数是锂聚合物电池,相较其他电池,锂聚合物电池具有较高的能量密度,较长寿命,同时也具有良好的放电特性和安全性。 全球无人机锂电池核心厂商有宁德新能源科技、欣旺达、鹏辉能源、深圳格瑞普和EaglePicher等,前五大厂商占有全球
    GIRtina 2025-01-07 11:02 74浏览
  • 在智能家居领域中,Wi-Fi、蓝牙、Zigbee、Thread与Z-Wave等无线通信协议是构建短距物联局域网的关键手段,它们常在实际应用中交叉运用,以满足智能家居生态系统多样化的功能需求。然而,这些协议之间并未遵循统一的互通标准,缺乏直接的互操作性,在进行组网时需要引入额外的网关作为“翻译桥梁”,极大地增加了系统的复杂性。 同时,Apple HomeKit、SamSung SmartThings、Amazon Alexa、Google Home等主流智能家居平台为了提升市占率与消费者
    华普微HOPERF 2025-01-06 17:23 145浏览
  • 这篇内容主要讨论三个基本问题,硅电容是什么,为什么要使用硅电容,如何正确使用硅电容?1.  硅电容是什么首先我们需要了解电容是什么?物理学上电容的概念指的是给定电位差下自由电荷的储藏量,记为C,单位是F,指的是容纳电荷的能力,C=εS/d=ε0εrS/4πkd(真空)=Q/U。百度百科上电容器的概念指的是两个相互靠近的导体,中间夹一层不导电的绝缘介质。通过观察电容本身的定义公式中可以看到,在各个变量中比较能够改变的就是εr,S和d,也就是介质的介电常数,金属板有效相对面积以及距离。当前
    知白 2025-01-06 12:04 173浏览
  • 村田是目前全球量产硅电容的领先企业,其在2016年收购了法国IPDiA头部硅电容器公司,并于2023年6月宣布投资约100亿日元将硅电容产能提升两倍。以下内容主要来自村田官网信息整理,村田高密度硅电容器采用半导体MOS工艺开发,并使用3D结构来大幅增加电极表面,因此在给定的占位面积内增加了静电容量。村田的硅技术以嵌入非结晶基板的单片结构为基础(单层MIM和多层MIM—MIM是指金属 / 绝缘体/ 金属) 村田硅电容采用先进3D拓扑结构在100um内,使开发的有效静电容量面积相当于80个
    知白 2025-01-07 15:02 76浏览
  • 本文介绍Linux系统更换开机logo方法教程,通用RK3566、RK3568、RK3588、RK3576等开发板,触觉智能RK3562开发板演示,搭载4核A53处理器,主频高达2.0GHz;内置独立1Tops算力NPU,可应用于物联网网关、平板电脑、智能家居、教育电子、工业显示与控制等行业。制作图片开机logo图片制作注意事项(1)图片必须为bmp格式;(2)图片大小不能大于4MB;(3)BMP位深最大是32,建议设置为8;(4)图片名称为logo.bmp和logo_kernel.bmp;开机
    Industio_触觉智能 2025-01-06 10:43 87浏览
  • PLC组态方式主要有三种,每种都有其独特的特点和适用场景。下面来简单说说: 1. 硬件组态   定义:硬件组态指的是选择适合的PLC型号、I/O模块、通信模块等硬件组件,并按照实际需求进行连接和配置。    灵活性:这种方式允许用户根据项目需求自由搭配硬件组件,具有较高的灵活性。    成本:可能需要额外的硬件购买成本,适用于对系统性能和扩展性有较高要求的场合。 2. 软件组态   定义:软件组态主要是通过PLC
    丙丁先生 2025-01-06 09:23 85浏览
  • 大模型的赋能是指利用大型机器学习模型(如深度学习模型)来增强或改进各种应用和服务。这种技术在许多领域都显示出了巨大的潜力,包括但不限于以下几个方面: 1. 企业服务:大模型可以用于构建智能客服系统、知识库问答系统等,提升企业的服务质量和运营效率。 2. 教育服务:在教育领域,大模型被应用于个性化学习、智能辅导、作业批改等,帮助教师减轻工作负担,提高教学质量。 3. 工业智能化:大模型有助于解决工业领域的复杂性和不确定性问题,尽管在认知能力方面尚未完全具备专家级的复杂决策能力。 4. 消费
    丙丁先生 2025-01-07 09:25 83浏览
我要评论
0
点击右上角,分享到朋友圈 我知道啦
请使用浏览器分享功能 我知道啦