CN101916117B - 潜器全方位推进器多油缸协调运动控制方法 - Google Patents
潜器全方位推进器多油缸协调运动控制方法 Download PDFInfo
- Publication number
- CN101916117B CN101916117B CN2010102215067A CN201010221506A CN101916117B CN 101916117 B CN101916117 B CN 101916117B CN 2010102215067 A CN2010102215067 A CN 2010102215067A CN 201010221506 A CN201010221506 A CN 201010221506A CN 101916117 B CN101916117 B CN 101916117B
- Authority
- CN
- China
- Prior art keywords
- hydraulic cylinder
- deviation
- submersible
- hydraulic
- signal
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Feedback Control In General (AREA)
- Control Of Presses (AREA)
Abstract
本发明提供的是一种潜器全方位推进器多油缸协调运动控制方法。待液压系统初始化完成后,控制器将光栅尺数据清零;潜器全方位推进器控制器解算出斜盘位移和倾斜角度,同时转换为每个液压缸需要的位移长度,并以移动量最小的液压缸为基准将其作为主液压缸,其他为从缸;光栅尺检测的偏差信号经偏差反馈补偿因子,作为油缸协调补偿网络的输入信号,通过控制器实时调整补偿、比例因子来;得到对另一个油缸的补偿指令信号,并将指令信号输入该套液压伺服系统,形成闭环反馈控制。本发明为多液压缸协调运动的实现提供了一种普遍适用的新途径;能改善螺旋浆系统的水动力性能和潜器全方位推进器的操纵性能;具有较强的鲁棒性。
Description
技术领域
本发明涉及的是一种海洋水下潜器推进器控制方法,具体是一种潜器全方位推进器操纵控制方法。
背景技术
在海洋开发和海洋工程中,由于潜器要执行各种复杂的使命,因而它应具备良好的操纵性能,同时随着海洋开发的深入发展,潜器的潜水深度不断增加,潜器的组成机构趋于大型化,总重量增加,总体规模变大,在使用方面受到的制约也变多。
潜器全方位推进器,又名变矢量螺旋桨,是一种在桨叶旋转一周的过程中,叶片螺距角作周期性变化的特种推进器,这样不仅可以在与桨轴平行的轴向产生推力,也能在与桨轴垂直的横向和垂向产生推力。全方位推进器主要是通过对旋转斜盘的控制改变螺距使螺旋桨产生各个方位的推力,推动水下潜器产生六个方位的运动从而达到全方位推进的目的。
旋转斜盘三自由度运动采用电液伺服系统驱动方式,液压缸既是支撑机构,又是驱动机构。旋转斜盘内环固定,外环的运动规律和位姿是通过控制三个液压缸的伸缩运动和位移来实现的,每个驱动支路都是单输入的电液伺服系统。外环与三个液压缸通过刚性万向头连接,三个液压缸的伸缩运动量受外环平面约束,需要协调控制液压缸的相对运动达到旋转斜盘姿态变化要求。全方位推进器多油缸协调控制对于设备运行的安全性、可靠性极其重要。
经对现有的技术文献检索发现,主要集中在多液压缸同步运动控制。没有发现与本发明主题相同或类似的文献报道。
发明内容
本发明的目的在于提供一种能够提高多液压缸协调运动的精度和灵敏度的潜器全方位推进器多油缸协调运动控制方法。
本发明的目的是这样实现的:
待液压系统初始化完成后,控制器将光栅尺数据清零系统开始正常工作;潜器全方位推进器控制器根据潜器运动要求,解算出斜盘位移和倾斜角度,同时转换为每个液压缸需要的位移长度,并以移动量最小的液压缸为基准将其作为主液压缸,其他为从缸;光栅尺检测的偏差信号经偏差反馈补偿因子,作为油缸协调补偿网络的输入信号,液压油缸协调运动偏差补偿网络采用PID控制器实现,通过控制器实时调整补偿、比例因子来;得到对另一个油缸的补偿指令信号,并将指令信号输入该套液压伺服系统,形成闭环反馈控制。
本发明的原理为:启动液压泵,给电液伺服阀正电压,液压缸归位,将反映三个液压缸位移位的光栅尺数据清零,关闭电液伺服阀,完成液压部分的初始化工作;潜器全方位推进器姿态控制系统根据推进器的运动要求,确定叶片螺距角,控制器解算出斜盘的位移和倾斜角度及每个液压缸需要的位移长度,并标定出需要伸缩移动量最小的液压缸为基准,将其作为主液压缸,其它两液压缸为从缸;由于三个液压缸存在位移差,在满足平面约束的情况下,引入偏差反馈补偿因子,通过光栅尺反馈信息检测两个液压缸位移的实际偏差,偏差信号经偏差反馈补偿因子,作为油缸协调补偿网络的输入信号;经补偿网络处理后,得到对另一个油缸的补偿指令信号,并将指令信号输入该套液压伺服系统,形成闭环反馈控制,达到消除两液压油缸的运动偏差,保证三液压缸能够协调运动。
液压油缸协调运动偏差补偿网络采用一种简单PID控制器实现,其物理意义明确。当三液压缸出现运动偏差时,补偿网络能够及时修正位移偏差,提高三液压缸协调运动的精度和灵敏度,对于超过三缸的液压伺服协调运动控制系统,该方法同样有效。
本发明的优点在于:
(1)采用多油缸协调控制代替传统的机械约束,满足了某些特殊条件下对多液压缸协调运动的需求,为多液压缸协调运动的实现提供了一种普遍适用的新途径;
(2)采用液压油缸协调运动偏差网络,使多油缸在运动过程中满足约束要求,从而改善螺旋浆系统的水动力性能和潜器全方位推进器的操纵性能;
(3)通过偏差反馈补偿因子和PID控制器设计,偏差反馈补偿网络可通过控制器来实时调整其量化、比例因子来提高控制精度,有效提高伺服精度,降低运动偏差,具有较强的鲁棒性。
附图说明
图1是潜器全方位推进器多油缸协调控制流程图;
图2是潜器全方位推进器多油缸协调控制原理结构图。
具体实施方式
下面结合附图举例对本发明做更详细地描述:
结合图1,本发明的工作流程为:系统启动时,首先从将液压系统初始化,待液压系统初始化完成后,控制器将光栅尺数据清零系统开始正常工作;潜器全方位推进器控制器根据潜器运动要求,解算出斜盘位移和倾斜角度,同时转换为每个液压缸需要的位移长度,并移动量最小的液压缸为基准,将其作为主液压缸,其他为从缸;由于斜盘上刚性连接的液压缸受满足平面约束,因此引入偏差反馈补偿因子,消除运动过程中的偏差反馈时数据不一致问题;偏差信号经偏差反馈补偿因子,作为油缸协调补偿网络的输入信号,液压油缸协调运动偏差补偿网络采用PID控制器实现,可通过控制器来实时调整其补偿、比例因子来提高控制精度;得到对另一个油缸的补偿指令信号,并将指令信号输入该套液压伺服系统,形成闭环反馈控制,达到消除两液压油缸的运动偏差;同理,其它也与主缸为基准,运动过程的控制方法相同。
结合图2,本发明采用光栅尺检测装置进行液压缸位移实时反馈,基于PID液压油缸协调运动偏差补偿网络闭环控制方案,采用主/从协调控制策略,实现多油缸的协调运动。指令位移信号L0、L1、L2分别送入H0、H1和H2液压伺服系统,通过H0、H1和H2液压缸的位移光栅尺检测装置检测得到油缸H0、H1和H2的位移量,以H0油缸为主缸,H1、H2油缸为从缸;引入偏差反馈补偿因子,其中,H1偏差反馈补偿因子为L1/L0,H2偏差反馈补偿因子为L2/L0,使运动过程中的偏差反馈时数据一致;将H1与H0油缸、H2与H0油缸位移的偏差经偏差反馈补偿因子作为输入信号送入PID协调运动补偿网络,然后将补偿网络的输出信号分别送入H1、H2液压伺服系统,实现对多油缸协调运动补偿控制,达到消除H1和H2与H0油缸的运动偏差,保证多油缸能够协调运动,同理,若增加其它油缸,控制方法与上述方法相同。
Claims (1)
1.一种潜器全方位推进器多液压缸协调运动控制方法,其特征是:待液压伺服系统初始化完成后,控制器将光栅尺数据清零;潜器全方位推进器控制器根据潜器运动要求,解算出斜盘位移和倾斜角度,同时转换为每个液压缸需要的位移长度,并以移动量最小的液压缸为基准将其作为主液压缸,其他为从液压缸;从液压缸光栅尺检测得到的偏差信号经偏差反馈补偿因子调整为满足平面约束的从液压缸位移偏差信号,作为液压缸协调运动偏差补偿网络的输入信号,液压缸协调运动偏差补偿网络采用PID控制器实现,通过运动偏差补偿网络实时调整补偿、比例因子来产生从液压缸相对主液压缸的运动偏差补偿指令信号;相应的液压伺服系统得到对从液压缸的补偿指令信号,并将指令信号输入该套液压伺服系统,形成闭环反馈控制;所述偏差反馈补偿因子为从液压缸指令位移信号/主液压缸指令位移信号。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010102215067A CN101916117B (zh) | 2010-07-09 | 2010-07-09 | 潜器全方位推进器多油缸协调运动控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010102215067A CN101916117B (zh) | 2010-07-09 | 2010-07-09 | 潜器全方位推进器多油缸协调运动控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101916117A CN101916117A (zh) | 2010-12-15 |
CN101916117B true CN101916117B (zh) | 2012-02-01 |
Family
ID=43323643
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2010102215067A Expired - Fee Related CN101916117B (zh) | 2010-07-09 | 2010-07-09 | 潜器全方位推进器多油缸协调运动控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101916117B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102426418B (zh) * | 2011-09-29 | 2013-06-05 | 哈尔滨工程大学 | 潜器全方位推进器单通道电液位置伺服控制方法 |
CN108279661B (zh) * | 2017-12-19 | 2019-09-24 | 广东精铟海洋工程股份有限公司 | 一种六自由度位移变化补偿平台的调试方法 |
CN108303870B (zh) * | 2017-12-19 | 2019-09-24 | 广东精铟海洋工程股份有限公司 | 一种多自由度位移变化补偿平台的控制方法、控制系统 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3983834A (en) * | 1973-07-23 | 1976-10-05 | Georg Hirmann | Propulsion system for watercraft and the like |
EP0385827A1 (fr) * | 1989-02-28 | 1990-09-05 | Societe Eca | Dispositif de propulsion pour véhicule sous-marin |
US7150662B1 (en) * | 2005-01-05 | 2006-12-19 | Brunswick Corporation | Watercraft docking system and propulsion assembly |
CN101024419A (zh) * | 2007-01-19 | 2007-08-29 | 哈尔滨工程大学 | 潜器全方位推进器控制装置 |
-
2010
- 2010-07-09 CN CN2010102215067A patent/CN101916117B/zh not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3983834A (en) * | 1973-07-23 | 1976-10-05 | Georg Hirmann | Propulsion system for watercraft and the like |
EP0385827A1 (fr) * | 1989-02-28 | 1990-09-05 | Societe Eca | Dispositif de propulsion pour véhicule sous-marin |
US7150662B1 (en) * | 2005-01-05 | 2006-12-19 | Brunswick Corporation | Watercraft docking system and propulsion assembly |
CN101024419A (zh) * | 2007-01-19 | 2007-08-29 | 哈尔滨工程大学 | 潜器全方位推进器控制装置 |
Non-Patent Citations (1)
Title |
---|
Liu Sheng et al.The Cooperative Motion Control of Forward and aft Variable Vector Propeller of Ocean Submarine.《Proceedings of the 2007 IEEE International Conference on Mechatronics and Automation》.2007,232-237. * |
Also Published As
Publication number | Publication date |
---|---|
CN101916117A (zh) | 2010-12-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101808893B (zh) | 在高速范围内船舶的表面驱动装置的控制方法 | |
CN101916117B (zh) | 潜器全方位推进器多油缸协调运动控制方法 | |
CN106438591A (zh) | 土压平衡盾构机比例控制高精度推进液压系统及控制方法 | |
CN206171736U (zh) | 一种可变形半潜式无人船 | |
CN102079482B (zh) | 起重机及其复合动作的控制方法、控制器 | |
CN101542131A (zh) | 工程机械的泵控制装置 | |
CN202707069U (zh) | 盾构机及其推进液压系统 | |
CN110126990B (zh) | 一种用于水下机器人和水面高速无人艇的投放装置 | |
CN100540395C (zh) | 潜器全方位推进器控制装置 | |
CN103949894A (zh) | 一种机床开式液体静压导轨油膜厚度控制装置及系统 | |
CN102493517A (zh) | 液压混合动力挖掘机回转系统及该回转系统的驱动和制动方法 | |
CN111959704A (zh) | 海洋渔获物船载加工设备海浪补偿系统 | |
CN103204231A (zh) | 可伸缩全回转推进器 | |
CN1247280A (zh) | 建筑机械的发动机转速控制系统 | |
CN104641111A (zh) | 一种用于泵排放压力控制的电动液压控制设计 | |
CN103626068A (zh) | 一种水下机器人主动升沉补偿系统 | |
CN112125194B (zh) | 海洋钻井补偿绞车的节能驱动系统 | |
CN105452101A (zh) | 桨距角指示器系统 | |
Liu et al. | Trajectory control of tunnel boring machine based on adaptive rectification trajectory planning and multi-cylinders coordinated control | |
CN107499486B (zh) | 一种定位用智能水上移动平台及其定位方法 | |
CN104554677B (zh) | 一种稳定下潜装置及具有该装置的水下无人潜航器 | |
CN208915362U (zh) | 一种船载自适应稳定平台 | |
CN204568036U (zh) | 一种稳定下潜装置及具有该装置的水下无人潜航器 | |
CN107943124B (zh) | 一种带位置/力双向反馈的主从式人工肌肉关节系统 | |
CN206856945U (zh) | 海洋科学考察船a型架横梁滑动机构 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20120201 Termination date: 20170709 |