一种具有辅助自动驾驶功能的蛙人运载器及辅助驾驶方法技术

本发明专利技术公开了一种具有辅助自动驾驶功能的蛙人运载器及辅助驾驶方法，属于潜水运载器领域，所述的运载器包括运载器壳体、仪表显示系统、动力推进系统、导航定位系统、操控系统五部分组成。运载器壳体用于其他系统的安装及蛙人的身体支撑；仪表显示系统用于显示状态信息、导航路径规划等；动力推进系统用于为运载器的行进提供动力；导航定位系统用于航向航速定位测算；操控系统用于控制运载器的上升、下潜、左转、右转等姿态。本运载器有能够在水下进行自动导航。可通过人工驾驶/自动驾驶按规划路径到达指定目标点。路径到达指定目标点。路径到达指定目标点。

【技术实现步骤摘要】
一种具有辅助自动驾驶功能的蛙人运载器及辅助驾驶方法


[0001]本专利技术属于潜水运载器领域，更具体的说涉及一种具有辅助自动驾驶功能的蛙人运载器及辅助驾驶方法。

技术介绍

[0002]国内现有蛙人运载器分为两类，其一为依靠身体姿态调整航姿，其二为使用连杆操控机械舵，长距离和高速航行对蛙人体力消耗巨大，影响蛙人水下骑行。现有技术存在以下缺点：
①
正常情况下，蛙人通过手上的力量扳动操作把手，以机械力传导的方式使连杆驱动机械舵控制运载器航姿。但高速航行时，舵板受水流冲击大，蛙人难以克服舵板受到的水流冲击扳动操作把手，甚至出现扳不动的情况；
②
蛙人在水下骑行时，受水流影响，运载器姿态无法保持，容易出现骑行过深、方向偏差大的情况，特别是骑行深度未保持好出现急速下沉会导致发生事故；
③
蛙人在水下骑行时，无导航容易迷失方向。

技术实现思路

