CN103075011B - 臂架轨迹优化方法、系统及包含该系统的工程机械 - Google Patents
臂架轨迹优化方法、系统及包含该系统的工程机械 Download PDFInfo
- Publication number
- CN103075011B CN103075011B CN201210590274.1A CN201210590274A CN103075011B CN 103075011 B CN103075011 B CN 103075011B CN 201210590274 A CN201210590274 A CN 201210590274A CN 103075011 B CN103075011 B CN 103075011B
- Authority
- CN
- China
- Prior art keywords
- arm support
- posture
- boom
- track
- arm
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 41
- 238000005457 optimization Methods 0.000 title claims description 9
- 230000036544 posture Effects 0.000 claims abstract description 51
- 239000011159 matrix material Substances 0.000 claims description 36
- 238000004364 calculation method Methods 0.000 claims description 6
- 231100001261 hazardous Toxicity 0.000 claims description 2
- 230000008569 process Effects 0.000 abstract description 18
- 238000004422 calculation algorithm Methods 0.000 description 10
- 230000000694 effects Effects 0.000 description 9
- 238000010586 diagram Methods 0.000 description 8
- 230000005489 elastic deformation Effects 0.000 description 8
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 7
- 230000008859 change Effects 0.000 description 5
- 230000002829 reductive effect Effects 0.000 description 5
- 230000009471 action Effects 0.000 description 3
- 238000013016 damping Methods 0.000 description 3
- 239000007921 spray Substances 0.000 description 3
- 238000013528 artificial neural network Methods 0.000 description 2
- 230000008901 benefit Effects 0.000 description 2
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000006073 displacement reaction Methods 0.000 description 2
- 238000009826 distribution Methods 0.000 description 2
- 230000005284 excitation Effects 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000037237 body shape Effects 0.000 description 1
- 230000008094 contradictory effect Effects 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 230000008030 elimination Effects 0.000 description 1
- 238000003379 elimination reaction Methods 0.000 description 1
- 238000001914 filtration Methods 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 238000012821 model calculation Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000001681 protective effect Effects 0.000 description 1
- 230000010349 pulsation Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000002441 reversible effect Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000001228 spectrum Methods 0.000 description 1
- 238000005507 spraying Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000005728 strengthening Methods 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
Landscapes
- Control And Safety Of Cranes (AREA)
Abstract
本发明公开了一种臂架轨迹优化方法、系统及包含该系统的工程机械,该方法包括:接收臂架的当前姿态以及目标位置,该当前姿态包括臂架的长度向量及角度向量;根据该当前姿态,确定所述臂架末端的当前位置;根据该当前位置及所述目标位置,规划所述臂架的轨迹;以及将该轨迹所涉及的姿态与预先存储的危险姿态进行比较,并在轨迹所涉及的姿态存在危险姿态时,重新规划轨迹,以使得重新规划后的轨迹不存在危险姿态。通过上述技术方案,可一些危险姿态,让臂架尽量处于稳定姿态,从而提高臂架在运动过程中的稳定性。
Description
技术领域
本发明涉及工程机械领域,具体地,涉及一种臂架轨迹优化方法、系统及包含该系统的工程机械。
背景技术
目前,国内外对臂架在运动过程的振动控制及轨迹控制的研究十分稀少。国内外高校及研究机构进行了很多针对压电智能材料应用于悬臂梁的主动控制的研究工作,其控制方式是通过压电材料的正逆压电效应对结构产生的变形进行抑制。另外,小松及国外的挖掘机公司曾对挖掘机的臂架结构的振动控制进行研究,国外著名消防车公司Magirus曾经就高空消防车臂架结构进行过轨迹控制以及简单的减振处理。
发明内容
本发明的目的是提供一种臂架轨迹优化方法、系统及包含该系统的工程机械。
为了实现上述目的,本发明提供一种臂架轨迹优化方法,该方法包括:接收臂架的当前姿态以及目标位置,该当前姿态包括臂架的长度向量及角度向量;根据该当前姿态,确定所述臂架末端的当前位置;根据该当前位置及所述目标位置,规划所述臂架的轨迹;以及将该轨迹所涉及的姿态与预先存储的危险姿态进行比较,并在轨迹所涉及的姿态存在危险姿态时,重新规划轨迹,以使得重新规划后的轨迹不存在危险姿态。
相应地,本发明还提供一种臂架轨迹优化系统,该系统包括:长度传感器,用于检测所述臂架各节臂的长度,得到所述臂架的长度向量;角度传感器,用于检测所述臂架各节臂的角度,得到所述臂架的角度向量;接收装置,用于接收臂架末端的目标位置;轨迹控制器,用于执行上述臂架轨迹优化方法。
相应地,本发明还提供一种工程机械,该工程机械包括上述系统。
通过上述技术方案,可一些危险姿态,让臂架尽量处于稳定姿态,从而提高臂架在运动过程中的稳定性。
本发明的其他特征和优点将在随后的具体实施方式部分予以详细说明。
附图说明
附图是用来提供对本发明的进一步理解,并且构成说明书的一部分,与下面的具体实施方式一起用于解释本发明,但并不构成对本发明的限制。在附图中:
图1示出了该高空消防车伸缩折叠臂的结构示意图;
图2为本发明提供的臂架控制系统的结构示意图;
图3为图1所示的伸缩折叠臂的简化模型图;
图4为在本发明的臂架控制系统的控制下施加至臂架的液压力与臂架的速度之间关系示意图;
图5为本发明提供的臂架轨迹规划流程图;
图6为本发明提供的臂架控制系统的另一实施方式的结构示意图;以及
图7为提高臂架运动稳定性的臂架控制方法流程图。
附图标记说明
10 长度传感器 20 角度传感器
30 速度传感器 40 控制器
50 液压系统 60 臂架
70 形变传感器
具体实施方式
以下结合附图对本发明的具体实施方式进行详细说明。应当理解的是,此处所描述的具体实施方式仅用于说明和解释本发明,并不用于限制本发明。
由于臂架在运动过程中,臂架的刚度变化较大,因此不能用静态的结构建模方式将此系统简化成固定的动力学方程。为此,本发明提出了一种基于变姿态臂架结构动力学模型的臂架运动过程中的振动控制方案。以下以高空消防车伸缩折叠臂为例进行说明,当然本发明并不限于此,本发明可适用于任何存在振动控制需求、稳定性控制、和/或轨迹规划的臂架。
图1示出了该高空消防车伸缩折叠臂的结构示意图,伸缩折叠臂是一种既可伸缩又可折叠的多节臂架,在此仅以两节折叠臂、多级伸缩臂的伸缩折叠臂作为实例对象进行说明。在下文的描述中,会涉及长度传感器,角度传感器、速度传感器、及应变传感器,需要说明的是,在传感器对外部数据进行采集的过程中,可对数据进行滤波处理。这种滤波处理的目的在于过滤掉信号中的干扰成分,例如由于颤振引起的高频振动和伸缩折叠臂的低频振动相叠加,从传感器中测量的数据中包含这两种成分,为了对所关注的低频振动进行有效的抑制,应根据具体的频率分布不同,设计滤波器将信号中包含的高频信号进行滤去,最后得到的信号主要由低频信号组成。
图2为本发明提供的臂架控制系统的结构示意图。如图2所示,该系统包括:长度传感器10于检测所述臂架60臂的长度,以得到该臂架60度向量;角度传感器20于检测所述臂架60臂的角度,以得到该臂架60度向量;速度传感器30于检测所述臂架60臂的速度,以得到该臂架60前速度向量;以及控制器40于根据所述长度向量及角度向量(该长度向量及角度向量即决定了臂架的当前姿态),确定与该当前姿态相对应的相对应的质量矩阵及刚度矩阵,将该质量矩阵及刚度矩阵代入所述臂架的结构动力学方程,根据该结构动力学方程进行主动振动控制,计算出反馈增益向量(在此,可对该结构动力学方程应用模态控制算法、PID控制算法、模糊控制算法、模糊神经网络、独立模态控制算法之一来计算出反馈增益向量,具体采用何种算法可取决于实际测出的臂架响应是否满足指标要求);以及根据该反馈增益向量及所述当前速度向量,施加一控制信号至液压系统50而控制该液压系统施加至所述臂架60压力,以在控制所述臂架60的同时,抑制所述臂架60。
其中,所述确定与该当前姿态相对应的质量矩阵及刚度矩阵包括:通过有限元计算方法建立不同姿态下臂架的刚度矩阵及质量矩阵数据库;拟合臂架的刚度矩阵及质量矩阵与臂架姿态之间的函数关系;以及根据该函数关系,确定所述臂架在所述当前姿态下的质量矩阵及刚度矩阵。举例而言,所述刚度矩阵与臂架姿态之间的函数关系可被拟合如下:
其中,为所述臂架的角度向量,L为所述臂架的长度向量,a及b均为拟合系数。
其中,所述臂架的结构动力学方程可通过以下步骤构建:可将图1所示的伸缩折叠臂简化成如图3所示的多自由柔性臂架模型,第一号臂总共有M1个伸缩臂,第二号臂总共有M2个伸缩臂。各节伸缩臂之间通过滑移副进行约束,同时伸缩臂建立接触。第一号臂与第二号臂之间建立转动副,飞臂与第二号臂之间建立转动副,同时飞臂与工作平台之间建立转动副。其中每节伸缩臂分别用多个梁单元节点进行模拟,以提高计算精度。根据建立的多自由度柔性臂架模型应用拉格朗日方法可建立结构动力学方程。
为了使模型计算精度更加可靠在结构动力学方程中引入风载荷和喷水载荷:风载荷按照中国建筑结构荷载规范(GBJ9-89)计算:
fw(z,t)=usD(z)w(z,t)
式中,D(z)是迎风面积;us是体型系数;w(z,t)是z高度处的动风压;uz是风脉动系数;w0(t)是10m高度处的风压;α=0.16是粗糙度系数;ρ=0.00125kg/m3表示空气密度;是设计风速常量,v(t)是10m处的脉动风速,按Davenport谱确定。
喷水载荷作用模型如下:
fw=βρπ(d/2)2v
其中ρ是水密度;d是水管直径;v是水流速度;β是喷水载荷系数;
根据多自由度柔性臂架模型和载荷作用模型得到动力学方程:
e=G+fw+fw(z,t)
x(t0)=x0
其中,x分别代表臂架的加速度、速度及位移向量,M表示臂架的质量矩阵,G表示载重量,C表示臂架的阻尼矩阵,K表示臂架的刚度矩阵,F表示臂架液压作动器控制力,e表示臂架总的外激励载荷,fw为喷水载荷,fw(z,t)为动力风载荷,Es为外部激励定位矩阵;Bs为作动器位置矩阵;x0、分别为结构的初始位移和初始速度向量。
根据结构动力学方程运用结构振动控制算法进行求解得到液压作动器控制力与臂架结构状态向量(本文为速度向量)的作用关系F=Ga*V
结构振动控制算法包括模态控制算法、PID控制算法、模糊控制算法、模糊神经网络等,其中以模态空间控制算法举例:
伸缩折叠臂柔性臂架模型自由度较多,方程之间各参数相互耦合这导致求解变的十分困难。通过独立空间模态方法,消除了耦合,在反馈中的反馈控制力完全独立于解耦的独立模态,因此可以减少控制器的阶数,使控制系统的设计得到简化。
其中一种控制算法通过动力学模态计算得到固有频率ωi以及相应的模态矩阵Φ=[φ1,φ2,…φn]。首先进行坐标变化将原有的{x}坐标替换为η=[η1,η2,…ηn]T,方程两边同时乘以ΦT矩阵得到广义模态坐标运动方程:
其中M*=ΦTMΦ,C*=ΦTCΦ,K*=ΦTKΦ,f=ΦTBsF
将广义模态坐标运动方程写成状态方程的形式:
其中为状态向量,Ai,Bi,Di分别为结构的系数矩阵、干扰矩阵、控制矩阵,且满足以下关系:
其中,ξi表示表示各阶模态阻尼比。
接着进行模态截断截去高阶模态可得:
最后通过线性2次型最优控制理论,设置合理的权矩阵Qi和常数Ri,控制力F及反馈增益的计算可通过下述方程得到:
Ga=lqr(Ai,Bi,Qi,Ri)
F=Ga*V
其中,lqr()为计算工具中常用的函数公式。
具体而言,其中,所述控制器控制所述液压系统施加至所述臂架的液压力可满足以下公式:
F=Ga*V
其中,F为所述液压力,Ga为所述反馈增益向量,V为所述当前速度向量。藉此,可保证液压力的方向和振动方向(该振动方向与速度方向相反)始终处于反方向,液压力始终阻碍臂架的振动,而不是加强臂架的振动,减少液压力时滞对系统的影响(具体原理将在以下进行分析)。当然,本发明并不限于该具体的公式,只要可达到减少液压力时滞对系统的影响、抑制臂架振动的效果,对该公式进行稍微的调整亦是可行的。
液压系统的时滞性是指从控制信号到油缸中的液压力达到控制信号所要求的液压力的大小这个过程中所要耗费的时间。一般来说时滞性越大,可控性则越差,两者是反比关系。良好的控制系统的建立需要解决液压系统时滞的影响。从理论上讲液压力越接近理论值,控制效果越好;同时液压力变化幅度越大,时滞性也越大,从而使得液压力偏离了预期的理论值,控制效果则会变差。这两者是矛盾关系,因此实际输出的液压力应在理论液压力的基础上进行调整。
图4为在本发明的臂架控制系统的控制下施加至臂架的液压力与臂架的速度之间关系示意图。如图4所示,当时刻为t1,t2,t3,t4时,臂架的运动速度为0,这时候臂架运动的方向将从正方向变为逆方向,如果此时刻对应的液压力不能很快的变换液压力作用方向,那么此臂架控制系统的振动控制效果会大大降低,严重时有可能对系统的振动起到加大作用。而通过本发明的臂架控制系统的控制,在臂架速度到达0的时刻,让液压系统的液压力也正好为0,这时液压系统能够迅速的调节液压力的方向,同时液压时滞的影响也最小。当然,以上将速度的变化趋势采用三角波的方式进行模拟仅仅是示例性的,而实际中可能是正弦波,或其他形式,这些都不影响这种控制策略的应用。本发明对液压力的控制方式不但能实现液压力连续的变化,降低液压力本身的冲击效应,同时保证液压力和振动方向始终处于反方向,从而使得液压力始终抑制结构振动,并且将液压系统的时滞效应带来的负面影响降到最低。
以上针对振动抑制及消除时滞影响方面对本发明的臂架控制系统进行了说明,以下针对轨迹规划来对本发明的臂架控制系统进行说明。需要说明的是,本实施例可与上述振动抑制及消除时滞影响的实施例结合使用,即所述控制器可根据本实施例所规划的轨迹来控制液压系统,然而其在控制液压系统施加液压力时,需如上述实施例那样进行控制,从而振动抑制并消除时滞影响。
一般而言,臂架(尤其是超长臂架)柔度较大,运动过程中变形很大,不同姿态下系统的刚度不同,因此对变幅运动及伸缩运动的正确规划能够确定最佳的刚度姿态,从而大幅度提高结构运动过程的稳定性,降低运动过程中的振动幅度。
图5为本发明提供的臂架轨迹规划流程图。如图5所示,所述控制器可接收臂架的当前姿态以及目标位置,该当前姿态包括臂架的长度向量及角度向量;根据该当前姿态,确定所述臂架末端的当前位置;根据该当前位置及所述目标位置,规划所述臂架的轨迹;以及将该轨迹所涉及的姿态与预先存储的危险姿态进行比较,并在轨迹所涉及的姿态存在危险姿态时,重新规划轨迹,以使得重新规划后的轨迹不存在危险姿态。藉此,避开这些危险姿态,让臂架尽量处于稳定姿态,从而提高臂架在运动过程中的稳定性。
其中,所述预先存储的危险姿态通过以下步骤确定:通过上述有限元计算方法及拟合的函数,确定所述臂架在每一姿态下的刚度矩阵;以及在所述刚度矩阵的竖直方向刚度或扭转刚度小于相应的预设值时,确定该刚度矩阵所对应的姿态为危险姿态,存储该危险姿态。通过该过程,可建立危险姿态数据库,在规划臂架运动轨迹时,可参考该危险姿态数据库。
具体而言,臂架在空间中的刚度分布可表示为一函数关系K(l1(t),l2(t),....lm(t),θ1(t),θ2(t).....θn(t)),其变量为该臂架的m节伸缩臂的长度l1,l2,……,lm;,n节折叠臂的角度θ1,θ2,……,θn。在臂架运动过程中,该长度及角度均是时间t的函数,其需满足边界条件:
θ1'<θ1(t)<θ1″,θ2'<θ2(t)<θ2″,……,θn'<θn(t)<θn″;
l1'<l1(t)<l1″,l2'<l2(t)<l2″,……,lm'<lm(t)<lm″,
其中,其中,θ1(t),θ2(t),……,θn(t)分别表示所述臂架的n节折叠臂的角度与时间t的函数;l1(t),l2(t),……,lm(t)分别表示所述臂架的m节伸缩臂的长度与时间t的函数;θ1',θ2',……,θn'分别表示所述臂架的n节折叠臂的最小允许角度;θ1",θ2″,……,θn″分别表示所述臂架的n节折叠臂的最大允许角度;l1',l2',……,lm'分别表示所述臂架的m节伸缩臂的最小允许长度;l1",l2″,……,lm″分别表示所述臂架的m节伸缩臂的最大允许长度。
另外,所述臂架在运动过程中可能还需要满足时间约束条件:
t<t1,
其中,t1表示所述臂架末端到达所述目标位置所消耗的时间最大允许值。
整体而言,在需要控制臂架末端从当前位置到目标位置时,寻找出最佳的长度及角度随时间变化的函数关系,以满足超长臂架运动过程中刚度最佳的状态从而抑制振动,并且使运动时间在规定值范围内,是解决超长臂架运动稳定性的核心问题。此种轨迹优化方式是求解泛函
K(l1(t),l2(t),....lm(t),θ1(t),θ2(t).....θn(t))在边界条件及时间约束下的最值问题。
以上对臂架运动的轨迹优化进行了说明,下面单从臂架稳定性控制方面对本发明的臂架控制系统进行说明,需要说明的是,以下所描述的控制方式可与上述轨迹规划实施方式相结合,但独立于上述抑制振动并解决时滞问题的实施方式,故以下单独对该实施方式进行描述。
图6为本发明提供的臂架控制系统的另一实施方式的结构示意图,图7为提高臂架运动稳定性的臂架控制方法流程图。如图6及图7所示,本发明提供一种用于提高臂架运动稳定性的臂架控制系统,该系统包括:应变传感器70于检测所述臂架60的弹性形变;以及控制器40于在控制所述臂架60轨迹(该轨迹可为按照上述轨迹规划实施方式得到的轨迹)运动期间,在所述弹性形变超出预定范围时,降低所述臂架60动速度。由于臂架运动速度越快,其所承受的动载荷越大,因此降低臂架运动速度有助于减少臂架的弹性变形,提高臂架的稳定性。
优选地,所述控制器还在控制所述臂架沿所述轨迹运动期间,在所述弹性形变小于所述预定范围内时,提高所述臂架的运动速度。藉此,可不但考虑到臂架运动的稳定性,而且还适当调节运动速度从而保证运行的时间较短,实现运动过程又快又稳的功能需求。
其中,所述应变传感器可安装于臂架的末端或者安装于臂架每节臂的末端。当安装于每节臂末端时,所述控制器可在任一应变传感器所检测的弹性形变超出预定范围时,便降低臂架的运动速度。
所述提高或降低臂架的运动速度是通过液压系统50液压力实现的。当在臂架运动过程中所检测到的弹性变形较大时,控制器可输出控制信号,控制液压系统调节液压力,使得臂架的变幅或伸缩运动的速度及角速度适当减慢,从而控制臂架的弹性变形返回到理想状态;当在臂架运动过程中所检测到的弹性变形较小时,控制器可输出控制信号,控制液压系统调节液压力,控制臂架的变幅或伸缩运动的速度及角速度适当加快,从而缩短整个臂架的运动的时间。其中伸缩折叠臂初始的运动速度及角速度可通过手柄控制电液比例控制输入,也可通过轨迹控制器中预设矩阵输入。
相应地,本发明还提供了有关上述系统的相应方法,具体细节及益处与上述系统相类似,于此不再赘述。
相应地,本发明还提供了一种工程机械,该工程机械包括根上述臂架控制系统。该工程机械可包括任何包含臂架的工程机械,诸如泵车、消防车、起重机等。
以上结合附图详细描述了本发明的优选实施方式,但是,本发明并不限于上述实施方式中的具体细节,在本发明的技术构思范围内,可以对本发明的技术方案进行多种简单变型,这些简单变型均属于本发明的保护范围。
另外需要说明的是,在上述具体实施方式中所描述的各个具体技术特征,在不矛盾的情况下,可以通过任何合适的方式进行组合。为了避免不必要的重复,本发明对各种可能的组合方式不再另行说明。
此外,本发明的各种不同的实施方式之间也可以进行任意组合,只要其不违背本发明的思想,其同样应当视为本发明所公开的内容。
Claims (8)
1.一种臂架轨迹优化方法,其特征在于,该方法包括:
接收臂架的当前姿态以及目标位置,该当前姿态包括臂架的长度向量及角度向量;
根据该当前姿态,确定所述臂架末端的当前位置;
根据该当前位置及所述目标位置,规划所述臂架的轨迹;以及
将该轨迹所涉及的姿态与预先存储的危险姿态进行比较,并在轨迹所涉及的姿态存在危险姿态时,重新规划轨迹,以使得重新规划后的轨迹不存在危险姿态。
2.根据权利要求1所述的方法,其特征在于,所述预先存储的危险姿态通过以下步骤确定:
确定所述臂架在每一姿态下的刚度矩阵;以及
在所述刚度矩阵的竖直方向刚度或扭转刚度小于相应的预设值时,确定该刚度矩阵所对应的姿态为危险姿态,存储该危险姿态。
3.根据权利要求2所述的方法,其特征在于,确定所述臂架在每一姿态下的刚度矩阵包括:
通过有限元计算方法建立不同姿态下臂架的刚度矩阵数据库;
拟合臂架的刚度矩阵与臂架姿态之间的函数关系;以及
根据该函数关系,确定所述臂架在所述每一姿态下的质量矩阵。
4.根据权利要求1-3中任一项权利要求所述的方法,其特征在于,所规划的臂架轨迹满足:
θ1'<θ1(t)<θ1″,θ2'<θ2(t)<θ2″,……,θn'<θn(t)<θn″;及
l1'<l1(t)<l1″,l2'<l2(t)<l2″,……,lm'<lm(t)<lm″,
其中,θ1(t),θ2(t),……,θn(t)分别表示所述臂架的n节折叠臂的角度与时间t的函数;l1(t),l2(t),……,lm(t)分别表示所述臂架的m节伸缩臂的长度与时间t的函数;θ1',θ2',……,θn'分别表示所述臂架的n节折叠臂的最小允许角度;θ1",θ2″,……,θn″分别表示所述臂架的n节折叠臂的最大允许角度;l1',l2',……,lm'分别表示所述臂架的m节伸缩臂的最小允许长度;1l",l2″,……,lm″分别表示所述臂架的m节伸缩臂的最大允许长度。
5.根据权利要求4所述的方法,其特征在于,所规划的臂架轨迹满足:t<t1,
其中,t1表示所述臂架末端到达所述目标位置所消耗的时间最大允许值。
6.根据权利要求1所述的方法,其特征在于,所述臂架为伸缩折叠臂。
7.一种臂架轨迹优化系统,其特征在于,该系统包括:
长度传感器,用于检测所述臂架各节臂的长度,得到所述臂架的长度向量;
角度传感器,用于检测所述臂架各节臂的角度,得到所述臂架的角度向量;
接收装置,用于接收臂架末端的目标位置;
轨迹控制器,用于执行根据权利要求1-6中任一项权利要求所述的方法。
8.一种工程机械,其特征在于,该工程机械包括根据权利要求7所述的系统。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210590274.1A CN103075011B (zh) | 2012-12-31 | 2012-12-31 | 臂架轨迹优化方法、系统及包含该系统的工程机械 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210590274.1A CN103075011B (zh) | 2012-12-31 | 2012-12-31 | 臂架轨迹优化方法、系统及包含该系统的工程机械 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103075011A CN103075011A (zh) | 2013-05-01 |
CN103075011B true CN103075011B (zh) | 2015-07-15 |
Family
ID=48151697
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210590274.1A Active CN103075011B (zh) | 2012-12-31 | 2012-12-31 | 臂架轨迹优化方法、系统及包含该系统的工程机械 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103075011B (zh) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103309352B (zh) * | 2013-07-03 | 2016-03-23 | 中联重科股份有限公司 | 一种臂架智能控制装置、系统、方法和工程机械 |
CN103537029B (zh) * | 2013-11-07 | 2016-02-24 | 徐州重型机械有限公司 | 一种消防车安全作业范围保护方法及装置 |
CN106840491B (zh) * | 2016-12-24 | 2019-06-11 | 北汽福田汽车股份有限公司 | 泵车臂架的受载检测方法、装置及泵车 |
BR102018015016A2 (pt) * | 2018-07-23 | 2020-02-04 | Companhia Paulista De Forca E Luz Cpfl | sistema para poda mecanizada em área urbana |
CN109573843B (zh) * | 2018-12-20 | 2020-08-11 | 国网北京市电力公司 | 吊车控制方法、系统及装置、终端 |
CN111729228A (zh) * | 2020-06-17 | 2020-10-02 | 北京中卓时代消防装备科技有限公司 | 高空救援消防车及其智能控制系统、智能控制方法 |
CN113233353B (zh) * | 2021-06-08 | 2023-06-23 | 三一海洋重工有限公司 | 一种起重机的自动控制方法及装置、起重机 |
CN116730200B (zh) * | 2023-08-15 | 2023-10-13 | 贵州省公路工程集团有限公司 | 一种缆索吊装方法、系统、计算机设备及存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0971387A (ja) * | 1995-09-05 | 1997-03-18 | Tadano Ltd | クレーン車における吊荷位置表示装置 |
RU2305063C2 (ru) * | 2005-10-31 | 2007-08-27 | Общество с ограниченной ответственностью "Научно-производственное предприятие "Резонанс" | Способ управления грузоподъемным краном |
CN101665216A (zh) * | 2009-09-29 | 2010-03-10 | 三一集团有限公司 | 一种岸桥集装箱吊具运行轨迹的控制方法、系统和装置 |
CN101723248A (zh) * | 2009-12-02 | 2010-06-09 | 上海能港电气工程科技有限公司 | 旋转式起重机轨迹优化控制系统及其控制方法 |
CN102345389A (zh) * | 2011-07-14 | 2012-02-08 | 长沙中联重工科技发展股份有限公司 | 工程机械以及机械臂的控制方法与控制装置 |
CN101723249B (zh) * | 2009-12-15 | 2012-10-17 | 闫永德 | 起重机械运行数据实时网络化监控及预警系统 |
-
2012
- 2012-12-31 CN CN201210590274.1A patent/CN103075011B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0971387A (ja) * | 1995-09-05 | 1997-03-18 | Tadano Ltd | クレーン車における吊荷位置表示装置 |
RU2305063C2 (ru) * | 2005-10-31 | 2007-08-27 | Общество с ограниченной ответственностью "Научно-производственное предприятие "Резонанс" | Способ управления грузоподъемным краном |
CN101665216A (zh) * | 2009-09-29 | 2010-03-10 | 三一集团有限公司 | 一种岸桥集装箱吊具运行轨迹的控制方法、系统和装置 |
CN101723248A (zh) * | 2009-12-02 | 2010-06-09 | 上海能港电气工程科技有限公司 | 旋转式起重机轨迹优化控制系统及其控制方法 |
CN101723249B (zh) * | 2009-12-15 | 2012-10-17 | 闫永德 | 起重机械运行数据实时网络化监控及预警系统 |
CN102345389A (zh) * | 2011-07-14 | 2012-02-08 | 长沙中联重工科技发展股份有限公司 | 工程机械以及机械臂的控制方法与控制装置 |
Also Published As
Publication number | Publication date |
---|---|
CN103075011A (zh) | 2013-05-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103092073B (zh) | 抑制臂架振动的控制方法及系统 | |
CN103075011B (zh) | 臂架轨迹优化方法、系统及包含该系统的工程机械 | |
CN103064425B (zh) | 提高臂架运动稳定性的方法、系统及工程机械 | |
Moallem et al. | An integral manifold approach for tip-position tracking of flexible multi-link manipulators | |
Huang et al. | Designing active flutter suppression for high-dimensional aeroelastic systems involving a control delay | |
Zhang et al. | Experimental implementation on vibration mode control of a moving 3-PRR flexible parallel manipulator with multiple PZT transducers | |
Zimmert et al. | 2-DOF control of a fire-rescue turntable ladder | |
Masoud et al. | Pendulation reduction on small ship-mounted telescopic cranes | |
CN103092225A (zh) | 用于臂架振动主动控制的控制器、系统以及方法 | |
Alexander et al. | Active vibration damping in hydraulic construction machinery | |
Hu et al. | Vibration Control of Smart Structure Using Sliding Mode Control with Observer. | |
Alandoli et al. | A review study on flexible link manipulators | |
Wanner et al. | A lumped parameter model of the boom of a mobile concrete pump | |
CN110220661A (zh) | 一种两自由度电液振动台自抗扰控制方法 | |
Korytov et al. | Impact sigmoidal cargo movement paths on the efficiency of bridge cranes | |
Pedersen et al. | Comparison of methods for modeling a hydraulic loader crane with flexible translational links | |
Liu et al. | Tracking performance improvements of an electrohydraulic Gough-Stewart platform using a fuzzy incremental controller | |
Wang et al. | Tip-position/velocity tracking control of manipulator for hull derusting and spray painting based on active disturbance rejection control | |
CN114312196B (zh) | 基于模型补偿的钟摆式悬架控制方法及其参数测量方法 | |
Hedrich | Active pneumatic suspension for future autonomous vehicles: design, prove of concept and hardware-in-the-loop simulations | |
Samin et al. | A hybrid controller for control of a 3-DOF rotary crane system | |
Al-Sweiti et al. | RETRACTED ARTICLE: Cargo pendulation suppression of ship cranes with elastic booms | |
Jensen et al. | Development of 3D Anti-Swing Control for Hydraulic Knuckle Boom Crane | |
Yang et al. | Research on a Variable Universe Control Method and the Performance of Large Sprayer Active Suspension Based on an Artificial Fish Swarm Algorithm–Back Propagation Fuzzy Neural Network | |
Burch et al. | Feedback control of a soft swinging appendage |
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 |