Dynamic Modelling and Continuous Trajectory Tracking Control of Space Robots Based on Lie Group SE(3)

Figure 2

PD control block diagram based on the Jacobi matrix.