CN103806666B - 一种混凝土泵车和臂架控制方法 - Google Patents

一种混凝土泵车和臂架控制方法 Download PDF

Info

Publication number
CN103806666B
CN103806666B CN201410036995.7A CN201410036995A CN103806666B CN 103806666 B CN103806666 B CN 103806666B CN 201410036995 A CN201410036995 A CN 201410036995A CN 103806666 B CN103806666 B CN 103806666B
Authority
CN
China
Prior art keywords
jib
arm
tail end
arm support
cantilever crane
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201410036995.7A
Other languages
English (en)
Other versions
CN103806666A (zh
Inventor
唐修俊
谭凌群
武利冲
蒲东亮
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Sany Automobile Manufacturing Co Ltd
Original Assignee
Sany Automobile Manufacturing Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Sany Automobile Manufacturing Co Ltd filed Critical Sany Automobile Manufacturing Co Ltd
Priority to CN201410036995.7A priority Critical patent/CN103806666B/zh
Publication of CN103806666A publication Critical patent/CN103806666A/zh
Priority to PCT/CN2015/070973 priority patent/WO2015109975A1/zh
Application granted granted Critical
Publication of CN103806666B publication Critical patent/CN103806666B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • EFIXED CONSTRUCTIONS
    • E04BUILDING
    • E04GSCAFFOLDING; FORMS; SHUTTERING; BUILDING IMPLEMENTS OR AIDS, OR THEIR USE; HANDLING BUILDING MATERIALS ON THE SITE; REPAIRING, BREAKING-UP OR OTHER WORK ON EXISTING BUILDINGS
    • E04G21/00Preparing, conveying, or working-up building materials or building elements in situ; Other devices or measures for constructional work
    • E04G21/02Conveying or working-up concrete or similar masses able to be heaped or cast
    • E04G21/04Devices for both conveying and distributing
    • E04G21/0418Devices for both conveying and distributing with distribution hose
    • E04G21/0445Devices for both conveying and distributing with distribution hose with booms
    • E04G21/0463Devices for both conveying and distributing with distribution hose with booms with boom control mechanisms, e.g. to automate concrete distribution

Abstract

本发明公开了一种臂架控制方法,包括实时获取遥控器动作信号和臂架的各节臂当前状态角度信号及臂架旋转角度信号;对臂架末端移动进行规划。还包括预测控制,预测控制包括:根据臂架末端的目标移动方向,并实时计算臂架末端点的坐标值,如果臂架末端点偏离了目标移动方向,则对臂架末端进行二次规划,二次规划输出下一个目标点。本发明还提供了一种混凝土泵车。本发明由于在臂架末端偏离了目标移动方向的情况下,对臂架末端进行了二次规划,不再根据原规划的方案控制臂架动作,保证臂架末端点始终朝向目标点移动,降低了臂架伸长和缩短反复交替运作的可能性,使臂架末端移动平稳。

Description

一种混凝土泵车和臂架控制方法
技术领域
本发明涉及工程机械领域,特别涉及一种混凝土泵车和臂架控制方法。
背景技术
混凝土泵车臂架,一般由4节臂或5节臂或6节臂相互铰接而成,混凝土通过臂架输送到目标浇注点。对于臂架的控制,通常的控制方式是由操作人员使用遥控器对各节臂分别进行控制,即一个一个节臂姿态控制,使臂架的整体从初始姿态运动到目标姿态,这种方式操作较为复杂,并且效率较低。
针对上述的控制方法中存在的不足,目前臂架智能控制方法,根据目标点坐标和各节臂的相关参数,通过运动方程和各种矩阵变换求出各个自由度的值。逆向求解的结果会出现多组解。因为多自由度的臂架,臂架末端移动到目标点,各节臂之间有不同的姿态达到目标点。这样就需要确定一组较优解作为实际控制策略。目前确定一个最优解较为复杂,控制效果不佳。
为了解决上述的技术问题,CN201110197146.6专利公开了“一种工程机械以及机械臂的控制方法与控制装置”该专利技术每次动作采用两个自由度的机械臂,并遵从节臂位移量最小的原则,通过预先定义的“斜率”,根据控制指令获取需要动作的两个节臂。这样虽然简化了算法,但会导致调节的两个节臂运动突变,臂架运动不连续性,臂架运动稳定性差。另外,如果臂架遇到障碍物,臂架无法控制等问题。另外,各节臂是由液压油缸驱动的,臂架在实际运动过程中,液压油缸伸缩量与各节臂角度变化量不是等线性函数关系,而是非线性函数关系,因此,即使液压油缸小的位移动作,也会导致节臂角度大幅变化,造成突变不稳定性问题。
另外,对于大惯性的柔性混凝土泵车臂架控制系统而言,因为各节臂伸长油缸进油量控制精度及臂架旋转角控制精度,及臂架运动惯性等客观原因,经常会出现臂架末端偏离目标移动方向,如图1所示,根据目标移动AB方向,臂架末端移动趋势是缩短的,在规划臂架末端移动时,都是根据遥控器动作信号开度,确定臂架末端移动的步长,如图1所示,P1和P2为臂架末端移动规划的下一个目标点,如果臂架末端偏离了P1点,到达S1点,臂架会根据原规划方案,从S1点向P2点移动。这样就会使得臂架末端从A点至S1点,臂架是缩短的,从S1点到P2点臂架是伸长的,这样造成规划方案与目标移动方向的臂架末端移动趋势相反的情况,使得臂架伸长和缩短反复交替运作,造成臂架末端移动不平稳。
发明内容
有鉴于此,本发明提出一种混凝土泵车和臂架控制方法,以减少臂架运动过程中,臂架伸长和缩短反复交替动作,造成臂架末端移动不平稳的问题。
一方面,本发明提供了一种臂架控制方法,包括实时获取遥控器动作信号和臂架的各节臂当前状态角度信号及臂架旋转角度信号;对臂架末端移动进行规划。包括预测控制,预测控制包括:根据臂架末端的目标移动方向,并实时计算臂架末端点的坐标值,如果臂架末端点偏离了目标移动方向,则对臂架末端进行二次规划,二次规划输出下一个目标点。
进一步地,预测控制还包括根据臂架末端的目标移动方向,预测臂架伸长区域和/或臂架缩短区域;如果臂架末端点在臂架伸长区域上,且臂架末端点偏离了目标移动方向,对臂架末端进行二次规划,二次规划使臂架伸长;如果臂架末端点在臂架缩短区域上,且臂架末端点偏离了目标移动方向,对臂架末端移动进行二次规划,二次规划使臂架缩短。
进一步地,在目标移动方向上找到至臂架旋转中心距离最短的垂直点,垂直点至目标移动方向上的区域为臂架伸长区域;另一侧为臂架缩短区域。
进一步地,在垂直点周围划定一个区域为臂架伸缩转换区域,如果臂架末端点在臂架伸缩转换区域上,关闭预测控制。
进一步地,臂架末端移动规划包括以下几个步骤
步骤1:根据臂架当前位置至下一个目标位置建立数学模型;根据各节臂移动量最小和运动平稳性原则,建立目标约束函数;
步骤2:根据遥控器动作信号、臂架的各节臂当前状态角度信号、臂架当前旋转角度信号;计算获得各节臂收展角度和臂架目标旋转角度;
步骤3:判断各节臂收展角度是否超出臂架收展角度范围;
步骤4:如果所有节臂收展角度均超出臂架收展角度范围,停止控制臂架动作;如果部分节臂收展角度超出臂架移动范围,返回步骤2重新计算,否则,控制臂架动作。
进一步地,目标约束函数包括如下:
OBJ1=∑wi·(θii-1)2
OBJ2=∑wi·((θii-1)-(θi-1i-2))2
其中,wi表示i节臂的权重;θi表示i节臂目标角度,θi-1表示i节臂当前角度,θi-2表示i节臂前一步的角度。
进一步地,如果i节臂被操作手锁定,i节臂的权重wi为0。
进一步地,在步骤2中:将空间轨迹规划分成臂架旋转和机械臂平面收展两个规划分别进行计算,分别获得各节臂收展角度和臂架目标旋转角度。
进一步地,数学模型如下:
Σ i = 1 N cos ( θ 0 ) l i cos ( Σ j = 1 i θ j - ( i - 1 ) · π ) = x end
Σ i = 1 N l i sin ( Σ j = 1 i θ j - ( i - 1 ) · π ) = y end
Σ i = 1 N - sin ( θ 0 ) l i cos ( Σ j = 1 i θ j - ( i - 1 ) · π ) = z end
其中,θmin≤θi≤θmax,θi为i节臂与i-1节臂的夹角,θmin表示i节臂最小收展角度,θmax表示i节臂最大收展角度;θ0为旋转角度;li为各节臂长度;xend,yend,zend为末端点坐标,N为臂架的节臂数量。
另外,还提供了一种混凝土泵车,包括比较,其采用上述任意一种所述的臂架控制方法。本发明提供的一种混凝土泵车和臂架控制方法,增加了预测控制程序,根据臂架末端的目标移动方向,并实时计算臂架末端点的坐标值,如果臂架末端偏离了目标移动方向,则对臂架末端进行二次规划,二次规划输出下一个目标点。由于在臂架末端偏离了目标移动方向的情况下,对臂架末端进行了二次规划,不再根据原规划的方案控制臂架动作,保证臂架末端点始终朝向目标点移动,降低了臂架伸长和缩短反复交替运作的可能性,使臂架末端动作更平稳。进一步地方案中,根据臂架末端的目标移动方向,预测臂架伸长区域和/或臂架缩短区域,作为对臂架运动规划的限制条件。如果臂架末端点在臂架伸长区域上,且臂架末端点偏离了目标移动方向,对臂架末端移动进行二次规划;二次规划使臂架伸长;如果臂架末端点在臂架缩短区域上,且臂架末端点偏离了目标移动方向,对臂架末端移动进行二次规划;二次规划使臂架缩短。根据二次规划的下一个目标点进行臂架末端移动规划计算,得到对应的臂架旋转角度和各个节臂的收展角度,使得臂架规划方案与目标移动方向的臂架移动趋势一致,进一步避免了臂架伸长或缩短反复交替动作,臂架移动平稳。
另外,规划臂架运动过程中,根据各节臂移动量最小和运动平稳性原则,建立目标约束函数;通过目标约束函数,确定一个最优解,实现臂架运动的连续性;同时,提高了臂架运动平稳性和精确控制,防止臂架运动突变不稳定的情况发生。减少各节臂移动量,节能减排的作用。另外,为了简化计算,将空间轨迹规划分成臂架旋转和机械臂平面收展两个规划分别进行计算,分别获得各节臂收展角度和臂架目标旋转角度,然后判断是否超出臂架移动范围,实现了臂架智能控制的目的。为了进一步提高臂架运动的连续性和平稳性能,还综合考虑臂架铰接连杆机构关系,融入运动学、动力学关系,调整轨迹算法;控制电流为斜坡函数。为了增大臂架作业范围,防止臂架与障碍物相碰,增加了节臂锁定功能,如果节臂被操作手锁定,节臂的权重为0。这样操作者可根据当前臂架姿态进行任意节臂的锁定实现目标点的轨迹规划,使得操作更加灵活,扩大施工作业范围和臂架规划策略通用性。
附图说明
构成本发明的一部分的附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1为现有臂架控制方法示意图;
图2为本发明臂架预测控制方法流程示意图;
图3为本发明臂架控制原理示意图;
图4为本发明臂架末端移动规划流程示意图;
图5为本发明臂架末端移动规划计算流程示意图。
具体实施方式
需要说明的是,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本发明。
本发明提供的一种臂架控制方法,包括实时获取遥控器动作信号和臂架的各节臂当前状态角度信号及臂架旋转角度信号;对臂架末端移动进行规划。包括预测控制,预测控制包括:根据臂架末端的目标移动方向,并实时计算臂架末端点的坐标值,如果臂架末端点偏离了目标移动方向,则对臂架末端进行二次规划,二次规划输出下一个目标点。需要说明的是,臂架末端点偏离了目标移动方向是指偏离了目标移动方向一定的范围,因此应理解为可以具有一定误差的偏离,即,对于误差范围内的偏离目标移动方向,可以不进行二次规划,超过误差范围就需要进行二次规划,根据控制精度,可以设置合适的误差范围。本发明由于在臂架末端偏离了目标移动方向的情况下,对臂架末端进行了二次规划,即从臂架末端的当前点到目标点重新规划,不再根据原规划的方案控制臂架动作,保证臂架末端点始终朝向目标点移动,降低了臂架伸长和缩短反复交替运作的可能性,使臂架末端动作更平稳。
如图2和图3所示,本发明优选的一种臂架控制方法,包括预测控制,预测控制方法包括根据臂架末端的目标移动方向AB,预测臂架伸长区域和/或臂架缩短区域;实时计算臂架末端点坐标值,如果臂架末端点在臂架伸长区域上,且臂架末端点偏离了目标移动方向AB,对臂架末端进行二次规划;二次规划使臂架伸长;如果臂架末端点在臂架缩短区域上,且臂架末端点偏离了目标移动方向AB,对臂架末端移动进行二次规划;二次规划使臂架缩短,二次规划输出下一个目标点H1、H2。需要说明的是,二次规划使臂架伸长及二次规划使臂架缩短均应理解为包括臂架保持不变的情形,即在伸长区域,臂架不会改变伸长的趋势,在缩短区域,臂架不会改变缩短的趋势,这样,在臂架伸长区域,不会出现臂架缩短的情况,在臂架缩短区域,不会出现臂架伸长的情况,进一步防止了臂架伸长和缩短反复动作。如果臂架末端点在臂架伸缩转换区域上,关闭预测控制。
通过数学计算方法,预测臂架伸长区域和臂架缩短区域及臂架伸缩转换区域;在目标移动方向上找到至臂架旋转中心距离最短的垂直点Q,垂直点Q至目标移动方向上的区域为臂架伸长区域QB;另一侧为臂架缩短区域AQ,在垂直点Q周围划定一个区域为臂架伸缩转换区域。一般以垂直点Q为中心,以500MM为半径画圆,作为臂架伸缩转换区域。在臂架伸缩转换区域不进行预测控制,避免因预测控制功能使臂架不能向目标方向移动。
臂架控制原理如图3所示,获取遥控器动作信号和臂架的各节臂当前状态角度信号及臂架旋转角度信号,在目标移动方向AB上,规划臂架末端点每一步移动的下一个目标点P1、P2、P3、P4、P5、P6,一般P1至P2的步长等于P2至P3的步长,P4至P5的步长等于P5至P6的步长。同时也会实时采集遥控器动作信号,根据遥控器动作信号实时更新各个目标点。
假设臂架末端点当前位置A向P1点移动,计算得到臂架末端点当前位置A和下一个目标点P1的坐标值,根据臂架当前位置A至下一个目标点P1对臂架末端移动进行规划计算;获得各节臂收展角度和臂架目标旋转角度(收展角度为各节臂架绕其铰接点转动的角度,臂架目标旋转角度为整个臂架装置绕连接臂架的转台需要旋转的角度)。由于各节臂伸长油缸进油量控制精度及臂架旋转角控制精度,及臂架运动惯性等客观原因,臂架末端点偏离目标移动方向AB,臂架末端点到达S1点。此时,需要判断臂架末端点S1在臂架伸长区域,还是在臂架缩短区域或者臂架转换区域。经过判断臂架末端点S1在臂架缩短区域,就需要对臂架末端的下一个目标点H1进行二次规划,不能依据前一次规划的下一个目标点P2进行移动。否则,臂架会伸长缩短交替动作,造成臂架运动不平稳。在对下一个目标点H1规划时,需要考虑使臂架缩短作为二次规划的限制条件。臂架末端点从A点至S1点,臂架是缩短的,臂架末端点从S1点至H1点,臂架也是缩短的,这样使得臂架末端在臂架缩短区域,臂架一直都是缩短的,臂架运动不平稳。
假设臂架末端点从P4向P5点移动,由于各节臂伸长油缸进油量控制精度及臂架旋转角控制精度,及臂架运动惯性等客观原因,臂架末端点偏离目标移动方向AB,臂架末端点到达S2点。此时臂架末端点S2在臂架伸长区域,就需要对臂架末端的下一个目标点H2进行二次规划,不能依据前一次规划的下一个目标点P6进行移动。否则,臂架会伸长缩短交替动作,造成臂架运动不平稳。在对下一个目标点H2规划时,需要考虑使臂架伸长作为二次规划的限制条件。臂架末端点从P4点至S2点,臂架是伸长的,臂架末端点从S2点至H2点,臂架也是伸长的,这样使得臂架末端在臂架伸长区域,臂架一直都是伸长的,臂架运动不平稳。
如图4和图5所示,在规划臂架末端移动时,包括以下几个步骤:
步骤1:根据臂架当前位置至下一个目标位置建立数学模型;根据各节臂移动量最小和运动平稳性原则,建立目标约束函数;
步骤2:根据遥控器动作信号、臂架的各节臂当前状态角度信号、臂架当前旋转角度信号;通过计算获得各节臂收展角度和臂架目标旋转角度;
步骤3:判断各节臂收展角度是否超出臂架收展角度范围;
步骤4:如果所有节臂收展角度均超出臂架收展角度范围,停止控制臂架动作;如果部分节臂收展角度超出臂架收展角度范围,返回步骤2重新计算,否则,控制臂架动作。
具体实施如下:
1)建立坐标系
以混凝土泵车转台与臂架始端节臂铰接处作为坐标原点,以车身的料斗方向为X正半轴,以垂直于车身的方向为Y轴正半轴,根据笛卡尔坐标系右手定则,可确定Z轴。本坐标系是臂架智能运动系统基准坐标系,即对臂架设计的运动规划策略都是以该坐标系作为参照的。
2)通过信号采集装置接收获取遥控器动作信号、臂架的各节臂当前状态角度信号、臂架当前旋转角度信号。遥控器动作信号包括操作手柄的方向信号和速度信号,信号采集装置通过无线信号接收装置接收遥控装置动作信号,通过角度传感器获取臂架的各节臂当前状态角度信号和臂架当前旋转角度信号。
3)臂架空间轨迹规划建立数学模型
设计多自由度臂架运动规划策略之前,首先需要建立系统数学模型。根据臂架结构运动学关系可知,在上述建立的坐标系基础上,数学模型为:
Σ i = 1 N cos ( θ 0 ) l i cos ( Σ j = 1 i θ j - ( i - 1 ) · π ) = x end
Σ i = 1 N l i sin ( Σ j = 1 i θ j - ( i - 1 ) · π ) = y end
Σ i = 1 N - sin ( θ 0 ) l i cos ( Σ j = 1 i θ j - ( i - 1 ) · π ) = z end
其中,θmin≤θi≤θmax,θi为i节臂与i-1节臂的夹角,θmin表示i节臂最小收展角度,θmax表示i节臂最大收展角度;θ0为旋转角度;li为各节臂长度;xend,yend,zend为末端点坐标,N为臂架的节臂数量。
将空间轨迹规划分成臂架旋转和机械臂平面收展两个规划分别进行计算,分别获得各节臂收展角度和臂架目标旋转角度。
若只考虑臂架平面运动则上述数学模型简化为:
Σ i = 1 N l i cos ( Σ j = 1 i θ j - ( i - 1 ) · π ) = x end ⇔ ceq 1 ( x ) = Σ i = 1 N l i cos ( Σ j = 1 i θ j - ( i - 1 ) · π ) - x end = 0
Σ i = 1 N l i sin ( Σ j = 1 i θ j - ( i - 1 ) · π ) = y end ⇔ ceq 2 ( x ) = Σ i = 1 N l i sin ( Σ j = 1 i θ j - ( i - 1 ) · π ) - y end = 0
4)建立目标约束函数时需要考虑:
其一、从当前位置移动到目标位置,臂架移动尽量小,即节能减排;
其二、臂架平稳移动,避免剧烈的速度变化,特别是反向运动。
OBJ1=∑wi·(θii-1)2
OBJ2=∑wi·((θii-1)-(θi-1i-2))2
其中,wi表示i节臂的权重;θi表示i节臂目标角度,θi-1表示i节臂当前角度,θi-2表示i节臂前一步的角度。
如果i节臂被操作手锁定,i节臂的权重wi为0。
5)、建立带约束的优化问题,将带约束的优化问题转化为非约束的优化问题
下一步加入惩罚因子,将带约束的优化问题转化为非约束的优化问题
g ( θ ) = w · ( θ i - θ i - 1 ) w · ( ( θ i - x i - 1 ) - ( θ i - 1 - θ i - 2 ) ) i = 1 . . . N ( σ ceq i ( θ ) ) i = 1,2 σ min ( 0 , θ i - θ i min ) σ min ( 0 , θ max - θ ) i = 1 . . . N
因此只要求得g(θ)的解即可。
如图4所示,具体步骤如下:
第一步:设定初始值,将获得的臂架的各节臂当前状态角度信号设定为初值、臂架当前旋转角度信号设定为初值;
第二步:采用一维线性搜索方法计算步长h或者采用负梯度方法;
第三步,如果,ceq1、2(x)<ε并且θimin≤θi≤θimax,则退出。
第四步,否则跳转第二步。
6)、臂架在运动过程中某节臂被锁定
在运动过程中,某个节臂若因为人为或者结构原因,导致无法移动,需要在规划策略设计中降低一维或多维自由度。具体地分为两种情况:
其一、若臂架旋转无法满足输入命令要求,则停止运动;
其二、若臂架某个节臂被锁定,则将当前节臂姿态记录下来,通过节臂平面运动规划中,将该i节臂的权重wi为0。
7)、通过计算获得各节臂收展角度和臂架目标旋转角度;
8)、判断各节臂收展角度是否超出臂架收展角度范围;如果所有节臂收展角度均超出臂架收展角度范围,停止控制臂架动作;如果部分节臂收展角度超出臂架收展角度范围,返回步骤2重新计算,否则,控制臂架动作。
9)、在步骤4中:根据各节臂角度与驱动各节臂动作的液压油缸伸缩量函数关系,需要充分考虑结构运动学和动力学,计算得到液压油缸伸缩量,向控制液压油缸的电磁换向阀输入控制电流,控制电流是一个斜坡函数,不是矩形函数。确保臂架动作连续性和平顺性。
10)、如果遥控器停止动作,停止臂架动作;如果遥控器继续动作,返回步骤1。
本发明提供的一种臂架控制方法,根据各节臂移动量最小和运动平稳性原则,建立目标约束函数;通过目标约束函数,确定一个最优解,实现臂架运动的连续性;同时,提高了臂架运动平稳性和精确控制,防止臂架运动突变不稳定的情况发生。减少各节臂移动量,节能减排的作用。另外,为了简化计算,将空间轨迹规划分成臂架旋转和机械臂平面收展两个规划分别进行计算,分别获得各节臂收展角度和臂架目标旋转角度,然后判断是否超出臂架移动范围,防止与障碍物相碰,实现了臂架智能控制的目的。为了进一步提高臂架运动的连续性和平稳性能,还综合考虑臂架铰接连杆机构关系,融入运动学、动力学关系,调整轨迹算法;控制电流是一个斜坡函数。为了增大臂架作业范围,防止臂架与障碍物相碰,增加了节臂锁定功能,如果i节臂被操作手锁定,i节臂的权重wi为0,这样操作者可根据当前臂架姿态进行任意节臂的锁定实现目标点的轨迹规划,使得操作更加灵活,扩大施工作业范围和臂架规划策略通用性。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。

