面向智能汽车的地下停车场定位与路径规划

李祎承; 杨东晓; 高翔; 马育林; 许述财

doi:10.37188/OPE.20233105.0757

您当前的位置：

首页 >

文章列表页 >

面向智能汽车的地下停车场定位与路径规划

路径规划 | 更新时间：2026-09-12

- 面向智能汽车的地下停车场定位与路径规划
- Location and path planning in underground parking lot for intelligent vehicles
- 光学精密工程 2023年31卷第5期页码：757-766
- 作者机构：
  
  1.江苏大学汽车工程研究院，江苏镇江 212013
  2.清华大学苏州汽车研究院（相城），江苏苏州 215133
  3.安徽工程大学机械工程学院，安徽芜湖 241000
  4.清华大学汽车安全与节能国家重点实验室，北京 100084
- 作者简介：
  
  李祎承（1988-），男，河北沧州人，副教授，博士生导师，2018年于武汉理工大学获得博士学位，主要从事智能汽车高精度定位技术。 E-mail： liyicheng070@ujs.edu.cn
  许述财（1978-），男，副研究员，博士，博士生导师，2007年于吉林大学学获得博士学位，主要从事智能汽车主被动安全技术。 E-mail：xushc@tsinghua.edu.cn
- 基金信息：
  
  国家重点研发计划项目(2018YFE0204302);国家自然科学基金(52272418;U20A20333;52002154);江苏省自然科学基金(BK20190853);江苏省重点研发计划(BE2020083-2;BE2021011-2)
- DOI：10.37188/OPE.20233105.0757
  中图分类号： TP391.4
- 收稿：2022-09-06，
  
  修回：2022-09-28，
  
  纸质出版：2023-03-10
- 稿件说明：
移动端阅览
李祎承,杨东晓,高翔等.面向智能汽车的地下停车场定位与路径规划[J].光学精密工程,2023,31(05):757-766.

LI Yicheng,YANG Dongxiao,GAO Xiang,et al.Location and path planning in underground parking lot for intelligent vehicles[J].Optics and Precision Engineering,2023,31(05):757-766.
李祎承,杨东晓,高翔等.面向智能汽车的地下停车场定位与路径规划[J].光学精密工程,2023,31(05):757-766. DOI： 10.37188/OPE.20233105.0757.

LI Yicheng,YANG Dongxiao,GAO Xiang,et al.Location and path planning in underground parking lot for intelligent vehicles[J].Optics and Precision Engineering,2023,31(05):757-766. DOI： 10.37188/OPE.20233105.0757.

摘要

为了解决智能车辆在全球定位系统（Global Positioning System， GPS）信号缺失的地下停车场中的定位与路径规划问题，本文使用双目离线建图、单目在线定位的视觉方法在场景中进行定位，并使用改进的路径规划算法规划全局行驶路线。首先，利用双目相机在地下停车场中的多个节点位置进行场景采集，节点的不同信息分层存储入视觉多层级地图。然后，利用单目相机进行由粗到精的地图匹配和位姿计算实现快速高精度定位。最后，使用改进的路径规划算法在地图中对各路口位置进行检测并生成路口路径图（Intersection Roadmap， IRM），全局可行驶路线根据定位结果和路径图规划得到。实验结果表明：使用单目相机的视觉定位平均误差为1.3 m，平均误差率为7.4%，基于路口路径图的规划算法相比概率路径图（Probabilistic Roadmap， PRM）算法，规划时间由5 s左右缩短至0.2 s以内，路径长度缩短了约9.56%。定位导航系统能够实时准确地实现车辆在停车场环境中的定位与路径规划，具备良好的实用性。

Abstract

To solve the location and path planning challenges for intelligent vehicles in GPS-restricted underground parking lots， we employ a vision-based approach that combines binocular offline mapping and monocular online localization to trace the intelligent vehicles within the scene. The improved path planning algorithm is used to plan the global route. First， the system uses a binocular camera to capture scenes at multiple nodes in the underground parking lot， which are then stored in different layers of a hierarchical map. The monocular camera is subsequently utilized to perform coarse-to-fine map matching and calculate the pose of the vehicle， ensuring high-speed and accurate positioning. Finally， the improved path planning algorithm is achieved by detecting intersections and generating a roadmap. The experimental results demonstrate that the average monocular positioning error and average error rate are 1.3 m and 7.4%， respectively， the planning time is reduced from approximately 5 s to less than 0.2 s， and the path length is shortened by approximately 9.56%. This positioning and navigation system is practical for real-time positioning and path planning of intelligent vehicles in parking lot environments.

关键词

Keywords

references

