CN113075932B - 一种基于3-rps并联机构的uuv矢量推进控制方法 - Google Patents
一种基于3-rps并联机构的uuv矢量推进控制方法 Download PDFInfo
- Publication number
- CN113075932B CN113075932B CN202110340744.8A CN202110340744A CN113075932B CN 113075932 B CN113075932 B CN 113075932B CN 202110340744 A CN202110340744 A CN 202110340744A CN 113075932 B CN113075932 B CN 113075932B
- Authority
- CN
- China
- Prior art keywords
- parallel mechanism
- rps parallel
- rps
- uuv
- plane
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/02—Control of position or course in two dimensions
- G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Toys (AREA)
Abstract
本发明公开了一种基于3‑RPS并联机构的UUV矢量推进控制方法。本发明将2个3‑RPS并联机构组合到一起,形成一个全新的机构,然后分析了该装置对螺旋桨方向的控制方式,避免了多解的情况的发生。最后将其装到UUV上,使UUV具有更好的推进控制效果,并能在复杂的海况下保持其稳定性。
Description
技术领域
本发明属于UUV推进控制领域,具体来说是基于3-RPS并联机构来对传统UUV推进控制策略进行改进,从而在保证UUV正常推进的同时,增加其灵巧性与稳定性,提高UUV运行效率。
背景技术
海洋自古以来都是人类探索未知与发掘资源的宝库。近年来,随着世界各国对海洋发展的日渐重视,以及海洋技术的飞速发展,水下无人机器人逐渐成为探索海洋的重要工具之一。由于水下无人机器人具有机动性好,可操作性强,无人生安全风险等优点,因此不管在民用领域还是军事领域,UUV都起着重要的作用。然而,UUV的发展种类众多,方向也各不相同,因此在UUV的推进控制方面,仍有着巨大的发展空间。
传统UUV靠舵叶来调整螺旋桨,在灵巧性上尚有欠缺,此外由于海洋中的环境较为复杂,外干扰因素众多,导致UUV的稳定性成为了UUV设计中的一个关键。现有的UUV在航行时难以保证良好的稳定性,而3-RPS并联机构具有可控性好、精度高、承载能力强等特点,可以使UUV在面对复杂海况时仍然能够灵活稳定地调整方向。
发明内容
本发明针对现有UUV在航行时无法保证良好的稳定性,改变了传统的靠舵叶调整螺旋桨的推进策略,提出了一种3-RPS+3-RPSUUV矢量推进装置及控制策略,用以提高UUV在海中作业时的推进控制性能。
本发明将2个3-RPS并联机构串联在一起,使得UUV调整螺旋桨方向的角度变得更为灵活,在提高UUV灵巧性的同时提高UUV的稳定性。
为了实现上述目的,本发明具体技术方案如下:
将两个3-RPS并联机构合并起来。具体是将前一个3-RPS并联机构的动平面作为后一个3-RPS并联机构的定平面,其中后一个3-RPS并联机构的三条运动支链起于定平面的三条边的中点。再将前一个3-RPS并联机构的定平面装于装于UUV的尾部,后一个3-RPS并联机构的动平面连接螺旋桨。通过以下控制策略来调整螺旋桨,从而推动UUV。
所述的控制策略具体是:
设前一个3-RPS并联机构的定平面为xoy面,且A1B1、A2B2、A3B3为前一个3-RPS并联机构的运动支链,C1D1、C2D2、C3D3为后一个3-RPS并联机构的运动支链,其中C1位于边B1B3的中点,C2位于边B1B2的中点,C3位于边B2B3的中点,将xoy面以60°为界限分成6个部分,运动支链A1B1、A2B2、A3B3分别位于210°、330°和90°,并设z轴垂直于xoy面;
当螺旋桨在0°~60°和180°~240°内转动时,只需调节A2B2,A3B3,C1D1,C2D2这四条运动支链,而不必调节A1B1与C3D3。其他角度同理。
而当考虑z轴时,将两个3-RPS并联机构的运动设置限制条件。具体是:
当螺旋桨在z轴上的转动角度小于前一个3-RPS并联机构的极限偏转角时,后一个3-RPS并联机构的三条运动支链上的电机不启动,确保在此情况下,后一个3-RPS并联机构的动平面与前一个3-RPS并联机构的动平面完全平行;
当螺旋桨在z轴上的转动角度大于前一个3-RPS并联机构的极限偏转角时,后一个3-RPS并联机构开始启动。具体方式为:当螺旋桨在xoy平面内的转动角度处于30°~150°时,前一个3-RPS并联机构的A3B3运动支链收缩到最短,A1B1与A2B2运动支链不动,后一个3-RPS并联机构的运动支链开始启动,使螺旋桨在z轴和xoy平面的方向都能达到目标角度。其他角度同理。
与传统的通过舵叶来调整螺旋桨的UUV推进控制策略相比,本发明具有以下优点:
1、3-RPS并联机构相比于传统的舵叶控制,可控性更好,精度更高,承载能力更强,尤其是在灵活性方面,3-RPS并联机构有着十分杰出的效能。
2、本次发明将2个3-RPS并联机构组装在一起,解决了单个3-RPS并联机构转动角度不足的问题,使得装置的自由度大大提高,这也导致UUV在航行时能具有更大的操作空间。
3、该装置整体结构较为紧凑,在面对复杂的海况时,能更好的保持UUV推进的稳定性。
附图说明
下面结合附图对本发明的具体实施方式作进一步详细说明。
图1 3-RPS并联机构;
图2 3-RPS+3-RPS装置组装方式简图;
图3 3-RPS+3-RPS装置结构图;
图4装置侧视坐标图;
图5UUV整体布局图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。此外,下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
本次发明具体技术方案如下:
考虑一个3-RPS并联机构自身的特性,对其进行位置反解,见图1。
使用Euler法,在3-RPS并联机构的定平台中心建立坐标系O-XYZ,在3-RPS并联机构的动平台中心建立坐标系Q-xyz,则3-RPS三杆的长度可表达为:
其中,Six、Siy、Siz、Rix、Riy、Riz分别为球面副中心和转动副中心在动平台中心建立坐标系Q-xyz和定平台中心建立坐标系O-XYZ中的X、Y、Z坐标。
将2个3-RPS并联机构合并起来,具体方式如图2,图3。将前一个3-RPS并联机构的动平台作为后一个3-RPS并联机构的定平台。后一个3-RPS并联机构的三条运动支链球副起于定平面的三条边的中点,这样可以让该装置在调整螺旋桨方向时能具有更多的角度选择。同时考虑到灵活性,运动平台及其运动副从前至后依次变小。
该装置共有6条运动支链(前3后3),每条支链上都安装有一个步进电机,通过步进电机带动螺杆旋转,从而使对应螺杆收缩,调整平台倾斜角度。
分析该装置对螺旋桨方向的控制方式。
由于螺旋桨的方向调整并不是二维的调整,而是在空间内的三维的调整。因此,首先考虑竖直平面内的方向转动,如图4。为了简化操作,可将xoy面以60°为界限分成6个部分。当螺旋桨在0°~60°和180°~240°内转动时,只需调节A2B2,A3B3,C1D1,C2D2这四条运动支链,而不必调节A1B1与C3D3。其他角度同理。而当考虑z轴时,则需要处理多解的情况。因此,在设计时,可以将2个3-RPS并联机构的运动设置限制条件。当螺旋桨在z轴上的转动角度小于1号3-RPS并联机构的极限偏转角时,2号3-RPS并联机构的三条运动支链上的电机不会启动,确保在此情况下,2号3-RPS并联机构的动平面与1号3-RPS并联机构的动平面完全平行。而当螺旋桨在z轴上的转动角度大于1号3-RPS并联机构的极限偏转角时,2号3-RPS并联机构开始启动。具体方式为:当螺旋桨在xoy平面内的转动角度处于30°~150°时,1号3-RPS并联机构的A3B3运动支链收缩到最短,A1B1与A2B2不动,2号3-RPS并联机构的运动支链开始启动,使螺旋桨在z轴和xoy平面的方向都能达到目标角度。其他角度同理。
将该装置装在UUV后方,前定平台与UUV相连,后动平台与螺旋桨相连,如图5。在控制时,一号3-RPS并联机构的运动支链通过安装在其上的步进电机,对一号动平台(即二号3-RPS并联机构的定平台)的位置和倾斜度进行调整,并连同二号3-RPS并联机构的运动支链,一起对二号3-RPS并联机构的动平台进行调整,从而改变螺旋桨的方向,调整UUV的推进。
Claims (2)
1.一种基于3-RPS并联机构的UUV矢量推进控制方法,其特征在于:
将两个3-RPS并联机构合并起来;具体是将前一个3-RPS并联机构的动平面作为后一个3-RPS并联机构的定平面,其中后一个3-RPS并联机构的三条运动支链起于定平面的三条边的中点;再将前一个3-RPS并联机构的定平面装于UUV的尾部,后一个3-RPS并联机构的动平面连接螺旋桨;通过以下控制策略来调整螺旋桨,从而推动UUV,
所述的控制策略具体是:
设前一个3-RPS并联机构的定平面为xoy面,且A1B1、A2B2、A3B3为前一个3-RPS并联机构的运动支链,C1D1、C2D2、C3D3为后一个3-RPS并联机构的运动支链,其中C1位于边B1B3的中点,C2位于边B1B2的中点,C3位于边B2B3的中点,将xoy面以60°为界限分成6个部分,运动支链A1B1、A2B2、A3B3分别位于210°、330°和90°,并设z轴垂直于xoy面;
当螺旋桨在0°~60°和180°~240°内转动时,只需调节A2B2,A3B3,C1D1,C2D2这四条运动支链,而不必调节A1B1与C3D3;其他角度同理;
而当考虑z轴时,将两个3-RPS并联机构的运动设置限制条件;具体是:
当螺旋桨在z轴上的转动角度小于前一个3-RPS并联机构的极限偏转角时,后一个3-RPS并联机构的三条运动支链上的电机不启动,确保在此情况下,后一个3-RPS并联机构的动平面与前一个3-RPS并联机构的动平面完全平行;
当螺旋桨在z轴上的转动角度大于前一个3-RPS并联机构的极限偏转角时,后一个3-RPS并联机构开始启动;具体方式为:当螺旋桨在xoy平面内的转动角度处于30°~150°时,前一个3-RPS并联机构的A3B3运动支链收缩到最短,A1B1与A2B2运动支链不动,后一个3-RPS并联机构的运动支链开始启动,使螺旋桨在z轴和xoy平面的方向都能达到目标角度;其他角度同理。
2.根据权利要求1所述的一种基于3-RPS并联机构的UUV矢量推进控制方法,其特征在于:前一个3-RPS并联机构的运动支链长度大于后一个3-RPS并联机构的运动支链长度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110340744.8A CN113075932B (zh) | 2021-03-30 | 2021-03-30 | 一种基于3-rps并联机构的uuv矢量推进控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110340744.8A CN113075932B (zh) | 2021-03-30 | 2021-03-30 | 一种基于3-rps并联机构的uuv矢量推进控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113075932A CN113075932A (zh) | 2021-07-06 |
CN113075932B true CN113075932B (zh) | 2022-03-22 |
Family
ID=76611809
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110340744.8A Active CN113075932B (zh) | 2021-03-30 | 2021-03-30 | 一种基于3-rps并联机构的uuv矢量推进控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113075932B (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103538709A (zh) * | 2013-10-18 | 2014-01-29 | 天津大学 | 一种自主式水下航行器的并联矢量推进机构 |
CN103754344A (zh) * | 2014-01-13 | 2014-04-30 | 天津大学 | 一种新型水下航行器并联矢量推进器结构及姿态确定方法 |
US8919274B1 (en) * | 2013-05-21 | 2014-12-30 | The United States Of America As Represented By The Secretary Of The Navy | Submersible vehicle with high maneuvering cyclic-pitch postswirl propulsors |
CN106428494A (zh) * | 2016-10-31 | 2017-02-22 | 吉林大学 | 一种基于空间并联机构的水下矢量推进器 |
CN107985536A (zh) * | 2017-11-30 | 2018-05-04 | 吉林大学 | 一种配备空间并联机构矢量推进器的潜航器 |
CN109050838A (zh) * | 2018-08-16 | 2018-12-21 | 浙江大学 | 基于矢量推进的水下直升机 |
CN109319068A (zh) * | 2018-11-09 | 2019-02-12 | 大连理工大学 | 一种水下运载装备的并联式矢量推进器 |
CN112507474A (zh) * | 2020-10-29 | 2021-03-16 | 北京控制工程研究所 | 一种针对空间二自由度并联矢量调节机构的精度分析方法 |
-
2021
- 2021-03-30 CN CN202110340744.8A patent/CN113075932B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8919274B1 (en) * | 2013-05-21 | 2014-12-30 | The United States Of America As Represented By The Secretary Of The Navy | Submersible vehicle with high maneuvering cyclic-pitch postswirl propulsors |
CN103538709A (zh) * | 2013-10-18 | 2014-01-29 | 天津大学 | 一种自主式水下航行器的并联矢量推进机构 |
CN103754344A (zh) * | 2014-01-13 | 2014-04-30 | 天津大学 | 一种新型水下航行器并联矢量推进器结构及姿态确定方法 |
CN106428494A (zh) * | 2016-10-31 | 2017-02-22 | 吉林大学 | 一种基于空间并联机构的水下矢量推进器 |
CN107985536A (zh) * | 2017-11-30 | 2018-05-04 | 吉林大学 | 一种配备空间并联机构矢量推进器的潜航器 |
CN109050838A (zh) * | 2018-08-16 | 2018-12-21 | 浙江大学 | 基于矢量推进的水下直升机 |
CN109319068A (zh) * | 2018-11-09 | 2019-02-12 | 大连理工大学 | 一种水下运载装备的并联式矢量推进器 |
CN112507474A (zh) * | 2020-10-29 | 2021-03-16 | 北京控制工程研究所 | 一种针对空间二自由度并联矢量调节机构的精度分析方法 |
Non-Patent Citations (1)
Title |
---|
UPR-UPU-UR矢量推进机构的推进性能研究;杜晓强等;《光学精密工程》;20201031;第28卷(第10期);第2277-2289页 * |
Also Published As
Publication number | Publication date |
---|---|
CN113075932A (zh) | 2021-07-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105216999B (zh) | 三自由度并联型矢量推进装置及具有该装置的水下机器人 | |
US9434460B1 (en) | Marine vessels and systems for laterally maneuvering marine vessels | |
US20220161911A1 (en) | Underwater robot, and method and apparatus for controlling the same | |
CN110758689A (zh) | 仿生机器鱼 | |
Yu et al. | A framework for biomimetic robot fish's design and its realization | |
WO2021139578A1 (zh) | 水下潜航器及其控制方法 | |
CN103754344A (zh) | 一种新型水下航行器并联矢量推进器结构及姿态确定方法 | |
CN103129729A (zh) | 一种挖泥船动力定位系统推力分配的寻优方法 | |
KR20190108353A (ko) | 수중 이동장치 | |
CN109850105B (zh) | 一种水下机器人驱动装置 | |
CN211731773U (zh) | 一种全自由度的水下潜航器 | |
CN106585936A (zh) | 一种水下航行器的仿生推进装置 | |
CN113075932B (zh) | 一种基于3-rps并联机构的uuv矢量推进控制方法 | |
CN113296524B (zh) | 水下仿生球形/半球形机器人的推力矢量分配优化方法 | |
CN113968326A (zh) | 一种矢量框架式水下机器人 | |
CN113296505B (zh) | 一种基于速变los的无人船多模式路径跟踪控制方法 | |
CN117465641A (zh) | 一种基于矢量喷口控制的三推进器水下机器人 | |
CN110937093A (zh) | 一种水下装备矢量推进器 | |
CN209972747U (zh) | 一种水下机器人 | |
CN211336395U (zh) | 一种水下装备矢量推进器 | |
CN113148076B (zh) | 一种水下仿生球形/半球形机器人及其运动控制方法 | |
CN208439409U (zh) | 一种单旋翼涵道水下无人航行器 | |
An et al. | Underwater Motion Characteristics Evaluation of a Bio-inspired Father-son Robot | |
CN220374734U (zh) | 一种水下机器人 | |
KR102134402B1 (ko) | 수중 이동체 |
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 |