一种室外移动机器人导引方法及导引系统
摘要:
一种室外移动机器人导引方法及导引系统,包括(1)计算机器人的当前经度、纬度、航向角;(2)判断机器人是否收到路径规划结果,即目标导引路径坐标点集;(3)更新导引路线,得到导引直线函数;(4)根据经度、纬度、航向角以及导引直线函数计算横向偏差Δd和角度偏差Δθ;(5)将Δd和Δθ作为反馈观测输入数字PID控制器,得到控制量,作为伺服电机的输入量,驱动移动机器人按导引路线运动;(6)更新计算机器人当前经度、纬度、航向角;(7)判断机器人是否移动到达中间点;(8)判断是否到达最终目标点,若到达最终目标点则结束,完成机器人导引。本发明能够修正角度误差,同时修正横向偏差,不仅适应宽大道路、场地,还能适应窄小的道路和环境。
公开/授权文献
0/0