Input-Constrained Hybrid Control of a Hyper-Redundant Mobile Medical Manipulator

To reduce the risk of infection in medical personnel working in infectious-disease areas, we proposed ahyper-redundant mobile medical manipulator (HRMMM) to perform contact tasks in place of healthcare workers.A kinematics-based tracking algorithm was designed to obtain highly accurate pose tracking. A kinematic modelof the HRMMM was established and its global Jacobian matrix was deduced. An expression of the trackingerror based on the Rodrigues rotation formula was designed, and the relationship between tracking errors andgripper velocities was derived to ensure accurate object tracking. Considering the input constraints of the physicalsystem, a joint-constraint model of the HRMMM was established, and the variable-substitution method was usedto transform asymmetric constraints to symmetric constraints. All constraints were normalized by dividing bytheir maximum values. A hybrid controller based on pseudo-inverse (PI) and quadratic programming (QP) wasdesigned to satisfy the real-time motion-control requirements in medical events. The PI method was used whenthere was no input saturation, and the QP method was used when saturation occurred. A quadratic performanceindex was designed to ensure smooth switching between PI and QP. The simulation results showed that theHRMMM could approach the target pose with a smooth motion trajectory, while meeting different types of inputconstraints.