GPS与测距法的融合模型在机器人导航中的实现

分析了GPS信号的误差对移动机器人定位精度的影响,提出了GPS信号与测距法的融合模型。即通过计算机器人当前位置估计值与GPS信号值的欧几里德距离d,得出融合系数β,β值的大小反映了此时GPS信号与测距法融合时各自所占的比值。该融合模型保证了GPS信号误差对移动机器人的位置估计的影响降到最低。从仿真结果看出,当GPS信号发生突变时,该融合模型仍能提供相对准确的位置估计。在实验中还采用了不断优化、调整方向角并设置假想目标位置的导航算法,从而使得机器人在接近目标位置时不会迷失方向而达到理想的目标位置。试验结果表明:机器人的定位精度有很大提高,在自动导航时其行驶轨迹控制在5cm～10cm的误差范围内。