J Shanghai Jiaotong Univ Sci ›› 2023, Vol. 28 ›› Issue (3): 348-359.doi: 10.1007/s12204-023-2580-4

• • 上一篇    下一篇

输入受限的超冗余移动医疗机械臂混合控制

张凯波1,陈丽1,董琦2   

  1. (1.上海工程技术大学 航空运输学院,上海201620;2. 牡丹江医学院 医学机能教研室,黑龙江 牡丹江157011)
  • 收稿日期:2022-06-02 修回日期:2022-09-05 接受日期:2023-05-28 出版日期:2023-05-28 发布日期:2023-05-22

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

ZHANG Kaibo1(张凯波),CHEN Li1*(陈丽),DONG Qi2(董琦)   

  1. (1. School of Air Transportation, Shanghai University of Engineering Science, Shanghai 201620, China; 2. Function Teaching and Research Office, Mudanjiang Medical University, Mudanjiang 157011, Heilongjiang, China)
  • Received:2022-06-02 Revised:2022-09-05 Accepted:2023-05-28 Online:2023-05-28 Published:2023-05-22

摘要: 为降低医务人员在传染病区域工作的感染风险,提出了采用超冗余移动医疗机械臂(HRMMM)代替医务人员在医疗服务中执行接触性任务。设计了一种基于运动学的姿态跟踪算法,以实现高精度的位姿跟踪。建立了HRMMM的运动学模型,推导了其整体雅可比矩阵。为了保证准确的目标跟踪,设计了基于罗德里格斯旋转公式的跟踪误差,并推导了跟踪误差与夹爪速度之间的关系。考虑到物理的输入约束,建立了HRMMM的关节约束模型,采用变量替换法将非对称约束转换为对称约束,所有约束都通过除以其最大值进行无量纲化。为了满足医疗事件中的实时运动控制要求,设计了一种基于伪逆(PI)和二次规划(QP)的混合控制器,无输入约束饱和时采用PI方法,出现约束饱和时采用QP方法。设计二次性能指标保证PI和QP之间的平滑切换。仿真结果表明HRMMM可以在满足在不同类型的输入约束情况下,以平滑的运动轨迹接近目标姿态。

关键词: 输入受限的混合控制,超冗余移动医疗机械臂,伪逆,二次规划,位姿跟踪

Abstract: 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.

Key words: input-constrained hybrid control, hyper-redundant mobile medical manipulator (HRMMM), pseudoinverse (PI), quadratic programming (QP), pose tracking

中图分类号: