公开(公告)号：CN105955268A

公开(公告)日：2016-09-21

申请号：CN201610312434.4

申请日：2016-05-12

Applicant: 哈尔滨工程大学

Inventor： 严浙平 ,  陈烨 ,  侯茹萍 ,  周佳加 ,  张伟 ,  罗朋飞

IPC: G05D1/02

CPC classification number: G05D1/0238

Abstract: 本发明提供的是一种考虑局部避碰的UUV动目标滑模跟踪控制方法。实时探测UUV、运动目标以及障碍物位置信息；获取运动目标k时刻状态估计；建立UUV和运动目标以及障碍物的相对运动模型；基于目标跟踪半径和障碍物规避安全半径的大小，根据UUV与运动目标及障碍物的相对位置，在跟踪策略和避碰策略之间自主切换；根据指令速度和航向与UUV航速及转艏角速度测量反馈，得到跟踪控制偏差，基于水平面非奇异终端滑模控制器解算得到k时刻UUV推进器推力和方向舵转艏力矩；循环执行上述步骤，实现运动目标下一刻的跟踪控制。本发明将复杂环境中的局部规划策略与UUV动力学模型相结合，在UUV航行安全性的前提下保证对运动目标的跟踪精度。

公开(公告)号：CN105955268B

公开(公告)日：2018-10-26

申请号：CN201610312434.4

申请日：2016-05-12

Applicant: 哈尔滨工程大学

Inventor： 严浙平 ,  陈烨 ,  侯茹萍 ,  周佳加 ,  张伟 ,  罗朋飞

IPC: G05D1/02

Abstract: 本发明提供的是一种考虑局部避碰的UUV动目标滑模跟踪控制方法。实时探测UUV、运动目标以及障碍物位置信息；获取运动目标k时刻状态估计；建立UUV和运动目标以及障碍物的相对运动模型；基于目标跟踪半径和障碍物规避安全半径的大小，根据UUV与运动目标及障碍物的相对位置，在跟踪策略和避碰策略之间自主切换；根据指令速度和航向与UUV航速及转艏角速度测量反馈，得到跟踪控制偏差，基于水平面非奇异终端滑模控制器解算得到k时刻UUV推进器推力和方向舵转艏力矩；循环执行上述步骤，实现运动目标下一刻的跟踪控制。本发明将复杂环境中的局部规划策略与UUV动力学模型相结合，在UUV航行安全性的前提下保证对运动目标的跟踪精度。