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.
[1]ZHANG W, LI H, CUI L, et al. Research progress and development trend of surgical robot and surgical instrument arm [J]. The International Journal of Medical Robotics and Computer Assisted Surgery, 2021, 17(5): e2309.
[2]MAYETIN U, KUCUK S. A low cost 3-DOF force sensing unit design for wrist rehabilitation robots [J]. Mechatronics, 2021, 78: 102623.
[3]PETERS B S, ARMIJO P R, KRAUSE C, et al. Review of emerging surgical robotic technology [J]. Surgical Endoscopy, 2018, 32(4): 1636-1655.
[4]ZHAO F, YANG Z, LI X, et al. Extract executable action sequences from natural language instructions based on DQN for medical service robots [J]. International Journal of Computers Communications & Control, 2021, 16(2): 4115.
[5]LI Z, MORAN P, DONG Q, et al. Development of a tele-nursing mobile manipulator for remote caregiving in quarantine areas [C]//2017 IEEE International Conference on Robotics and Automation. Singapore: IEEE, 2017: 3581-3586.
[6]BOSTELMAN R, HONG T, MARVEL J. Survey of research for performance measurement of mobile manipulators [J]. Journal of Research of the National Institute of Standards and Technology, 2016, 121: 342-366.
[7]MATHEW S S, JISHA V R. Decentralized control of a slow moving mobile manipulator [C]//2022 IEEE International Conference on Signal Processing, Informatics, Communication and Energy Systems. Thiruvananthapuram: IEEE, 2022: 442-447.
[8]EGERSTEDT N, HU X. Coordinated trajectory following for mobile manipulation [C]//Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings. San Francisco: IEEE, 2000: 3479-3484.
[9]YAMAMOTO Y, YUN X. Coordinating locomotion and manipulation of a mobile manipulator [J]. IEEE Transactions on Automatic Control, 1994, 39(6): 1326-1332.
[10]HUANG Q, TANIE K, SUGANO S. Coordinated motion planning for a mobile manipulator considering stability and manipulation [J]. The International Journal of Robotics Research, 2000, 19(8): 732-742.
[11]KORAYEM M H, ESFEDEN R A, NEKOO S R. Path planning algorithm in wheeled mobile manipulators based on motion of arms [J]. Journal of Mechanical Science and Technology, 2015, 29(4): 1753-1763.
[12]SERAJI H. A unified approach to motion control of mobile manipulators [J]. The International Journal of Robotics Research, 1998, 17(2): 107-118.
[13]LI W, XIONG R. A hybrid visual servo control method for simultaneously controlling a nonholonomic mobile and a manipulator [J]. Frontiers of Information Technology & Electronic Engineering, 2021, 22(2): 141-154.
[14]GIFTTHALER M, FARSHIDIAN F, SANDY T, et al. Efficient kinematic planning for mobile manipulators with non-holonomic constraints using optimal control [C]//2017 IEEE International Conference on Robotics and Automation. Singapore: IEEE, 2017: 3411-3417.
[15]BUSS S R, KIM J S. Selectively damped least squares for inverse kinematics [J]. Journal of Graphics Tools, 2005, 10(3): 37-49.
[16]ZHANG X, FAN B, WANG C, et al. An improved weighted gradient projection method for inverse kinematics of redundant surgical manipulators [J]. Sensors, 2021, 21(21): 7362.
[17]CHAN T F, DUBEY R V. A weighted least-norm solution based scheme for avoiding joint limits for redundant manipulators [C]//IEEE International Conference on Robotics and Automation. Atlanta: IEEE, 1993: 395-402.
[18]WAN J, WU H T, MA R, et al. A study on avoiding joint limits for inverse kinematics of redundant manipulators using improved clamping weighted least-norm method [J]. Journal of Mechanical Science and Technology, 2018, 32(3): 1367-1378.
[19]TOSHANI H, FARROKHI M. Real-time inverse kinematics of redundant manipulators using neural networks and quadratic programming: A Lyapunov-based approach [J]. Robotics and Autonomous Systems, 2014, 62(6): 766-781.
[20]ZHANG Z, CHEN S, ZHU X, et al. Two hybrid end-effector posture-maintaining and obstacle-limits avoidance schemes for redundant robot manipulators [J]. IEEE Transactions on Industrial Informatics, 2020, 16(2): 754-763.
[21]KELEMEN M, VIRGALA I, LIPTA′K T, et al. A novel approach for a inverse kinematics solution of a redundant manipulator [J]. Applied Sciences, 2018, 8(11): 2229.
[22]FARONI M, BESCHI M, PEDROCCHI N, et al. Predictive inverse kinematics for redundant manipulators with task scaling and kinematic constraints [J]. IEEE Transactions on Robotics, 2019, 35(1): 278-285.
[23]FLACCO F, DE LUCA A, KHATIB O. Control of redundant robots under hard joint constraints: Saturation in the null space [J]. IEEE Transactions on Robotics, 2015, 31(3): 637-654.
[24]KIM K, NA M, SONG J B. Joint limit avoidance of a mobile manipulator for prevention of rapid velocity increase [C]//2021 18th International Conference on Ubiquitous Robots. Gangneung: IEEE, 2021: 244-248.
[25]LEORO J, HSIAO T. Motion planning of nonholonomic mobile manipulators with manipulability maximization considering joints physical constraints and self-collision avoidance [J]. Applied Sciences, 2021, 11(14): 6509.
[26]QUIROZ-OMAN?A J J, ADORNO B V. Whole-body kinematic control of nonholonomic mobile manipulators using linear programming [J]. Journal of Intelligent & Robotic Systems, 2018, 91(2): 263-278.
[27]ZHANG Z J, CHEN S Y, XIE J H, et al. Two hybrid multiobjective motion planning schemes synthesized by recurrent neural networks for wheeled mobile robot manipulators [J]. IEEE Transactions on Systems, Man, and Cybernetics: Systems, 2021, 51(5): 3270-3281.
[28]GALLEGO G, YEZZI A. A compact formula for the derivative of a 3-D rotation in exponential coordinates [J]. Journal of Mathematical Imaging and Vision, 2015, 51(3): 378-384.
[29]YU Y, DING X, ZHU J J. Attitude tracking control of a quadrotor UAV in the exponential coordinates [J]. Journal of the Franklin Institute, 2013, 350(8): 2044-2068.
[30]BENZAOUIA A, BENHAYOUN M, MESQUINE F. Stabilization of systems with unsymmetrical saturated control: An LMI approach [J]. Circuits, Systems, and Signal Processing, 2014, 33(10): 3263-3275.
[31]LI K, ZHANG Y. State adjustment of redundant robot manipulator based on quadratic programming [J]. Robotica, 2012, 30(3): 477-489.
