WO2015109975A1 - Concrete pump truck and boom control method - Google Patents

Concrete pump truck and boom control method Download PDF

Info

Publication number
WO2015109975A1
WO2015109975A1 PCT/CN2015/070973 CN2015070973W WO2015109975A1 WO 2015109975 A1 WO2015109975 A1 WO 2015109975A1 CN 2015070973 W CN2015070973 W CN 2015070973W WO 2015109975 A1 WO2015109975 A1 WO 2015109975A1
Authority
WO
WIPO (PCT)
Prior art keywords
boom
arm
target
angle
control method
Prior art date
Application number
PCT/CN2015/070973
Other languages
French (fr)
Chinese (zh)
Inventor
唐修俊
谭凌群
武利冲
蒲东亮
Original Assignee
三一汽车制造有限公司
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 三一汽车制造有限公司 filed Critical 三一汽车制造有限公司
Publication of WO2015109975A1 publication Critical patent/WO2015109975A1/en

Links

Images

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

Definitions

  • the boom will move from the point S1 to the point P2 according to the original plan. This will shorten the end of the boom from point A to point S1, and the boom will be elongated from point S1 to point P2, causing the plan to move in the opposite direction to the end of the boom in the target moving direction.
  • the arm frame is stretched and shortened repeatedly, causing the arm end to move unevenly.
  • an area is defined around the vertical point as a boom expansion and contraction conversion area, and if the arm end point is in the boom expansion and contraction conversion area, the predictive control is turned off.
  • the target constraint function is established according to the principle of minimum arm movement and motion stability, and the target constraint function is used to determine an optimal solution to achieve the continuity of the boom movement. At the same time, the improvement is achieved.
  • the stability and accuracy of the movement of the boom prevent the unstable movement of the boom, and reduce the movement of the arms and save energy and reduce emissions.

Landscapes

  • Engineering & Computer Science (AREA)
  • Architecture (AREA)
  • Mechanical Engineering (AREA)
  • Civil Engineering (AREA)
  • Structural Engineering (AREA)
  • Jib Cranes (AREA)
  • Operation Control Of Excavators (AREA)

Abstract

Disclosed are a boom control method and a concrete pump truck, wherein the control method comprises acquiring an actuating signal of a remote controller, a current state angle signal of each boom section of a boom, and a rotation angle signal of the boom in real time; and planning the movement of the tail end of the boom. The method further comprises a prediction control, in which, according to the target moving direction of the tail end of the boom, the coordinate values of the tail end point of the boom are calculated in real time, if the tail end point of the boom deviates from the target moving direction, the tail end of the boom is arranged according to a secondary plan, and a next target point is output by means of the secondary plan. In this method, the tail end of the boom is arranged according to a secondary plan in the condition that the tail end of the boom deviates from the target moving direction, the probability that the boom stretches and contracts repeatedly and alternately is lowered, and the method has the advantage of the tail end of the boom moving stably.

Description

