This invention relates to a method for
elimination modeling and force mapping control of a planar five-bar closed-chain
rehabilitation robot, belonging to the field of
rehabilitation robot control technology. This method addresses the problems of
coupling between active and passive joints in planar five-bar closed-chain mechanisms, difficulties in achieving control in active
joint coordinates, and the difficulty in accurately mapping driving torque to end-
effector force. It establishes closed-chain position constraint equations, obtains velocity constraint relationships by differentiating the constraint equations, explicitly eliminates
passive joint variables under the condition that the
passive joint constraint Jacobian matrix is non-singular, constructs a constraint-consistent Jacobian matrix, establishes reduced dynamic equations in active
joint coordinates, obtains the estimated end-
effector force, and generates
motor drive torque commands based on the estimated end-
effector force. This method is applicable to end-effector
impedance control, trajectory tracking control, and
rehabilitation training assistance control of planar five-bar closed-chain rehabilitation robots.