摘要
本发明提出一种机器人智能导航方法和系统。其中,方法包括:实时采集多种卫星导航系统的机器人的经纬度和加速度与角速度并进行滤波处理;应用卡尔曼滤波和其扩展算法对多种卫星导航系统的机器人的经纬度进行数据拟合,得到当前位置;根据经纬度差得到当前位置的机器人的朝向与目的地之间的夹角;根据实际方向角和规划方向角得到偏差角;PID控制器根据偏差角计算转速调整量;根据障碍物的距离得到障碍物绕行策略,并计算绕行半径;根据绕行半径计算得到转向角度与速度;根据环境变化调整最大行进速度、绕行半径、障碍物绕行策略和避障响应时间。本发明显著提升了全场景下的定位精度和可靠性。
技术关键词
机器人智能导航
卫星导航系统
惯性导航系统
障碍物
PID控制器
扩展算法
卡尔曼滤波算法
湿滑环境
规划
避障模块
加速度
智能导航系统
摩擦力传感器
偏差
策略
时间同步
数据