基于A*和TEB融合的行人感知无碰跟随方法

doi:10.7527/S1000-6893.2020.24909

电子电气工程与控制

本期目录 | 过刊浏览 | 高级检索

前一篇 | 后一篇

基于A^*和TEB融合的行人感知无碰跟随方法

庞磊^1,2, 曹志强^1,2, 喻俊志^1,3

1. 中国科学院自动化研究所复杂系统管理与控制国家重点实验室, 北京 100190;
2. 中国科学院大学人工智能学院, 北京 100049;
3. 北京大学工学院先进制造与机器人系, 北京 100871

收稿日期:2020-10-21 修回日期:2020-11-12 发布日期:2020-11-27
通讯作者: 喻俊志 E-mail:junzhi.yu@ia.ac.cn
基金资助:
国家自然科学基金（61633020，61633017，61725305，61836015）

A pedestrian-aware collision-free following approach for mobile robots based on A^* and TEB

PANG Lei^1,2, CAO Zhiqiang^1,2, YU Junzhi^1,3

1. State Key Laboratory of Management and Control for Complex Systems, Institute of Automation, Chinese Academy of Sciences, Beijing 100190, China;
2. School of Artificial Intelligence, University of Chinese Academy of Sciences, Beijing 100049, China;
3. Department of Advanced Manufacturing and Robotics, College of Engineering, Peking University, Beijing 100871, China

Received:2020-10-21 Revised:2020-11-12 Published:2020-11-27
Supported by:
National Natural Science Foundation of China (61633020, 61633017, 61725305, 61836015)

摘要/Abstract

摘要： 移动机器人通过跟随一个指定行人实现导航是一种便捷的方式。针对行人跟随中的机器人跟随和避障问题，提出了一种基于路径规划的无碰跟随方法。该方法结合激光点云分割提供的非行人障碍信息生成静态障碍代价地图，并根据3D行人定位结果，利用基于无迹卡尔曼滤波器（Unscented Kalman Filter，UKF）和最近邻联合概率数据关联（Nearest Near Joint Probabilistic Data Association，NN-JPDA）的多行人跟踪器估计干扰行人运动状态，进而生成动态行人代价地图。在此基础上，基于A^*的全局规划器结合静态障碍代价地图输出指向目标行人的全局路径，而基于时间弹性带（TEB）算法的局部规划器也将动态行人代价地图纳入考虑范围以规划优化的局部路径，这能够帮助机器人实现行人感知的避障且跟随全局路径。通过低频全局规划与高频局部规划结合的方式实现对目标行人安全无碰的跟随。实验验证了所提方法的有效性。

关键词: 导航, 行人跟随, 路径规划, 避障, 运动状态估计, 无碰跟随

Abstract: Navigation by following a specified leader is a convenient way for mobile robots. To solve the problem of robot’s following with obstacle avoidance, a collision-free following approach based on path planning is proposed. The static obstacle cost map is generated according to the results of the point cloud segmentation. Multiple disturbing pedestrians are tracked based on the Unscented Kalman Filter (UKF) and Nearest Near Joint Probabilistic Data Association (NN-JPDA) to estimate their motion states, and then the dynamic pedestrian cost map is generated. On this basis, the A^*-based global planner plans a global path with the static obstacle cost map, whereas the local planner implemented with Timed-Elastic-Band (TEB) algorithm also takes the dynamic pedestrian cost map into account to plan an optimized local path. This local path tends to follow the global path and helps the mobile robot achieve pedestrian-aware obstacle avoidance. By combining low-frequency global planning with high-frequency local planning, the mobile robot realizes a safe and collision-free person following. The effectiveness of the proposed approach is validated by experiments.

Key words: navigation, person following, path planning, obstacle avoidance, motion estimation, collision-free following

中图分类号:

V249.32

庞磊, 曹志强, 喻俊志. 基于A^*和TEB融合的行人感知无碰跟随方法[J]. 航空学报, 2021, 42(4): 524909-524909.

