基于IMU的绳驱械臂臂段末端姿态等效控制方法及装置

本发明涉及一种基于IMU的绳驱械臂臂段末端姿态等效控制方法及装置，其中方法包括对期望的臂段两个旋转方向的总角度进行五次多项式插值，得到期望关节角度，基于正运动学计算，得到当前期望的末端姿态；获得当前联动臂段末端的实际姿态，得到当前末端姿态差；计算联动臂段当前角度差；输入PID控制器，输出角度控制量；将角度控制量映射为驱动绳索的速度，并再次映射为驱动电机的转速；输入所述电机控制器，所述电机控制器控制驱动电机按期望的转速转动。本发明解决现有技术中，对绳驱分段联动机械臂的联动臂段进行关节角度取平均值的闭环控制无法精确控制末端姿态，以及编码器占据机械臂内部较多空间的问题。