一种血管介入手术机器人的主从位置自适应跟踪控制方法

摘要

本发明涉及一种血管介入手术机器人的主从位置自适应跟踪控制方法，首先，建立了主手端操作机构动力学模型和从手端递送机构动力学模型，然后将递送机构轴向运动模型的线性部分和非线性部分分开考虑，求解了滑模控制的等效控制量和鲁棒控制量，在滑模控制的基础上，针对不确定上下界的扰动，设计了自使用滑模控制方法，与现有技术相比，本发明能明显的减小系统的抖动和控制偏差，提高了控制效果，从而提高主从位置跟踪的性能。