[发明专利]一种海流影响下的无人巡检船直线航迹跟踪实现方法

摘要

本发明公开了一种海流影响下的无人巡检船直线航迹跟踪实现方法，具体涉及海水养殖监测技术领域。该海流影响下的无人巡检船直线航迹跟踪实现方法在考虑海流的影响下，针对海水养殖工厂化、生态化发展需求，将LOS导航算法与PID控制相结合，解决无人巡检船的直线航迹跟踪问题。LOS算法用于无人巡检船的航向控制，再通过PID控制算法完成航迹跟踪，从而使无人船驶向采集点完成水质数据采集，通过MATLAB对其进行仿真研究，仿真结果表明，该方法具有良好的控制效果。

主权项

1.一种海流影响下的无人巡检船直线航迹跟踪实现方法，其特征在于，具体包括：Ⅰ.建立海流环境模型：建立二维笛卡尔坐标系(x，y)下离散栅格空间，△x、△y分别为x、y轴方向栅格的大小，栅格中任一点q定义为式(1)q＝q(i，j)，0≦i在航迹控制过程中，忽略漂角，即有u＞＞0，v≈0,前进的合速度船舶运动数学模型为式(4)：Ⅲ.基于LOS导航算法，计算无人巡检船的直线航迹：①求解LOS角LOS角为LOS矢量与X轴的夹角，方向由X轴指向LOS矢量，LOS矢量是指从无人巡检船当前位置指向期望到达的位置的矢量，假设无人巡检船当前位置为P(x,y)，期望位置为Pk+1(xk+1,yk+1)，并假设Pk+1和Pk可以进行测量，则“LOS角”通过式(5)计算得到：②求解LOS的位置以P(x,y)为圆心，以nl为半径的圆与预设路径有两个交点，其中距离(xk,yk)较远的交点为Plos(xlos,ylos)，(xlos‑x)2+(ylos‑y)2＝(nl)2    (7)其中，l为船身长度；当无人巡检船根据采集路线的规划，进入期望航向点一定范围时，则放弃当前跟踪该期望航向点，而转入跟踪下一个期望航向点，即令k＝k+1，根据当前船舶位置(x,y)是否在以当前路径点(xk,yk)为圆心、半径为r的圆内为依据，即是否满足表达式(7)，来确定(xk+1,yk+1)能否作为下一个路径点，具体如式(8)，(xk‑x)2+(yk‑y)2≤r2    (8)其中，r＝2l，在对LOS位置进行计算时切换到下一个期望航向点的数据进行计算，以实现航迹连续跟踪；③对LOS直线航迹进行跟踪分析期望航向点Plos(xlos,ylos)与无人巡检船当前位置在期望航迹上的投影点相距Δ＝nl，n＝2～5，Δ为无人巡检船的可视距离，此时，LOS控制算法表示为式(9)：其中，α为X轴方向与期望航迹线PkPk+1的夹角，即设定的期望航向角，d为无人巡检船的横向跟随误差；Ⅳ.基于LOS算法设计PID控制器：PID控制器的控制规律如式(10)：由于舵角δ与当前航向角ψ成比例变化而航向角偏差为式(11)：ψd＝ψ‑ψlos    (11)由式(10)、(11)得出，如果某一时刻，系统存在一个较大的ψd，经PID控制便会产生一个舵角，该舵角会控制无人巡检船偏向期望航向点航行，此时无人巡检船的当前航向角就趋近于无人巡检船期望航向角，ψd减小，通过不断控制，只要ψd存在，便会出现一个控制舵角使ψd减小，直到ψd趋于零，即无人巡检船达到期望航迹线；Ⅴ.对无人巡检船进行无外部干扰和有海流影响两种情况进行仿真和分析。