CN114924564A - 一种无人船自主航行控制系统 - Google Patents
一种无人船自主航行控制系统 Download PDFInfo
- Publication number
- CN114924564A CN114924564A CN202210579665.7A CN202210579665A CN114924564A CN 114924564 A CN114924564 A CN 114924564A CN 202210579665 A CN202210579665 A CN 202210579665A CN 114924564 A CN114924564 A CN 114924564A
- Authority
- CN
- China
- Prior art keywords
- unmanned ship
- navigation
- control
- control system
- data
- 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.)
- Pending
Links
- 238000012545 processing Methods 0.000 claims abstract description 26
- 238000013500 data storage Methods 0.000 claims abstract description 15
- 238000011217 control strategy Methods 0.000 claims abstract description 14
- 238000007726 management method Methods 0.000 claims abstract description 9
- 230000005540 biological transmission Effects 0.000 claims description 30
- 238000005259 measurement Methods 0.000 claims description 16
- 238000000034 method Methods 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 5
- 230000005611 electricity Effects 0.000 claims description 2
- 238000005096 rolling process Methods 0.000 claims description 2
- 238000005516 engineering process Methods 0.000 description 3
- 230000002093 peripheral effect Effects 0.000 description 3
- 230000000007 visual effect Effects 0.000 description 3
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 3
- WHXSMMKQMYFTQS-UHFFFAOYSA-N Lithium Chemical compound [Li] WHXSMMKQMYFTQS-UHFFFAOYSA-N 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 229910052744 lithium Inorganic materials 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000007175 bidirectional communication Effects 0.000 description 1
- 230000006854 communication Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 210000001503 joint Anatomy 0.000 description 1
- 230000014759 maintenance of location Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
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
技术领域
本发明属于船舶自主航行技术领域，具体为一种无人船自主航行控制系统。
背景技术
无人船是一种不依赖于人员控制，具有一定程度的自主航行能力、可实现实时环境感知、实时数据监测等任务的智能水面航行器。近年来，随着海洋产业以及海洋军事的迅速发展，无人船的研究已经逐渐成为当下船舶研究的新的热点方向。无人船自主航行技术是实现无人船智能、可靠运行的关键技术，要想使无人船可以按照既定的航线稳定、可靠地运行，就必须在自主航行技术上有所突破。通过设计合适的自主航行系统和控制算法，使无人船根据任务需求对航线进行自主规划，以及通过在运行过程中对无人船的航速、航向进行控制，使无人船沿着规划好的轨迹稳定航行是无人船自动驾驶的核心问题。
但在无人船执行任务时，往往需要有一名地面站操作人员看着无人船或者对着船端的摄像头实时传回的画面持续控制才能进行，因此目前的无人船不完全具备自主航行能力。
发明内容
发明目的：为解决在无人船执行任务时，往往需要有一名地面站操作人员看着无人船或者对着船端的摄像头实时传回的画面持续控制才能进行的问题，本发明提出了一种无人船自主航行控制系统，使搭载本系统的无人船都具备自主航行能力，实现稳定可靠自主航行，并且能够实时回传无人船航行姿态、位置、状态等航行信息和图像信息。
技术方案：一种无人船自主航行控制系统，包括：主控系统、协处理系统、电源管理系统、数据采集系统、数据保存系统和推进系统；
所述电源管理系统，用于为其他系统供电；
所述数据采集系统，用于获取无人船的实时运行信息；
所述数据保存系统，用于保存无人船待执行的运行信息；
所述主控系统，用于将无人船的实时运行信息与待执行的运行信息进行比对，得到无人船自主航行的控制策略，并将该控制策略发送给协处理系统；
所述协处理系统，用于依据控制策略向推进系统发送控制信号；
所述推进系统，用于根据接收到的控制信号，控制无人机航行，实现自主航行。
进一步的，所述的数据采集系统包括：
高度测量系统，用于实时获取无人船的垂荡信息；
导航与定位系统，用于实时获取无人船的定位信息；
航行姿态测量系统，用于实时获取无人船的航行姿态信息；
数传图传系统，用于采集无人船在航行过程中的航行数据和图像信息。
进一步的，所述的航行数据包括无人船的航速、艏向、航向。
进一步的，所述航行姿态测量系统包括：
双轴倾角传感器，用于获取无人船相对于水平面的倾斜角度和俯仰角度；
陀螺仪模块，用于获取无人船航行时的加速度、航向角、横摇、纵摇数据。
进一步的，所述高度测量系统包括气压计模块。
进一步的，所述导航与定位系统包括BDS模块。
进一步的，所述控制信号包括用于控制推进系统的PWM信号。
进一步的，所述推进系统包括：电调、舵、无刷电调、第二电机、推进器、有刷电调、第一电机和推侧器；
所述电调依据控制信号控制舵，实现对无人船的转向控制；
所述无刷电调依据控制信号控制第二电机，由第二电机带动推进器，实现对无人船的前进控制；
所述有刷电调依据控制信号控制第一电机，由第一电机带动侧推器，实现对无人船的水平面侧移控制。
有益效果：本发明与现有技术相比，具有以下优点：
(1)本发明的控制系统实现了无人船的自动出坞、自动返航、水面悬停、自动靠离泊等自主航行功能；
(2)本发明的控制系统可推广到无人车、无人潜航器等需要自主航行的无人系统当中，具有一定的普适性；
(3)搭载本发明控制系统的无人船，可实现船舶的无人自主航行功能(不包括避障功能)，当面临水面工作环境恶劣时，可使用搭载本发明控制系统的无人船执行任务。
附图说明
图1为无人船自主航行系统总体框架图；
图2为本发明的推进系统布置图。
具体实施方式
现结合附图和实施例进一步阐述本发明的技术方案。
如图1所示，本发明的无人船自主航行控制系统由主控系统1、协处理系统3、远距离遥控系统5、电源管理系统7、高度测量系统10、数据保存系统12、导航与定位系统14、航行姿态测量系统16、调试系统18、数传图传系统22和推进系统26组成。
其中，高度测量系统10、导航与定位系统14、航行姿态测量系统16和数传图传系统22均用于在航行时采集无人机实时的运行信息。现对上述系统的功能做进一步说明。
该高度测量系统10，用于检测所在区域的无人船的垂荡信息，并通过SPI总线将无人船的垂荡信息反馈给主控系统1。在一些实施例中，高度测量系统10内包含气压计模块BMP280。
该导航与定位系统14，用于采集无人船的定位信息，并通过串行外设接口SPI将无人船的定位信息发送给主控系统1。在一些实施例中，导航与定位系统14内包含BDS模块15，该BDS模块15将采集到的无人船的定位信息通过串行外设接口SPI上传给主控系统1。
该航行姿态测量系统16，用于无人船实时的航行姿态信息，该航行姿态信息包括但不限于无人船航行时的加速度、航向角、横摇、纵摇数据以及无人船相对于水平面的倾斜角度和俯仰角度。在一些实施例中，航行姿态测量系统16可由陀螺仪模块MPU9250和双轴倾角传感器LCA326组成，陀螺仪模块MPU9250内部集成有3轴陀螺仪、3轴加速度计和3轴磁力计，用于输出无人船航行时的加速度、航向角、横摇、纵摇数据。双轴倾角传感器LCA326设置有双通道地球引力倾斜单元，通过测量静态重力加速度，转换成倾角变化，从而可测量双轴倾角传感器LCA326输出相对于水平面的倾斜和俯仰角度，即双轴倾角传感器LCA326用于获取无人船相对于水平面的倾斜角度和俯仰角度。主控系统1用于融合陀螺仪模块和双轴倾角传感器LCA326获取的数据，当陀螺仪模块获取的数据与实际无人船的数据误差大于5度时，主控系统1可采用双轴倾角传感器LCA326获取的数据对陀螺仪模块获取的数据进行修正，弥补系统算法层面因为修正不够导致的精度下降。
该数传图传系统22，用于采集无人船在自主航行过程中的航行数据和图像，航行数据包括无人船的航速、艏向、航向等，图像为无人船以第一视角拍摄的画面；并通过自组网/4G方式与主控系统完成通信。在一些实施例中，数传图传系统22可由900M数传调试电台模块、4G数传电台模块和4G图传机模块组成；900M数传调试电台模块用于近距离自组网数据传输，4G数传电台模块和4G图传机模块通过4G链路分别传回航行数据和图像。
本发明的主控系统1，获取无人船实时的运行信息，获取的方式包括但不限于UART、SPI、RS232、ADC。主控系统1从数据保存系统12获取待执行的运行信息，将待执行的运行信息与无人船实时的运行信息进行比对，基于对比结构，得到无人船自主航行的控制策略，该控制策略包括转向、前进或水平面侧移运动。该主控系统1与其他系统的数据传递关系为：
通过RS232方式接收来自航行姿态测量系统16的航行姿态信息；以及通过串行外设接口SPI接收来自导航与定位系统14的定位信息；以及通过SPI总线接收来自高度测量系统10的无人船的垂荡信息，以及通过船载SDIO接口将需存储的数据存储至数据保存系统12或者从数据保存系统12中获取所需的待执行的运行信息，该待执行的运行信息是事先存储至数据保存系统12中的；以及通过自组网/4G方式与数传图传系统22进行双向通信包括：向数传图传系统22发送采集航行时的数据与图像信息的命令、接收来自数传图传系统22的航行数据和图像信息；以及通过自组网、4G、USB方式与调试系统进行通讯。以及通过通用串行数据总线UART将得到的无人船自主航行的控制策略发送给协处理系统3。本实施例中，采用型号为STM32F407的主控系统。
本发明的协处理系统3通过通用串行数据总线UART与主控系统1进行通信，主控系统1发送无人船实时的运行信息给协处理系统3，此处将无人船实时的运行信息发送给协处理系统3的目的是由协处理系统3进行备份。
协处理系统3根据接收到的无人船偏航程度的判定信息对推进系统26进行控制；无人船偏航越远，推进系统26的功率越大，
根据主控系统1下发的控制策略，协处理系统3中编写好单片机程序，由单片机的IO口产生PWM信号以此来驱动推进系统26，使无人船实现自主航行。同时，协处理系统3可以通过SBUS总线接收来自远距离遥控系统5的PPM格式编码的控制指令，基于该控制指令来驱动推进系统26。同时，协处理系统3可以通过集成电路总线IIC接收来自航行姿态测量系统16的航行姿态信息，主要目的在于对航行姿态信息进行备份。
本发明的远距离遥控系统5用于当无人船在执行自主航行任务出现故障时，通过SBUS总线向协处理系统3发送PPM格式编码的控制指令，通过在协处理系统3中解码为8通道的PWM信号，此PWM信号可直接用于驱动推进系统26，因此通过对8通道进行定义，使无人船处于不同的模式，例如定义通道1的PWM信号为无人船处于遥控器控制状态，即无人船处于手动模式。定义通道2的PWM信号使无人船处于悬停模式，以此类推到通道8。在一些实施例中，远距离遥控系统5内包含有2.4G模块6，该2.4G模块6通过SBUS总线向协处理系统3发送指令。
本发明的数据保存系统12用于保存数传图传系统22回传给主控系统的航行数据和图像，航行数据包括无人船的航速、艏向、航向等，图像为无人船以第一视角拍摄的画面；具体的，数据保存系统12通过船载SDIO接口接收来自主控系统1下发的数据，对该数据进行保存，以及在数据保存系统12中事先存储待执行的运行信息，供主控系统1调用。在一些实施例中，数据保存系统12内包含SD卡模块13。
如图2所示，本发明的推进系统26主要包括电调27、舵28、无刷电调29、第二电机30、推进器31、有刷电调32、第一电机33和推侧器34；协处理系统3发送的PWM信号驱动电调27，电调27控制舵28，完成对无人船的转向控制；协处理系统3发送的PWM信号驱动无刷电调29，无刷电调29控制第二电机30，第二电机30带动推进器31，完成无人船的前进控制；协处理系统3发送的PWM信号驱动有刷电调32，有刷电调32控制第一电机33，第一电机33带动侧推器34，完成无人船的水平面侧移运动(类似汽车的侧方停车)。本发明的电源管理系统7用于对控制系统内所有的系统进行供电。在一些实施例中，电源管理系统7可由高性能锂电池9和电流计模块8组成。电流计模块8将高性能锂电池9的电能降压到11.1V给各系统供电，降压到5V给主控系统和协处理系统供电。
本发明的调试系统18用于实验人员使用地面站在对无人船进行调试时的对接。在一些实施例中，调试系统18可由900M数传调试电台、USB调试接口和4G数传调试电台组成，900M数传调试电台用于近距离无线调试使用，通过自组网Digimesh方式与主控系统进行数据传输；USB调试接口用于近距离有线调试使用，通过USB有线方式与主控系统进行数据传输；4G数传调试电台用于远程无线调试使用，通过4G物联网卡方式与主控系统进行无线传输。
实施例：
现通过一实施例来说明本发明系统。
假设待执行的自主航行任务，包括：从当前位置点A到下一时刻目标点B。与这个任务相匹配的信息包括：无人船在A点的航行姿态信息和定位信息，以及无人船在B点的航行姿态信息和定位信息。
若无人船要执行从A点到B点的自主航行任务，控制策略如下：根据上述A点和B点的姿态信息和定位信息，得到无人船A点到B点的期望航向角、AB两点的直线视距，采用直线视距LOS法将无人船的位置跟踪问题转化为航向控制问题，通过程序内设置的PID控制器，使无人船的航向角收敛于期望航向角，从而使无人船不断驶向B点，到达B点后B点转变为A点，再将新A点与数据保存系统中的下一个B点进行对比。
Claims (8)
1.一种无人船自主航行控制系统，其特征在于：包括：主控系统、协处理系统、电源管理系统、数据采集系统、数据保存系统和推进系统；
所述电源管理系统，用于为其他系统供电；
所述数据采集系统，用于获取无人船的实时运行信息；
所述数据保存系统，用于保存无人船待执行的运行信息；
所述主控系统，用于将无人船的实时运行信息与待执行的运行信息进行比对，得到无人船自主航行的控制策略，并将该控制策略发送给协处理系统；
所述协处理系统，用于依据控制策略向推进系统发送控制信号；
所述推进系统，用于根据接收到的控制信号，控制无人机航行，实现自主航行。
2.根据权利要求1所述的一种无人船自主航行控制系统，其特征在于：所述的数据采集系统包括：
高度测量系统，用于实时获取无人船的垂荡信息；
导航与定位系统，用于实时获取无人船的定位信息；
航行姿态测量系统，用于实时获取无人船的航行姿态信息；
数传图传系统，用于采集无人船在航行过程中的航行数据和图像信息。
3.根据权利要求2所述的一种无人船自主航行控制系统，其特征在于：所述的航行数据包括无人船的航速、艏向、航向。
4.根据权利要求1所述的一种无人船自主航行控制系统，其特征在于：所述航行姿态测量系统包括：
双轴倾角传感器，用于获取无人船相对于水平面的倾斜角度和俯仰角度；
陀螺仪模块，用于获取无人船航行时的加速度、航向角、横摇、纵摇数据。
5.根据权利要求1所述的一种无人船自主航行控制系统，其特征在于：所述高度测量系统包括气压计模块。
6.根据权利要求1所述的一种无人船自主航行控制系统，其特征在于：所述导航与定位系统包括BDS模块。
7.根据权利要求1所述的一种无人船自主航行控制系统，其特征在于：所述控制信号包括用于控制推进系统的PWM信号。
8.根据权利要求1所述的一种无人船自主航行控制系统，其特征在于：所述推进系统包括：电调、舵、无刷电调、第二电机、推进器、有刷电调、第一电机和推侧器；
所述电调依据控制信号控制舵，实现对无人船的转向控制；
所述无刷电调依据控制信号控制第二电机，由第二电机带动推进器，实现对无人船的前进控制；
所述有刷电调依据控制信号控制第一电机，由第一电机带动侧推器，实现对无人船的水平面侧移控制。
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202210579665.7A CN114924564A (zh) | 2022-05-26 | 2022-05-26 | 一种无人船自主航行控制系统 |
| PCT/CN2023/077612 WO2023226485A1 (zh) | 2022-05-26 | 2023-02-22 | 一种无人船自主航行控制系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202210579665.7A CN114924564A (zh) | 2022-05-26 | 2022-05-26 | 一种无人船自主航行控制系统 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN114924564A true CN114924564A (zh) | 2022-08-19 |
Family
ID=82810402
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202210579665.7A Pending CN114924564A (zh) | 2022-05-26 | 2022-05-26 | 一种无人船自主航行控制系统 |
Country Status (2)
| Country | Link |
|---|---|
| CN (1) | CN114924564A (zh) |
| WO (1) | WO2023226485A1 (zh) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2023226485A1 (zh) * | 2022-05-26 | 2023-11-30 | 江苏科技大学 | 一种无人船自主航行控制系统 |
Family Cites Families (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2017140096A1 (zh) * | 2016-02-18 | 2017-08-24 | 北京臻迪科技股份有限公司 | 一种无人船及系统 |
| CN106444767B (zh) * | 2016-10-24 | 2019-06-21 | 天津城建大学 | 一种基于apm和i7智能芯片的联动组合自主导航无人船控制系统 |
| CN206470602U (zh) * | 2016-12-30 | 2017-09-05 | 海天水务集团股份公司 | 采样检测无人船的智能控制系统 |
| CN107229276A (zh) * | 2017-05-27 | 2017-10-03 | 浙江大学 | 基于ARM Cortex‑M7处理器的智能无人船平台及其控制方法 |
| CN108549396B (zh) * | 2018-04-17 | 2021-03-02 | 福州大学 | 一种基于stm32f429的双电机驱动无人船控制系统 |
| CN114924564A (zh) * | 2022-05-26 | 2022-08-19 | 江苏科技大学 | 一种无人船自主航行控制系统 |
-
2022
- 2022-05-26 CN CN202210579665.7A patent/CN114924564A/zh active Pending
-
2023
- 2023-02-22 WO PCT/CN2023/077612 patent/WO2023226485A1/zh unknown
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| WO2023226485A1 (zh) * | 2022-05-26 | 2023-11-30 | 江苏科技大学 | 一种无人船自主航行控制系统 |
Also Published As
| Publication number | Publication date |
|---|---|
| WO2023226485A1 (zh) | 2023-11-30 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN106394815B (zh) | 一种无人船加无人潜水器的组合系统 | |
| CN104369842B (zh) | 基于自主水下航行器的水面辅助机器人及使用方法 | |
| WO2020220654A1 (zh) | 一种无人船搭载无人机的海上巡逻设备及其使用方法 | |
| CN109131801A (zh) | 全海深无人潜水器的自主回收装置及控制方法 | |
| CN107065882B (zh) | 一种usv水面动态自主回收uuv的方法 | |
| CN103176451B (zh) | 一种舰船辅助航行及编队指挥的方法 | |
| CN105905244B (zh) | 自守位声纳定位浮标 | |
| CN112558642B (zh) | 一种适用于异构多无人系统的海空联合围捕方法 | |
| CN105667745A (zh) | 自主水下航行器及其控制方法 | |
| CN108321598B (zh) | 一种模块化水下自治航行器 | |
| CN105468014A (zh) | 一种单自驾仪一体化的飞行器系统及其二维云台控制方法 | |
| CN110456793B (zh) | 一种无人艇自主停泊方法、装置及无人艇 | |
| CN111679669B (zh) | 一种无人船自主精准停靠方法及系统 | |
| CN112960078A (zh) | 一种无人帆船自动驾驶系统及其方法 | |
| WO2023226485A1 (zh) | 一种无人船自主航行控制系统 | |
| CN107878669A (zh) | 智慧水面监测三体船 | |
| CN106444767A (zh) | 一种基于apm和i7智能芯片的联动组合自主导航无人船控制系统 | |
| CN111438691B (zh) | 仿生六足机器蟹控制系统 | |
| CN114355914B (zh) | 用于无人船的自主巡航系统及控制方法 | |
| JP2022029823A (ja) | 無人飛行体の制御システム、及び無人飛行体の制御方法 | |
| KR20190067601A (ko) | 연안 모니터링 및 관측을 위한 공중 및 수상 복합 이동체 | |
| CN109263814B (zh) | 一种水面多功能自主巡航船系统 | |
| CN109334968A (zh) | 可空中实时重构的涵道飞行器、对接分离方法及系统 | |
| CN108255176B (zh) | 一种双无人艇自主协同回收船舶方法 | |
| CN111942530A (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 |