CN114379749A - 一种并联三体水下机器人稳心高度的调节方法 - Google Patents
一种并联三体水下机器人稳心高度的调节方法 Download PDFInfo
- Publication number
- CN114379749A CN114379749A CN202210100444.7A CN202210100444A CN114379749A CN 114379749 A CN114379749 A CN 114379749A CN 202210100444 A CN202210100444 A CN 202210100444A CN 114379749 A CN114379749 A CN 114379749A
- Authority
- CN
- China
- Prior art keywords
- height
- buoyancy
- underwater robot
- parallel
- center
- 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.)
- Granted
Links
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
- B63G8/22—Adjustment of buoyancy by water ballasting; Emptying equipment for ballast tanks
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Aviation & Aerospace Engineering (AREA)
- Ocean & Marine Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种并联三体水下机器人稳心高度的调节方法。本发明所提调节方法主要包括两个步骤。第一,调节并联三体水下机器人上下单体的浮力,通过改变上下单体的浮力差来调节其稳心高度。第二,调节并联三体水下机器人所构成等腰三角形的顶角大小,通过改变上下单体相对位置来进一步调节其稳心高度。本发明给出了浮力调节量、调节后顶角大小与稳心高度的具体函数关系,从而实现通过调节各单体浮力调节量、等腰三角构型的顶角大小,调节整体构型的稳心高度。本发明具有机理明确清晰、方法验证有效等特点,可广泛应用于并联多体水下机器人稳心高度的调节工作,以更好应对不同海流环境的干扰。
Description
技术领域
本发明涉及水下机器人自稳定领域,具体地说是一种并联三体水下机器人稳心高度的调节方法。
背景技术
由于长期腐蚀、地质灾害等原因,近几十年来海洋油气设施事故屡有发生,不仅给油气工业带来重大影响,也给生命安全和生态环境带来了严重威胁。海洋中流场方向、大小复杂多变,且海流与油气设施接触后产生的涡流同样具有一定的复杂性,这些复杂的流场会对水下机器人作业姿态的有效保持带来极大挑战。
为了提升作业的姿态稳定能力,并联多体水下机器人得到了近些年的广泛关注。例如,上下结构的并联三体水下机器人相对于单体水下机器人具有更好的抗倾覆(旋转力矩更大)和自稳定能力。影响水下机器人自稳定能力的重要因素是稳心高度。稳心高度是指潜体重心和浮心之间的距离。这个距离很关键:如果距离太小,则潜体不稳,有慢摇倾向,稳性过小;如果距离太大,则有快摇倾向,稳性过大。
为了应对不同的海流环境干扰,影响自稳定能力的稳心高度调节具有重要意义。然而,针对并联三体水下机器人,目前尚未有一种可依据实际工况完成稳心高度调节的方法。
发明内容
针对上述问题,本发明目的是提供一种并联三体水下机器人稳心高度的调节方法,建立出浮力调节量、相对位置调节后顶角大小与稳心高度的函数关系,为并联三体水下机器人稳心高度调节工作提供支撑。
本发明是通过以下技术方案来实现的:
一种并联三体水下机器人稳心高度的调节方法,包括通过以下步骤进行稳心高度的调节:
步骤1、计算各单体浮力调节量,输出指令用于改变整体构型的稳心高度;
步骤2、计算等腰三角构型的顶角大小,输出指令用于改变各单体相对位置,调节整体构型的稳心高度。
所述稳心高度为重心与浮心之间的距离。
所述步骤1包括:
根据重力平衡原理、浮力平衡原理,建立浮力调节量与稳心高度的函数关系;调节并联三体水下机器人各单体浮力,改变各单体的浮力差来调节其整体构型的稳心高度。
所述浮力调节量与稳心高度的函数关系为:
其中,htf、ht、L和θt分别为并联三体水下机器人的浮力调节后稳心高度、浮力调节后新浮心纵坐标、重心纵坐标、浮力调节前的稳心高度、腰长和顶角大小,hs为单体水下机器人的稳心高度,B为单体水下机器人浮力调节前所受浮力大小,μΔB为上侧各单体水下机器人的浮力调节量。
所述步骤2包括:
根据重力平衡原理、浮力平衡原理,建立浮力调节量、调节后顶角大小与稳心高度的函数关系;调节并联三体水下机器人所构成等腰三角形的顶角大小,改变各单体相对位置来进一步调节其整体构型的稳心高度。
所述浮力调节量、调节后顶角大小与稳心高度的函数关系为:
所述条件包括:假设浮力调节前三体水下机器人中各单体的外形、重心均相同,且初始状态下重力等于浮力;假设单体水下机器人之间连接杆的重力与浮力忽略不计;假设并联三体水下机器人在运动中姿态保持水平;假设浮力调节过程中上侧两个单体浮力调节量相等,且总浮力保持不变。
所述三体水下机器人并联的构型为等腰三角形,所述等腰三角形的腰两端的单体距离固定,等腰三角形顶角开合大小可调节。
所述调节并联三体水下机器人各单体浮力,是通过调节各单体的浮力调节机构的排水量来实现的;
所述等腰三角构型的顶角开合大小的调节,是通过输出指令控制顶点处单体旋转机构运动,实现对并联三体等腰三角构型的顶角大小调节。
一种并联三体水下机器人稳心高度的调节装置,包括:处理部、存储部,存储部存储有程序,处理部加载程序执行如上所述的方法步骤,实现并联三体水下机器人稳心高度的调节。
本发明具有以下有益效果及优点:
1.通过调节并联三体水下机器人上下单体的浮力,在改变上下单体浮力差的情况下,实现了稳心高度的有效调节。
2.在浮力调节的基础上,通过调节并联三体水下机器人所构成等腰三角形的顶角大小,实现了稳心高度的进一步调节。
3.本发明能够实现浮力调节量、相对位置调节后顶角大小与稳心高度关系的连续描述。
4.本发明能够为并联多体水下机器人自稳定性研究提供理论支撑。
附图说明
通过阅读参照以下附图对非限制性实施例所作的详细描述,本发明的其它特征、目的和优点能够更加明显易懂:
图1为本发明的方法流程图;
图2为本发明的单体水下机器人中性浮力状态下的受力情况及稳心高度示意图;
图3为本发明的单体中性浮力状态下并联三体水下机器人受力情况及稳心高度示意图;
图4为本发明的通过浮力调节来调节并联三体水下机器人稳心高度示意图;
图5为本发明的通过顶角大小调节来调节并联三体水下机器人稳心高度示意图。
图6为本发明的方法所述的并联三体水下机器的顶角大小改变原理图;
具体实施方式
下面结合具体实施例对本发明作进一步详述。以下实施例将有助于本领域的技术人员进一步理解本发明,但不以任何形式限制本发明。应当指出的是,对本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变化和改进。这些都属于本发明的保护范围。
除非另有定义,本文所使用的所有技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中在发明的说明书中所使用的术语只是为了描述具体的实施例的目的,不是旨在于限制本发明。
单体水下机器人可以近似的看作圆柱体,则在垂直方向上其浮心位于圆柱形的中心。单体水下机器人在水中通常处于中性浮力状态,其重心g与浮心b大小相等、方向相反,且在同一直线上。单体水下机器人中性浮力状态下的受力情况及稳心高度如图2所示,其中B、G分别为所受浮力与重力大小,hs为单体水下机器人的稳心高度。
并联三体水下机器人(“倒三角”构型且左右对称)受力情况及稳心高度如图3所示,各单体被分别命名为AUV1、AUV2和AUV3。图中,b1、b2、b3和bc分别为单体AUV1、AUV2、AUV3和并联三体水下机器人的浮心,g1、g2、g3和gc分别为单体AUV1、AUV2、AUV3和并联三体水下机器人的重心,l和L分别为并联三体水下机器人浮心或重心三角构型的底和腰长度,ht为并联三体水下机器人的稳心高度。此外,根据合力矩原理,在平面汇交力系中,合力对平面内任意一点的力矩,等于其所有分力对于同一点的力矩的代数和,推导后有hs=ht。
并联多体水下机器人稳心高度的调节可采用上下单体浮力调节与等腰三角形顶角大小调节相结合后的方法。
下面阐述通过上下单体浮力调节来调节稳心高度的原理。
单体水下机器人浮力调节采用浮力调节机构改变各单体排水量从而改变浮力的方式,所以浮力调节后单体水下机器人垂直方向的重心与浮心位置不变,只是浮力大小发生变化。假设AUV1与AUV2浮力调节后的浮力变化均为μΔB,其中ΔB为浮力调节量,μ为系数。为了使系统整体达到总浮力不变,AUV3浮力调节后的浮力变化应为-2μΔB。假设坐标系原点在AUV3重心g3处,则b1与b2、g1与g2关于y轴对称。图4为通过浮力调节来调节并联三体水下机器人稳心高度示意图。图中,bcf为浮力调节后并联三体水下机器人的新浮心,htf为浮力调节后并联三体水下机器人的稳心高度。
整理得
同理,并联三体水下机器人的浮心满足如下关系:
整理得
则浮力调节后并联三体水下机器人的稳心高度为
定义等腰三角形的顶角为θt,又由于ht=hs,则有
上述公式(10)中,μΔB待调节的参数,其他为可以获取的参量。通过改变并联三体水下机器人各单体的浮力调节量μΔB实现对稳心高度的调节。将μΔB转换为排水或吸水指令输出给各单体上的浮力调节机构用于改变排水量从而改变浮力,各单体上的浮力调节机构采用申请号为201711366548.8,名称为“一种微小型水下机器人浮力调节系统”所述的浮力调节系统。
如果仅仅通过改变μΔB不能到达稳心高度要求,则在浮力调节的基础上,再通过构型变换机构调节等腰三角形的顶角大小,可实现稳心高度的进一步调节,下面阐述其原理。
图5为通过等腰三角形的顶角大小调节来调节并联三体水下机器人稳心高度示意图。调节后,三角形腰长不变,仍为L,底边长度改变。图中,bcfa为角度调节后并联三体水下机器人的新浮心,gca为角度调节后并联三体水下机器人的新重心,htfa为角度调节后并联三体水下机器人的稳心高度。
整理得
同理,并联三体水下机器人的浮心在y轴方向满足如下关系:
整理得
则角度调节后并联三体水下机器人的稳心高度为
上述公式(15)中,θta为待调节的参数,μΔB可由公式(10)获取,其他参量为可以获取的参量。因此,通过改变θta,能进一步实现对稳心高度的调节。如图6所示,为本发明的方法所述的并联三体水下机器的顶角大小改变原理图,θta的调节是通过对顶点处单体中段的旋转机构转动来实现顶角的变化。AUV1通过连接杆固定连接在顶点处单体AUV3仓壁外,顶点处单体AUV3中间舱段的旋转机构包括:单体AUV3中段设有转盘,AUV2通过连接杆固定连接在转盘上,转盘中心与单体AUV3仓内的旋转电机输出轴端连接,控制器根据θta输出电机旋转指令控制旋转电机带动转盘转动,实现对并联三体等腰三角构型的顶角大小调节。本方法的函数关系计算过程中,假设顶角大小调节后各单体的重心与浮心依然在垂直方向上共线。
以上所述仅为本发明的较佳实施例而已,并不用以限定本发明,对于本技术领域的技术人员来说,在不脱离本发明原理的前提下所作的任何修改、改进和等同替换等,均包含在本发明的保护范围内。
Claims (10)
1.一种并联三体水下机器人稳心高度的调节方法,其特征在于,包括通过以下步骤进行稳心高度的调节:
步骤1、计算各单体浮力调节量,输出指令用于改变整体构型的稳心高度;
步骤2、计算等腰三角构型的顶角大小,输出指令用于改变各单体相对位置,调节整体构型的稳心高度。
2.根据权利要求1所述的一种并联三体水下机器人稳心高度的调节方法,其特征在于,所述稳心高度为重心与浮心之间的距离。
3.根据权利要求1所述的一种并联三体水下机器人稳心高度的调节方法,其特征在于,所述步骤1包括:
根据重力平衡原理、浮力平衡原理,建立浮力调节量与稳心高度的函数关系;调节并联三体水下机器人各单体浮力,改变各单体的浮力差来调节其整体构型的稳心高度。
5.根据权利要求1所述的一种并联三体水下机器人稳心高度的调节方法,其特征在于,所述步骤2包括:
根据重力平衡原理、浮力平衡原理,建立浮力调节量、调节后顶角大小与稳心高度的函数关系;调节并联三体水下机器人所构成等腰三角形的顶角大小,改变各单体相对位置来进一步调节其整体构型的稳心高度。
7.根据权利要求1所述的一种并联三体水下机器人稳心高度的调节方法,其特征在于,所述条件包括:假设浮力调节前三体水下机器人中各单体的外形、重心均相同,且初始状态下重力等于浮力;假设单体水下机器人之间连接杆的重力与浮力忽略不计;假设并联三体水下机器人在运动中姿态保持水平;假设浮力调节过程中上侧两个单体浮力调节量相等,且总浮力保持不变。
8.根据权利要求1所述的一种并联三体水下机器人稳心高度的调节方法,其特征在于,所述三体水下机器人并联的构型为等腰三角形,所述等腰三角形的腰两端的单体距离固定,等腰三角形顶角开合大小可调节。
9.根据权利要求1所述的一种并联三体水下机器人稳心高度的调节方法,其特征在于,所述调节并联三体水下机器人各单体浮力,是通过调节各单体的浮力调节机构的排水量来实现的;
所述等腰三角构型的顶角开合大小的调节,是通过输出指令控制顶点处单体旋转机构运动,实现对并联三体等腰三角构型的顶角大小调节。
10.一种并联三体水下机器人稳心高度的调节装置,其特征在于,包括:处理部、存储部,存储部存储有程序,处理部加载程序执行如权利要求1-9任意一项所述的方法步骤,实现并联三体水下机器人稳心高度的调节。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210100444.7A CN114379749B (zh) | 2022-01-27 | 2022-01-27 | 一种并联三体水下机器人稳心高度的调节方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210100444.7A CN114379749B (zh) | 2022-01-27 | 2022-01-27 | 一种并联三体水下机器人稳心高度的调节方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114379749A true CN114379749A (zh) | 2022-04-22 |
CN114379749B CN114379749B (zh) | 2022-11-15 |
Family
ID=81204589
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210100444.7A Active CN114379749B (zh) | 2022-01-27 | 2022-01-27 | 一种并联三体水下机器人稳心高度的调节方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114379749B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115009486A (zh) * | 2022-07-14 | 2022-09-06 | 飞马滨(青岛)智能科技有限公司 | 一种水下机器人的重心调节方法 |
CN116424528A (zh) * | 2023-05-25 | 2023-07-14 | 中国船舶科学研究中心 | 一种具有稳心高调节功能的auv导流罩机构 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012080752A (ja) * | 2010-10-01 | 2012-04-19 | Yoshiji Kondo | 三体モータ |
CN103144752A (zh) * | 2013-02-05 | 2013-06-12 | 华南理工大学 | 一种多自由度操纵水下拖曳体 |
CN109703705A (zh) * | 2018-12-26 | 2019-05-03 | 哈尔滨工程大学 | 一种半潜式无人平台 |
CN110065588A (zh) * | 2019-04-30 | 2019-07-30 | 天津大学 | 一种快速拆装半潜三体无人艇 |
CN110435858A (zh) * | 2019-08-19 | 2019-11-12 | 华南理工大学 | 一种自主稳定多自由度运动可控吊舱式水下拖曳体 |
CN213354801U (zh) * | 2020-08-05 | 2021-06-04 | 华南理工大学 | 一种三回转体组合式自主水下航行器 |
-
2022
- 2022-01-27 CN CN202210100444.7A patent/CN114379749B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012080752A (ja) * | 2010-10-01 | 2012-04-19 | Yoshiji Kondo | 三体モータ |
CN103144752A (zh) * | 2013-02-05 | 2013-06-12 | 华南理工大学 | 一种多自由度操纵水下拖曳体 |
CN109703705A (zh) * | 2018-12-26 | 2019-05-03 | 哈尔滨工程大学 | 一种半潜式无人平台 |
CN110065588A (zh) * | 2019-04-30 | 2019-07-30 | 天津大学 | 一种快速拆装半潜三体无人艇 |
CN110435858A (zh) * | 2019-08-19 | 2019-11-12 | 华南理工大学 | 一种自主稳定多自由度运动可控吊舱式水下拖曳体 |
CN213354801U (zh) * | 2020-08-05 | 2021-06-04 | 华南理工大学 | 一种三回转体组合式自主水下航行器 |
Non-Patent Citations (1)
Title |
---|
戴鹏: "基于参数化的三体组合式自主水下航行器多目标优化设计研究", 《中国优秀硕士学位论文全文数据库》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115009486A (zh) * | 2022-07-14 | 2022-09-06 | 飞马滨(青岛)智能科技有限公司 | 一种水下机器人的重心调节方法 |
CN116424528A (zh) * | 2023-05-25 | 2023-07-14 | 中国船舶科学研究中心 | 一种具有稳心高调节功能的auv导流罩机构 |
CN116424528B (zh) * | 2023-05-25 | 2024-02-02 | 中国船舶科学研究中心 | 一种具有稳心高调节功能的auv导流罩机构 |
Also Published As
Publication number | Publication date |
---|---|
CN114379749B (zh) | 2022-11-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114379749B (zh) | 一种并联三体水下机器人稳心高度的调节方法 | |
CN110937510B (zh) | 具有双摆特性的海上起重机稳定控制方法及系统 | |
CN107719595B (zh) | 一种复合式海洋平台减摇系统及方法 | |
CN109334892B (zh) | 一种多体船的简化鲁棒自适应减纵摇控制方法 | |
CN107161882B (zh) | 一种新型的主动补偿吊机系统 | |
CN103064425B (zh) | 提高臂架运动稳定性的方法、系统及工程机械 | |
CN112875509A (zh) | 一种带负载升降运动的欠驱动塔式起重机定位消摆方法 | |
CN112147887B (zh) | 一种基于模糊滑模控制的桥式起重机定位消摆方法 | |
CN113465861B (zh) | 一种两自由度电液振动台的干扰力补偿方法 | |
CN110220661B (zh) | 一种两自由度电液振动台自抗扰控制方法 | |
Bruckmann et al. | An energy-efficient wire-based storage and retrieval system | |
CN111522236B (zh) | 一种二级摆动型塔式吊车系统跟踪控制方法及系统 | |
CN112897338A (zh) | 一种欠驱动双摆塔式起重机轨迹跟踪与摆动抑制控制方法 | |
CN112919318B (zh) | 一种基于阻抗控制的船用主动减摆收放机械臂 | |
Qian et al. | Finite-time neural network-based hierarchical sliding mode antiswing control for underactuated dual ship-mounted cranes with unmatched sea wave disturbances suppression | |
CN112052583B (zh) | 一种基于径向弹簧-阻尼器的铸造起重机增强耦合自适应滑模控制方法 | |
CN117163219B (zh) | 一种考虑杆长杆间约束的船载栈桥前馈模糊控制方法 | |
CN110032817B (zh) | 一种双吊起重作业仿真建模方法 | |
Zhu et al. | Dynamic characteristics of series-parallel hybrid rigid-flexible coupling double-mass underactuated system on floating platform | |
Su et al. | Load stability analysis of a floating multi-robot coordinated towing system | |
Cao et al. | Nonlinear model predictive control of shipboard boom cranes with ship roll motion | |
CN208556433U (zh) | 多点数控焊接机械手臂 | |
CN111498037A (zh) | 基于变结构自抗扰控制的高速双体船纵向减摇方法 | |
CN117105096B (zh) | 一种适用于变绳长双摆型船用起重机的滑模控制方法 | |
Li et al. | Dynamic Analysis of Marine Tower Cranes with Double Pendulum Subject to Ocean Wave Disturbance |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |