专利名称：一种混凝土泵车臂架变形量的补偿方法
技术领域：
本发明涉及一种混凝土泵车臂架变形量的补偿方法，属于混凝土泵车臂架技术领域。
背景技术：
在混凝土泵车臂架的智能化控制中，每一节臂和转台通过控制系统实现闭环协调控制。施工时，只需操作手柄给出泵车臂架末端出料口一个运动方向，就能实现多节臂的协调动作，使臂架自动以最佳形态将出料口按着规定轨迹平稳移动到目标位置。然而要想使臂架精确的到达指定的位置，臂架变形量引起的臂架浇筑口的偏移是不忽略的一个重要因素。因此，在控制中要采取有效的补偿方法来补偿臂架的变形量。现在中国还没有很好解决泵车臂架轨迹控制问题，表现出来的问题是运动轨迹误差大，超出了使用价值。究其原因是没有解决臂架变形补偿问题。现采用的补偿方法是单节臂补偿、多节臂误差累计方法，即根据各节臂在不同位姿下的变形量，通过一定的计算方法求出一个等效的平均变形量，并将此平均变形量转化为该节臂在一定位姿角度下的补偿角度值，把每一节臂架的补偿值进行累加，就是对臂架终端位置的补偿。采用这种方法的优点是无间断计算，可以计算出任何一个位置的变形，没有遗漏。缺点是测试的工作量很大， 只好简化测量点，结果无法与计算模型相对应，另一个缺点是形成了累积误差，最终无法确定终端的精确位置。
发明内容
针对上述现有技术存在的问题，本发明提供一种混凝土泵车臂架变形量的补偿方法，克服了现有补偿方法的不足，可有效的补偿臂架的变形带来的控制误差，并且测试周期短，补偿精度高，在控制程序中易于实现，实现臂架的智能控制。为了实现上述目的，本发明采用的技术方案是一种混凝土泵车臂架变形量的补偿方法，其具体步骤是
先将浇筑空间按高度分层，即将浇筑空间划分成一系列的平面浇筑层；在某一平面浇筑层内，浇筑口的坐标用柱面坐标( PlZ )；在同一浇筑层面、同一幅度，不因吊臂的回转角度的变化，而改变臂架的变形量， 在臂架正向包络状态，变形量只和浇注口到回转中心的距离有关，因此测量实际变形的数据点就大量压缩，每一个层面只需要测量一条直线，即从最小幅度到最大幅度一条直线上的若干点上的变形量，在高度上按照一定的间隔画出相应直线，就形成了一个垂直立面，以泵车回转中心线为轴360度旋转，形成一个立体的锥体空间，这个空间就是泵车可到达的作业空间，在这个空间节点上的任何一点的变形量都可以得到，实际测量的是各节臂架的位置角度和浇注口的坐标值，利用角度和臂长计算出的浇注口坐标值与对应节点的实际测量值比较，得出差值，从而建立变形量数据库，以备调用；
根据各倾角传感器反馈的角度调用相应的轨迹规划程序，得到相应的浇筑轨迹方程，将浇筑轨迹离散化为一系列的点，得到相应点浇筑口坐标()；
通过测试测量出轨迹离散后浇筑口坐标(Hz )转化为柱面坐标(PlZ )后的臂
架变形量(4 )，建立臂架变形的数据表，其中为臂架相对于转台中心水平方向的
变形量，‘为臂架垂直方向的变形量；
根据臂架浇筑口的坐标(P力工)调用臂架变形数据表中相应的变形量，然后对原浇
筑点进行补偿得到新的实际浇筑点坐标((乂乂)；
再根据新的浇筑点坐标(广乂乂)调用关节变量反解程序求出相应的关节变量
{ΛΑΑΑΑΑ )，其中马为回转角度，^为一臂角度，鸟为二臂角度，^为三臂角度4
为四臂角度， 为五臂角度；
根据关节变量(B1AAAAA )调用控制程序控制浇筑口运动到相应的浇筑点。其中，对于层与层之间未测试层的臂架变形量采用插补算法进行计算。本发明的有益效果是针对混凝土泵车臂架变形量引起的臂架浇筑口的偏移，提出一种臂架变形量的补偿方法，克服了现有补偿方法的不足。其采用终端实时补偿来补偿臂架的变形量，从而修正理论计算浇筑轨迹上浇筑点的坐标值，并用修正后的坐标值重新计算各节臂的关节变量，这样可以有效的补偿臂架的变形带来的控制误差，并且测试周期短，补偿精度高，在控制程序中易于实现，可以有效的实现臂架的智能控制。
图1为典型的五节臂混凝土泵车臂架的结构示意图； 图2为本发明浇筑空间划分的示意图3为本发明浇筑口柱面坐标的表示图； 图4为本发明插补算法补偿的示意图5为本发明浇筑水平非回转直线轨迹终端实时补偿的示意图。
具体实施例方式下面将结合附图和具体实施例对本发明作进一步说明。如图1所示，本发明采用终端实时补偿，首先通过测试获得臂架的变形量数据表， 然后根据各倾角传感器反馈的角度调用相应的轨迹规划程序、臂架变形数据以及关节变量反解程序，将补偿后的各浇筑点的关节变量求解出来以用来控制浇筑口运动。如图2所示，先将浇筑空间按高度分层，即将浇筑空间划分成一系列的平面浇筑层；在某一平面浇筑层内，浇筑口的坐标用柱面坐标(PH )；在同一浇筑层面、同一幅度，不因吊臂的回转角度的变化，而改变臂架的变形量，在臂架正向包络状态，变形量只和浇注口到回转中心的距离有关，因此测量实际变形的数据点就大量压缩，每一个层面只需要测量一条直线，即从最小幅度到最大幅度一条直线上的若干点上的变形量，在高度上按照一定的间隔画出相应直线，就形成了一个垂直立面，以泵车回转中心线为轴360度旋转， 形成一个立体的锥体空间，这个空间就是泵车可到达的作业空间，在这个空间节点上的任何一点的变形量都可以得到，实际测量的是各节臂架的位置角度和浇注口的坐标值，利用角度和臂长计算出的浇注口坐标值与对应节点的实际测量值比较，得出差值，从而建立变形量数据库，以备调用；具体如下
首先对整个浇筑空间进行分层，将浇筑空间划分成一系列的平面浇筑层进行测试； 如图3和图4所示，对于某一层来说，浇筑口的坐标(U3 )转化为柱面坐标(Ρ,Θ,Ζ )，由于转台转角5的值不影响臂架的变形量所以对于每一层只测试转角为0°的水平非回转直线浇筑轨迹。通过实际测试测量出轨迹离散后浇筑口坐标(P工)的臂架变形量 )，其中为臂架相对于转台中心水平方向的变形量，^为臂架垂直方向的变形量；得到结果如下表所示
权利要求
1.一种混凝土泵车臂架变形量的补偿方法，其特征在于采用终端实时补偿，其具体步骤是先将浇筑空间按高度分层，即将浇筑空间划分成一系列的平面浇筑层；在某一平面浇筑层内，浇筑口的坐标用柱面坐标( P拟)；在同一浇筑层面、同一幅度，不因吊臂的回转角度的变化，而改变臂架的变形量， 在臂架正向包络状态，变形量只和浇注口到回转中心的距离有关，因此测量实际变形的数据点就大量压缩，每一个层面只需要测量一条直线，即从最小幅度到最大幅度一条直线上的若干点上的变形量，在高度上按照一定的间隔画出相应直线，就形成了一个垂直立面，以泵车回转中心线为轴360度旋转，形成一个立体的锥体空间，这个空间就是泵车可到达的作业空间，在这个空间节点上的任何一点的变形量都可以得到，实际测量的是各节臂架的位置角度和浇注口的坐标值，利用角度和臂长计算出的浇注口坐标值与对应节点的实际测量值比较，得出差值，从而建立变形量数据库，以备调用；根据各倾角传感器反馈的角度调用相应的轨迹规划程序，得到相应的浇筑轨迹方程， 将浇筑轨迹离散化为一系列的点，得到相应点浇筑口坐标(U，z )；通过测试测量出轨迹离散后浇筑口坐标()转化为柱面坐标(PH )后的臂架变形量(^ )，建立臂架变形的数据表，其中~为臂架相对于转台中心水平方向的变形量，Szs为臂架垂直方向的变形量；根据臂架浇筑口的坐标(AftZ )调用臂架变形数据表中相应的变形量，然后对原浇筑点进行补偿得到新的实际浇筑点坐标(hz.)；再根据新的浇筑点坐标(乂 )调用关节变量反解程序求出相应的关节变量 (各各马, , , )，其中铒为回转角度，巧为一臂角度，钱为二臂角度，线为三臂角度，f. 为四臂角度，乓为五臂角度；根据关节变量()调用控制程序控制浇筑口运动到相应的浇筑点。
2.根据权利要求1所述的一种混凝土泵车臂架变形量的补偿方法，其特征在于所述的臂架变形量(、Ssx )采用插补算法进行计算。
全文摘要
本发明公开了一种混凝土泵车臂架变形量的补偿方法，属于混凝土泵车臂架技术领域，采用终端实时补偿，通过测试建立一系列浇筑轨迹坐标所对应的臂架变形数据表，当操作人员控制浇筑口运动到指定浇筑轨迹的起始浇筑点上，控制系统就会根据各节臂倾角传感器所反馈的角度值经过计算调用相应的轨迹规划程序、臂架变形数据以及关节变量反解程序，将补偿后的各浇筑点的关节变量求解出来以控制浇筑口运动的应用。有益效果是采用本方法补偿臂架的变形量，控制简单，精度高，易于实现，能够在智能控制过程中有效的补偿臂架的变形量。
文档编号E04G21/02GK102345390SQ20111020429
公开日2012年2月8日 申请日期2011年7月21日 优先权日2011年7月21日
发明者于立娟, 杨力夫, 罗衍领, 胡传正, 邱艳峰, 魏彬 申请人:徐工集团工程机械股份有限公司江苏徐州工程机械研究院