[0003]本专利技术提出了一种具有辅助自动驾驶功能的蛙人运载器，采用“摇杆+电舵+推进器”方式控制航姿，操作方便省力；通过导航定位系统、动力推进系统、仪表显示系统相互配合完成定向定深，实现自动驾驶航行功能，能为蛙人节省有限的氧气和体力，降低操控难度，有效避免蛙人误操作的情况，最大限度保证水下蛙人航行安全；具有高精度组合导航系统，能实现水面水下精准导航，能实现路径规划功能，可有效避免蛙人迷失方向的情况。
[0004]本运载器有能够在水下进行自动导航。可通过人工驾驶/自动驾驶按规划路径到达指定目标点。
[0005]为了实现上述目的，本申请是采用以下技术方案实现的：所述的运载器由运载器壳体、仪表显示系统、动力推进系统、导航定位系统、操控系统组成；
[0006]运载器壳体用于其他系统的安装及蛙人的身体支撑；
[0007]仪表显示系统用于显示状态信息、导航路径规划；
[0008]动力推进系统用于为运载器的行进提供动力；
[0009]导航定位系统用于航向航速定位测算；
[0010]操控系统用于控制运载器的上升、下潜、左转、右转姿态；
[0011]所述的仪表显示系统、动力推进系统、导航定位系统、操控系统都安装于运载器壳体内部，导航定位系统与仪表显示系统连接，操控系统与仪表显示系统连接，动力推进系统与仪表显示系统连接。
[0012]进一步地，所述的动力推进系统包括电池电器舱、推进电机、垂直舵机、水平舵机，所述的电池电器舱中包含有动力电池和电机驱动器，所述的动力电池与电机驱动器连接，电机驱动器与推进电机、垂直舵机、水平舵机连接，用于对电机的控制。
[0013]进一步地，所述的操控系统包括摇杆、垂直舵板、水平舵板、螺旋桨、采集板，所述的摇杆内安装有霍尔传感器，传感器的输出端与采集板连接，采集板输出端与电机驱动器
连接，所述螺旋桨与推进电机输出轴连接，垂直舵板与垂直舵机输出轴连接，水平舵板与水平舵机输出轴连接。
[0014]进一步地，所述的运载器通过摇杆进行手动驾驶。
[0015]进一步地，所述的运载器通过导航系统进行自动驾驶。
[0016]再一方面，一种具有辅助自动驾驶功能的蛙人运载器辅助驾驶方法，适用于所述的运载器，所述的辅助驾驶方法:
[0017]S1由潜水员通过仪表显示系统输入按钮输入目标点的经纬度坐标(x,y)与目标深度h；
[0018]S2仪表显示系统从导航定位系统实时采集运载器的实时经纬度坐标(x
n
,y
n
)，航向角φ
n
，深度h
n
，n为当前时刻；
[0019]S3仪表显示系统中央处理器实时计算运载器与目标点之间的方位角:
[0020][0021]其中，Haversine为半正矢公式，用来计算两点间地理坐标距离；计算航向误差：Δφ
n
＝φ
n
‑
φ'
n
；深度误差：Δh
n
＝h
‑
h
n
；
[0022]S4根据PID原理，计算航向调节量：
[0023][0024]计算深度调节量：
[0025][0026]其中，K
P
、K
i
、K
d
为航向PID的比例、积分、微分参数，K'
p
、K'
i
、K'
d
为深度PID的比例、积分、微分参数，需要通过试验来调整确定。
[0027]S5将航向调节量与深度调节量分别按比例映射成舵板开角；垂直舵板开角：θ
v
＝f(α)；水平舵板开角：θ
h
＝f(β)；函数f映射关系与实际舵板最大开度，调节量的最大限定值相关；
[0028]S6将θ
v
、θ
h
输入舵板电机控制器，控制舵板达到θ
v
、θ
h
开角；
[0029]S7重复上述第S2到第S6步骤，达到定向定深功能。
[0030]本专利技术有益效果：
[0031](1)相较于现有蛙人运载器存在的航向指示不精准的问题，本专利技术提出了一种具有辅助自动驾驶功能的蛙人运载器，其具有高精度组合导航系统，能实现水面水下精准导航，能实现路径规划功能，可有效避免蛙人迷失方向的情况。
[0032](2)相较于现有蛙人运载器存在的无姿态辅助控制功能的问题，本专利技术提出了一种具有辅助自动驾驶功能的蛙人运载器，其具有辅助自动驾驶等功能，导航定位系统、动力推进系统、仪表显示系统相互配合完成定向定深，实现自动驾驶航行功能，可有效避免蛙人误操作的情况，减少体力消耗，最大限度保证水下蛙人航行安全。
[0033](3)相较于现有蛙人运载器存在的高速水流冲击导致舵板操控困难的问题，本专利技术提出了一种具有辅助自动驾驶功能的蛙人运载器，采用“摇杆+电舵+推进器”方式控制航
姿，操作方便省力，减少蛙人体力消耗。
附图说明
[0034]图1为本专利技术运载器组成图；
[0035]图2为本专利技术摇杆侧视图；
[0036]图3为本专利技术舵板控制图；
[0037]图4为本专利技术运载器控制图；
[0038]图5为本专利技术人工驾驶流程图；
[0039]图6为本专利技术自动驾驶流程图。
[0040]图中、1、天线；2、导航舱；3、显示仪表；4、运载器壳体；5、摇杆；6、电池电器舱；7、推进电机；8、螺旋桨；9、垂直舵机；10、垂直舵板；11、水平舵板；12、水平舵机。
具体实施方式
[0041]以下将以附图公开本公开的实施方式，为明确说明起见，许多实务上的细节将在以下叙述中一并说明。然而，应了解到，这些实务上的细节不应用以限制本公开。也就是说，在本公开内容部分实施方式中，这些实务上的细节是非必要的。此外，为简化附图起见，一些现有惯用的结构与元件在附图中将以简单示意的方式示出的本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种具有辅助自动驾驶功能的蛙人运载器，其特征在于：所述的运载器由运载器壳体、仪表显示系统、动力推进系统、导航定位系统、操控系统组成；运载器壳体用于其他系统的安装及蛙人的身体支撑；仪表显示系统用于显示状态信息、导航路径规划；动力推进系统用于为运载器的行进提供动力；导航定位系统用于航向航速定位测算；操控系统用于控制运载器的上升、下潜、左转、右转姿态；所述的仪表显示系统、动力推进系统、导航定位系统、操控系统都安装于运载器壳体内部，导航定位系统与仪表显示系统连接，操控系统与仪表显示系统连接，动力推进系统与仪表显示系统连接。2.根据权利要求1所述的一种具有辅助自动驾驶功能的蛙人运载器，其特征在于：所述的动力推进系统包括电池电器舱、推进电机、垂直舵机、水平舵机，所述的电池电器舱中包含有动力电池和电机驱动器，所述的动力电池与电机驱动器连接，电机驱动器与推进电机、垂直舵机、水平舵机连接，用于对电机的控制。3.根据权利要求1所述的一种具有辅助自动驾驶功能的蛙人运载器，其特征在于：所述的操控系统包括摇杆、垂直舵板、水平舵板、螺旋桨、采集板，所述的摇杆内安装有霍尔传感器，传感器的输出端与采集板连接，采集板输出端与电机驱动器连接，所述螺旋桨与推进电机输出轴连接，垂直舵板与垂直舵机输出轴连接，水平舵板与水平舵机输出轴连接。4.根据权利要求1所述的一种具有辅助自动驾驶功能的蛙人运载器，其特征在于：所述的运载器通过摇杆进行手动驾驶。5.根据权利要求1所述的一种具有辅助自动驾驶功能的蛙人运载器，其特征在于：所述的运载器通过导航系统进行自动驾驶。6.一种具有辅助自动驾驶功能的蛙人运载器辅助驾驶方法，适用于权利要求1
‑
5中任一项所述的运载器，其特征在于：所述的辅助驾驶方法:S1由潜水员通...

【专利技术属性】
技术研发人员：刘宁，张欧，李耀龙，高晓兰，
申请(专利权)人：昆明五威科工贸有限公司，
类型：发明
国别省市：