原创 Arduino寻线小车的设计和实践(视频)

2010-8-31 14:29 4411 6 8 分类: MCU/ 嵌入式

 


Arduino寻线小车的主角是Arduino Mini寻线传感器,如下图所示:


5c0fe779-3462-4e76-b4ed-ff307499aa17.jpg


Mini寻线传感器可以帮助进行白线或者黑线的跟踪,可以检测白底中的黑线,也可以检测黑底中的白线。


输出接口:3线制接口(1-信号,2-电源正,3-电源负),可连在传感器扩展板的数字接口上。
输出电平:TTL电平(黑线低电平有效,白线高电平有效)



这个设计用到了3个寻线传感器在智能小车上,它们的安装图如下:


8dcf9acd-6d69-4cc8-ac6e-f88a23a4ee36.jpg


我用黑色的电工胶布贴在我家客厅的米黄色瓷砖地板上,让小车依靠寻线传感器提供的高低电平信号来判断车轮是前进、右转还是左转,以使小车能沿着黑色的跑道,向火车一样行进。


左、中、右3个寻线传感器,如果左边的传感器检测到黑色,发出低电平,那么小车应该右转还是左转?答案是左转。为啥?下面Arduino程序也是这样编写的,琢磨琢磨。


实验照片:


bdef0313-39ec-4ea7-9f26-147e7c1ddeb4.jpg


这个设计的Arduino程序:


int IR_right=9;//定义右侧避障传感器接口
int IR_left=10;//定义中间避障传感器接口
int IR_middle=8;//定义左侧避障传感器接口
int E_right =5; //连接电机1的使能端口到数字接口5
int M_right =4; //连接电机1的转向端口到数字接口4
int E_left = 6;//连接电机2的使能端口到数字接口6
int M_left=7; //连接电机2的转向端口到数字接口5
int potpin=0;//定义电位计相连的模拟接口0上
float velocity;//车速调节
void setup()
{
   //给各数字接口设置输入输出状态  
   pinMode(M_right, OUTPUT);
   pinMode(E_right, OUTPUT);
   pinMode(M_left, OUTPUT);
   pinMode(E_left, OUTPUT);
   pinMode(IR_right,INPUT);
   pinMode(IR_left, INPUT);
   pinMode(IR_middle, INPUT);
}
void advance()//前进
{
     digitalWrite(M_right,LOW);
     analogWrite(E_right,int(velocity));
     digitalWrite(M_left,HIGH);
     analogWrite(E_left,int(velocity));
}
void back()//后退
{
     digitalWrite(M_right,HIGH);
     analogWrite(E_right,int(velocity));
     digitalWrite(M_left,LOW);
     analogWrite(E_left,int(velocity));
}
void right()//右转
{
     digitalWrite(M_right,HIGH);
     analogWrite(E_right,int(velocity));
     digitalWrite(M_left,HIGH);
     analogWrite(E_left,int(velocity));
}
void left()//左转
{
     digitalWrite(M_right,LOW);
     analogWrite(E_right,int(velocity));
     digitalWrite(M_left,LOW);
     analogWrite(E_left,int(velocity));
}
void Stop()//停止
{
     digitalWrite(E_right, LOW); //右电机停
     digitalWrite(E_left, LOW); //左电机停
}
void loop()
{
   //读电位计给出的车速调节值
   velocity=(float)analogRead(potpin)/1023*255;
    int Right,Left, Middle;
   //读红外蔽障传感器的信号
    Right=digitalRead(IR_right);
    Left=digitalRead(IR_left);
    Middle=digitalRead(IR_middle);
    //如果右、左两个红外为高电平,中红外为低电平
    //说明小车没有偏离黑色条纹跑道
    if(Right==HIGH && Middle==LOW && Left==HIGH)
    advance();//小车前进
    //如果左红外为低电平
    else if(Right==HIGH && Middle==HIGH && Left==LOW )
    left();//小车左转
    //如果左、中红外为低电平
    else if(Right==HIGH && Middle==LOW && Left==LOW )
    left();//小车左转
    //如果右红外为低电平
    else if(Right==LOW && Middle==HIGH && Left==HIGH)
    right();//小车右转
    //如果右、中红外为低电平
    else if(Right==LOW && Middle==LOW && Left==HIGH)
    right();//小车右转   
    else
    Stop();//小车停止
}


