毕业论文

打赏
当前位置: 毕业论文 > 自动化 >

移动机器人的避障实验设计+源程序+流程图(10)

时间:2017-01-14 10:40来源:毕业论文
第三种方法是先让让机器人后退一段距离,再旋转一定的角度,最后再向前走。后退一段距离是为了更加安全地离开障碍物,不过后退的距离不能太大,尤


第三种方法是先让让机器人后退一段距离,再旋转一定的角度,最后再向前走。后退一段距离是为了更加安全地离开障碍物,不过后退的距离不能太大,尤其是当机器人后部没有安装传感器时,后退太多有可能让机器人后部碰到物体。旋转角度的选择问题跟第二种一样,靠经验设定,并根据实际情况调整。
我们经常采用的是第二种方法,比较简单,容易实现,避障效果也较好。

传感与通信模块的程序流程图如图7所示。
图7程序流程图

    运动控制模块的程序流程图如图8所示。
    图8  程序流程图
红外测距程序
while(1)
    {
        //读四次A/D取均值
        temp= AD_Val(0);    //读转换结果
        for(i=0;i<50000;i++);   //延时
           temp+= AD_Val(0);    //读转换结果
        for(i=0;i<50000;i++);   //延时
        temp+= AD_Val(0);    //读转换结果
        for(i=0;i<50000;i++);   //延时
        temp+= AD_Val(0);    //读转换结果
        temp=temp/4;    //4次结果取均值
        if((temp >=163)&&( temp <=984))// 0.4V(对应2.5V基准电压10位A/D转换结果为163)到2.4V(对应2.5V基准电压10位A/D转换结果为984)之间为有效范围
        {
          data[0]= (13840/( temp +7))-4;//距离计算
          CAN_Send(CAN2,2,1,0,0,0,data,0);//发送测量结果到运动模块,CAN发送的ID设置为2,帧格式为标准帧,数据长度为1字节
        }
        for(i=0;i<20000;i++);   //延时
    }
    return 0;
}
6结论
    这次设计的算法能解决基本的避障问题,对于障碍物在红外的探头能检测到的范围内,对于红外检测不到的地方,比如障碍物的高度太高或者太低或者太宽,小车是不能顺利避障的。若小车在前进过程中遇到很多障碍,一般的障碍,可以通过这种方法避障,特殊情况下,小车就要先后退,在左转90度与障碍物,再前进,当然,这种情况就比较特殊了,所以没有放到程序里。 移动机器人的避障实验设计+源程序+流程图(10):http://www.751com.cn/zidonghua/lunwen_2232.html
------分隔线----------------------------
推荐内容