一种基于轮胎半径自适应的自动驾驶低速清扫车定位方法
摘要:
本发明涉及一种基于轮胎半径自适应的自动驾驶低速清扫车定位方法,包括以下步骤:1)根据GNSS状态判断子模块的GNSS状态的标志位,车辆航向角估计模块计算获得当前航向角ψk;2)轮胎半径估计模块采用卡尔曼滤波对车轮半径进行估计,得到轮胎半径估计值r;3)位置估计模块根据轮胎半径估计值r、轮速传感器测量得到的轮速信号ω以及传感器信号处理模块得到的当前航向角ψk对车辆位置进行在线实时估计,最终得到车辆位置估计值。与现有技术相比,本发明具有成本低廉易实现、位置估计准确、鲁棒性强等优点。
0/0