摘要：针对串联型机械臂关节空间内的轨迹跟踪控制,提出了一种自适应鲁棒容错控制方法。在机械臂动力学模型中加入了外界干扰、关节摩擦与故障模型,并将其等价成二阶被控系统。在此基础上,结合非奇异快速终端滑模面和反步法控制策略,设计一种新型的反步非奇异快速终端滑模控制器。通过李亚普诺夫准则验证了控制策略的全局渐近稳定性;引入自适应技术估计系统不确定性的上界,提高控制器的鲁棒性。以二自由度机械臂为被控对象,对所设计控制器的有效性进行了验证,结果表明:与传统的非奇异快速终端滑模控制器及反步非奇异快速终端滑模控制器相比,该控制器具有响应速度快、鲁棒性强、抖振小的优点,能有效应对系统故障和实现机械臂的高精度轨迹跟踪控制。

摘要：目的本文根据多自由度机械臂在外科手术、康复训练中与操作人员进行实时力位交互的需求,设计了一种具有工具重力补偿功能的机械臂力控牵引方法。方法首先通过安装在机械臂末端的六自由度力传感器检测作用在末端工具上的牵引力,然后应用上位机中的力-位与力-速控制算法将力信息转化为机械臂末端预期位姿偏移量并更新机械臂末端运动速度,进而控制机械臂沿受力方向运动。本文进一步提出一种末端工具重力补偿算法,能够有效补偿机械臂末端工具重力在力传感器上的偏差值。结果实验模拟无框架立体定向手术的患者注册环节,在无牵引力作用时上位机补偿后的外力值控制在±0.2N以内,最大力控循环采样率30Hz,最大系统延迟52ms。结论通过牵引力控制能够方便地对机械臂实现力控牵引摆位及运动过程中的紧急避障,重力补偿效果明显。