无人移动靶船行进控制方法及系统与流程

本发明涉及远程无线控制，更具体地说，涉及人移动靶船行进控制方法及系统。

背景技术：

1、无人靶船是一种用于专供舰炮、岸炮、导弹、鱼雷等对海实弹射击训练用的目标船；无人靶船具有多种技术特点，包括可自主航行、航迹规划、智能导航、避障、路径规划、失联返航等；此外，无人靶船还可以事先对无人艇范围内水面典型目标的快速检测、跟踪及自主避碰，具备同时对海上多个动静态目标实时规避能力；

2、无人靶船在航行过程中可能受到风浪、水流等外部因素的影响，导致其动态特性发生变化，例如航速、航向、姿态等；这些变化因素会使得远程控制更加困难，在操作时需要根据实际情况调整控制参数和策略；现有的控制方式要么依靠操作员获取靶船的信息进行远程控制，要么事先制定航线路线通过远程通信控制靶船移动，但是这两种方式在变化因素产生时都无法及时地调整控制参数，在航行时，会逐渐产生偏差，远离预定的航线；

3、无人靶船在行进过程中需要确保其安全性和可靠性，避免出现失控、碰撞等危险情况；虽然现有的无人靶船有自动避障功能，但是在遇到大风浪的情况下，可能会被风浪裹挟和障碍物进行碰撞，在遇到这类意外情况后很难根据实际情况进行下一步的控制。

技术实现思路

1、针对现有技术存在的无人靶船在行进过程中需要确保其安全性和可靠性，避免出现失控、碰撞等危险情况；虽然现有的无人靶船有自动避障功能，但是在遇到大风浪的情况下，可能会被风浪裹挟和障碍物进行碰撞，在遇到这类意外情况后很难根据实际情况进行下一步的控制的不足，本发明的目的在于提供无人移动靶船行进控制系统。

2、为实现上述目的，本发明提供了如下技术方案：

3、一种无人移动靶船行进控制系统，所述无人移动靶船行进控制系统包括：

4、智能设备模块，所述智能设备模块包括靶船和控制台，所述控制台用于控制所述靶船的移动；

5、数据采集模块，所述数据采集模块用于采集靶船信息和靶船航行环境的信息；

6、动态调节模块，所述动态调节模块用于根据航行环境的外界因素动态地调节所述控制台的控制参数；

7、智能判定模块，所述智能判定模块判断靶船当前时间点的航行过程中，是否会因为外部因素改变自身动态特性，具体为：

8、获取得到当前时间点航行环境的风力，并标记为f；

9、获取得到当前时间点风力和船只方向的夹角，并标记为a；

10、获取得到当前时间点航行环境的水流速度，并标记为vq；

11、获取得到当前时间点航行环境的水流方向和船只方向的夹角，并标记为b；

12、设定靶船的预定移动速度，并标记为vw；

13、根据公式计算获得船只航行时受外界环境因素的影响值r；

14、将影响值r和预先设定的阈值进行对比，如果影响值r大于预先设定阈值，则将靶船当前时间点的航行环境为危险环境，将信号传输给所述动态调节模块进行动态调节控制，如果影响值r小于预先设定阈值，则将信号传输给所述控制台保持正常控制；

15、避障模块，所述避障模块用于在靶船遇到障碍物时进行自动避障。

16、优选的，所述控制台还用于获取平面坐标系，以所述控制台为原点，以靶船横向移动的方向为x轴，以靶船纵向移动的方向为y轴，获取得到所述靶船的坐标。

17、优选的，所述控制台还用于获取靶船的行进路线坐标，具体为：

18、获取得到所述靶船目的地的坐标；

19、预先设定所述靶船的行进路线，所述控制台根据所述靶船的行进路线获取的得到所述靶船的行进路线坐标。

20、优选的，所述数据采集模块还包括靶船信息采集单元和环境采集单元，具体为：

21、所述环境采集单元用于采集靶船航行环境的信息，且所述环境采集单元包括安装在靶船前端的风向标、风速计、水流流向标和水流流速计。

22、优选地，所述动态调节模块用于根据航行环境的外界因素动态的调节控制参数，具体为：

23、获取得到靶船当前时间点的航线速度，并标记为vt；