BADUE C ， GUIDOLINI R ， CARNEIRO R V ， et al . Self-driving cars： a survey ［J］. Expert Systems With Applications ， 2021 ， 165 ： 113816 . doi: 10.1016/j.eswa.2020.113816 http://dx.doi.org/10.1016/j.eswa.2020.113816

刘鹏飞 . 里程计辅助的高精度车载GNSS/INS组合导航系统［J］. 光学精密工程， 2020 ， 28 （ 4 ）： 979 - 987 .

LIU P F . High-precision vehicle GNSS/INS integrated navigation system aided by odometer ［J］. Opt. Precision Eng. ， 2020 ， 28 （ 4 ）： 979 - 987 . （in Chinese）

HOU X Y ， BERGMANN J . Pedestrian dead reckoning with wearable sensors： a systematic review ［J］. IEEE Sensors Journal ， 2021 ， 21 （ 1 ）： 143 - 152 . doi: 10.1109/jsen.2020.3014955 http://dx.doi.org/10.1109/jsen.2020.3014955

GU F Q ， KHOSHELHAM K ， YU C Y ， et al . Accurate step length estimation for pedestrian dead reckoning localization using stacked autoencoders ［J］. IEEE Transactions on Instrumentation and Measurement ， 2019 ， 68 （ 8 ）： 2705 - 2713 . doi: 10.1109/tim.2018.2871808 http://dx.doi.org/10.1109/tim.2018.2871808

KUNHOTH J ， KARKAR A ， AL-MAADEED S ， et al . Indoor positioning and wayfinding systems： a survey ［J］. Human-Centric Computing and Information Sciences ， 2020 ， 10 ： 18 . doi: 10.1186/s13673-020-00222-0 http://dx.doi.org/10.1186/s13673-020-00222-0

周楚霖，陈敬东，黄凡 . 基于无迹粒子滤波的WiFi-PDR融合室内定位技术［J］. 计算机科学， 2022 ， 49 （ S1 ）： 606 - 611 . doi: 10.11896/jsjkx.210700108 http://dx.doi.org/10.11896/jsjkx.210700108

ZHOU C L ， CHEN J D ， HUANG F . WiFi-PDR fusion indoor positioning technology based on unscented particle filter ［J］. Computer Science ， 2022 ， 49 （ S1 ）： 606 - 611 . （in Chinese） . doi: 10.11896/jsjkx.210700108 http://dx.doi.org/10.11896/jsjkx.210700108

孙森震，李广云，冯其强，等 . 可见光通信与双目视觉的室内定位［J］. 光学精密工程， 2020 ， 28 （ 4 ）： 834 - 843 .

SUN S Z ， LI G Y ， FENG Q Q ， et al . Indoor positioning based on visible light communication and binocular vision ［J］. Opt. Precision Eng. ， 2020 ， 28 （ 4 ）： 834 - 843 . （in Chinese）

LIU F ， LIU J ， YIN Y Q ， et al . Survey on WiFi-based indoor positioning techniques ［J］. IET Communications ， 2020 ， 14 （ 9 ）： 1372 - 1383 . doi: 10.1049/iet-com.2019.1059 http://dx.doi.org/10.1049/iet-com.2019.1059

YANG D G ， ZHU Z L ， ZHANG J C ， et al . The overview of human localization and vital sign signal measurement using handheld IR-UWB through-wall radar ［J］. Sensors （Basel， Switzerland）， 2021 ， 21 （ 2 ）： 402 . doi: 10.3390/s21020402 http://dx.doi.org/10.3390/s21020402

杜航原，郝燕玲，赵玉新，等 . 用概率假设密度滤波实现同步定位与地图创建［J］. 光学精密工程， 2011 ， 19 （ 12 ）： 3064 - 3073 . doi: 10.3788/ope.20111912.3064 http://dx.doi.org/10.3788/ope.20111912.3064

DU H Y ， HAO Y L ， ZHAO Y X ， et al . Implementation of SLAM by probability hypothesis density filter ［J］. Opt. Precision Eng. ， 2011 ， 19 （ 12 ）： 3064 - 3073 . （in Chinese） . doi: 10.3788/ope.20111912.3064 http://dx.doi.org/10.3788/ope.20111912.3064

尹芳，吴云 . 空间非合作旋转目标的模型重建与位姿优化［J］. 光学精密工程， 2019 ， 27 （ 8 ）： 1854 - 1862 . doi: 10.3788/ope.20192708.1854 http://dx.doi.org/10.3788/ope.20192708.1854

YIN F ， WU Y . Model reconstruction and pose optimization of non-cooperative rotating space target ［J］. Opt. Precision Eng. ， 2019 ， 27 （ 8 ）： 1854 - 1862 . （in Chinese） . doi: 10.3788/ope.20192708.1854 http://dx.doi.org/10.3788/ope.20192708.1854

