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

• Published in: Shanghai jiao tong da xue xue bao Vol. 28; no. 3; pp. 348 - 359
• Main Authors: Zhang, Kaibo, Chen, Li, Dong, Qi
• Format: Journal Article
• Language: English
• Published: Shanghai Shanghai Jiaotong University Press 2023; Springer Nature B.V; School of Air Transportation,Shanghai University of Engineering Science,Shanghai 201620,China%Function Teaching and Research Office,Mudanjiang Medical University,Mudanjiang 157011,Heilongjiang,China
• Subjects: Algorithms; Architecture; Computer Science; Constraint modelling; Electrical Engineering; Engineering; Health risks; Hybrid control; Jacobi matrix method; Jacobian matrix; Kinematics; Life Sciences; Manipulators; Materials Science; Medical personnel; Original Paper; Performance indices; Quadratic programming; Tracking errors; pseudoinverse (PI); pose tracking; TP 242; A; input-constrained hybrid control; 位姿跟踪; 二次规划; 伪逆; hyper-redundant mobile medical manipulator (HRMMM); 超冗余移动医疗机械臂; 输入受限的混合控制; quadratic programming (QP); quadratic programming(QP); hyper-redundant mobile medical manipulator(HRMMM); pseudo-inverse(PI)
• ISSN: 1007-1172; 1674-8115; 1995-8188
• DOI: 10.1007/s12204-023-2580-4

To reduce the risk of infection in medical personnel working in infectious-disease areas, we proposed a hyper-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 model of the HRMMM was established and its global Jacobian matrix was deduced. An expression of the tracking error based on the Rodrigues rotation formula was designed, and the relationship between tracking errors and gripper velocities was derived to ensure accurate object tracking. Considering the input constraints of the physical system, a joint-constraint model of the HRMMM was established, and the variable-substitution method was used to transform asymmetric constraints to symmetric constraints. All constraints were normalized by dividing by their maximum values. A hybrid controller based on pseudo-inverse (PI) and quadratic programming (QP) was designed to satisfy the real-time motion-control requirements in medical events. The PI method was used when there was no input saturation, and the QP method was used when saturation occurred. A quadratic performance index was designed to ensure smooth switching between PI and QP. The simulation results showed that the HRMMM could approach the target pose with a smooth motion trajectory, while meeting different types of input constraints.