水下机器人在布放回收过程中的自动运动控制方法及装置

    公开(公告)号:CN111625009A

    公开(公告)日:2020-09-04

    申请号:CN202010506071.4

    申请日:2020-06-05

    Abstract: 本发明提供一种水下机器人在布放回收过程中的自动运动控制方法,包括:构建地球坐标系,船舶坐标系以及水下机器人坐标系,设定船舶坐标系下水下机器人的期望位置的矢量以及期望航向偏转角;获取超短基线定位设备检测的当前时刻船舶坐标系下水下机器人的实际位置的矢量,计算船舶坐标系下的位置偏移矢量;计算水下机器人相对船舶的实际航向偏转角,计算航向偏移矢量;计算船舶坐标系向水下机器人坐标系投影的转换矩阵,计算水下机器人坐标系下的位置偏移矢量;根据位置偏移矢量,计算水下机器人坐标系X轴和Y轴方向的自动定位控制目标;根据航向偏移矢量,计算水下机器人坐标系水平旋转方向自动定航控制目标;计算水下机器人推进器的推进力。

Patent Agency Ranking