基于相对雅可比的水下双臂机器人自适应抗扰协调规划方法及系统

本发明涉及一种基于相对雅可比的水下双臂机器人自适应抗扰协调规划方法及系统，该方法包括：根据相对雅可比矩阵建模方法，建立水下双臂机器人的运动学方程；考虑谐波噪声的影响，设计补偿谐波噪声的自适应抗噪动态系统；根据水下双臂机器人协调运动规划的需求，在运动学方程中引入自适应抗噪动态系统和水下双臂机器人末端执行器的位姿误差后求解该运动学方程，得到自适应抗扰协调规划计算结果，以相应驱动水下双臂机器人完成协调规划任务。与现有技术相比，本发明能够有效提高水下双臂机器人运动控制的抗噪性能，提升协调规划任务的准确性和稳定性，提高水下双臂机器人在谐波噪声干扰复杂条件下顺利完成协调运动规划任务的能力。