粒子群优化的手术机器人从手夹持力模糊控制

简介

利用扩展雅克比矩阵方法,在逆运动学中引入自运动向量,采用具有能量优化与避障约束的标量函数设计自运动向量,规划避障次级任务;为了减小机械手关节驱动器实际输出的峰值力矩,避免过大峰值力矩导致的转矩饱和,提出力矩峰值减小优化算法,该方法采用局部优化策略,使用当前转矩及给定约束优化下一状态转矩。通过平面3连杆机械手的仿真结果表明,机械手在笛卡尔空间完成轨迹跟踪主任务的同时,能有效避开障碍物,减小输出力矩峰值。