CN115047868A - 一种无人船自主航行系统及其方法 - Google Patents
一种无人船自主航行系统及其方法 Download PDFInfo
- Publication number
- CN115047868A CN115047868A CN202210529661.8A CN202210529661A CN115047868A CN 115047868 A CN115047868 A CN 115047868A CN 202210529661 A CN202210529661 A CN 202210529661A CN 115047868 A CN115047868 A CN 115047868A
- Authority
- CN
- China
- Prior art keywords
- unmanned ship
- ship
- pixhawk
- unmanned
- firmware
- 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
- 238000000034 method Methods 0.000 title claims abstract description 23
- 238000001514 detection method Methods 0.000 claims abstract description 19
- 240000007651 Rubus glaucus Species 0.000 claims abstract description 14
- 235000011034 Rubus glaucus Nutrition 0.000 claims abstract description 14
- 235000009122 Rubus idaeus Nutrition 0.000 claims abstract description 14
- 230000033001 locomotion Effects 0.000 claims abstract description 7
- 230000006870 function Effects 0.000 claims description 12
- 230000009471 action Effects 0.000 claims description 9
- 230000002093 peripheral effect Effects 0.000 claims description 8
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 8
- 230000004044 response Effects 0.000 claims description 7
- 230000003044 adaptive effect Effects 0.000 claims description 4
- 238000004891 communication Methods 0.000 claims description 4
- 230000000694 effects Effects 0.000 claims description 4
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims description 3
- 230000008569 process Effects 0.000 claims description 2
- 239000008186 active pharmaceutical agent Substances 0.000 claims 2
- 238000004804 winding Methods 0.000 claims 1
- 230000002349 favourable effect Effects 0.000 abstract 1
- 238000004140 cleaning Methods 0.000 description 6
- 238000012544 monitoring process Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 238000010408 sweeping Methods 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
本发明公开了一种无人船自主航行系统及其方法,包括:船端部分,用于无人船的航行姿态和位置检测、数据采集、执行元件控制,含树莓派、Pixhawk、GPS、航姿检测模块、电机;岸基部分,包括无线收发器、用于从岸端向船端发送控制指令的遥控器和地面站;地面站包括远程控制平台或PC,和无人船无线通信并进行控制,上传新任务和设置参数;工作人员可用API通过Mavlink协议与无人船通信,实现对无人船状态和参数信息的编程访问,以及对无人船运动的直接控制;可通过地面站实时观测无人船的位置、航点、航速等信息,并对系统的在线参数实时调整。本发明无人船的自主航行程度高,有利于提高无人船的模块化和标准化水平。
Description
技术领域
本发明属于船舶自主航行技术领域,涉及一种无人船自主航行系统及其方法。
背景技术
无人船是一种不依赖于人员控制,具有一定程度的自主航行能力、可实现实时环境感知、实时数据监测等任务的智能水面航行器。随着计算机、通信、导航以及控制技术的迅速发展,无人船被逐渐应用于军事上的海洋巡视、侦查监视以及扫雷等工作;与此同时,通过搭载不同的功能模块,无人船也逐渐被广泛应用于海洋救援、垃圾清理、水文地形探测、环境气候监测以及灾害预警等民用领域中。相比于传统的人工操纵船舶,无人船具有更高的航行精度与更稳定的运行效果,并在减少人力投入,降低任务危险性等方面具有突出的优势。因此,随着信息技术的高度发达与无人驾驶技术的日渐成熟,无人船在应用上越来越受到人们的青睐。
目前,对无人船的研究还有很多关键技术需要突破。在自主航行技术领域,无人船在执行复杂任务时,往往需要有一名地面站操作人员看着无人船或对着船端的摄像头实时传回的画面持续控制才能进行,类似虚拟驾驶。此方案实质上是通过人员远程驾驶无人船实现的自主航行,航行时的精确性和稳定性目前都无法保证,严重依赖驾驶人员。如何使无人船自动沿着规划好的轨迹稳定可靠航行,是当前要迫切需要解决的问题。
发明内容
本发明的目的在于克服现有技术的缺陷,提供一种无人船自主航行系统及其方法,能够实时回传无人船航行姿态、位置、状态等航行信息和图像信息,从而实现无人船沿着规划好的轨迹稳定可靠的自主航行。
为解决上述技术问题,本发明采用以下技术方案:
本发明的一种无人船自主航行系统,包括:
船端部分,用于无人船的航行运动姿态检测、位置信息检测、航行数据采集、执行元件控制;包括树莓派、Pixhawk、GPS模块、航姿检测模块、由第一电调提供驱动的第一电机、由第二电调提供驱动的第二电机;Pixhawk提供相对稳定和高效的自动驾驶实现方式;GPS模块为无人船提供准确的定位信息;航姿检测模块为无人船提供实时的航向与姿态信息;无人船由第一电机和第二电机提供推进,并通过两个电机的差速转动实现转向;所述的树莓派在Linux操作系统上运行,使用Python语言编程,并有对应库对Pixhawk进行访问;
测试人员可使用API通过Mavlink协议与无人船进行通信,从而实现对无人船的状态和参数信息的编程访问,以及对无人船运动的直接控制;
岸基部分,包括用于岸基和Pixhawk的数据传输的无线收发器、用于从岸端向船端发送控制指令的遥控器、地面站;所述的地面站是在岸基PC端上运行的软件应用程序,包括远程控制平台或PC端,通过无线方式和无人船进行通信,控制航行中的无人船,上传新任务和设置参数;操作人员通过地面站实时观测无人船的各项信息:位置、航点、航向、航速、设备剩余电量,并进行系统的在线参数实时调整。所述的地面站是虚拟驾驶舱,可显示无人船航姿和位置的实时数据、与真实驾驶无人船相同的仪表数据和来自船端树莓派摄像机的实时视频;地面站所采用版本为Windows下的Mission Planner。
优选的,所述的遥控器采用乐迪R9DS,所述的无线收发器采用XB Radio PRO,所述的Pixhawk采用版本为Pixhawk 2.4.8,所述的航姿检测模块采用北微BWK218。
本发明的一种无人船自主航行方法,采用上述的无人船自主航行系统,其方法包括:
第一阶段:根据无人船实际情况,对无人船自主航行系统进行固件配置和参数调整;其固件可直接应用开源飞控社区发布的无人船固件;其内部函数和参数需要根据无人船进行实际调整的步骤包括:
S1.1.船端部分与地面站建立链接:将系统上电,使船端和岸端初始化,岸端通过无线收发器和船端Pixhawk建立链接;
S1.2.将无人船固件加载到Pixhawk硬件当中并获取固件参数:先判断系统内设备是否为自动驾驶仪Pixhawk,再判断自动驾驶仪Pixhawk内固件是否为无人船固件;若是,则执行下一步,若否,则需要人员进行固件修改,更新后再获取无人船固件内参数;
S1.3.设置并配置外围设备,包括GPS模块、航姿检测模块、无线收发器、遥控器;
S1.4.对无人船固件内参数进行调整并修改实船的控制增益,使无人船的响应和固件参数整体配置相适应;
第二阶段,无人船航迹规划,包括:
S2.1.无人船配置和参数调整完毕后将系统重启,系统初始化并进行软件自检和硬件自检,打开地面站并通过软件写入航点并生成航线,航点生成航线的算法为B样条曲线拟合;
S2.2.拟合成航线后,将航线信息转换为Google地图中的经纬度信息并通过Mavlink协议传输到Pixhawk中,使用遥控器通过SBUS协议发送解锁指令,此时无人船处于非自主巡航模式,需要测试人员通过遥控器发送执行自主巡航指令,系统才会执行预设的自主巡航任务;系统可通过遥控器发送其它巡航模式的对应模式切换指令,使无人船执行相应模式下的航行任务。
具体地,在第一阶段所述的设置并配置外围设备,其过程包括:外接的GPS模块需要TTL电平,接Pixhawk的RX和接地口;Pixhawk向外发送GPS配置命令,若GPS不兼容会对GPS造成干扰,故TX口不接;接线后需要360度旋转GPS以校准模块;Mission planner内需对GPS_RATE_MS和GPS_TYPE等软件参数进行配置,来设置GPS模块的发送频率、通信方式;航姿检测模块需布置在Pixhawk的正上方一同旋转来初始化硬件;无线收发器需配置Mesh自组网模式和SBUS模式;遥控器的通道1和2设置为控制左右电机,通道5的PWM占空比用来作航行模式的切换:占空比0-10%为手动模式,10-30%为自主巡航模式。
具体地,在第一阶段所述的对无人船固件内参数进行调整并修改实船的控制增益,使无人船的响应和固件参数整体配置相适应,包括在Mission planner内配置如下关键函数和参数:
ARMING_CHECK配置为0,关闭Pixhawk解锁前的自检开关;
ARMING_REQUIRE配置为1,硬件上电使能;
BRD_SAFETYENABLE配置为1,使能Pixhawk安全解锁开关;
FENCE_ACTION配置为0,无人船突破电子围栏时没有动作;
FENCE_ENABLE配置为0,关闭电子围栏;
FRAME_CLASS配置为2,Mission planner软件内使用船固件;
FS_THR_ENABLE配置为1,油门低于预设值时开启失控保护;
PILOT_STEER_TYPE配置为1,选择无人船偏航时策略;
PIVOT_TURN_ANGLE配置为60,在艏向偏角大于此参数时做绕点转向动作;
SERVO1_FUNCTION配置为73,为无人船左桨控制通道;
SERVO3_FUNCTION配置为74,为无人船右桨控制通道;
Pixhawk控制电机的实际增益由调节SERVO1_OUTPUT和SERVO3_OUTPUT通道的PID输出决定。
进一步的,无人船的巡航模式包括:非自主巡航模式,按照Mission planner软件内规划好的航线,沿航线行驶;手动模式,允许测试人员远程人工驾驶无人船进行行驶;避障模式,基于树莓派的图像采集,通过对水面障碍物的识别来达到规避的效果;悬停模式,无人船在外部风浪较大环境下时执行留待在目标点的任务;一键返航模式,使无人船按照原来的轨迹原路返回初始点;智能返航模式,无人船不按照原来的轨迹原路返回,而是结合避障模式从当前点直线返回目标点
与现有技术相比,本发明具有以下优点和有益效果:
1.本发明基于树莓派和Pixhawk搭建了无人船的自主航行系统,可实现对作业中的无人船进行航行控制和系统状态的实时监测,使得搭载本系统的无人船具备自主航行能力。
2.本发明针对无人船实际情况,结合搭建的自主航行系统,提出一种无人船自主航行系统的配置方法:S1船端部分与地面站建立链接;S2将无人船固件加载到Pixhawk硬件当中并获取固件参数;S3设置并配置GPS模块、航姿检测模块、无线收发器、遥控器等外围设备;S4对无人船固件内参数进行调整并修改实船的控制增益,使无人船的响应和固件参数整体配置相适应。从而让具有普适性的Pixhawk固件能够针对无人船展开实际应用。
3.本发明基于其自主航行系统和无人船自主航行系统配置,提出一种无人船自主航行方法:上电使系统初始化并进行软件自检和硬件自检,打开地面站并通过软件写入航点并生成航线,将航线信息转换为Google地图中的经纬度信息并通过Mavlink协议传输到Pixhawk中,使用遥控器通过SBUS协议发送解锁指令,此时无人船处于非自主巡航模式,需要测试人员通过遥控器发送执行自主巡航指令,系统才会执行预设的自主巡航任务。系统除了主要的巡航模式以外,还有手动模式、避障模式、悬停模式、一键返航模式、智能返航模式/自动靠泊模式,通过遥控器发送对应模式切换指令,并可执行相应模式下的航行任务。
4.本发明可实现对作业中的无人船进行航行控制和系统状态的实时监测,为无人船的自主航行提供了一套完备的实验方案,有利于提高无人船航行研究领域的模块化和标准化水平。
附图说明
图1为本发明的一种实施例的无人船自主航行系统总体架构图。
图2为本发明的一种实施例的无人船自主航行固件调参流程图。
图3为本发明的一种实施例的无人船航迹规划工作流程图;
图4为本发明的一种实施例的搭载无人船自主航行系统岸基部分的地面站示意图。
图5为本发明的一种实施例的搭载无人船自主航行系统船端部分示意图。
图6为本发明的一种实施例的长江某水域负责水面垃圾清扫任务的无人船航迹规划图。
具体实施方式
下面结合附图对本发明做进一步详细说明。
如图1所示,本发明的一种无人船自主航行系统,包括:
船端部分,用于无人船的运动姿态检测、位置信息检测、航行数据采集、执行元件控制等功能。其船端部分包括树莓派、Pixhawk、GPS模块、航姿检测模块、第一电调、第二电调、第一电机、第二电机。
岸基部分,包括地面站、无线收发器、遥控器。其中,地面站是在岸基PC端上运行的软件应用程序,包括远程控制平台或PC端。操作人员可通过地面站实时观测无人船的各项信息:位置、航点、航向、航速、设备剩余电量等,也可进行在线参数的实时调整。
其船端部分的树莓派具体型号为树莓派4B,在Linux操作系统上运行,使用Python语言编程,并有对应库对Pixhawk进行访问,测试人员可使用API通过Mavlink协议与无人船进行通信,从而实现对无人船的状态和参数信息的编程访问,以及对无人船运动的直接控制。所述的Pixhawk具体版本为Pixhawk 2.4.8,此平台提供了一种相对稳定和高效的自动驾驶实现方式,主要应用于无人机和无人车平台。所述的GPS模块具体型号为NEO-M8N,主要为无人船提供准确的定位信息。所述的航姿检测模块具体型号为北微BWK218,为无人船提供实时的航向与姿态信息。所述的第一电调、第二电调分别为第一电机、第二电机提供驱动,第一电机和第二电机为无人船提供推进,无人船的转向通过两个电机的差速转动来实现,不需要安装专门的舵系也拥有极好的操纵性。
所述的岸基部分的无线收发器具体型号为XB Radio PRO,用于完成岸基和Pixhawk的数据传输。所述遥控器具体型号为乐迪R9DS,用于从岸端向船端发送控制指令。所述的地面站是在岸基PC端上运行的软件应用程序,通过无线方式和无人船进行通信。地面站显示无人船航姿和位置的实时数据,是虚拟驾驶舱,显示与真实驾驶无人船相同的仪表数据。地面站还用于控制航行中的无人船,上传新任务和设置参数。还用于显示来自船端树莓派摄像机的实时视频。地面站可供选择的很多,本发明优选使用的地面站版本为Windows下的Mission Planner。
本发明的一种无人船自主航行方法,包括:
第一阶段:无人船自主航行系统的固件配置和参数调整。
如图2所示为无人船自主航行固件调参流程图。
所述的无人船自主航行系统,一旦搭建完毕,需要根据无人船实际情况进行固件配置和参数调整。其固件为开源飞控社区发布的无人船固件,可直接应用,但内部函数和参数需要根据无人船进行实际调整。包括如下步骤:
S1船端部分与地面站建立链接;
S2将无人船固件加载到Pixhawk硬件当中并获取固件参数;S3设置并配置好GPS模块、航姿检测模块、无线收发器、遥控器等外围设备;
S3设置并配置GPS模块、航姿检测模块、无线收发器、遥控器等外围设备;
S4对无人船固件内参数进行调整并修改实船的控制增益,使无人船的响应和固件参数整体配置相适应。
所述S1船端部分与地面站建立链接:将系统上电,使船端和岸端初始化,岸端通过无线收发器和船端Pixhawk建立链接。
所述S2将无人船固件加载到Pixhawk硬件当中并获取固件参数:先判断系统内设备是否为自动驾驶仪Pixhawk,再判断自动驾驶仪Pixhawk内固件是否为无人船固件,若是,则执行下一步,若不是,则需要人员进行固件修改,更新后再获取无人船固件内参数。
所述S3设置并配置GPS模块、航姿检测模块、无线收发器、遥控器等外围设备:外接的GPS模块需要TTL电平,接Pixhawk的RX和接地口,Pixhawk会向外发送GPS配置命令,若GPS不兼容会对GPS造成干扰,故TX口不接;接线后需要360度旋转GPS以校准模块;Missionplanner内需要对GPS_RATE_MS和GPS_TYPE等软件参数进行配置,来设置GPS模块的发送频率,通信方式等。航姿检测模块配置时需要布置在Pixhawk的正上方一同旋转来初始化硬件。无线收发器需要配置Mesh自组网模式和SBUS模式,遥控器的通道1和2设置为控制左右电机,通道5的PWM占空比用来作航行模式的切换,例如占空比0-10%为手动模式,10-30%为自主巡航模式,依次类推。
所述S4对无人船固件内参数进行调整并修改实船的控制增益,使无人船的响应和固件参数整体配置相适应,需要在Mission planner内配置如下关键函数和参数:
ARMING_CHECK配置为0,关闭Pixhawk解锁前的自检开关;
ARMING_REQUIRE配置为1,硬件上电使能;
BRD_SAFETYENABLE配置为1,使能Pixhawk安全解锁开关;
FENCE_ACTION配置为0,无人船突破电子围栏时没有动作;
FENCE_ENABLE配置为0,关闭电子围栏;
FRAME_CLASS配置为2,Mission planner软件内使用船固件;
FS_THR_ENABLE配置为1,油门低于预设值时开启失控保护;
PILOT_STEER_TYPE配置为1,选择无人船偏航时策略;
PIVOT_TURN_ANGLE配置为60,在艏向偏角大于此参数时做绕点转向动作;
SERVO1_FUNCTION配置为73,为无人船左桨控制通道;
SERVO3_FUNCTION配置为74,为无人船右桨控制通道。
Pixhawk控制电机的实际增益由调节SERVO1_OUTPUT和SERVO3_OUTPUT通道的PID输出决定。
第二阶段:进行无人船航迹规划工作。
如图3所示为无人船航迹规划工作流程图。
上述无人船自主航行系统配置和参数调整完毕后,将系统重启,系统初始化并进行软件自检和硬件自检,打开地面站并通过软件写入航点并生成航线,航点生成航线的算法为B样条曲线拟合。拟合成航线后,将航线信息转换为Google地图中的经纬度信息并通过Mavlink协议传输到Pixhawk中,使用遥控器通过SBUS协议发送解锁指令,此时无人船处于非自主巡航模式,需要测试人员通过遥控器发送执行自主巡航指令,系统才会执行预设的自主巡航任务。系统除了主要的巡航模式以外,还有手动模式、避障模式、悬停模式、一键返航模式、智能返航模式/自动靠泊模式,通过遥控器发送对应模式切换指令,使无人船执行相应模式下的航行任务。
所述的各类航行模式如下:巡航模式可按照Mission planner软件内规划好的航线,沿航线行驶,误差精度在0.7米;手动模式允许测试人员远程人工驾驶无人船进行行驶;避障模式可基于树莓派的图像采集,通过对水面障碍物的识别来达到规避的效果;悬停模式是无人船在外部风浪较大环境下时执行留待在目标点的任务;一键返航模式可使无人船按照原来的轨迹原路返回初始点;智能返航模式是无人船不按照原来的轨迹原路返回,而是结合避障模式从当前点直线返回目标点。
如图4所示为搭载无人船自主航行系统地面站端的一种实例,通过在Missionplanner软件内配置调试好API和底层等操作,使其具备成为无人船自主航行地面站的能力。地面站主界面为航行界面,可以显示无人船的艏向、航迹、航点等信息;左上窗口显示无人船航姿等信息,左下窗口显示航速、地速、绝对坐标、距离下一个航点距离等信息,在实际工程应用领域具有较大意义。
如图5所示为搭载无人船自主航行系统船端部分的一种实例,所搭载船体为920自扶正船型,具有较好操纵性的同时,拥有较好的抗倾覆能力,系统均匀布置在船体顶部。
如图6所示为长江某水域负责水面垃圾清扫任务的无人船航迹规划图,地点为镇江海事局对面开阔长江水域,搭载本发明所述自主航行系统的水面垃圾清扫无人船在规划好的电子围栏内进行水面清扫作业,通过图示航线和实地实验验证了此方法的有效性。
Claims (10)
1.一种无人船自主航行系统,其特征在于,包括:
船端部分,用于无人船的航行运动姿态检测、位置信息检测、航行数据采集、执行元件控制;包括树莓派、Pixhawk、GPS模块、航姿检测模块、由第一电调提供驱动的第一电机、由第二电调提供驱动的第二电机;Pixhawk提供相对稳定和高效的自动驾驶实现方式;GPS模块为无人船提供准确的定位信息;航姿检测模块为无人船提供实时的航向与姿态信息;无人船由第一电机和第二电机提供推进,并通过两个电机的差速转动实现转向;所述的树莓派在Linux操作系统上运行,使用Python语言编程,并有对应库对Pixhawk进行访问;
测试人员可使用API通过Mavlink协议与无人船进行通信,从而实现对无人船的状态和参数信息的编程访问,以及对无人船运动的直接控制;
岸基部分,包括用于岸基和Pixhawk的数据传输的无线收发器、用于从岸端向船端发送控制指令的遥控器、地面站;所述的地面站是在岸基PC端上运行的软件应用程序,包括远程控制平台或PC端,通过无线方式和无人船进行通信,控制航行中的无人船,上传新任务和设置参数;操作人员通过地面站实时观测无人船的各项信息:位置、航点、航向、航速、设备剩余电量,并进行系统的在线参数实时调整。
2.根据权利要求1所述的一种无人船自主航行系统,其特征在于,所述的地面站是虚拟驾驶舱,可显示无人船航姿和位置的实时数据、与真实驾驶无人船相同的仪表数据和来自船端树莓派摄像机的实时视频;地面站所采用版本为Windows下的Mission Planner。
3.根据权利要求1所述的一种无人船自主航行系统,其特征在于,所述的遥控器采用乐迪R9DS。
4.根据权利要求1所述的一种无人船自主航行系统,其特征在于,所述的无线收发器采用XB Radio PRO。
5.根据权利要求1所述的一种无人船自主航行系统,其特征在于,所述的Pixhawk采用版本为Pixhawk 2.4.8。
6.根据权利要求1所述的一种无人船自主航行系统,其特征在于,所述的航姿检测模块采用北微BWK218。
7.一种无人船自主航行方法,其特征在于,采用如权利要求1至6任一项所述的无人船自主航行系统,其方法包括:
第一阶段:根据无人船实际情况,对无人船自主航行系统进行固件配置和参数调整;其固件可直接应用开源飞控社区发布的无人船固件;其内部函数和参数需要根据无人船进行实际调整的步骤包括:
S1.1.船端部分与地面站建立链接:将系统上电,使船端和岸端初始化,岸端通过无线收发器和船端Pixhawk建立链接;
S1.2.将无人船固件加载到Pixhawk硬件当中并获取固件参数:先判断系统内设备是否为自动驾驶仪Pixhawk,再判断自动驾驶仪Pixhawk内固件是否为无人船固件;若是,则执行下一步,若否,则需要人员进行固件修改,更新后再获取无人船固件内参数;
S1.3.设置并配置外围设备,包括GPS模块、航姿检测模块、无线收发器、遥控器;
S1.4.对无人船固件内参数进行调整并修改实船的控制增益,使无人船的响应和固件参数整体配置相适应;
第二阶段,无人船航迹规划,包括:
S2.1.无人船配置和参数调整完毕后将系统重启,系统初始化并进行软件自检和硬件自检,打开地面站并通过软件写入航点并生成航线,航点生成航线的算法为B样条曲线拟合;
S2.2.拟合成航线后,将航线信息转换为Google地图中的经纬度信息并通过Mavlink协议传输到Pixhawk中,使用遥控器通过SBUS协议发送解锁指令,此时无人船处于非自主巡航模式,需要测试人员通过遥控器发送执行自主巡航指令,系统才会执行预设的自主巡航任务;系统可通过遥控器发送其它巡航模式的对应模式切换指令,使无人船执行相应模式下的航行任务。
8.根据权利要求7所述的一种无人船自主航行方法,其特征在于,在第一阶段,所述的设置并配置外围设备,其过程包括:外接的GPS模块需要TTL电平,接Pixhawk的RX和接地口;Pixhawk向外发送GPS配置命令,若GPS不兼容会对GPS造成干扰,故TX口不接;接线后需要360度旋转GPS以校准模块;Mission planner内需对GPS_RATE_MS和GPS_TYPE等软件参数进行配置,来设置GPS模块的发送频率、通信方式;航姿检测模块需布置在Pixhawk的正上方一同旋转来初始化硬件;无线收发器需配置Mesh自组网模式和SBUS模式;遥控器的通道1和2设置为控制左右电机,通道5的PWM占空比用来作航行模式的切换:占空比0-10%为手动模式,10-30%为自主巡航模式。
9.根据权利要求7所述的一种无人船自主航行方法,其特征在于,在第一阶段,所述的对无人船固件内参数进行调整并修改实船的控制增益,使无人船的响应和固件参数整体配置相适应,包括在Mission planner内配置如下关键函数和参数:
ARMING_CHECK配置为0,关闭Pixhawk解锁前的自检开关;
ARMING_REQUIRE配置为1,硬件上电使能;
BRD_SAFETYENABLE配置为1,使能Pixhawk安全解锁开关;
FENCE_ACTION配置为0,无人船突破电子围栏时没有动作;
FENCE_ENABLE配置为0,关闭电子围栏;
FRAME_CLASS配置为2,Mission planner软件内使用船固件;
FS_THR_ENABLE配置为1,油门低于预设值时开启失控保护;
PILOT_STEER_TYPE配置为1,选择无人船偏航时策略;
PIVOT_TURN_ANGLE配置为60,在艏向偏角大于此参数时做绕点转向动作;
SERVO1_FUNCTION配置为73,为无人船左桨控制通道;
SERVO3_FUNCTION配置为74,为无人船右桨控制通道;
Pixhawk控制电机的实际增益由调节SERVO1_OUTPUT和SERVO3_OUTPUT通道的PID输出决定。
10.根据权利要求7所述的一种无人船自主航行方法,其特征在于,无人船的巡航模式包括:非自主巡航模式,按照Mission planner软件内规划好的航线沿航线行驶;手动模式,允许测试人员远程人工驾驶无人船进行行驶;避障模式,基于树莓派的图像采集,通过对水面障碍物的识别来达到规避的效果;悬停模式,无人船在外部风浪较大环境下时执行留待在目标点的任务;一键返航模式,使无人船按照原来的轨迹原路返回初始点;智能返航模式,无人船不按照原来的轨迹原路返回,而是结合避障模式从当前点直线返回目标点。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210529661.8A CN115047868A (zh) | 2022-05-16 | 2022-05-16 | 一种无人船自主航行系统及其方法 |
PCT/CN2023/077602 WO2023221586A1 (zh) | 2022-05-16 | 2023-02-22 | 一种无人船自主航行系统及其方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210529661.8A CN115047868A (zh) | 2022-05-16 | 2022-05-16 | 一种无人船自主航行系统及其方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115047868A true CN115047868A (zh) | 2022-09-13 |
Family
ID=83157804
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210529661.8A Pending CN115047868A (zh) | 2022-05-16 | 2022-05-16 | 一种无人船自主航行系统及其方法 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN115047868A (zh) |
WO (1) | WO2023221586A1 (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2023221586A1 (zh) * | 2022-05-16 | 2023-11-23 | 江苏科技大学 | 一种无人船自主航行系统及其方法 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117406757B (zh) * | 2023-12-12 | 2024-04-19 | 西北工业大学宁波研究院 | 一种基于三维全局视觉的水下自主航行方法 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6273981B2 (ja) * | 2014-04-04 | 2018-02-07 | 株式会社Ihi | 自律航走体の制御システム |
CN105180942B (zh) * | 2015-09-11 | 2018-07-20 | 安科智慧城市技术(中国)有限公司 | 一种无人船自主导航方法及装置 |
CN107229276A (zh) * | 2017-05-27 | 2017-10-03 | 浙江大学 | 基于ARM Cortex‑M7处理器的智能无人船平台及其控制方法 |
CN108549396B (zh) * | 2018-04-17 | 2021-03-02 | 福州大学 | 一种基于stm32f429的双电机驱动无人船控制系统 |
US11307584B2 (en) * | 2018-09-04 | 2022-04-19 | Skydio, Inc. | Applications and skills for an autonomous unmanned aerial vehicle |
CN110794853A (zh) * | 2019-11-20 | 2020-02-14 | 哈尔滨工程大学 | 一种半潜式航行器自动巡航系统及控制方法 |
CN115047868A (zh) * | 2022-05-16 | 2022-09-13 | 江苏科技大学 | 一种无人船自主航行系统及其方法 |
-
2022
- 2022-05-16 CN CN202210529661.8A patent/CN115047868A/zh active Pending
-
2023
- 2023-02-22 WO PCT/CN2023/077602 patent/WO2023221586A1/zh unknown
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2023221586A1 (zh) * | 2022-05-16 | 2023-11-23 | 江苏科技大学 | 一种无人船自主航行系统及其方法 |
Also Published As
Publication number | Publication date |
---|---|
WO2023221586A1 (zh) | 2023-11-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2023221586A1 (zh) | 一种无人船自主航行系统及其方法 | |
CN105947142B (zh) | 一种无人驾驶水上航行器 | |
Erckens et al. | Avalon | |
Niculescu | Lateral track control law for Aerosonde UAV | |
CN106094606A (zh) | 一种水面无人艇导航与控制遥操作平台 | |
Moulton et al. | An autonomous surface vehicle for long term operations | |
CN106647790A (zh) | 面向复杂环境的四旋翼无人机飞行器系统及飞行方法 | |
CN103176451B (zh) | 一种舰船辅助航行及编队指挥的方法 | |
CN205581642U (zh) | 一种基于stm32的无人艇自适应舵机控制系统 | |
CN108153311A (zh) | 面向无人艇编队的智能控制系统及控制方法 | |
CN112130575A (zh) | 基于OneNET平台的无人船控制系统及其自主避障方法 | |
CN114281083A (zh) | 一种基于混合路径规划自主导航的无人船水质监测物联网控制系统及方法 | |
Sinisterra et al. | A USV platform for surface autonomy | |
Liu et al. | Development of USV autonomy: Architecture, implementation and sea trials | |
CN113093737B (zh) | 水空两栖式全方位自主搜救舰队 | |
CN109144075A (zh) | 一种无人船的控制系统和控制方法 | |
WO2023226485A1 (zh) | 一种无人船自主航行控制系统 | |
CN112180915A (zh) | 基于ros的双推力无人船运动控制系统及控制方法 | |
Conte et al. | Experimental testing of a cooperative ASV-ROV multi-agent system | |
Xiao et al. | Research on Multi-mode control system and autonomous cruise method for unmanned surface vehicles | |
CN113960994A (zh) | 一种多无人艇协同航行的s面自适应控制算法 | |
CN112230639A (zh) | 一种用于自主遥控水下机器人的远程回收控制系统及方法 | |
CN116700299A (zh) | 一种基于数字孪生的auv集群控制系统及方法 | |
CN110794853A (zh) | 一种半潜式航行器自动巡航系统及控制方法 | |
CN205691985U (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 |