自动割草机器人的设计与实现

中国机器人网 2011-10-18

机器人割草机传感器

4191 字丨阅读本文需 10 分钟

1 系统结构

  自动割草机器人主控系统的结构框图如图1所示。系统主要由单片机控制系统、传感器系统、电机驱动系统3大部分组成。其中单片机控制系统的处理器采用国产芯片STC12C5410AD,包含10 bit的ADC以及串口、I2C等通用串行接口,高达40 MHz的主频完全可以胜任本系统的计算和处理速度。

 

 

  运动系统主要通过单片机给出的多路PWM信号对自动割草机器人的行动电机以及割草电机进行控制。传感器系统由电子篱笆传感器、光电开关传感器、碰撞开关传感器、雨水传感器、无线遥控接收模块等组成。其中,电子篱笆传感器用于探测割草区域的边缘;光电开关传感器用于避开慢速的或者静止的障碍物;碰撞开关传感器用于避开快速的或者主动碰向割草机的物体;雨水传感器用于检测下雨天气,并且相应作出回基站的操作;倾角开关传感器用于安全措施,防止自动割草机器人在割草过程中发生意外事件翻倒,一旦传感器检测的角度超过设定的阈值,系统自动停止一切工作,进入休眠状态;无线遥控部分用于方便使用者无线控制自动割草机器人,无线遥控的距离约20 m.各个系统都采用模块化设计,可扩展性高、升级维护方便、二次开发周期短。表1为自动割草机器人参数表。

 

 

  2 硬件系统设计

  2.1 主控系统

  主控系统采用STC12c5410AD单片机,最高主频40 MHz,8路AD输入,可以满足自动割草机器人系统的控制需求。本系统采用30 MHz的有源晶振,8路AD输入基本上可以满足系统中模拟量的采集需求。

  2.2 运动控制系统

  运动控制系统中行动电机部分采用2片L298直流电机驱动芯片对直流电机进行控制。1片L298驱动芯片可以提供最高3 A的驱动电流,本系统的行动电机供电电压为24 V,对于设计要求行动总功率不大于60 W的驱动系统来说,2片L298拥有足够的驱动能力。在机械结构上,电机轴上使用了减速齿轮,用于加大最大电机输出转矩,提高在草地上行走的能力。

  割草电机驱动部分采用mosfet驱动,IRLR2705这款mosfet可以提供峰值28 A的电流,满足了割草电机的要求。割草电机的开通和关断由一个单片机IO控制。割草电机驱动有一个电流检测反馈环节,当割草电机的工作电流过大(一般是堵转时),电流信号被采样电阻取出并且送往单片机AD转换器中进行检测并且软件保护。防止堵转的电机烧毁mosfet管。电机驱动电路图如图2.

 
  2.3.2 倾角开关
  在割草机运行过程中,有可能因为意外使割草机倾斜或者翻倒。由于割草机底盘有一对高速运行的割草刀片,所以底盘暴露在外面就会威胁到人或者动物的安全。在车子倾斜到一定角度时,倾角开关就会给出一个开关信号,单片机根据这个信号关断所有的电机控制信号,并且进入待机状态,等待操作者手动开机。
  2.3.3 碰撞开关
  碰撞开关是为了让割草机可以躲开光电避障开关检测不到的盲区障碍物与快速移动物体,是一种被动的避障方式。碰撞开关的原理是在割草机被外物碰撞到前方的一个机械的弹簧结构后,会让一个触点短路,这样能给单片机一个低电平信号,通知单片机遇到了障碍物,单片机就会执行相应的避障措施。
  2.3.4 雨水传感器
  雨水传感器由一个湿敏电阻与一个比较器组成。在正常工作情况下,湿敏电阻阻值为1 MΩ左右,这样可使比较器输出为高(正极电压(约2.5 V)大于负极电压(约2 V))。如果有雨水碰到湿敏电阻,则电阻的阻值会急剧下降到1 kΩ左右,比较器输出就为低(正极电压(约0 V)小于负极(约2 V))。这样就能使单片机得到雨水感应信号,执行回基站避雨的操作。图4为雨水传感器电路图。
 

 
  2.3.5 光电开关避障
  光电避障是最主要的避障方式,也是一种主动的避障方式。优点是不用碰到障碍物就可以检测到并且躲开,避免直接碰撞到障碍物。光电开关可检测的距离可以根据实际控制的需要进行调节。
  2.3.6 传感器在车体位置上的排布
  多传感器系统传感器的位置与排布对于控制精度有很大影响,在借鉴了其他多传感器系统的排布后,设计出本系统的传感器排布图[2],如图5所示。
 

  A1、A2、A3、A4都是电子篱笆探头的放置位置。B1与B2是光电传感器和碰撞开关的安装位置,尽量放在边缘有利于检测障碍物减小检测的盲区。其中,A3、A4这两个电子篱笆探头主要用于检测前端电子篱笆区域,如果检测到,执行后退再转向的动作。A1、A2则是用于进入基站时的寻线,因为进入基站的任务是通过首先寻找到边界的电子篱笆线,然后再切入电子篱笆线中,最后通过寻线的方式一直走入基站。A1、A2也可以在自动割草时发挥作用,避免割草机走出边界,特别是在割草区域的边角地带,成为处理边界算法中的一个重要辅助信号。
  2.4 其他部分
  其他部分包括过电流保护、欠电压保护。过电流保护主要保护割草机驱动电路不会因为堵转、割刀卡死等原因损坏;欠电压保护通过检测电池电压来确定是否应该回基站充电,实现自动充电的功能。
  3 软件系统设计
  自动割草机器人的软件部分使用单片机C语言编程设计[3],根据实际的控制要求实现自动割草机器人的功能。软件部分尽量使用查询代替中断,增加了软件的健壮性。割草路径的规划是自动割草机器人的主要算法部分。
