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

本发明属于潜水运载器领域，更具体的说涉及一种具有辅助自动驾驶功能的蛙人运载器及辅助驾驶方法。

背景技术：

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

技术实现思路

1、本发明提出了一种具有辅助自动驾驶功能的蛙人运载器，采用“摇杆+电舵+推进器”方式控制航姿，操作方便省力；通过导航定位系统、动力推进系统、仪表显示系统相互配合完成定向定深，实现自动驾驶航行功能，能为蛙人节省有限的氧气和体力，降低操控难度，有效避免蛙人误操作的情况，最大限度保证水下蛙人航行安全；具有高精度组合导航系统，能实现水面水下精准导航，能实现路径规划功能，可有效避免蛙人迷失方向的情况。

2、本运载器有能够在水下进行自动导航。可通过人工驾驶/自动驾驶按规划路径到达指定目标点。

3、为了实现上述目的，本申请是采用以下技术方案实现的：所述的运载器由运载器壳体、仪表显示系统、动力推进系统、导航定位系统、操控系统组成；

4、运载器壳体用于其他系统的安装及蛙人的身体支撑；

5、仪表显示系统用于显示状态信息、导航路径规划；

6、动力推进系统用于为运载器的行进提供动力；

7、导航定位系统用于航向航速定位测算；

8、操控系统用于控制运载器的上升、下潜、左转、右转姿态；

9、所述的仪表显示系统、动力推进系统、导航定位系统、操控系统都安装于运载器壳体内部，导航定位系统与仪表显示系统连接，操控系统与仪表显示系统连接，动力推进系统与仪表显示系统连接。

10、进一步地，所述的动力推进系统包括电池电器舱、推进电机、垂直舵机、水平舵机，所述的电池电器舱中包含有动力电池和电机驱动器，所述的动力电池与电机驱动器连接，电机驱动器与推进电机、垂直舵机、水平舵机连接，用于对电机的控制。

11、进一步地，所述的操控系统包括摇杆、垂直舵板、水平舵板、螺旋桨、采集板，所述的摇杆内安装有霍尔传感器，传感器的输出端与采集板连接，采集板输出端与电机驱动器连接，所述螺旋桨与推进电机输出轴连接，垂直舵板与垂直舵机输出轴连接，水平舵板与水平舵机输出轴连接。

12、进一步地，所述的运载器通过摇杆进行手动驾驶。

13、进一步地，所述的运载器通过导航系统进行自动驾驶。

14、再一方面，一种具有辅助自动驾驶功能的蛙人运载器辅助驾驶方法，适用于所述的运载器，所述的辅助驾驶方法:

15、s1由潜水员通过仪表显示系统输入按钮输入目标点的经纬度坐标(x,y)与目标深度h；

16、s2仪表显示系统从导航定位系统实时采集运载器的实时经纬度坐标(xn,yn)，航向角φn，深度hn，n为当前时刻；

17、s3仪表显示系统中央处理器实时计算运载器与目标点之间的方位角:

18、

19、其中，haversine为半正矢公式，用来计算两点间地理坐标距离；计算航向误差：δφn＝φn-φ'n；深度误差：δhn＝h-hn；

20、s4根据pid原理，计算航向调节量：

21、

22、计算深度调节量：

23、

24、其中，kp、ki、kd为航向pid的比例、积分、微分参数，k'p、k'i、k'd为深度pid的比例、积分、微分参数，需要通过试验来调整确定。

25、s5将航向调节量与深度调节量分别按比例映射成舵板开角；垂直舵板开角：θv＝f(α)；水平舵板开角：θh＝f(β)；函数f映射关系与实际舵板最大开度，调节量的最大限定值相关；

26、s6将θv、θh输入舵板电机控制器，控制舵板达到θv、θh开角；

27、s7重复上述第s2到第s6步骤，达到定向定深功能。

28、本发明有益效果：

29、(1)相较于现有蛙人运载器存在的航向指示不精准的问题，本发明提出了一种具有辅助自动驾驶功能的蛙人运载器，其具有高精度组合导航系统，能实现水面水下精准导航，能实现路径规划功能，可有效避免蛙人迷失方向的情况。

30、(2)相较于现有蛙人运载器存在的无姿态辅助控制功能的问题，本发明提出了一种具有辅助自动驾驶功能的蛙人运载器，其具有辅助自动驾驶等功能，导航定位系统、动力推进系统、仪表显示系统相互配合完成定向定深，实现自动驾驶航行功能，可有效避免蛙人误操作的情况，减少体力消耗，最大限度保证水下蛙人航行安全。

31、(3)相较于现有蛙人运载器存在的高速水流冲击导致舵板操控困难的问题，本发明提出了一种具有辅助自动驾驶功能的蛙人运载器，采用“摇杆+电舵+推进器”方式控制航姿，操作方便省力，减少蛙人体力消耗。

技术特征：

1.一种具有辅助自动驾驶功能的蛙人运载器，其特征在于：所述的运载器由运载器壳体、仪表显示系统、动力推进系统、导航定位系统、操控系统组成；

2.根据权利要求1所述的一种具有辅助自动驾驶功能的蛙人运载器，其特征在于：所述的动力推进系统包括电池电器舱、推进电机、垂直舵机、水平舵机，所述的电池电器舱中包含有动力电池和电机驱动器，所述的动力电池与电机驱动器连接，电机驱动器与推进电机、垂直舵机、水平舵机连接，用于对电机的控制。

3.根据权利要求1所述的一种具有辅助自动驾驶功能的蛙人运载器，其特征在于：所述的操控系统包括摇杆、垂直舵板、水平舵板、螺旋桨、采集板，所述的摇杆内安装有霍尔传感器，传感器的输出端与采集板连接，采集板输出端与电机驱动器连接，所述螺旋桨与推进电机输出轴连接，垂直舵板与垂直舵机输出轴连接，水平舵板与水平舵机输出轴连接。

4.根据权利要求1所述的一种具有辅助自动驾驶功能的蛙人运载器，其特征在于：所述的运载器通过摇杆进行手动驾驶。

5.根据权利要求1所述的一种具有辅助自动驾驶功能的蛙人运载器，其特征在于：所述的运载器通过导航系统进行自动驾驶。

6.一种具有辅助自动驾驶功能的蛙人运载器辅助驾驶方法，适用于权利要求1-5中任一项所述的运载器，其特征在于：所述的辅助驾驶方法:

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

技术研发人员：刘宁,张欧,李耀龙,高晓兰
受保护的技术使用者：昆明五威科工贸有限公司
技术研发日：
技术公布日：2024/1/15