原创 Arduino红外蔽障小车的实践(视频)

2010-9-1 09:13 3238 6 7 分类: MCU/ 嵌入式

 


先看看小车的安装步骤:


第一步:


7c8ac8fb-8116-472c-b50b-c76ef5a05213.jpg


后面两个电机带动轮子,前面是一个万向滚珠,实际上这个小车是两轮小车,前面的滚珠作为三点支撑。


第二步:


64426b3a-faa4-4158-8782-f80538fda480.jpg  


在“下”安装盘的前方,安装电池盒,并焊接了一个电源小开关,这个开关可以装在“上”安装盘上,方便接通电源,运行程序。


第三步:


8a214494-5c7b-4597-9078-ca756f9ae9f0.jpg


装上电池,这个电池需2400mA充电电池,5个,最好不用普通的碱性电池,碱性电池容量小,当小车负载大时,由于电流补充不够,导致电压下降,甚至低于AVR单片机对电压的要求,程序就会出错,小车不听指挥了。


第四步:


60962a56-2b37-4a53-a0e8-cceae689bc71.jpg


把Arduino控制器、L298驱动板和传感器扩展板层叠一起放在“上”安装盘上,把一个电位计模块也装好,这个电位计模块可以调节小车速度。安装红外测距传感器支架,这个支架可以朝上安装也可以朝下安装,我觉得朝下安装好些,为啥?如果朝上安装,红外测距传感器就看不到低矮的障碍物了!


第五步:


e172f339-0a94-41fa-9c64-625178ab056a.jpg


这是个总装图,要利用一些孔把电机、红外、电源的线理好,接好。看看那个小电源开关已经稳妥地安装到了“上”安装盘。


红外蔽障传感器的后端有个小旋钮,可以用“一字起”工具旋转,以调节测量距离,我通过调节,把测量距离设为20厘米左右。这个红外传感器如果在20厘米内检测到障碍物,则发低电平,否则为高电平。


be49c9ff-5b7d-4ed4-9814-ccc8542bbb24.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==HIGH && Left==HIGH)
    advance();//前进
    //如果右、中、左三个红外为低电平,前方有障碍,
    //这样可以使小车从死角出来
    if(Right==LOW && Middle==LOW  && Left==LOW )
      {
        back();//后退
        delay(500);//后退时间 
        right();//右转
        delay(300);//右转时间      
      }
    //如果中红外为低电平,前方有障碍
    if(Right==HIGH && Middle==LOW && Left==HIGH  )
     {
        back();//后退
        delay(500);//后退时间 
        right();//右转
        delay(300);//右转时间
     }
     //面对夹缝,小车退回
     if(Right==LOW && Middle==HIGH  && Left==LOW )
      {
        back();//后退
        delay(500);//后退时间 
        right();//右转
        delay(300);//右转时间
      }
    //如果中、左红外为低电平,左边有障碍
    if(Right==HIGH && Middle==LOW && Left==LOW  )
    right();//右转
    //如果左红外为低电平,左边有障碍
    if(Right==HIGH && Middle==HIGH && Left==LOW)
    right();//右转
    //如果右、中红外为低电平,右边有障碍
    if(Right==LOW && Middle==LOW  && Left==HIGH )
    left();//左转
    //如果右红外为低电平,右边有障碍
    if(Right==LOW && Middle==HIGH  && Left==HIGH )
    left();//左转
}


实验照片


4fafbc1a-174d-4860-a3a4-a3a88655d825.jpg

PARTNER CONTENT

文章评论1条评论)

登录后参与讨论

用户1211942 2010-8-27 19:09

哈哈,不错,值得学习,有视频就更好了,有需要以上器材的可以联系我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控制器。所以赶快去安装免费的微软...
我要评论
1
6
关闭 站长推荐上一条 /3 下一条