一种超声波辅助融合定位的无人车导航纠偏方法
发布时间: 2022-04-27
基本信息
本发明公开了一种超声波辅助融合定位的无人车导航纠偏方法,包括S1、以无人车自身坐标系建立车身坐标系;S2、在无人车上安装信息采集装置和超声波传感器,采集并计算无人车的位姿信息以及所在空间的环境信息;S3、对无人车的位姿信息进行扩展卡尔曼滤波融合,得到融合后的位姿;S4、将超声波传感器的量测数据结合融合后的位姿,比较导航过程中左右两侧前后超声波与墙壁距离关系以及无人车融合后的位姿,并根据无人车与左右墙体之间的相对位置关系判断车体是否偏移;S5、判断车体偏移后停止导航并下发转向角度w,将无人车矫正到与左右障碍平面平行的关系再继续导航。本发明可有效降低传感器测量过程随机噪声,极大减少无人车与行进途中本体左右的墙体发生碰撞的概率。
Copyright © 2022 中国科学技术协会 版权所有 | 京ICP备16016202号-20