CN115639751A - 混联平台迟滞响应的主动补偿方法 - Google Patents

混联平台迟滞响应的主动补偿方法 Download PDF

Info

Publication number
CN115639751A
CN115639751A CN202211284267.9A CN202211284267A CN115639751A CN 115639751 A CN115639751 A CN 115639751A CN 202211284267 A CN202211284267 A CN 202211284267A CN 115639751 A CN115639751 A CN 115639751A
Authority
CN
China
Prior art keywords
platform
layer
hidden layer
prediction model
mass
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
Application number
CN202211284267.9A
Other languages
English (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 Engineering University
Original Assignee
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 Engineering University filed Critical Harbin Engineering University
Priority to CN202211284267.9A priority Critical patent/CN115639751A/zh
Publication of CN115639751A publication Critical patent/CN115639751A/zh
Pending legal-status Critical Current

Links

Images

Landscapes

  • Management, Administration, Business Operations System, And Electronic Commerce (AREA)

Abstract

本发明提供了一种混联平台迟滞响应的主动补偿方法,涉及海洋工程领域,首先取反的当前姿态变化信息发送到预测模型,得到下一时刻的船体姿态变化信号,提前预测海浪对船体的影响,然后进行逆运动学推算,获得执行器的补偿信息,最后通过控制器输出到执行器中,对执行器下一时刻的运动进行补偿,在执行器动作之前,将海浪对船体可能造成的影响消除,解决补偿迟滞响应的弊端。为了保证预测的精度,最后将下一时刻执行器的运行信息取反,并逆向推算出船体姿态的理论变化值,将理论变化值与船体姿态的实际变化值做差值,并将差值返回到预测模型中,将差值叠加到后一时刻的预测值中,对执行器进行进一步修正,使得补偿效果更好。

Description

混联平台迟滞响应的主动补偿方法
技术领域
本发明涉及海洋工程技术领域,具体而言,涉及一种混联平台迟滞响应的主动补偿方法。
背景技术
随着人口数量的急剧增加,人类面临着陆地资源紧缺,生态环境恶化等全球性难题。为应对上述危机,人类将资源开发利用的目光由陆地逐渐转向海洋。但是海上风电机组常常出故障,需要运维人员经常乘坐船舶到达海上平台进行风电机组维修,因此进行安全海上运维工作就十分必要。
海上风电运维系统就是能够安全将运维人员和设备送到风机平台上,由于海浪的影响,船身处于颠簸摆动的状态,运维系统不能准确平稳的将运维人员和设备送到风机平台上。由于维修设备和吊装重物巨大的惯性,使运维系统的动作滞后于船舶的相对运动;同时,受到机械摩擦、电子元件损耗等不良因素的影响,而且海浪对运维系统的影响呈现明显的非线性特性,最终导致运维系统的执行动作产生时滞,即实际执行动作与期望动作能够到达的位置存在偏差;另外由于执行机构在执行控制信号的时候需要一定的时间,进而使得系统的信号输出比较慢,当前施加的控制作用不能及时输出,进一步加重时滞的产生,严重影响了系统的稳定性,使得系统的控制性能大幅降低。
发明内容
本发明所要解决的问题是如何降低运维系统因海浪产生的迟滞影响。
为解决上述问题,一方面,本发明提供了一种混联平台迟滞响应的主动补偿方法,所述混联平台包括并联平台和舷梯,所述并联平台包括上平台和下平台,所述混联平台迟滞响应的主动补偿方法包括:
根据传感器的反馈信息获取船体的当前姿态变化信息;
将所述当前姿态变化信息取反发送至预测模型中,并结合当前执行器的运动信息,得到下一时刻的姿态变化预测信息;
根据所述姿态变化预测信息对所述混联平台进行分析,获取补偿信息,其中,对所述混联平台的分析包括运动学分析和动力学分析;
将所述补偿信息发送至控制器中,其中,所述控制器根据所述补偿信息修正控制信号,并将修正后的控制信号发送至所述执行器,控制所述执行器在下一时刻运动;
基于所述执行器的运动,获取所述执行器在下一时刻的所述运动信息,并将所述运动信息反馈至所述预测模型中;
循环执行上述步骤,以补偿所述执行器在每一时刻的运动误差。
进一步地,所述将所述当前姿态变化信息取反发送至预测模型中,并结合当前执行器的运动信息,得到下一时刻的姿态变化预测信息包括:
所述预测模型中引入混联平台在输入和输出过程中的动态特征参数,表达式为:
yp(τ+1)=f(y(τ),...,y(τ-n+1),u(τ),...,u(τ-m+1),d(τ),...,d(τ-m+1)),
其中,yp(τ)为所述混联平台内的液压油缸在τ时刻的预测变化量,y(τ) 为所述混联平台内的液压油缸在τ时刻的实际变化量,u(τ)表示所述预测模型在τ时刻的输入,d(τ)为所述混联平台的液压系统在τ时刻的时滞时长,由仿真系统实际延迟时间产生,m、n分别表示有n个u和m个d。
根据上述表达式可知在过去的n个输入和m个输出决定着系统在τ+1时刻的输出值yp(τ+1)。Elman神经网络预测模型的输入为:之前时刻的监测输入以及反馈的当前时刻的输出及外部干扰。在之后的仿真过程中,Elman网络模型输出的yp可以替代实际输出y。训练好的Elman网络预测模型可以独立于机械系统之外,即可表示为下式:
yp(τ)=f(yp(τ-1),u(τ-1),d(τ-1)),
进一步地,所述根据所述姿态变化预测信息对所述混联平台进行分析,获取补偿信息包括:
根据所述姿态变化预测信息对所述混联平台进行所述运动学分析,得到所述并联平台和所述舷梯的各个关节的速度和位移量;
根据所述速度和所述位移量,获得所述混联平台中所述执行器的驱动力和驱动力矩,其中,所述补偿信息包括各关节的所述速度和所述位移量以及所述执行器的所述驱动力和所述驱动力矩。
进一步地,所述运动学分析包括:
所述上平台相对于所述下平台的齐次变换矩阵为:
Figure BDA0003899213510000031
其中,
Figure BDA0003899213510000032
为位姿变换矩阵;
Figure BDA0003899213510000033
为所述上平台相对所述下平台的位移矩阵;
Figure BDA0003899213510000034
Figure BDA0003899213510000035
之间的坐标转换公式:
Figure BDA0003899213510000036
其中,
Figure BDA0003899213510000037
为所述上平台铰点坐标;
Figure BDA0003899213510000038
为所述下平台铰点坐标;
所述上平台和所述下平台之间的驱动杆杆长向量为:
Figure BDA0003899213510000039
所述舷梯末端相对于所述上平台中心的齐次变换矩阵为:
Figure BDA00038992135100000310
Figure BDA00038992135100000311
Figure BDA00038992135100000312
Figure BDA00038992135100000313
其中,θ1为旋转关节旋转角;θ2为俯仰关节的俯仰角;d为伸缩关节运动后所述舷梯长度。
进一步地,所述动力学分析包括:
所述并联平台的总动能为所述上平台的总动能与所述驱动杆的总动能之和,具体为:
Figure BDA0003899213510000041
其中,所述上平台的总动能为:
Figure BDA0003899213510000042
Mp为所述上平台的质量矩,Vp为所述上平台的移动矢量矩阵;
其中,所述驱动杆的总动能为:
Figure BDA0003899213510000043
m1为所述驱动杆缸体部分质量,m2为活塞部分质量;VGi为所述驱动杆质心的运动速度,
Figure BDA0003899213510000044
第i根所述驱动杆的势能为:
Figure BDA0003899213510000045
其中,g为重力加速度;gi为液压油缸质心到所述下平台铰点的距离;s1为所述液压油缸缸体质心到所述下平台铰点的距离;s2为伸缩质心到所述上平台铰点的距离;hgi为伸缩油缸质心占所述驱动杆总长度的比例
Figure BDA0003899213510000046
li为所述驱动杆的杆长向量;liz为li的z轴坐标;
进一步地,所述混联平台中的各个机构所需驱动力为:
Figure BDA0003899213510000047
其中,L为拉格朗日系数,L=K-P,K为动能,P为位能;其中
Figure BDA0003899213510000048
Figure BDA0003899213510000049
分别为求偏导和求导数运算;
Figure BDA0003899213510000051
其中,l为所述旋转关节质心到所述上平台质心的水平距离,d1为俯仰铰链到固定舷梯质心的距离,d2为所述固定舷梯质心到活动舷梯质心的距离,θ1为所述旋转关节旋转角;θ2为所述俯仰关节的俯仰角,m3为所述上平台质量; m4为俯仰机构质量;m5为伸缩机构质量。
进一步地,所述混联平台迟滞响应的主动补偿方法还包括对预测模型的隐含层参数进行在线优化;
所述对预测模型的隐含层参数进行在线优化包括:
确定预测模型的最大层延迟系数和隐含层神经元个数的范围;
设置且固定所述预测模型的隐含层层延迟系数为所述最大层延迟系数,通过改变所述隐含层神经元个数,记录优化目标的变化,取使得优化目标产生最小值的层延迟系数为最终隐含层神经元个数;
在所述隐含层神经元个数取所述最终隐含层神经元个数的情况下,所述隐含层层延迟系数从1不断增大到所述最大层延迟系数,记录优化目标的变化,取使得所述优化目标产生最小值的所述隐含层层延迟系数为最终隐含层层延迟系数;
根据优化得到的最终隐含层神经元个数及最终隐含层层延迟系数,创建优化后的预测模型。
进一步地,所述预测模型的所述隐含层在当前时刻的总输入为:
Figure BDA0003899213510000052
式中ωji是输入层到所述隐含层的权值;Oip为所述输入层的输出量;ωjl结构层的权值;Olp是所述结构层的输出量;τ时间函数;θj为第j层的阈值;d 为所述隐含层延迟系数。
所述优化目标为所述预测模型的误差函数,所述误差函数为:
Figure BDA0003899213510000061
其中,ydk为输出层的期望值,P为总体样本的数量。
进一步地,所述对预测模型的隐含层参数进行在线优化之前,所述混联平台迟滞响应的主动补偿方法还包括:
以所述误差函数取值最小为目标,通过负梯度搜索技术调节所述预测模型中各层的权值或阈值,以使实际输出结果接近期望结果。
进一步地,所述预测模型的所述隐含层到输出层的所述权值ωkj(τ+1)在训练过程中调整依据的公式为:
ωkj(τ+1)=ωkj(τ)+Δωkj(τ+1),
Figure BDA0003899213510000062
其中,Δωkj(τ+1)表示第j个隐含层对第k个输出层神经元网络权值的更新;η表示学习速率;P表示样本数;
Figure BDA0003899213510000063
表示隐含层输出值。
所述预测模型的所述输出层的所述阈值θk(τ+1)在训练过程中调整依据的公式为:
θk(τ+1)=θk(τ)+Δθk(τ+1),
Figure BDA0003899213510000064
Figure BDA0003899213510000065
θk表示输出层阈值;yk(τ)表示输出层各节点的实际值;ydk(τ)表示输出层各节点的期望值;
Figure BDA0003899213510000066
表示输出层的输入量;。
所述预测模型的所述输入层到所述隐含层的所述权值ωji(τ+1)在训练过程中调整依据的公式为:
ωji(τ+1)=ωji(τ)+Δωji(τ+1),
Figure BDA0003899213510000071
其中,Δωji(τ+1)表示第i个输入层对第j个隐含层神经元网络权值的更新;
Figure BDA0003899213510000072
表示隐含层层的学习信号;
Figure BDA0003899213510000073
表示输入层的输出值。
所述预测模型的所述隐含层的所述阈值θj(τ+1)在训练过程中调整依据的公式为:
θj(τ+1)=θj(τ)+Δθj(τ+1),
Figure BDA0003899213510000074
Figure BDA0003899213510000075
其中θj表示隐含层阈值;
Figure BDA0003899213510000076
表示隐含层的输入量。
所述预测模型的结构层的所述权值ωjl(τ+1)在训练过程中调整依据的公式为:
ωjl(τ+1)=ωjl(τ)+Δωjl(τ+1),
Figure BDA0003899213510000077
Figure BDA0003899213510000078
其中ωjl表示结构层的权值,
Figure BDA0003899213510000079
表示隐含层的输出量。
与现有技术相比,本发明具有如下有益效果:
本发明提供的一种混联平台迟滞响应的主动补偿方法,首先取反的当前姿态变化信息发送到预测模型,得到下一时刻的船体姿态变化信号,提前预测海浪对船体的影响,然后进行逆运动学推算,获得执行器的补偿信息,最后通过控制器输出到执行器中,对执行器下一时刻的运动进行补偿,在执行器动作之前,将海浪对船体可能造成的影响消除,解决补偿迟滞响应的弊端。为了保证预测的精度,最后将下一时刻执行器的运行信息取反,并逆向推算出船体姿态的理论变化值,将理论变化值与船体姿态的实际变化值做差值,并将差值返回到预测模型中,将差值叠加到后一时刻的预测值中,对执行器进行进一步修正,使得补偿效果更好,促使运维系统更平稳的工作,以保证将工组人员或者设备准确输送至指定地点。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作一简单的介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1示出了本发明实施例中混联平台的结构示意图;
图2示出了本发明实施例中混联平台迟滞响应的主动补偿方法的流程图;
图3示出了六自由度并联平台结构和坐标系示意图;
图4示出了混联平台中各机构的坐标系示意图;
图5示出了驱动杆质心分布;
图6示出了Elman隐含层参数优化流程;
图7示出了主动海浪补偿系统联合仿真AMESim模型示意图;
图8示出了主动海浪补偿系统预测控制联合仿真Simulink模型示意图;
图9示出了横摇补偿误差分析结果图;
图10示出了纵摇补偿误差分析结果图;
图11示出了升沉补偿误差分析结果图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地说明,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
如图1所示,混联海浪补偿平台机构由六自由度并联平台和三自由度串联舷梯组成。在六自由度并联平台中,下平台与运维船采用固定副连接,六根驱动杆分别与上、下平台用虎克铰连接。驱动杆采用液压缸实现,液压缸与活塞杆之间用圆柱副连接。在三自由度串联舷梯中,旋转机构与六自由度并联平台的上平台通过转动副连接,俯仰机构通过转动副与转动机构连接,伸缩关节通过移动副与俯仰机构连接。
图2示出了本发明实施例中混联平台迟滞响应的主动补偿方法的流程图,如上所述,混联平台包括并联平台和舷梯,所述并联平台包括上平台和下平台,所述混联平台迟滞响应的主动补偿方法包括:
步骤1:根据传感器的反馈信息获取船体的当前姿态变化信息;其中所述姿态变化信息包括:横荡,纵荡,艏摇,横摇,纵摇,垂荡等产生的船体动荡位移变化。
步骤2:将所述当前姿态变化信息取反发送至预测模型中,并结合当前执行器的运动信息,得到下一时刻的姿态变化预测信息。在将所述当前姿态变化信息取反发送至预测模型中的时候,将所述当前姿态变化信息取反,即相当于将海浪对船体的影响通过反向消除,并使用取反后的所述当前姿态变化信息进行预测,预测下一时刻船体姿态的变化情况。
步骤3:根据所述姿态变化预测信息对所述混联平台进行分析,获取补偿信息,其中,对所述混联平台的分析包括运动学分析和动力学分析;
步骤4:将所述补偿信息发送至控制器中,其中,所述控制器根据所述补偿信息修正控制信号,并将修正后的控制信号发送至所述执行器,控制所述执行器在下一时刻运动;
步骤5:基于所述执行器的运动,获取所述执行器在下一时刻的所述运动信息,并将所述运动信息反馈至所述预测模型中;
循环执行上述步骤,以补偿所述执行器在每一时刻的运动误差。
因为混联海浪补偿平台的机械结构和液压系统等原因不能及时做出补偿反应,产生迟滞响应。本发明为了消除迟滞响应,首先取反的当前姿态变化信息发送到Elman神经网络预测模型,得到下一时刻的船体姿态变化信号,提前预测海浪对船体的影响,然后进行逆运动学推算分析,获得执行器的补偿信息,最后通过控制器输出到执行器中,对执行器下一时刻的运动进行补偿,在执行器动作之前,将海浪对船体可能造成的影响消除,解决补偿迟滞响应的弊端。为了保证预测的精度,最后将下一时刻执行器的运行信息取反,并逆向推算出船体姿态的理论变化值,将理论变化值与船体姿态的实际变化值做差值,并将差值返回到预测模型中,将差值叠加到后一时刻的预测值中,对执行器进行进一步修正,使得补偿效果更好,促使运维系统更平稳的工作,以保证将工组人员或者设备准确输送至指定地点,在恶劣天气下,海上平台的运维工作也能正常进行。
在本发明的一种实施例中,所述将所述当前姿态变化信息取反发送至预测模型中,并结合当前执行器的运动信息,得到下一时刻的姿态变化预测信息包括:
所述预测模型中引入混联平台在输入和输出过程中的动态特征参数,表达式为:
yp(τ+1)=f(y(τ),...,y(τ-n+1),u(τ),...,u(τ-m+1),d(τ),...,d(τ-m+1)),
其中,yp(τ)为所述混联平台内的液压油缸在τ时刻的预测变化量,y(τ) 为所述混联平台内的液压油缸在τ时刻的实际变化量,u(τ)表示预测模型在τ时刻的输入,d(τ)为所述混联平台的液压系统在τ时刻的时滞时长,由仿真系统实际延迟时间产生,m、n分别表示有n个u和m个d,f()表示yp(τ+1) 的预测与哪些因素相关。
根据上述表达式可知在过去的n个输出和m个输入决定着系统在τ+1时刻的输出值yp(τ+1)。Elman神经网络预测模型的输入为:之前时刻的监测输入以及反馈的当前时刻的输出及外部干扰。在之后的仿真过程中,Elman网络模型输出的yp可以替代实际输出y。训练好的Elman网络预测模型可以独立于机械系统之外,即可表示为下式:
yp(τ)=f(yp(τ-1),u(τ-1),d(τ-1)),
在解决主动海浪补偿系统执行机构滞后的问题中,之前的控制信号会影响系统输出的当前控制信号,但是当前控制信号受多少个之前控制信号的影响无法确定,即该滞后系统的滞后时间不能理论推到出。因此基于Elman网络的原理提出混联平台迟滞响应的主动补偿方法。
在本发明的一种实施例中,所述根据所述姿态变化预测信息对所述混联平台进行分析,获取补偿信息包括:
根据所述姿态变化预测信息对所述混联平台进行所述运动学分析,得到所述并联平台和所述舷梯的各个关节的速度和位移量;
根据所述速度和所述位移量,获得所述混联平台中所述执行器的驱动力和驱动力矩,其中,所述补偿信息包括各关节的所述速度和所述位移量以及所述执行器的所述驱动力和所述驱动力矩。
在本发明的一种实施例中,如图3所示,首先进行六自由度平台的建模,进行运动学推算在所述下平台中心点B建立坐标系B-xbybzb,所述上平台中心点A建立坐标系A-xayaza。所述下平台为静平台固定在船上,所述上平台为动平台,随着驱动杆长度的变化而运动,同时所述上平台运动的姿态可由A坐标系相对于B坐标系表示。所述上平台的铰点为Ai(i=1,2,3,4,5,6),所述下平台的铰点为Bi(i=1,2,3,4,5,6)。
所述上平台相对于所述下平台的齐次变换矩阵为:
Figure BDA0003899213510000111
其中,
Figure BDA0003899213510000112
为位姿变换矩阵;
Figure BDA0003899213510000113
为所述上平台相对所述下平台的位移矩阵;
Figure BDA0003899213510000114
Figure BDA0003899213510000115
之间的坐标转换公式:
Figure BDA0003899213510000116
其中,
Figure BDA0003899213510000117
为所述上平台铰点坐标;
Figure BDA0003899213510000118
为所述下平台铰点坐标;
设六自由度并联平台的六个连杆杆长分别为li(i=1,2,3,4,5,6),同一连杆两端分别对应上、所述下平台铰点,因此上平台和所述下平台之间的驱动杆杆长向量为:
Figure BDA0003899213510000119
如图4所示,为准确描述该机构的运动方式,本文采用D-H参数法建立三自由度串联舷梯各关节的坐标系。三自由度串联舷梯参考坐标系为o-xoyozo,由于三自由度串联舷梯通过回转关节固定在六自由度并联平台的上平台,故点o与上平台坐标系A-xayaza原点A重合。转动关节坐标系为o1-x1y1z1,转动轴为z1;俯仰关节坐标系为o2-x2y2z2,转动轴为z2;伸缩关节坐标系为o3-x3y3z3,移动轴为z3。其中o2到o距离为l,o2到o3距离为d。
逆运动学解算即已知舷梯末端位姿,求各关节的运动量。所述舷梯末端相对于所述上平台中心的齐次变换矩阵为:
Figure BDA0003899213510000121
各关节运动量表示为:
Figure BDA0003899213510000122
Figure BDA0003899213510000123
Figure BDA0003899213510000124
其中,θ1为旋转关节旋转角;θ2为俯仰关节的俯仰角;d为伸缩关节运动后舷梯长度。
计算完逆运动学之后,再计算各个执行机构的所需力与力矩,先分析上平台的动能和势能。采用拉格朗日法,建立六自由度并联平台的动力学建模。
通过观察可知,六自由度Stewart并联平台中,上平台的运动可分解为平移和旋转,所述上平台的总动能为:
所述上平台的总动能为:
Figure BDA0003899213510000125
Mp为所述上平台的质量矩,Vp为平台的移动矢量矩阵。
所述驱动杆的总动能为:
Figure BDA0003899213510000131
m1为驱动杆缸体部分质量,m2为活塞部分质量;VGi为驱动杆质心的运动速度,
Figure BDA0003899213510000132
对于驱动杆的动能和势能计算,将驱动杆缸体和驱动杆活塞的运动用各自质心的运动来表示,因此需确定驱动杆质心的位置。如附图5所示,假定驱动杆缸体部分质量为m1,活塞部分质量为m2;缸体质心到所述下平台铰点的距离为s1,活塞质心到所述上平台铰点距离为s2;驱动杆质心的速度为VGi,驱动杆的杆长为li,第i根驱动杆的势能为:
Figure BDA0003899213510000133
其中,g为重力加速度;gi为液压油缸质心到所述下平台铰点的距离;s1为液压油缸缸体质心到所述下平台铰点的距离;s2为伸缩质心到所述上平台铰点的距离;hgi为伸缩油缸质心占驱动杆总长度的比例
Figure BDA0003899213510000134
li为驱动杆的杆长向量;liz为li的z轴坐标。
通过上述推导过程,我们可以得到所述并联平台的总动能为所述上平台的总动能与驱动杆的总动能之和,具体为:
Figure BDA0003899213510000135
同样采用拉格朗日发对三自由度串联舷梯开展动力学分析及方程推导,根据之前运动学建模,转动关节(第一关节)坐标系为o1-x1y1z1,转动轴为z1;俯仰关节(第二关节)坐标系为o2-x2y2z2,转动轴为z2;伸缩关节(第三关节) 坐标系为o3-x3y3z3,移动轴为z3。其中,旋转关节质心到所述上平台质心的水平距离为l,俯仰铰链到固定舷梯质心为d1,固定舷梯质心到活动舷梯质心距离为d2。θ1为旋转关节旋转角;θ2为俯仰关节得俯仰角。平台质量为m3;俯仰机构质量为m4;伸缩机构质量为m5。旋转关节的转动惯量为I1,俯仰关节的转动惯量为I2,俯仰关节的转动惯量为I3
其中,所述混联平台中的各个机构所需驱动力为:
Figure BDA0003899213510000141
其中,L为拉格朗日系数,L=K-P,K为动能,P为位能;其中
Figure BDA0003899213510000142
Figure BDA0003899213510000143
分别为求偏导和求导数运算;
对于第一关节的动能:
Figure BDA0003899213510000144
第二关节动能不光有第一关节带来的旋转量,同时还存在俯仰产生,所以第二关节的动能:
Figure BDA0003899213510000145
同样,对于第三关节,不光有伸缩带来的动能,也有第一第二关节带来的动量,第三关节的动能:
Figure 1
运动总能量为:
Figure 2
假设在水平时,重力势能为0求得各个机构的重力势能为:
P1=0,
P2=m4gd1sinθ1
P3=m5g(d1+d2)sinθ2
P1为回转机构的重力势能;P2为回转机构重力势能;P3为伸缩机构重力势能。
因此,总重力势能:P=P1+P2+P3=m4gd1sinθ1+m5g(d1+d2)sinθ2
通过上述分析,可以得到:
Figure BDA0003899213510000151
其中,l为旋转关节质心到所述上平台质心的水平距离,d1为俯仰铰链到固定舷梯质心的距离,d2为固定舷梯质心到活动舷梯质心的距离,θ1为旋转关节旋转角;θ2为俯仰关节的俯仰角,m3为所述上平台质量;m4为俯仰机构质量;m5为伸缩机构质量。
对L求偏导和倒数
Figure BDA0003899213510000152
Figure BDA0003899213510000153
最终得到:
Figure BDA0003899213510000154
Figure BDA0003899213510000155
Figure BDA0003899213510000156
分别为第一关节,第二关节和第三关节运动所需要的力。
在本发明的一种实施例中,所述混联平台迟滞响应的主动补偿方法还包括对预测模型的隐含层参数进行在线优化;
如图6所示,所述对预测模型的隐含层参数进行在线优化包括:
确定预测模型的最大层延迟系数和隐含层神经元个数的范围;
设置且固定所述预测模型的隐含层层延迟系数为所述最大层延迟系数,通过改变所述隐含层神经元个数,记录优化目标的变化,取使得优化目标产生最小值的层延迟系数为最终隐含层神经元个数;
在所述隐含层神经元个数取所述最终隐含层神经元个数的情况下,所述隐含层层延迟系数从1不断增大到所述最大层延迟系数,记录优化目标的变化,取使得所述优化目标产生最小值的所述隐含层层延迟系数为最终隐含层层延迟系数。
根据优化得到的最终隐含层神经元个数及最终隐含层层延迟系数,创建优化后的预测模型。
在本发明的一种实施例中,所述对预测模型的隐含层参数进行在线优化之前,所述混联平台迟滞响应的主动补偿方法还包括:
以所述误差函数取值最小为目标,通过负梯度搜索技术调节所述预测模型中各层的权值或阈值,以使实际输出结果接近期望结果。
其中,所述预测模型的隐含层在当前时刻的总输入为:
Figure BDA0003899213510000161
式中ωji是输入层到隐含层的权值;Oip为输入层的输出量;ωjl结构层的权值;Olp是结构层的输出量;τ时间函数;θj为第j层的阈值;d为隐含层延迟系数。对于单个隐含层中神经元数量的选择,在保证网络学习能正确表达输入和输出关系的条件下,应选取较少的节点数以优化网络结构,提高计算效率。
所述优化目标为预测模型的误差函数,所述误差函数为:
Figure BDA0003899213510000162
其中,ydk为输出层的期望值,P为总体样本的数量;
Elman网络算法的核心思想为总误差均方值最小,即以所述误差函数取值最小为目标,通过负梯度搜索技术调节所述预测模型中各层的权值或阈值,以使实际输出结果接近期望结果。
在对各层的权值或者阈值进行调整的时候,调整的依据如下。
其中,所述预测模型的所述隐含层到输出层的所述权值ωkj(τ+1)在训练过程中调整依据的公式为:
ωkj(τ+1)=ωkj(τ)+Δωkj(τ+1),
Figure BDA0003899213510000171
其中,Δωkj(τ+1)表示第j个隐含层对第k个输出层神经元网络权值的更新;η为学习速率;P为样本数;
Figure BDA0003899213510000172
表示隐含层输出值。
所述预测模型的所述输出层的所述阈值θk(τ+1)在训练过程中调整依据的公式为:
θk(τ+1)=θk(τ)+Δθk(τ+1),
Figure BDA0003899213510000173
Figure BDA0003899213510000174
θk表示输出层阈值;yk(τ)为输出层各节点的实际值;ydk(τ)为输出层各节点的期望值;
Figure BDA0003899213510000175
是输出层的输入量;。
所述预测模型的所述输入层到所述隐含层的所述权值ωji(τ+1)在训练过程中调整依据的公式为:
ωji(τ+1)=ωji(τ)+Δωji(τ+1),
Figure BDA0003899213510000176
其中,Δωji(τ+1)表示第i个输入层对第j个隐含层神经元网络权值的更新;
Figure BDA0003899213510000177
是隐含层层的学习信号;
Figure BDA0003899213510000178
表示输入层的输出值。
所述预测模型的所述隐含层的所述阈值θj(τ+1)在训练过程中调整依据的公式为:
θj(τ+1)=θj(τ)+Δθj(τ+1),
Figure BDA0003899213510000179
Figure BDA0003899213510000181
其中θj表示隐含层阈值;
Figure BDA0003899213510000182
是隐含层的输入量。
所述预测模型的所述结构层的所述权值ωjl(τ+1)在训练过程中调整依据的公式为:
ωjl(τ+1)=ωjl(τ)+Δωjl(τ+1),
Figure BDA0003899213510000183
Figure BDA0003899213510000184
其中ωjl是结构层的权值,
Figure BDA0003899213510000185
是隐含层的输出量。
由上述可实现Elman神经网络预测模型各层间连接权值与阈值的调整。根据误差函数可知误差En的产生一方面是各层神经元连接权值和阈值的设置,这个问题可由权值与阈值的计算来调整,另一方面结合上一实施例中Elman 神经网络隐含层参数优化的方法,对预测模型可以进一步优化。
在本发明的一种实施例中,为了支撑上述方法和预测模型的顺利执行,设计了如下系统,将在Simulink(一种可视化仿真工具,模块图环境)中生成AMESim(多学科领域的复杂系统建模与仿真平台)的接口模块SimuCosim,实现Simulink和AMESim的联合仿真。从而实现Simulink-AMESim-ADAMS机电液联合仿真。
Simulink通过控制算法向AMESim的伺服阀输入控制量,AMESim执行机构产生相应的运动,并且将运动量输入至ADAMS(机械系统动力学自动分析) 中,从而ADAMS软件中的机构各关节进行输入的运动量,最后输出为混联机构末端在补偿方向与参考点的偏差量,即可反映主动海浪补偿系统的控制效果。如图7所示,为主动海浪补偿系统联合仿真AMESim模型。图8为主动海浪补偿系统Elman预测控制联合仿真simulink模型。
在主动海浪补偿系统混联机构末端设置参考点模拟实际作业中的风机平台,通过仿真分别得到在理想补偿以及PID控制算法和Elman预测控制各自控制算法的控制下,得到混联机构运动补偿后与参考点的误差曲线,分别如图9、图10和图11所示。
在系统理想补偿时候补偿误差几乎为零,混联机构末端与参考点几乎相对静止。但是在有液压系统执行机构存在时滞的情况下,横摇、纵摇和升沉方向补偿误差都变大,故需要通过控制系统来解决时滞问题,使得补偿误差减小,从而保证混联机构在受到海浪的干扰下保持与风机平台保持静止。在两种方法的控制下,海浪对于混联机构的影响已经得到了有效的控制。图9 为横摇方向的补偿误差,在没有补偿的情况下即为输入周期五秒,最大幅度为6°,在PID控制下,横摇方向最大幅度为2°,在Elman预测控制下,横摇方向最大幅度为1°。图10所示为纵摇方向的补偿误差在没有补偿的情况下即为输入周期五秒,最大幅度为1.5°,在PID控制下,纵摇方向最大幅度为0.4°,在Elman预测控制下,纵摇方向最大幅度为不到0.2°。图11所示为纵摇方向的补偿误差在没有补偿的情况下即为输入周期五秒,最大幅度为2.5m,在PID 控制下,升沉方向最大幅度为0.4m,在Elman预测控制下,升沉方向最大幅度为0.2m。从而可以说明尽管Elman预测值与测量值存在一定误差,但是对系统的控制量确定并没有太大的影响,并且相对于传统PID控制补偿效果更有效。
表1为本发明提出的基于Elman神经网络的控制方法与传统PID控制方法所得结果对比表:
表1Elman神经网络预测控制误差与传统PID控制方法误差对比
无补偿情况误差 传统PID控制误差 本发明Elman预测控制误差
横摇
纵摇 1.5° 0.4° 0.2°
升沉 2.5m 0.4m 0.2m
尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。

Claims (10)

1.一种混联平台迟滞响应的主动补偿方法,其特征在于,所述混联平台包括并联平台和舷梯,所述并联平台包括上平台和下平台,所述混联平台迟滞响应的主动补偿方法包括:
根据传感器的反馈信息获取船体的当前姿态变化信息;
将所述当前姿态变化信息取反发送至预测模型中,并结合当前执行器的运动信息,得到下一时刻的姿态变化预测信息;
根据所述姿态变化预测信息对所述混联平台进行分析,获取补偿信息,其中,对所述混联平台的分析包括运动学分析和动力学分析;
将所述补偿信息发送至控制器中,其中,所述控制器根据所述补偿信息修正控制信号,并将修正后的控制信号发送至所述执行器,控制所述执行器在下一时刻运动;
基于所述执行器的运动,获取所述执行器在下一时刻的所述运动信息,并将所述运动信息反馈至所述预测模型中;
循环执行上述步骤,以补偿所述执行器在每一时刻的运动误差。
2.根据权利要求1所述的混联平台迟滞响应的主动补偿方法,其特征在于,所述将所述当前姿态变化信息取反发送至预测模型中,并结合当前执行器的运动信息,得到下一时刻的姿态变化预测信息包括:
所述预测模型中引入混联平台在输入和输出过程中的动态特征参数,表达式为:
yp(τ+1)=f(y(τ),...,y(τ-n+1),u(τ),...,u(τ-m+1),d(τ),...,d(τ-m+1))
其中,yp(τ)为所述混联平台内的液压油缸在τ时刻的预测变化量,y(τ)为所述混联平台内的液压油缸在τ时刻的实际变化量,u(τ)表示所述预测模型在τ时刻的输入,d(τ)为所述混联平台的液压系统在τ时刻的时滞时长,由仿真系统实际延迟时间产生,m、n分别表示有n个u和m个d。
3.根据权利要求1所述的混联平台迟滞响应的主动补偿方法,其特征在于,所述根据所述姿态变化预测信息对所述混联平台进行分析,获取补偿信息包括:
根据所述姿态变化预测信息对所述混联平台进行所述运动学分析,得到所述并联平台和所述舷梯的各个关节的速度和位移量;
根据所述速度和所述位移量,获得所述混联平台中所述执行器的驱动力和驱动力矩,其中,所述补偿信息包括各关节的所述速度和所述位移量以及所述执行器的所述驱动力和所述驱动力矩。
4.根据权利要求1所述的混联平台迟滞响应的主动补偿方法,其特征在于,所述运动学分析包括:
所述上平台相对于所述下平台的齐次变换矩阵为:
Figure FDA0003899213500000021
其中,
Figure FDA0003899213500000022
为位姿变换矩阵;
Figure FDA0003899213500000023
为所述上平台相对所述下平台的位移矩阵;
Figure FDA0003899213500000024
Figure FDA0003899213500000025
之间的坐标转换公式:
Figure FDA0003899213500000026
其中,
Figure FDA0003899213500000027
为所述上平台铰点坐标;
Figure FDA0003899213500000028
为所述下平台铰点坐标;
所述上平台和所述下平台之间的驱动杆杆长向量为:
Figure FDA0003899213500000029
所述舷梯末端相对于所述上平台中心的齐次变换矩阵为:
Figure FDA00038992135000000210
Figure FDA0003899213500000031
Figure FDA0003899213500000032
Figure FDA0003899213500000033
其中,θ1为旋转关节旋转角;θ2为俯仰关节的俯仰角;d为伸缩关节运动后所述舷梯长度。
5.根据权利要求4所述的混联平台迟滞响应的主动补偿方法,其特征在于,所述动力学分析包括:
所述并联平台的总动能为所述上平台的总动能与所述驱动杆的总动能之和,具体为:
Figure FDA0003899213500000034
其中,所述上平台的总动能为:
Figure FDA0003899213500000035
Mp为所述上平台的质量矩,Vp为所述上平台的移动矢量矩阵;
其中,所述驱动杆的总动能为:
Figure FDA0003899213500000036
m1为所述驱动杆缸体部分质量,m2为活塞部分质量;VGi为所述驱动杆质心的运动速度,
Figure FDA0003899213500000037
第i根所述驱动杆的势能为:
Figure FDA0003899213500000038
其中,g为重力加速度;gi为液压油缸质心到所述下平台铰点的距离;s1为所述液压油缸缸体质心到所述下平台铰点的距离;s2为伸缩质心到所述上平台铰点的距离;hgi为伸缩油缸质心占所述驱动杆总长度的比例
Figure FDA0003899213500000041
li为所述驱动杆的杆长向量;liz为li的z轴坐标。
6.根据权利要求5所述的混联平台迟滞响应的主动补偿方法,其特征在于,所述混联平台中的各个机构所需驱动力为:
Figure FDA0003899213500000042
其中,L为拉格朗日系数,L=K-P,K为动能,P为位能;其中
Figure FDA0003899213500000043
Figure FDA0003899213500000044
分别为求偏导和求导数运算;
Figure FDA0003899213500000045
其中,l为所述旋转关节质心到所述上平台质心的水平距离,d1为俯仰铰链到固定舷梯质心的距离,d2为所述固定舷梯质心到活动舷梯质心的距离,θ1为所述旋转关节旋转角;θ2为所述俯仰关节的俯仰角,m3为所述上平台质量;m4为俯仰机构质量;m5为伸缩机构质量。
7.根据权利要求1所述的混联平台迟滞响应的主动补偿方法,其特征在于,还包括对预测模型的隐含层参数进行在线优化;
所述对预测模型的隐含层参数进行在线优化包括:
确定预测模型的最大层延迟系数和隐含层神经元个数的范围;
设置且固定所述预测模型的隐含层层延迟系数为所述最大层延迟系数,通过改变所述隐含层神经元个数,记录优化目标的变化,取使得优化目标产生最小值的层延迟系数为最终隐含层神经元个数;
在所述隐含层神经元个数取所述最终隐含层神经元个数的情况下,所述隐含层层延迟系数从1不断增大到所述最大层延迟系数,记录优化目标的变化,取使得所述优化目标产生最小值的所述隐含层层延迟系数为最终隐含层层延迟系数;
根据优化得到的最终隐含层神经元个数及最终隐含层层延迟系数,创建优化后的预测模型。
8.根据权利要求7所述的混联平台迟滞响应的主动补偿方法,其特征在于,所述预测模型的所述隐含层在当前时刻的总输入为:
Figure FDA0003899213500000051
式中ωji是输入层到所述隐含层的权值;Oip为所述输入层的输出量;ωjl结构层的权值;Olp是所述结构层的输出量;τ时间函数;θj为第j层的阈值;d为所述隐含层延迟系数;
所述优化目标为所述预测模型的误差函数,所述误差函数为:
Figure FDA0003899213500000052
其中,ydk为输出层的期望值,P为总体样本的数量。
9.根据权利要求7所述的混联平台迟滞响应的主动补偿方法,其特征在于,所述对预测模型的隐含层参数进行在线优化之前,还包括:
以所述误差函数取值最小为目标,通过负梯度搜索技术调节所述预测模型中各层的权值或阈值,以使实际输出结果接近期望结果。
10.根据权利要求9所述的混联平台迟滞响应的主动补偿方法,其特征在于,所述预测模型的所述隐含层到输出层的所述权值ωkj(τ+1)在训练过程中调整依据的公式为:
ωkj(τ+1)=ωkj(τ)+Δωkj(τ+1),
Figure FDA0003899213500000053
其中,Δωkj(τ+1)表示第j个隐含层对第k个输出层神经元网络权值的更新;η表示学习速率;P表示样本数;
Figure FDA0003899213500000054
表示隐含层输出值。
所述预测模型的所述输出层的所述阈值θk(τ+1)在训练过程中调整依据的公式为:
θk(τ+1)=θk(τ)+Δθk(τ+1),
Figure FDA0003899213500000061
Figure FDA0003899213500000062
θk表示输出层阈值;yk(τ)表示输出层各节点的实际值;ydk(τ)表示输出层各节点的期望值;
Figure FDA0003899213500000063
表示输出层的输入量;。
所述预测模型的所述输入层到所述隐含层的所述权值ωji(τ+1)在训练过程中调整依据的公式为:
ωji(τ+1)=ωji(τ)+Δωji(τ+1),
Figure FDA0003899213500000064
其中,Δωji(τ+1)表示第i个输入层对第j个隐含层神经元网络权值的更新;
Figure FDA0003899213500000065
表示隐含层层的学习信号;
Figure FDA0003899213500000066
表示输入层的输出值。
所述预测模型的所述隐含层的所述阈值θj(τ+1)在训练过程中调整依据的公式为:
θj(τ+1)=θj(τ)+Δθj(τ+1),
Figure FDA0003899213500000067
Figure FDA0003899213500000068
其中θj表示隐含层阈值;
Figure FDA0003899213500000069
表示隐含层的输入量。
所述预测模型的结构层的所述权值ωjl(τ+1)在训练过程中调整依据的公式为:
ωjl(τ+1)=ωjl(τ)+Δωjl(τ+1),
Figure FDA0003899213500000071
Figure FDA0003899213500000072
其中ωjl表示结构层的权值,
Figure FDA0003899213500000073
表示隐含层的输出量。
CN202211284267.9A 2022-10-20 2022-10-20 混联平台迟滞响应的主动补偿方法 Pending CN115639751A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202211284267.9A CN115639751A (zh) 2022-10-20 2022-10-20 混联平台迟滞响应的主动补偿方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211284267.9A CN115639751A (zh) 2022-10-20 2022-10-20 混联平台迟滞响应的主动补偿方法

Publications (1)

Publication Number Publication Date
CN115639751A true CN115639751A (zh) 2023-01-24

Family

ID=84944770

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211284267.9A Pending CN115639751A (zh) 2022-10-20 2022-10-20 混联平台迟滞响应的主动补偿方法

Country Status (1)

Country Link
CN (1) CN115639751A (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116860029A (zh) * 2023-06-30 2023-10-10 北京千尧新能源科技开发有限公司 基于数字孪生的登乘廊桥控制方法及相关设备

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116860029A (zh) * 2023-06-30 2023-10-10 北京千尧新能源科技开发有限公司 基于数字孪生的登乘廊桥控制方法及相关设备
CN116860029B (zh) * 2023-06-30 2023-12-19 北京千尧新能源科技开发有限公司 基于数字孪生的登乘廊桥控制方法及相关设备

Similar Documents

Publication Publication Date Title
Esfahani et al. A time delay controller included terminal sliding mode and fuzzy gain tuning for underwater vehicle-manipulator systems
CN110027678B (zh) 一种基于海浪主动补偿的混联登乘机构运动规划方法
CN111240345B (zh) 基于双bp网络增强学习框架的水下机器人轨迹跟踪方法
CN110908281A (zh) 无人直升机姿态运动有限时间收敛强化学习控制方法
CN111240344B (zh) 基于强化学习技术的自主水下机器人无模型控制方法
CN112306076A (zh) 一种混合驱动水下机器人动力学模型建立方法
CN110083057A (zh) 基于水翼运动姿态的pid控制方法
CN115639751A (zh) 混联平台迟滞响应的主动补偿方法
CN111649906B (zh) 一种风洞试验的受油机模型支撑装置的滑膜跟随控制方法
Chu et al. Incorporation of ship motion prediction into active heave compensation for offshore crane operation
Jing et al. Self-tuning adaptive active disturbance rejection pitch control of a manta-ray-like underwater glider
Tang et al. Proportional-integral-derivative controller optimization by particle swarm optimization and back propagation neural network for a parallel stabilized platform in marine operations
CN114545935A (zh) 基于改进麻雀算法的模糊pid动力定位铺缆船循迹控制方法
Cai et al. Autonomous manipulation of an underwater vehicle-manipulator system by a composite control scheme with disturbance estimation
CN114715331B (zh) 一种浮式海洋平台动力定位控制方法及系统
Miao et al. Artificial-neural-network-based optimal Smoother design for oscillation suppression control of underactuated overhead cranes with distributed mass beams
CN114943168B (zh) 一种水上浮桥组合方法及系统
Qiao et al. Motion tracking control of actuator in the active-truncated model test of deep-water mooring system
CN114296449B (zh) 基于固定时间h∞控制的水面无人艇轨迹快速跟踪控制方法
CN114924485A (zh) 一种过驱动水下机器人动力定位自适应容错控制架构及方法
CN114660942A (zh) 一种复合式直升机全模式自适应控制方法
CN114012733A (zh) 一种用于pc构件模具划线的机械臂控制方法
CN116968878A (zh) 一种基于混联机构的海上登乘系统的部署方法
Zhang et al. Ship Heave Compensation Based on PID-DDPG Hybrid Control
CN112327666B (zh) 动力巡航系统控制模型的目标函数权重矩阵确定方法

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