一种作业型ROV六自由度运动控制方法

本发明属于无人水下机器人运动控制技术领域,具体涉及一种过驱动作业型遥控水下机器人的作业型ROV六自由度运动控制方法。本发明包括：建立ROV水动力学模型；建立作业型ROV在六个自由度方向的控制力和力矩向量；计算本体坐标系{b}中作业型ROV的运动状态；建立ROV的运动学方程；将ROV本体坐标系中的角速度运动状态转化为大地坐标系中来表示；将ROV本体坐标系中的角位移状态转化为大地坐标系中来表示；根据输入的大地坐标系中的ROV期望航向角,计算在本体坐标系中ROV的期望航向角。本发明中可以逼真的模拟通过外部控制输入来操纵作业型ROV运动及姿态变化的过程,具有能够逼真的模拟水下作业过程中ROV的各种运动及控制参数变化过程的优点。