一种基于误差四元数反馈的ROV姿态控制方法
基本信息
申请号 | CN201610108631.4 | 申请日 | - |
公开(公告)号 | CN105619394A | 公开(公告)日 | 2016-06-01 |
申请公布号 | CN105619394A | 申请公布日 | 2016-06-01 |
分类号 | B25J9/04(2006.01)I;B63C11/52(2006.01)I | 分类 | 手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手; |
发明人 | 温泉;宋晓暖;曹雪峰;徐兴洲;孙伟志;熊海霞 | 申请(专利权)人 | 青岛海山海洋装备有限公司 |
代理机构 | 北京和信华成知识产权代理事务所(普通合伙) | 代理人 | 胡剑辉 |
地址 | 266109 山东省青岛市高新区松园路17号A4楼301室 | ||
法律状态 | - |
摘要
摘要 | 本发明公开一种基于误差四元数反馈的ROV姿态控制方法,建立惯性坐标系和ROV的运动坐标系;并对其三自由度旋转姿态进行建模;姿态传感器对ROV进行检测输出姿态四元数,ROV的当前四元数与目标四元数对比,求出误差四元数;输入PID控制器,计算得出ROV运动坐标系中三个轴上所需的力矩,处理器根据所需力矩控制推进器电机的电压,产生相应的推力,完成ROV的姿态调整,使ROV完成360°无死角旋转运动并实现姿态稳定,实现较复杂工作环境下作业。 |