TAHERI H ， XIA Z C . SLAM； definition and evolution ［J］. Engineering Applications of Artificial Intelligence ， 2021 ， 97 ： 104032 . doi: 10.1016/j.engappai.2020.104032 http://dx.doi.org/10.1016/j.engappai.2020.104032

KOLHATKAR C ， WAGLE K . Review of SLAM algorithms for indoor mobile robot with LIDAR and RGB-D camera technology ［C］. Innovations in Electrical and Electronic Engineering ， 2021 ： 397 - 409 . doi: 10.1007/978-981-15-4692-1_30 http://dx.doi.org/10.1007/978-981-15-4692-1_30

采国顺，刘昊吉，冯吉伟，等 . 智能汽车的运动规划与控制研究综述［J］. 汽车安全与节能学报， 2021 ， 12 （ 3 ）： 279 - 297 . doi: 10.3969/j.issn.1674-8484.2021.03.002 http://dx.doi.org/10.3969/j.issn.1674-8484.2021.03.002

CAI G S ， LIU H J ， FENG J W ， et al . Review on the research of motion planning and control for intelligent vehicles ［J］. Journal of Automotive Safety and Energy ， 2021 ， 12 （ 3 ）： 279 - 297 . （in Chinese） . doi: 10.3969/j.issn.1674-8484.2021.03.002 http://dx.doi.org/10.3969/j.issn.1674-8484.2021.03.002

李艳生，万勇，张毅，等 . 基于人工蜂群-自适应遗传算法的仓储机器人路径规划［J］. 仪器仪表学报， 2022 ， 43 （ 4 ）： 282 - 290 .

LI Y S ， WAN Y ， ZHANG Y ， et al . Path planning for warehouse robot based on the artificial bee colony-adaptive genetic algorithm ［J］. Chinese Journal of Scientific Instrument ， 2022 ， 43 （ 4 ）： 282 - 290 . （in Chinese）

陈秋莲，郑以君，蒋环宇，等 . 基于神经网络改进粒子群算法的动态路径规划［J］. 华中科技大学学报（自然科学版）， 2021 ， 49 （ 2 ）： 51 - 55 .

CHEN Q L ， ZHENG Y J ， JIANG H Y ， et al . Improved particle swarm optimization algorithm based on neural network for dynamic path planning ［J］. Journal of Huazhong University of Science and Technology （Natural Science Edition）， 2021 ， 49 （ 2 ）： 51 - 55 . （in Chinese）

肖金壮，余雪乐，周刚，等 . 一种面向室内AGV路径规划的改进蚁群算法［J］. 仪器仪表学报， 2022 ， 43 （ 3 ）： 277 - 285 .

XIAO J Z ， YU X L ， ZHOU G ， et al . An improved ant colony algorithm for indoor AGV path planning ［J］. Chinese Journal of Scientific Instrument ， 2022 ， 43 （ 3 ）： 277 - 285 . （in Chinese）

张韬，项祺，郑婉文，等 . 基于改进A * 算法的路径规划在海战兵棋推演中的应用［J］. 兵工学报， 2022 ， 43 （ 4 ）： 960 - 968 . doi: 10.12382/bgxb.2021.0209 http://dx.doi.org/10.12382/bgxb.2021.0209

ZHANG T ， XIANG Q ， ZHENG W W ， et al . Application of path planning based on improved A * algorithm in war gaming of naval warfare ［J］. Acta Armamentarii ， 2022 ， 43 （ 4 ）： 960 - 968 . （in Chinese） . doi: 10.12382/bgxb.2021.0209 http://dx.doi.org/10.12382/bgxb.2021.0209

秦旭，黄晓华，马东明，等 . 基于改进D * 算法的巡检机器人路径规划［J］. 组合机床与自动化加工技术， 2022 （ 6 ）： 10 - 13 .

QIN X ， HUANG X H ， MA D M ， et al . Path planning of inspection robot based on improved D * algorithm ［J］. Modular Machine Tool ＆ Automatic Manufacturing Technique ， 2022 （ 6 ）： 10 - 13 . （in Chinese）

吕进锋，马建伟，李晓静 . 基于改进的随机路径图及和声算法的舰船航线规划［J］. 控制理论与应用， 2020 ， 37 （ 12 ）： 2551 - 2559 . doi: 10.7641/CTA.2020.90979 http://dx.doi.org/10.7641/CTA.2020.90979

LÜ J F ， MA J W ， LI X J . Route planning based on improved probabilistic roadmap and harmony search ［J］. Control Theory ＆ Applications ， 2020 ， 37 （ 12 ）： 2551 - 2559 . （in Chinese） . doi: 10.7641/CTA.2020.90979 http://dx.doi.org/10.7641/CTA.2020.90979

