一种混凝土泵车及臂架控制方法与控制装置制造方法及图纸

本发明专利技术公开了一种臂架控制方法，包括以下几个步骤：步骤1：根据臂架当前位置至下一个目标位置建立数学模型；根据各节臂移动量最小和运动平稳性原则，建立目标约束函数；步骤2：获取遥控器动作信号、臂架的各节臂当前状态角度信号、臂架当前旋转角度信号；步骤3：通过计算获得各节臂移动角度和臂架目标旋转角度；步骤4：判断是否超出臂架移动范围；步骤5：如果超出臂架移动范围，停止控制臂架动作；否则，控制臂架动作。本发明专利技术还提供了混凝土泵车和臂架控制装置。本发明专利技术臂架运动量最小、平稳性和连续性好、精确度高，作业范围大。

【技术实现步骤摘要】

本专利技术涉及工程机械领域，特别涉及一种混凝土泵车及臂架控制方法与控制装置。
技术介绍
混凝土泵车臂架，一般由4节臂、5节臂、6节臂相互铰接而成，混凝土通过臂架输送到目标浇注点。对于臂架的控制，通常的控制方式是由操作人员使用遥控器对各节臂分别进行控制，即一个一个节臂姿态控制，使臂架的整体从初始姿态运动到目标姿态，这种方式操作较为复杂，并且效率较低。针对上述的控制方法中存在的不足，目前已展开了多种智能程度更高的控制方法，并且现在的运动学逆向求解的方法已能够根据目标点坐标和各节臂的相关参数，通过运动方程和各种矩阵变换求出各个自由度的值。逆向求解的结果会出现多组解。因为多自由度的臂架，臂架末端移动到目标点，各节臂之间有不同的姿态达到目标点。这样就需要确定一组较优解作为实际控制策略。目前确定一个最优解较为复杂，控制效果不佳。为了解决上述的技术问题，CN201110197146.6专利公开了“一种工程机械以及机械臂的控制方法与控制装置”该专利技术每次动作采用两个自由度的机械臂，并遵从节臂位移量最小的原则，通过预先定义的“斜率”，根据控制指令获取需要动作的两个节臂。这样虽然简化了算法，但会导致调节的两个节臂运动突变，臂架运动不连续性，臂架运动稳定性差。如果臂架遇到障碍物，臂架无法控制等问题。另外，各节臂是由液压油缸驱动的，臂架在实际运动过程中，液压油缸伸缩量与各节臂角度变化量不是等线性函数关系，而是非线性函<br>数关系，因此，即使液压油缸小的位移动作，也会导致节臂角度大幅变化，造成突变不稳定性问题。
技术实现思路
有鉴于此，本专利技术提出一种混凝土泵车及臂架控制方法与控制装置。以实现臂架运动量最小和平稳性好，及增大臂架作用范围。一方面，本专利技术提供了一种臂架控制方法，包括以下几个步骤：步骤1：根据臂架当前位置至下一个目标位置建立数学模型；根据各节臂移动量最小和运动平稳性原则，建立目标约束函数；步骤2：获取遥控器动作信号、臂架的各节臂当前状态角度信号、臂架当前旋转角度信号；步骤3：通过计算获得各节臂移动角度和臂架目标旋转角度；步骤4：判断各节臂移动角度是否超出臂架移动范围；步骤5：如果所有节臂移动角度均超出臂架移动范围，停止控制臂架动作；如果部分节臂移动角度超出臂架移动范围，返回步骤3重新计算，否则，控制臂架动作。进一步地，目标约束函数包括如下：OBJ1＝Σwi·(θi-θi-1)2OBJ2＝Σwi·((θi-θi-1)-(θi-1-θi-2))2其中，wi表示i节臂的权重；θi表示节臂移动的目标，θi-1表示当前角度，θi-2表示前一步的角度。进一步地，如果i节臂被操作手锁定，i节臂的权重wi为0。进一步地，根据各节臂角度与驱动各节臂动作的液压油缸伸缩量函数关系，计算液压油缸伸缩量，进行控制臂架动作。进一步地，在步骤3中：将空间轨迹规划分成臂架旋转和机械臂平面动作两个规划分别进行计算，分别获得各节臂移动角度和臂架目标旋转角度。进一步地，数学模型如下：Σi=1Ncos(θ0)licos(Σj=1iθj-(i-1)·π)=xend]]>Σi=1Nlisin(Σj=1iθj-(i-1)·π)=yend]]>Σi=1N-sin(θ0)licos(Σj=1iθj-(i-1)·π)=zend]]>其中，θmin≤θi≤θmax，θi为i节臂与i-1节臂的夹角，θmin表示i节臂最小移动角度，θmax表示i节臂最大移动角度；θ0为旋转角度；li为各节臂长度；xend,yend,zend为末端点坐标，N为臂架的节臂数量。进一步地，还包括步骤6，如果遥控器停止动作，停止臂架动作；如果遥控器继续动作，返回步骤1。另一方面还提供了一种臂架控制装置，包括：遥控装置、信号采集装置、信号预处理装置、计算模块装置、输出装置，信号采集装置包括各节臂角度传感器、转台旋转角度传感器、无线信号接收装置，无线信号接收装置接收遥控装置动作信号；各节臂角度传感器信号和转台旋转角度传感器信号及遥控装置动作信号经过信号预处理装置处理后，通过计算模块装置获得各节臂移动角度，再通过输出装置控制臂架动作。进一步地，遥控装置包括节臂锁定装置。另一方面还提供了一种混凝土泵车，包括上述的臂架控制装置本专利技术提供的一种混凝土泵车及臂架控制方法与控制装置，根据各节臂移动量最小和运动平稳性原则，建立目标约束函数；通过目标约束函数，确定一个最优解，实现臂架运动的连续性；同时，提高了臂架运动平稳性和精确控制，防止臂架运动突变不稳定的情况发生。减少各节臂移动量，节能减排的作用。另外，为了简化计算，将空间轨迹规划分成臂架旋转和机械臂平面动作两个规划分别进行计算，分别获得各节臂移动角度和臂架目标旋转角度，然后判断是否超出臂架移动范围，实现了臂架智能控制的目的。为了进一步提高臂架运动的连续性和平稳性能，还综合考虑臂架铰接连杆机构关系，融入运动学、动力学关系，调整轨迹算法；控制电流为斜坡函数。为了增大臂架作业范围，防止臂架与障碍物相碰，增加了节臂锁定功能，如果i节臂被操作手锁定，i节臂的权重wi为0。这样操作者可根据当前臂架姿态进行任意节臂的锁定实现目标点的轨迹规划，使得操作更加灵活，扩大施工作业范围和臂架规划策略通用性。附图说明构成本专利技术的一部分的附图用来提供对本专利技术的进一步理解，本专利技术的示意性实施例及其说明用于解释本专利技术，并不构成对本专利技术的不当限定。在附图中：图1为本专利技术臂架控制方法流程示意图；图2为本专利技术臂架平面运动规划计算流程示意图；图3为本专利技术臂架装置结构示意图。具体实施方式需要说明的是，在不冲突的情况下，本专利技术中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本专利技术。如图1和图2所示，本专利技术优选的一种臂架控制方法，包括以下几个步骤：步骤1：根据臂架当前位置至下一个目标位置建立数学模型；根据各节臂移动量最小和运动平稳性原则，建立目标约束函数；步骤2：获取遥控器动作信号、臂架的各节臂当前状态角度信号、臂架当前旋转角度信号；步骤3：通过计算获得各节臂移动角度和臂架目标旋转角度；步骤4：判断各节臂移动角度是否超出臂架移动范围；步骤5：如果所有节臂移动角度均超出臂架本文档来自技高网...

【技术保护点】
一种臂架控制方法，其特征在于，包括以下几个步骤：步骤1：根据臂架当前位置至下一个目标位置建立数学模型；根据各节臂移动量最小和运动平稳性原则，建立目标约束函数；步骤2：获取遥控器动作信号、臂架的各节臂当前状态角度信号、臂架当前旋转角度信号；步骤3：通过计算获得各节臂移动角度和臂架目标旋转角度；步骤4：判断各节臂移动角度是否超出臂架移动范围；步骤5：如果所有节臂移动角度均超出臂架移动范围，停止控制臂架动作；如果部分节臂移动角度超出臂架移动范围，返回步骤3重新计算，否则，控制臂架动作。

【技术特征摘要】
1.一种臂架控制方法，其特征在于，包括以下几个步骤：
步骤1：根据臂架当前位置至下一个目标位置建立数学模型；根据各节臂
移动量最小和运动平稳性原则，建立目标约束函数；
步骤2：获取遥控器动作信号、臂架的各节臂当前状态角度信号、臂架当
前旋转角度信号；
步骤3：通过计算获得各节臂移动角度和臂架目标旋转角度；
步骤4：判断各节臂移动角度是否超出臂架移动范围；
步骤5：如果所有节臂移动角度均超出臂架移动范围，停止控制臂架动作；
如果部分节臂移动角度超出臂架移动范围，返回步骤3重新计算，否则，控制
臂架动作。
2.根据权利要求1所述的臂架控制方法，其特征在于，目标约束函数包括
如下：
OBJ1＝Σwi·(θi-θi-1)2OBJ2＝Σwi·((θi-θi-1)-(θi-1-θi-2))2其中，wi表示第i节臂的权重；θi表示i节臂移动的目标角度，θi-1表示
当前角度，θi-2表示前一步的角度。
3.根据权利要求2所述的臂架控制方法，其特征在于，如果第i节臂被操
作手锁定，i节臂的权重wi为0。
4.根据权利要求1所述的臂架控制方法，其特征在于，在步骤5中：根据
各节臂角度与驱动各节臂动作的液压油缸伸缩量函数关系，计算液压油缸伸缩

\t量，进行控制臂架动作。
5.根据权利要求1所述的臂架控制方法，其特征在于，在步骤3中：将空
间轨迹规划分成臂架旋转和机械臂平面动作两个规划分别进行计算，分别获得
各节臂移动角度和臂架目标旋转角度。
6.根据权利要求1所述的臂架控制方法，其特征/在于，数学模型如下：
...

【专利技术属性】
技术研发人员：代晴华，谭凌群，唐修俊，武利冲，
申请(专利权)人：三一汽车制造有限公司，
类型：发明
国别省市：