蛇形水下机器人的模型构建方法、控制方法及设备

本发明提供了一种蛇形水下机器人的模型构建方法、控制方法及设备，涉及水下机器人技术领域，基于所述蛇形水下机器人，所述蛇形水下机器人包括互相连接的基座、连杆和关节，所述蛇形水下机器人的模型构建方法包括：获取所述蛇形水下机器人的水下机器人坐标系，其中，所述水下机器人坐标系包括连杆坐标系、推进器坐标系和世界坐标系；基于雅可比矩阵，根据所述水下机器人坐标系得到运动学方程；根据所述运动学方程得到动力学方程；通过所述动力学方程得到蛇形水下机器人模型。本发明实现了提高蛇形水下机器人的控制精度。