CN108791779A - 一种仿生水下滑翔机器人控制系统及控制方法 - Google Patents
一种仿生水下滑翔机器人控制系统及控制方法 Download PDFInfo
- Publication number
- CN108791779A CN108791779A CN201810853879.2A CN201810853879A CN108791779A CN 108791779 A CN108791779 A CN 108791779A CN 201810853879 A CN201810853879 A CN 201810853879A CN 108791779 A CN108791779 A CN 108791779A
- Authority
- CN
- China
- Prior art keywords
- underwater
- spectroradiometer
- bionical
- posture
- control
- 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 24
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims abstract description 46
- 230000033001 locomotion Effects 0.000 claims abstract description 36
- 230000003592 biomimetic effect Effects 0.000 claims abstract description 10
- 230000009189 diving Effects 0.000 claims abstract description 10
- 230000007246 mechanism Effects 0.000 claims description 25
- 230000001105 regulatory effect Effects 0.000 claims description 22
- 238000006073 displacement reaction Methods 0.000 claims description 12
- 238000005070 sampling Methods 0.000 claims description 12
- 230000000694 effects Effects 0.000 claims description 11
- 238000007789 sealing Methods 0.000 claims description 10
- 238000007667 floating Methods 0.000 claims description 9
- 239000007788 liquid Substances 0.000 claims description 9
- 238000001514 detection method Methods 0.000 claims description 8
- 238000004590 computer program Methods 0.000 claims description 7
- 238000012545 processing Methods 0.000 claims description 7
- 238000011161 development Methods 0.000 claims description 6
- 230000003014 reinforcing effect Effects 0.000 claims description 5
- 238000003860 storage Methods 0.000 claims description 5
- 230000009466 transformation Effects 0.000 claims description 5
- 230000001276 controlling effect Effects 0.000 claims description 4
- 230000007935 neutral effect Effects 0.000 claims description 4
- 230000005236 sound signal Effects 0.000 claims description 3
- 230000037237 body shape Effects 0.000 claims 1
- 230000005484 gravity Effects 0.000 description 11
- 241000251468 Actinopterygii Species 0.000 description 5
- 238000006243 chemical reaction Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 5
- 230000006870 function Effects 0.000 description 5
- 230000001133 acceleration Effects 0.000 description 4
- 238000004458 analytical method Methods 0.000 description 4
- 230000008901 benefit Effects 0.000 description 4
- 230000008859 change Effects 0.000 description 4
- 238000013461 design Methods 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 4
- 210000000988 bone and bone Anatomy 0.000 description 3
- 239000000686 essence Substances 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 238000005259 measurement Methods 0.000 description 2
- 239000007787 solid Substances 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 239000000853 adhesive Substances 0.000 description 1
- 230000001070 adhesive effect Effects 0.000 description 1
- 230000004888 barrier function Effects 0.000 description 1
- 230000033228 biological regulation Effects 0.000 description 1
- 239000002775 capsule Substances 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000013500 data storage Methods 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 238000009826 distribution Methods 0.000 description 1
- 230000002068 genetic effect Effects 0.000 description 1
- 230000001771 impaired effect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000007373 indentation Methods 0.000 description 1
- 230000008595 infiltration Effects 0.000 description 1
- 238000001764 infiltration Methods 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 239000013307 optical fiber Substances 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 239000011505 plaster Substances 0.000 description 1
- 238000007639 printing Methods 0.000 description 1
- 238000012857 repacking Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 230000009182 swimming Effects 0.000 description 1
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/001—Underwater vessels adapted for special purposes, e.g. unmanned underwater vessels; Equipment specially adapted therefor, e.g. docking stations
-
- 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/39—Arrangements of sonic watch equipment, e.g. low-frequency, sonar
-
- 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/001—Underwater vessels adapted for special purposes, e.g. unmanned underwater vessels; Equipment specially adapted therefor, e.g. docking stations
- B63G2008/002—Underwater vessels adapted for special purposes, e.g. unmanned underwater vessels; Equipment specially adapted therefor, e.g. docking stations unmanned
- B63G2008/005—Underwater vessels adapted for special purposes, e.g. unmanned underwater vessels; Equipment specially adapted therefor, e.g. docking stations unmanned remotely controlled
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Toys (AREA)
Abstract
本发明属于机器人控制技术领域，公开了一种仿生水下滑翔机器人控制系统及控制方法,水面控制系统，用于控制仿生水下滑翔机器人运动状态；手柄式操控杆，用于控制控制仿生水下滑翔机器人运动速度和角速度；短基线定位系统，将定位图和声纳探测到的图像实时地反馈在控制台的显示屏上；控制台，用于显示仿生水下滑翔机器人的定位，声呐图，仿生水下滑翔机器人的机体状态；机器人位姿信息采集系统，用于得到仿生水下滑翔机器人的潜水姿态、深度、及距河床高度。本发明的机器人位姿信息采集系统，为了得到潜水器的潜水姿态、深度、及距河(海)床高度。
Description
技术领域
本发明属于机器人控制技术领域，尤其涉及一种仿生水下滑翔机器人及其 控制系统。
背景技术
目前，业内常用的现有技术是这样的：
随着人们对海洋的探索范围越来越广，对海洋开发的需求越来越强，水下 探测机器人成为全世界研究的对象。水下探测机器人又分为有缆水下机器人和 无缆水下机器人，虽然有缆机器人能根据运动方式不同而分为摇曳试，海底移 动式和浮游试，但是有缆机器人都是遥控试的。且由于缆线的长度有限，只能 在限定的范围内进行探测，如果缆线过长也会出现打结的现象。而无缆水下机 器人能够依靠本身的自主决策和控制能力，更高效的完成任务。水下滑翔机作 为一种无缆机器具有人阻力小，航速较高，制造维修成本低，续航时间长和探 索范围广等特点。
综上所述，现有技术存在的问题及解决上述问题的难度和意义：
(1)我们用3D建模来打印滑翔机的外壳，但是由于机体过长，不能完整 的打出每一个部分，只能将较长的外壳再进行分解打印。正因为外壳的部件增 多，连接的截面就越多，渗水的可能性就更大。为了保持机体的密封性，我们 会在机体内外的连接处粘上防水胶布，也会为机体内部零件打印出各自的密封 仓。
(2)水下滑翔是以锯齿形状向前运动，如若变轨则需机身倾斜,但是变轨半 径很大，不能快速躲避障碍物。所以我们将变轨机构转移到了艉部，我们也利 用3D建模技术打印出了类似鱼尾的变轨装置。可以通过舵机的控制来进行左右 摆动。
水下滑翔机的密封性是非常重要的，如果密封良好就是对机体内各电子设 备的良好保障，也减小了电子受损的可能性。对于变轨的改装之后，滑翔机在 海洋航行的过程中更加灵敏。
发明内容
针对现有技术存在的问题，本发明提供了一种仿生水下滑翔机器人及其控 制系统。
本发明是这样实现的，一种仿生水下滑翔机器人控制系统，所述仿生水下 滑翔机器人控制系统包括：
水面控制系统，用于控制仿生水下滑翔机器人运动状态；
手柄式操控杆，用于控制控制仿生水下滑翔机器人运动速度和角速度；
短基线定位系统，将定位图和声纳探测到的图像实时地反馈在控制台的显 示屏上；
控制台，用于显示仿生水下滑翔机器人的定位，声呐图，仿生水下滑翔机 器人的机体状态。
机器人位姿信息采集系统，用于得到仿生水下滑翔机器人的潜水姿态、深 度、及距河床高度。
进一步，所述控制台包括主控台显示器和笔记本电脑显示器；主控台显示 器用于短基线/GPS仿生水下滑翔机器人定位信息显示以及仿生水下滑翔机器 人的机体姿态显示并进行保存；声呐图的声纳探测信息用笔记本电脑显示和存 储。
进一步，水面控制系统包括上位机、下位机均采用工控机；上位机、下位 机均通过信号连接控制台、手柄式操控杆、短基线定位系统、机器人位姿信息 采集系统。
进一步，所述仿生水下滑翔机器人控制系统进一步包括：
控制箱，在路地上控制仿生水下滑翔机；
放置在仿生水下滑翔机艏部的纳稳压电源，为步进电机提供电流；
安装在电子仓连接开发板的姿态和温湿度传感器以及深度、高度传感器接 口；
集成在姿态仓前半部置的步进电机；
姿态仓后半部搁置的水泵、气囊
及姿态仓前后的姿态盖；
姿态盖两端面用螺栓连接姿态盖密封，密封面开有密封槽，装有橡胶密封 圈；端面浇铸有加强筋；
深度、高度传感器接口连接有压力传感器，通过测量水压，将电流量转化 为电压量，获得16位的数字量，进行相应的反向变换，推知潜水器的潜水 深度；
深度、高度传感器接口还连接有三轴磁力计、三轴角速率陀螺、三轴加速 度计MEMS传感器；通过信息融合解算，得到仿生水下滑翔机器人的三个欧 拉角、三轴角速率和三轴加速度；由RS232输出信息到控制台。
深度、高度传感器接口还连接有高度计，用于探测水底河床和杂物碰撞与 仿生水下滑翔机器人的距离。
本发明的另一目的在于提供一种仿生水下滑翔机器人，所述仿生水下滑翔 机器人至少搭载所述的仿生水下滑翔机器人控制系统。
本发明的另一目的在于提供一种实现所述仿生水下滑翔机器人控制系统的 仿生水下滑翔机器人控制方法，所述仿生水下滑翔机器人控制方法包括：
机器的运动控制和姿态控制；
(1)通过俯仰调节机构向艉部移动电池组，使得水下滑翔机器人保持艏朝 下艉朝上姿态:
(2)通过浮力调节机构减少载体排水体积，使得水下滑翔机器人处在负浮力 状态。水下滑翔机器人在负浮力作用下开始下潜运动，并最终达到下潜定常滑 翔运动状态；
(3)当到达预定深度时，通过浮力调节机构增大载体排水体积达到中性状态, 水下滑翔机器人开始减速下潜，并最终停止运动；
(4)通过俯仰调节机构向艉部移动电池组，使得水下滑翔机器人姿态 变为艏朝上艉朝下；
(5)通过浮力调节机构增大载体排水体积，使得水下滑翔机器人处在正浮力 状态。水下滑翔机器人在正浮力作用下开始上浮运动，并最终达到上浮定常翔 运动状态；
(6)通过变轨调节机构向艉部移动电池组，使得水下滑翔机器人姿态变为 艏朝左艉朝右或艏朝右艉朝左；
(7)当水下滑翔机器开始上浮运动到达水面后就完成一一个周期的滑翔 运动。
声纳控制；
声纳系统是由发射机、水听器、接收机、显示器和控制器等几个部件组成。 发射机用于产生电信号，换能器则将电信号转变为声信号向水中发射，水声信 号若遇到目标就会被反射，然后以反射形式返回到水听器,水听器接收后又将其 转换为电信号，接收机接收到电信号后，进行各方位处理，再将处理结果反应 至控制器或显示器，最后根据这些处理过的信息探测出目标的位置。声呐系统 安置在机体最前方。
水下液体取样器控制。
液体取样机的底部有取样孔，取样机体内安装具有活动塞坐的活动把手， 用舵机连接活动把手，当到达取样地点，启动舵机，活动把手离开取样机底部 样水进入取样机，活动把手再次移动到底部，取样完成。
本发明的另一目的在于提供一种计算机程序，所述计算机程序运行权利要 求6所述仿生水下滑翔机器人控制方法。
本发明的另一目的在于提供一种信息数据处理终端，所述信息数据处理终 端实现所述仿生水下滑翔机器人控制方法。
本发明的另一目的在于提供一种计算机可读存储介质，包括指令，当其在 计算机上运行时，使得计算机执行所述的仿生水下滑翔机器人控制方法。
综上所述，本发明的优点及积极效果为：
最优解的质量就最优解的质量，现代智能算法相比于传统的分支定界法要 质量好，GA整数规划法相对于分支定界法使目标函数提高了15.3％；本专利算 法相对于分支定界法使目标函数提高了29.3％。分析其原因是因为该目标函数 非线性，存在多个局部最优点，传统的分支定界法无法获得全局最优，所以整 体质量较差，但是传统的分支定界法具有程序简单，运算快速等优点。
收敛速及分别对比2种现代智能算法的收敛速度效果。
从图中可以看本发明控制方法在迭代次数为70次左右基本稳定，而遗传算 法在迭代了30次之后基本趋于稳定。本专利算法增加了复杂度，收敛速度有所 降低，但得到的最优解质量较高，适用于解决MINLP问题。
本发明的机器人位姿信息采集系统，为了得到潜水器的潜水姿态、深度、 及距河(海)床高度，设计了基于C8051F310的潜水器位姿信息采集板。
采用NS-F压力传感器测量水压，传感器的输出为4－20m A的电流 量，通过一个精密电阻和运放芯片OPA2364搭建的I/U转换电路，可以 将电流量转化为电压量，实现－5V输出，再通过A/D转换芯片，获 得16位的数字量，进行相应的反向变换，即可推知潜水器的潜水深度。可 实现水深的实时测量。
采用Micro-Strain公司的姿态测量单元3DM—GX1，该单元通过三轴 磁力计、三轴角速率陀螺、三轴加速度计等MEMS传感器，通过信息融合解 算，可得到潜水器的三个欧拉角、三轴角速率和三轴加速度，由RS232输出 信息，为了确定ROV相对于河床的高度，本水下机器人设计了高度计，可以 有效避免与水底河床和杂物碰撞，以保证潜水器安全工作。
附图说明
图1是本发明实施例提供的仿生水下滑翔机器人控制系统示意图。
图中：1、水面控制系统；2、手柄式操控杆；3、短基线定位系统；4、控 制台；5、机器人位姿信息采集系统。
图2是本发明实施例提供的支撑架示意图。
图3是本发明实施例提供的姿态盖示意图。
图4是本发明实施例提供的姿态仓示意图。
图5是本发明实施例提供的在鱼艉首端连接舵机实行鱼艉左右摇摆运动图；
图中：a、艉骨；b、鱼濮。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白，以下结合实施例， 对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以 解释本发明，并不用于限定本发明。
图1，本发明实施例提供的仿生水下滑翔机器人控制系统，包括：
水面控制系统1，用于控制仿生水下滑翔机器人运动状态；
手柄式操控杆2，用于控制控制仿生水下滑翔机器人运动速度和角速度；
短基线定位系统3，将定位图和声纳探测到的图像实时地反馈在控制台的显 示屏上；
控制台4，用于显示仿生水下滑翔机器人的定位，声呐图，仿生水下滑翔机 器人的机体状态。
机器人位姿信息采集系统5，用于得到仿生水下滑翔机器人的潜水姿态、深 度、及距河床高度。
所述控制台包括主控台显示器和笔记本电脑显示器；主控台显示器用于短 基线/GPS仿生水下滑翔机器人定位信息显示以及仿生水下滑翔机器人的机体 姿态显示并进行保存；声呐图的声纳探测信息用笔记本电脑显示和存储。
水面控制系统包括上位机、下位机均采用工控机；上位机、下位机均通过 信号连接控制台、手柄式操控杆、短基线定位系统、机器人位姿信息采集系统。
所述仿生水下滑翔机器人控制系统进一步包括：
控制箱，在路地上控制滑翔机；
放置在滑翔机艏部的纳稳压电源为步进电机提供电流；
安装在电子仓连接开发板的姿态和温湿度传感器以及深度、高度传感器接 口；
集成在姿态仓前半部置的步进电机；
姿态仓后半部搁置的水泵、气囊
及姿态仓前后的姿态盖；
姿态盖两端面用螺栓连接姿态盖密封，密封面开有密封槽，装有橡胶密封 圈；端面浇铸有加强筋；
深度、高度传感器接口连接有压力传感器，通过测量水压，将电流量转化 为电压量，获得16位的数字量，进行相应的反向变换，推知潜水器的潜水 深度；
深度、高度传感器接口还连接有三轴磁力计、三轴角速率陀螺、三轴加速 度计MEMS传感器；通过信息融合解算，得到仿生水下滑翔机器人的三个欧 拉角、三轴角速率和三轴加速度；由RS232输出信息到控制台。
深度、高度传感器接口还连接有高度计，用于探测水底河床和杂物碰撞与 仿生水下滑翔机器人的距离。
本发明实施例提供的仿生水下滑翔机器人控制方法，包括：
机器的运动控制和姿态控制；
(1)通过俯仰调节机构向艉部移动电池组，使得水下滑翔机器人保持艏朝 下艉朝上姿态:
(2)通过浮力调节机构减少载体排水体积，使得水下滑翔机器人处在负浮力 状态。水下滑翔机器人在负浮力作用下开始下潜运动，并最终达到下潜定常滑 翔运动状态；
(3)当到达预定深度时，通过浮力调节机构增大载体排水体积达到中性状态, 水下滑翔机器人开始减速下潜，并最终停止运动；
(4)通过俯仰调节机构向艉部移动电池组，使得水下滑翔机器人姿态 变为艏朝上艉朝下；
(5)通过浮力调节机构增大载体排水体积，使得水下滑翔机器人处在正浮力 状态。水下滑翔机器人在正浮力作用下开始上浮运动，并最终达到上浮定常翔 运动状态；
(6)通过变轨调节机构向艉部移动电池组，使得水下滑翔机器人姿态变为 艏朝左艉朝右或艏朝右艉朝左；
(7)当水下滑翔机器开始上浮运动到达水面后就完成一一个周期的滑翔 运动。
声纳控制；
声纳系统是由发射机、水听器、接收机、显示器和控制器等几个部件组成。 发射机用于产生电信号，换能器则将电信号转变为声信号向水中发射，水声信 号若遇到目标就会被反射，然后以反射形式返回到水听器,水听器接收后又将其 转换为电信号，接收机接收到电信号后，进行各方位处理，再将处理结果反应 至控制器或显示器，最后根据这些处理过的信息探测出目标的位置。声呐系统 安置在机体最前方。
水下液体取样器控制。
液体取样机的底部有取样孔，取样机体内安装具有活动塞坐的活动把手， 用舵机连接活动把手，当到达取样地点，启动舵机，活动把手离开取样机底部 样水进入取样机，活动把手再次移动到底部，取样完成。
下面结合具体分析对本发明作进一步描述。
本发明实施例提供的仿生水下滑翔机器人控制系统包括：水面控制系统， 水下控制系统水面控制系统包括上位机，下位机。上位机采用工控机，装在操 纵箱中，设计两个玩具手柄式操控杆，并可以控制运动速度和角速度。操控手 柄由操控人员握在手中，水下滑翔机的一切活动都由操控手柄控制。短基线定 位系统定位图和声纳探测到的图像则实时地反馈在两个显示屏上，硬件平台主 要集中在电脑上，以用来显示水下机器人的定位，声呐图，机体状态。控制台 有两个显示器，主控台显示器用于短基线/GPS定位信息显示以及姿态显示并 进行保存，声纳探测信息分别用笔记本电脑显示和存储。除了机器的运动控制和姿态控制，控制项目还包括：平台俯仰和偏转控制；声纳控制；水下液体 取样器控制。
水面控制系统姿态传感器及电力电源水下分配设备等等需要装置在密闭容 器中，设计了控制箱，容纳稳压电源，姿态和温湿度传感器，推进器调速器、 电光转换板，以及深度、高度传感器接口等，根据设计工作水深和容纳设备尺 寸、重量，合布置、固定安装。壳体采用厚度3mm的ABS胶板制造，内 设安装架如图2和加强筋，前置步进电机，后置水泵，气囊。两端面用螺栓连 接姿态盖密封，如图3所示。密封面开有密封槽，装有橡胶密封圈。为加强端 面强度，端面也设计有加强筋。姿态仓整体图如图4。
下面结合工作原理对本发明作进一步描述。
水下滑翔机驱动及运动原理：
水下滑翔机在载体浮力以及滑翔翼的作用下，产生向前的水平滑翔速度。 水下滑翔机重心调节系统是通过调整载体内部的质量分布，从而改变载体重心 与浮心的相对位置，以产生横滚力矩和俯仰力矩，实现载体回转和俯仰运动。
在航行过程中，水下滑翔机通过重心调节系统对其姿态和运动轨迹进行控 制，实现垂直剖面内的锯齿形运动。在水下滑翔机_上浮下潜的过程中，只在其 锯齿形航迹的最高点和最低点调节重力和浮力的关系，中间航程完全实现了无 动力调节，定常回转运动中，保持重心的侧向偏移量不变，中间过程无需调节。 因此，针对深海大范围的探测，水下滑翔机较其他形式的水下航行器具有较大 的能源优势。
重心位置调节原理：
水下滑翔机通过改变重心相对浮心的位置，实现姿态的调节和控制根据实 际需要，水下滑翔机可以有两种方式实现滑翔。第一种是通过吸入或排出外部 液体，改变自身的重量，产生下沉或上浮的动力，同时相应改变载体重心在纵 向上的位置，形成一定的攻角，再利用水平翼把该垂向力转化为前行的动力， 从而实现纵向滑翔；第二种是通过液压系统将液体从外皮囊内压入密封的滑翔 器壳体内部或从密封的滑翔器壳体内部压入外皮囊内，改变自身的体积，产生 下沉或上浮的动力，同时调节载体重心，实现纵向滑翔。
工作流程
在水池中实验时，首先要向腔内灌水，通过排气孔向腔外排水，灌水完毕， 将排气孔堵上，此时由于重力大于浮力，水下滑翔机开始向下滑行；当滑行到一 定深度时，压力传感器的电压信号达到某一设定值，控制电路驱动水泵向外排 水，腔内水被排尽后，重力小于浮力，水下滑行机改变俯仰角,开始向上滑行； 当滑行到某一深度时，压力传感器的电压信号达到某-设定值，控制电路驱动电 磁阀，打开阀门，由于此时腔内的压强为负压，水被压入腔内，回到初始状态， 再向下滑行这样，水下滑翔机就实现了沿纵剖面滑翔的功能通过遥控器发出回 转指令，控电路就会启动步进电机，使作为侧向调节质量块的电池组产生偏转， 水下滑翔机就会以一定攻角产生转动。
下面结合具体分析对本发明作进一步描述。
滑翔运动分析：
水下滑翔机器人航行过程中，主要是沿锯齿形轨迹作周期性的滑翔运动.
水下滑翔机器人完成一个周期滑翔运动的过程为:
(1)通过俯仰调节机构向艉部移动电池组，使得水下滑翔机器人保持艏朝 下艉朝上姿态:
(2)通过浮力调节机构减少载体排水体积，使得水下滑翔机器人处在负浮力 状态。水下滑翔机器人在负浮力作用下开始下潜运动，并最终达到下潜定常滑 翔运动状态；
(3)当到达预定深度时，通过浮力调节机构增大载体排水体积达到中性状态, 水下滑翔机器人开始减速下潜，并最终停止运动；
(4)通过俯仰调节机构向艉部移动电池组，使得水下滑翔机器人姿态 变为艏朝上艉朝下；
(5)通过浮力调节机构增大载体排水体积，使得水下滑翔机器人处在正浮力 状态。水下滑翔机器人在正浮力作用下开始上浮运动，并最终达到上浮定常翔 运动状态；
(6)通过变轨调节机构向艉部移动电池组，使得水下滑翔机器人姿态变为 艏朝左艉朝右或艏朝右艉朝左；
(7)当水下滑翔机器开始上浮运动到达水面后就完成一一个周期的滑翔 运动。
机器人位姿信息采集系统为了得到潜水器的潜水姿态、深度、及距河(海) 床高度，设计了基于C8051F310的潜水器位姿信息采集板。
艉部设计为鱼尾形状，由艉骨，濮组成。在鱼艉首端连接舵机实行鱼艉左 右摇摆运动如图5所示。图中：a、艉骨；b、鱼濮。
采用NS-F压力传感器测量水压，传感器的输出为4－20m A的电流 量，通过一个精密电阻和运放芯片OPA2364搭建的I/U转换电路，可以 将电流量转化为电压量，实现－5V输出，再通过A/D转换芯片，获 得16位的数字量，进行相应的反向变换，即可推知潜水器的潜水深度。可 实现水深的实时测量。
采用Micro-Strain公司的姿态测量单元3DM—GX1，该单元通过三轴 磁力计、三轴角速率陀螺、三轴加速度计等MEMS传感器，通过信息融合解 算，可得到潜水器的三个欧拉角、三轴角速率和三轴加速度，由RS232输出 信息，为了确定ROV相对于河床的高度，本水下机器人设计了高度计，可以 有效避免与水底河床和杂物碰撞，以保证潜水器安全工作。
首先，依次连接各组件，随后打开电源箱开关；然后，操作水面站软件界面， 建立CAN通信，给开发板接通动电力，打开开发板运行使能开关，测试步进电机， 舵机是否全部运行正常，检查各传感器是否接收数据正常；最后，将水下滑翔机本体 放入水中，切换至闭环控制模式，操作手柄便可开动滑翔机。
在上述实施例中，可以全部或部分地通过软件、硬件、固件或者其任意组 合来实现。当使用全部或部分地以计算机程序产品的形式实现，所述计算机程 序产品包括一个或多个计算机指令。在计算机上加载或执行所述计算机程序指 令时，全部或部分地产生按照本发明实施例所述的流程或功能。所述计算机可 以是通用计算机、专用计算机、计算机网络、或者其他可编程装置。所述计算 机指令可以存储在计算机可读存储介质中，或者从一个计算机可读存储介质向 另一个计算机可读存储介质传输，例如，所述计算机指令可以从一个网站站点、 计算机、服务器或数据中心通过有线(例如同轴电缆、光纤、数字用户线(DSL)或 无线(例如红外、无线、微波等)方式向另一个网站站点、计算机、服务器或数据 中心进行传输)。所述计算机可读取存储介质可以是计算机能够存取的任何可用 介质或者是包含一个或多个可用介质集成的服务器、数据中心等数据存储设备。 所述可用介质可以是磁性介质，(例如，软盘、硬盘、磁带)、光介质(例如，DVD)、 或者半导体介质(例如固态硬盘Solid State Disk(SSD))等。
以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发 明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明 的保护范围之内。
Claims (9)
1.一种仿生水下滑翔机器人控制系统，其特征在于，所述仿生水下滑翔机器人控制系统包括：
水面控制系统，用于控制仿生水下滑翔机器人运动状态；
手柄式操控杆，用于控制控制仿生水下滑翔机器人运动速度和角速度；
短基线定位系统，将定位图和声纳探测到的图像实时地反馈在控制台的显示屏上；
控制台，用于显示仿生水下滑翔机器人的定位，声呐图，仿生水下滑翔机器人的机体状态；
机器人位姿信息采集系统，用于得到仿生水下滑翔机器人的潜水姿态、深度、及距河床高度。
2.如权利要求1所述的仿生水下滑翔机器人控制系统，其特征在于，所述控制台包括主控台显示器和笔记本电脑显示器；主控台显示器用于短基线/GPS仿生水下滑翔机器人定位信息显示以及仿生水下滑翔机器人的机体姿态显示并进行保存；声呐图的声纳探测信息用笔记本电脑显示和存储。
3.如权利要求1所述的仿生水下滑翔机器人控制系统，其特征在于，水面控制系统包括上位机、下位机均采用工控机；上位机、下位机均通过信号连接控制台、手柄式操控杆、短基线定位系统、机器人位姿信息采集系统。
4.如权利要求1所述的仿生水下滑翔机器人控制系统，其特征在于，所述水下滑翔机器人控制系统进一步包括：
控制箱，用于在路地上控制仿生水下滑翔机；
放置在仿生水下滑翔机艏部的纳稳压电源，为步进电机提供电流；
安装在电子仓连接开发板的姿态和温湿度传感器以及深度、高度传感器接口；
集成在姿态仓前半部置的步进电机；
姿态仓后半部搁置的水泵、气囊
及姿态仓前后的姿态盖；
姿态盖两端面用螺栓连接姿态盖密封，密封面开有密封槽，装有橡胶密封圈；端面浇铸有加强筋；
深度、高度传感器接口连接有压力传感器，通过测量水压，将电流量转化为电压量，获得16位的数字量，进行相应的反向变换，推知潜水器的潜水深度；
深度、高度传感器接口还连接有三轴磁力计、三轴角速率陀螺、三轴加速度计MEMS传感器；通过信息融合解算，得到仿生水下滑翔机器人的三个欧拉角、三轴角速率和三轴加速度；由RS232输出信息到控制台；
深度、高度传感器接口还连接有高度计，用于探测水底河床和杂物碰撞与仿生水下滑翔机器人的距离。
5.一种仿生水下滑翔机器人，其特征在于，所述仿生水下滑翔机器人至少搭载权利要求1～4任意一项所述的仿生水下滑翔机器人控制系统。
6.一种实现权利要求1所述仿生水下滑翔机器人控制系统的仿生水下滑翔机器人控制方法，其特征在于，所述仿生水下滑翔机器人控制方法包括：
机器的运动控制和姿态控制：
(1)通过俯仰调节机构向艉部移动电池组，使得水下滑翔机器人保持艏朝下艉朝上姿态；
(2)通过浮力调节机构减少载体排水体积，使得水下滑翔机器人处在负浮力状态；水下滑翔机器人在负浮力作用下开始下潜运动，并最终达到下潜定常滑翔运动状态；
(3)当到达预定深度时，通过浮力调节机构增大载体排水体积达到中性状态,水下滑翔机器人开始减速下潜，并最终停止运动；
(4)通过俯仰调节机构向艉部移动电池组，使得水下滑翔机器人姿态变为艏朝上艉朝下；
(5)通过浮力调节机构增大载体排水体积，使得水下滑翔机器人处在正浮力状态；水下滑翔机器人在正浮力作用下开始上浮运动，并最终达到上浮定常翔运动状态；
(6)通过变轨调节机构向艉部移动电池组，使得水下滑翔机器人姿态变为艏朝左艉朝右或艏朝右艉朝左；
(7)当水下滑翔机器开始上浮运动到达水面后就完成一一个周期的滑翔运动；
声纳控制：
声纳系统是由发射机、水听器、接收机、显示器和控制器等几个部件组成。发射机用于产生电信号，换能器则将电信号转变为声信号向水中发射，水声信号若遇到目标就会被反射，然后以反射形式返回到水听器,水听器接收后又将其转换为电信号，接收机接收到电信号后，进行各方位处理，再将处理结果反应至控制器或显示器，最后根据这些处理过的信息探测出目标的位置；声呐系统安置在机体最前方；
水下液体取样器控制：
液体取样机的底部有取样孔，取样机体内安装具有活动塞坐的活动把手，用舵机连接活动把手，当到达取样地点，启动舵机，活动把手离开取样机底部样水进入取样机，活动把手再次移动到底部，取样完成。
7.一种计算机程序，其特征在于，所述计算机程序运行权利要求6所述仿生水下滑翔机器人控制方法。
8.一种信息数据处理终端，其特征在于，所述信息数据处理终端实现权利要求6所述仿生水下滑翔机器人控制方法。
9.一种计算机可读存储介质，包括指令，当其在计算机上运行时，使得计算机执行如权利要求6所述的仿生水下滑翔机器人控制方法。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201810853879.2A CN108791779A (zh) | 2018-07-30 | 2018-07-30 | 一种仿生水下滑翔机器人控制系统及控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201810853879.2A CN108791779A (zh) | 2018-07-30 | 2018-07-30 | 一种仿生水下滑翔机器人控制系统及控制方法 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN108791779A true CN108791779A (zh) | 2018-11-13 |
Family
ID=64078699
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201810853879.2A Pending CN108791779A (zh) | 2018-07-30 | 2018-07-30 | 一种仿生水下滑翔机器人控制系统及控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN108791779A (zh) |
Cited By (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109144105A (zh) * | 2018-11-13 | 2019-01-04 | 武汉交通职业学院 | 一种船底智能水下清洗机器人、控制系统及控制方法 |
| CN109614726A (zh) * | 2018-12-17 | 2019-04-12 | 浙江大学 | 一种基于遗传算法的浮力调节低功耗控制方法 |
| CN109747801A (zh) * | 2019-01-25 | 2019-05-14 | 哈尔滨工程大学 | 一种用于水下滑翔机的四元十字阵声学检测系统 |
| CN110220671A (zh) * | 2019-03-21 | 2019-09-10 | 中国科学院自动化研究所 | 水下仿生推进器测试平台 |
| CN111645836A (zh) * | 2019-03-04 | 2020-09-11 | 中电科海洋信息技术研究院有限公司 | 水下滑翔机浮力调节机构 |
| CN113721195A (zh) * | 2020-05-26 | 2021-11-30 | 中国科学院声学研究所 | 一种基于深水水下滑翔机的四通道水听器阵列及运行方法 |
| CN114148495A (zh) * | 2021-12-02 | 2022-03-08 | 中国船舶科学研究中心 | 双功能无人潜航器模式切换方法及装置 |
| CN115113213A (zh) * | 2022-08-29 | 2022-09-27 | 青岛海研电子有限公司 | 水下声呐、水下航行器及水下航行器在宽广水域巡航方法 |
Citations (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6223895A (ja) * | 1985-07-24 | 1987-01-31 | Tokyo Univ | 重力・浮力調整による艇姿勢の制御を用いたグライダ−型潜水艇 |
| JP2007276609A (ja) * | 2006-04-06 | 2007-10-25 | Osaka Prefecture Univ | 水中グライダー |
| CN102012704A (zh) * | 2010-09-21 | 2011-04-13 | 上海大学 | 水下机器人姿态内控制系统 |
| CN102963514A (zh) * | 2012-11-26 | 2013-03-13 | 上海交通大学 | 便携式水下海洋环境监测滑翔机 |
| CN103832564A (zh) * | 2014-03-14 | 2014-06-04 | 中国计量学院 | 一种梭形水下滑翔器设计及控制方法 |
| CN103970144A (zh) * | 2014-03-28 | 2014-08-06 | 哈尔滨工程大学 | 一种自主式水下机器人的水面操控系统 |
| CN104142688A (zh) * | 2014-08-06 | 2014-11-12 | 深圳乐智机器人有限公司 | 一种水下机器人平台 |
| CN104683739A (zh) * | 2013-11-26 | 2015-06-03 | 中国科学院沈阳自动化研究所 | 用于水下无人航行器的岸基/水面信息显控系统及方法 |
| CN205311867U (zh) * | 2016-01-08 | 2016-06-15 | 何惠威 | 一种便携式水下机器人 |
| CN106005323A (zh) * | 2016-06-30 | 2016-10-12 | 深圳乐智机器人有限公司 | 一种仿生水下滑翔机及其推进方法 |
| CN107416154A (zh) * | 2017-05-11 | 2017-12-01 | 江苏科技大学 | 一种水路装置、水囊调节水下无人航行器及其控制系统 |
-
2018
- 2018-07-30 CN CN201810853879.2A patent/CN108791779A/zh active Pending
Patent Citations (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6223895A (ja) * | 1985-07-24 | 1987-01-31 | Tokyo Univ | 重力・浮力調整による艇姿勢の制御を用いたグライダ−型潜水艇 |
| JP2007276609A (ja) * | 2006-04-06 | 2007-10-25 | Osaka Prefecture Univ | 水中グライダー |
| CN102012704A (zh) * | 2010-09-21 | 2011-04-13 | 上海大学 | 水下机器人姿态内控制系统 |
| CN102963514A (zh) * | 2012-11-26 | 2013-03-13 | 上海交通大学 | 便携式水下海洋环境监测滑翔机 |
| CN104683739A (zh) * | 2013-11-26 | 2015-06-03 | 中国科学院沈阳自动化研究所 | 用于水下无人航行器的岸基/水面信息显控系统及方法 |
| CN103832564A (zh) * | 2014-03-14 | 2014-06-04 | 中国计量学院 | 一种梭形水下滑翔器设计及控制方法 |
| CN103970144A (zh) * | 2014-03-28 | 2014-08-06 | 哈尔滨工程大学 | 一种自主式水下机器人的水面操控系统 |
| CN104142688A (zh) * | 2014-08-06 | 2014-11-12 | 深圳乐智机器人有限公司 | 一种水下机器人平台 |
| CN205311867U (zh) * | 2016-01-08 | 2016-06-15 | 何惠威 | 一种便携式水下机器人 |
| CN106005323A (zh) * | 2016-06-30 | 2016-10-12 | 深圳乐智机器人有限公司 | 一种仿生水下滑翔机及其推进方法 |
| CN107416154A (zh) * | 2017-05-11 | 2017-12-01 | 江苏科技大学 | 一种水路装置、水囊调节水下无人航行器及其控制系统 |
Non-Patent Citations (1)
| Title |
|---|
| 徐得志等: "水下航行器垂向操纵运动数学仿真研究", 《中国水运》, pages 167 - 168 * |
Cited By (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109144105A (zh) * | 2018-11-13 | 2019-01-04 | 武汉交通职业学院 | 一种船底智能水下清洗机器人、控制系统及控制方法 |
| CN109614726A (zh) * | 2018-12-17 | 2019-04-12 | 浙江大学 | 一种基于遗传算法的浮力调节低功耗控制方法 |
| CN109614726B (zh) * | 2018-12-17 | 2021-05-14 | 浙江大学 | 一种基于遗传算法的浮力调节低功耗控制方法 |
| CN109747801A (zh) * | 2019-01-25 | 2019-05-14 | 哈尔滨工程大学 | 一种用于水下滑翔机的四元十字阵声学检测系统 |
| CN111645836A (zh) * | 2019-03-04 | 2020-09-11 | 中电科海洋信息技术研究院有限公司 | 水下滑翔机浮力调节机构 |
| CN110220671A (zh) * | 2019-03-21 | 2019-09-10 | 中国科学院自动化研究所 | 水下仿生推进器测试平台 |
| CN113721195A (zh) * | 2020-05-26 | 2021-11-30 | 中国科学院声学研究所 | 一种基于深水水下滑翔机的四通道水听器阵列及运行方法 |
| CN113721195B (zh) * | 2020-05-26 | 2024-03-22 | 中国科学院声学研究所 | 一种基于深水水下滑翔机的四通道水听器阵列及运行方法 |
| CN114148495A (zh) * | 2021-12-02 | 2022-03-08 | 中国船舶科学研究中心 | 双功能无人潜航器模式切换方法及装置 |
| CN114148495B (zh) * | 2021-12-02 | 2023-03-14 | 中国船舶科学研究中心 | 双功能无人潜航器模式切换方法及装置 |
| CN115113213A (zh) * | 2022-08-29 | 2022-09-27 | 青岛海研电子有限公司 | 水下声呐、水下航行器及水下航行器在宽广水域巡航方法 |
| CN115113213B (zh) * | 2022-08-29 | 2022-11-22 | 青岛海研电子有限公司 | 水下声呐、水下航行器及水下航行器在宽广水域巡航方法 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN108791779A (zh) | 一种仿生水下滑翔机器人控制系统及控制方法 | |
| US12096755B2 (en) | Castable sensor device | |
| CN104155991B (zh) | 水下机器人位姿控制方法 | |
| Gonzalez | Design, modelling and control of an autonomous underwater vehicle | |
| CN105549602B (zh) | 浮力均衡装置辅助的uuv主动坐底方法 | |
| CN103612728A (zh) | 水下三维立体探测滑翔机器人 | |
| CN107063198A (zh) | 一种船载自稳定云台测量系统及应用方法 | |
| Hegrenaes et al. | Comparison of mathematical models for the HUGIN 4500 AUV based on experimental data | |
| MX2011012512A (es) | Sistema y metodo para usar vehiculo bajo el agua autónomo para facilitar adquisicio de datos sismicos. | |
| MXPA06008524A (es) | Colocacion de cable sismico utilizando unidades de sistema de medicion de inercia acopladas. | |
| Proctor | Semi-autonomous guidance and control of a Saab SeaEye Falcon ROV | |
| CN111175850B (zh) | 可下潜自主式海气观测平台 | |
| CN204037874U (zh) | 测量型无人艇 | |
| CN111452939A (zh) | 一种用于引水隧洞检测的自主巡线水下直升机 | |
| CN107014374B (zh) | 一种基于互补滤波的水下滑翔器节能算法 | |
| Ahmad Mazlan | A fully actuated tail propulsion system for a biomimetic autonomous underwater vehicle | |
| CN208585396U (zh) | 一种仿生水下滑翔机器人 | |
| CN208344498U (zh) | 定位浮标 | |
| KR102238344B1 (ko) | 드론을 이용하여 해양 관측을 수행할 수 있는 수로조사시스템 | |
| CN212332938U (zh) | 一种用于引水隧洞检测的自主巡线水下直升机 | |
| KR102092574B1 (ko) | 전자해도의 실시간 갱신이 가능한 전자해도 현시용 모바일 디바이스의 운용시스템 | |
| CN106527453A (zh) | 一种水下无人船定深航行控制系统及方法 | |
| CN107856827A (zh) | 一种船舶吃水和载重状态检测机器人 | |
| CN108519621A (zh) | 一种海底地震检波飞行节点布放方法 | |
| CN205486864U (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 | ||
| RJ01 | Rejection of invention patent application after publication | ||
| RJ01 | Rejection of invention patent application after publication |
Application publication date: 20181113 |