设计与实验是个交互的过程,没有一步到位的设计,通过实验发现软硬件设计的问题,通过实验来完善设计。


这个寻线小车的设计也经历了这样的过程,通过这样的交互完善的过程,我总结了以下几点经验:


1、寻线传感器应与被测物体近些,距离越远,传感器受环境光的干扰越大,所以我通过铜柱把传感器安装到铝合金传感器支架上,就是想让传感器离地面近些。但是也不能过近,这样会影响光的传导,所以可以用个土办法,可以向上抬高些传感器,就是向上稍微弯曲传感器支架。


2、黑色电工胶布我贴了两道,这样可以加宽黑色跑道,便于小车寻线。左、右寻线传感器与中央传感器之间的距离要小于黑色跑道宽度,如果大于,会出现3个传感器都检测不到黑色,这样根据程序,小车就会在跑道上停下来。同时左、右寻线传感器之间的距离要大于黑色跑道宽度,为啥?如果左边和中央的传感器都检测到黑色,应该左转,这在程序中有体现。


3、小车的速度不能太快,否则在直道变弯道时,小车会因为惯性而冲出跑道。太慢则小车的行进速度,哈哈。所以我在小车上加了个电位计,方便调试合适的速度。


4、原来认为小车寻线要搞个白板,上面贴黑色,实际上对白色没有那高的要求,浅色即可,所以我选择了客厅的地板,地板瓷砖间的黑色细勾缝,影响不到小车寻线。


在家里边设计边实验设计寻线小车,花不了多少钱,但它的设计过程与真实工业项目的设计路径不是一样一样的吗!

PARTNER CONTENT

文章评论2条评论)

登录后参与讨论

用户377235 2013-11-1 13:01

不错,很好,我得好好学习

用户1211942 2010-8-31 17:20

超赞!是个很好的入门教程,需要以上器材的可以联系我dfrobot.taobao.com
相关推荐阅读
用户374501 2011-10-22 21:38
用LabVIEW前面板遥控乐高NXT机械手车
乐高NXT套件自带的软件是NXT-G软件,它是以国家仪器公司的LabVIEW软件为核心架构的,NXT-G软件界面简单易懂,但要进行复杂功能的程序开发,还需采用更高阶的开发平台,如NI公司的LabVI...
用户374501 2011-10-18 17:20
键盘遥控NXT机器人的LabVIEW编程详解
键盘遥控乐高NXT机器人:图1 基于LabVIEW的键盘遥控NXT机器人示意图视频请观看:  程序下载:键盘遥控labview程序.rar      要用键盘遥控乐高NXT机器人,首先需把键盘的按键...
用户374501 2011-10-09 11:39
乐高Technic伐木车8049驾驶部分电控改造
    最近我购买了乐高Technic伐木车8049套件,大多数买乐高科技套件的LEGO爱好者,到不是为了照着搭建手册体验下套件的魅力,主要还是为了套件里的零件,“零件”圈里人的说法是“肉”,也就是说...
用户374501 2011-09-25 18:42
用Matlab软件为乐高NXT机器人编程
要在matlab环境下给NXT机器人编程,你必须拥有Matlab R2008以上版本,还必须安装德国亚琛大学开发的NXT Toolbox组件。我的版本Matlab 2009a,32位的版本,64位版...
用户374501 2011-08-29 20:40
开博周年,用微软机器人软件MSRS编程实例来纪念
去年,大概这个时间段,我开始在EDN写博客,其实在这以前我也在其他论坛和博客网写些东西,后来我想还是找个技术博客大站来长期保留我的文章,同时也可以分享些东西给其他同仁,于是选择了EDN,哈哈,我的选择...
用户374501 2011-08-27 17:23
用微软机器人软件MSRS给NXT控制器编程
Microsoft Robotics Studio可以使你在PC机上创建程序来远程控制机器人,在这个软件所支持众多公司的机器人控制器中,当然也支持乐高迷手头的NXT控制器。所以赶快去安装免费的微软...
我要评论
2
6
关闭 站长推荐上一条 /3 下一条