王海芳，张瑶，朱亚锟，等 . 基于改进双向RRT * 的移动机器人路径规划算法［J］. 东北大学学报（自然科学版）， 2021 ， 42 （ 8 ）： 1065 - 1070， 1142 .

WANG H F ， ZHANG Y ， ZHU Y K ， et al . Mobile robot path planning based on improved bidirectional RRT * ［J］. Journal of Northeastern University （Natural Science）， 2021 ， 42 （ 8 ）： 1065 - 1070， 1142 . （in Chinese）

李新德，刘苗苗，徐叶帆，等 . 一种基于2D和3D SIFT特征级融合的一般物体识别算法［J］. 电子学报， 2015 ， 43 （ 11 ）： 2277 - 2283 .

LI X D ， LIU M M ， XU Y F ， et al . A recognition algorithm of generic objects based on FeatureLevel fusion of 2D and 3D SIFT descriptors ［J］. Acta Electronica Sinica ， 2015 ， 43 （ 11 ）： 2277 - 2283 . （in Chinese）

齐咏生，陈培亮，刘利强，等 . 基于单目视觉的动态环境同步定位与多地图构建算法［J］. 农业机械学报， 2022 ， 53 （ 4 ）： 280 - 292 . doi: 10.6041/j.issn.1000-1298.2022.04.030 http://dx.doi.org/10.6041/j.issn.1000-1298.2022.04.030

QI Y S ， CHEN P L ， LIU L Q ， et al . Simultaneous localization and multi-mapping algorithm in dynamic environment based on monocular vision ［J］. Transactions of the Chinese Society for Agricultural Machinery ， 2022 ， 53 （ 4 ）： 280 - 292 . （in Chinese） . doi: 10.6041/j.issn.1000-1298.2022.04.030 http://dx.doi.org/10.6041/j.issn.1000-1298.2022.04.030

李健，曹垚，王宗敏，等 . 融合k-means聚类和Hausdorff距离的散乱点云精简算法［J］. 武汉大学学报·信息科学版， 2020 ， 45 （ 2 ）： 250 - 257 .

LI J ， CAO Y ， WANG Z M ， et al . Scattered point cloud simplification algorithm integrating k-means clustering and Hausdorff distance ［J］. Geomatics and Information Science of Wuhan University ， 2020 ， 45 （ 2 ）： 250 - 257 . （in Chinese）

王中宇，李亚茹，郝仁杰，等 . 基于点特征的单目视觉位姿测量算法［J］. 红外与激光工程， 2019 ， 48 （ 5 ）： 169 - 176 . doi: 10.3788/irla201948.0517002 http://dx.doi.org/10.3788/irla201948.0517002

WANG Z Y ， LI Y R ， HAO R J ， et al . Monocular vision pose measurement algorithm based on points feature ［J］. Infrared and Laser Engineering ， 2019 ， 48 （ 5 ）： 169 - 176 . （in Chinese） . doi: 10.3788/irla201948.0517002 http://dx.doi.org/10.3788/irla201948.0517002

李霞，苏筠皓，岳振超，等 . 基于中值点Hough变换玉米行检测的导航线提取方法［J］. 农业工程学报， 2022 ， 38 （ 5 ）： 167 - 174 . doi: 10.11975/j.issn.1002-6819.2022.05.020 http://dx.doi.org/10.11975/j.issn.1002-6819.2022.05.020

LI X ， SU J H ， YUE Z C ， et al . Extracting navigation line to detect the maize seedling line using Median-point Hough transform ［J］. Transactions of the Chinese Society of Agricultural Engineering ， 2022 ， 38 （ 5 ）： 167 - 174 . （in Chinese） . doi: 10.11975/j.issn.1002-6819.2022.05.020 http://dx.doi.org/10.11975/j.issn.1002-6819.2022.05.020

骆开庆，邓军灿，蔡伟博，等 . 基于Shi-Tomasi角点验证的线段提取算法优化方法［J］. 华南师范大学学报（自然科学版）， 2022 ， 54 （ 1 ）： 113 - 121 .

LUO K Q ， DENG J C ， CAI W B ， et al . Line segment extraction algorithm optimization based on Shi-tomasi corner detector ［J］. Journal of South China Normal University （Natural Science Edition）， 2022 ， 54 （ 1 ）： 113 - 121 . （in Chinese）

浏览量

1800

下载量

CSCD

文章被引用时，请邮件提醒。

提交

工具集

关联资源

改进特征点匹配与蚁群优化的微操作控制方法

基于空间约束的差动共焦离轴非球面自适应测量方法

基于激光雷达点云地图的车辆定位与导航

两栖球形机器人的路径规划策略

基于控制变量参数化方法的自由漂浮空间机器人路径规划研究