CN113716003B - 一种x型舵潜航器及其舵卡抗沉方法 - Google Patents
一种x型舵潜航器及其舵卡抗沉方法 Download PDFInfo
- Publication number
- CN113716003B CN113716003B CN202111136377.6A CN202111136377A CN113716003B CN 113716003 B CN113716003 B CN 113716003B CN 202111136377 A CN202111136377 A CN 202111136377A CN 113716003 B CN113716003 B CN 113716003B
- Authority
- CN
- China
- Prior art keywords
- rudder
- control
- underwater vehicle
- component
- sinking
- 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.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
- B63G8/00—Underwater vessels, e.g. submarines; Equipment specially adapted therefor
- B63G8/14—Control of attitude or depth
- B63G8/18—Control of attitude or depth by hydrofoils
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
- B63G8/00—Underwater vessels, e.g. submarines; Equipment specially adapted therefor
- B63G8/14—Control of attitude or depth
- B63G8/16—Control of attitude or depth by direct use of propellers or jets
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
- B63G8/00—Underwater vessels, e.g. submarines; Equipment specially adapted therefor
- B63G8/14—Control of attitude or depth
- B63G8/20—Steering equipment
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
- B63G8/00—Underwater vessels, e.g. submarines; Equipment specially adapted therefor
- B63G8/14—Control of attitude or depth
- B63G8/22—Adjustment of buoyancy by water ballasting; Emptying equipment for ballast tanks
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
- B63G8/00—Underwater vessels, e.g. submarines; Equipment specially adapted therefor
- B63G8/14—Control of attitude or depth
- B63G8/26—Trimming equipment
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Aviation & Aerospace Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本申请属于潜航器设计技术领域,尤其涉及一种X型舵潜航器及其舵卡抗沉方法。包括艇体、驱动系统、电控系统;驱动系统包括舵叶、舵机、螺旋桨、驱动电机;电控系统包括上位控制组件、电源组件、驱动组件、数据采集组件、运动控制组件、嵌入组件;上位控制组件包括PC上位机;电源组件包括电池组、电平稳压功率电源组件;数据采集组件包括传感器组;控制组件包括控制采集板、JetsonNano开发板、差分转换器、隔离驱动器、继电器、LDO稳压器;本申请的X型舵抗沉自主潜航器结构的生存能力高,便于实现挽回操作,能够快速进行适应性改造,运用于各类型尺寸和吨位的潜航器结构,相对于传统潜航设备,在复杂环境下能具有更好的控制性能。
Description
技术领域
本申请属于潜航器设计技术领域,尤其涉及一种X型舵潜航器及其舵卡抗沉方法。
背景技术
自主潜航器作为水下作业无人载具,在科考领域扮演重要角色,可在水下自主勘探;在军事领域,具有隐蔽性,可在危险海域侦查敌情、援潜救生等。随着海洋资源探索需求不断提高,各国更加重视对自主潜航器技术的研究,根据作业性质,以桨、舵联合操纵型自主潜航器最常见,传统控制结构的潜航器难以应对变模型、变工况的抗沉问题。例如中国专利CN107264752A公开了一种四螺旋桨推进的无舵水下无人潜航器,其本身由四台电机分别带动四个螺旋桨转动来推进潜航器前行,且尾舵不设调整方向,推动效率高,但可控性差,容错性能低,不具备应对螺旋桨故障险情突发情况的应对能力。CN107792325B适用于微型无人潜航器的尾部集成结构及其操舵方法提供以一种适用于X形尾舵结构的驱动控制结构,虽然能够实现尾舵独立控制,但由于其采用拉杆、转轴结构隔离控制的方式,舵机驱动动作需经由较长的传递渠道转换为尾舵的动作,这导致实际应用时,舵机的转角动作无法精准快速的转换为尾舵的对应动作。在可靠性方面,没有应对舵卡抗沉异常情况容错控制。
发明内容
本申请的目的在于,提供一种操纵性、机动性和生存性好,在变工况下具有更好适应性,能够提升潜航器稳态工况下的控制性和危险工况下的安全性的X型舵潜航器及其舵卡抗沉方法。
为实现上述目的,本申请采用如下技术方案。
一种X型舵抗沉自主潜航器,包括艇体、驱动系统、电控系统;
驱动系统包括:设于艇体艉部呈X型布置的四个舵叶、设于艇体内部与各舵叶连接的四个独立的大扭力防水舵机;设于艇体艉部的螺旋桨、设于艇体内部用于驱动螺旋桨的驱动电机;
电控系统包括:上位控制组件、电源组件、驱动组件、数据采集组件、运动控制组件、嵌入组件;具体而言:
所述上位控制组件,包括PC上位机,所述PC上位机内建CVI交互组件,并通过Lora模块与控制组件通讯;
所述电源组件包括电池组、电平稳压功率电源组件;所述电池组经电平稳压功率电源组件转换电压并输出5V和12V直流电;
所述数据采集组件包括传感器组;传感器组包括惯性传感器、深度传感器、电导率传感器、水下距离传感器,各组件采用两路485总线传输,以保证满足不同波特率通讯需求;
所述控制组件包括控制采集板、JetsonNano开发板、差分转换器、隔离驱动器、继电器、LDO稳压器;
所述控制采集板定时查询两路485总线上的传感器数据并通过两路485总线通讯,一路485总线连接电导率和距离传感器,另一路485总线连接深度传感器和Lora通讯组件;控制采集板采用光耦隔离,经过升压驱动控制继电器;控制采集板通过Lora模块与PC上位机通讯传输数据,同时根据PC上位机控制指令,经过隔离驱动器升压驱动控制两路继电器进而操控活塞式压载水舱;控制采集板通过TTL串口与JetsonNano开发板通讯,所述JetsonNano开发板用于完成推进器调速,根据惯性传感器的传感器数据、基于DRL算法对AUV艉部呈X型布置的4个舵叶进行控制,实现对AUV六自由度运动的驱动控制;所述JetsonNano开发板通过TLL串口与运动控制系统进行通讯控制;Lora通讯组件用于实现水面以上的配置和数据传输,选取远程Lora通讯组件,其通过TTL-RS485转换组件,连接至485-1#总线,与PC上位机一对一定点传输,在水面以上接受配置指令和航行完成上浮后的传感器数据上载;
所述运动控制组件包括一块经TTL串口连接至JetsonNano开发板并受其控制的脉冲宽度调制器,所述脉冲宽度调制器用于驱动控制防水舵机以及驱动电机,实现AUV六自由度运动和调速控制;上浮下潜采用舵叶协同活塞式压载水舱实现。
对前述X型舵抗沉自主潜航器的进一步改进或优选方案,所述艇体的上表面和下表面还开设若干流水孔;艇体内部设置有舵杆用于调整重力以及重心分布的配重块,具体而言,在将各零部件均衡分布在密封舱内部,将活塞式压载水舱置于重心位置后,利用配重块平衡舱体,以使X型舵抗沉自主潜航器呈零浮力状态。
对前述X型舵抗沉自主潜航器的进一步改进或优选方案,所述传感器组中,深度传感器搭载采用24位AD精度的MS5837-30BA压力传感器,MS5837-30BA压力传感器还需经解算板转发为115200波特率串口通讯;电导率传感器型号为ECTDS10-ISO;水下距离传感器型号为超声波水下距离传感器;北斗/GPS双模定位组件型号为ATGM336H,当AUV上浮至水面,经Lora通讯组件将坐标信息上传至PC上位机;惯性传感器采用ICM-20948九轴运动追踪模组。
对前述X型舵抗沉自主潜航器的进一步改进或优选方案,所述控制采集板采用采用GD32F103C8T6为控制采集板核心;还包括由TLP521可控制光电藕合器和ULN2083晶体管阵组成的驱动隔离升压电路,ULN2083晶体管阵输出控制继电器。
对前述X型舵抗沉自主潜航器的进一步改进或优选方案,4片舵叶正交布置,每片舵叶独立偏转;舵轴中心与潜艇中线面的夹角为45°,叶片转动引起潜艇的偏转和潜浮;所述运动控制组件采用控制方案如下:针对X型舵抗沉自主潜航器可能执行的直线航行、变航向航行、舵卡上浮三种任务,分别采用两种DRL算法:DDPG和PPO,以及三种奖励函数:反正切奖励函数、线性奖励函数、二次奖励函数进行训练,对比后选择最优的算法和奖励函数组合来执行相应任务。
对前述X型舵抗沉自主潜航器的进一步改进或优选方案,开关考虑采用无源触电防水开关、大功率继电器作为锂电池开关,选定额定参数为12V,30A的直流继电器CHS01-S-112LA(30A),线圈吸收二极管选用1N4007;而稳压电路采用三路MORNSUN(金升阳)的VRB1205S-10WR3隔离型DC-DC模块,分别对于舵机、控制器进行供电。稳压电路输入端串入1.1A自恢复保险丝BSMD0805-110-12V,瞬间熔断电流2A,结合DC-DC模块自身的防反、过流保护可较为有效保护后级电路及其存储的数据。
对前述X型舵抗沉自主潜航器的进一步改进或优选方案,还包括潜航器壳体1,潜航器壳体1尾端设置有四个舵叶安装孔1a,舵叶安装孔1a的前后侧设置有舵机固定孔1b,舵叶安装孔1a和舵机固定孔1b由贯通壳壁延伸至潜航器壳体1内部。
对前述X型舵抗沉自主潜航器的进一步改进或优选方案,所述大扭力防水舵机2设置于潜航器壳体1内部,且通过螺栓螺母组与舵机固定孔1b配合连接;大扭力防水舵机2的转轴对准舵叶安装孔1a中心且指向潜航器壳体1外部;大扭力防水舵机2的转轴末端设置有第一连接法兰结构2a;
所述舵叶3安装于各舵叶安装孔1a中,舵叶3的舵杆末端设置有可以与第一连接法兰结构2a对接的第二连接法兰结构3a。
对前述X型舵抗沉自主潜航器的进一步改进或优选方案,所述第一连接法兰结构2a和第二连接法兰结构3a尺寸与舵叶安装孔1a匹配。
用于前述X型舵潜航器的舵卡抗沉方法,所述舵卡抗沉方法用于解决掉深和舵卡险情下的AUV运动问题,具体而言:
当航行器遭遇舵卡的情况,随机设置一个舵卡位置和角度,给定预设好的目标姿态,通过电控系统输出信号,控制剩余三个舵叶结合螺旋桨实现上浮自救;
当航行器遭遇掉深的情况,随机设置一个舵卡位置和角度,给定预设好的目标姿态,通过电控系统输出信号,控制舵叶结合螺旋桨实现上浮自救。
在计算过程中,X舵的4片舵叶正交布置,每片舵叶均能独立控制;舵轴中心与潜艇中线面的夹角为45°,叶片转动引起潜艇的偏转和潜浮;X型舵自主潜航器在水中的运动视作刚体在流体中的空间运动,包括6个运动自由度,分别为沿艇体运动坐标系x,y,z方向的平动和转动,搭建AUV数值模型和水下仿真环境,针对X型舵自主潜航器执行舵卡上浮任务,采用DDPG算法和反正切奖励函数对指潜航器模型进行训练,并对其结果进行了对比和分析。
以JetsonNano开发板为实艇AUV的运动控制中心,对其进行必要的配置之后,将仿真环境中训练好的智能体模型直接迁移到JetsonNano开发板上,使其能够启动AUV推进器、控制艉部4个舵叶完成各项任务。
其有益效果在于:
本申请的X型舵抗沉自主潜航器能够实现六自由度航行,配合其运动学和动力学模型,在正常运行的情况下,能够在水下运动因故障发生舵卡情况时,控制其余舵叶和推进器灵活调节航行姿态和参数,在前述状况下仍具有上浮自救、主动抗沉等能力。
本申请的X型舵抗沉自主潜航器结构的生存能力高,便于实现挽回操作,能够快速进行适应性改造,运用于各类型尺寸和吨位的潜航器结构,相对于传统潜航设备,在复杂环境下能具有更好的控制性能。
附图说明
图1是X型舵抗沉自主潜航器的拓扑结构示意图;
图2是运动控制组件中控制采集核心的电路示意图;
图3是驱动隔离升压电路的示意图;
图4是X型舵抗沉自主潜航器壳体结构示意图;
图5是X型舵抗沉自主潜航器壳体内X舵分布结构示意图;
图6是舵叶结构示意图;
图7是有效控制下4号舵舵卡10°的AUV控制信号示意图;
图8是有效控制下4号舵舵卡10°的和姿态示意图;
图9是失控下4号舵舵卡10°的AUV控制信号示意图;
图10是失控下4号舵舵卡10°的和姿态示意图。
具体实施方式
以下结合具体实施例对本申请作详细说明。
本申请的一种X型舵抗沉自主潜航器,用于提供一种能够实现更稳定运行状态,在突发情况时能够获得更好的安全性,可以实现远程数据采集和控制,灵活配置各种巡航算法等功能的自主潜航器。
如图1所示,X型舵抗沉自主潜航器的基本组成结构包括艇体、驱动系统、电控系统;其中艇体与传统潜航器水滴流线型艇体结构一致。
本X型舵抗沉自主潜航器采用X型舵结构,其驱动系统包括:设于艇体艉部呈X型布置的四个舵叶、设于艇体内部与各舵叶连接的四个独立的大扭力防水舵机;设于艇体艉部的螺旋桨、设于艇体内部用于驱动螺旋桨的驱动电机;
四个独立舵机控制的舵叶,能够实现独立控制,在某个舵叶卡住或者遭遇险情时,能够通过调节其他舵叶的姿态来恢复航行姿态,实现上浮自救。
电控系统包括:上位控制组件、电源组件、驱动组件、数据采集组件、运动控制组件、嵌入组件;具体而言:
上位控制组件,包括PC上位机,PC上位机内建CVI交互组件,并通过Lora模块与控制组件通讯;上位控制组件和运动控制组件通过Lora实现通讯传输,以控制舵机以及压载水舱的状态,进而对潜航器运行姿态进行控制,实现远程数据收集和设备控制。
电源组件包括电池组、电平稳压功率电源组件;电池组经电平稳压功率电源组件转换电压并输出5V和12V直流电;
在具体实施过程中,以三并四串4S的锂电池组进行电平转换及稳压,以供各级电气机构使用,系统主要功耗部件组成包括:无刷直流电机尾舵螺旋桨;四路舵机X型舵叶;直流减速电机活塞式压载水舱;JetsonNano开发板顶层控制核心;GD32核心的次级控制器控制采集板;传感器组。其中无刷电机电调、电导率传感器可直连至电池组。
本实施例中,舵机额定电流为0.5A,5V供电;直流减速电机采用5V供电,额定电流0.9A;JetsonNano开发板采用microusb供电并配置为的5W低功耗模式;GD32控制采集版主要功耗为两路5V继电器,单片机部分经过线性稳压芯片AMS1117-3.3得到3.3V供电,整板功耗估约3.2W;传感器组总功耗共2W。
因而本实施例中设计稳压供电部分功耗如下:
根据功率核算结果,提供一种优选设计方法,其中开关考虑采用无源触电防水开关、大功率继电器作为锂电池开关,选定额定参数为12V,30A的直流继电器CHS01-S-112LA(30A),线圈吸收二极管选用1N4007。各性能参数均可满足使用需求。
而稳压电路采用三路MORNSUN(金升阳)的VRB1205S-10WR3隔离型DC-DC模块,分别对于舵机、控制器进行供电。稳压电路输入端串入1.1A自恢复保险丝BSMD0805-110-12V,瞬间熔断电流2A,结合DC-DC模块自身的防反、过流保护可较为有效保护后级电路及其存储的数据。
数据采集组件包括传感器组;传感器组包括惯性传感器、深度传感器、电导率传感器、水下距离传感器,各组件采用两路485总线传输,以保证满足不同波特率通讯需求;
基于多传感器组件能够获知潜航器实际航行时设备以及环境的数据和状态信息,以便于在自动控制和远程控制时保证能够执行更准确有效的操作,提高潜航器的安全性和控制效率。
控制组件包括控制采集板、JetsonNano开发板、差分转换器、隔离驱动器、继电器、LDO稳压器;
控制采集板定时查询两路485总线上的传感器数据并通过两路485总线通讯,一路485总线连接电导率和距离传感器,另一路485总线连接深度传感器和Lora通讯组件;控制采集板采用光耦隔离,经过升压驱动控制继电器;
控制采集板通过Lora模块与PC上位机通讯传输数据,同时根据PC上位机控制指令,经过隔离驱动器升压驱动控制两路继电器进而操控活塞式压载水舱;
控制采集板通过TTL串口与JetsonNano开发板通讯,JetsonNano开发板用于完成推进器调速,根据惯性传感器等传感器数据、基于DRL算法对AUV艉部呈X型布置的4个舵叶进行控制,实现对AUV六自由度运动的驱动控制;JetsonNano开发板通过TLL串口与运动控制系统进行通讯控制;
本实施例中采用GD32F103C8T6为核心设计控制采集板,编程实现TTL、485通讯、多传感器深度、电导率、温度采集、继电器隔离驱动等功能,串口与Nano通讯;两路485通讯,一路连接电导率,另一路连接深度传感器和LoRa通讯模块;采用TLP521可控制光电藕合器光耦隔离,经过ULN2803升压驱动,控制继电器,此外六路PWM经过330R限流电阻外接控制舵机和驱动电机。
Lora通讯组件用于实现水面以上的配置和数据传输,选取远程通讯组件Lora,其通过TTL-RS485转换组件,连接至485-1#总线,与PC上位机一对一定点传输,在水面以上接受配置指令和航行完成上浮后的传感器数据上载;运动控制组件包括一块经TTL串口连接至JetsonNano开发板并受其控制的脉冲宽度调制器,脉冲宽度调制器用于驱动控制防水舵机以及驱动电机,实现AUV六自由度运动和调速控制;上浮下潜采用舵叶协同活塞式压载水舱实现。
艇体的上表面和下表面还开设若干流水孔;艇体内部设置有舵杆用于调整重力以及重心分布的配重块,具体而言,在将各零部件均衡分布在密封舱内部,将活塞式压载水舱置于重心位置后,利用配重块平衡舱体,以使X型舵抗沉自主潜航器呈零浮力状态。
传感器组中,惯性传感器采集的位姿信息经过解算实现整个系统的运动控制,本实施例中使用ICM-20948九轴运动追踪模组,具有16位AD精度;深度传感器搭载采用24位AD精度的MS5837-30BA压力传感器,MS5837-30BA压力传感器还需经解算板转发为115200波特率串口通讯;电导率传感器型号为ECTDS10-ISO,同时测量电导率、盐分、TDS。电导率测量范围0-10000us/cm,RS485接口Modbus协议;水下距离传感器型号为超声波水下距离传感器;北斗/GPS双模定位组件型号为ATGM336H,同时兼容GPS和北斗卫星精度远高于单模块,9600波特率TTL串口。当AUV上浮至水面,经LoRa将坐标信息上传至上位机。当AUV上浮至水面,经Lora通讯组件将坐标信息上传至上位机;为了实现水面以上的配置和数据传输,选取远程通讯模块LoRa,其通过TTL-RS485转换模块,连接至485-1#总线,与PC上位机一对一定点传输,在水面以上接受配置指令和航行完成上浮后的传感器数据上载。控制采集板采用采用GD32F103C8T6为控制采集板核心,其接线图如图2所示;还包括由TLP521可控制光电藕合器和ULN2083晶体管阵组成的驱动隔离升压电路,如图3所示,ULN2083晶体管阵输出控制继电器。
本申请的X型舵抗沉自主潜航器的4片舵叶正交布置,每片舵叶独立偏转;舵轴中心与潜艇中线面的夹角为45°,叶片转动引起潜艇的偏转和潜浮;
在实际操纵过程中,本申请结合DRL与自主潜航器控制,通过读取IMU、深度计传感器的数据,经智能体计算4个舵叶动作,从而对X型舵X型舵潜航器进行六自由度控制。
运动控制组件采用控制方案如下:针对X型舵抗沉自主潜航器可能执行的直线航行、变航向航行、舵卡上浮三种任务,分别采用两种DRL算法:DDPG和PPO,以及三种奖励函数:反正切奖励函数、线性奖励函数、二次奖励函数进行训练,对比后选择最优的算法和奖励函数组合来执行相应任务。
在具体实施过程中,X型舵抗沉自主潜航器包括潜航器壳体1,为便于使用,在前述基础之上,本申请还提供对于结构的改进方案,X型舵潜航器水下运动的过程受阻力影响,需要紧固舵叶并防止发生振动,因此基于舵机与X型舵潜航器壳体锁紧、壳体与舵机锁紧、舵叶与舵机锁紧的三结构锁紧设计形式,具体而言,潜航器壳体1尾端设置有四个舵叶安装孔1a,舵叶安装孔1a的前后侧设置有舵机固定孔1b,舵叶安装孔1a和舵机固定孔1b由贯通壳壁延伸至潜航器壳体1内部。大扭力防水舵机2设置于潜航器壳体1内部,且通过螺栓螺母组与舵机固定孔1b配合连接;大扭力防水舵机2的转轴对准舵叶安装孔1a中心且指向潜航器壳体1外部;大扭力防水舵机2的转轴末端设置有第一连接法兰结构2a;
舵叶3安装于各舵叶安装孔1a中,舵叶3的舵杆末端设置有可以与第一连接法兰结构2a对接的第二连接法兰结构3a。其中第一连接法兰结构2a和第二连接法兰结构3a尺寸与舵叶安装孔1a匹配。
艇体上表面开设方形流水孔,下表面开设长条形流水孔;艇体内部设计了隔板,在实现分舱功能的同时加强航行器纵向总体强度;对各零部件的通信及电源线路进行集中,通过水密接头对密封舱进行穿出,实现密封舱内外的水下有线通信;同时使用海水用环氧树脂灌封胶进行接口加固密封;X型舵潜航器密封舱内的活塞式压载水舱对整体重量和浮力以及扭矩产生影响。将各零部件均衡分布在密封舱,随后将活塞式压载水舱置于重心位置,利用配重块平衡舱体;
在前述结构基础上,本申请还提供一种用于前述X型舵潜航器的舵卡抗沉方法,所述舵卡抗沉方法用于解决掉深和舵卡险情下的AUV运动问题,具体而言:
当航行器遭遇舵卡的情况,随机设置一个舵卡位置和角度,给定预设好的目标姿态,通过电控系统输出信号,控制剩余三个舵叶结合螺旋桨实现上浮自救;
当航行器遭遇掉深的情况,随机设置一个舵卡位置和角度,给定预设好的目标姿态,通过电控系统输出信号,控制舵叶结合螺旋桨实现上浮自救。
在计算过程中,X舵的4片舵叶正交布置,每片舵叶均能独立控制;舵轴中心与潜艇中线面的夹角为45°,叶片转动引起潜艇的偏转和潜浮;X型舵自主潜航器在水中的运动视作刚体在流体中的空间运动,包括6个运动自由度,分别为沿艇体运动坐标系x,y,z方向的平动和转动,其运动学和动力学模型如下:
前述方法便于实现挽回操作,能够快速进行适应性改造,运用于各类型尺寸和吨位的潜航器结构,相对于传统潜航设备,在复杂环境下能具有更好的控制性能。
以下集合具体测试方案进行说明:
测试一:当AUV发生10°舵卡时,AUV通过对剩下3个舵进行控制,实现AUV以预定姿态完成上浮自救,如下图所示。在AUV开始运动之前,受到水流作用,导致其初始航向和纵倾不是0°,但是AUV在fin4发生10°舵卡情况下,能够有效控制AUV完成上浮自救,并保持了对姿态的控制,其测试结果如图7、图8所示:
测试二:当AUV在fin4发生10°舵卡、其他舵不控制的AUV运动时状态如图9、图10所示,可见AUV航向一直朝一侧偏转,当航向超过临界值-180°时,因传感器的读数规则而变为180°,并继续保持偏转。
实际应用过程中,本申请基于DRL控制策略,提升潜航器的稳态运行性能和突发险情时的安全性。控制拓扑设计为Nano&GD32F103s双核心,隔离了数据采集和运动控制保证嵌入式的工作性能;LoRa&PC上位机的通讯模式,可以远程配置参数和接收采集到的数据。在Nano嵌入式系统中运行基于DDPG算法的主动抗沉策略,和基于BG-RRT算法的回收路径规划。相较传统X型舵潜航器,在应对随机单舵卡死、海水密度骤降多达2%(掉深)等极端工况时也能保持0°横倾和15°纵倾可靠上浮。对于X型舵潜航器水下回收,通过BG-RRT路径规划算法结合DRL算法能够快随规划、安全归航。
因此,本申请不仅是水文数据提取的工具性设计,亦可作为新一代水下航行器甚至载人潜艇的小型原理样机,拓展验证后续更多智能算法。
最后应当说明的是,以上实施例仅用以说明本申请的技术方案,而非对本申请保护范围的限制,尽管参照较佳实施例对本申请作了详细地说明,本领域的普通技术人员应当理解,可以对本申请的技术方案进行修改或者等同替换,而不脱离本申请技术方案的实质和范围。
Claims (9)
1.一种X型舵抗沉自主潜航器,其特征在于,包括艇体、驱动系统、电控系统;
驱动系统包括设于艇体艉部呈X型布置的四个舵叶、设于艇体内部与各舵叶连接的四个独立的大扭力防水舵机;设于艇体艉部的螺旋桨、设于艇体内部用于驱动螺旋桨的驱动电机;
电控系统包括上位控制组件、电源组件、驱动组件、数据采集组件、运动控制组件、嵌入组件;具体而言:
所述上位控制组件,包括PC上位机,所述PC上位机内建CVI交互组件,并通过Lora模块与控制组件通讯;
所述电源组件包括电池组、电平稳压功率电源组件;所述电池组经电平稳压功率电源组件转换电压并输出5V和12V直流电;
所述数据采集组件包括传感器组;传感器组包括惯性传感器、深度传感器、电导率传感器、水下距离传感器,各组件采用两路485总线传输,以保证满足不同波特率通讯需求;
所述控制组件包括控制采集板、JetsonNano开发板、差分转换器、隔离驱动器、继电器、LDO稳压器;
所述控制采集板定时查询两路485总线上的传感器数据并通过两路485总线通讯,一路485总线连接电导率和距离传感器,另一路485总线连接深度传感器和Lora通讯组件;控制采集板采用光耦隔离,经过升压驱动控制继电器;控制采集板通过Lora模块与PC上位机通讯传输数据,同时根据PC上位机控制指令,经过隔离驱动器升压驱动控制两路继电器进而操控活塞式压载水舱;控制采集板通过TTL串口与JetsonNano开发板通讯,所述JetsonNano开发板用于完成推进器调速,根据惯性传感器的传感器数据、基于DRL算法对AUV艉部呈X型布置的4个舵叶进行控制,实现对AUV六自由度运动的驱动控制;所述JetsonNano开发板通过TLL串口与运动控制系统进行通讯控制;Lora通讯组件用于实现水面以上的配置和数据传输,选取远程Lora通讯组件,其通过TTL-RS485转换组件,连接至485-1#总线,与PC上位机一对一定点传输,在水面以上接受配置指令和航行完成上浮后的传感器数据上载;
所述运动控制组件包括一块经TTL串口连接至JetsonNano开发板并受其控制的脉冲宽度调制器,所述脉冲宽度调制器用于驱动控制防水舵机以及驱动电机,实现AUV六自由度运动和调速控制;上浮下潜采用舵叶协同活塞式压载水舱实现。
2.根据权利要求1所述的一种X型舵抗沉自主潜航器,其特征在于,所述艇体的上表面和下表面还开设若干流水孔;艇体内部设置有舵杆用于调整重力以及重心分布的配重块,具体而言,在将各零部件均衡分布在密封舱内部,将活塞式压载水舱置于重心位置后,利用配重块平衡舱体,以使X型舵抗沉自主潜航器呈零浮力状态。
3.根据权利要求1所述的一种X型舵抗沉自主潜航器,其特征在于,所述传感器组中,深度传感器搭载采用24位AD精度的MS5837-30BA压力传感器,MS5837-30BA压力传感器还需经解算板转发为115200波特率串口通讯;电导率传感器型号为ECTDS10-ISO;水下距离传感器型号为超声波水下距离传感器;北斗/GPS双模定位组件型号为ATGM336H,当AUV上浮至水面,经Lora通讯组件将坐标信息上传至PC上位机;惯性传感器采用ICM-20948九轴运动追踪模组。
4.根据权利要求1所述的一种X型舵抗沉自主潜航器,其特征在于,所述控制采集板采用GD32F103C8T6芯片为控制采集板核心;还包括由TLP521可控制光电藕合器和ULN2083晶体管阵组成的驱动隔离升压电路,ULN2083晶体管阵输出控制继电器;所述继电器是指SRD-05VDC-SL-C。
5.根据权利要求1所述的一种X型舵抗沉自主潜航器,其特征在于,所述四个舵叶正交布置,每片舵叶独立偏转;舵轴中心与潜艇中线面的夹角为45°,叶片转动引起潜艇的偏转和潜浮;所述运动控制组件采用控制方案如下:针对X型舵抗沉自主潜航器可能执行的航向航行、舵卡上浮和掉深上浮三种任务,分别采用两种DRL算法:DDPG和PPO,以及三种奖励函数:反正切奖励函数、线性奖励函数、二次奖励函数进行训练,对比后选择最优的算法和奖励函数组合来执行相应任务。
6.根据权利要求1所述的一种X型舵抗沉自主潜航器,其特征在于,所述X型舵抗沉自主潜航器以PC上位机为交互终端,以GD32F103C8T6芯片和JetsonNano开发板为双控核心,其中GD32F103C8T6芯片用于实现传感器数据的接收,将接收到的深度数据传送至JetsonNano开发板,JetsonNano开发板利用深度信息和IMU惯性测量单元,计算AUV的输出舵角和电机转速并传输至GD32F103C8T6芯片,进而控制无刷电机和防水舵机的运动。
7.根据权利要求1所述的一种X型舵抗沉自主潜航器,其特征在于,所述电平稳压功率电源组件包括用于储能的锂电池、用于作为电池开关的直流继电器CHS01-S-112LA、用于稳压隔离VRB1205S-10WR3隔离型DC-DC模块、串入稳压电路输入端的自恢复保险丝BSMD0805。
8.根据权利要求1所述的一种X型舵抗沉自主潜航器,其特征在于,还包括潜航器壳体(1),潜航器壳体(1)尾端设置有四个舵叶安装孔(1a),舵叶安装孔(1a)的前后侧设置有舵机固定孔(1b),舵叶安装孔(1a)和舵机固定孔(1b)由贯通壳壁延伸至潜航器壳体(1)内部。
9.一种用于X型舵抗沉自主潜航器的舵卡抗沉方法,其特征在于,具体包括如下步骤:
当航行器遭遇舵卡的情况,随机设置一个舵卡位置和角度,给定预设好的目标姿态,通过电控系统输出信号,控制剩余三个舵叶结合螺旋桨实现上浮自救;
当航行器遭遇掉深的情况,随机设置一个舵卡位置和角度,给定预设好的目标姿态,通过电控系统输出信号,控制舵叶结合螺旋桨实现上浮自救;
在计算过程中,X舵的4片舵叶正交布置,每片舵叶均能独立控制;舵轴中心与潜艇中线面的夹角为45°,叶片转动引起潜艇的偏转和潜浮;X型舵自主潜航器在水中的运动视作刚体在流体中的空间运动,包括6个运动自由度,分别为沿艇体运动坐标系x,y,z方向的平动和转动,搭建AUV数值模型和水下仿真环境,针对X型舵自主潜航器执行舵卡上浮任务,采用DDPG算法和反正切奖励函数对指潜航器模型进行训练,并对其结果进行了对比和分析;
以JetsonNano开发板为实艇AUV的运动控制中心,将仿真环境中训练好的智能体模型直接迁移到JetsonNano开发板上,使其能够启动AUV推进器、控制艉部4个舵叶完成各项任务。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111136377.6A CN113716003B (zh) | 2021-09-27 | 2021-09-27 | 一种x型舵潜航器及其舵卡抗沉方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111136377.6A CN113716003B (zh) | 2021-09-27 | 2021-09-27 | 一种x型舵潜航器及其舵卡抗沉方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113716003A CN113716003A (zh) | 2021-11-30 |
CN113716003B true CN113716003B (zh) | 2022-11-15 |
Family
ID=78685066
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111136377.6A Active CN113716003B (zh) | 2021-09-27 | 2021-09-27 | 一种x型舵潜航器及其舵卡抗沉方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113716003B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116252939B (zh) * | 2023-02-28 | 2024-02-02 | 中国船舶科学研究中心 | 一种适用于x型操纵面水下航行器的主动流动控制方法 |
CN116300660A (zh) * | 2023-05-15 | 2023-06-23 | 海南坤联科技有限公司 | 潜艇控制方法及系统 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6223676B1 (en) * | 1999-11-23 | 2001-05-01 | Newport News Shipbuilding And Dry Dock Company | Control for X-stern vehicle |
DE102008031044B4 (de) * | 2008-06-26 | 2014-08-21 | Thyssenkrupp Marine Systems Gmbh | Vorrichtung für U-Boote als Abweiser |
CN103754342B (zh) * | 2014-01-10 | 2016-03-02 | 韩先锋 | 一种“x”字舵和“十”字舵的舵型转换装置 |
CN103984327B (zh) * | 2014-05-29 | 2017-04-12 | 北京信息科技大学 | 一种基于模糊控制的小型数字舵机系统 |
DE102016006933B3 (de) * | 2016-06-10 | 2017-11-16 | Thyssenkrupp Ag | Verfahren zur Kompensation der Blockade eines Ruderblattes in einem X-Ruder |
CN107792325B (zh) * | 2017-10-12 | 2020-04-14 | 中国船舶重工集团公司第七一九研究所 | 适用于微型无人潜航器的尾部集成结构及其操舵方法 |
CN109747800A (zh) * | 2019-01-15 | 2019-05-14 | 哈尔滨工程大学 | 一种欠驱动微型auv |
CN211391649U (zh) * | 2019-12-28 | 2020-09-01 | 中国科学院沈阳自动化研究所 | 水下机器人用方向控制装置 |
CN112829907A (zh) * | 2020-12-16 | 2021-05-25 | 江苏华阳重工股份有限公司 | 一种潜艇的转向装置 |
-
2021
- 2021-09-27 CN CN202111136377.6A patent/CN113716003B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN113716003A (zh) | 2021-11-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113716003B (zh) | 一种x型舵潜航器及其舵卡抗沉方法 | |
CN102963514B (zh) | 便携式水下海洋环境监测滑翔机 | |
CN2892668Y (zh) | 舵翼式微小型水下机器人 | |
CN108312151B (zh) | 漂流探测水下机器人装置及控制方法 | |
CN111231592A (zh) | 一种火箭助推式跨介质自适应潜水无人机及控制方法 | |
CN207889964U (zh) | 一种无人帆船动力及转向装置 | |
CN101070091A (zh) | 深海太阳能潜水器 | |
GB2511731B (en) | Autonomous Vessel Robot AI System | |
AU2018413663B2 (en) | Remote control unmanned surface vehicle with wind-driven cycloidal propeller | |
CN111645835A (zh) | 一种一带多水下无人子母潜航器 | |
CN109591992B (zh) | 船用电动推进器控制系统、电动推进器及电动船 | |
CN110641637B (zh) | 一种基于温差能发电的航迹可控的海洋观测平台 | |
CN113697077B (zh) | 用于航行器的推进装置、航行器及用于航行器的控制方法 | |
CN104743091A (zh) | 一种双翼波浪推进远程无人艇 | |
CN101628620A (zh) | 水下飞机 | |
CN112660347B (zh) | 一种节能式水下滑翔机 | |
CN208344516U (zh) | 一种鳍舵组合自修正水面水下航行器 | |
CN211731772U (zh) | 分体拖缆式水面—水下无人航行器 | |
Aage et al. | Hydrodynamic manoeuvrability data of a flatfish type AUV | |
CN113665749B (zh) | 航行器 | |
CN208198727U (zh) | 一种利用波浪推进的无人船 | |
CN113093737B (zh) | 水空两栖式全方位自主搜救舰队 | |
CN204587282U (zh) | 一种双翼波浪推进远程无人艇 | |
Elkolali et al. | A low-cost wave/solar powered unmanned surface vehicle | |
CN113232809A (zh) | 模块化小型auv装置 |
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 |