一种臂架运动自适应控制方法及消防车的利记博彩app
【技术领域】
[0001] 本发明设及一种臂架运动自适应控制方法及消防车，属于工程机械技术领域。
【背景技术】
[0002] 当前消防车臂架运动的控制方法均采用分段线性比例控制，如图1、图2、图3所 示，W消防车臂架结构形式是主伸缩臂和单节曲臂为例，臂架运动的起始进行线性加速、中 间段W最大速度匀速运行、接近极限位置进行线性减速。W图2伸缩为例，初始加速段，伸 缩速度系数=kl*伸缩长度化1为常数）；中间匀速段，伸缩速度系数=1 ;末尾减速段，伸 缩速度系数=k3*伸缩长度化3为常数），具体控制方法是；在主臂变幅、伸缩、曲臂展收的 始末给定减速一次方程式，臂架按此关系式加速和减速运行。
[0003] 简单的分段线性控制，难W连续、平稳控制油缸运行速度，首先在不同减速一次式 转折点存在难W跳越的抖动点；其次运动起始和接近极限位置的线性减速，做不到软启动、 软停止，不可避免产生振动；另外，此控制方法没有对实际运行速度监控和调节，外力或其 它因素会影响实际速度偏罔预定速度。
[0004] 现有消防车臂架运动（变幅、伸缩、曲臂展收）的过程不稳定，起始阶段和快到极 限位置时会抖动，及由臂架抖动造成整车晃动；运动过程中有个别抖动点；因此消防车臂 架运动稳定性和可靠性有待进一步提高。
【发明内容】
[0005] 针对上述现有技术存在的问题，本发明提供一种臂架运动自适应控制方法及消防 车，臂架运行光滑、平稳、连续，对速度实时监控和预调节，使实际速度按设定速度自适应运 行，排除外力干扰。
[0006] 为了实现上述目的，本发明采用的技术方案是：一种臂架运动自适应控制方法，
[0007] 在控制器中预存由综合臂架结构特性、油缸运动特性和专家经验制定的臂架运动 速度曲线，
[000引手动动作时；W手柄推动方向来选择臂架运动曲线类型；根据传感器所测数据自 适应选择曲线中对应速度，并由手柄推动位置自适应选择设定速度与速度曲线中对应速度 之间的系数；自动动作时；根据动作逻辑确定曲线运行顺序，按传感器所测数据自适应选 择曲线中对应速度；自动动作时系数是1;
[0009] 根据设定速度给定输出电流，输出电流随设定速度自适应变化；
[0010] 对传感器输入的数据微分和滤波，得到实际速度；对实际速度微分得到相应的加 速度大小和方向；
[0011] 当实际速度超过设定速度一定范围，根据加速度大小和方向对输出电流微调，使 速度向着设定方向变化。
[0012] 进一步的，在控制器中预存由综合臂架结构特性、油缸运动特性和专家经验制定 的臂架运动速度曲线包括变幅角度-变幅速度曲线、伸缩长度-伸缩速度曲线、主曲臂夹 角-曲臂展收速度曲线。
[0013] 进一步的，传感器包括主臂角度传感器、长度传感器、曲臂角度传感器，=种传感 器分别检测的数据为变幅角度、伸缩长度、曲臂角度。
[0014] 进一步的，变幅角度-变幅速度曲线、伸缩长度-伸缩速度曲线和主曲臂夹角-曲 臂展收速度曲线的变化趋势相似。
[0015] 为了实现上述目的，本发明还提供一种消防车，其包括上述的臂架运动自适应控 制方法。
[0016] 本发明的有益效果是；臂架按照设定的平滑的臂架运动速度曲线（包括伸缩、变 幅、曲臂）自适应运行使臂架软启动、软停止、运行性能良好；提高了臂架运动可靠性、稳定 性；对传感器输入数据微分并进行滤波得到实际速度，对速度微分得到加速度；与设定速 度比较，超出一定范围根据加速度对输出电流微调；做到了对速度实时监控和预调节，使实 际速度按设定速度自适应运行，排除外力干扰，提高运行精度和运行稳定性。
【附图说明】
[0017]图1为【背景技术】中消防车臂架变幅角度-变幅速度曲线图；
[0018] 图2为【背景技术】中消防车臂架伸缩长度-伸缩速度曲线图；
[0019] 图3为【背景技术】中消防车臂架主曲臂夹角-曲臂展收速度曲线图；
[0020] 图4为本发明消防车臂架变幅角度-变幅速度曲线图；
[0021] 图5为本发明消防车臂架伸缩长度-伸缩速度曲线图；
[0022] 图6为本发明消防车臂架主曲臂夹角-曲臂展收速度曲线图；
[0023] 图7为本发明控制流程图。
【具体实施方式】
[0024] 下面结合附图对本发明作进一步说明。
[0025] 如图7所示，本臂架运动自适应控制方法，
[0026] 在控制器中预存由综合臂架结构特性、油缸运动特性和专家经验制定的臂架运动 速度曲线，臂架运动速度曲线包括变幅角度-变幅速度曲线、伸缩长度-伸缩速度曲线、主 曲臂夹角-曲臂展收速度曲线，变幅角度-变幅速度曲线、伸缩长度-伸缩速度曲线和主曲 臂夹角-曲臂展收速度曲线的变化趋势相似，手动动作时；W手柄推动方向来选择臂架运 动曲线类型；自动动作时；根据动作逻辑确定曲线运行顺序，按传感器所测数据自适应选 择曲线中对应速度；
[0027] 传感器包括主臂角度传感器、长度传感器、曲臂角度传感器，=种传感器分别检测 的数据为变幅角度、伸缩长度、曲臂角度，根据传感器所测数据：变幅角度、伸缩长度、曲臂 角度，自适应选择曲线中对应变幅速度、伸缩速度、曲臂展收速度，并由手柄推动位置自适 应选择设定速度与速度曲线中对应速度之间的系数；自动动作时系数是1 ;
[002引根据设定速度给定输出电流，输出电流随设定速度自适应变化；
[0029] 对传感器输入的变幅角度、伸缩长度、曲臂展收速度微分和滤波，得到实际变幅速 度、伸缩速度、曲臂展收速度；对实际变幅速度、伸缩速度、曲臂展收速度微分得到相应的加 速度大小和方向；
[0030] 当实际速度超过设定速度一定范围，根据加速度大小和方向对输出电流微调，使 速度向着设定方向变化。
[0031] 实施例，W臂架伸缩曲线为例，曲线公式：
[0032] 如图5所示，臂架伸缩长度LG0~11，伸缩速度VI=kl*x2,化11x3=LkUkll 为常数）；臂架伸缩长度LGL1~L2,伸缩速度V2=Cl+k2*i^{L-C3)/C4C5+说），化2、 (：1、〔3、〔4、〔5、〔6为常数）；
[0033] 臂架伸缩长度LGL2~L3,伸缩速度V3=Ax2+Bx+C
[0034] (4、8、(：为常数，化3江-〔7)/(又0+〔8))八又0-〔9)=又0，又=又0+(：10，1^3、〔7、〔8、〔9、 CIO为常数）；
[0035] 臂架伸缩长度LGL3~L4,伸缩速度V4 =C11，C11为常数；
[0036] 臂架伸缩长度LGL4~15,伸缩速度V3 =A1x2+B1x+C1
[0037] (A1、B1、C1 为常数，（k4(L-Cll)/(x〇-C12))/(xO+C13)=x0，x=xO+C14，k4、Cll、 C12、C13、C14 为常数）；
[003引LGL5~L6的速度可对称到LI~L2对应速度公式上计算；
[0039] LGL6~L7的速度可对称到L0~L1对应速度公式上计。
[0040] 由此可见臂架伸缩的始终，臂架伸缩速度相对臂架伸缩长度都是大于1次方的关 系，使臂架平稳运行；且减速关系式得到的整个曲线光滑、平缓，不会在不同伸缩段分界点 出现使臂架抖动的速度变化值。
[0041] 另外，实际伸缩速度二化/dt，当曲线中对应伸缩速度和实际伸缩速度相差超过 一定范围，根据理论加速度a=dVMt的大小和方向对传感器输出电流微调。
[0042] 同理，参照图4和图6,臂架变幅、曲臂展收都可W通过同样的方法来控制，实现消 防车臂架按照设定的平滑的臂架运动速度曲线自适应运行，使臂架软启动、软停止、运行性 能良好；提高了臂架运动可靠性、稳定性。
【主权项】
1. 一种臂架运动自适应控制方法，其特征在于， 在控制器中预存由综合臂架结构特性、油缸运动特性和专家经验制定的臂架运动速度 曲线， 手动动作时：以手柄推动方向来选择臂架运动曲线类型；根据传感器所测数据自适应 选择曲线中对应速度，并由手柄推动位置自适应选择设定速度与速度曲线中对应速度之间 的系数；自动动作时：根据动作逻辑确定曲线运行顺序，按传感器所测数据自适应选择曲 线中对应速度；自动动作时系数是1; 根据设定速度给定输出电流，输出电流随设定速度自适应变化； 对传感器输入的数据微分和滤波，得到实际速度；对实际速度微分得到相应的加速度 大小和方向； 当实际速度超过设定速度一定范围，根据加速度大小和方向对输出电流微调，使速度 向着设定方向变化。2. 根据权利要求1所述的一种臂架运动自适应控制方法，其特征在于， 所述的在控制器中预存由综合臂架结构特性、油缸运动特性和专家经验制定的臂架运 动速度曲线包括变幅角度-变幅速度曲线、伸缩长度-伸缩速度曲线、主曲臂夹角-曲臂展 收速度曲线。3. 根据权利要求1所述的一种臂架运动自适应控制方法，其特征在于， 所述的传感器包括主臂角度传感器、长度传感器、曲臂角度传感器，三种传感器分别检 测的数据为变幅角度、伸缩长度、曲臂角度。4. 根据权利要求2所述的一种臂架运动自适应控制方法，其特征在于， 所述的变幅角度-变幅速度曲线、伸缩长度-伸缩速度曲线和主曲臂夹角-曲臂展收 速度曲线的变化趋势相似。5. -种消防车，其特征在于，包括如权利要求1-4任一项所述的臂架运动自适应控制 方法。
【专利摘要】本发明公开一种臂架运动自适应控制方法及消防车，在控制器中预存综合臂架结构特性、油缸运动特性和专家经验制定的臂架运动速度曲线，以手柄选择臂架运动曲线类型；根据传感器所测数据自适应选择曲线中对应速度，并由手柄推动位置自适应选择设定速度与速度曲线中对应速度之间的系数,自动动作时系数是1；根据设定速度给定输出电流，输出电流随设定速度自适应变化；对传感器输入的数据微分和滤波得到实际速度；对实际速度微分得到相应的加速度大小和方向；当实际速度超过设定速度一定范围，对输出电流微调，使速度向着设定方向变化。对速度实时监控和预调节，使实际速度真正按设定速度自适应运行，从而排除外力干扰，使臂架运行光滑、平稳、连续。
【IPC分类】A62C37/00, A62C27/00
【公开号】CN104906735
【申请号】CN201510191716
【发明人】田文娟, 阚四华, 魏浩
【申请人】徐州重型机械有限公司
【公开日】2015年9月16日
【申请日】2015年4月21日