基于车辆二自由度单轨模型进行航位推算,并在此基础上,用扩展卡尔曼滤波方法融合环视相机检测结果设计了一种自主泊车定位及库位跟踪算法,可利用低成本传感器在地下车库环境下实时估计车辆位姿,同时优化环视相机库位角点的检测结果。仿真及试验结果表明,提出的定位及库位跟踪算法可以有效减小车辆运动数据噪声,提供更准确的车辆库位相对位置,为后续的规划和控制提供精度更高的定位结果。
科研之友
微信
新浪微博
Facebook
分享链接
