绳驱柔性机械臂的闭环运动控制方法及系统

摘要

本发明涉及绳驱柔性机械臂的闭环运动控制方法和系统。其中方法包括：获取绳驱柔性机械臂当前时刻的期望目标构型；根据绳驱柔性机械臂运动学模型计算得到要形成的期望目标构型的期望绳长；根据电机编码器数据，计算当前的电机演算绳长；通过臂杆组件中的关节编码器数据，获取等效绳长；将电机演算绳长与期望绳长的差值进行绳长闭环控制的输入量，将输出的绳长控制量进一步转换为电机的旋转角度值，以作为电机位置闭环输入量；通过电机位置闭环控制的方式，根据电机位置闭环输入量，输出驱动电机的PWM波，以驱动电机带动绳索运动。其中的系统包括运动控制器以实施上述控制方法。本发明能够显著提升绳驱柔性机械臂的运动控制精度。