[发明专利]水下机器人自动返航控制方法、计算机和存储介质有效
申请号: | 201710954851.3 | 申请日: | 2017-10-13 |
公开(公告)号: | CN107957729B | 公开(公告)日: | 2020-11-24 |
发明(设计)人: | 覃丹;周红坤;杨帆;张先奎;曾广移;巩宇;王文辉;黄小凤 | 申请(专利权)人: | 中国船舶重工集团公司七五0试验场;中国南方电网有限责任公司调峰调频发电公司 |
主分类号: | G05D1/10 | 分类号: | G05D1/10;G05D1/04 |
代理公司: | 广州华进联合专利商标代理有限公司 44224 | 代理人: | 黄隶凡 |
地址: | 650000*** | 国省代码: | 云南;53 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 水下 机器人 自动 返航 控制 方法 计算机 存储 介质 | ||
本发明涉及一种水下机器人自动返航控制方法、计算机和存储介质,方法包括:控制脱缆电机解脱高压电缆与接线箱之间的连接线缆,控制释放电机将接线箱由水下机器人上卸载释放,控制光纤切割电机将光纤切断;获取测距声呐的测量数据,根据测距声呐的测量数据判定当前水域位置;在当前水域位置为开阔水域时,根据第一返航模式控制水下机器人返航,在当前水域位置为输水管道时,根据第二返航模式控制水下机器人返航。通过依次控制脱缆电机、释放电机以及光纤切割电机将脐带缆及其设备与水下机器人实现分离,使得水下机器人不被脐带缆束缚,使得水下机器人的返航更为便捷和高效,避免水下机器人滞留在输水管道内,从而消除安全隐患。
技术领域
本发明涉及水下机器人技术领域,特别是涉及水下机器人自动返航控制方法、计算机和存储介质。
背景技术
水下机器人在水下作业的过程中,由于作业环境的复杂性,经常存在自身脐带缆被不明物体缠住后不能解脱的情况。当发生水下机器人脐带缆缠绕的情况,不能停机进行处理,停机处理将会带来严重的经济损失。此外,水下机器人长时间滞留在输水管道内对整个电厂的生产存在重大的安全隐患。
传统的缆控机器人处理上述情况的措施是将脐带缆从水面切断,使得水下机器人不被束缚,然后在通过其他技术手段将水下机器人回收,这样不仅成本高昂,实施难度大,而且存在很高的危险性,脐带缆仍部分连接在水下机器人上,残存的脐带缆依然容易束缚在水下的杂物上,造成返航不便。
发明内容
基于此,有必要提供一种水下机器人自动返航控制方法、计算机和存储介质。
一种水下机器人自动返航控制方法,包括:
控制脱缆电机解脱高压电缆与接线箱之间的连接线缆,控制释放电机将所述接线箱由水下机器人上卸载释放,控制光纤切割电机将光纤切断;
获取测距声呐的测量数据,根据测距声呐的测量数据判定当前水域位置;
在所述当前水域位置为开阔水域时,根据第一返航模式控制水下机器人返航,在所述当前水域位置为输水管道时,根据第二返航模式控制所述水下机器人返航。
在其中一个实施例中,所述获取测距声呐的测量数据,根据测距声呐的测量数据判定当前水域位置的步骤包括:
获取所述测距声呐在前、后、左、右、上和下六个方向的测量数据,当所述测距声呐在至少三个方向上测量到障碍物时,则判定所述当前水域位置为输水管道,当所述测距声呐在至多两个方向上测量到障碍物时,则判定所述当前水域位置为开阔水域。
在其中一个实施例中,所述根据第一返航模式控制水下机器人返航的步骤包括:
在所述第一返航模式下,检测是否接收到导引声呐的信号,当接收到所述导引声呐的信号时,则根据所述导引声呐的信号控制所述水下机器人返航。
在其中一个实施例中,所述根据第一返航模式控制水下机器人返航的步骤包括:
当无法接收到所述导引声呐的信号时,则控制所述水下机器人竖直上浮。
在其中一个实施例中,所述根据第一返航模式控制水下机器人返航的步骤包括:
当检测到所述导引声呐的信号的距离小于预设距离时,则控制所述水下机器人上浮。
在其中一个实施例中,所述根据第二返航模式控制所述水下机器人返航的步骤包括:
在所述第二返航模式下,检测是否接收到导引声呐的信号,当接收到所述导引声呐的信号时,则根据所述导引声呐的信号控制所述水下机器人返航。
在其中一个实施例中,当无法接收到所述导引声呐的信号时,则根据预设航线控制所述水下机器人返航。
在其中一个实施例中,所述方法还包括:
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国船舶重工集团公司七五0试验场;中国南方电网有限责任公司调峰调频发电公司,未经中国船舶重工集团公司七五0试验场;中国南方电网有限责任公司调峰调频发电公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201710954851.3/2.html,转载请声明来源钻瓜专利网。
- 上一篇:无人机降落方法、无人机及海上浮台
- 下一篇:一种无人飞行器稳定飞行控制方法