[go: up one dir, main page]

CN114735140B - Disturbance speed compensation method, equipment and medium for wind power pile boarding trestle bridge - Google Patents

Disturbance speed compensation method, equipment and medium for wind power pile boarding trestle bridge Download PDF

Info

Publication number
CN114735140B
CN114735140B CN202210380956.3A CN202210380956A CN114735140B CN 114735140 B CN114735140 B CN 114735140B CN 202210380956 A CN202210380956 A CN 202210380956A CN 114735140 B CN114735140 B CN 114735140B
Authority
CN
China
Prior art keywords
formula
increment
disturbance
control
value
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
Application number
CN202210380956.3A
Other languages
Chinese (zh)
Other versions
CN114735140A (en
Inventor
张松涛
宋吉广
梁利华
史洪宇
吉明
王经甫
杨生
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Harbin Harbin Ship Rolling Reduction Automation Equipment Co ltd
Harbin Engineering University
Original Assignee
Harbin Harbin Ship Rolling Reduction Automation Equipment Co ltd
Harbin Engineering University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Harbin Harbin Ship Rolling Reduction Automation Equipment Co ltd, Harbin Engineering University filed Critical Harbin Harbin Ship Rolling Reduction Automation Equipment Co ltd
Priority to CN202210380956.3A priority Critical patent/CN114735140B/en
Publication of CN114735140A publication Critical patent/CN114735140A/en
Application granted granted Critical
Publication of CN114735140B publication Critical patent/CN114735140B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B63SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63BSHIPS OR OTHER WATERBORNE VESSELS; EQUIPMENT FOR SHIPPING 
    • B63B27/00Arrangement of ship-based loading or unloading equipment for cargo or passengers
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B63SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63BSHIPS OR OTHER WATERBORNE VESSELS; EQUIPMENT FOR SHIPPING 
    • B63B17/00Vessels parts, details, or accessories, not otherwise provided for
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B63SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63BSHIPS OR OTHER WATERBORNE VESSELS; EQUIPMENT FOR SHIPPING 
    • B63B17/00Vessels parts, details, or accessories, not otherwise provided for
    • B63B2017/0072Seaway compensators
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02EREDUCTION OF GREENHOUSE GAS [GHG] EMISSIONS, RELATED TO ENERGY GENERATION, TRANSMISSION OR DISTRIBUTION
    • Y02E10/00Energy generation through renewable energy sources
    • Y02E10/70Wind energy
    • Y02E10/72Wind turbines with rotation axis in wind direction
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02EREDUCTION OF GREENHOUSE GAS [GHG] EMISSIONS, RELATED TO ENERGY GENERATION, TRANSMISSION OR DISTRIBUTION
    • Y02E10/00Energy generation through renewable energy sources
    • Y02E10/70Wind energy
    • Y02E10/727Offshore wind turbines

Landscapes

  • Chemical & Material Sciences (AREA)
  • Engineering & Computer Science (AREA)
  • Combustion & Propulsion (AREA)
  • Mechanical Engineering (AREA)
  • Ocean & Marine Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Feedback Control In General (AREA)

Abstract

The invention provides a method, equipment and medium for compensating the interference speed of a wind power pile boarding trestle. According to the method, the interference speed (ship motion speed) compensation mode is introduced and is combined with the interference position compensation, so that the rapidity and the compensation effect of the active motion compensation trestle are improved, the use experience of the trestle lapping process is improved, the accessibility of the wind power pile in severe weather is improved, and the safety of passengers is improved.

Description

一种风电桩登乘栈桥的干扰速度补偿方法、设备和介质Disturbance speed compensation method, equipment and medium for wind power pile boarding trestle bridge

技术领域technical field

本发明属于具有波浪补偿功能的海上风电登乘栈桥技术领域,特别是涉及一种风电桩登乘栈桥的干扰速度补偿方法、设备和介质。具体说是一种对船舶运动速度进行补偿,以提高运动补偿精度,实现高海况条件下栈桥顺利搭接海上风电桩的控制方法。The invention belongs to the technical field of offshore wind power boarding and boarding trestles with wave compensation function, and in particular relates to a method, equipment and medium for compensating the disturbance speed of wind power pile boarding and boarding trestles. Specifically, it is a control method for compensating the speed of the ship to improve the accuracy of the motion compensation and realize the smooth lapping of the trestle bridge under high sea conditions.

背景技术Background technique

风能是清洁的可再生能源。相比陆地风力发电,海上风电具有不占用陆地面积和对鸟类影响小等优点,此外海上风电还具有静风期少,风力大等优点。我国在近海和中远海均具有丰富的风能,发展海上风电对优化我国能源结构具有重要的意义。Wind energy is clean and renewable energy. Compared with land wind power generation, offshore wind power has the advantages of not occupying land area and having little impact on birds. In addition, offshore wind power also has the advantages of less quiet wind period and strong wind force. my country has abundant wind energy in both offshore and COSCO seas, and the development of offshore wind power is of great significance to optimize my country's energy structure.

然而,海上风电的安装和维护成本要比陆地风电高。在恶劣的天气条件下,运维船剧烈的摇晃使得运维人员登乘风电桩变得困难和危险。主动式运动补偿(Active MotionCompensation,AMC)栈桥通过补偿某几个自由度的船舶运动,使得栈桥末端相对大地坐标系(固定于大地的风电桩)保持静止或者减少海浪对船舶运动的影响,用以提高恶略天气下人员对风电桩的可达性。However, installation and maintenance costs of offshore wind power are higher than onshore wind power. In severe weather conditions, the violent shaking of the operation and maintenance ship makes it difficult and dangerous for the operation and maintenance personnel to board the wind power pile. The active motion compensation (Active Motion Compensation, AMC) trestle makes the end of the trestle stay still relative to the earth coordinate system (the wind power pile fixed on the ground) or reduces the influence of waves on the motion of the ship by compensating the ship motion of certain degrees of freedom. Improve the accessibility of personnel to wind power piles in severe weather.

三自由度AMC栈桥如图1所示,主要由(B1)底座、(B2)支座、(B3)俯仰桥、(B4) 伸缩桥和位于伸缩桥末端的(B5)插入板组成。当插入板插入风电机组平台的基础爬梯后维护人员通过支座、俯仰桥和伸缩桥到达爬梯,登上海上风电机组平台。根据安全规范要求,当运维船与海上风电机组爬梯的距离不超过成人一半的步长时,才能登乘风电平台的爬梯。然而海上潮汐和海浪的影响,会导致船舶和海上风电平台的爬梯在垂直方向和水平方向上存在一定的距离,该距离会随着船舶的摇晃而变化。The three-degree-of-freedom AMC trestle bridge is shown in Figure 1, and it is mainly composed of (B1) base, (B2) support, (B3) pitch bridge, (B4) telescopic bridge and (B5) insert plate at the end of the telescopic bridge. After the insertion plate is inserted into the foundation ladder of the wind turbine platform, maintenance personnel reach the ladder through the support, pitch bridge and telescopic bridge, and board the offshore wind turbine platform. According to the requirements of safety regulations, only when the distance between the operation and maintenance ship and the ladder of offshore wind turbines does not exceed half the step length of an adult can one board the ladder of the wind power platform. However, the impact of sea tides and waves will cause a certain distance between the ship and the ladder of the offshore wind power platform in the vertical direction and the horizontal direction, and the distance will change with the shaking of the ship.

安装在船舶上的运动测量单元,会测量船舶六个自由度的运动,通过(Y1)回转液压缸、(Y2)俯仰液压缸和(Y3)伸缩液压缸补偿船舶的首摇、纵摇和垂荡运动导致(B5) 插入板相对爬梯的位移变化。同时整个栈桥也可以保持相对稳定的状态。The motion measurement unit installed on the ship will measure the motion of the ship's six degrees of freedom, and compensate the ship's yaw, pitch and yaw through the (Y1) rotary hydraulic cylinder, (Y2) pitch hydraulic cylinder and (Y3) telescopic hydraulic cylinder The oscillating motion causes the displacement change of (B5) inserting plate relative to the ladder. At the same time, the entire trestle can also maintain a relatively stable state.

当海上风浪很小时,操作人员可以关闭主动式运动补偿功能,通过操作手柄,控制比例阀组实现对回转、俯仰和伸缩液压缸活塞杆运动速度的控制,能够顺利地使伸缩桥末端的插入板插入爬梯,完成人员通道的建立。而大风浪状态下,位于伸缩桥末端的插入板会放大船舶的摇晃,使得插入爬梯的过程变的困难。此时,需要开启主动补偿功能,消除或减小船舶摇晃对插入板影响,当操作手柄无动作时,插入板末端的坐标保持相对大地坐标系的静止或减小船舶运动的影响。为了完成主动运动补偿,需要利用运动参考单元(MotionReference Unit,MRU)测量出船舶在六个自由度的运动,进而通过转换矩阵计算出栈桥在回转自由度、俯仰自由度和伸缩自由度的补偿量,来补偿船舶在首摇、纵摇和垂荡方向的运动。为了保持插入板相对大地坐标系的静止,主动式运动补偿栈桥需要补偿船舶运动导致的插入板位置的变化,因此栈桥在回转、俯仰和伸缩三个自由度上的控制都是位置伺服系统,根据位置误差进行液压缸活塞杆伸出量的控制。然而这种补偿方式,在主动运动补偿的过程中主要存在以下问题:When the wind and waves on the sea are small, the operator can turn off the active motion compensation function, and control the proportional valve group through the operating handle to control the movement speed of the slewing, pitching and telescopic hydraulic cylinder piston rod, which can smoothly make the insertion plate at the end of the telescopic bridge Insert the ladder to complete the establishment of the personnel passage. In the case of strong wind and waves, the insertion plate at the end of the telescopic bridge will amplify the shaking of the ship, making the process of inserting the ladder difficult. At this time, it is necessary to turn on the active compensation function to eliminate or reduce the influence of the ship's shaking on the plug-in board. When the operating handle does not move, the coordinates at the end of the plug-in board remain static relative to the earth coordinate system or reduce the influence of the ship's motion. In order to complete active motion compensation, it is necessary to use the motion reference unit (MotionReference Unit, MRU) to measure the motion of the ship in six degrees of freedom, and then calculate the compensation amount of the trestle in the rotation degree of freedom, pitching degree of freedom and telescopic degree of freedom through the transformation matrix , to compensate for the motion of the ship in the yaw, pitch and heave directions. In order to keep the insertion board stationary relative to the earth coordinate system, the active motion compensation trestle needs to compensate the position change of the insertion board caused by the ship's motion, so the control of the trestle in the three degrees of freedom of rotation, pitch and telescopic is a position servo system, according to The position error is used to control the extension of the piston rod of the hydraulic cylinder. However, this compensation method mainly has the following problems in the process of active motion compensation:

(1)由于船舶运动随机性,MRU的采样延迟,液压缸运动速度的限制,栈桥安装的机械间隙等影响,在主动运动补偿栈桥工作过程中,对于相对高频的船舶运动,仅仅依靠测量的船舶位置进行补偿,会导致跟踪滞后,补偿效果欠佳。(1) Due to the randomness of ship motion, the sampling delay of MRU, the limitation of hydraulic cylinder motion speed, the mechanical clearance of trestle installation, etc., during the working process of active motion compensation trestle, for relatively high-frequency ship motion, only rely on the measured Compensating the position of the ship will cause tracking lag and the compensation effect is not good.

(2)高海况下操作手柄驱动插入板插入风电机组平台的基础爬梯过程中,仅仅将操作手柄的速度控制与主动运动补偿的位置控制进行简单叠加,不能获得与平静海面下关闭补偿功能时操作手柄过程一致的体验,操作不平顺。(2) In the process of inserting the operating handle to drive the insertion plate into the foundation ladder of the wind turbine platform under high sea conditions, only the speed control of the operating handle and the position control of active motion compensation are simply superimposed, and the operation when the compensation function is closed under calm seas cannot be obtained. The experience of the handle process is consistent, and the operation is not smooth.

发明内容Contents of the invention

本发明目的是为了解决现有技术中的问题,提出了一种风电桩登乘栈桥的干扰速度补偿方法、设备和介质。本发明通过引入干扰速度(船舶运动速度)补偿的方式与干扰位置补偿相结合,提高主动式运动补偿栈桥的快速性和补偿效果,并改善栈桥搭接过程的使用体验,提高恶劣天气下风电桩的可达性,增加登乘人员的安全性。The purpose of the present invention is to solve the problems in the prior art, and propose a method, device and medium for compensating the disturbance speed of a wind power pile boarding trestle. The present invention combines the interference position compensation with the introduction of interference speed (ship motion speed) compensation to improve the rapidity and compensation effect of active motion compensation trestles, improve the use experience of the trestle lapping process, and improve the efficiency of wind power piles in bad weather. accessibility, increasing the safety of boarding personnel.

本发明是通过以下技术方案实现的,本发明提出一种风电桩登乘栈桥的干扰速度补偿方法,所述方法具体包括以下步骤:The present invention is achieved through the following technical solutions. The present invention proposes a method for compensating the disturbance speed of a wind power pile boarding trestle. The method specifically includes the following steps:

步骤1、设插入板的位置为x=[x1,x2,x3]T,x1,x2,x3分别为插入板在大地坐标系O-XYZ三个坐标轴的坐标值,则该坐标值表示为:Step 1. Set the position of the plug-in board as x=[x 1 , x 2 , x 3 ] T , where x 1 , x 2 , and x 3 are the coordinate values of the plug-in board in the three coordinate axes of the earth coordinate system O-XYZ respectively, Then the coordinate value is expressed as:

Figure BDA0003592964980000021
Figure BDA0003592964980000021

式中,A、B、C和D为系统矩阵,u(k)=[r(k),p(k),s(k)]T分别为栈桥的回转值、俯仰值和伸缩值;d(k)=[rs(k),ps(k),hs(k)]T分别为船舶的首摇值、纵摇值和垂荡值,输出值 y=[x1,x2,x3]T,k表示时间序列;In the formula, A, B, C and D are system matrices, u(k)=[r(k), p(k), s(k)] T are the rotation value, pitch value and telescopic value of the trestle respectively; d (k)=[r s (k), p s (k), h s (k)] T are the yaw value, pitch value and heave value of the ship respectively, the output value y=[x 1 ,x 2 ,x 3 ] T , k represents time series;

步骤2、将方程(1)变为差分形式,设置包换位置和速度跟踪误差的目标函数J(k),通过目标函数确定控制量的增量;Step 2, change the equation (1) into a differential form, set the objective function J(k) that covers the position and speed tracking error, and determine the increment of the control amount through the objective function;

步骤3、通过扩张状态观测器ESO获得船舶运动干扰的增量;Step 3. Obtain the increment of the ship motion disturbance through the extended state observer ESO;

步骤4、综合控制量增量和干扰量增量获得最终的控制量;Step 4, the final control quantity is obtained by integrating the control quantity increment and the disturbance quantity increment;

步骤5、将开启AMC功能时刻的系统状态记为x(0),当操作手柄无动作时,插入板的目标位置xr(k)=x(0),插入板的目标速度

Figure BDA0003592964980000031
此时的控制量用来补偿船舶运动导致的插入板坐标的变化;当操作手柄动作时,插入板的目标速度
Figure BDA0003592964980000032
与操作手柄的输出电压成比例,xr(k)为
Figure BDA0003592964980000033
的积分,以跟踪手柄的操作。Step 5. Record the system state at the moment when the AMC function is turned on as x(0). When the operating handle does not move, the target position of the plug-in board x r (k)=x(0), and the target speed of the plug-in board
Figure BDA0003592964980000031
The control amount at this time is used to compensate the change of the coordinates of the insertion board caused by the movement of the ship; when the operating handle is moved, the target speed of the insertion board
Figure BDA0003592964980000032
Proportional to the output voltage of the operating handle, x r (k) is
Figure BDA0003592964980000033
points to track controller operations.

进一步地,将方程(1)变成差分形式:Further, transform equation (1) into differential form:

Figure BDA0003592964980000034
Figure BDA0003592964980000034

式中,

Figure BDA0003592964980000035
分别为状态量、控制量和干扰量的增量;系统矩阵中
Figure BDA0003592964980000036
Figure BDA0003592964980000037
O为零矩阵,I为单位矩阵。In the formula,
Figure BDA0003592964980000035
are the increments of the state quantity, control quantity and disturbance quantity respectively; in the system matrix
Figure BDA0003592964980000036
Figure BDA0003592964980000037
O is the zero matrix and I is the identity matrix.

进一步地,考虑控制变量u(k)的幅值约束和速度约束,通过解下述目标函数来获得控制变量的增量:Further, considering the amplitude constraint and speed constraint of the control variable u(k), the increment of the control variable is obtained by solving the following objective function:

Figure BDA0003592964980000038
Figure BDA0003592964980000038

Figure BDA0003592964980000039
Figure BDA0003592964980000039

式中,Np为预测时域,矩阵Q和S为半正定矩阵,矩阵R和P为正定矩阵,

Figure BDA00035929649800000310
Figure BDA00035929649800000311
代表状态误差,xr(k)为插入板的目标位置,xd(k)为x(k)的微分即插入板的速度,因此误差中既包含了位置误差也包含了速度误差;
Figure BDA00035929649800000312
为控制量增量,增加的自由度
Figure BDA00035929649800000313
用来模拟干扰量的增量。In the formula, N p is the prediction time domain, the matrices Q and S are semi-positive definite matrices, and the matrices R and P are positive definite matrices,
Figure BDA00035929649800000310
Figure BDA00035929649800000311
Represents the state error, x r (k) is the target position of the inserted board, x d (k) is the differential of x(k), which is the speed of the inserted board, so the error includes both position error and speed error;
Figure BDA00035929649800000312
For the control volume increment, the increased degrees of freedom
Figure BDA00035929649800000313
The increment used to simulate the amount of disturbance.

进一步地,最小化目标函数J(k)获得如下的控制序列:Further, minimize the objective function J(k) to obtain the following control sequence:

Figure BDA00035929649800000314
Figure BDA00035929649800000314

因此,在每一个采样周期解目标函数问题可以转化为如下的二次规划:Therefore, solving the objective function problem at each sampling period can be transformed into the following quadratic programming:

Figure BDA00035929649800000315
Figure BDA00035929649800000315

Subject to Lη≤bSubject to Lη≤b

式中,L和b用来限制控制量的幅值和速度;矩阵F和H如下定义,并通过实时计算获得:In the formula, L and b are used to limit the amplitude and speed of the control variable; the matrices F and H are defined as follows and obtained by real-time calculation:

Figure BDA0003592964980000041
Figure BDA0003592964980000041

Figure BDA0003592964980000042
Figure BDA0003592964980000042

Figure BDA0003592964980000043
Figure BDA0003592964980000043

Figure BDA0003592964980000044
Figure BDA0003592964980000044

状态

Figure BDA0003592964980000045
可表示为:state
Figure BDA0003592964980000045
Can be expressed as:

Figure BDA0003592964980000046
Figure BDA0003592964980000046

进一步地,采用式(5)实时优化η*,可以获得控制量增量的优化值

Figure BDA0003592964980000047
同时,也可以获得优化的干扰值增量
Figure BDA0003592964980000048
因此控制量增量可以通过下式获得:Further, using formula (5) to optimize η * in real time, the optimal value of the control increment can be obtained
Figure BDA0003592964980000047
At the same time, an optimized disturbance value increment can also be obtained
Figure BDA0003592964980000048
Therefore, the control increment can be obtained by the following formula:

Figure BDA0003592964980000049
Figure BDA0003592964980000049

式中,μ(k)用来补偿干扰

Figure BDA00035929649800000410
其通过
Figure BDA00035929649800000411
获得;最小化误差E(k),μ(k)满足In the formula, μ(k) is used to compensate the disturbance
Figure BDA00035929649800000410
its passing
Figure BDA00035929649800000411
Obtain; minimize the error E(k), μ(k) satisfies

Figure BDA00035929649800000412
Figure BDA00035929649800000412

式中,

Figure BDA00035929649800000413
是干扰的估计值,同时μ(k)通过下式计算:In the formula,
Figure BDA00035929649800000413
is the estimated value of the disturbance, while μ(k) is calculated by:

Figure BDA00035929649800000414
Figure BDA00035929649800000414

进一步地,为了获得干扰量增量

Figure BDA00035929649800000415
的估计值
Figure BDA00035929649800000416
采用如下的扩张状态观测器ESO 来观测干扰:Further, in order to obtain the interference amount increment
Figure BDA00035929649800000415
estimated value of
Figure BDA00035929649800000416
The following extended state observer ESO is used to observe the disturbance:

Figure BDA0003592964980000051
Figure BDA0003592964980000051

式中,

Figure BDA0003592964980000052
代表*的估计值,
Figure BDA0003592964980000053
代表x微分的估计值,
Figure BDA0003592964980000054
代表x二次微分的估计值;Ts为采样周期,θ是观测器增益,ko1,ko2,ko3和ko4为观测器系数;函数gi(i=1,2,3,4) 表示为:In the formula,
Figure BDA0003592964980000052
represents the estimated value of *,
Figure BDA0003592964980000053
represents an estimate of the x-differentiation,
Figure BDA0003592964980000054
Represents the estimated value of the quadratic differential of x; T s is the sampling period, θ is the observer gain, k o1 , k o2 , k o3 and k o4 are the observer coefficients; the function g i (i=1,2,3,4 ) Expressed as:

Figure BDA0003592964980000055
Figure BDA0003592964980000055

式中,α1=γ,α2=2γ-1,α3=3γ-2,α4=4γ-3,γ∈(3/4,1);K为正定矩阵;基于式(10)对d(k)的估计,获得

Figure BDA0003592964980000056
并通过式(9)计算μ(k);进而优化的控制变量为In the formula, α 1 = γ, α 2 = 2γ-1, α 3 = 3γ-2, α 4 = 4γ-3, γ∈(3/4,1); K is a positive definite matrix; based on formula (10) for The estimate of d(k), obtains
Figure BDA0003592964980000056
And calculate μ(k) through formula (9); then the optimized control variable is

Figure BDA0003592964980000057
Figure BDA0003592964980000057

进一步地,通过液压缸行程和机械结构,确定控制量的最大最小值分别为usU、usL;通过比例阀流量确定控制量增量的最大最小值分别为

Figure BDA0003592964980000058
即Further, through the stroke of the hydraulic cylinder and the mechanical structure, the maximum and minimum values of the control quantities determined are u sU and u sL respectively; the maximum and minimum values of the control quantity increments determined by the flow rate of the proportional valve are respectively
Figure BDA0003592964980000058
Right now

Figure BDA0003592964980000059
Figure BDA0003592964980000059

式(9)中的μ(k)可被重新描述为:μ(k) in Equation (9) can be re-described as:

Figure BDA00035929649800000510
Figure BDA00035929649800000510

式中,

Figure BDA00035929649800000511
因此控制量的幅值约束可采用如下不等式表示:In the formula,
Figure BDA00035929649800000511
Therefore, the magnitude constraint of the control quantity can be expressed by the following inequality:

Figure BDA00035929649800000512
Figure BDA00035929649800000512

式中,In the formula,

Figure BDA0003592964980000061
Figure BDA0003592964980000061

同样控制量增量的约束可采用如下不等式表示:Similarly, the constraint on the increment of the control quantity can be expressed by the following inequality:

Figure BDA0003592964980000062
Figure BDA0003592964980000062

式中,

Figure BDA0003592964980000063
Figure BDA0003592964980000064
分别为
Figure BDA0003592964980000065
Figure BDA0003592964980000066
的增量;In the formula,
Figure BDA0003592964980000063
and
Figure BDA0003592964980000064
respectively
Figure BDA0003592964980000065
and
Figure BDA0003592964980000066
increment;

Figure BDA0003592964980000067
Figure BDA0003592964980000067

本发明提出一种电子设备,包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现所述一种风电桩登乘栈桥的干扰速度补偿方法的步骤。The present invention proposes an electronic device, including a memory and a processor. The memory stores a computer program. When the processor executes the computer program, the steps of the method for compensating the disturbance speed of a wind power pile boarding trestle are realized.

本发明提出一种计算机可读存储介质,用于存储计算机指令,所述计算机指令被处理器执行时实现所述一种风电桩登乘栈桥的干扰速度补偿方法的步骤。The present invention proposes a computer-readable storage medium for storing computer instructions, and when the computer instructions are executed by a processor, the steps of the disturbance speed compensation method for wind power pile boarding trestles are realized.

本发明的有益效果为:The beneficial effects of the present invention are:

(1)采用栈桥模型的差分形式,并在误差中加入跟踪速度误差,提高了主动式运动补偿的快速性和动态补偿精度;(1) Adopting the differential form of the trestle model, and adding the tracking speed error to the error, the rapidity and dynamic compensation accuracy of active motion compensation are improved;

(2)将与操作手柄输出电压成比例的值作为跟踪速度,将跟踪速度的积分作目标位置,改善手柄的操纵体验;(2) Use the value proportional to the output voltage of the operating handle as the tracking speed, and use the integral of the tracking speed as the target position to improve the operating experience of the handle;

(3)控制量求解控制中考虑液压缸运动的速度限制和栈桥的位置约束,使获得的控制量是物理上的可行控制,避免了依靠限位开关限制运动幅值导致的紧急制动,保证了在极限位置的运动平稳性。(3) The speed limit of the hydraulic cylinder movement and the position constraint of the trestle bridge are considered in the solution control of the control quantity, so that the obtained control quantity is a physically feasible control, avoiding the emergency braking caused by limiting the movement amplitude by the limit switch, and ensuring The smoothness of movement in extreme positions is guaranteed.

附图说明Description of drawings

图1为AMC栈桥组成示意图;其中Y1回转液压缸;Y2俯仰液压缸;Y3伸缩液压缸;B1底座;B2支座;B3俯仰桥;B4伸缩桥;B5插入板;Figure 1 is a schematic diagram of the composition of the AMC trestle; among them, Y1 rotary hydraulic cylinder; Y2 pitch hydraulic cylinder; Y3 telescopic hydraulic cylinder; B1 base; B2 support; B3 pitch bridge; B4 telescopic bridge; B5 insert plate;

图2为栈桥搭接风电桩示意图;其中B4伸缩桥;B5插入板;C1风电机组平台;C2 爬梯;Figure 2 is a schematic diagram of the trestle bridge lapped with wind power piles; among them, B4 telescopic bridge; B5 insert plate; C1 wind turbine platform; C2 ladder;

图3为干扰速度补偿功能原理框图。Figure 3 is a functional block diagram of disturbance speed compensation.

具体实施方式Detailed ways

下面将结合本发明实施例中的附图对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。The technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments are only some of the embodiments of the present invention, not all of them. Based on the embodiments of the present invention, all other embodiments obtained by persons of ordinary skill in the art without making creative efforts belong to the protection scope of the present invention.

结合图1-图3,本发明提出一种风电桩登乘栈桥的干扰速度补偿方法,栈桥的搭接过程如图2所示,插入板插入风电机组平台的基础爬梯,完成人员通道的建立;所述方法具体包括以下步骤:Combining with Fig. 1-Fig. 3, the present invention proposes a method for compensating the interference speed of the wind power pile boarding trestle bridge. The lapping process of the trestle bridge is shown in Fig. 2. The insertion board is inserted into the foundation ladder of the wind turbine platform to complete the establishment of the personnel passage; Described method specifically comprises the following steps:

步骤1、设插入板的位置为x=[x1,x2,x3]T,x1,x2,x3分别为插入板在大地坐标系O-XYZ三个坐标轴的坐标值,则该坐标值表示为:Step 1. Set the position of the plug-in board as x=[x 1 , x 2 , x 3 ] T , where x 1 , x 2 , and x 3 are the coordinate values of the plug-in board in the three coordinate axes of the earth coordinate system O-XYZ respectively, Then the coordinate value is expressed as:

Figure BDA0003592964980000071
Figure BDA0003592964980000071

式中,A、B、C和D为系统矩阵,u(k)=[r(k),p(k),s(k)]T分别为栈桥的回转值、俯仰值和伸缩值;d(k)=[rs(k),ps(k),hs(k)]T分别为船舶的首摇值、纵摇值和垂荡值,输出值 y=[x1,x2,x3]T,k表示时间序列;In the formula, A, B, C and D are system matrices, u(k)=[r(k), p(k), s(k)] T are the rotation value, pitch value and telescopic value of the trestle respectively; d (k)=[r s (k), p s (k), h s (k)] T are the yaw value, pitch value and heave value of the ship respectively, the output value y=[x 1 ,x 2 ,x 3 ] T , k represents time series;

步骤2、为了处理快速变化的船舶运动,将方程(1)变为差分形式,设置包换位置和速度跟踪误差的目标函数J(k),通过目标函数确定控制量的增量;Step 2, in order to deal with the fast-changing ship motion, change the equation (1) into a differential form, set the objective function J(k) that covers the position and velocity tracking error, and determine the increment of the control amount through the objective function;

步骤3、通过扩张状态观测器ESO获得船舶运动干扰的增量;Step 3. Obtain the increment of the ship motion disturbance through the extended state observer ESO;

步骤4、综合控制量增量和干扰量增量获得最终的控制量;Step 4, the final control quantity is obtained by integrating the control quantity increment and the disturbance quantity increment;

步骤5、将开启AMC功能时刻的系统状态记为x(0),当操作手柄无动作时,插入板的目标位置xr(k)=x(0),插入板的目标速度

Figure BDA0003592964980000072
此时的控制量用来补偿船舶运动导致的插入板坐标的变化,误差中包含了速度误差;当操作手柄动作时,插入板的目标速度
Figure BDA0003592964980000073
与操作手柄的输出电压成比例,xr(k)为
Figure BDA0003592964980000074
的积分,以跟踪手柄的操作。当操作手柄时,式(3)中插入板的目标位置
Figure BDA0003592964980000075
(数字控制系统中以累加和代替积分值),插入板末端的目标速度
Figure BDA0003592964980000076
(vr为操作手柄三个自由度的输出电压,kv为比例系数)。此时的控制量除了用来补偿船舶运动导致的插入板坐标的变化,还同时响应手柄的操作。通过调整kv获得与通过vr直接控制比例阀开口一致的速度,使手柄操作更加平顺,改善开启AMC功能后手柄的操作体验。Step 5. Record the system state at the moment when the AMC function is turned on as x(0). When the operating handle does not move, the target position of the plug-in board x r (k)=x(0), and the target speed of the plug-in board
Figure BDA0003592964980000072
The control amount at this time is used to compensate the change of the coordinates of the insertion board caused by the movement of the ship, and the error includes the speed error; when the operating handle is moved, the target speed of the insertion board
Figure BDA0003592964980000073
Proportional to the output voltage of the operating handle, x r (k) is
Figure BDA0003592964980000074
points to track controller operations. When the handle is operated, the target position of the insertion plate in equation (3)
Figure BDA0003592964980000075
(In the digital control system, the cumulative sum is used instead of the integral value), insert the target speed at the end of the board
Figure BDA0003592964980000076
(v r is the output voltage of the three degrees of freedom of the operating handle, and k v is the proportional coefficient). The control quantity at this time is not only used to compensate the change of the coordinates of the insertion board caused by the movement of the ship, but also responds to the operation of the handle at the same time. By adjusting k v to obtain the same speed as directly controlling the opening of the proportional valve through v r , the handle operation is smoother, and the operating experience of the handle after the AMC function is turned on is improved.

将方程(1)变成差分形式:Put equation (1) into differential form:

Figure BDA0003592964980000081
Figure BDA0003592964980000081

式中,

Figure BDA0003592964980000082
分别为状态量、控制量和干扰量的增量;系统矩阵中
Figure BDA0003592964980000083
Figure BDA0003592964980000084
O为零矩阵,I为单位矩阵。In the formula,
Figure BDA0003592964980000082
are the increments of the state quantity, control quantity and disturbance quantity respectively; in the system matrix
Figure BDA0003592964980000083
Figure BDA0003592964980000084
O is the zero matrix and I is the identity matrix.

考虑控制变量u(k)的幅值约束和速度约束,通过解下述目标函数来获得控制变量的增量:Considering the magnitude constraint and speed constraint of the control variable u(k), the increment of the control variable is obtained by solving the following objective function:

Figure BDA0003592964980000085
Figure BDA0003592964980000085

Figure BDA0003592964980000086
Figure BDA0003592964980000086

式中,Np为预测时域,矩阵Q和S为半正定矩阵,矩阵R和P为正定矩阵,

Figure BDA0003592964980000087
Figure BDA0003592964980000088
代表状态误差,xr(k)为插入板的目标位置,xd(k)为x(k)的微分即插入板的速度,因此误差中既包含了位置误差也包含了速度误差;
Figure BDA0003592964980000089
为控制量增量,增加的自由度
Figure BDA00035929649800000810
用来模拟干扰量的增量。In the formula, N p is the prediction time domain, the matrices Q and S are semi-positive definite matrices, and the matrices R and P are positive definite matrices,
Figure BDA0003592964980000087
Figure BDA0003592964980000088
Represents the state error, x r (k) is the target position of the inserted board, x d (k) is the differential of x(k), which is the speed of the inserted board, so the error includes both position error and speed error;
Figure BDA0003592964980000089
For the control volume increment, the increased degrees of freedom
Figure BDA00035929649800000810
The increment used to simulate the amount of disturbance.

目标函数中包含了速度误差和干扰量的增量(等效于干扰速度),因此能够反映快速变化的船舶运动。The objective function includes the speed error and the increment of the disturbance (equivalent to the disturbance speed), so it can reflect the rapidly changing ship motion.

最小化目标函数J(k)获得如下的控制序列:Minimize the objective function J(k) to obtain the following control sequence:

Figure BDA00035929649800000811
Figure BDA00035929649800000811

因此,在每一个采样周期解目标函数问题可以转化为如下的二次规划:Therefore, solving the objective function problem at each sampling period can be transformed into the following quadratic programming:

Figure BDA00035929649800000812
Figure BDA00035929649800000812

Subject to Lη≤bSubject to Lη≤b

式中,L和b用来限制控制量的幅值和速度;矩阵F和H如下定义,并通过实时计算获得:In the formula, L and b are used to limit the amplitude and speed of the control variable; the matrices F and H are defined as follows and obtained by real-time calculation:

Figure BDA0003592964980000091
Figure BDA0003592964980000091

Figure BDA0003592964980000092
Figure BDA0003592964980000092

Figure BDA0003592964980000093
Figure BDA0003592964980000093

Figure BDA0003592964980000094
Figure BDA0003592964980000094

状态

Figure BDA0003592964980000095
可表示为:state
Figure BDA0003592964980000095
Can be expressed as:

Figure BDA0003592964980000096
Figure BDA0003592964980000096

采用式(5)实时优化η*,可以获得控制量增量的优化值

Figure BDA0003592964980000097
同时,也可以获得优化的干扰值增量
Figure BDA0003592964980000098
因此控制量增量可以通过下式获得:Using formula (5) to optimize η * in real time, the optimal value of control quantity increment can be obtained
Figure BDA0003592964980000097
At the same time, an optimized disturbance value increment can also be obtained
Figure BDA0003592964980000098
Therefore, the control increment can be obtained by the following formula:

Figure BDA0003592964980000099
Figure BDA0003592964980000099

式中,μ(k)用来补偿干扰

Figure BDA00035929649800000910
其通过
Figure BDA00035929649800000911
获得;最小化误差E(k),μ(k)满足In the formula, μ(k) is used to compensate the disturbance
Figure BDA00035929649800000910
its passing
Figure BDA00035929649800000911
Obtain; minimize the error E(k), μ(k) satisfies

Figure BDA00035929649800000912
Figure BDA00035929649800000912

式中,

Figure BDA00035929649800000913
是干扰的估计值,同时μ(k)通过下式计算:In the formula,
Figure BDA00035929649800000913
is the estimated value of the disturbance, while μ(k) is calculated by:

Figure BDA00035929649800000914
Figure BDA00035929649800000914

为了获得干扰量增量

Figure BDA00035929649800000915
的估计值
Figure BDA00035929649800000916
采用如下的扩张状态观测器ESO来观测干扰:In order to obtain the amount of interference increment
Figure BDA00035929649800000915
estimated value of
Figure BDA00035929649800000916
The following extended state observer ESO is used to observe the disturbance:

Figure BDA0003592964980000101
Figure BDA0003592964980000101

式中,

Figure BDA0003592964980000102
代表*的估计值,
Figure BDA0003592964980000103
代表x微分的估计值,
Figure BDA0003592964980000104
代表x二次微分的估计值;Ts为采样周期,θ是观测器增益,ko1,ko2,ko3和ko4为观测器系数;函数gi(i=1,2,3,4) 表示为:In the formula,
Figure BDA0003592964980000102
represents the estimated value of *,
Figure BDA0003592964980000103
represents an estimate of the x-differentiation,
Figure BDA0003592964980000104
Represents the estimated value of the quadratic differential of x; T s is the sampling period, θ is the observer gain, k o1 , k o2 , k o3 and k o4 are the observer coefficients; the function g i (i=1,2,3,4 ) Expressed as:

Figure BDA0003592964980000105
Figure BDA0003592964980000105

式中,α1=γ,α2=2γ-1,α3=3γ-2,α4=4γ-3,γ∈(3/4,1);K为正定矩阵;基于式(10)对d(k)的估计,获得

Figure BDA0003592964980000106
并通过式(9)计算μ(k);进而优化的控制变量为In the formula, α 1 = γ, α 2 = 2γ-1, α 3 = 3γ-2, α 4 = 4γ-3, γ∈(3/4,1); K is a positive definite matrix; based on formula (10) for The estimate of d(k), obtains
Figure BDA0003592964980000106
And calculate μ(k) through formula (9); then the optimized control variable is

Figure BDA0003592964980000107
Figure BDA0003592964980000107

通过液压缸行程和机械结构,确定控制量的最大最小值分别为usU、usL;通过比例阀流量确定控制量增量的最大最小值分别为

Figure BDA0003592964980000108
即According to hydraulic cylinder stroke and mechanical structure, the maximum and minimum values of control quantity determined are u sU and u sL respectively; the maximum and minimum values of control quantity increment determined by proportional valve flow are respectively
Figure BDA0003592964980000108
Right now

Figure BDA0003592964980000109
Figure BDA0003592964980000109

式(9)中的μ(k)可被重新描述为:μ(k) in Equation (9) can be re-described as:

Figure BDA00035929649800001010
Figure BDA00035929649800001010

式中,

Figure BDA00035929649800001011
因此控制量的幅值约束可采用如下不等式表示:In the formula,
Figure BDA00035929649800001011
Therefore, the magnitude constraint of the control quantity can be expressed by the following inequality:

Figure BDA00035929649800001012
Figure BDA00035929649800001012

式中,In the formula,

Figure BDA0003592964980000111
Figure BDA0003592964980000111

同样控制量增量的约束可采用如下不等式表示:Similarly, the constraint on the increment of the control quantity can be expressed by the following inequality:

Figure BDA0003592964980000112
Figure BDA0003592964980000112

式中,

Figure BDA0003592964980000113
Figure BDA0003592964980000114
分别为
Figure BDA0003592964980000115
Figure BDA0003592964980000116
的增量;In the formula,
Figure BDA0003592964980000113
and
Figure BDA0003592964980000114
respectively
Figure BDA0003592964980000115
and
Figure BDA0003592964980000116
increment;

Figure BDA0003592964980000117
Figure BDA0003592964980000117

如图3所示,本发明基于干扰速度补偿的主动式运动补偿方法的系统包括操作手柄积分单元,二次规划单元,控制量计算单元,扩张状态观测器单元,栈桥被控对象和MRU。As shown in Fig. 3, the system of the active motion compensation method based on disturbance speed compensation of the present invention includes an operating handle integration unit, a quadratic programming unit, a control quantity calculation unit, an extended state observer unit, a trestle controlled object and an MRU.

本发明提出一种电子设备,包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现所述一种风电桩登乘栈桥的干扰速度补偿方法的步骤。The present invention proposes an electronic device, including a memory and a processor. The memory stores a computer program. When the processor executes the computer program, the steps of the method for compensating the disturbance speed of a wind power pile boarding trestle are realized.

本发明提出一种计算机可读存储介质,用于存储计算机指令,所述计算机指令被处理器执行时实现所述一种风电桩登乘栈桥的干扰速度补偿方法的步骤。The present invention proposes a computer-readable storage medium for storing computer instructions, and when the computer instructions are executed by a processor, the steps of the disturbance speed compensation method for wind power pile boarding trestles are implemented.

以上对本发明所提出的一种风电桩登乘栈桥的干扰速度补偿方法、设备和介质进行了详细介绍,本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处,综上所述,本说明书内容不应理解为对本发明的限制。The above has introduced in detail the disturbance speed compensation method, equipment and medium of a wind power pile boarding trestle proposed by the present invention. In this paper, specific examples have been used to illustrate the principle and implementation of the present invention. The description of the above embodiments It is only used to help understand the method of the present invention and its core idea; at the same time, for those of ordinary skill in the art, according to the idea of the present invention, there will be changes in the specific implementation and scope of application. In summary, The contents of this description should not be construed as limiting the present invention.

Claims (4)

1.一种风电桩登乘栈桥的干扰速度补偿方法,其特征在于,所述方法具体包括以下步骤:1. A method for compensating the disturbance speed of a wind power pile boarding trestle bridge, characterized in that, the method specifically comprises the following steps: 步骤1、设插入板的位置为x=[x1,x2,x3]T,x1,x2,x3分别为插入板在大地坐标系O-XYZ三个坐标轴的坐标值,则该坐标值表示为:Step 1. Set the position of the plug-in board as x=[x 1 , x 2 , x 3 ] T , where x 1 , x 2 , and x 3 are the coordinate values of the plug-in board in the three coordinate axes of the earth coordinate system O-XYZ respectively, Then the coordinate value is expressed as:
Figure FDA0003985546890000011
Figure FDA0003985546890000011
式中,A、B、C和D为系统矩阵,u(k)=[r(k),p(k),s(k)]T分别为栈桥的回转值、俯仰值和伸缩值;d(k)=[rs(k),ps(k),hs(k)]T分别为船舶的首摇值、纵摇值和垂荡值,输出值为y(k),k表示时间序列;u(k)为控制变量,d(k)为干扰量;In the formula, A, B, C and D are system matrices, u(k)=[r(k), p(k), s(k)] T are the rotation value, pitch value and telescopic value of the trestle respectively; d (k)=[r s (k), p s (k), h s (k)] T are the yaw value, pitch value and heave value of the ship respectively, the output value is y(k), and k represents Time series; u(k) is the control variable, d(k) is the interference quantity; 步骤2、将方程(1)变为差分形式,设置包含位置和速度跟踪误差的目标函数J(k),通过目标函数确定控制量的增量;Step 2. Change the equation (1) into a differential form, set an objective function J(k) including position and speed tracking errors, and determine the increment of the control quantity through the objective function; 步骤3、通过扩张状态观测器ESO获得船舶运动干扰的增量;Step 3. Obtain the increment of the ship motion disturbance through the extended state observer ESO; 步骤4、综合控制量增量和干扰量增量获得最终的控制量;Step 4, the final control quantity is obtained by integrating the control quantity increment and the disturbance quantity increment; 步骤5、将开启主动式运动补偿AMC功能时刻的系统状态记为x(0),当操作手柄无动作时,插入板的目标位置xr(k)=x(0),插入板的目标速度
Figure FDA0003985546890000012
此时的控制量用来补偿船舶运动导致的插入板坐标的变化;当操作手柄动作时,插入板的目标速度
Figure FDA0003985546890000013
与操作手柄的输出电压成比例,xr(k)为
Figure FDA0003985546890000014
的积分,以跟踪手柄的操作;
Step 5. Record the system state at the moment when the active motion compensation AMC function is turned on as x(0). When the operating handle does not move, the target position of the insertion board x r (k)=x(0), and the target speed of the insertion board
Figure FDA0003985546890000012
The control amount at this time is used to compensate the change of the coordinates of the insertion board caused by the movement of the ship; when the operating handle is moved, the target speed of the insertion board
Figure FDA0003985546890000013
Proportional to the output voltage of the operating handle, x r (k) is
Figure FDA0003985546890000014
points to track the operation of the controller;
将方程(1)变成差分形式:Put equation (1) into differential form:
Figure FDA0003985546890000015
Figure FDA0003985546890000015
式中,
Figure FDA0003985546890000016
分别为状态量、控制量和干扰量的增量;系统矩阵中
Figure FDA0003985546890000017
Figure FDA0003985546890000018
O为零矩阵,I为单位矩阵;
In the formula,
Figure FDA0003985546890000016
are the increments of the state quantity, control quantity and disturbance quantity respectively; in the system matrix
Figure FDA0003985546890000017
Figure FDA0003985546890000018
O is a zero matrix, and I is an identity matrix;
考虑控制变量u(k)的幅值约束和速度约束,通过解下述目标函数来获得控制变量的增量:Considering the magnitude constraint and speed constraint of the control variable u(k), the increment of the control variable is obtained by solving the following objective function:
Figure FDA0003985546890000021
Figure FDA0003985546890000021
式中,Np为预测时域,矩阵Q和S为半正定矩阵,矩阵R和P为正定矩阵,
Figure FDA0003985546890000022
Figure FDA0003985546890000023
代表状态误差,xr(k)为插入板的目标位置,xd(k)为x(k)的微分即插入板的速度,因此误差中既包含了位置误差也包含了速度跟踪误差;
Figure FDA0003985546890000024
为控制量增量,增加的自由度
Figure FDA0003985546890000025
用来模拟干扰量的增量;
In the formula, N p is the prediction time domain, the matrices Q and S are semi-positive definite matrices, and the matrices R and P are positive definite matrices,
Figure FDA0003985546890000022
Figure FDA0003985546890000023
Represents the state error, x r (k) is the target position of the plug-in board, x d (k) is the differential of x(k), which is the speed of the plug-in board, so the error includes both position error and speed tracking error;
Figure FDA0003985546890000024
For the control volume increment, the increased degrees of freedom
Figure FDA0003985546890000025
Increment used to simulate the amount of disturbance;
最小化目标函数J(k)获得如下的控制序列:Minimize the objective function J(k) to obtain the following control sequence:
Figure FDA0003985546890000026
Figure FDA0003985546890000026
因此,在每一个采样周期解目标函数问题转化为如下的二次规划:Therefore, solving the objective function problem at each sampling period is transformed into the following quadratic programming:
Figure FDA0003985546890000027
Figure FDA0003985546890000027
式中,L和b用来限制控制量的幅值和速度;矩阵F和H如下定义,并通过实时计算获得:In the formula, L and b are used to limit the amplitude and speed of the control variable; the matrices F and H are defined as follows and obtained by real-time calculation:
Figure FDA0003985546890000028
Figure FDA0003985546890000028
Figure FDA0003985546890000029
Figure FDA0003985546890000029
Figure FDA00039855468900000210
Figure FDA00039855468900000210
Figure FDA00039855468900000211
Figure FDA00039855468900000211
状态
Figure FDA00039855468900000212
表示为:
state
Figure FDA00039855468900000212
Expressed as:
Figure FDA00039855468900000213
Figure FDA00039855468900000213
采用式(5)实时优化η*,获得控制量增量的优化值
Figure FDA0003985546890000031
同时,获得优化的干扰值增量
Figure FDA00039855468900000317
因此控制量增量通过下式获得:
Use formula (5) to optimize η * in real time to obtain the optimal value of the control quantity increment
Figure FDA0003985546890000031
At the same time, an optimized disturbance value increment is obtained
Figure FDA00039855468900000317
Therefore, the control quantity increment is obtained by the following formula:
Figure FDA0003985546890000032
Figure FDA0003985546890000032
式中,μ(k)用来补偿干扰
Figure FDA0003985546890000033
其通过
Figure FDA0003985546890000034
获得;最小化误差E(k),μ(k)满足
In the formula, μ(k) is used to compensate the disturbance
Figure FDA0003985546890000033
its passing
Figure FDA0003985546890000034
Obtain; minimize the error E(k), μ(k) satisfies
Figure FDA0003985546890000035
Figure FDA0003985546890000035
式中,
Figure FDA0003985546890000036
是干扰的估计值,同时μ(k)通过下式计算:
In the formula,
Figure FDA0003985546890000036
is the estimated value of the disturbance, while μ(k) is calculated by:
Figure FDA0003985546890000037
Figure FDA0003985546890000037
为了获得干扰量增量
Figure FDA0003985546890000038
的估计值
Figure FDA0003985546890000039
采用如下的扩张状态观测器ESO来观测干扰:
In order to obtain the amount of interference increment
Figure FDA0003985546890000038
estimated value of
Figure FDA0003985546890000039
The following extended state observer ESO is used to observe the disturbance:
Figure FDA00039855468900000310
Figure FDA00039855468900000310
式中,
Figure FDA00039855468900000311
代表*的估计值,
Figure FDA00039855468900000312
代表x微分的估计值,
Figure FDA00039855468900000313
代表x二次微分的估计值;Ts为采样周期,θ是观测器增益,ko1,ko2,ko3和ko4为观测器系数;函数gi(i=1,2,3,4)表示为:
In the formula,
Figure FDA00039855468900000311
represents the estimated value of *,
Figure FDA00039855468900000312
represents an estimate of the x-differentiation,
Figure FDA00039855468900000313
Represents the estimated value of the quadratic differential of x; T s is the sampling period, θ is the observer gain, k o1 , k o2 , k o3 and k o4 are the observer coefficients; the function g i (i=1,2,3,4 )Expressed as:
Figure FDA00039855468900000314
Figure FDA00039855468900000314
式中,α1=γ,α2=2γ-1,α3=3γ-2,α4=4γ-3,γ∈(3/4,1);K为正定矩阵;基于式(10)对d(k)的估计,获得
Figure FDA00039855468900000315
并通过式(9)计算μ(k);进而优化的控制变量为
In the formula, α 1 = γ, α 2 = 2γ-1, α 3 = 3γ-2, α 4 = 4γ-3, γ∈(3/4,1); K is a positive definite matrix; based on formula (10) for The estimate of d(k), obtains
Figure FDA00039855468900000315
And calculate μ(k) through formula (9); then the optimized control variable is
Figure FDA00039855468900000316
Figure FDA00039855468900000316
2.根据权利要求1所述的方法,其特征在于,通过液压缸行程和机械结构,确定控制量的最大最小值分别为usU、usL;通过比例阀流量确定控制量增量的最大最小值分别为
Figure FDA0003985546890000041
2. The method according to claim 1, characterized in that, through the stroke of the hydraulic cylinder and the mechanical structure, the maximum and minimum values of the control quantities are determined to be u sU and u sL respectively; the maximum and minimum increments of the control quantities are determined by the proportional valve flow Values are
Figure FDA0003985546890000041
Right now
Figure FDA0003985546890000042
Figure FDA0003985546890000042
式(9)中的μ(k)被重新描述为:μ(k) in (9) is re-described as:
Figure FDA0003985546890000043
Figure FDA0003985546890000043
式中,
Figure FDA0003985546890000044
因此控制量的幅值约束采用如下不等式表示:
In the formula,
Figure FDA0003985546890000044
Therefore, the amplitude constraint of the control quantity is expressed by the following inequality:
Figure FDA0003985546890000045
Figure FDA0003985546890000045
式中,In the formula,
Figure FDA0003985546890000046
Figure FDA0003985546890000046
同样控制量增量的约束采用如下不等式表示:Similarly, the constraint on the increment of the control quantity is expressed by the following inequality:
Figure FDA0003985546890000047
Figure FDA0003985546890000047
式中,
Figure FDA0003985546890000048
Figure FDA0003985546890000049
分别为
Figure FDA00039855468900000410
Figure FDA00039855468900000411
的增量;
In the formula,
Figure FDA0003985546890000048
and
Figure FDA0003985546890000049
respectively
Figure FDA00039855468900000410
and
Figure FDA00039855468900000411
increment;
Figure FDA00039855468900000412
Figure FDA00039855468900000412
3.一种电子设备,包括存储器和处理器,所述存储器存储有计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1-2任一项所述方法的步骤。3. An electronic device, comprising a memory and a processor, wherein the memory stores a computer program, wherein the processor implements the steps of the method according to any one of claims 1-2 when executing the computer program. 4.一种计算机可读存储介质,用于存储计算机指令,其特征在于,所述计算机指令被处理器执行时实现权利要求1-2任一项所述方法的步骤。4. A computer-readable storage medium for storing computer instructions, wherein the steps of the method according to any one of claims 1-2 are implemented when the computer instructions are executed by a processor.
CN202210380956.3A 2022-04-12 2022-04-12 Disturbance speed compensation method, equipment and medium for wind power pile boarding trestle bridge Active CN114735140B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210380956.3A CN114735140B (en) 2022-04-12 2022-04-12 Disturbance speed compensation method, equipment and medium for wind power pile boarding trestle bridge

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210380956.3A CN114735140B (en) 2022-04-12 2022-04-12 Disturbance speed compensation method, equipment and medium for wind power pile boarding trestle bridge

Publications (2)

Publication Number Publication Date
CN114735140A CN114735140A (en) 2022-07-12
CN114735140B true CN114735140B (en) 2023-03-10

Family

ID=82282201

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210380956.3A Active CN114735140B (en) 2022-04-12 2022-04-12 Disturbance speed compensation method, equipment and medium for wind power pile boarding trestle bridge

Country Status (1)

Country Link
CN (1) CN114735140B (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116184841B (en) * 2023-04-28 2023-07-21 山东大学 Marine trestle model predictive control method based on extremum searching algorithm
CN117163219B (en) * 2023-09-15 2024-05-14 哈尔滨理工大学 A feedforward fuzzy control method for shipborne trestle considering the constraints between rod length and rod interval

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2014131884A (en) * 2013-01-04 2014-07-17 Shimonoseki Ryoju Engineering Kk Embarking-disembarking device
CN105408199A (en) * 2013-07-19 2016-03-16 Icd软件股份公司 Apparatus and method for providing active motion compensation control of an articulated gangway
WO2016193713A1 (en) * 2015-06-02 2016-12-08 Marine Electrical Consulting Limited Method and apparatus for adaptive motion compensation
CN107434010A (en) * 2017-09-26 2017-12-05 哈尔滨工程大学 A kind of electronic wave Active Compensation, which is stepped on, multiplies system and its control method
CN107675607A (en) * 2016-10-28 2018-02-09 福建省新能海上风电研发中心有限公司 A kind of six degree of freedom Active Compensation formula offshore platform steps on the application method for multiplying trestle
CN111045332A (en) * 2019-12-27 2020-04-21 哈尔滨工程大学 An Unmanned Vehicle Path Tracking Guidance Strategy and Disturbance Compensation Method
CN113031429A (en) * 2021-02-26 2021-06-25 北京星光凯明智能科技有限公司 Shipborne carrier stabilizing platform and control method
CN113104153A (en) * 2021-04-25 2021-07-13 大连海事大学 An offshore transfer trestle bridge wave compensation control system and its working method
CN113431814A (en) * 2021-06-17 2021-09-24 江苏科技大学 Synchronous control method based on parallel motion of multiple hydraulic cylinders of heave compensation platform

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102008024513B4 (en) * 2008-05-21 2017-08-24 Liebherr-Werk Nenzing Gmbh Crane control with active coast sequence
JP6852178B2 (en) * 2017-02-28 2021-03-31 ジェイ. レイ マクダーモット, エス.エー. Offshore ship-to-ship lifting with target tracking assistance

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2014131884A (en) * 2013-01-04 2014-07-17 Shimonoseki Ryoju Engineering Kk Embarking-disembarking device
CN105408199A (en) * 2013-07-19 2016-03-16 Icd软件股份公司 Apparatus and method for providing active motion compensation control of an articulated gangway
WO2016193713A1 (en) * 2015-06-02 2016-12-08 Marine Electrical Consulting Limited Method and apparatus for adaptive motion compensation
CN107675607A (en) * 2016-10-28 2018-02-09 福建省新能海上风电研发中心有限公司 A kind of six degree of freedom Active Compensation formula offshore platform steps on the application method for multiplying trestle
CN107434010A (en) * 2017-09-26 2017-12-05 哈尔滨工程大学 A kind of electronic wave Active Compensation, which is stepped on, multiplies system and its control method
CN111045332A (en) * 2019-12-27 2020-04-21 哈尔滨工程大学 An Unmanned Vehicle Path Tracking Guidance Strategy and Disturbance Compensation Method
CN113031429A (en) * 2021-02-26 2021-06-25 北京星光凯明智能科技有限公司 Shipborne carrier stabilizing platform and control method
CN113104153A (en) * 2021-04-25 2021-07-13 大连海事大学 An offshore transfer trestle bridge wave compensation control system and its working method
CN113431814A (en) * 2021-06-17 2021-09-24 江苏科技大学 Synchronous control method based on parallel motion of multiple hydraulic cylinders of heave compensation platform

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
一种用于登乘栈桥的主动波浪补偿方法;苏长青等;《船舶与海洋工程》;20170825;第33卷(第04期);第22-25页 *

Also Published As

Publication number Publication date
CN114735140A (en) 2022-07-12

Similar Documents

Publication Publication Date Title
CN114735140B (en) Disturbance speed compensation method, equipment and medium for wind power pile boarding trestle bridge
EP2489872B1 (en) Blade load reduction for wind turbine
Schipf et al. Collective pitch feedforward control of floating wind turbines using lidar
CN112405497B (en) A hybrid mechanism system based on passive compensation and its motion decomposition method
CN115826606B (en) Dynamic positioning control method for self-elevating ship platform
CN116627043B (en) Regional power positioning control method of combined anchoring system
Liang et al. Modeling and controller design of an active motion compensated gangway based on inverse dynamics in joint space
CN106828789A (en) A kind of high-rise pile cap steps on the wave compensating device by operation
CN113387276B (en) Ship crane control method for improving LQR
Wille et al. Modeling and course control of sailboats
CN117163219B (en) A feedforward fuzzy control method for shipborne trestle considering the constraints between rod length and rod interval
Zheng et al. Sea trial test on offshore integration of an oscillating buoy wave energy device and floating breakwater
Liu et al. Dynamic response of a SWATH vessel for installing pre-assembled floating wind turbines
Chen et al. Analysis of the wet-towing operation of a semi-submersible floating wind turbine using a single tugboat
CN110422284A (en) A kind of active compensation method and system based on Ship Motion forecast
Zhang et al. Wave heave compensation based on an optimized backstepping control method
CN117922772A (en) Floating type fan rudder wing integrated anti-rolling control system
CN113357081B (en) Method and device for inhibiting dynamic shaking of offshore floating type wind power generation equipment
US12215664B2 (en) Parametric wave energy, subsea power generation
Jaouen et al. How does barge-master compensate for the barge motions: Experimental and numerical study
Zhang et al. Control Performance Analysis of Mining Ship Heave Compensation System Based on Fuzzy Logic Algorithm.
Yu et al. Model test and validation of the CROWN floating offshore wind turbine
Sreenivasan et al. Numerical simulations of offshore wind turbine component lifts to determine installation operability
CN111994201A (en) Compensation method based on sea wave compensation device
Hassan et al. Installation of pre-assembled offshore floating wind turbine using a floating vessel

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