[发明专利]抑制臂架振动的控制方法及系统

说明书

技术领域

本发明涉及工程机械领域，具体地，涉及一种用于抑制臂架振动的控制方法及系统。

背景技术

目前，国内外对臂架在运动过程的振动控制及轨迹控制的研究十分稀少。国内外高校及研究机构进行了很多针对压电智能材料应用于悬臂梁的主动控制的研究工作，其控制方式是通过压电材料的正逆压电效应对结构产生的变形进行抑制。另外，小松及国外的挖掘机公司曾对挖掘机的臂架结构的振动控制进行研究，国外著名消防车公司Magirus曾经就高空消防车臂架结构进行过轨迹控制以及简单的减振处理。

发明内容

本发明的目的是提供一种用于抑制臂架振动的控制方法及系统。

为了实现上述目的，本发明提供一种用于抑制臂架振动的控制方法，该方法包括：接收臂架的当前姿态及当前速度向量，该臂架的当前姿态包括臂架的长度向量及角度向量；根据该当前姿态，确定与该当前姿态相对应的质量矩阵及刚度矩阵；将该质量矩阵及刚度矩阵代入所述臂架的结构动力学方程，根据该结构动力学方程进行主动振动控制，计算出反馈增益向量；以及根据所述反馈增益向量及所述当前速度向量，控制施加至所述臂架的液压力，以抑制所述臂架振动。

相应地，本发明还提供一种用于抑制臂架振动的控制系统，该系统包括：长度传感器，用于检测所述臂架各节臂的长度，得到所述臂架的长度向量；角度传感器，用于检测所述臂架各节臂的角度，得到所述臂架的角度向量；速度传感器，用于检测所述臂架各节臂的速度，得到所述臂架的速度向量；以及振动控制器，用于执行上述控制方法。

通过上述技术方案，可进行变姿态建模，得到当前姿态下的反馈增益向量，并根据该反馈增益向量及速度传感器的反馈来控制液压力，可有效抑制臂架振动。

本发明的其他特征和优点将在随后的具体实施方式部分予以详细说明。

附图说明

附图是用来提供对本发明的进一步理解，并且构成说明书的一部分，与下面的具体实施方式一起用于解释本发明，但并不构成对本发明的限制。在附图中：

图1示出了该高空消防车伸缩折叠臂的结构示意图；

图2为本发明提供的臂架控制系统的结构示意图；

图3为图1所示的伸缩折叠臂的简化模型图；

图4为在本发明的臂架控制系统的控制下施加至臂架的液压力与臂架的速度之间关系示意图；

图5为本发明提供的臂架轨迹规划流程图；

图6为本发明提供的臂架控制系统的另一实施方式的结构示意图；以及

图7为提高臂架运动稳定性的臂架控制方法流程图。

附图标记说明

10     长度传感器     20     角度传感器

30     速度传感器     40     控制器

50     液压系统       60     臂架

70     形变传感器

具体实施方式

以下结合附图对本发明的具体实施方式进行详细说明。应当理解的是，此处所描述的具体实施方式仅用于说明和解释本发明，并不用于限制本发明。

由于臂架在运动过程中，臂架的刚度变化较大，因此不能用静态的结构建模方式将此系统简化成固定的动力学方程。为此，本发明提出了一种基于变姿态臂架结构动力学模型的臂架运动过程中的振动控制方案。以下以高空消防车伸缩折叠臂为例进行说明，当然本发明并不限于此，本发明可适用于任何存在振动控制需求、稳定性控制、和/或轨迹规划的臂架。

图1示出了该高空消防车伸缩折叠臂的结构示意图，伸缩折叠臂是一种既可伸缩又可折叠的多节臂架，在此仅以两节折叠臂、多级伸缩臂的伸缩折叠臂作为实例对象进行说明。在下文的描述中，会涉及长度传感器，角度传感器、速度传感器、及应变传感器，需要说明的是，在传感器对外部数据进行采集的过程中，可对数据进行滤波处理。这种滤波处理的目的在于过滤掉信号中的干扰成分，例如由于颤振引起的高频振动和伸缩折叠臂的低频振动相叠加，从传感器中测量的数据中包含这两种成分，为了对所关注的低频振动进行有效的抑制，应根据具体的频率分布不同，设计滤波器将信号中包含的高频信号进行滤去，最后得到的信号主要由低频信号组成。