3.1 软件总体结构
  主程序主要执行初始化以及自动割草机器人的3种行走策略:普通行走的任务;回到基站的任务;执行出站的任务。在外部中断中,外部光电避障、碰撞开关避障和保护部分的信号是主要外部中断的来源,用于实时响应这些异常事件。软件流程图如图6.

  3.2 割草路径规划
  路径规划是指,在具有障碍物的环境中,按照一定的评价标准,寻找一条从起始状态到目标状态的无碰撞路径。本算法中路径规划采用了基于知识的遗传算法,它包含了自然选择和进化的思想,具有很强鲁棒性。机器人整体的运动规划一般又称为路径规划,由于机器人整体看作是一个点或者是一个固定的几何体,自由度比较少,因此路径规划问题相对比较简单。传统的机器人运动规划算法已经能较好地解决路径规划问题。
  自动割草机器人路径规划的遍历策略是割草机设计中的一个重要环节,涉及到割草机割草的效率。合理的遍历策略可以使自动割草机器人在最短的时间内遍历整个割草区域[4].常用的割草策略主要有两种方式:直线运行方式和边界跟踪运行方式[5].两种覆盖区域方式如图7、图8所示。

  采用直线运行时,转向处会有不可避免的重叠路径,使总的运行距离增加;采用边界跟踪的方式时,需要机器人不断地调整进行方向,容易带来误差。针对自动割草机器人以单片机为核心的控制器而言,需要自动割草机器人的运行轨迹尽量简单化和规范化。因此采取直线运行方式遍历子区间,在前向的电子篱笆传感器感应到边界后,割草机器人后退一小段距离,然后以一个轮子为中心,另一个轮子左转(或右转)180°,完成掉头,然后继续前进,下次再碰到边界就向相反的方向旋转180°,这样就可以做到区域的覆盖。
  3.3 割草边界区域的处理方法
  割草机器人在区域的边角处行走是最容易出现问题的时候,不合理的行走策略可能导致割草机器人走出边界。所以要利用割草机器人现有的传感器去选择在区域边角的运行策略。
  经过实验发现,出现越界问题的情况主要有两种。
  (1)割草机到达边界的一个角落,如图9.在这种情况下割草机器人传感器A4(或者A3)首先检测到边界L1的信息,根据直线运行方式就应该先后退再向左转(或向右转)。正常情况下走到这种角落时就应该是先检测到L1,然后后退一段距离,再向右方向转180°。在转弯的过程中,由于L2的存在, A3就会感应到角落的另外一个边界L2,如果没有特别的策略,就会执行先后退一段距离,再向左转180°的策略,这样就很容易走出边界,或者使控制变得混乱。要避免这种情况就需要在软件上做出改动,即在转弯过程中如果有其他传感器检测到边界,就说明已经到了另一个边界角落的位置。最好的处理方法就是原路回转过去,回到原位后再次左转180°,开始从这个区域的顶端到另外一端的循环行走遍历。

  (2)割草机遇到了一个倾斜的边界,如图10.如果没有特殊的策略,A4检测到边界后,就执行转向的策略,这样就会有很大一片的前方区域(区域一)不能遍历到,所以就需要利用右边的A2去解决这个问题。在正常行走时,如果A2首先检测到了边界,则执行先后退、然后左拐一定的角度、最后前进的策略。自动割草机器人就会沿着这根斜线边界不断调整自己的角度前进,而不会漏掉这些区域,适用于边界不是很规则的草地。

 

  4 系统整体调试
  割草机器人整体调试步骤:(1)单片机控制系统的测试;(2)运动控制系统的调试;(3)各个传感部分的调试;(4)运动控制系统与传感器相结合的整机调试。
  首先单独测试单片机的控制,测试通过后进行运动模块的测试,获取割草机的运动参数。然后进行各个传感模块的测试,其中重点的是电子篱笆、光电避障的测试。在确认各个传感模块工作无误后即可开始进行割草机器人的整体测试以及割草路径规划。最终实现自动割草机器人自动割草、自动充电与雨雪天自动返回基站等功能。
  自动割草机器人系统借鉴了国外的割草机系统的特点,特别加强了安全性与可靠性的设计,实现了更好的控制。从外界获取信息能力来看,多传感器系统保证了获得的外界信息的完整性、有效性,保证了自动割草的正常进行以及意外情况的及时应对。从系统性能方面,采用功耗合理、性能优越的单片机控制系统,保证了性能与成本的兼顾。从功能方面,基本实现了全部割草机器人应有的功能,并且加强了安全性。通过现场的测试结果,割草机器人完全能够胜任坡度不大于15°的草地的割草需求,实现了真正的无人值守自动割草。
 

免责声明:凡注明来源本网的所有作品,均为本网合法拥有版权或有权使用的作品,欢迎转载,注明出处本网。非本网作品均来自其他媒体,转载目的在于传递更多信息,并不代表本网赞同其观点和对其真实性负责。如您发现有任何侵权内容,请依照下方联系方式进行沟通,我们将第一时间进行处理。

0赞 好资讯,需要你的鼓励
来自:中国机器人网
0

参与评论

登录后参与讨论 0/1000

为你推荐

加载中...