Development of Optimal Path Planning for Automated Excavator

자동화 굴삭기 최적경로 생성 알고리즘 개발

The paper focuses on the establishment of optimized bucket path planning and trajectory control designated for force-reflecting backhoe reacting to excavation environment, such as potential obstacles and ground characteristics. The developed path planning method can be used for precise bucket control, and more importantly for obstacle avoidance which is directly related to safety issues. The platform of this research was based on conventional papers regarding the kinematic model of excavator. Jacobian matrix was constructed to find optimal joint angles and rotation angles of bucket from position and orientation data of excavator. By applying Newton-Raphson method optimal joint angles and bucket orientation were derived simultaneously in the way of minimizing positional errors of excavator. The model presented in this paper was intended to function as a cornerstone to build complete and advanced path planning of excavator by implementing soil mechanics and further study of excavator dynamics together.