公开(公告)号：CN102722177A

公开(公告)日：2012-10-10

申请号：CN201210214661.5

申请日：2012-06-27

Applicant: 哈尔滨工程大学

Inventor： 王宏健 ,  陈子印 ,  李娟 ,  王琳琳 ,  李村 ,  贾鹤鸣

IPC: G05D1/10

Abstract: 本发明提供的是一种具有PID反馈增益的自主水下航行器三维直线路径跟踪控制方法。步骤1.初始化；步骤2.通过AUV三维航迹跟踪误差方程计算AUV与期望航迹上“虚拟向导”点在Serret-Frenet坐标系下的相对位置偏差；步骤3.采用基于反馈增益的反步法，计算期望路径上“虚拟向导”点的移动速度、纵倾角和艏摇角的虚拟控制量；步骤4.计算AUV纵倾角速度和艏摇角速度的虚拟控制量；步骤5.推导欠驱动自主水下航行器AUV的三维路径跟踪的动力学控制律包括推进器推力、纵倾控制力矩和转艏控制力矩控制信号，实现欠驱动AUV的三维直线航迹跟踪控制。本发明能够实现对AUV三维空间航迹点和直线航迹的跟踪控制。

公开(公告)号：CN102722177B

公开(公告)日：2014-06-25

申请号：CN201210214661.5

申请日：2012-06-27

Applicant: 哈尔滨工程大学

Inventor： 王宏健 ,  陈子印 ,  李娟 ,  王琳琳 ,  李村 ,  贾鹤鸣

IPC: G05D1/10

Abstract: 本发明提供的是一种具有PID反馈增益的自主水下航行器三维直线路径跟踪控制方法。步骤1.初始化；步骤2.通过AUV三维航迹跟踪误差方程计算AUV与期望航迹上“虚拟向导”点在Serret-Frenet坐标系下的相对位置偏差；步骤3.采用基于反馈增益的反步法，计算期望路径上“虚拟向导”点的移动速度、纵倾角和艏摇角的虚拟控制量；步骤4.计算AUV纵倾角速度和艏摇角速度的虚拟控制量；步骤5.推导欠驱动自主水下航行器AUV的三维路径跟踪的动力学控制律包括推进器推力、纵倾控制力矩和转艏控制力矩控制信号，实现欠驱动AUV的三维直线航迹跟踪控制。本发明能够实现对AUV三维空间航迹点和直线航迹的跟踪控制。