一种用于水下自主航行器的航迹控制方法技术

本发明专利技术提供了一种用于水下自主航行器的航迹控制方法，计算当前位置到规划路径直线的垂直距离，得到航行路径偏移量的控制量，计算水下航行器到达目标点的航向偏差和AUV到达目标点的航向控制量，将控制量引入到航向控制中，通过航向角总控制量根据各电机的位置进行推力分配，得到各电机的控制量，实现航迹航行的精确控制。本发明专利技术采用的水下自主航行器的航迹控制方法可在有海流的情况下实现水下自主航行器的精确航迹跟踪控制，采用的模糊PID控制算法对PID控制参数进行优化调整，对航行控制具有较好的自适应能力和较强的鲁棒性，本发明专利技术方法简单可行，工作可靠，可有效提高海流条件下水下自主航行器的航迹跟踪精度。

【技术实现步骤摘要】
一种用于水下自主航行器的航迹控制方法
本专利技术涉及水下航行器领域，尤其是用于水下自主航行器(AUV,AutonomousUnderwaterVehicle)的航行控制方法。
技术介绍
认识、开发和利用海洋是建设海洋强国的基础，在各种海洋技术中，水下自主航行器能在一般潜航器不能达到的水域自主进行工作，被广泛应用在科研考察、水下作业和军事活动中。传统的水下自主航行器通常采用目标点闭环的方式来按规划的航路航行，即目标航向角始终指向航行目标点，如图1所示，图中MN表示规划的路径，N为航行路径目标点，L1表示在静水水域航行时的航迹，L2表示在有海流情况下,传统的目标点闭环控制方法所实现的航迹，如果按照该航迹航行，水下航行器就会在海流的作用下偏离规划的路径，无法完成航迹精确跟踪任务。例如，在狭窄水域航行或海底地形地貌的全覆盖探测时,就要求水下自主航行器严格按照规划的航路航行。PID控制算法在各种控制方法中发展最为成熟，控制器设计可以不基于系统模型，被广泛应用在工业界各种控制系统中，目前水下航行器普遍采用该算法进行航行控制，但该控制器参数一本文档来自技高网...

【技术保护点】
1.一种用于水下自主航行器的航迹控制方法，其特征在于包括下述步骤：/n(1)计算当前位置到规划路径直线的垂直距离ΔL，即目前沿规划航路航行的偏差ΔL；计算方法为：/n当前位置A的坐标为(x，y，z)，规划路径直线的方向向量为M，规划路径上的一个点B的坐标为(x

【技术特征摘要】
1.一种用于水下自主航行器的航迹控制方法，其特征在于包括下述步骤：
(1)计算当前位置到规划路径直线的垂直距离ΔL，即目前沿规划航路航行的偏差ΔL；计算方法为：
当前位置A的坐标为(x，y，z)，规划路径直线的方向向量为M，规划路径上的一个点B的坐标为(x1，y1，z1)，向量AB＝(x，y，z)-(x1，y1，z1)，则ΔL＝|AB+M|；
(2)计算出航行路径偏移量的控制量ΔL控制；
采用PID算法计算出航行路径偏移量的控制量ΔL控制如下：



式(1)中，Kp为比例系数，Ki为积分系数，Kd为微分系数，ΔL为当前位置到规划路径的距离偏差，t为积分时间，dt为微分时间；
计算机控制系统对上式进行离散化处理，离散后的控制量ΔL控制为：



式(2)中，ΔLm为第m个控制周期当前位置到规划路径的距离偏差；
(3)计算水下航行器到达目标点的航向偏差ΔH；
首先计算到达本段路径目标点的航向H，即目标航向H，当前位置A的坐标为(x，y，z)，目标点N的坐标为(x0，y0，z0)，目标航向H＝(x，y，z)-(x0，y0，z0)，然后计算航向的偏差量ΔH，当前航向H1由姿态传感器可得ΔH＝H-H1；
(4)计算AUV到达目标点的航向控制量ΔH控制；
H0表示到达本段路径目标点的航向角，H表示安装在AUV上的航向传感器测量的实时航向角，ΔH表示到达目标点航向角偏差；
采用模糊PID算法计算出到达目标点的航向控制量ΔH控制，具体算法如下：
将控制...

【专利技术属性】
技术研发人员：赵艺，贺昱曜，彭星光，宋保维，潘光，张福斌，高剑，张立川，张克涵，
申请(专利权)人：西北工业大学，
类型：发明
国别省市：陕西;61