P-Rob Six-Degree-of-Freedom Robot Manipulator Dynamics Modeling and Anti-Disturbance Control

In this paper, the problem of modeling and anti-disturbance control is studied for lightweight personal robotics (P-Robs) with a six-degree-of-freedom robot manipulator to solve the movement instability phenomenon caused by time-varying uncertain disturbances during the movement of the robot manipulator. The detailed dynamical equations of the P-Rob system are solved based on the Lagrange energy equation, and the actual dynamical model of the robot manipulator system is obtained. The disturbance observer is designed to estimate the disturbance effectively, and an integral sliding mode control algorithm is proposed to realize tracking control. Stability analysis of the system is carried out using the Lyapunov function. Finally, experiments are conducted on an actual P-Rob system model, and the experimental results show that the robot manipulator system tracks the desired trajectory effectively, which validates the effectiveness of the proposed control algorithm.