A dual-loop feedback trajectory tracking control for rock drilling hydraulically driven manipulator

Abstract

This paper is devoted to proposing a feedback trajectory tracking control method for hydraulically driven rock drilling robotic manipulators. The rock drilling robot has a large-scale long boom and multiple joints (6R-2P), so the deformation of the arm may not be neglected. A kinematic model with the flexible deformation of the boom is developed by adding a modified coordinate transformation matrix to the general model. Each joint motion is determined by solving the inverse kinematic model in an optimization algorithm, which aims at minimizing the positional error and smoothing the motion. A dual-loop feedback controller is proposed to track the end-effector’s position and orientation. Based on the model predictive control (MPC) method, the inner-loop controller controls the cylinder motion by controlling the cylinder motion. The outer-loop controller uses the fuzzy-PID control to correct the position error which is caused by the inner-loop controller. Several reference trajectories are designed to validate the effectiveness of the proposed dual-loop control strategy, which demonstrates it has higher accuracy and lower control fluctuation than single-loop and other dual-loop controllers.