DOI QR코드

DOI QR Code

A Fusion Algorithm of Pure Pursuit and Velocity Planning to Improve the Path Following Performance of Differential Driven Robots in Unstructured Environments

차동 구동형 로봇의 비정형 환경 주행 경로 추종 성능 향상을 위한 Pure pursuit와 속도 계획의 융합 알고리즘

  • Bongsang Kim (Autonomous Vehicle & Intelligent Robotics Program, Hongik University) ;
  • Kyuho Lee (Autonomous Vehicle & Intelligent Robotics Program, Hongik University) ;
  • Seungbeom Baek (Autonomous Vehicle & Intelligent Robotics Program, Hongik University) ;
  • Seonghee Lee (Hanwha Systems Co., Ltd.) ;
  • Heechang Moon (Mechanical and System Design Engineering, Hongik University)
  • Received : 2023.05.27
  • Accepted : 2023.07.26
  • Published : 2023.08.31

Abstract

In the path traveling of differential-drive robots, the steering controller plays an important role in determining the path-following performance. When a robot with a pure-pursuit algorithm is used to continuously drive a right-angled driving path in an unstructured environment without turning in place, the robot cannot accurately follow the right-angled path and stops driving due to the ground and motor load caused by turning. In the case of pure-pursuit, only the current robot position and the steering angle to the current target path point are generated, and the steering component does not reflect the speed plan, which requires improvement for precise path following. In this study, we propose a driving algorithm for differentially driven robots that enables precise path following by planning the driving speed using the radius of curvature and fusing the planned speed with the steering angle of the existing pure-pursuit controller, similar to the Model Predict Control control that reflects speed planning. When speed planning is applied, the robot slows down before entering a right-angle path and returns to the input speed when leaving the right-angle path. The pure-pursuit controller then fuses the steering angle calculated at each path point with the accelerated and decelerated velocity to achieve more precise following of the orthogonal path.

Keywords

Acknowledgement

This work was supported by Korea Research Institute for defense Technology planning and advancement (KRIT) grant funded by the Korea government (DAPA (Defense Acquisition Program Administration)) (No. KRIT-CT-21-009, Development of Realtime Automatic Mission Execution and Correction Technology based on Battlefield Information, 2022)

References

  1. R. C. Coulter, "Implementation of the pure pursuit path tracking algorithm," Carnegie Mellon Univ., Pittsburgh, PA, USA, Rep. CMU-RI-TR-92-01, Jan., 1992, [Online], https://www.ri.cmu.edu/publications/implementation-of-the-pure-pursuit-path-trackingalgorithm. 
  2. T. W. Kim and H. J. Kim, "Path Tacking Control for a Skid-steer Vehicle using Learning-based Model Predictive Control," Journal of Institute of Control, Robotics and Systems, Seoul, Korea, pp. 181-182, 2016, [Online], http://www.dbpia.co.kr/Article/NODE06649521. 
  3. C. Woo, M. Lee, and T. Yoon, "Robust Trajectory Tracking Control of a Mecanum Wheeled Mobile Robot Using Impedance Control and Integral Sliding Mode Control," Journal of Korea Robotics Society, vol. 13, no. 4, pp. 256-264, Dec., 2018, DOI: 0.7746/jkros.2018.13.4.256.  https://doi.org/10.7746/jkros.2018.13.4.256
  4. I. Hwang, S. Ko, M. Kim, Y. Shin, and D. Lee, "Development of a New Kinematic Model of Mobile Robot for Improving Trajectory-tracking Performances in Rough Terrains," Journal of Mechanical Science and Technology, Jeongseon, Korea, pp. 2722-2725, 2016, [Online], http://www.dbpia.co.kr/Article/NODE07105202.  105202
  5. W. B. Baek and W. H. Kim, "A Study on Robust Trajectory Tracking Control of a Skid Steering Robots," Journal of the Korean Society of Manufacturing Technology Engineers, vol. 19, no. 1, pp. 121-127, Feb., 2010, [Online], http://www.dbpia.co.kr/Article/NODE01370083. 
  6. J. M. Snider, "Automatic steering methods for autonomous automobile path tracking," Carnegie Mellon Univ., Pittsburgh, PA, USA, Rep. CMU-RI-TR-09-08, Feb., 2009, [Online], https://www.ri.cmu.edu/pub_files/2009/2/Automatic_Steering_Methods_for_Autonomous_Automobile_Path_Tracking.pdf. 
  7. B. Kim, S. Cho, and H. Moon, "Slip Detection and Control Algorithm to Improve Path Tracking Performance of Four- Wheel Independently Actuated Farming Platform," Journal of Korea Robotics Society, vo1. 15, no. 3, pp. 221-232, Sept., 2020, DOI: 10.7746/jkros.2020.15.3.221. 
  8. J.-H. Kim, M.-J. Kim, S.-W. Beak, and J.-H. Kim, "Development of Leader-Follower Tracked Vehicle for Agriculture Convertgence of Skid Steering and Pure Pursuit using β Compensation Coefficient," Journal of Institute of Control Robotics and Systems, vol. 24, no. 11, pp. 1033-1042, 2018, DOI: 10.5302/J.ICROS.2018.18.0163. 
  9. Y. S. Kim and W. B. Cho, "A Study on the Relationship Between Road Design, Operation and Posted Speeds," Journal of Korean Society of Transportation, vo1. 23, no. 7, pp. 35-42, Dec., 2005, [Online], https://www.dbpia.co.kr/journal/articleDetail?nodeId=NODE07500556 
  10. J.-H. Kim, H. W. Kim, and J. Lee, "Development of Navigation Algorithm based on the Geometric Method for Self-Driving of the Tracked Vehicle: Convergence of Skid Steering and Pure Pursuit Using Compensation Coefficients," The Korean Society of Automotive Engineers Conference, pp. 738-742, Nov., 2020, [Online], https://www.dbpia.co.kr/journal/articleDetail?nodeId=NODE10519447. 
  11. K. Lee, B. Kim, H. Choi, and H. Moon, "Development of Path Tracking Algorithm and Variable Look Ahead Distance Algorithm to Improve the Path-Following Performance of Autonomous Tracked Platform for Agriculture," Journal of Korea Robotics Society, vo1. 17, no. 2, pp. 142-151, Jun., 2020, DOI : 10.7746/jkros.2022.17.2.142.