一种混凝土泵车和臂架控制方法Concrete pump truck and boom control method
本申请要求于2014年01月26日提交中国专利局、申请号为201410036995.7、发明名称为“一种混凝土泵车和臂架控制方法”的中国专利申请的优先权,其全部内容通过引用结合在本申请中。This application claims priority to Chinese Patent Application No. 201410036995.7, entitled "A Concrete Pump Truck and Boom Control Method", filed on January 26, 2014, the entire contents of which are incorporated by reference. In this application.
技术领域Technical field
本发明涉及工程机械领域,特别涉及一种混凝土泵车和臂架控制方法。The invention relates to the field of engineering machinery, in particular to a concrete pump truck and a boom control method.
背景技术Background technique
混凝土泵车的臂架,一般由4节臂或5节臂或6节臂相互铰接而成,混凝土通过臂架输送到目标浇注点。通常的臂架控制方式是由操作人员使用遥控器对各节臂分别进行姿态调整,使臂架的整体从初始姿态运动到目标姿态,这种方式操作较为复杂,并且效率较低。The boom of the concrete pump truck is generally articulated by four arms or five arms or six arms, and the concrete is transported to the target pouring point through the boom. The usual boom control mode is that the operator uses the remote controller to adjust the posture of each arm separately, so that the whole arm moves from the initial posture to the target posture. This method is complicated and low in efficiency.
针对上述控制方式存在的不足,目前提出的臂架智能控制方法,能根据目标点坐标和各节臂的相关参数,通过运动方程和各种矩阵变换求出各个自由度的值,采用逆向求解的结果会出现多组解。对于多自由度的臂架,要使臂架末端移动到目标点,各节臂之间有不同的姿态,这样就需要确定一组较优解作为实际控制策略。而目前确定一个最优解较为复杂,控制效果不佳。In view of the shortcomings of the above control methods, the proposed intelligent control method of the boom can determine the values of each degree of freedom by the equation of motion and various matrix transformations according to the coordinates of the target point and the relevant parameters of each arm, and the inverse solution is used. As a result, multiple sets of solutions will appear. For a multi-degree-of-freedom boom, the end of the boom is moved to the target point, and each arm has a different posture, so it is necessary to determine a set of better solutions as the actual control strategy. At present, it is more complicated to determine an optimal solution, and the control effect is not good.
为了解决上述的技术问题,CN201110197146.6专利公开了“一种工程机械以及机械臂的控制方法与控制装置”,该专利技术每次动作采用两个自由度的机械臂,并遵从节臂位移量最小的原则,通过预先定义的“斜率”,根据控制指令确定需要动作的两个节臂。这样虽然简化了算法,但会导致调节的两个节臂运动突变,臂架运动不连续,臂架稳定性差。另外,如果臂架遇到障碍物,会出现无法控制等问题。而且,各节臂是由液压油缸驱动的,臂架在实际运动过程中,液压油缸伸缩量与各节臂角度变化量是非线性函数关系,即使液压油缸小的位移动作,也会导致节臂角度的大幅变化,造成突变及不稳定性问题。 In order to solve the above technical problem, the CN201110197146.6 patent discloses "a control method and a control device for a construction machine and a robot arm", which uses a two-degree-of-freedom robot arm for each movement and follows the arm arm displacement amount. The minimum principle is to determine the two booms that need to be actuated according to the control command by a predefined "slope". Although this simplifies the algorithm, it will cause the two arm movements of the adjustment to be abrupt, the movement of the boom is discontinuous, and the stability of the boom is poor. In addition, if the boom encounters an obstacle, there will be problems such as uncontrollable. Moreover, each arm is driven by a hydraulic cylinder. During the actual movement of the boom, the amount of expansion and contraction of the hydraulic cylinder is a nonlinear function relationship with the angular change of each arm. Even if the displacement of the hydraulic cylinder is small, the angle of the arm will be caused. Significant changes that cause mutations and instability problems.
与此同时,对于大惯性的柔性混凝土泵车臂架控制系统而言,因为各节臂伸长油缸进油量控制精度、臂架旋转角控制精度及臂架运动惯性等客观原因,经常会出现臂架末端偏离目标移动方向。如图1所示,在目标移动AB方向,臂架末端移动趋势是缩短的,在规划臂架末端移动时,都是根据遥控器动作信号开度,确定臂架末端移动的步长,P1和P2为臂架末端移动规划的下一个目标点,如果臂架末端偏离了P1点,到达S1点,臂架会根据原规划方案,从S1点向P2点移动。这样就会使得臂架末端从A点至S1点臂架是缩短的,从S1点到P2点臂架是伸长的,从而造成规划方案与目标移动方向的臂架末端移动趋势相反的情况,使得臂架伸长和缩短反复交替运作,导致臂架末端移动不平稳。At the same time, for the flexible inertia pump truck boom control system with large inertia, it often appears because of the objective reasons such as the control accuracy of the oil inlet cylinder of each section, the control accuracy of the boom rotation angle and the inertia of the boom. The end of the boom is offset from the target moving direction. As shown in Figure 1, in the direction of the target movement AB, the movement trend of the end of the boom is shortened. When the end of the planning boom moves, the step of moving the end of the boom is determined according to the opening signal of the remote control action signal, P1 and P2 is the next target point for the end movement planning of the boom. If the end of the boom deviates from the point P1 and reaches the point S1, the boom will move from the point S1 to the point P2 according to the original plan. This will shorten the end of the boom from point A to point S1, and the boom will be elongated from point S1 to point P2, causing the plan to move in the opposite direction to the end of the boom in the target moving direction. The arm frame is stretched and shortened repeatedly, causing the arm end to move unevenly.
发明内容Summary of the invention
有鉴于此,本发明提出一种混凝土泵车和臂架控制方法,以减少臂架运动过程中,臂架伸长和缩短反复交替动作,造成臂架末端移动不平稳的问题。In view of this, the present invention proposes a concrete pump truck and boom control method to reduce the problem that the boom is elongated and shortened repeatedly during the movement of the boom, and the movement of the end of the boom is not stable.
一方面,本发明提供了一种臂架控制方法,包括实时获取遥控器动作信号、臂架的各节臂当前状态角度信号及臂架旋转角度信号,对臂架末端移动进行规划,并且还包括预测控制,所述预测控制包括:In one aspect, the present invention provides a boom control method including real-time acquisition of a remote controller motion signal, a current state angle signal of each arm of the boom, and a boom rotation angle signal to plan movement of the boom end, and also includes Predictive control, the predictive control comprising:
根据所述臂架末端的目标移动方向,实时计算臂架末端点的坐标值,如果所述臂架末端点偏离了所述目标移动方向,则对所述臂架末端进行二次规划,所述二次规划输出下一个目标点。Calculating a coordinate value of the end point of the boom in real time according to the target moving direction of the end of the boom, and if the end point of the boom deviates from the moving direction of the target, performing secondary planning on the end of the boom, The secondary plan outputs the next target point.
进一步地,所述预测控制还包括以下步骤:Further, the predictive control further includes the following steps:
根据所述目标移动方向,预测臂架伸长区域和/或臂架缩短区域;Predicting the boom extension region and/or the boom shortening region according to the target moving direction;
如果所述臂架末端点在所述臂架伸长区域,且偏离了所述目标移动方向,则对所述臂架末端进行使臂架伸长的二次规划;If the end of the boom is located in the elongated region of the boom and deviates from the moving direction of the target, performing a secondary plan for elongating the boom to the end of the boom;
如果所述臂架末端点在所述臂架缩短区域,且偏离了所述目标移动方向,则对所述臂架末端进行使臂架缩短的二次规划。If the end of the boom is at the shortening area of the boom and deviates from the target moving direction, a secondary plan for shortening the boom is performed on the end of the boom.
进一步地,在所述目标移动方向上找到与臂架旋转中心距离最短的垂直点,所述垂直点至所述目标移动方向的区域为所述臂架伸长区域,相对 侧为所述臂架缩短区域。Further, a vertical point that is the shortest distance from the center of rotation of the boom is found in the target moving direction, and the area from the vertical point to the moving direction of the target is the extended area of the boom, and The side is the shortening area of the boom.
进一步地,在所述垂直点周围划定一个区域为臂架伸缩转换区域,如果所述臂架末端点在所述臂架伸缩转换区域,则关闭预测控制。Further, an area is defined around the vertical point as a boom expansion and contraction conversion area, and if the arm end point is in the boom expansion and contraction conversion area, the predictive control is turned off.
进一步地,对臂架末端移动规划包括:Further, the plan for moving the end of the boom includes:
步骤1:根据臂架当前位置至下一目标位置建立数学模型,并根据各节臂移动量最小和运动平稳性原则,建立目标约束函数;Step 1: Establish a mathematical model according to the current position of the boom to the next target position, and establish a target constraint function according to the principle of minimum arm movement and stability of each arm;
步骤2:根据所述遥控器动作信号、臂架的各节臂当前状态角度信号及臂架旋转角度信号,计算获得各节臂收展角度和臂架目标旋转角度;Step 2: calculating, according to the motion signal of the remote controller, the current state angle signal of each arm of the boom, and the rotation angle signal of the boom, obtaining the angle of the arm extension and the target rotation angle of the boom;
步骤3:判断所述各节臂收展角度是否超出臂架收展角度范围;Step 3: determining whether the angle of the arm of each section exceeds the range of the boom angle of the boom;
步骤4:如果所有节臂收展角度均超出,停止控制臂架动作;如果部分节臂收展角度超出,返回步骤2重新计算。Step 4: If all the boom angles are exceeded, stop the control boom motion; if the section boom angle is exceeded, return to step 2 to recalculate.
进一步地,所述目标约束函数包括如下公式:Further, the target constraint function includes the following formula:
OBJ1=∑wi·(θii-1)2 OBJ 1 =∑w i ·(θ ii-1 ) 2
OBJ2=∑wi·((θii-1)-(θi-1i-2))2 OBJ 2 =∑w i ·((θ ii-1 )-(θ i-1i-2 )) 2
其中,wi表示i节臂的权重;θi表示i节臂目标角度,θi-1表示i节臂当前角度,θi-2表示i节臂前一步的角度。Where w i represents the weight of the i-section arm; θ i represents the i-section arm target angle, θ i-1 represents the current angle of the i- section arm, and θ i-2 represents the angle of the previous step of the i-section arm.
进一步地,如果i节臂被操作手锁定,wi为0。Further, if the i-section arm is locked by the operating hand, w i is zero.
进一步地,在所述步骤2中:将空间轨迹规划分成臂架旋转和机械臂平面收展分别计算,并分别获得所述各节臂收展角度和臂架目标旋转角度。Further, in the step 2, the spatial trajectory planning is divided into a boom rotation and a mechanical arm plane expansion, respectively, and the respective section arm expansion angles and the boom target rotation angles are respectively obtained.
进一步地,所述数学模型如下:Further, the mathematical model is as follows:
Figure PCTCN2015070973-appb-000001
Figure PCTCN2015070973-appb-000001
Figure PCTCN2015070973-appb-000002
Figure PCTCN2015070973-appb-000002
Figure PCTCN2015070973-appb-000003
Figure PCTCN2015070973-appb-000003
其中,θmin≤θi≤θmax,θi为i节臂与i-1节臂的夹角,θmin表示i节臂最小收展角度,θmax表示i节臂最大收展角度,θ0为旋转角度,li为各 节臂长度,xend,yend,zend为末端点坐标,N为臂架的节臂数量。Where θ min ≤ θ i ≤ θ max , θ i is the angle between the i-section arm and the i-1-section arm, θ min represents the minimum buck angle of the i-section arm, and θ max represents the maximum buck angle of the i-section arm, θ 0 is the rotation angle, l i is the length of each arm, x end , y end , z end is the end point coordinate, and N is the number of the arm of the boom.
另外,本发明,还提供了一种混凝土泵车,包括臂架,并采用上述任意一种所述的臂架控制方法。Further, the present invention provides a concrete pump truck comprising a boom and using the boom control method of any of the above.
本发明提供的一种混凝土泵车和臂架控制方法,增加了预测控制程序,根据臂架末端的目标移动方向,实时计算臂架末端点的坐标值,如果臂架末端偏离了目标移动方向,则对臂架末端进行二次规划,该二次规划输出下一个目标点。由于在臂架末端偏离目标移动方向的情况下,对臂架末端进行了二次规划,不再根据原规划的方案控制臂架动作,保证臂架末端点始终朝向目标点移动,降低了臂架伸长和缩短反复交替运作的可能性,使臂架末端动作更平稳。The invention provides a concrete pump truck and boom control method, which adds a predictive control program, and calculates the coordinate value of the end point of the boom in real time according to the target moving direction at the end of the boom. If the end of the boom deviates from the target moving direction, Then the second end of the boom end is planned, and the second plan outputs the next target point. Because the end of the boom is deviated from the target moving direction, the end of the boom is quadraticized, and the motion of the boom is no longer controlled according to the original plan, so that the end point of the boom always moves toward the target point, and the boom is lowered. Elongation and shortening the possibility of repeated alternating operations, making the end of the boom more stable.
进一步的技术方案中,根据臂架末端的目标移动方向,预测臂架伸长区域和/或臂架缩短区域,作为对臂架运动规划的限制条件。如果臂架末端点在臂架伸长区域,且偏离了目标移动方向,对臂架末端移动进行使臂架伸长的二次规划;如果臂架末端点在臂架缩短区域,且偏离了目标移动方向,对臂架末端移动进行使臂架缩短的二次规划。根据二次规划的下一个目标点进行臂架末端移动规划计算,得到对应的臂架旋转角度和各个节臂的收展角度,使得臂架规划方案与目标移动方向的臂架移动趋势一致,进一步避免了臂架伸长或缩短反复交替动作,臂架移动平稳。In a further technical solution, the boom extension region and/or the boom shortening region are predicted according to the target moving direction of the boom end as a limitation condition for the boom motion planning. If the end of the boom is at the extension of the boom and deviates from the target moving direction, the end of the boom is moved to make a secondary plan for elongating the boom; if the end of the boom is in the shortened area of the boom and deviates from the target The direction of movement, the movement of the end of the boom to make a secondary plan to shorten the boom. According to the next target point of the secondary planning, the calculation of the end movement of the boom is carried out, and the corresponding arm rotation angle and the folding angle of each arm are obtained, so that the boom planning scheme and the target moving direction of the boom movement trend are consistent, further It avoids the extension of the boom or shortens the repeated alternating movements, and the boom moves smoothly.
另外,规划臂架运动过程中,根据各节臂移动量最小和运动平稳性原则,建立目标约束函数,通过目标约束函数,确定一个最优解,实现臂架运动的连续性;同时,提高了臂架运动平稳性和精确性,防止臂架运动突变不稳定的情况发生,并起到减少各节臂移动量及节能减排的作用。In addition, during the planning of the boom movement, the target constraint function is established according to the principle of minimum arm movement and motion stability, and the target constraint function is used to determine an optimal solution to achieve the continuity of the boom movement. At the same time, the improvement is achieved. The stability and accuracy of the movement of the boom prevent the unstable movement of the boom, and reduce the movement of the arms and save energy and reduce emissions.
为了简化计算,优选将空间轨迹规划分成臂架旋转和机械臂平面收展分别进行计算,并分别获得各节臂收展角度和臂架目标旋转角度,然后判断是否超出臂架移动范围,实现了臂架智能控制的目的。In order to simplify the calculation, it is preferred to divide the spatial trajectory planning into the jib rotation and the mechanical arm plane to be separately calculated, and obtain the angle of each section arm and the target rotation angle of the jib respectively, and then judge whether the boom movement range is exceeded or not. The purpose of the arm frame intelligent control.
为了进一步提高臂架运动的连续性和平稳性能,还综合考虑臂架铰接连杆机构关系,融入运动学、动力学关系,调整轨迹算法,进而控制电流为斜坡函数。为了增大臂架作业范围,防止臂架与障碍物相碰,增加了节臂锁定功能,如果节臂被操作手锁定,节臂的权重为0。操作者可根据当前臂架姿态进行任意节臂的锁定实现目标点的轨迹规划,使得操作更加灵 活,扩大了施工作业范围和臂架规划策略通用性。In order to further improve the continuity and smooth performance of the boom movement, the relationship between the articulated linkage mechanism of the boom is also considered, the kinematics and dynamics relationship are integrated, the trajectory algorithm is adjusted, and the current is controlled as a ramp function. In order to increase the working range of the boom and prevent the boom from colliding with the obstacle, the arm locking function is added. If the arm is locked by the operating hand, the weight of the arm is zero. The operator can lock the arbitrary target arm according to the current boom attitude to realize the trajectory planning of the target point, which makes the operation more flexible. Live, expanding the scope of construction operations and the versatility of the boom planning strategy.
附图说明DRAWINGS
构成本发明的一部分的附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:The accompanying drawings, which are incorporated in the claims In the drawing:
图1为现有臂架控制方法示意图;1 is a schematic view of a conventional boom control method;
图2为本发明臂架预测控制方法流程示意图;2 is a schematic flow chart of a method for predicting and controlling a boom according to the present invention;
图3为本发明臂架控制原理示意图;3 is a schematic view showing the principle of the boom control of the present invention;
图4为本发明臂架末端移动规划流程示意图;4 is a schematic flow chart of the end movement planning of the boom of the present invention;
图5为本发明臂架末端移动规划计算流程示意图。FIG. 5 is a schematic flow chart of the calculation process of the end movement of the boom of the present invention.
具体实施方式detailed description
需要说明的是,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本发明。It should be noted that the embodiments in the present invention and the features in the embodiments may be combined with each other without conflict. The invention will be described in detail below with reference to the drawings in conjunction with the embodiments.
本发明提供的一种臂架控制方法,包括实时获取遥控器动作信号和臂架的各节臂当前状态角度信号及臂架旋转角度信号,对臂架末端移动进行规划,此外还包括预测控制,该预测控制包括:The invention provides a boom control method, which comprises real-time acquiring a motion signal of a remote controller and a current state angle signal of each arm of the boom and a rotation angle signal of the boom, planning the movement of the end of the boom, and further including predictive control. The predictive control includes:
根据臂架末端的目标移动方向,实时计算臂架末端点的坐标值,如果臂架末端点偏离了目标移动方向,则对臂架末端进行二次规划,该二次规划输出下一个目标点。According to the target moving direction at the end of the boom, the coordinate value of the end point of the boom is calculated in real time. If the end point of the boom deviates from the target moving direction, the end of the boom is secondarily planned, and the secondary planning outputs the next target point.
需要说明的是,臂架末端点偏离了目标移动方向是指偏离了目标移动方向一定的范围,因此应理解为可以具有一定误差的偏离,即对于误差范围内的偏离目标移动方向,可以不进行二次规划,超过误差范围就需要进行二次规划。根据控制精度,可以设置合适的误差范围。It should be noted that the deviation of the end point of the boom from the target moving direction refers to a certain range deviating from the moving direction of the target. Therefore, it should be understood that the deviation may be a certain error, that is, the deviation from the target moving direction within the error range may not be performed. Secondary planning, beyond the error range, requires secondary planning. According to the control accuracy, an appropriate error range can be set.
本发明由于在臂架末端偏离目标移动方向的情况下,对臂架末端进行了二次规划,即从臂架末端的当前点到目标点重新规划,不再根据原规划的方案控制臂架动作,保证臂架末端点始终朝向目标点移动,降低了臂架伸长和缩短反复交替运作的可能性,使臂架末端动作更平稳。 In the present invention, since the end of the boom is deviated from the target moving direction, the end of the boom is secondarily planned, that is, from the current point of the boom end to the target point, and the boom motion is no longer controlled according to the original planned scheme. The arm end point is always moved toward the target point, which reduces the possibility of the arm frame elongating and shortening the repeated alternate operation, so that the end of the arm frame moves more smoothly.
如图2和图3所示,本发明优选的一种臂架控制方法,包括预测控制,预测控制优选包括:根据臂架末端的目标移动方向AB,预测臂架伸长区域和/或臂架缩短区域;实时计算臂架末端点坐标值,如果臂架末端点在臂架伸长区域,且臂架末端点偏离了目标移动方向AB,对臂架末端进行使臂架伸长的二次规划;如果臂架末端点在臂架缩短区域,且臂架末端点偏离了目标移动方向AB,对臂架末端进行使臂架缩短的二次规划,二次规划输出下一个目标点H1、H2。As shown in FIG. 2 and FIG. 3, a preferred boom control method according to the present invention includes predictive control, and the predictive control preferably includes: predicting the boom extension region and/or the boom according to the target moving direction AB at the end of the boom. Shorten the area; calculate the coordinates of the end point of the boom in real time. If the end of the boom is in the extended area of the boom, and the end point of the boom deviates from the target moving direction AB, the secondary planning of the boom extension is performed on the end of the boom. If the end of the boom is at the shortened area of the boom, and the end point of the boom deviates from the target moving direction AB, the secondary planning of shortening the boom is performed on the end of the boom, and the next target points H1 and H2 are output by the secondary planning.
需要说明的是,二次规划使臂架伸长及二次规划使臂架缩短均应理解为包括臂架保持不变的情形,即在伸长区域,臂架不会改变伸长的趋势,在缩短区域,臂架不会改变缩短的趋势。因而在臂架伸长区域,不会出现臂架缩短的情况,在臂架缩短区域,不会出现臂架伸长的情况,进一步防止了臂架伸长和缩短反复动作。如果臂架末端点在臂架伸缩转换区域上,关闭预测控制。It should be noted that the secondary planning to extend the boom and the secondary planning to shorten the boom should be understood to include the case where the boom remains unchanged, that is, in the extended region, the boom does not change the tendency of elongation. In the shortened area, the boom does not change the tendency to shorten. Therefore, in the extended region of the boom, the boom is not shortened, and in the shortened region of the boom, the boom is not elongated, and the boom is further prevented from being extended and the repeated motion is shortened. If the end of the boom is on the boom expansion and contraction transition area, the predictive control is turned off.
通过数学计算方法,预测臂架伸长区域和臂架缩短区域及臂架伸缩转换区域;在目标移动方向上找到与臂架旋转中心距离最短的垂直点Q,垂直点Q至目标移动方向的区域为臂架伸长区域QB,相对侧为臂架缩短区域AQ,在垂直点Q周围划定一个区域为臂架伸缩转换区域。一般以垂直点Q为中心,以500MM为半径画圆,作为臂架伸缩转换区域。在臂架伸缩转换区域不进行预测控制,避免因预测控制功能使臂架不能向目标方向移动的问题。Through the mathematical calculation method, predict the boom extension area and the boom shortening area and the boom expansion and contraction conversion area; find the vertical point Q with the shortest distance from the rotation center of the boom in the target moving direction, and the area from the vertical point Q to the target moving direction The boom extension area QB, the opposite side is the boom shortening area AQ, and an area defined around the vertical point Q is the boom expansion and contraction conversion area. Generally, the vertical point Q is centered, and a circle is drawn with a radius of 500 mm as a boom expansion and contraction conversion region. Predictive control is not performed in the boom expansion and contraction conversion area, and the problem that the boom cannot move to the target direction due to the predictive control function is avoided.
臂架控制原理如图3所示,获取遥控器动作信号、臂架的各节臂当前状态角度信号及臂架旋转角度信号,在目标移动方向AB上,规划臂架末端点每一步移动的下一个目标点P1、P2、P3、P4、P5、P6,一般P1至P2的步长等于P2至P3的步长,P4至P5的步长等于P5至P6的步长。同时也实时采集遥控器动作信号,根据遥控器动作信号实时更新各个目标点。The control principle of the boom is as shown in Fig. 3. Obtain the action signal of the remote controller, the current state angle signal of each arm of the boom and the rotation angle signal of the boom. In the target moving direction AB, plan the movement of the end point of the boom at each step. A target point P1, P2, P3, P4, P5, P6, generally the step size of P1 to P2 is equal to the step size of P2 to P3, and the step size of P4 to P5 is equal to the step size of P5 to P6. At the same time, the remote control action signal is also collected in real time, and each target point is updated in real time according to the remote action signal.
假设臂架末端点当前位置A向P1点移动,计算得到臂架末端点当前位置A和下一个目标点P1的坐标值,根据臂架当前位置A至下一个目标点P1对臂架末端移动进行规划计算;获得各节臂收展角度和臂架目标旋转角度(收展角度为各节臂架绕其铰接点转动的角度,臂架目标旋转角度为整个臂架装置绕连接臂架的转台需要旋转的角度)。 Assume that the current position A of the boom end point moves to the point P1, and the coordinate values of the current position A of the boom end point and the next target point P1 are calculated, and the arm end movement is performed according to the current position A of the boom to the next target point P1. Planning calculation; obtaining the angle of the arm of each section and the angle of rotation of the target of the boom (the angle of rotation is the angle of rotation of each arm around its hinge point, and the target rotation angle of the boom is the need of the turntable of the entire boom device around the connecting arm) The angle of rotation).
由于各节臂伸长油缸进油量控制精度、臂架旋转角控制精度及臂架运动惯性等客观原因,臂架末端点偏离目标移动方向AB,臂架末端点到达S1点。此时,需要判断臂架末端点S1在臂架伸长区域,还是在臂架缩短区域或者臂架转换区域。经过判断臂架末端点S1在臂架缩短区域,就需要对臂架末端的下一个目标点H1进行二次规划,不能依据前一次规划的下一个目标点P2进行移动。否则,臂架会伸长缩短交替动作,造成臂架运动不平稳。在对下一个目标点H1规划时,需要考虑使臂架缩短作为二次规划的限制条件。臂架末端点从A点至S1点,臂架是缩短的,臂架末端点从S1点至H1点,臂架也是缩短的,这样使得臂架末端在臂架缩短区域,臂架一直都是缩短的,臂架运动不平稳。Due to the objective reasons such as the control accuracy of the oil-increasing cylinder of each arm, the control accuracy of the boom rotation angle and the inertia of the boom, the end point of the boom deviates from the target moving direction AB, and the end point of the boom reaches the point S1. At this time, it is necessary to judge whether the boom end point S1 is in the boom extension region or in the boom shortening region or the boom conversion region. After judging that the boom end point S1 is in the boom shortening area, it is necessary to perform secondary planning on the next target point H1 at the end of the boom, and cannot move according to the previous planned target point P2. Otherwise, the boom will elongate and shorten the alternate action, causing the boom to move unsteadily. When planning for the next target point H1, it is necessary to consider shortening the boom as a constraint for secondary planning. The end point of the boom is from point A to point S1, the boom is shortened, the end point of the boom is from point S1 to point H1, and the boom is also shortened, so that the end of the boom is in the shortened area of the boom, and the boom is always Shortened, the boom movement is not stable.
假设臂架末端点从P4向P5点移动,由于各节臂伸长油缸进油量控制精度、臂架旋转角控制精度及臂架运动惯性等客观原因,臂架末端点偏离目标移动方向AB,臂架末端点到达S2点。此时臂架末端点S2在臂架伸长区域,就需要对臂架末端的下一个目标点H2进行二次规划,不能依据前一次规划的下一个目标点P6进行移动。否则,臂架会伸长缩短交替动作,造成臂架运动不平稳。在对下一个目标点H2规划时,需要考虑使臂架伸长作为二次规划的限制条件。臂架末端点从P4点至S2点,臂架是伸长的,臂架末端点从S2点至H2点,臂架也是伸长的,这样使得臂架末端在臂架伸长区域,臂架一直都是伸长的,臂架运动不平稳。Assume that the end point of the boom moves from P4 to P5. Due to the objective reasons such as the control accuracy of the oil cylinder of each section arm, the control accuracy of the boom rotation angle and the inertia of the boom, the end point of the boom deviates from the target moving direction AB. The end of the boom reaches the point S2. At this time, the boom end point S2 is in the boom extension region, and the next target point H2 at the end of the boom needs to be quadraticized, and cannot be moved according to the previous planned target point P6. Otherwise, the boom will elongate and shorten the alternate action, causing the boom to move unsteadily. When planning for the next target point H2, it is necessary to consider the extension of the boom as a constraint for the secondary planning. The end of the boom is from P4 to S2, the boom is elongated, the end of the boom is from S2 to H2, and the boom is also elongated, so that the end of the boom is in the extended area of the boom, the boom It has always been stretched and the boom movement is not stable.
如图4和图5所示,在规划臂架末端移动时,包括:As shown in Figures 4 and 5, when the end of the planning boom moves, it includes:
步骤1:根据臂架当前位置至下一个目标位置建立数学模型,并根据各节臂移动量最小和运动平稳性原则,建立目标约束函数;Step 1: Establish a mathematical model according to the current position of the boom to the next target position, and establish a target constraint function according to the principle of minimum arm movement and smoothness of each arm;
步骤2:根据遥控器动作信号、臂架的各节臂当前状态角度信号、臂架当前旋转角度信号,通过计算获得各节臂收展角度和臂架目标旋转角度;Step 2: According to the remote action signal, the current state angle signal of each arm of the boom, and the current rotation angle signal of the boom, the angle of the boom extension and the target rotation angle of the boom are obtained through calculation;
步骤3:判断各节臂收展角度是否超出臂架收展角度范围;Step 3: Determine whether the angle of the arm of each section exceeds the range of the boom angle;
步骤4:如果所有节臂收展角度均超出臂架收展角度范围,停止控制臂架动作;如果部分节臂收展角度超出臂架收展角度范围,返回步骤2重新计算,否则,控制臂架动作。Step 4: If all the boom angles exceed the boom angle range, stop the control boom motion; if the section boom angle exceeds the boom bracket angle range, return to step 2 to recalculate, otherwise, the control arm Frame action.
具体实施如下:The specific implementation is as follows:
1)建立坐标系 1) Establish a coordinate system
以混凝土泵车转台与臂架始端节臂铰接处作为坐标原点,以车身的料斗方向为X正半轴,以垂直于车身的方向为Y轴正半轴,根据笛卡尔坐标系右手定则,可确定Z轴。本坐标系是臂架智能运动系统基准坐标系,即对臂架设计的运动规划策略都是以该坐标系作为参照的。The hinge position of the concrete pump truck turntable and the starting end of the boom frame is taken as the coordinate origin, and the hopper direction of the vehicle body is the X positive half shaft, and the direction perpendicular to the vehicle body is the positive half axis of the Y axis, according to the right hand rule of the Cartesian coordinate system. The Z axis can be determined. This coordinate system is the reference coordinate system of the boom intelligent motion system, that is, the motion planning strategy for the boom design is based on the coordinate system.
2)通过信号采集装置接收获取遥控器动作信号、臂架的各节臂当前状态角度信号、臂架当前旋转角度信号。遥控器动作信号包括操作手柄的方向信号和速度信号,信号采集装置通过无线信号接收装置接收遥控装置动作信号,通过角度传感器获取臂架的各节臂当前状态角度信号和臂架当前旋转角度信号。2) receiving, by the signal acquisition device, the action signal of the remote controller, the current state angle signal of each arm of the boom, and the current rotation angle signal of the boom. The remote control action signal includes a direction signal and a speed signal of the operation handle, and the signal acquisition device receives the action signal of the remote control device through the wireless signal receiving device, and acquires the current state angle signal of each arm of the boom and the current rotation angle signal of the boom through the angle sensor.
3)臂架空间轨迹规划建立数学模型3) Establish a mathematical model for the trajectory planning of the boom space
设计多自由度臂架运动规划策略之前,首先需要建立系统数学模型。根据臂架结构运动学关系可知,在上述建立的坐标系基础上,数学模型为:Before designing a multi-degree-of-freedom boom motion planning strategy, you first need to establish a system mathematical model. According to the kinematics of the boom structure, based on the above established coordinate system, the mathematical model is:
Figure PCTCN2015070973-appb-000004
Figure PCTCN2015070973-appb-000004
Figure PCTCN2015070973-appb-000005
Figure PCTCN2015070973-appb-000005
Figure PCTCN2015070973-appb-000006
Figure PCTCN2015070973-appb-000006
其中,θmin≤θi≤θmax,θi为i节臂与i-1节臂的夹角,θmin表示i节臂最小收展角度,θmax表示i节臂最大收展角度;θ0为旋转角度;li为各节臂长度;xend,yend,zend为末端点坐标,N为臂架的节臂数量。Where θ min ≤ θ i ≤ θ max , θ i is the angle between the i-section arm and the i-1-section arm, θ min represents the minimum buck angle of the i-section arm, and θ max represents the maximum buck angle of the i-section arm; 0 is the rotation angle; l i is the length of each arm; x end , y end , z end is the end point coordinate, and N is the number of the arm of the boom.
将空间轨迹规划分成臂架旋转和机械臂平面收展两个规划分别进行计算,分别获得各节臂收展角度和臂架目标旋转角度。The spatial trajectory planning is divided into two parts: the boom rotation and the mechanical arm plane expansion, and the calculation results are respectively obtained, and the angles of the booms and the target rotation angles of the booms are respectively obtained.
若只考虑臂架平面运动则上述数学模型简化为: If only the plane motion of the boom is considered, the above mathematical model is simplified as:
Figure PCTCN2015070973-appb-000007
Figure PCTCN2015070973-appb-000007
Figure PCTCN2015070973-appb-000008
Figure PCTCN2015070973-appb-000008
4)建立目标约束函数时需要考虑:4) Consider the following when building the target constraint function:
其一、从当前位置移动到目标位置,臂架移动尽量小,即节能减排;First, moving from the current position to the target position, the boom movement is as small as possible, that is, energy saving and emission reduction;
其二、臂架平稳移动,避免剧烈的速度变化,特别是反向运动。Second, the boom moves smoothly, avoiding drastic speed changes, especially reverse motion.
OBJ1=∑wi·(θii-1)2 OBJ 1 =∑w i ·(θ ii-1 ) 2
OBJ2=∑wi·((θii-1)-(θi-1i-2))2 OBJ 2 =∑w i ·((θ ii-1 )-(θ i-1i-2 )) 2
其中,wi表示i节臂的权重,θi表示i节臂目标角度,θi-1表示i节臂当前角度,θi-2表示i节臂前一步的角度。Where w i represents the weight of the i-section arm, θ i represents the i-section arm target angle, θ i-1 represents the current angle of the i- section arm, and θ i-2 represents the angle of the previous step of the i-section arm.
如果i节臂被操作手锁定,i节臂的权重wi为0。If the i-section arm is locked by the operator, the weight w i of the i-section arm is zero.
5)建立带约束的优化问题,将带约束的优化问题转化为非约束的优化问题。5) Establish a constrained optimization problem and transform the constrained optimization problem into an unconstrained optimization problem.
下一步加入惩罚因子,将带约束的优化问题转化为非约束的优化问题Next, add a penalty factor to transform the constrained optimization problem into an unconstrained optimization problem.
Figure PCTCN2015070973-appb-000009
Figure PCTCN2015070973-appb-000009
因此只要求得g(θ)的解即可。Therefore, only the solution of g(θ) is required.
如图4所示,具体步骤如下:As shown in Figure 4, the specific steps are as follows:
第一步:设定初始值,将获得的臂架的各节臂当前状态角度信号设定为初值、臂架当前旋转角度信号设定为初值;Step 1: Set the initial value, set the current state angle signal of each arm of the obtained boom to the initial value, and set the current rotation angle signal of the boom to the initial value;
第二步:采用一维线性搜索方法计算步长h或者采用负梯度方法;Step 2: Calculate the step size h or adopt a negative gradient method using a one-dimensional linear search method;
第三步,如果,ceq1、2(x)<ε并且θimin≤θi≤θimax,则退出; In the third step, if ceq 1 , 2 (x) < ε and θ imin ≤ θ i ≤ θ imax , exit;
第四步,否则跳转第二步。The fourth step, otherwise jump to the second step.
6)臂架在运动过程中某节臂被锁定;6) A certain arm is locked during the movement of the boom;
在运动过程中,某个节臂若因为人为或者结构原因,导致无法移动,需要在规划策略设计中降低一维或多维自由度。具体地分为两种情况:During the movement, if a certain arm is unable to move due to human or structural reasons, it is necessary to reduce one-dimensional or multi-dimensional degrees of freedom in planning strategy design. Specifically divided into two cases:
其一、若臂架旋转无法满足输入命令要求,则停止运动;First, if the boom rotation cannot meet the input command requirements, the motion is stopped;
其二、若臂架某个节臂被锁定,则将当前节臂姿态记录下来,通过节臂平面运动规划中,将该i节臂的权重wi为0。Second, if a certain arm of the boom is locked, the current arm posture is recorded, and the weight w i of the i-section arm is 0 through the plan motion of the joint arm plane.
7)通过计算获得各节臂收展角度和臂架目标旋转角度;7) obtaining the angle of the arm extension and the target rotation angle of the boom by calculation;
8)判断各节臂收展角度是否超出臂架收展角度范围;如果所有节臂收展角度均超出,停止控制臂架动作;如果部分节臂收展角度超出,返回步骤2重新计算,否则,控制臂架动作。8) Determine whether the angle of the arm of each section exceeds the range of the boom angle; if all the angles of the arm are exceeded, stop the control of the boom; if the angle of the section is exceeded, return to step 2 to recalculate, otherwise , control the movement of the boom.
9)在步骤4中:根据各节臂角度与驱动各节臂动作的液压油缸伸缩量函数关系,需要充分考虑结构运动学和动力学,计算得到液压油缸伸缩量,向控制液压油缸的电磁换向阀输入控制电流,控制电流是一个斜坡函数,而不是矩形函数,确保臂架动作连续性和平顺性。9) In step 4: According to the relationship between the arm angle and the hydraulic cylinder expansion and contraction function of driving the arm movements, it is necessary to fully consider the structural kinematics and dynamics, calculate the hydraulic cylinder expansion and contraction amount, and control the electromagnetic cylinder to electromagnetic exchange. The control current is input to the valve, and the control current is a ramp function instead of a rectangular function to ensure the continuity and smoothness of the boom movement.
10)如果遥控器停止动作,停止臂架动作;如果遥控器继续动作,返回步骤1。10) If the remote control stops, stop the boom movement; if the remote control continues to move, return to step 1.
本发明提供的一种臂架控制方法,根据各节臂移动量最小和运动平稳性原则,建立目标约束函数;通过目标约束函数,确定一个最优解,实现臂架运动的连续性;同时,提高了臂架运动平稳性和精确控制,防止臂架运动突变不稳定的情况发生,减少各节臂移动量,起到节能减排的作用。The invention provides a boom control method, which establishes a target constraint function according to the principle of minimum arm movement and motion stability of each arm; and determines an optimal solution by the target constraint function to realize the continuity of the boom motion; Improve the stability and precise control of the movement of the boom, prevent the unstable movement of the boom from occurring, reduce the amount of movement of each arm, and play the role of energy saving and emission reduction.
另外,为了简化计算,将空间轨迹规划分成臂架旋转和机械臂平面收展分别进行计算,并分别获得各节臂收展角度和臂架目标旋转角度,然后判断是否超出臂架移动范围,防止与障碍物相碰,实现了臂架智能控制的目的。In addition, in order to simplify the calculation, the spatial trajectory planning is divided into the jib rotation and the mechanical arm plane to be separately calculated, and the angle of each arm and the target rotation angle of the jib are respectively obtained, and then it is judged whether the movement range of the jib is exceeded or not Collision with obstacles, the purpose of intelligent control of the boom.
为了进一步提高臂架运动的连续性和平稳性能,还综合考虑臂架铰接连杆机构关系,融入运动学、动力学关系,调整轨迹算法,控制电流是一个斜坡函数。In order to further improve the continuity and smooth performance of the boom movement, the relationship between the articulated linkage mechanism of the boom is also considered, the kinematics and dynamics relationship are integrated, and the trajectory algorithm is adjusted. The control current is a ramp function.
为了增大臂架作业范围,防止臂架与障碍物相碰,增加了节臂锁定功能,如果i节臂被操作手锁定,i节臂的权重wi为0,这样操作者可根据当 前臂架姿态进行任意节臂的锁定,实现目标点的轨迹规划,使得操作更加灵活,扩大了施工作业范围和臂架规划策略通用性。In order to increase the working range of the boom and prevent the boom from colliding with the obstacle, the arm locking function is added. If the i-section arm is locked by the operating hand, the weight w i of the i-section arm is 0, so that the operator can follow the current arm. The posture of the frame is locked by any arm, and the trajectory planning of the target point is realized, which makes the operation more flexible, and expands the scope of construction work and the versatility of the boom planning strategy.
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。 The above is only the preferred embodiment of the present invention, and is not intended to limit the present invention. Any modifications, equivalent substitutions, improvements, etc., which are included in the spirit and scope of the present invention, should be included in the present invention. Within the scope of protection.