Claims (10)

1.一种臂架控制方法,包括实时获取遥控器动作信号和臂架的各节臂当前状态角度信号及臂架旋转角度信号;对臂架末端移动进行规划,其特征在于,包括预测控制,预测控制包括:根据臂架末端的目标移动方向,并实时计算臂架末端点的坐标值,如果臂架末端点偏离了目标移动方向,则对臂架末端进行二次规划,二次规划输出下一个目标点。
2.根据权利要求1所述的臂架控制方法,其特征在于,预测控制还包括根据臂架末端的目标移动方向,预测臂架伸长区域和/或臂架缩短区域;如果臂架末端点在臂架伸长区域上,且臂架末端点偏离了目标移动方向,对臂架末端进行二次规划,二次规划使臂架伸长;如果臂架末端点在臂架缩短区域上,且臂架末端点偏离了目标移动方向,对臂架末端移动进行二次规划,二次规划使臂架缩短。
3.根据权利要求2所述的臂架控制方法,其特征在于,在目标移动方向上找到至臂架旋转中心距离最短的垂直点,垂直点至目标移动方向上的区域为臂架伸长区域;另一侧为臂架缩短区域。
4.根据权利要求3所述的臂架控制方法,其特征在于,在垂直点周围划定一个区域为臂架伸缩转换区域,如果臂架末端点在臂架伸缩转换区域上,关闭预测控制。
5.根据权利要求1所述的臂架控制方法,其特征在于,臂架末端移动规划包括以下几个步骤
步骤1:根据臂架当前位置至下一个目标位置建立数学模型;根据各节臂移动量最小和运动平稳性原则,建立目标约束函数;
步骤2:根据遥控器动作信号、臂架的各节臂当前状态角度信号、臂架当前旋转角度信号;计算获得各节臂收展角度和臂架目标旋转角度;
步骤3:判断各节臂收展角度是否超出臂架收展角度范围;
步骤4:如果所有节臂收展角度均超出臂架收展角度范围,停止控制臂架动作;如果部分节臂收展角度超出臂架移动范围,返回步骤2重新计算,否则,控制臂架动作。
6.根据权利要求5所述的臂架控制方法,其特征在于,目标约束函数包括如下:
OBJ1=∑wi·(θii-1)2
OBJ2=∑wi·((θii-1)-(θi-1i-2))2
其中,wi表示i节臂的权重;θi表示i节臂目标角度,θi-1表示i节臂当前角度,θi-2表示i节臂前一步的角度。
7.根据权利要求6所述的臂架控制方法,其特征在于,如果i节臂被操作手锁定,i节臂的权重wi为0。
8.根据权利要求5所述的臂架控制方法,其特征在于,在步骤2中:将空间轨迹规划分成臂架旋转和机械臂平面收展两个规划分别进行计算,分别获得各节臂收展角度和臂架目标旋转角度。
9.根据权利要求5所述的臂架控制方法,其特征在于,数学模型如下:
&Sigma; i = 1 N cos ( &theta; 0 ) l i cos ( &Sigma; j = 1 i &theta; j - ( i - 1 ) &CenterDot; &pi; ) = x end
&Sigma; i = 1 N l i sin ( &Sigma; j = 1 i &theta; j - ( i - 1 ) &CenterDot; &pi; ) = y end
&Sigma; i = 1 N - sin ( &theta; 0 ) l i cos ( &Sigma; j = 1 i &theta; j - ( i - 1 ) &CenterDot; &pi; ) = z end
其中,θmin≤θi≤θmax,θi为i节臂与i-1节臂的夹角,θmin表示i节臂最小收展角度,θmax表示i节臂最大收展角度;θ0为旋转角度;li为各节臂长度;xend,yend,zend为末端点坐标,N为臂架的节臂数量。
10.一种混凝土泵车,包括臂架,其特征在于,采用如权利要求1至9所述任意一项所述的臂架控制方法。
CN201410036995.7A 2014-01-26 2014-01-26 一种混凝土泵车和臂架控制方法 Active CN103806666B (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201410036995.7A CN103806666B (zh) 2014-01-26 2014-01-26 一种混凝土泵车和臂架控制方法
PCT/CN2015/070973 WO2015109975A1 (zh) 2014-01-26 2015-01-19 一种混凝土泵车和臂架控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410036995.7A CN103806666B (zh) 2014-01-26 2014-01-26 一种混凝土泵车和臂架控制方法

Publications (2)

Publication Number Publication Date
CN103806666A CN103806666A (zh) 2014-05-21
CN103806666B true CN103806666B (zh) 2015-02-18

Family

ID=50704010

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410036995.7A Active CN103806666B (zh) 2014-01-26 2014-01-26 一种混凝土泵车和臂架控制方法

Country Status (2)

Country Link
CN (1) CN103806666B (zh)
WO (1) WO2015109975A1 (zh)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103806666B (zh) * 2014-01-26 2015-02-18 三一汽车制造有限公司 一种混凝土泵车和臂架控制方法
CN106150101B (zh) * 2016-08-19 2018-08-07 北汽福田汽车股份有限公司 臂架的控制器、控制系统、控制方法及泵车
CN109375585A (zh) * 2018-09-28 2019-02-22 湖南希法工程机械有限公司 臂架末端位置控制方法及系统及包含该系统的工程机械
DE102019105817A1 (de) * 2019-03-07 2020-09-10 Liebherr-Mischtechnik Gmbh Gelenkarm-Steuerung einer Betonpumpe
DE102019105871A1 (de) 2019-03-07 2020-09-10 Liebherr-Mischtechnik Gmbh Gelenkarm-Steuerung einer Betonpumpe
DE102019105814A1 (de) * 2019-03-07 2020-09-10 Liebherr-Mischtechnik Gmbh Gelenkarm-Steuerung einer Betonpumpe
CN114753640B (zh) * 2022-04-01 2023-04-07 中联重科股份有限公司 臂架末端运动规划方法、装置、控制系统及工程机械
CN115781900A (zh) * 2022-11-18 2023-03-14 中铁四局集团第二工程有限公司 铁路预制箱梁智能布料装置、布料系统及布料方法

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1975070A (zh) * 2006-12-31 2007-06-06 三一重工股份有限公司 一种智能臂架控制装置
CN201406841Y (zh) * 2009-03-31 2010-02-17 北京易斯路电子有限公司 混凝土泵车智能臂架控制系统
CN101893900A (zh) * 2010-06-29 2010-11-24 三一重工股份有限公司 工程机械及其臂架控制系统

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4120905B2 (ja) * 1999-03-31 2008-07-16 石川島建機株式会社 ブーム付コンクリートポンプ車の運転制御装置
CN101487343B (zh) * 2009-01-14 2011-01-19 三一重工股份有限公司 一种混凝土泵车的控制方法、装置及系统
JP2011074712A (ja) * 2009-10-01 2011-04-14 Ihi Construction Machinery Ltd ブーム付きコンクリートポンプ車の残留コンクリート処理方法及び装置
CN103233581B (zh) * 2013-02-08 2016-07-06 上海格尼特控制技术有限公司 一种混凝土臂架泵车的控制方法
CN103806666B (zh) * 2014-01-26 2015-02-18 三一汽车制造有限公司 一种混凝土泵车和臂架控制方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1975070A (zh) * 2006-12-31 2007-06-06 三一重工股份有限公司 一种智能臂架控制装置
CN201406841Y (zh) * 2009-03-31 2010-02-17 北京易斯路电子有限公司 混凝土泵车智能臂架控制系统
CN101893900A (zh) * 2010-06-29 2010-11-24 三一重工股份有限公司 工程机械及其臂架控制系统

Also Published As

Publication number Publication date
WO2015109975A1 (zh) 2015-07-30
CN103806666A (zh) 2014-05-21

Similar Documents

Publication Publication Date Title
CN103806666B (zh) 一种混凝土泵车和臂架控制方法
CN103806667B (zh) 一种混凝土泵车及臂架控制方法与控制装置
US8577564B2 (en) System and method for controlling movement along a three dimensional path
JP7014789B2 (ja) 可撓性アーム上に取り付けられたロボットアームの動的補償
AU2011329243B2 (en) Control system for a machine
CN101525944B (zh) 混凝土泵车智能臂架控制系统及其控制方法
EP3012376B1 (en) Method for automatically controlling the operation of the lift assembly of a work vehicle
CN110455290B (zh) 一种智能液压挖掘机的最优轨迹规划方法
EP3128084B1 (en) Work vehicle with improved implement position control and self-leveling functionality
US8594896B2 (en) Lift arm control system
JPH11247231A (ja) 土工機械の自律制御のためのソフトウェア・アーキテクチュア
US20140067092A1 (en) Adaptive work cycle control system
CN104400783A (zh) 具有张力和关节位置反馈的机器人关节用挠性驱动单元控制方法
CN109467010B (zh) 用于借助起重机移动负载的方法
CN103792956B (zh) 智能臂空间运动控制方法及装置
JP2000327294A (ja) 作業用具の協働制御を行うための装置及びその方法
Činkelj et al. Closed-loop control of hydraulic telescopic handler
KR20210116597A (ko) 자동 운전 작업 기계
CN103195251A (zh) 臂架末端的运动控制方法、装置、系统和多节臂架车辆
WO2020033096A1 (en) Control system for movable additive manufacturing
JP2023524450A (ja) 静水圧旋回動作作動、監視、および制御システム
US20160160472A1 (en) System for Determining a Position of a Component
CN112947433B (zh) 一种果园移动机器人及其自主导航方法
US11634887B2 (en) Method and system for controlling construction machinery
CN102530725A (zh) 汽车起重机防摆控制技术

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
PE01 Entry into force of the registration of the contract for pledge of patent right

Denomination of invention: Concrete pump truck and cantilever crane control method

Effective date of registration: 20161101

Granted publication date: 20150218

Pledgee: Hunan Sany Road Machinery Co., Ltd.

Pledgor: SANY Automobile Manufacturing Co., Ltd.

Registration number: 2016430000042

PLDC Enforcement, change and cancellation of contracts on pledge of patent right or utility model
PC01 Cancellation of the registration of the contract for pledge of patent right

Date of cancellation: 20211126

Granted publication date: 20150218

Pledgee: HUNAN SANY ROAD MACHINERY Co.,Ltd.

Pledgor: Sany Automobile Manufacturing Co.,Ltd.

Registration number: 2016430000042

PC01 Cancellation of the registration of the contract for pledge of patent right