PANG Lei, CAO Zhiqiang, YU Junzhi. A pedestrian-aware collision-free following approach for mobile robots based on A^* and TEB[J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2021, 42(4): 524909-524909.

参考文献

[1] 王晶, 顾维博, 窦立亚. 基于Leader-Follower的多无人机编队轨迹跟踪设计[J]. 航空学报, 2020, 41(S1):723758. WANG J, GU W B, DOU L Y. Leader-Follower formation control of multiple UAVs with trajectory tracking design[J]. Acta Aeronautica et Astronautica Sinica, 2020, 41(S1):723758(in Chinese).
[2] GROSS H M, DEBES K, EINHORN E, et al. Mobile robotic rehabilitation assistant for walking and orientation training of stroke patients:A report on work in progress[C]//IEEE International Conference on Systems, Man, and Cybernetics. Piscataway:IEEE Press, 2014:1880-1887.
[3] CHUNG W, KIM H, YOO Y, et al. The detection and following of human legs through inductive approaches for a mobile robot with a single laser range finder[J]. IEEE Transactions on Industrial Electronics, 2011, 59(8):3156-3166.
[4] FERREIRA B Q, KARIPIDOU K, ROSA F, et al. A study on trust in a robotic suitcase[C]//International Conference on Social Robotics, 2016:179-189.
[5] PERDOCH M, BRADLEY D M, CHANG J K, et al. Leader tracking for a walking logistics robot[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway:IEEE Press, 2015:2994-3001.
[6] 宋闯, 赵佳佳, 王康, 等. 面向智能感知的小样本学习研究综述[J]. 航空学报, 2020, 41(S1):723756. SONG C, ZHAO J J, WANG K, et al. A survey of few shot learning based on intelligent perception[J]. Acta Aeronautica et Astronautica Sinica, 2020, 41(S1):723756(in Chinese).
[7] 余铎, 王耀南, 毛建旭, 等. 基于视觉的移动机器人目标跟踪方法[J]. 仪器仪表学报, 2019, 40(1):227-235. YU D, WANG Y N, MAO J X, et al. Vision-based object tracking method of mobile robot[J]. Chinese Journal of Scientific Instrument. 2019, 40(1):227-235(in Chinese).
[8] 孟祥瑞. 基于多线激光雷达的移动机器人环境感知与导航控制研究[D]. 北京:中国科学院大学, 2018:49-63. MENG X R. Research on environmental perception and navigation control for mobile robots based on 3D LiDAR[D]. Beijing:University of Chinese Academy of Sciences, 2018:49-63(in Chinese).
[9] 梁栋, 高赛, 孙涵, 等. 结合核相关滤波器和深度学习的运动相机中无人机目标检测[J]. 航空学报, 2020, 41(9):323733. LIANG D, GAO S, SUN H, et al. UAV detection in motion cameras combining kernelized correlation filters and deep learning[J]. Acta Aeronautica et Astronautica Sinica, 2020, 41(9):323733(in Chinese).
[10] DOISY G, JEVTIC A, LUCET E, et al. Adaptive person-following algorithm based on depth images and mapping[C]//IROS Workshop on Robot Motion Planning. Piscataway:IEEE Press, 2012.
[11] HU J S, WANG J J, HO D M. Design of sensing system and anticipative behavior for human following of mobile robots[J]. IEEE Transactions on Industrial Electronics, 2013, 61(4):1916-1927.
[12] ISLAM M J, HONG J, SATTAR J. Person-following by autonomous robots:A categorical overview[J]. The International Journal of Robotics Research, 2019, 38(14):1581-1618.
[13] YOON Y, YOON H, KIM J. Depth assisted person following robots[C]//IEEE RO-MAN. Piscataway:IEEE Press, 2013:330-331.
[14] YUN W, KIM D, LEE J. Person following with obstacle avoidance based on multi-layered mean shift and force field method[C]//IEEE International Conference on Systems, Man and Cybernetics. Piscataway:IEEE Press, 2010:3813-3816.
[15] NIKDEL P, SHRESTHA R, VAUGHAN R. The hands-free push-cart:Autonomous following in front by predicting user trajectory around obstacles[C]//IEEE International Conference on Robotics and Automation. Piscataway:IEEE Press, 2018:4548-4554.
[16] TASAKI R, SAKURAI H, TERASHIMA K. Moving target localization method using foot mounted acceleration sensor for autonomous following robot[C]//IEEE Conference on Control Technology and Applications. Piscataway:IEEE Press, 2017:827-833.
[17] REDMON J, FARHADI A. YOLOv3:An incremental improvement[DB/OL]. arXiv preprint:1804.02767,2018.
[18] PANG L, CAO Z Q, YU J Z, et al. A robust visual person-following approach for mobile robots in disturbing environments[J]. IEEE Systems Journal, 2020, 14(2):2965-2968.
[19] PANG L, CAO Z Q, YU J Z, et al. An efficient 3D pedestrian detector with calibrated RGB camera and 3D LiDAR[C]//IEEE International Conference on Robotics and Biomimetics. Piscataway:IEEE Press, 2019:2902-2907.
[20] BLAIR W D, BRANDT-PEARCE M. NNJPDA for tracking closely spaced Rayleigh targets with possibly merged measurements[C]//Signal and Data Processing of Small Targets. Piscataway:IEEE Press, 1999:396-408.
[21] LU D V, HERSHBERGER D, SMART W D. Layered cost maps for context-sensitive navigation[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway:IEEE Press, 2014:709-715.
[22] HART P E, NILSSON N J, RAPHAEL B. A formal basis for the heuristic determination of minimum cost paths[J]. IEEE Transactions on Systems Science and Cybernetics, 1968, 4(2):100-107.
[23] RÖSMANN C, HOFFMANN F, BERTRAM T. Integrated online trajectory planning and optimization in distinctive topologies[J]. Robotics and Autonomous Systems, 2017, 88:142-153.

E-mail：hkxb@buaa.edu.cn

关于我们

期刊社服务

专业学科

封面文章

友情链接

主管单位：中国科学技术协会主办单位：中国航空学会北京航空航天大学

基于A^*和TEB融合的行人感知无碰跟随方法

A pedestrian-aware collision-free following approach for mobile robots based on A^* and TEB

RichHTML

PDF (PC)

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价

[1]	熊凯, 魏春岭, 李连升, 周鹏. 基于扩维QLEKF的脉冲星/星间定向组合导航[J]. 航空学报, 2023, 44(3): 526232-526232.
[2]	徐国栋, 张丹蕾, 徐振东. 脉冲星特征频率信号的到达时间处理方法[J]. 航空学报, 2023, 44(3): 526185-526185.
[3]	张大鹏, 呼延宗泊, 李恒年. 基于卫星实测数据的X射线脉冲星导航体制验证[J]. 航空学报, 2023, 44(3): 526510-526510.
[4]	周庆勇, 闫林丽, 李连升, 冯来平, 石永强, 孙鹏飞, 方柳, 王龙. XPNAV⁃1卫星聚焦型X射线脉冲星望远镜在轨稳定性分析[J]. 航空学报, 2023, 44(3): 526610-526610.
[5]	闫林丽, 葛明玉, 庹攸隶, 周庆勇, 叶文韬, 郑世界, 韩大炜. 5颗导航用X射线脉冲星计时分析[J]. 航空学报, 2023, 44(3): 526588-526588.
[6]	盛立志, 郑伟, 苏桐, 张大鹏, 王奕迪, 杨向辉, 徐能, 李治泽. “天枢Ⅱ号”X射线脉冲星导航动态模拟系统及实验验证[J]. 航空学报, 2023, 44(3): 526656-526656.
[7]	赵成仕, 高玉平, 童明雷, 朱幸芝, 罗近涛. 导航脉冲星星历表时空参考系统一性问题[J]. 航空学报, 2023, 44(3): 526580-526580.
[8]	苏剑宇, 方海燕, 高敬敬, 赵良. X射线脉冲星导航的最优观测周期确定[J]. 航空学报, 2023, 44(3): 526597-526597.
[9]	印俊秋, 刘云鹏, 汤晓斌. 基于仿脉冲星X射线信标的航天器定位方法[J]. 航空学报, 2023, 44(3): 526596-526596.
[10]	姜坤, 焦文海, 郝晓龙, 刘莹, 王奕迪, 张新源, 国际. 脉冲星试验01星科学试验与成果[J]. 航空学报, 2023, 44(3): 526611-526611.
[11]	韩大炜, 郑世界, 庹攸隶, 葛明玉, 宋黎明, 李新乔, 文向阳, 熊少林. 利用GECAM卫星Crab脉冲星观测数据的定轨分析[J]. 航空学报, 2023, 44(3): 526641-526641.
[12]	李保权, 李海涛, 曹阳, 桑鹏, 刘亚宁, 余道淳. 轻量化大面积嵌套聚焦型X射线望远镜[J]. 航空学报, 2023, 44(3): 526671-526671.
[13]	刘金胜, 王博, 宋娟, 王文丛, 李璟璟, 徐振华. Wolter‑I型X射线脉冲星探测器的空间环境本底分析[J]. 航空学报, 2023, 44(3): 526599-526599.
[14]	郑伟, 王禹淞, 姜坤, 王奕迪. X射线脉冲星导航方法研究综述[J]. 航空学报, 2023, 44(3): 527451-527451.
[15]	李连升, 梅志武, 谢军, 姜坤, 石永强, 曹振, 左富昌. X射线聚焦光学在脉冲星探测领域的应用[J]. 航空学报, 2023, 44(3): 528286-528286.

基于A*和TEB融合的行人感知无碰跟随方法

A pedestrian-aware collision-free following approach for mobile robots based on A* and TEB

RichHTML

PDF (PC)

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价

基于A^*和TEB融合的行人感知无碰跟随方法

A pedestrian-aware collision-free following approach for mobile robots based on A^* and TEB