Claims (10)

  1. 一种臂架控制方法,包括实时获取遥控器动作信号、臂架的各节臂当前状态角度信号及臂架旋转角度信号,对臂架末端移动进行规划,其特征在于,还包括预测控制,所述预测控制包括:A boom control method includes real-time acquisition of a motion signal of a remote controller, a current state angle signal of each arm of the boom, and a rotation angle signal of the boom, and planning the movement of the end of the boom, which is characterized in that it also includes predictive control. The predictive control includes:
    根据所述臂架末端的目标移动方向,实时计算臂架末端点的坐标值,如果所述臂架末端点偏离了所述目标移动方向,则对所述臂架末端进行二次规划,所述二次规划输出下一个目标点。Calculating a coordinate value of the end point of the boom in real time according to the target moving direction of the end of the boom, and if the end point of the boom deviates from the moving direction of the target, performing secondary planning on the end of the boom, The secondary plan outputs the next target point.
  2. 根据权利要求1所述的臂架控制方法,其特征在于,所述预测控制还包括以下步骤:The boom control method according to claim 1, wherein the predictive control further comprises the following steps:
    根据所述目标移动方向,预测臂架伸长区域和/或臂架缩短区域;Predicting the boom extension region and/or the boom shortening region according to the target moving direction;
    如果所述臂架末端点在所述臂架伸长区域,且偏离了所述目标移动方向,则对所述臂架末端进行使臂架伸长的二次规划;If the end of the boom is located in the elongated region of the boom and deviates from the moving direction of the target, performing a secondary plan for elongating the boom to the end of the boom;
    如果所述臂架末端点在所述臂架缩短区域,且偏离了所述目标移动方向,则对所述臂架末端进行使臂架缩短的二次规划。If the end of the boom is at the shortening area of the boom and deviates from the target moving direction, a secondary plan for shortening the boom is performed on the end of the boom.
  3. 根据权利要求2所述的臂架控制方法,其特征在于,在所述目标移动方向上找到与臂架旋转中心距离最短的垂直点,所述垂直点至所述目标移动方向的区域为所述臂架伸长区域,相对侧为所述臂架缩短区域。The boom control method according to claim 2, wherein a vertical point that is the shortest distance from the center of rotation of the boom is found in the target moving direction, and the area from the vertical point to the moving direction of the target is the The boom extension region, the opposite side is the boom shortening region.
  4. 根据权利要求3所述的臂架控制方法,其特征在于,在所述垂直点周围划定一个区域为臂架伸缩转换区域,如果所述臂架末端点在所述臂架伸缩转换区域,则关闭预测控制。The boom control method according to claim 3, wherein a region defined around the vertical point is a boom telescopic conversion region, and if the boom end point is in the boom telescopic conversion region, Turn off predictive control.
  5. 根据权利要求1-4任一项所述的臂架控制方法,其特征在于,对臂架末端移动规划包括:The boom control method according to any one of claims 1 to 4, wherein the plan for moving the end of the boom comprises:
    步骤1:根据臂架当前位置至下一目标位置建立数学模型,并根据各节臂移动量最小和运动平稳性原则,建立目标约束函数;Step 1: Establish a mathematical model according to the current position of the boom to the next target position, and establish a target constraint function according to the principle of minimum arm movement and stability of each arm;
    步骤2:根据所述遥控器动作信号、臂架的各节臂当前状态角度信号及臂架旋转角度信号,计算获得各节臂收展角度和臂架目标旋转角度;Step 2: calculating, according to the motion signal of the remote controller, the current state angle signal of each arm of the boom, and the rotation angle signal of the boom, obtaining the angle of the arm extension and the target rotation angle of the boom;
    步骤3:判断所述各节臂收展角度是否超出臂架收展角度范围;Step 3: determining whether the angle of the arm of each section exceeds the range of the boom angle of the boom;
    步骤4:如果所有节臂收展角度均超出,停止控制臂架动作;如果部分节臂收展角度超出,返回步骤2重新计算。 Step 4: If all the boom angles are exceeded, stop the control boom motion; if the section boom angle is exceeded, return to step 2 to recalculate.
  6. 根据权利要求5所述的臂架控制方法,其特征在于,所述目标约束函数包括如下公式:The boom control method according to claim 5, wherein the target constraint function comprises the following formula:
    OBJ1=∑wi·(θii-1)2 OBJ 1 =∑w i ·(θ ii-1 ) 2
    OBJ2=∑wi·((θii-1)-(θi-1i-2))2 OBJ 2 =∑w i ·((θ ii-1 )-(θ i-1i-2 )) 2
    其中,wi表示i节臂的权重;θi表示i节臂目标角度,θi-1表示i节臂当前角度,θi-2表示i节臂前一步的角度。Where w i represents the weight of the i-section arm; θ i represents the i-section arm target angle, θ i-1 represents the current angle of the i- section arm, and θ i-2 represents the angle of the previous step of the i-section arm.
  7. 根据权利要求6所述的臂架控制方法,其特征在于,如果i节臂被操作手锁定,wi为0。The boom control method according to claim 6, wherein if the i-section arm is locked by the operating hand, w i is zero.
  8. 根据权利要求5所述的臂架控制方法,其特征在于,在所述步骤2中:将空间轨迹规划分成臂架旋转和机械臂平面收展分别计算,并分别获得所述各节臂收展角度和臂架目标旋转角度。The boom control method according to claim 5, wherein in the step 2, the spatial trajectory planning is divided into a boom rotation and a mechanical arm plane expansion, respectively, and the respective section arms are respectively obtained. Angle and boom target rotation angle.
  9. 根据权利要求5所述的臂架控制方法,其特征在于,所述数学模型如下:The boom control method according to claim 5, wherein the mathematical model is as follows:
    Figure PCTCN2015070973-appb-100001
    Figure PCTCN2015070973-appb-100001
    Figure PCTCN2015070973-appb-100002
    Figure PCTCN2015070973-appb-100002
    Figure PCTCN2015070973-appb-100003
    Figure PCTCN2015070973-appb-100003
    其中,θmin≤θi≤θmax,θi为i节臂与i-1节臂的夹角,θmin表示i节臂最小收展角度,θmax表示i节臂最大收展角度,θ0为旋转角度,li为各节臂长度,xend,yend,zend为末端点坐标,N为臂架的节臂数量。Where θ min ≤ θ i ≤ θ max , θ i is the angle between the i-section arm and the i-1-section arm, θ min represents the minimum buck angle of the i-section arm, and θ max represents the maximum buck angle of the i-section arm, θ 0 is the rotation angle, l i is the length of each arm, x end , y end , z end is the end point coordinate, and N is the number of the arm of the boom.
  10. 一种混凝土泵车,包括臂架,其特征在于,采用如权利要求1至9所述任意一项所述的臂架控制方法。 A concrete pump truck comprising a boom, characterized in that the boom control method according to any one of claims 1 to 9 is employed.
PCT/CN2015/070973 2014-01-26 2015-01-19 Concrete pump truck and boom control method WO2015109975A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN201410036995.7 2014-01-26
CN201410036995.7A CN103806666B (en) 2014-01-26 2014-01-26 Concrete pump truck and cantilever crane control method

Publications (1)

Publication Number Publication Date
WO2015109975A1 true WO2015109975A1 (en) 2015-07-30

Family

ID=50704010

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2015/070973 WO2015109975A1 (en) 2014-01-26 2015-01-19 Concrete pump truck and boom control method

Country Status (2)

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

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP3705664A1 (en) 2019-03-07 2020-09-09 Liebherr-Mischtechnik GmbH Articulated arm control for a concrete pump
EP3705663A1 (en) 2019-03-07 2020-09-09 Liebherr-Mischtechnik GmbH Articulated arm control for a concrete pump
EP3705662A1 (en) 2019-03-07 2020-09-09 Liebherr-Mischtechnik GmbH Articulated arm control for a concrete pump
CN115781900A (en) * 2022-11-18 2023-03-14 中铁四局集团第二工程有限公司 Intelligent material distribution device, material distribution system and material distribution method for railway prefabricated box girder

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103806666B (en) * 2014-01-26 2015-02-18 三一汽车制造有限公司 Concrete pump truck and cantilever crane control method
CN106150101B (en) * 2016-08-19 2018-08-07 北汽福田汽车股份有限公司 Controller, control system, control method and the pump truck of arm support
CN109375585A (en) * 2018-09-28 2019-02-22 湖南希法工程机械有限公司 Arm support tail end position control method and system and engineering machinery comprising the system
CN114753640B (en) * 2022-04-01 2023-04-07 中联重科股份有限公司 Arm support tail end motion planning method and device, control system and engineering machinery

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000282687A (en) * 1999-03-31 2000-10-10 Ishikawajima Constr Mach Co Operation control device for concrete pump with boom
CN101487343A (en) * 2009-01-14 2009-07-22 三一重工股份有限公司 Control method, apparatus and system for concrete pump vehicle
CN101893900A (en) * 2010-06-29 2010-11-24 三一重工股份有限公司 Engineering plant and arm support control system thereof
JP2011074712A (en) * 2009-10-01 2011-04-14 Ihi Construction Machinery Ltd Remaining concrete treatment method and device, for concrete pump vehicle with boom
CN103233581A (en) * 2013-02-08 2013-08-07 上海格尼特控制技术有限公司 Concrete arm support pumper and control method thereof
CN103806666A (en) * 2014-01-26 2014-05-21 三一汽车制造有限公司 Concrete pump truck and cantilever crane control method

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN100591880C (en) * 2006-12-31 2010-02-24 三一重工股份有限公司 Intelligent cantilever crane control device
CN201406841Y (en) * 2009-03-31 2010-02-17 北京易斯路电子有限公司 Control system for concrete pump truck intelligent cantilever crane

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000282687A (en) * 1999-03-31 2000-10-10 Ishikawajima Constr Mach Co Operation control device for concrete pump with boom
CN101487343A (en) * 2009-01-14 2009-07-22 三一重工股份有限公司 Control method, apparatus and system for concrete pump vehicle
JP2011074712A (en) * 2009-10-01 2011-04-14 Ihi Construction Machinery Ltd Remaining concrete treatment method and device, for concrete pump vehicle with boom
CN101893900A (en) * 2010-06-29 2010-11-24 三一重工股份有限公司 Engineering plant and arm support control system thereof
CN103233581A (en) * 2013-02-08 2013-08-07 上海格尼特控制技术有限公司 Concrete arm support pumper and control method thereof
CN103806666A (en) * 2014-01-26 2014-05-21 三一汽车制造有限公司 Concrete pump truck and cantilever crane control method

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP3705664A1 (en) 2019-03-07 2020-09-09 Liebherr-Mischtechnik GmbH Articulated arm control for a concrete pump
EP3705663A1 (en) 2019-03-07 2020-09-09 Liebherr-Mischtechnik GmbH Articulated arm control for a concrete pump
EP3705662A1 (en) 2019-03-07 2020-09-09 Liebherr-Mischtechnik GmbH Articulated arm control for a concrete pump
DE102019105814A1 (en) * 2019-03-07 2020-09-10 Liebherr-Mischtechnik Gmbh Articulated arm control of a concrete pump
DE102019105871A1 (en) * 2019-03-07 2020-09-10 Liebherr-Mischtechnik Gmbh Articulated arm control of a concrete pump
DE102019105817A1 (en) * 2019-03-07 2020-09-10 Liebherr-Mischtechnik Gmbh Articulated arm control of a concrete pump
CN115781900A (en) * 2022-11-18 2023-03-14 中铁四局集团第二工程有限公司 Intelligent material distribution device, material distribution system and material distribution method for railway prefabricated box girder

Also Published As

Publication number Publication date
CN103806666B (en) 2015-02-18
CN103806666A (en) 2014-05-21

Similar Documents

Publication Publication Date Title
WO2015109975A1 (en) Concrete pump truck and boom control method
WO2015109976A1 (en) Concrete pump truck, and boom control method and control device
US11642785B2 (en) Collision-free motion planning for closed kinematics
US9777491B2 (en) Structural 3D printing machine
CN108089578B (en) Walking motion planning method for biped walking robot
CN110039542A (en) Visual servo tracking and controlling method and robot system with directional velocity control
KR20120073616A (en) Path planning apparatus of robot and method thereof
CN107966907B (en) Obstacle avoidance solution applied to redundant manipulator
CN115605328A (en) Collision avoidance motion planning method for industrial robot
CN112264989B (en) Double-mechanical-arm cooperative obstacle avoidance method based on neighborhood traversal
CN103149933A (en) Closed-loop control-based humanoid robot omnidirectional walking method
WO2011012033A1 (en) Method and system for controlling large-scale engineering manipulator
WO2018019111A1 (en) Robot and joint motion control method and device therefor
CN110455290B (en) Optimal trajectory planning method for intelligent hydraulic excavator
JPWO2002066210A1 (en) Robot controller
WO2013007039A1 (en) Mechanical arm control method and device and engineering machinery
WO2013004099A1 (en) Arm-support vibration suppression method and system, and arm-support type engineering machinery
CN103792956A (en) Method and device controlling spatial motion of intelligent arm
WO2015165346A1 (en) Engineering machine and arm support control system
JP2012128585A (en) Mobile device, robot, and control system for the same
WO2013044627A1 (en) Arm support action control system and concrete pump truck
Campa et al. Kinematic modeling and control of the hexapod parallel robot
Xue et al. Lywal: a leg-wheel transformable quadruped robot with picking up and transport functions
Lin et al. Innovative design and simulation of a transformable robot with flexibility and versatility, RHex-T3
CN115057355A (en) Active-disturbance-rejection control method and system for variable-rope-length double-pendulum bridge crane

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 15740775

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 15740775

Country of ref document: EP

Kind code of ref document: A1