本发明公开了一种无人船巡航控制方法及系统，方法包括：获取无人船的航行点；根据航行点，自动生成航行线路或自定义航行线路得到预定航行路线；实时监测无人船是否发生偏航情况，若是，则发送指令至无人船返回预定航行路线；实时监测无人船的前方航道是否有障碍物，若是，则采取避障操作。系统包括：航行点获取单元、航线制定单元、偏航监测单元和避障单元。本发明通过制定航行线路，实时监测无人船的偏航情况和航道上的障碍物情况，使得无人船能及时应对突发的障碍情况，有效避免撞上障碍物的情况，并且能指示无人船返回预定航行路线，实时性较强，大大提高无人船的安全性。本发明可广泛应用于无人船产品中。
1.一种无人船巡航控制方法，其特征在于，包括以下步骤：A、获取无人船的航行点；
B、根据航行点，自动生成航行线路或自定义航行线路得到预定航行路线，并将预定航行线路发送至无人船；
C、实时监测无人船是否发生偏航情况，若是，则发送指令至无人船返回预定航行路线；
D、实时监测无人船的前方航道是否有障碍物，若是，则采取避障操作；反之，则保持当前航行状态不变；
B1、根据航行点，自动生成航行线路或自定义航行线路得到预定航行路线；
B2、根据预定航行路线，计算出航行线路各坐标点的航行方向以及各转弯点的转向方向和转向角度；
B3、将航行路线、航行线路上各坐标点的航行方向以及各转弯点的转向方向和转向角度发送至无人船。
2.根据权利要求1所述的一种无人船巡航控制方法，其特征在于：所述步骤C包括：C1、无人船实时反馈当前的位置坐标和航行方向；
C2、根据无人船反馈的位置坐标和航行方向，判断其是否与预定航行线路的数据不一致，若是，则计算返回预定航行路线的转向方向和转向角度并发送至无人船并立刻根据转向方向和转向角度执行转向操作；反之，则保持当前航行状态不变。
3.根据权利要求1所述的一种无人船巡航控制方法，其特征在于：所述步骤D包括：D1、实时通过超声波传感器检测无人船的前方航道是否有障碍物，若是，则执行步骤D2；反之，则保持当前航行状态不变；
D2、通过摄像头回传得到实时的航行影像，并根据超声波传感器测得的障碍物距离，计算得到障碍物的大小和位置，进而计算出转向方向和转向角度；
D3、根据转向方向和转向角度，通过超声波传感器检测在转向范围内是否有障碍物，若是，则重新计算转向方向和转向角度，直到转向范围内没有障碍物；
D4、无人船根据确定后的转向方向和转向角度进行转向操作，并在越过障碍物后返回预定航行线路。
航线制定单元，用于根据航行点，自动生成航行线路或自定义航行线路得到预定航行路线，并将预定航行线路发送至无人船；
偏航监测单元，用于实时监测无人船是否发生偏航情况，若是，则发送指令至无人船返回预定航行路线；反之，则保持当前航行状态不变；
避障单元，用于实时监测无人船的前方航道是否有障碍物，若是，则采取避障操作；反之，则保持当前航行状态不变；
航线生成单元，用于根据航行点，自动生成航行线路或自定义航行线路得到预定航行路线；
航线计算单元，用于根据预定航行路线，计算出航行线路各坐标点的航行方向以及各转弯点的转向方向和转向角度；
航线发送单元，用于将航行路线、航行线路上各坐标点的航行方向以及各转弯点的转向方向和转向角度发送至无人船。
5.根据权利要求4所述的一种无人船巡航控制系统，其特征在于：所述偏航监测单元包括：位置反馈单元，用于无人船实时反馈当前的位置坐标和航行方向；
偏航判断单元，用于根据无人船反馈的位置坐标和航行方向，判断其是否与预定航行线路的数据不一致，若是，则计算返回预定航行路线的转向方向和转向角度并发送至无人船并立刻根据转向方向和转向角度执行转向操作；反之，则保持当前航行状态不变。
6.根据权利要求4所述的一种无人船巡航控制系统，其特征在于：所述避障单元包括：障碍物检测单元，用于实时通过超声波传感器检测无人船的前方航道是否有障碍物，若是，则执行转向计算单元；反之，则保持当前航行状态不变；
转向计算单元，用于通过摄像头回传得到实时的航行影像，并根据超声波传感器测得的障碍物距离，计算得到障碍物的大小和位置，进而计算出转向方向和转向角度；
转向调整单元，用于根据转向方向和转向角度，通过超声波传感器检测在转向范围内是否有障碍物，若是，则重新计算转向方向和转向角度，直到转向范围内没有障碍物；
返回航线单元，用于无人船根据确定后的转向方向和转向角度进行转向操作，并在越过障碍物后返回预定航行线路。
一种无人船巡航控制方法及系统
技术领域
[0001] 本发明涉及无人船控制技术领域，尤其涉及一种无人船巡航控制方法及系统。
背景技术
[0002] 目前环保监查部门为掌握所辖水域的水质情况，通常是对其进行定期或不定期的采样检测分析，依水质的各项质量指标决定相应的环保措施。然而以往的采样方式，普遍是通过人工在该水域不同位点进行采样，这种传统的采样方式，尽管曾为发展环保事业发挥了积极的作用，但是也存在着手段落后，有局限性、效率低，特别是对中、重度污染水体采样时，一不小心还存在危及操作人员人身安全隐患的诸多不尽如人意之处。在国务院4月16日正式对外颁布的《水污染防治行动计划》中，对未来一个阶段的水污染防控提出了非常严格的计划和标准。严格的计划需要严谨地落实，而无人船作为一种新兴的高科技产品，正是助推这一政策落地的有力武器。
[0003] 无人船学名叫“水面机器人”，是一种不需要载人来操作，通过远程遥控，甚至不需操控即可自主航行执行任务的水上机器人。比较适合执行危险或者枯燥、重复的军用、民用任务，例如运用在军事打击、安防巡逻、地貌测绘、环境监测、应急救援等领域。
[0004] 然而，无人船的真实航行环境信息很难完全预知，经常会遇到未知的突发威胁或障碍，现在的无人船在出现突发威胁障碍时大部分缺乏应变能力，不能及时绕过威胁并重新回到预先规划的行路上，导致无人船容易出现意外。
发明内容
[0005] 为了解决上述技术问题，本发明的目的是提供一种能自动规划航线，且能有效避开障碍物的一种无人船巡航控制方法及系统。
[0006] 本发明所采用的技术方案是：
[0007] 一种无人船巡航控制方法，包括以下步骤：
[0008] A、获取无人船的航行点；
[0009] B、根据航行点，自动生成航行线路或自定义航行线路得到预定航行路线，并将预定航行线路发送至无人船；
[0010] C、实时监测无人船是否发生偏航情况，若是，则发送指令至无人船返回预定航行路线；反之，则保持当前航行状态不变；
[0011] D、实时监测无人船的前方航道是否有障碍物，若是，则采取避障操作；反之，则保持当前航行状态不变。
[0012] 作为所述的一种无人船巡航控制方法的进一步改进，所述步骤B包括：
[0013] B1、根据航行点，自动生成航行线路或自定义航行线路得到预定航行路线；
[0014] B2、根据预定航行路线，计算出航行线路各坐标点的航行方向以及各转弯点的转向方向和转向角度；
[0015] B3、将航行路线、航行线路上各坐标点的航行方向以及各转弯点的转向方向和转向角度发送至无人船。
[0016] 作为所述的一种无人船巡航控制方法的进一步改进，所述步骤C包括：
[0017] C1、无人船实时反馈当前的位置坐标和航行方向；
[0018] C2、根据无人船反馈的位置坐标和航行方向，判断其是否与预定航行线路的数据不一致，若是，则计算返回预定航行路线的转向方向和转向角度并发送至无人船并立刻根据转向方向和转向角度执行转向操作；反之，则保持当前航行状态不变。
[0019] 作为所述的一种无人船巡航控制方法的进一步改进，所述步骤D包括：
[0020] D1、实时通过超声波传感器检测无人船的前方航道是否有障碍物，若是，则执行步骤D2；反之，则保持当前航行状态不变；
[0021] D2、通过摄像头回传得到实时的航行影像，并根据超声波传感器测得的障碍物距离，计算得到障碍物的大小和位置，进而计算出转向方向和转向角度；
[0022] D3、根据转向方向和转向角度，通过超声波传感器检测在转向范围内是否有障碍物，若是，则重新计算转向方向和转向角度，直到转向范围内没有障碍物；
[0023] D4、无人船根据确定后的转向方向和转向角度进行转向操作，并在越过障碍物后返回预定航行线路。
[0024] 本发明所采用的另一技术方案是：
[0025] 一种无人船巡航控制系统，包括：
[0026] 航行点获取单元，用于获取无人船的航行点；
[0027] 航线制定单元，用于根据航行点，自动生成航行线路或自定义航行线路得到预定航行路线，并将预定航行线路发送至无人船；
[0028] 偏航监测单元，用于实时监测无人船是否发生偏航情况，若是，则发送指令至无人船返回预定航行路线；反之，则保持当前航行状态不变；
[0029] 避障单元，用于实时监测无人船的前方航道是否有障碍物，若是，则采取避障操作；反之，则保持当前航行状态不变。
[0030] 作为所述的一种无人船巡航控制系统的进一步改进，所述航线制定单元包括：
[0031] 航线生成单元，用于根据航行点，自动生成航行线路或自定义航行线路得到预定航行路线；
[0032] 航线计算单元，用于根据预定航行路线，计算出航行线路各坐标点的航行方向以及各转弯点的转向方向和转向角度；
[0033] 航线发送单元，用于将航行路线、航行线路上各坐标点的航行方向以及各转弯点的转向方向和转向角度发送至无人船。
[0034] 作为所述的一种无人船巡航控制系统的进一步改进，所述偏航监测单元包括：
[0035] 位置反馈单元，用于无人船实时反馈当前的位置坐标和航行方向；
[0036] 偏航判断单元，用于根据无人船反馈的位置坐标和航行方向，判断其是否与预定航行线路的数据不一致，若是，则计算返回预定航行路线的转向方向和转向角度并发送至无人船并立刻根据转向方向和转向角度执行转向操作；反之，则保持当前航行状态不变。
[0037] 作为所述的一种无人船巡航控制系统的进一步改进，所述避障单元包括：
[0038] 障碍物检测单元，用于实时通过超声波传感器检测无人船的前方航道是否有障碍物，若是，则执行转向计算单元；反之，则保持当前航行状态不变；
[0039] 转向计算单元，用于通过摄像头回传得到实时的航行影像，并根据超声波传感器测得的障碍物距离，计算得到障碍物的大小和位置，进而计算出转向方向和转向角度；
[0040] 转向调整单元，用于根据转向方向和转向角度，通过超声波传感器检测在转向范围内是否有障碍物，若是，则重新计算转向方向和转向角度，直到转向范围内没有障碍物；
[0041] 返回航线单元，用于无人船根据确定后的转向方向和转向角度进行转向操作，并在越过障碍物后返回预定航行线路。
[0042] 本发明的有益效果是：
[0043] 本发明一种无人船巡航控制方法及系统通过制定航行线路，并实时监测无人船的偏航情况和航道上的障碍物情况，使得无人船能及时应对突发的障碍情况，有效避免撞上障碍物的情况，并且能指示无人船返回预定航行路线，实时性较强，大大提高无人船的安全性。
附图说明
[0044] 下面结合附图对本发明的具体实施方式作进一步说明：
[0045] 图1是本发明一种无人船巡航控制方法的步骤流程图；
[0046] 图2是本发明一种无人船巡航控制方法步骤B的步骤流程图；
[0047] 图3是本发明一种无人船巡航控制方法步骤C的步骤流程图；
[0048] 图4是本发明一种无人船巡航控制方法步骤D的步骤流程图；
[0049] 图5是本发明一种无人船巡航控制系统的模块方框图。
具体实施方式
[0050] 参考图1，本发明一种无人船巡航控制方法，包括以下步骤：
[0051] A、获取无人船的航行点；
[0052] B、根据航行点，自动生成航行线路或自定义航行线路得到预定航行路线，并将预定航行线路发送至无人船；
[0053] C、实时监测无人船是否发生偏航情况，若是，则发送指令至无人船返回预定航行路线；反之，则保持当前航行状态不变；
[0054] D、实时监测无人船的前方航道是否有障碍物，若是，则采取避障操作；反之，则保持当前航行状态不变。
[0055] 其中，步骤C和步骤D不分先后次序执行，在航行过程中两步骤均一直进行中，直到完成航行。
[0056] 参考图2，进一步作为优选的实施方式，所述步骤B包括：
[0057] B1、根据航行点，自动生成航行线路或自定义航行线路得到预定航行路线；
[0058] B2、根据预定航行路线，计算出航行线路各坐标点的航行方向以及各转弯点的转向方向和转向角度；
[0059] B3、将航行路线、航行线路上各坐标点的航行方向以及各转弯点的转向方向和转向角度发送至无人船。
[0060] 参考图3，进一步作为优选的实施方式，所述步骤C包括：
[0061] C1、无人船实时反馈当前的位置坐标和航行方向；
[0062] C2、根据无人船反馈的位置坐标和航行方向，判断其是否与预定航行线路的数据不一致，若是，则计算返回预定航行路线的转向方向和转向角度并发送至无人船并立刻根据转向方向和转向角度执行转向操作；反之，则保持当前航行状态不变。
[0063] 参考图4，进一步作为优选的实施方式，所述步骤D包括：
[0064] D1、实时通过超声波传感器检测无人船的前方航道是否有障碍物，若是，则执行步骤D2；反之，则保持当前航行状态不变；
[0065] D2、通过摄像头回传得到实时的航行影像，并根据超声波传感器测得的障碍物距离，计算得到障碍物的大小和位置，进而计算出转向方向和转向角度；
[0066] D3、根据转向方向和转向角度，通过超声波传感器检测在转向范围内是否有障碍物，若是，则重新计算转向方向和转向角度，直到转向范围内没有障碍物；
[0067] D4、无人船根据确定后的转向方向和转向角度进行转向操作，并在越过障碍物后返回预定航行线路。
[0068] 参考图5，本发明一种无人船巡航控制系统，包括：
[0069] 航行点获取单元，用于获取无人船的航行点；
[0070] 航线制定单元，用于根据航行点，自动生成航行线路或自定义航行线路得到预定航行路线，并将预定航行线路发送至无人船；
[0071] 偏航监测单元，用于实时监测无人船是否发生偏航情况，若是，则发送指令至无人船返回预定航行路线；反之，则保持当前航行状态不变；
[0072] 避障单元，用于实时监测无人船的前方航道是否有障碍物，若是，则采取避障操作；反之，则保持当前航行状态不变。
[0073] 进一步作为优选的实施方式，所述航线制定单元包括：
[0074] 航线生成单元，用于根据航行点，自动生成航行线路或自定义航行线路得到预定航行路线；
[0075] 航线计算单元，用于根据预定航行路线，计算出航行线路各坐标点的航行方向以及各转弯点的转向方向和转向角度；
[0076] 航线发送单元，用于将航行路线、航行线路上各坐标点的航行方向以及各转弯点的转向方向和转向角度发送至无人船。
[0077] 进一步作为优选的实施方式，所述偏航监测单元包括：
[0078] 位置反馈单元，用于无人船实时反馈当前的位置坐标和航行方向；
[0079] 偏航判断单元，用于根据无人船反馈的位置坐标和航行方向，判断其是否与预定航行线路的数据不一致，若是，则计算返回预定航行路线的转向方向和转向角度并发送至无人船并立刻根据转向方向和转向角度执行转向操作；反之，则保持当前航行状态不变。
[0080] 进一步作为优选的实施方式，所述避障单元包括：
[0081] 障碍物检测单元，用于实时通过超声波传感器检测无人船的前方航道是否有障碍物，若是，则执行转向计算单元；反之，则保持当前航行状态不变；
[0082] 转向计算单元，用于通过摄像头回传得到实时的航行影像，并根据超声波传感器测得的障碍物距离，计算得到障碍物的大小和位置，进而计算出转向方向和转向角度；
[0083] 转向调整单元，用于根据转向方向和转向角度，通过超声波传感器检测在转向范围内是否有障碍物，若是，则重新计算转向方向和转向角度，直到转向范围内没有障碍物；
[0084] 返回航线单元，用于无人船根据确定后的转向方向和转向角度进行转向操作，并在越过障碍物后返回预定航行线路。
[0085] 本发明具体实施例如下：
[0086] S1、在上位机端，采用网格设定航行点或沿江中线设定航行点；
[0087] S2、根据航行点，通过自动生成或手动连接航行点形成得到预定航行路线；
[0088] S3计算出航行线路各坐标点的航行方向以及各转弯点的转向方向和转向角度并将预定航行线路发送至无人船，并将航行路线、航行线路上各坐标点的航行方向以及各转弯点的转向方向和转向角度发送至无人船；
[0089] S4、无人船实时反馈当前的位置坐标和航行方向，根据无人船反馈的位置坐标和航行方向，判断其是否与预定航行线路的数据不一致，若是，即表示当前反馈的位置坐标不在预定航行线路上，已经发生了偏航情况，则计算返回预定航行路线的转向方向和转向角度并将其发送至无人船并立刻根据转向方向和转向角度执行转向操作；反之，则保持当前航行状态不变；
[0090] S5、实时通过超声波传感器检测无人船的前方航道是否有障碍物，若是，则执行步骤S6；反之，则保持当前航行状态不变；
[0091] S6、通过摄像头回传得到实时的航行影像，并根据超声波传感器测得的障碍物距离，计算得到障碍物的大小和位置，进而计算出转向方向和转向角度；
[0092] S7、根据转向方向和转向角度，通过超声波传感器检测在转向范围内是否有障碍物，若是，则重新计算转向方向和转向角度，直到转向范围内没有障碍物；
[0093] S8、无人船根据确定后的转向方向和转向角度进行转向操作，并在越过障碍物后返回预定航行线路继续航行。
[0094] 从上述内容可知，本发明一种无人船巡航控制方法及系统通过制定航行线路，并实时监测无人船的偏航情况和航道上的障碍物情况，使得无人船能及时应对突发的障碍情况，有效避免撞上障碍物的情况，并且能指示无人船返回预定航行路线，实时性较强，大大提高无人船的安全性，为有效地完成航行采样检测任务提供了巨大的帮助。
[0095] 以上是对本发明的较佳实施进行了具体说明，但本发明创造并不限于所述实施例，熟悉本领域的技术人员在不违背本发明精神的前提下还可做作出种种的等同变形或替换，这些等同的变形或替换均包含在本申请权利要求所限定的范围内。
