Smooth Obstacle-avoidance by 4-wheel Navigational Vehicle Using Non-360° Range Sensors
TAN Zhibin, ZHAO Zuoxi, ZHAO Ruqi, LI Jiaojiao, YU Long
Key Laboratory of Key Technology on Agricultural Machine and Equipment of South China Agricultural University, College of Engineering, South China Agricultural University, Guangzhou 510642, China
An obstacle-avoidance navigation algorithm based on bug algorithm is proposed for the vehicle using non-360° range sensors and having minimum turning radius. Then the vehicle can bypass obstacle edge along a continuous and smooth path and complete the fixed-goal navigation task. This algorithm uses "virtual antenna" to intuitively represent passable state in the front. The "tentacle algorithm" is used to analyze turning state, and the minimum turning radius of the vehicle is changed according to the surrounding environment to correct the turning route in real time. The test result on a Pioneer 3-AT wheeled robot show that the robot using the proposed algorithm can reach the fixed goal in an unknown environment without collision, and the trajectory is continuous and smooth. The algorithm solve the problem that bug algorithm cannot be used in this kind of vehicles.
[1] 王荣本,李斌,储江伟,等.世界智能车辆行驶安全保障技术的研究进展[J].公路交通科技,2002,19(2):117-121.Wang R B, Li B, Chu J W, et al. A review of the safety guarantee technology of worldwide intelligent vehicle[J]. Journal of Highway and Transportation Research and Development, 2002, 19(2): 117-121.[2] 孟江华,朱纪洪,孙增圻.未知环境下基于传感器的移动机器人路径规划新方法[J].机器人,2005,27(4):319-324.Meng J H, Zhu J H, Sun Z Q. A new path planning algorithm for sensor-based mobile robot in unknown environment[J]. Robot, 2005, 27(4): 319-324.[3] Lumelsky V J, Stepanov A A. Path-planning strategies for a point mobile automaton moving amidst unknown obstacles of arbitrary shape[J]. Algorithmica (New York), 1987, 2(4): 403-430.[4] Sankaranarayanan A, Vidyasagar M. A new path planning algorithm for moving a point object amidst unknown obstacles in a plane[C]//IEEE International Conference on Robotics and Automation. Piscataway, USA: IEEE, 1990: 1930-1936.[5] Sankaranarayanan A, Vidyasagar M. Path planning for moving a point object admidst unknown obstacles in a plane: A new algorithm and a general theory for algorithm development[C]// 29th IEEE Conference on Decision and Control. Piscataway, USA: IEEE, 1990: 1111-1119.[6] Kamon I, Rivlin E. Sensory-based motion planning with global proofs[J]. IEEE Transactions on Robotics and Automation, 1997, 13(6): 814-822. [7] Lumelsky V J, Skewis T. Incorporating range sensing in the robot navigation function[J]. IEEE Transactions on Systems, Man, and Cybernetics, 1990, 20(5): 1058-1069. [8] Kamon I, Rimon E, Rivlin E. TangentBug: A range-sensor-based navigation algorithm[J]. International Journal of Robotics Research, 1998, 17(9): 934-953. [9] Magid E, Rivlin E. CautiousBug: A competitive algorithm for sensory-based robot navigation[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA: IEEE, 2004: 2757-2762.[10] Choset H, Lynch K M, Hutchinson S, et al. Principles of robot motion: Theory, algorithms, and implementations[M]. Cambridge, UK: A Bradford Book, 2005.[11] 刘祥,陈建新.一种基于有限视场的移动机器人避障路径规划算法[J].空间控制技术与应用,2008,34(4):11-16.Liu X, Chen J X. A limited field-of-view based obstacle avoidance and path planning algorithm for mobile robots[J]. Aerospace Control and Application, 2008, 34(4): 11-16.[12] 郝宗波,洪炳熔.未知环境下基于传感器的移动机器人路径规划[J].电子学报,2006,34(5):953-956.Hao Z B, Hong B R. Sensor-based path planning for mobile robot in unknown environment[J]. Acta Electronica Sinica, 2006, 34(5): 953-956.[13] 赵祚喜,汪宁,张智刚,等.一种适用于非360°探测机器人的避障导航算法[J].机械工程学报,2010,46(19):44-52.Zhao Z X, Wang N, Zhan Z G, et al. Implementation of sensor-based navigation on mobile robots using non-360° range sensor[J]. Journal of Mechanical Engineering, 2010, 46(19): 44-52.[14] von Hundelshausen F, Himmelsbach M, Hecker F, et al. Driving with tentacles: Integral structures for sensing and motion[J]. Journal of Field Robotics, 2008, 25(9): 640-673. [15] 王珂珂,赵汗青,吕强,等.基于虚拟触角的自主车辆运动规划方法[J].装甲兵工程学院学报,2011,25(4):50-53.Wang K K, Zhao H Q, Lu Q, et.al. A motion planning method for autonomous land vehicles based on virtual tentacles[J]. Journal of Academy of Armored Force Engineering, 2011, 25(4): 50-53.[16] 牛润新,夏静霆,汪小华,等.智能车辆路径巡航和自主避障的触须算法[J].交通运输工程学报,2010,10(6):53-58.Niu R X, Xia J T, Wang X H, et al. Tentacle algorithm of obstacle avoidance and autonomous driving for intelligent vehicle[J]. Journal of Traffic and Transportation Engineering, 2010, 10(6): 53-58.[17] 余志生.汽车理论[M].3版.北京:机械工业出版社,2005.Yu Z S. The theory of automobile[M]. 3rd ed. Beijing: China Machine Press, 2005.