绳驱动机械手抓取力自整定模糊PID控制

Self-tuning fuzzy PID control of grasping force of rope driven manipulator

针对绳驱动机械手传动存在线弹性形变、抓取力减小,易导致抓取目标震颤和滑落的问题,设计了一种自整定模糊PID抓取力控制算法。首先,建立了基于力控制的绳驱动机械手和直流电机的数学模型,并用Padé算法对控制系统的模型进行降阶;其次,通过Matlab的模糊控制工具箱设计了自整定模糊PID控制器;最后,利用Simulink环境分别建立了PID控制、模糊控制、自整定模糊PID控制算法的仿真模型,并实现了不同算法的抓取力控制仿真。仿真结果表明:自整定模糊PID抓取力控制算法可以在0.5 s内使系统达到稳定状态,稳态误差小于0.5%。当绳索发生回弹时能够在0.3 s内补偿抓取力,具有良好的动态性能,满足目标稳定抓取的要求。

A self-tuning fuzzy PID grab force control algorithm was designed to solve the problems of linear elastic deformation and reduced grab force of rope driven robot hand,which easily causes shake and slip of grab target.Firstly,the mathematical models of rope driven manipulator and DC motor based on force control were established,and the order of the control system model was reduced by Padéalgorithm.Secondly,the fuzzy technology was combined with PID control,and a self-tuning fuzzy PID controller was designed through the fuzzy control toolbox of Matlab.Finally,the simulation models of PID control,fuzzy control and self-tuning fuzzy PID control were established by using Simulink environment,and the grasping force control simulation of different algorithms was realized.The simulation results show that the algorithm can make the system reach a stable state within 0.5 s,and the steady-state error is less than 0.5%.When the rope rebounds,it can compensate the grasping force within 0.3 s,and has good dynamic performance,which meets the requirements of stable grasping of the target.