[发明专利]基于柔性执行器驱动的机器人串级抗干扰控制方法及系统

摘要

本发明公开了一种基于柔性执行器驱动的机器人串级抗干扰控制方法，所述机器人包括臂侧位置控制器和电机侧位置控制器，臂侧位置控制器和电机侧位置控制器以串级方式相连，所述控制方法包括：获取臂侧实际位置q；获取电机侧实际位置θ；根据所述臂侧实际位置q与臂侧参考位置qr以及所述臂侧位置控制器得到电机侧参考位置θr；根据所述电机侧参考位置θr与所述电机侧实际位置θ以及所述电机侧位置控制器得到电机侧位置控制器的输出电压u；根据所述电机侧位置控制器的输出电压u驱动所述机器人。本发明相比传统的柔性执行器驱动的机器人控制方法，该控制方法算法简单，结构容易实现，系统可以达到良好的动态性能和稳态性能。