24、根据公式y＝vw-vt+f×cos(a)+vq×(b)，计算获得靶船回到预定行进路线的速度调整值y；

25、根据公式p＝atan2[(vq×sin(b))/(vw+f×cos(b))-vt]，计算获得靶船活到预定行进路线的角度调整值p；

26、将获得的所述速度调整值y和所述角度调整值p通过信息发送给靶船进行调节。

27、优选的，所述避障模块用于在靶船遇到障碍物时进行紧急处理，具体为：

28、所述避障模块还包括摄像单元，所述摄像单元位于所述靶船的正前端，且所述摄像单元用于采集所述靶船前端的视频信息；

29、获取得到所述靶船当前时间点的视频图片帧，所述控制台将所述视频图片帧跟所述靶船出发时间点的视频图片帧进行对比，判断靶船前方是否存在障碍物；

30、如果是，则获得当前时间点所述靶船和障碍的距离，并标记为k l；

31、获取得到所述障碍物正对所述靶船方向的面积，并标记为s；

32、根据公式：

33、

34、

35、g＝g1+g2-vt；

36、计算获得靶船绕过所述障碍物的速度调整值g；

37、获取得到所述靶船绕过所述障碍物的角度调整值x；

38、将信号传输给控制台控制所述靶船避过障碍物。

39、优选的，所述靶船绕过所述障碍物的角度调整值x的获取方式如下，具体为：

40、根据公式：

41、x1＝atan2((vq×sin(b))/(vt+f×cos(a)+g),(f×sin(a))；

42、x2＝(vt+vq×cos(b)+g))-atan2(s/kl,1)；

43、x＝x1/x2；

44、计算获得所述靶船绕过所述障碍物的角度调整值x。

45、优选的，所述的无人移动靶船行进控制系统还包括紧急制动模块，具体为：

46、获取得到所述靶船和障碍物的安全距离ds；

47、将当前时间点所述靶船和障碍的距离kl和所述靶船和障碍物的安全距离ds进行对比，判断kl是否小于ds，如果是，则将信号传输给控制台紧急制动靶船，如果否，则将信号传输给所述避障模块避开障碍物。

48、优选的，所述靶船和障碍物的安全距离ds的获取方式如下，具体为：

49、根据公式ds＝k×(kl+s/2)+vt^2/(2×(f×cos(a)+vq×cos(b)))，计算获得所述靶船和障碍物的安全距离ds。

50、另一方面，本发明还提出了一种无人移动靶船行进控制方法，所述的一种无人移动靶船行进控制方法包括以下步骤：

51、s1：获取得到当前时间点航行环境的风力，并标记为f；

52、s2：获取得到当前时间点风力和船只方向的夹角，并标记为a；

53、s3：获取得到当前时间点航行环境的水流速度，并标记为vq；

54、s4：获取得到当前时间点航行环境的水流方向和船只方向的夹角，并标记为b；

55、s5：设定靶船的预定移动速度，并标记为vw；

56、s6：计算获得船只航行时受外界环境因素的影响值r；

57、s7：将影响值r和预先设定的阈值进行对比，如果影响值r大于预先设定阈值，则将靶船当前时间点的航行环境为危险环境，将信号传输给所述动态调节模块进行动态调节控制，如果影响值r小于预先设定阈值，则将信号传输给所述控制台保持正常控制。

58、与现有技术相比，本发明具备以下有益效果：

59、1、通过智能判定模块和动态调节模块的设置，可以在靶船航行时评估航行环境对靶船的影响程度，在外界航行环境恶劣时通过动态调节模块来根据变化印度进行实时调整靶船的控制参数，在外界航行环境正常时通过控制台直属控制，可以在靶船航行过程中，尽量避免靶船偏离航线，在靶船产生偏移时，实时的根据靶船的动态特性动态调节控制参数。

60、2、通过避障模块和紧急制动模块的设置，可以自动判断靶船的前方是否存在障碍物，在靶船的行进路径和障碍物重合时自动调节靶船的控制参数避开障碍物，在靶船因为海浪等意外因素推动导致和障碍物距离过近时，对靶船进行紧急制动，减少靶船跟障碍物的碰撞力度。