Energy-Based Trajectory Tracking Control of a Six-DOF Robotic Manipulator Using the Port-Hamiltonian Framework

Structure-preserving trajectory tracking control for a six-degree-of-freedom robotic manipulator is developed within the port-Hamiltonian framework. Error Hamiltonian is constructed by incorporating configuration and momentum tracking errors into the system energy. Based on this formulation, a momentum-based tracking controller with feedforward compensation and damping injection is derived without coordinate transformations or matching conditions. A disturbance estimator is further introduced to compensate unknown external torques. Energy-based analysis proves nominal closed-loop stability and uniform ultimate boundedness in the presence of estimation errors. Simulation results on a full rigid-body manipulator demonstrate accurate trajectory tracking under coupled and high-speed joint motions.