CN112540534A - 一种舰载大负载并联稳定平台的控制方法 - Google Patents
一种舰载大负载并联稳定平台的控制方法 Download PDFInfo
- Publication number
- CN112540534A CN112540534A CN201910890461.3A CN201910890461A CN112540534A CN 112540534 A CN112540534 A CN 112540534A CN 201910890461 A CN201910890461 A CN 201910890461A CN 112540534 A CN112540534 A CN 112540534A
- Authority
- CN
- China
- Prior art keywords
- platform
- parallel
- attitude
- load
- stable platform
- 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 18
- 239000011159 matrix material Substances 0.000 claims abstract description 7
- 230000033001 locomotion Effects 0.000 claims description 8
- 238000005096 rolling process Methods 0.000 claims description 8
- 230000000087 stabilizing effect Effects 0.000 claims description 4
- 238000011217 control strategy Methods 0.000 claims description 3
- 238000005259 measurement Methods 0.000 claims description 3
- 230000008878 coupling Effects 0.000 abstract description 3
- 238000010168 coupling process Methods 0.000 abstract description 3
- 238000005859 coupling reaction Methods 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 4
- 230000006641 stabilisation Effects 0.000 description 2
- 238000011105 stabilization Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
- 238000013519 translation Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0875—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted to water vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提出的一种舰载大负载并联稳定平台的控制方法,通过将并联平台作为一个整体,直接对负载安装面的姿态进行稳定控制,不单独对各电动缸进行位置控制,可避免由于各缸性能不一致、负载不平衡等原因对稳定精度的影响。本发明通过下述方法予以实现:姿态传感器感知负载安装面的当前姿态传送给稳定平台控制器;控制器将当前姿态与目标姿态取差,并对误差量进行细分,然后分别对姿态各方向进行控制,得到一个耦合控制量;建立并联平台的雅可比矩阵,对耦合控制量进行解耦,得到各电动缸的速度控制量;伺服驱动器执行速度控制量驱动电动缸运动,姿态传感器感知平台新的姿态传送给控制器,周而复始,直至当前姿态与目标姿态相同。
Description
技术领域
本发明关于一种舰载大负载并联稳定平台的控制方法,涉及舰载并联稳定平台的控制,其结果可推广应用于车载、机载等并联稳定平台的控制。
背景技术
舰船在航行过程中,由于受到风浪等环境条件的作用,会产生横摇、纵摇、艏摇、横荡、纵荡、垂荡等运动,这种运动对舰船上各种仪器设备的工作精度带来了严重影响。稳定平台能隔离船体的运动,为舰载仪器设备提供一个稳定的工作平台,在舰载设备中得到了广泛的应用。传统的稳定平台一般为串联结构,应用在大负载场合存在平台本体过重、驱动力小、控制困难等难以克服的问题。并联结构的稳定平台具有刚度高、强承载能力等特点,已越来越多的应用于大负载设备的稳定控制,通常采用六自由度并联机构作为并联稳定平台。
目前并联稳定平台的控制方法一般都采用基于关节空间的单自由度进行设计,即由稳定控制器根据姿态传感器反馈数据计算控制量,由并联平台的位置反解计算各缸的位置运动量,控制各缸实现位置协同运动,达到稳定的目的。由于并联平台各缸性能不一致、负载不平衡等原因,这种控制方法想要实现各缸的精确同步运动,达到高精度稳定控制有较大难度。因此,本发明提出采用一种位姿大闭环的并联平台稳定控制策略,将并联平台作为一个整体,直接对平台负载安装面的姿态进行闭环稳定控制,不再对各关节空间进行单自由度位置控制。
发明内容
本发明提出的一种舰载大负载并联稳定平台的控制方法,是采用一种位姿大闭环的稳定控制策略,通过将并联平台作为一个整体,直接对平台负载安装面的姿态进行闭环稳定控制,实现舰载稳定平台的大负载、高精度稳定控制。
采用本发明实现的控制系统由姿态传感器、稳定平台控制器、伺服驱动器、以及并联平台等组成。并联平台采用六自由度并联平台,姿态传感器采用MEMS惯性测量单元;稳定平台控制器采用可编程运动控制器;伺服驱动器采用速度闭环控制。稳定平台控制器通过高速串口与姿态传感器连接,通过EtherCAT总线与伺服驱动器连接。
本发明的目的是这样达到的:首先将姿态传感器安装于并联平台的负载安装面上,姿态传感器感知负载安装面的当前姿态角(横摇角θx、纵摇角θy和艏摇角θz),通过高速串口以4ms的周期传送给稳定平台控制器;稳定平台控制器将当前姿态角(θx、θy、θz)与目标姿态角(θxd、θyd、θzd)取差,得到误差量ex、ey、ez,并以1ms的伺服周期对误差量进行细分,得到每个伺服周期误差量e′x、e′v、e′z,然后分别对横摇、纵摇和艏摇三个方向进行闭环稳定控制,得到各个方向的目标速度控制量ux、uy、uz;建立并联平台的雅可比矩阵J,对横摇、纵摇和艏摇的耦合速度控制量进行解耦,得到各个电动缸的目标速度控制量v1、v2、v3、v4、v5、v6;将各个电动缸的目标速度量通过EtherCAT总线传输给伺服驱动器,伺服驱动器执行目标速度量驱动电动缸运动,姿态传感器感知负载安装面新的姿态角传送给稳定平台控制器,周而复始,直至当前姿态角与目标姿态角相等。
本发明所提出的一种舰载大负载并联稳定平台的控制方法具有如下有益效果:该控制方法不再单独对各电动缸进行位置闭环控制,可避免由于各电动缸性能不一致、负载不平衡等原因对稳定精度的影响,具有承载能力强、稳定精度高、控制简单、易于工程实现等特点。
受限于姿态传感器的性能限制,本发明主要针对横摇、纵摇和艏摇进行稳定控制,但并不因此将本发明限制在所述的实施例范围之中,发明结果可推广应用于横荡、纵荡、垂荡等多方向的稳定控制。
附图说明
图1是采用本发明实现的并联稳定平台控制系统组成图。
图2是采用本发明实现的并联稳定平台控制系统结构框图。
图3是本发明实现的控制流程图。
图4是六自由度并联平台组成及坐标示意图。
以下结合附图进一步说明本发明。
具体实施方式
参阅图1、图4。采用本发明实现的并联稳定平台控制系统组成包括姿态传感器、稳定平台控制器、伺服驱动器、以及并联平台台体等组成部分。并联平台台体为六自由度并联平台,其下平台与船体固连,上平台为负载安装面;姿态传感器为MEMS惯性测量单元,安装于并联平台的上平台,即负载安装面处,可感知负载安装面的横摇、纵摇和艏摇角度,数据输出周期为4ms,数据输出接口为高速串口;稳定平台控制器负责接收姿态传感器数据,进行处理、细分、控制、解耦后通过EtherCAT总线输出控制量给伺服驱动器,控制器伺服周期为1ms;伺服驱动器采用速度闭环控制,接收执行控制器输出的控制量,驱动电动缸运动,电动缸带动负载安装面运动。
参阅图1、图2、图3(第1步)。按照流程,本发明首先通过姿态传感器感知并联平台负载安装面当前姿态角(横摇角θx、纵摇角θy和艏摇角θz),以4ms的周期传送给稳定平台控制器。
参阅图2、图3(第2步)。稳定平台控制器将当前姿态角(θx、θy、θz)与目标姿态角(θxa、θyd、θzd)取差,得到误差量:
ex=θxa-θx、ey=θyd-θy、ez=θzd-θz
稳定平台控制器的伺服周期为1ms,按照控制器的伺服周期对误差量进行细分,得到每个伺服周期误差量:
e′x=ex*0.25、e′y=ey*0.25、e′z=ez*0.25
参阅图2、图3(第3步)。稳定平台控制器分别对横摇、纵摇和艏摇三个方向进行闭环稳定控制,得到三个方向的目标速度控制量:
ux=Gx*e′x、uy=Gy*e′y、uz=Gz*e′z
式中Gx、Gy、Gz分别为横摇、纵摇和艏摇的PID控制器。
参阅图2、图3(第4步)、图4。Ai、Bi分别为下平台和上平台铰点,O、P为上下平台中心点,建立并联平台的雅可比矩阵,上平台铰点Bi处的速度矢量VBi可表示为:
VBi=ωp×Rbi+Vp,i=1,…,6
式中Rbi为Bi在上平台坐标系中的矢量,ωp、Vp分别是上平台中心点在下平台坐标系中的角速度和线速度矢量,将VBi向Bi→Ai方向投影,得到沿电动缸方向的相对移动速度vi:
vi=ei·VBi=(Rbi×ei)·ωp+ei·Vp,i=1,…,6
式中ei为沿电动缸i的单位矢量,将式中的六个方程联立起来写成统一矩阵的形式:
式中的J为并联平台的雅可比矩阵,它是上平台速度到电动缸速度的映射。
参阅图2、图3(第4步)。使用并联平台的雅可比矩阵对横摇、纵摇和艏摇的耦合速度控制量进行解耦,得到各个电动缸的目标速度控制量:
[v1 v2 v3 v4 v5 v6]T=J[0 0 0 ux uy uz]T
式中横荡、纵荡、垂荡三个平移方向的线速度均设定为0。
参阅图2、图3(第5步)。稳定平台控制器将六个电动缸的目标速度量v1、v2、v3、v4、v5、v6通过EtherCAT总线传输给伺服驱动器,伺服驱动器执行目标速度量驱动电动缸运动,姿态传感器感知负载安装面新的姿态角传送给稳定平台控制器,周而复始,直至当前姿态角与目标姿态角相等。
Claims (6)
1.一种舰载大负载并联稳定平台的控制方法,其特征在于:采用一种位姿大闭环的稳定控制策略,通过将并联平台作为一个整体,直接对平台负载安装面的姿态进行闭环稳定控制,实现舰载稳定平台的大负载、高精度稳定控制。
2.根据权利要求1所述的一种舰载大负载并联稳定平台的控制方法,其特征在于:控制系统由姿态传感器、稳定平台控制器、伺服驱动器、以及并联平台等组成。并联平台采用六自由度并联平台,姿态传感器采用MEMS惯性测量单元;稳定平台控制器采用可编程运动控制器;伺服驱动器采用速度闭环控制。稳定平台控制器通过高速串口与姿态传感器连接,通过EtherCAT总线与伺服驱动器连接。
3.根据权利要求1所述的一种舰载大负载并联稳定平台的控制方法,其特征在于:姿态传感器安装于并联平台的负载安装面上,姿态传感器感知负载安装面的当前姿态角(横摇角θx、纵摇角θy和艏摇角θz),通过高速串口以4ms的周期传送给稳定平台控制器。
4.根据权利要求1所述的一种舰载大负载并联稳定平台的控制方法,其特征在于:稳定平台控制器将当前姿态角(θx、θy、θz)与目标姿态角(θxd、θyd、θzd)取差,得到误差量ex、ey、ez,并以1ms的伺服周期对误差量进行细分,得到每个伺服周期误差量e′x、e′y、e′z,然后分别对对横摇、纵摇和艏摇三个方向进行闭环稳定控制,得到各个方向的目标速度控制量ux、uy、uz。
5.根据权利要求1所述的一种舰载大负载并联稳定平台的控制方法,其特征在于:建立并联平台的雅可比矩阵J,对横摇、纵摇和艏摇的耦合速度控制量进行解耦,得到各个电动缸的目标速度控制量v1、v2、v3、v4、v5、v6。
6.根据权利要求1所述的一种舰载大负载并联稳定平台的控制方法,其特征在于:将各个电动缸的目标速度控制量通过EtherCAT总线传输给伺服驱动器,伺服驱动器执行目标速度量驱动电动缸运动,姿态传感器感知负载安装面新的姿态角传送给稳定平台控制器,周而复始,直至当前姿态角与目标姿态角相等。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910890461.3A CN112540534A (zh) | 2019-09-20 | 2019-09-20 | 一种舰载大负载并联稳定平台的控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910890461.3A CN112540534A (zh) | 2019-09-20 | 2019-09-20 | 一种舰载大负载并联稳定平台的控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112540534A true CN112540534A (zh) | 2021-03-23 |
Family
ID=75012250
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910890461.3A Pending CN112540534A (zh) | 2019-09-20 | 2019-09-20 | 一种舰载大负载并联稳定平台的控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112540534A (zh) |
Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5492312A (en) * | 1995-04-17 | 1996-02-20 | Lord Corporation | Multi-degree of freedom magnetorheological devices and system for using same |
US20010013927A1 (en) * | 1997-12-26 | 2001-08-16 | Hiroshi Itoh | Stage apparatus, exposure apparatus using the same, and a device manufacturing method |
CN202428439U (zh) * | 2012-01-13 | 2012-09-12 | 河南科技大学 | 三自由度移动并联机器人机构 |
CN103862458A (zh) * | 2012-12-11 | 2014-06-18 | 天津工业大学 | 一种用于机载伺服系统的六自由度并联平台 |
CN104731107A (zh) * | 2015-03-26 | 2015-06-24 | 北京特种机械研究所 | 一种电动六自由度运动平台高精度控制系统及控制方法 |
CA2895123A1 (en) * | 2014-07-15 | 2016-01-15 | Soc Robotics Inc. | Motion system with plurality of stewart platform based actuators |
CN105751200A (zh) * | 2014-12-05 | 2016-07-13 | 济南鲁智电子科技有限公司 | 全液压自主移动机械臂的动作方法 |
CN106695759A (zh) * | 2016-12-13 | 2017-05-24 | 九江精密测试技术研究所 | 一种具有对称混联分支的三自由度并联稳定平台 |
CN206426085U (zh) * | 2016-12-13 | 2017-08-22 | 九江精密测试技术研究所 | 一种具有对称混联分支的三自由度并联稳定平台 |
CN206748409U (zh) * | 2017-04-13 | 2017-12-15 | 哈尔滨工程大学 | 九自由度串并混联稳定平台 |
CN107498541A (zh) * | 2017-09-20 | 2017-12-22 | 北京航空航天大学 | 一种两平动一转动三自由度并联机构 |
CN107618632A (zh) * | 2017-07-19 | 2018-01-23 | 湖南工程学院 | 用于海上风电运维船的六自由度稳定装置及风电运维船 |
CN108155480A (zh) * | 2017-12-25 | 2018-06-12 | 西安电子科技大学 | 一种多波束天线调整平台及其控制系统与方法 |
CN109002658A (zh) * | 2018-09-06 | 2018-12-14 | 成都泛美视界科技有限公司 | 六自由度并联机构运动速度算法优化及速率提升方法 |
CN110039542A (zh) * | 2019-06-13 | 2019-07-23 | 东北大学 | 具有速度方向控制的视觉伺服跟踪控制方法及机器人系统 |
-
2019
- 2019-09-20 CN CN201910890461.3A patent/CN112540534A/zh active Pending
Patent Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5492312A (en) * | 1995-04-17 | 1996-02-20 | Lord Corporation | Multi-degree of freedom magnetorheological devices and system for using same |
US20010013927A1 (en) * | 1997-12-26 | 2001-08-16 | Hiroshi Itoh | Stage apparatus, exposure apparatus using the same, and a device manufacturing method |
CN202428439U (zh) * | 2012-01-13 | 2012-09-12 | 河南科技大学 | 三自由度移动并联机器人机构 |
CN103862458A (zh) * | 2012-12-11 | 2014-06-18 | 天津工业大学 | 一种用于机载伺服系统的六自由度并联平台 |
CA2895123A1 (en) * | 2014-07-15 | 2016-01-15 | Soc Robotics Inc. | Motion system with plurality of stewart platform based actuators |
CN105751200A (zh) * | 2014-12-05 | 2016-07-13 | 济南鲁智电子科技有限公司 | 全液压自主移动机械臂的动作方法 |
CN104731107A (zh) * | 2015-03-26 | 2015-06-24 | 北京特种机械研究所 | 一种电动六自由度运动平台高精度控制系统及控制方法 |
CN106695759A (zh) * | 2016-12-13 | 2017-05-24 | 九江精密测试技术研究所 | 一种具有对称混联分支的三自由度并联稳定平台 |
CN206426085U (zh) * | 2016-12-13 | 2017-08-22 | 九江精密测试技术研究所 | 一种具有对称混联分支的三自由度并联稳定平台 |
CN206748409U (zh) * | 2017-04-13 | 2017-12-15 | 哈尔滨工程大学 | 九自由度串并混联稳定平台 |
CN107618632A (zh) * | 2017-07-19 | 2018-01-23 | 湖南工程学院 | 用于海上风电运维船的六自由度稳定装置及风电运维船 |
CN107498541A (zh) * | 2017-09-20 | 2017-12-22 | 北京航空航天大学 | 一种两平动一转动三自由度并联机构 |
CN108155480A (zh) * | 2017-12-25 | 2018-06-12 | 西安电子科技大学 | 一种多波束天线调整平台及其控制系统与方法 |
CN109002658A (zh) * | 2018-09-06 | 2018-12-14 | 成都泛美视界科技有限公司 | 六自由度并联机构运动速度算法优化及速率提升方法 |
CN110039542A (zh) * | 2019-06-13 | 2019-07-23 | 东北大学 | 具有速度方向控制的视觉伺服跟踪控制方法及机器人系统 |
Non-Patent Citations (2)
Title |
---|
S. IQBAL等: "Design and robustness evaluation of an H∞ loop shaping controller for a 2DOF stabilized platform" * |
赵裕明,等: "含有冗余支链的3-RPS/3n-SPS并联机构逆动力学建模" * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111045438B (zh) | 一种船载自稳平台及其控制系统和方法 | |
CN106737659B (zh) | 一种水下无人航行器和机械手系统的手艇协调控制方法 | |
CN109765892B (zh) | 一种无人船集群的碰撞自规避编队控制器结构及设计方法 | |
Skjetne et al. | Modeling, identification, and adaptive maneuvering of Cybership II: A complete design with experiments | |
Ihle et al. | Formation control of marine surface craft: A Lagrangian approach | |
CN103942383B (zh) | 一种深海作业型水下机器人的动力学和运动学估计方法 | |
CN112148022B (zh) | 全驱动自主水下机器人回收三维路径跟踪控制系统及方法 | |
CN102774481B (zh) | 用于支撑舰首炮的并联机构平台装置 | |
CN105425812B (zh) | 一种基于双模型下的无人机自动着舰轨迹控制方法 | |
CN110531776B (zh) | 基于自抗扰控制技术的四旋翼飞行器位置控制方法和系统 | |
Hegrenaes et al. | Comparison of mathematical models for the HUGIN 4500 AUV based on experimental data | |
CN113419428B (zh) | 基于3d映射制导的机/船协同路径跟踪控制器设计方法 | |
CN111037542B (zh) | 一种逆动力学控制机器人直线加工的轨迹误差补偿方法 | |
CN111857165B (zh) | 一种水下航行器的轨迹跟踪控制方法 | |
CN107656530B (zh) | 变参数开架式海洋水下机器人的轨迹跟踪控制方法、装置和系统 | |
CN109240289B (zh) | 波浪滑翔器艏摇信息自适应滤波方法 | |
CN107102653B (zh) | 一种控制无人机的挂载设备对地角度的装置和方法 | |
CN108445753B (zh) | 用于平衡侧向力和抑制无人机侧向反推力的方法 | |
CN110895418B (zh) | 补偿舵机动力学滞后的低速旋转飞行器控制方法及系统 | |
AU2017331880B2 (en) | Underwater Sailing Body and Method of Controlling Posture of Underwater Sailing Body | |
CN112373042A (zh) | 一种五轴3d打印机位姿的监控方法及系统 | |
CN108303870A (zh) | 一种多自由度位移变化补偿平台的控制方法、控制系统 | |
CN114089634A (zh) | 一种基于多电机主从轴协同算法的水下机器人控制方法 | |
CN112540534A (zh) | 一种舰载大负载并联稳定平台的控制方法 | |
CN112180915A (zh) | 基于ros的双推力无人船运动控制系统及控制方法 |
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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20210323 |