CN113406961A - 一种无人船过桥控制方法、装置、电子设备及存储介质 - Google Patents

一种无人船过桥控制方法、装置、电子设备及存储介质 Download PDF

Info

Publication number
CN113406961A
CN113406961A CN202110783834.4A CN202110783834A CN113406961A CN 113406961 A CN113406961 A CN 113406961A CN 202110783834 A CN202110783834 A CN 202110783834A CN 113406961 A CN113406961 A CN 113406961A
Authority
CN
China
Prior art keywords
unmanned ship
bridge
crossing
latitude
longitude
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202110783834.4A
Other languages
English (en)
Other versions
CN113406961B (zh
Inventor
程宇威
朱健楠
张金阳
池雨豪
虞梦苓
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shaanxi Orca Electronic Intelligent Technology Co ltd
Original Assignee
Shaanxi Orca Electronic Intelligent Technology Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Shaanxi Orca Electronic Intelligent Technology Co ltd filed Critical Shaanxi Orca Electronic Intelligent Technology Co ltd
Priority to CN202110783834.4A priority Critical patent/CN113406961B/zh
Publication of CN113406961A publication Critical patent/CN113406961A/zh
Application granted granted Critical
Publication of CN113406961B publication Critical patent/CN113406961B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种无人船过桥控制方法、装置、电子设备及存储介质，该无人船过桥控制方法包括有步骤：根据从后端数据库获取的过桥起始点和过桥终止点的经纬度计算得到过桥控制角度；基于无人船当前的经纬度、航向角及过桥起始点的经纬度控制无人船行驶至过桥起始点；调整无人船的方向，使其与所述过桥控制角度重合，然后控制无人船驶入桥梁，过桥时，动态调整无人船的航向角，使其与所述过桥控制角度保持重合；基于惯性数据及入桥前无人船的经纬度，采用惯性导航算法计算出无人船当前的位置信息；基于卫星信号数据、无人船当前的位置信息判定无人船过桥是否结束，若卫星信号数据和/或无人船当前的位置信息满足预设条件，则判定无人船过桥结束。

Description

一种无人船过桥控制方法、装置、电子设备及存储介质
技术领域
本发明涉及无人船控制技术领域，尤其涉及一种无人船过桥控制方法、装置、电子设备及存储介质。
背景技术
近年来，随着智能技术的快速发展，无人船自主行驶的智能化程度得到重视，各种类型和用途的无人船得到了广泛应用。无人船的自主航行是智能化的体现，主要依靠卫星定位导航。然而，在实际应用中，很多水域都会有桥梁横跨水面，在桥梁下方，无人船的定位信号会受到遮挡的影响，当定位信号弱时，无人船难以控制。如何在定位信号弱的情况下依然能自主行驶是一个无人船控制领域的技术难点。
发明内容
本发明所要解决的技术问题在于提供一种无人船过桥控制方法、装置、电子设备及存储介质，以解决现有技术无人船行驶在桥梁下方时，因定位信号弱而导致无人船难以控制的技术问题。
为解决上述技术问题，本发明提供一种无人船过桥控制方法，其包括有如下步骤：
S10、接收控制终端下达的过桥指令，根据所述过桥指令从后端数据库获取过桥起始点和过桥终止点的经纬度信息，并根据过桥起始点和过桥终止点的经纬度计算得到过桥控制角度；
S20、基于无人船当前的经纬度、航向角及过桥起始点的经纬度控制无人船行驶至过桥起始点；
S30、调整无人船的方向，使其与所述过桥控制角度重合，然后控制无人船驶入桥梁，过桥时，动态调整无人船的航向角，使其与所述过桥控制角度保持重合；
S40、基于惯性数据及入桥前无人船的经纬度，采用惯性导航算法计算出无人船当前的位置信息；
S50、基于卫星信号数据、无人船当前的位置信息判定无人船过桥是否结束，若卫星信号数据和/或无人船当前的位置信息满足预设条件，则判定无人船过桥结束。
为解决上述技术问题，本发明提供一种无人船过桥控制装置，其包括有：计算模块，用于接收控制终端下达的过桥指令，根据所述过桥指令从后端数据库获取过桥起始点和过桥终止点的经纬度，并根据过桥起始点和过桥终止点的经纬度计算得到过桥控制角度；过桥准备控制模块，用于基于无人船当前的经纬度、航向角及过桥起始点的经纬度控制无人船行驶至过桥起始点；惯性导航模块，用于调整无人船的方向，使其与所述过桥控制角度重合，然后控制无人船驶入桥梁，过桥时，动态调整无人船的航向角，使其与所述过桥控制角度保持重合；航迹推测模块，用于基于惯性数据及过桥起始点的经纬度，采用惯性导航算法计算出无人船当前的位置信息；过桥结束判定模块，用于基于卫星信号数据、无人船当前的位置信息判定无人船过桥是否结束，若卫星信号数据和/或无人船当前的位置信息满足预设条件，则判定无人船过桥结束。
为解决上述技术问题，本发明提供一种电子设备，其包括有至少一个处理器以及与所述处理器通信连接的至少一个存储器，其中，所述存储器存储有程序指令，所述程序指令被所述处理器调用执行时实现上述的无人船过桥控制方法。
为解决上述技术问题，本发明提供一种存储介质，其存储有程序指令，所述程序指令被处理器执行时实现上述的无人船过桥控制方法。
本发明的有益技术效果在于：上述的无人船过桥控制方法，通过过桥起始点和过桥终止点的经纬度计算得到过桥控制角度，在无人船行驶至过桥起始点时，调整无人船的方向使其与所述过桥控制角度重合，然后控制无人船驶入桥梁，过桥时，动态调整无人船的航向角使其与所述过桥控制角度保持重合，从而使无人船能够顺利穿越桥梁，解决了无人船行驶在桥梁下方时，因定位信号弱而导致无人船难以控制的技术问题。
附图说明
图1为本发明的一种无人船过桥控制方法的工作流程图；
图2为本发明的一种无人船过桥控制装置的结构示意图；
图3为本发明的一种电子设备的结构示意图。
具体实施方式
为使本领域的普通技术人员更加清楚地理解本发明的目的、技术方案和优点，以下结合附图和实施例对本发明做进一步的阐述。
图1示出了本发明的一种无人船过桥控制方法的工作流程图，如图1所示，在本发明一个实施例中，无人船过桥控制方法，包括有如下步骤：
S10、接收控制终端下达的过桥指令，根据所述过桥指令从后端数据库获取过桥起始点和过桥终止点的经纬度，并根据过桥起始点和过桥终止点的经纬度计算得到过桥控制角度；
本实施例的执行主体装载在无人船上，无人船在过桥之前依靠卫星定位导航自主航行。当无人船停靠在过桥起始点附近，通过控制终端远程向无人船下达过桥指令，无人船接收到过桥指令后，从后端数据库获取到过桥起始点和过桥终止点的经纬度信息，然后将大地坐标系转化为平面直角坐标系，根据过桥起始点和过桥终止点的经纬度建立由过桥起始点指向过桥终止点的向量，最后通过三角函数计算得到该向量的方向，即为过桥控制角度。
S20、基于无人船当前的经纬度、航向角及过桥起始点的经纬度控制无人船行驶至过桥起始点；
在具体实施中，无人船搭载的船载定位系统可以实时获取无人船当前的经纬度，无人船的惯性测量单元可以实时获取无人船当前的航向角。过桥指令下达后，无人船先根据获取到的无人船当前的经纬度及过桥起始点的经纬度计算得到目标航向角，然后将无人船当前的航向角与目标航向角比对，得到控制量并根据该控制量调整无人船的方向，进而控制无人船向过桥起始点运动。
本实施例对船载定位系统不做限定，船载定位系统可采用全球定位系统(GlobalPositioning System，GPS)，也可以采用格洛纳斯(GLOBALNAVIGATION SATELLITE SYSTEM，简称GLONASS)卫星导航系统或北斗卫星导航系统。
S30、调整无人船的方向，使其与所述过桥控制角度重合，然后控制无人船驶入桥梁，过桥时，动态调整无人船的航向角，使其与所述过桥控制角度保持重合；
在具体实施中，无人船到达起始点以后，将过桥控制角度作为目标航向角，然后将无人船当前的航向角与目标航向角比对，得到控制量并根据该控制量调整无人船的方向，使其与过桥控制角度重合，进而控制无人船驶入桥梁，向过桥终止点行进；过桥时，实时获取无人船当前的航向角，控制无人船使无人船的航向角与过桥控制角度的差值保持在设定的范围内，控制无人船沿过桥控制角度向过桥终止点行进。需要说明的是，本发明对“控制无人船使无人船的航向角与过桥控制角度的差值保持在设定的范围内”所采用的具体方式不做限定，可以通过PID(Proportion Integral Differential)控制的方式使无人船的航向角与过桥控制角度的差值保持在设定的范围内，也可以采用其他方式使无人船的航向角与过桥控制角度的差值保持在设定的范围内。
S40、基于惯性数据及入桥前无人船的经纬度，采用惯性导航算法计算出无人船当前的位置信息；
本步骤中，在无人船由过桥起始点驶向过桥终止点过程中，无人船未进入桥下时，通过船载定位系统仍可以实时获取无人船当前的经纬度，直至无人船进入桥下，卫星定位信号弱而无法获取无人船的位置信息，从而需要采用惯性导航算法计算无人船当前的位置信息。
作为一种可行的实施方式，通过获取的前进油门值和旋转油门值计算得到惯性数据。在具体实施中，构建一个前进油门值队列和一个旋转油门值队列，分别记为Q1、Q2；实时获取无人船当前的前进油门值T1并将其加入到前进油门值队列Q1中，同时实时获取无人船当前的旋转油门值T2并将其加入到旋转油门值队列Q2中；选取前进油门值队列Q1、旋转油门值队列Q2中的前N个数据，结合无人船的动力学模型，由前进油门值计算得到加速度，积分可得速度S；由旋转油门值计算得到角速度G。
以速度S及角速度G为基础，结合入桥前无人船的经纬度，采用惯性导航算法计算出无人船当前的位置信息。在具体实施中，先对得到的速度S及角速度G进行饱和处理，使其处于无人船正常航行的范围内；再对经饱和处理后的速度S及角速度G进行积分，得到无人船的行驶距离及当前方向角；最后利用无人船的行驶距离及当前方向角计算得到无人船在水平及垂直距离的行驶距离，随后将其转化为大地坐标系，再结合入桥前无人船的经纬度，即可得到无人船当前位置。
作为另一种可行的实施方式，可以仅利用无人船搭载的惯性测量单元(包括加速度计和陀旋仪等等)获取无人船的惯性数据(例如速度、加速度、航向角、角速度等)，再基于获取到的无人船的惯性数据采用现有的惯性导航算法可以计算出无人船当前的位置信息。
S50、基于卫星信号数据、无人船当前的位置信息判定无人船过桥是否结束，若卫星信号数据和/或无人船当前的位置信息满足预设条件，则判定无人船过桥结束。
作为一种可行的实施方式，基于卫星信号数据、无人船当前的位置信息判定无人船过桥是否结束，若卫星信号数据满足预设条件，则判定无人船过桥结束。在具体实施中，通过船载定位系统获取当前的卫星信号的载噪比及卫星可使用数量，当载噪比高于设定阈值，且卫星可使用数量大于设定阈值时，则认为当前定位信号已恢复，因而判定无人船已经驶出桥梁，无人船过桥结束。
作为另一种可行的实施方式，基于卫星信号数据、无人船当前的位置信息判定无人船过桥是否结束，若无人船当前的位置信息满足预设条件，则判定无人船过桥结束。在具体实施中，由步骤S40计算得出无人船当前的位置信息，分别计算无人船当前的位置与过桥起始点之间的距离及过桥终止点与过桥起始点之间的距离，若无人船当前的位置与过桥起始点之间的距离，较过桥终止点与过桥起始点之间的距离更远，则可以判定无人船已经驶出桥梁，无人船过桥结束。
作为又一种可行的实施方式，基于卫星信号数据、无人船当前的位置信息判定无人船过桥是否结束，若卫星信号数据及无人船当前的位置信息均满足预设条件，则判定无人船过桥结束。
在具体实施中，通过船载定位系统获取当前的卫星信号的载噪比及卫星可使用数量，当载噪比高于设定阈值，且卫星可使用数量大于设定阈值时，则认为当前定位信号已恢复。当检测到定位信号恢复时，一般可以判定无人船过桥结束；但是若桥梁中间有缝隙，无人船在穿越桥梁过程中，会出现因桥梁缝隙而导致卫星信号偶尔性增强的情况，从而产生误判，因此，同时需要基于卫星信号数据对无人船过桥是否结束进行辅助判断。由步骤S40计算得出无人船当前的位置信息，分别计算无人船当前的位置与过桥起始点之间的距离及过桥终止点与过桥起始点之间的距离，若无人船当前的位置与过桥起始点之间的距离，较过桥终止点与过桥起始点之间的距离更远，则可以推测无人船已经驶出桥梁。如此，若定位信号已恢复，且根据无人船当前的位置信息推测无人船已经驶出桥梁，则判定无人船过桥结束。
本申请实施例提供的无人船过桥控制方法，通过过桥起始点和过桥终止点的经纬度计算得到过桥控制角度，在无人船行驶至过桥起始点时，调整无人船的方向使其与所述过桥控制角度重合，然后控制无人船驶入桥梁，过桥时，动态调整无人船的航向角使其与所述过桥控制角度保持重合，从而使无人船能够顺利穿越桥梁，解决了无人船行驶在桥梁下方时，因定位信号弱而导致无人船难以控制的技术问题。
如图1所示，在本发明一个优选实施例中，无人船过桥控制方法，在所述步骤S10之前还包括有步骤：S01、设定过桥起始点和过桥终止点。
作为一种可行的实施方式，所述步骤S01进一步包括有步骤S01a、S01b和S01c。
S01a、根据控制终端的遥控指令控制无人船行驶至桥的一侧，通过船载定位系统每隔一段时间获取一次无人船当前位置的经纬度及水平分量精度因子信息，得到过桥起始点点队列；
在具体实施中，构建一个过桥起始点点队列，记为
Figure BDA0003158312210000081
然后根据控制终端的遥控指令控制无人船行驶至桥的一侧，然后保持静止一段时间，此时无人船还未进入桥梁，定位信号强度高，通过船载定位系统每隔一段时间获取一次无人船当前位置的经纬度及水平分量精度因子信息，从而得到过桥起始点点队列
Figure BDA0003158312210000082
其中，N1,N2,N3...Nq表示无人船行驶至桥的一侧时连续获取的无人船当前位置的经纬度，即无人船停在桥一侧时，连续采集q个点的经纬度信息，q为大于3的自然数。
S01b、根据控制终端的遥控指令控制无人船行驶至桥的另一侧，通过船载定位系统每隔一段时间获取一次无人船当前位置的经纬度及水平分量精度因子信息，得到过桥终止点点队列；
在具体实施中，构建一个过桥终止点点队列，记为
Figure BDA0003158312210000083
然后根据控制终端的遥控指令控制无人船行驶至桥的另一侧，然后保持静止一段时间，此时无人船已驶出桥梁，定位信号强度高，通过船载定位系统每隔一段时间获取一次无人船当前位置的经纬度及水平分量精度因子信息，从而得到过桥终止点点队列
Figure BDA0003158312210000084
其中，M1,M2,M3...Mq表示无人船行驶至桥的另一侧时连续获取的无人船当前位置的经纬度，即无人船停在桥另一侧时，连续采集q个点的经纬度信息，q为大于3的自然数。
S01c、对所得的过桥起始点点队列和过桥终止点点队列进行加权平均，权值为每个点的水平分量精度因子，得到过桥起始点和过桥终止点的经纬度并上传后端数据库。
在具体实施中，以过桥起始点点队列
Figure BDA0003158312210000091
过桥终止点点队列
Figure BDA0003158312210000092
为基础数据，对纬度和经度取加权平均，权值为每个点的水平分量精度因子，最终得到过桥起始点的经纬度N0、过桥终止点的经纬度M0。
作为另一种可行的实施方式，设定过桥起始点和过桥终止点可以通过以下步骤完成：控制无人船行驶至桥的一侧，通过船载定位系统获取无人船当前位置的经纬度作为过桥起始点的经纬度；然后控制无人船行驶至桥的另一侧，然后通过船载定位系统获取无人船当前位置的经纬度作为过桥终止点的经纬度。
图2示出了本发明的一种无人船过桥控制装置的结构示意图，如图2所示，在本发明一个实施例中，无人船过桥控制装置包括有：
计算模块110，用于接收控制终端下达的过桥指令，根据所述过桥指令从后端数据库获取过桥起始点和过桥终止点的经纬度，并根据过桥起始点和过桥终止点的经纬度计算得到过桥控制角度；
过桥准备控制模块120，用于基于无人船当前的经纬度、航向角及过桥起始点的经纬度控制无人船行驶至过桥起始点；
惯性导航模块130，用于调整无人船的方向，使其与所述过桥控制角度重合，然后控制无人船驶入桥梁，过桥时，动态调整无人船的航向角，使其与所述过桥控制角度保持重合；
航迹推测模块140，用于基于惯性数据及过桥起始点的经纬度，采用惯性导航算法计算出无人船当前的位置信息；
过桥结束判定模块150，用于基于卫星信号数据、无人船当前的位置信息判定无人船过桥是否结束，若卫星信号数据和/或无人船当前的位置信息满足预设条件，则判定无人船过桥结束。
所述计算模块110、过桥准备控制模块120、惯性导航模块130、航迹推测模块140、过桥结束判定模块150为与图1所示实施例中的无人船过桥控制方法的步骤S10-S50一一对应的功能模块，可以对应执行图1所示实施例中的无人船过桥控制方法中的步骤S10-S50，以实现无人船过桥控制。
本申请实施例提供的无人船过桥控制装置，通过过桥起始点和过桥终止点的经纬度计算得到过桥控制角度，在无人船行驶至过桥起始点时，调整无人船的方向使其与所述过桥控制角度重合，然后控制无人船驶入桥梁，过桥时，动态调整无人船的航向角使其与所述过桥控制角度保持重合，从而使无人船能够顺利穿越桥梁，解决了无人船行驶在桥梁下方时，因定位信号弱而导致无人船难以控制的技术问题。
如图2所示，在本发明一个优选实施例中，无人船过桥控制装置还包括有坐标点设立模块101。所述坐标点设立模块101为与图1所示实施例中的无人船过桥控制方法的步骤S01对应的功能模块，可以执行图1所示实施例中的无人船过桥控制方法的步骤S01，以设定过桥起始点和过桥终止点。
图3示出了本发明的一种电子设备的结构示意图，如图3所示，在本发明一个实施例中，电子设备包括有处理器210以及与所述处理器210通信连接的存储器220。该电子设备还可以包括I/O接口230和通讯组件240。
其中，存储器220用于存储各种类型的数据以支持在该电子设备上的操作，这些数据可以包括用于在该电子设备上操作的任何应用程序或方法的指令，以及应用程序相关的数据，例如，用于执行上述的无人船过桥控制方法的程序指令、无人船的经纬度信息等等。该存储器220可以由任何类型的一个或一个以上易失性或非易失性存储设备或者它们的组合实现，例如静态随机存取存储器(Static Random Access Memory，简称SRAM)，电可擦除可编程只读存储器(Electrically Erasable Programmable Read-Only Memory，简称EEPROM)，可擦除可编程只读存储器(Erasable Programmable Read-Only Memory，简称EPROM)，可编程只读存储器(Programmable Read-Only Memory，简称PROM)，只读存储器(Read-Only Memory，简称ROM)，磁存储器，快闪存储器，磁盘或光盘。处理器210可以采用一个或一个以上，处理器210用于控制该电子设备的整体操作，通过调用执行所述存储器220存储的程序指令，以完成上述的无人船过桥控制方法的步骤。I/O接口230为处理器210和其他接口模块之间提供接口，上述其他接口模块可以是船载定位系统、惯性测量单元等。通信组件240用于该电子设备与其他设备之间进行有线或无线通信。无线通信包括Wi-Fi，蓝牙，近场通信(Near Field Communication，简称NFC)，2G、3G或4G，或它们中的一种或几种的组合，因此相应的该通信组件15可以包括：Wi-Fi模块，蓝牙模块，NFC模块。
本发明实施例还提供了一种包含有程序指令的存储介质，该程序指令被处理器执行时实现上述无人船过桥控制方法的步骤。其中，该存储介质可以为上述包括程序指令的存储器220，上述程序指令可由电子设备的处理器210执行以完成上述的无人船过桥控制方法。
以上所述仅为本发明的优选实施例，而非对本发明做任何形式上的限制。本领域的技术人员可在上述实施例的基础上施以各种等同的更改和改进，凡在权利要求范围内所做的等同变化或修饰，均应落入本发明的保护范围之内。

Claims (10)

1.一种无人船过桥控制方法，其特征在于，所述无人船过桥控制方法包括有步骤：
S10、接收控制终端下达的过桥指令，根据所述过桥指令从后端数据库获取过桥起始点和过桥终止点的经纬度信息，并根据过桥起始点和过桥终止点的经纬度计算得到过桥控制角度；
S20、基于无人船当前的经纬度、航向角及过桥起始点的经纬度控制无人船行驶至过桥起始点；
S30、调整无人船的方向，使其与所述过桥控制角度重合，然后控制无人船驶入桥梁，过桥时，动态调整无人船的航向角，使其与所述过桥控制角度保持重合；
S40、基于惯性数据及入桥前无人船的经纬度，采用惯性导航算法计算出无人船当前的位置信息；
S50、基于卫星信号数据、无人船当前的位置信息判定无人船过桥是否结束，若卫星信号数据和/或无人船当前的位置信息满足预设条件，则判定无人船过桥结束。
2.如权利要求1所述的无人船过桥控制方法，其特征在于，在所述步骤S10之前还包括有步骤：S01、设定过桥起始点和过桥终止点。
3.如权利要求2所述的无人船过桥控制方法，其特征在于，所述步骤S01进一步包括有：
根据控制终端的遥控指令控制无人船行驶至桥的一侧，通过船载定位系统每隔一段时间获取一次无人船当前位置的经纬度及水平分量精度因子信息，得到过桥起始点点队列；
根据控制终端的遥控指令控制无人船行驶至桥的另一侧，通过船载定位系统每隔一段时间获取一次无人船当前位置的经纬度及水平分量精度因子信息，得到过桥终止点点队列；
对所得的过桥起始点点队列和过桥终止点点队列进行加权平均，权值为每个点的水平分量精度因子，得到过桥起始点和过桥终止点的经纬度并上传后端数据库。
4.如权利要求1所述的无人船过桥控制方法，其特征在于，在所述步骤S10中，根据过桥起始点和过桥终止点的经纬度计算得到过桥控制角度进一步包括有：
将大地坐标系转化为平面直角坐标系，根据过桥起始点和过桥终止点的经纬度建立由过桥起始点指向过桥终止点的向量；通过三角函数计算得到该向量的方向，即为过桥控制角度。
5.如权利要求1所述的无人船过桥控制方法，其特征在于，所述步骤S20进一步包括有：
根据无人船当前的经纬度及过桥起始点的经纬度计算得到目标航向角；
将无人船当前的航向角与目标航向角比对，得到控制量并根据该控制量调整无人船的方向，进而控制无人船向过桥起始点运动。
6.如权利要求1所述的无人船过桥控制方法，其特征在于，所述步骤S30进一步包括有：
无人船到达起始点以后，将过桥控制角度作为目标航向角，然后将无人船当前的航向角与目标航向角比对，得到控制量并根据该控制量调整无人船的方向，使其与过桥控制角度重合，进而控制无人船驶入桥梁，向过桥终止点行进；
过桥时，实时获取无人船当前的航向角，控制无人船使无人船的航向角与过桥控制角度的差值保持在设定的范围内，控制无人船沿过桥控制角度向过桥终止点行进。
7.如权利要求1所述的无人船过桥控制方法，其特征在于，所述步骤S40进一步包括有：
实时获取无人船当前的前进油门值并将其加入到前进油门值队列中，同时实时获取无人船当前的旋转油门值并将其加入到旋转油门值队列中；
选取前进油门值队列、旋转油门值队列中的前N个数据，结合无人船的动力学模型，由前进油门值计算得到加速度，积分可得速度；由旋转油门值计算得到角速度；
对得到的速度及角速度进行饱和处理，使其处于无人船正常航行的范围内；
对经饱和处理后的速度及角速度进行积分，得到无人船的行驶距离及当前方向角；
利用无人船的行驶距离及当前方向角计算得到无人船在水平及垂直距离的行驶距离，随后将其转化为大地坐标系，再结合入桥前无人船的经纬度，即可得到无人船当前位置。
8.一种无人船过桥控制装置，其特征在于，所述无人船过桥控制装置包括有：
计算模块，用于接收控制终端下达的过桥指令，根据所述过桥指令从后端数据库获取过桥起始点和过桥终止点的经纬度，并根据过桥起始点和过桥终止点的经纬度计算得到过桥控制角度；
过桥准备控制模块，用于基于无人船当前的经纬度、航向角及过桥起始点的经纬度控制无人船行驶至过桥起始点；
惯性导航模块，用于调整无人船的方向，使其与所述过桥控制角度重合，然后控制无人船驶入桥梁，过桥时，动态调整无人船的航向角，使其与所述过桥控制角度保持重合；
航迹推测模块，用于基于惯性数据及过桥起始点的经纬度，采用惯性导航算法计算出无人船当前的位置信息；
过桥结束判定模块，用于基于卫星信号数据、无人船当前的位置信息判定无人船过桥是否结束，若卫星信号数据和/或无人船当前的位置信息满足预设条件，则判定无人船过桥结束。
9.一种电子设备，其特征在于，所述电子设备包括有至少一个处理器以及与所述处理器通信连接的至少一个存储器，其中，所述存储器存储有程序指令，所述程序指令被所述处理器调用执行时实现权利要求1至7任一项所述的无人船过桥控制方法。
10.一种存储介质，其特征在于，所述存储介质存储有程序指令，所述程序指令被处理器执行时实现权利要求1至7任一项所述的无人船过桥控制方法。
CN202110783834.4A 2021-07-12 2021-07-12 一种无人船过桥控制方法、装置、电子设备及存储介质 Active CN113406961B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110783834.4A CN113406961B (zh) 2021-07-12 2021-07-12 一种无人船过桥控制方法、装置、电子设备及存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110783834.4A CN113406961B (zh) 2021-07-12 2021-07-12 一种无人船过桥控制方法、装置、电子设备及存储介质

Publications (2)

Publication Number Publication Date
CN113406961A true CN113406961A (zh) 2021-09-17
CN113406961B CN113406961B (zh) 2024-03-29

Family

ID=77686090

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110783834.4A Active CN113406961B (zh) 2021-07-12 2021-07-12 一种无人船过桥控制方法、装置、电子设备及存储介质

Country Status (1)

Country Link
CN (1) CN113406961B (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115113630A (zh) * 2022-08-26 2022-09-27 陕西欧卡电子智能科技有限公司 无人船过桥方法、装置、计算机设备及存储介质
CN115616610A (zh) * 2022-12-19 2023-01-17 陕西欧卡电子智能科技有限公司 船舶通过桥梁的检测方法、装置、计算机设备及存储介质

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
ES2213868T3 (es) * 1997-11-21 2004-09-01 Joachim Bohmer Garaje.
CN105446368A (zh) * 2016-01-20 2016-03-30 华德宝机械（昆山）有限公司 一种登船桥渡板调节控制系统及登船桥
CN107493460A (zh) * 2017-09-21 2017-12-19 北京图森未来科技有限公司 一种图像采集方法及系统
CN108573280A (zh) * 2018-04-08 2018-09-25 四方继保（武汉）软件有限公司 一种无人船自主通过桥梁的方法
CN109448443A (zh) * 2018-11-06 2019-03-08 广州怡禄电讯科技有限公司 基于视频分析的桥梁防撞监测系统
CN109911114A (zh) * 2019-03-08 2019-06-21 大连海事大学 一种具有三级减震自稳系统的无人船
CN111142527A (zh) * 2019-12-31 2020-05-12 陕西欧卡电子智能科技有限公司 无人船任意路径的追踪控制方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
ES2213868T3 (es) * 1997-11-21 2004-09-01 Joachim Bohmer Garaje.
CN105446368A (zh) * 2016-01-20 2016-03-30 华德宝机械（昆山）有限公司 一种登船桥渡板调节控制系统及登船桥
CN107493460A (zh) * 2017-09-21 2017-12-19 北京图森未来科技有限公司 一种图像采集方法及系统
CN108573280A (zh) * 2018-04-08 2018-09-25 四方继保（武汉）软件有限公司 一种无人船自主通过桥梁的方法
CN109448443A (zh) * 2018-11-06 2019-03-08 广州怡禄电讯科技有限公司 基于视频分析的桥梁防撞监测系统
CN109911114A (zh) * 2019-03-08 2019-06-21 大连海事大学 一种具有三级减震自稳系统的无人船
CN111142527A (zh) * 2019-12-31 2020-05-12 陕西欧卡电子智能科技有限公司 无人船任意路径的追踪控制方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
郑大明: "桥梁斜交角度控制对船舶过桥操纵的影响", 《集美大学学报》, vol. 23, no. 1, pages 47 - 51 *

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115113630A (zh) * 2022-08-26 2022-09-27 陕西欧卡电子智能科技有限公司 无人船过桥方法、装置、计算机设备及存储介质
CN115113630B (zh) * 2022-08-26 2022-12-09 陕西欧卡电子智能科技有限公司 无人船过桥方法、装置、计算机设备及存储介质
CN115616610A (zh) * 2022-12-19 2023-01-17 陕西欧卡电子智能科技有限公司 船舶通过桥梁的检测方法、装置、计算机设备及存储介质

Also Published As

Publication number Publication date
CN113406961B (zh) 2024-03-29

Similar Documents

Publication Publication Date Title
US9377780B1 (en) Systems and methods for determining a heading value of a marine vessel
US10067503B2 (en) Method for recording flight path and controlling automatic flight of unmanned aerial vehicle
US5523951A (en) System and method for automatic ship steering
CN113406961A (zh) 一种无人船过桥控制方法、装置、电子设备及存储介质
US11906983B2 (en) System and method for tracking targets
CN112835085B (zh) 确定车辆位置的方法和装置
CN106352872B (zh) 一种无人机自主导航系统及其导航方法
US11662418B2 (en) Blind area tracking method and apparatus for directional antenna and motion tracking system
US10732298B2 (en) Operating device, operating method, operating system, and operating program
CN114046792B (zh) 一种无人船水面定位与建图方法、装置及相关组件
EP3598264B1 (en) Flight control method and device of unmanned aerial vehicle, and unmanned aerial vehicle
CN111070205A (zh) 对桩控制方法、装置、智能机器人及存储介质
Yan et al. Performance assessment of the android smartphone’s IMU in a GNSS/INS coupled navigation model
CN112650257B (zh) 一种无人艇区域保持控制方法及装置
US20210263162A1 (en) Method for determining the position and orientation of a vehicle
KR20170090138A (ko) 선박의 위험환경 회피 시스템 및 이를 이용한 회피 방법
CN114779791A (zh) 一种波浪滑翔器位置保持方法及系统
CN115617052A (zh) 流速下的无人船入库方法、装置、计算机设备及存储介质
US11061145B2 (en) Systems and methods of adjusting position information
CN116755472A (zh) 一种基于通信链路切换的海上异构无人平台、编队控制方法
CN108287538A (zh) 一种基于rtk技术无人驾驶船系统
Almeida et al. ίVAMOS! Underwater Mining Machine Navigation System
US20230409050A1 (en) Aircraft control system, aircraft, aircraft control method, and program
RU2617147C1 (ru) Способ начального ориентирования гироскопической навигационной системы для наземных подвижных объектов
CN114791735A (zh) 无人船纠偏方法及系统

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant