一种水下作业机器人复合人机共享协同控制方法

本发明公开了一种水下作业机器人复合人机共享协同控制方法，包括机器人建模阶段、信息采集阶段、运动映射阶段、任务分配阶段、任务优先级分离式共享控制阶段和力反馈阶段，其中，任务分配阶段将任务分为关节约束任务、混合共享全身协同控制任务和姿态优化任务；关节约束任务由自主系统控制，用于防止机器人的自碰撞；混合共享全身协同控制任务集中于水下机械臂末端的运动控制，水下机械臂末端通过混合共享控制方法进行控制，融合操作员和自主系统的输入，并对水下车辆和水下机械臂进行运动分配；姿态优化任务由自主系统控制，用于帮助操作员调整视角。本发明可以自动实现自我避障和辅助姿态调整，并且在末端操作任务中实现人机共享控制。