Dynamics motion simulation of the Hermes robot arm subjected to constraints

During operations with a manipulator arm situations will occur when the manipulator end-effector is, or comes, in contact with its environment. The dynamics equations, which describe the motion of the manipulator, can be represented by an ordinary differential equation for the free motion and an additional algebraic (in)equality for the motion...