CN114954862A - 一种带缆水下机器人运动控制方法 - Google Patents
一种带缆水下机器人运动控制方法 Download PDFInfo
- Publication number
- CN114954862A CN114954862A CN202210765078.7A CN202210765078A CN114954862A CN 114954862 A CN114954862 A CN 114954862A CN 202210765078 A CN202210765078 A CN 202210765078A CN 114954862 A CN114954862 A CN 114954862A
- Authority
- CN
- China
- Prior art keywords
- underwater robot
- module
- central control
- underwater
- control module
- 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 35
- 230000033001 locomotion Effects 0.000 title claims abstract description 19
- 230000008054 signal transmission Effects 0.000 claims description 10
- 238000012545 processing Methods 0.000 claims description 9
- 230000009189 diving Effects 0.000 claims description 7
- 238000007667 floating Methods 0.000 claims description 6
- 238000013519 translation Methods 0.000 claims description 6
- 230000001360 synchronised effect Effects 0.000 claims description 4
- 230000003313 weakening effect Effects 0.000 claims description 4
- 238000004364 calculation method Methods 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000004891 communication Methods 0.000 claims description 3
- 238000005516 engineering process Methods 0.000 claims description 3
- 238000005259 measurement Methods 0.000 claims description 3
- 238000005096 rolling process Methods 0.000 claims description 3
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000007547 defect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63C—LAUNCHING, HAULING-OUT, OR DRY-DOCKING OF VESSELS; LIFE-SAVING IN WATER; EQUIPMENT FOR DWELLING OR WORKING UNDER WATER; MEANS FOR SALVAGING OR SEARCHING FOR UNDERWATER OBJECTS
- B63C11/00—Equipment for dwelling or working underwater; Means for searching for underwater objects
- B63C11/52—Tools specially adapted for working underwater, not otherwise provided for
-
- 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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Ocean & Marine Engineering (AREA)
- Aviation & Aerospace Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种带缆水下机器人运动控制方法,所述控制方法涉及的模块包括中控模块、信号传输模块、姿态传感模块、深度传感模块、位置信息模块和推进模块,所述信号传输模块通过信号线与中控模块连接,所述姿态传感模块和深度传感模块通过信号线与中控模块连接,涉及水下机器人领域。该带缆水下机器人运动控制方法,具有两种工作模式,使得该水下机器人能够实现多种水下操作功能,功能齐全,实用方便,提高了其功能性,同时水下机器人依靠多组推进***实现了多组动作操作,推进***的利用效率高,节省了机体内部的空间,且水下机器人水中外部环境的干扰下,使得操作各个动作时仍具有较好的稳定性、快速性和准确性。
Description
技术领域
本发明涉及水下机器人技术领域,具体为一种带缆水下机器人运动控制方法。
背景技术
水下机器人也称无人遥控潜水器,是一种工作于水下的极限作业机器人,水下环境恶劣危险,人的潜水深度有限,所以水下机器人已成为开发海洋的重要工具,水下机器人主要应用于安全搜救、管道检查、船舶河道海洋石油、科研教学、水下娱乐、能源产业、水下考古和渔业等相关领域,现有的有缆水下机器人,功能性过于单一,且由于水下干扰的复杂性,水下机器人控制***要保持较好的稳定性、快速性和准确性具有一定的难度。
发明内容
(一)解决的技术问题
针对现有技术的不足,本发明提供了一种带缆水下机器人运动控制方法,解决了现有的有缆水下机器人,功能性过于单一,且由于水下干扰的复杂性,水下机器人控制***要保持较好的稳定性、快速性和准确性具有一定的难度问题。
(二)技术方案
为实现以上目的,本发明通过以下技术方案予以实现:一种带缆水下机器人运动控制方法,所述控制方法涉及的模块包括中控模块、信号传输模块、姿态传感模块、深度传感模块、位置信息模块和推进模块,所述信号传输模块通过信号线与中控模块连接,所述姿态传感模块和深度传感模块通过信号线与中控模块连接,所述位置信息模块和推进模块通过信号线与中控模块连接。
步骤一:中控模块通电并进行程序格式化,同步启动水下机器人;
步骤二:水下机器人通过姿态传感模块、深度传感模块和位置信息模块对水下信息进行采集,并同步将水下信息传输至中控模块,中控模块对水下信息进行计算,同步信号传输模块,将数据传输至控制手柄终端;
步骤三:中控模块对水下机器人的模式进行选定,同时根据水下采集信息,对预期的位置和姿态信息采用遇限削弱积分的PID算法进行控制运算,并同步将运算信息传输至水下机器人内部控制***,有控制***对水下机器人的推进***进行控制,其中水下机器人工作模式可分为水平工作模式和贴壁工作模式。
优选的,所述中控模块与水下机器人之间通过SJA1000总线进行通讯,通讯时,将不同的数据信息打包成不同的多帧报文,并依次发送,接收时,对报文一帧一帧进行接收,并对序列号标识符进行判断,根据序列号标识符代表的数据信息进行数据处理。
优选的,所述水平工作模式时对水下机器人的控制方法包括,将水下机器人的工作模式调为水平工作模式,中控模块采用遇限削弱积分的PID算法分别计算出推进***的输出值,实现对水下机器人的姿态控制;无线手柄控制中控模块向水下机器人发送下潜、上浮、平动、左转、右转、前进或后退指令信息后,中控模块通过决策处理获得实现上述动作时对每个推进***施加的推力值,并将每个推进***的推力值和步骤,计算出的输出值进行整合,得到推进***的最终推力值;根据推进器的特性关系式,中控模块将最终推力值转换成数字模拟控制信号后发送给水下机器人的控制***;水下机器人的控制***通过转换模块将数字模拟控制信号转换成电压值,控制舱根据电压值控制推进***进行工作。
优选的,所述贴壁工作模式时对水下机器人的控制方法包括,中控模块将水下机器人的工作模式调为水平工作模式,通过无线手柄控制上位PC机先向水下机器人发送翻滚指令,控制水下机器人处于侧翻且底部正对壁面的姿态,再向水下机器人发送垂推指令,从而给水下机器人上层四个推进器附加大小相等的正向推力,将正向推力锁定不变,将水下机器人工作模式切换为贴壁工作模式,中控模块采用遇限削弱积分的PID算法分别计算出下层推进***的输出值,实现对水下机器人的航向控制,通过无线手柄控制上位机向水下机器人发送下潜、上浮、平动、左转、右转、前进或后退指令信息后,中控模块通过决策处理获得实现上述动作时对下层推进***的推力值。
优选的,所述姿态传感模块为姿态传感器,采用MEMS技术的高性能三维运动姿态测量***。
优选的,所述深度传感模块为压力变送器。
(三)有益效果
本发明具有两种工作模式,使得该水下机器人能够实现多种水下操作功能,功能齐全,实用方便,提高了其功能性,同时水下机器人依靠多组推进***实现了多组动作操作,推进***的利用效率高,节省了机体内部的空间,且水下机器人水中外部环境的干扰下,使得操作各个动作时仍具有较好的稳定性、快速性和准确性。
附图说明
图1为本发明流程示意图;
图2为本发明连接关系示意图;
图3为本发明控制方法流程图。
具体实施方式
下面将结合本发明的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
如图1-图3所示,本发明实施例提供一种带缆水下机器人运动控制方法,控制方法涉及的模块包括中控模块、信号传输模块、姿态传感模块、深度传感模块、位置信息模块和推进模块,信号传输模块通过信号线与中控模块连接,姿态传感模块和深度传感模块通过信号线与中控模块连接,位置信息模块和推进模块通过信号线与中控模块连接。
步骤一:中控模块通电并进行程序格式化,同步启动水下机器人;
步骤二:水下机器人通过姿态传感模块、深度传感模块和位置信息模块对水下信息进行采集,并同步将水下信息传输至中控模块,中控模块对水下信息进行计算,同步信号传输模块,将数据传输至控制手柄终端;
步骤三:中控模块对水下机器人的模式进行选定,同时根据水下采集信息,对预期的位置和姿态信息采用遇限削弱积分的PID算法进行控制运算,并同步将运算信息传输至水下机器人内部控制***,有控制***对水下机器人的推进***进行控制,其中水下机器人工作模式可分为水平工作模式和贴壁工作模式。
中控模块与水下机器人之间通过SJA1000总线进行通讯,通讯时,将不同的数据信息打包成不同的多帧报文,并依次发送,接收时,对报文一帧一帧进行接收,并对序列号标识符进行判断,根据序列号标识符代表的数据信息进行数据处理。
水平工作模式时对水下机器人的控制方法包括,将水下机器人的工作模式调为水平工作模式,中控模块采用遇限削弱积分的PID算法分别计算出推进***的输出值,实现对水下机器人的姿态控制;无线手柄控制中控模块向水下机器人发送下潜、上浮、平动、左转、右转、前进或后退指令信息后,中控模块通过决策处理获得实现上述动作时对每个推进***施加的推力值,并将每个推进***的推力值和步骤,计算出的输出值进行整合,得到推进***的最终推力值;根据推进器的特性关系式,中控模块将最终推力值转换成数字模拟控制信号后发送给水下机器人的控制***;水下机器人的控制***通过转换模块将数字模拟控制信号转换成电压值,控制舱根据电压值控制推进***进行工作。
贴壁工作模式时对水下机器人的控制方法包括,中控模块将水下机器人的工作模式调为水平工作模式,通过无线手柄控制上位PC机先向水下机器人发送翻滚指令,控制水下机器人处于侧翻且底部正对壁面的姿态,再向水下机器人发送垂推指令,从而给水下机器人上层四个推进器附加大小相等的正向推力,将正向推力锁定不变,将水下机器人工作模式切换为贴壁工作模式,中控模块采用遇限削弱积分的PID算法分别计算出下层推进***的输出值,实现对水下机器人的航向控制,通过无线手柄控制上位机向水下机器人发送下潜、上浮、平动、左转、右转、前进或后退指令信息后,中控模块通过决策处理获得实现上述动作时对下层推进***的推力值。
姿态传感模块为姿态传感器,采用MEMS技术的高性能三维运动姿态测量***。
深度传感模块为压力变送器。
使用时,中控模块通电并进行程序格式化,同步启动水下机器人,水下机器人通过姿态传感模块、深度传感模块和位置信息模块对水下信息进行采集,并同步将水下信息传输至中控模块,中控模块对水下信息进行计算,同步信号传输模块,将数据传输至控制手柄终端,中控模块对水下机器人的模式进行选定,同时根据水下采集信息,对预期的位置和姿态信息采用遇限削弱积分的PID算法进行控制运算,并同步将运算信息传输至水下机器人内部控制***,有控制***对水下机器人的推进***进行控制,其中水下机器人工作模式可分为水平工作模式和贴壁工作模式。
需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
Claims (7)
1.一种带缆水下机器人运动控制方法,其特征在于:所述控制方法涉及的模块包括中控模块、信号传输模块、姿态传感模块、深度传感模块、位置信息模块和推进模块,所述信号传输模块通过信号线与中控模块连接,所述姿态传感模块和深度传感模块通过信号线与中控模块连接,所述位置信息模块和推进模块通过信号线与中控模块连接。
2.根据权利要求1所述的一种带缆水下机器人运动控制方法,其特征在于:包括以下步骤:
步骤一:中控模块通电并进行程序格式化,同步启动水下机器人;
步骤二:水下机器人通过姿态传感模块、深度传感模块和位置信息模块对水下信息进行采集,并同步将水下信息传输至中控模块,中控模块对水下信息进行计算,同步信号传输模块,将数据传输至控制手柄终端;
步骤三:中控模块对水下机器人的模式进行选定,同时根据水下采集信息,对预期的位置和姿态信息采用遇限削弱积分的PID算法进行控制运算,并同步将运算信息传输至水下机器人内部控制***,有控制***对水下机器人的推进***进行控制,其中水下机器人工作模式可分为水平工作模式和贴壁工作模式。
3.根据权利要求2所述的一种带缆水下机器人运动控制方法,其特征在于:所述中控模块与水下机器人之间通过SJA1000总线进行通讯,通讯时,将不同的数据信息打包成不同的多帧报文,并依次发送,接收时,对报文一帧一帧进行接收,并对序列号标识符进行判断,根据序列号标识符代表的数据信息进行数据处理。
4.根据权利要求3所述的一种带缆水下机器人运动控制方法,其特征在于:所述水平工作模式时对水下机器人的控制方法包括,将水下机器人的工作模式调为水平工作模式,中控模块采用遇限削弱积分的PID算法分别计算出推进***的输出值,实现对水下机器人的姿态控制;无线手柄控制中控模块向水下机器人发送下潜、上浮、平动、左转、右转、前进或后退指令信息后,中控模块通过决策处理获得实现上述动作时对每个推进***施加的推力值,并将每个推进***的推力值和步骤,计算出的输出值进行整合,得到推进***的最终推力值;根据推进器的特性关系式,中控模块将最终推力值转换成数字模拟控制信号后发送给水下机器人的控制***;水下机器人的控制***通过转换模块将数字模拟控制信号转换成电压值,控制舱根据电压值控制推进***进行工作。
5.根据权利要求4所述的一种带缆水下机器人运动控制方法,其特征在于:所述贴壁工作模式时对水下机器人的控制方法包括,中控模块将水下机器人的工作模式调为水平工作模式,通过无线手柄控制上位PC机先向水下机器人发送翻滚指令,控制水下机器人处于侧翻且底部正对壁面的姿态,再向水下机器人发送垂推指令,从而给水下机器人上层四个推进器附加大小相等的正向推力,将正向推力锁定不变,将水下机器人工作模式切换为贴壁工作模式,中控模块采用遇限削弱积分的PID算法分别计算出下层推进***的输出值,实现对水下机器人的航向控制,通过无线手柄控制上位机向水下机器人发送下潜、上浮、平动、左转、右转、前进或后退指令信息后,中控模块通过决策处理获得实现上述动作时对下层推进***的推力值。
6.根据权利要求5所述的一种带缆水下机器人运动控制方法,其特征在于:所述姿态传感模块为姿态传感器,采用MEMS技术的高性能三维运动姿态测量***。
7.根据权利要求6所述的一种带缆水下机器人运动控制方法,其特征在于:所述深度传感模块为压力变送器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210765078.7A CN114954862A (zh) | 2022-07-01 | 2022-07-01 | 一种带缆水下机器人运动控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210765078.7A CN114954862A (zh) | 2022-07-01 | 2022-07-01 | 一种带缆水下机器人运动控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114954862A true CN114954862A (zh) | 2022-08-30 |
Family
ID=82967042
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210765078.7A Pending CN114954862A (zh) | 2022-07-01 | 2022-07-01 | 一种带缆水下机器人运动控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114954862A (zh) |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101751036A (zh) * | 2008-12-12 | 2010-06-23 | 中国科学院沈阳自动化研究所 | 微型水下机器人电机控制装置及控制方法 |
KR101177839B1 (ko) * | 2011-06-03 | 2012-08-29 | 삼성중공업 주식회사 | 수중로봇 위치 측정 시스템 및 그 방법 및 시스템 |
JP2013063702A (ja) * | 2011-09-16 | 2013-04-11 | Tokyo Univ Of Marine Science & Technology | 水中ロボット |
CN104199447A (zh) * | 2014-08-18 | 2014-12-10 | 江苏科技大学 | 水下结构物检测机器人控制***及运动控制方法 |
CN105404303A (zh) * | 2015-12-28 | 2016-03-16 | 河海大学常州校区 | 一种rov水下机器人的运动控制方法 |
CN107203217A (zh) * | 2017-07-26 | 2017-09-26 | 江苏科技大学 | 一种基于滑模控制的水下机器人姿态调节控制*** |
CN107450572A (zh) * | 2017-07-26 | 2017-12-08 | 江苏科技大学 | 基于滑模控制的水下机器人姿态调节控制***及处理方法 |
CN107499476A (zh) * | 2017-08-21 | 2017-12-22 | 江苏科技大学 | 水下机器人控制***及运动控制方法 |
CN109062228A (zh) * | 2018-07-11 | 2018-12-21 | 山东省科学院自动化研究所 | 一种用于rov水下机器人的控制*** |
CN110794855A (zh) * | 2019-11-26 | 2020-02-14 | 南方电网调峰调频发电有限公司 | 一种水下机器人综合控制***及其方法 |
CN113602462A (zh) * | 2021-10-08 | 2021-11-05 | 南京工程学院 | 水下机器人及其水中高可视度情况下姿态与运动控制方法 |
-
2022
- 2022-07-01 CN CN202210765078.7A patent/CN114954862A/zh active Pending
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101751036A (zh) * | 2008-12-12 | 2010-06-23 | 中国科学院沈阳自动化研究所 | 微型水下机器人电机控制装置及控制方法 |
KR101177839B1 (ko) * | 2011-06-03 | 2012-08-29 | 삼성중공업 주식회사 | 수중로봇 위치 측정 시스템 및 그 방법 및 시스템 |
JP2013063702A (ja) * | 2011-09-16 | 2013-04-11 | Tokyo Univ Of Marine Science & Technology | 水中ロボット |
CN104199447A (zh) * | 2014-08-18 | 2014-12-10 | 江苏科技大学 | 水下结构物检测机器人控制***及运动控制方法 |
CN105404303A (zh) * | 2015-12-28 | 2016-03-16 | 河海大学常州校区 | 一种rov水下机器人的运动控制方法 |
CN107203217A (zh) * | 2017-07-26 | 2017-09-26 | 江苏科技大学 | 一种基于滑模控制的水下机器人姿态调节控制*** |
CN107450572A (zh) * | 2017-07-26 | 2017-12-08 | 江苏科技大学 | 基于滑模控制的水下机器人姿态调节控制***及处理方法 |
CN107499476A (zh) * | 2017-08-21 | 2017-12-22 | 江苏科技大学 | 水下机器人控制***及运动控制方法 |
CN109062228A (zh) * | 2018-07-11 | 2018-12-21 | 山东省科学院自动化研究所 | 一种用于rov水下机器人的控制*** |
CN110794855A (zh) * | 2019-11-26 | 2020-02-14 | 南方电网调峰调频发电有限公司 | 一种水下机器人综合控制***及其方法 |
CN113602462A (zh) * | 2021-10-08 | 2021-11-05 | 南京工程学院 | 水下机器人及其水中高可视度情况下姿态与运动控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107499476B (zh) | 水下机器人控制***及运动控制方法 | |
CN107957727B (zh) | 水下机器人控制***及动力定位方法 | |
CN106394833B (zh) | 一种爬游混合型无人潜水器及其使用方法 | |
CN105404303A (zh) | 一种rov水下机器人的运动控制方法 | |
CN109131801A (zh) | 全海深无人潜水器的自主回收装置及控制方法 | |
CN204979196U (zh) | 水下多轴机器人 | |
CN106695834A (zh) | 一种双体探测水下机器人装置及控制方法 | |
CN108241179A (zh) | 一种仿生与滑翔混合推进方式的水下机器人 | |
CN111268071A (zh) | 分体拖缆式水面—水下无人航行器 | |
CN102139749A (zh) | 一种水下监控机器人机构 | |
Hasan et al. | Design of omni directional remotely operated vehicle (ROV) | |
CN105923114A (zh) | 一种半潜式无人艇及其使用方法 | |
CN114954862A (zh) | 一种带缆水下机器人运动控制方法 | |
CN208993903U (zh) | 全海深无人潜水器的自主回收装置 | |
Bono et al. | Romeo goes to antarctica [unmanned underwater vehicle] | |
CN210284562U (zh) | 一种用于水下长距离隧洞检测的装置 | |
Liang et al. | Experiment of robofish aided underwater archaeology | |
Martínez et al. | Hardware and software architecture for auv based on low-cost sensors | |
CN113625729A (zh) | 一种大时延下的水下机器人遥操作装置及实现方法 | |
Guan et al. | Mechanical analysis of remotely operated vehicle | |
CN108928450B (zh) | 一种多足机器人水下飞行方法 | |
CN113110458A (zh) | 一种无人船虚拟目标跟踪控制*** | |
CN110844029A (zh) | 一种水下四旋翼航行器 | |
CN110687906A (zh) | 基于剪枝技术的船舶智能自动舵 | |
CN112152144B (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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20220830 |