汽车工程 ›› 2022, Vol. 44 ›› Issue (7): 1009-1017.doi: 10.19562/j.chinasae.qcgc.2022.07.007

所属专题: 智能网联汽车技术专题-感知&HMI&测评2022年

• • 上一篇    下一篇

视觉与单路侧单元辅助的车辆定位方法

盛树轩,荆崇波,蒋朝阳()   

  1. 北京理工大学机械与车辆学院,北京  100081
  • 收稿日期:2021-12-07 修回日期:2022-02-18 出版日期:2022-07-25 发布日期:2022-07-20
  • 通讯作者: 蒋朝阳 E-mail:cjiang@bit.edu.cn
  • 基金资助:
    国家自然科学基金(52002026)

Vision and Single RSU Assisted Vehicle Positioning Method

Shuxuan Sheng,Chongbo Jing,Chaoyang Jiang()   

  1. School of Mechanical Engineering,Beijing Institute of Technology,Beijing  100081
  • Received:2021-12-07 Revised:2022-02-18 Online:2022-07-25 Published:2022-07-20
  • Contact: Chaoyang Jiang E-mail:cjiang@bit.edu.cn

摘要:

为准确获取在城市峡谷等GNSS定位受限环境下的车辆位置,提出了一种视觉与单路侧单元(RSU)辅助的车辆定位方法。利用相机观测车辆到车道线的横向距离,利用单RSU与车辆进行测距与通信,通过误差状态卡尔曼滤波算法对GNSS、IMU、RSU和相机观测信息进行融合,实现对车辆位姿的准确估计。针对上述方法进行了实车测试,分析了单RSU测距信息和横向距离观测对定位结果的影响。结果表明:单RSU测距信息可有效降低纵向定位误差,但对横向定位误差的修正作用随着远离RSU逐渐降低,横向距离观测可有效弥补这一不足。二者优势互补,水平定位均方根误差小于10 cm,验证了所提出方法的有效性。

关键词: 车辆定位, 视觉测距, 路侧单元, 误差状态卡尔曼滤波

Abstract:

To accurately acquire the vehicle location in the GNSS restricted environment such as urban canyon, a visual vehicle locating method is proposed with single road side unit (RSU) assisted. A camera is used to measure the lateral distance from the vehicle to the lane lines, and the RSU and vehicle are interacted for the distance measurement and communications. The information of GNSS, IMU, RSU and camera observed are fused through the error state Kalman filtering algorithm to fulfill the accurate estimation of the location and orientation of vehicle. Real vehicle tests are conducted to analyze the effects of the ranging information of single RSU and the lateral distance measured on positioning results. The results show that the ranging information of single RSU can effectively reduce the longitudinal positioning error, but its correction effects of lateral positioning error gradually reduce with the increase of the distance from RSU. This defect can be effectively remedied by lateral distance measurement, and complementing both advantages results in a root mean square error in horizontal positioning less than 10 cm, verifying the effectiveness of the method proposed.

Key words: vehicle positioning, visual ranging, road side unit, error state Kalman filtering