The present application relates to a kind of plane five-pole closed-chain
rehabilitation robot elimination modeling and force mapping control method, belong to
rehabilitation robot control technical field.The method is aimed at the
coupling of active joint and
passive joint in plane five-pole closed-chain mechanism, control implementation difficulty under active
joint coordinates and the problem that driving torque is difficult to accurately map as end force, establishes closed-chain position constraint equation, obtains velocity constraint relationship by derivation to constraint equation, under the nonsingular condition of
passive joint constraint jacobian matrix,
passive joint variable is explicitly eliminated, constraint consistent jacobian matrix is constructed, reduced dynamics equation under active
joint coordinates is established, end force estimate is solved, and motor driving torque instruction is generated according to the end force estimate.The method is suitable for end
impedance control, trajectory tracking control and
rehabilitation training boost control of plane five-pole closed-chain
rehabilitation robot.