[发明专利]一种混凝土泵车臂架变形量的补偿方法

说明书

技术领域

本发明涉及一种混凝土泵车臂架变形量的补偿方法，属于混凝土泵车臂架技术领域。

背景技术

在混凝土泵车臂架的智能化控制中，每一节臂和转台通过控制系统实现闭环协调控制。施工时，只需操作手柄给出泵车臂架末端出料口一个运动方向，就能实现多节臂的协调动作，使臂架自动以最佳形态将出料口按着规定轨迹平稳移动到目标位置。然而要想使臂架精确的到达指定的位置，臂架变形量引起的臂架浇筑口的偏移是不忽略的一个重要因素。因此，在控制中要采取有效的补偿方法来补偿臂架的变形量。

现在中国还没有很好解决泵车臂架轨迹控制问题，表现出来的问题是运动轨迹误差大，超出了使用价值。究其原因是没有解决臂架变形补偿问题。现采用的补偿方法是单节臂补偿、多节臂误差累计方法，即根据各节臂在不同位姿下的变形量，通过一定的计算方法求出一个等效的平均变形量，并将此平均变形量转化为该节臂在一定位姿角度下的补偿角度值，把每一节臂架的补偿值进行累加，就是对臂架终端位置的补偿。采用这种方法的优点是无间断计算，可以计算出任何一个位置的变形，没有遗漏。缺点是测试的工作量很大，只好简化测量点，结果无法与计算模型相对应，另一个缺点是形成了累积误差，最终无法确定终端的精确位置。

发明内容

针对上述现有技术存在的问题，本发明提供一种混凝土泵车臂架变形量的补偿方法，克服了现有补偿方法的不足，可有效的补偿臂架的变形带来的控制误差，并且测试周期短，补偿精度高，在控制程序中易于实现，实现臂架的智能控制。

为了实现上述目的，本发明采用的技术方案是：一种混凝土泵车臂架变形量的补偿方法，其具体步骤是：

先将浇筑空间按高度分层，即将浇筑空间划分成一系列的平面浇筑层；在某一平面浇筑层内，浇筑口的坐标用柱面坐标(                                                )；在同一浇筑层面、同一幅度，不因吊臂的回转角度的变化，而改变臂架的变形量，在臂架正向包络状态，变形量只和浇注口到回转中心的距离有关，因此测量实际变形的数据点就大量压缩，每一个层面只需要测量一条直线，即从最小幅度到最大幅度一条直线上的若干点上的变形量，在高度上按照一定的间隔画出相应直线，就形成了一个垂直立面，以泵车回转中心线为轴360度旋转，形成一个立体的锥体空间，这个空间就是泵车可到达的作业空间，在这个空间节点上的任何一点的变形量都可以得到，实际测量的是各节臂架的位置角度和浇注口的坐标值，利用角度和臂长计算出的浇注口坐标值与对应节点的实际测量值比较，得出差值，从而建立变形量数据库，以备调用；

根据各倾角传感器反馈的角度调用相应的轨迹规划程序，得到相应的浇筑轨迹方程，将浇筑轨迹离散化为一系列的点，得到相应点浇筑口坐标()； 

通过测试测量出轨迹离散后浇筑口坐标() 转化为柱面坐标 ()后的臂架变形量()，建立臂架变形的数据表，其中为臂架相对于转台中心水平方向的变形量，为臂架垂直方向的变形量；

根据臂架浇筑口的坐标()调用臂架变形数据表中相应的变形量，然后对原浇筑点进行补偿得到新的实际浇筑点坐标()；

再根据新的浇筑点坐标()调用关节变量反解程序求出相应的关节变量()，其中为回转角度，为一臂角度，为二臂角度，为三臂角度，为四臂角度，为五臂角度；

根据关节变量()调用控制程序控制浇筑口运动到相应的浇筑点。

其中，对于层与层之间未测试层的臂架变形量采用插补算法进行计算。

本发明的有益效果是：针对混凝土泵车臂架变形量引起的臂架浇筑口的偏移，提出一种臂架变形量的补偿方法，克服了现有补偿方法的不足。其采用终端实时补偿来补偿臂架的变形量，从而修正理论计算浇筑轨迹上浇筑点的坐标值，并用修正后的坐标值重新计算各节臂的关节变量，这样可以有效的补偿臂架的变形带来的控制误差，并且测试周期短，补偿精度高，在控制程序中易于实现，可以有效的实现臂架的智能控制。

附图说明

图1 为典型的五节臂混凝土泵车臂架的结构示意图；

图2 为本发明浇筑空间划分的示意图；

图3 为本发明浇筑口柱面坐标的表示图；

图4 为本发明插补算法补偿的示意图；

图5 为本发明浇筑水平非回转直线轨迹终端实时补偿的示意图。

具体实施方式

下面将结合附图和具体实施例对本发明作进一步说明。