CN103309352B - 一种臂架智能控制装置、系统、方法和工程机械 - Google Patents

一种臂架智能控制装置、系统、方法和工程机械 Download PDF

Info

Publication number
CN103309352B
CN103309352B CN201310277361.6A CN201310277361A CN103309352B CN 103309352 B CN103309352 B CN 103309352B CN 201310277361 A CN201310277361 A CN 201310277361A CN 103309352 B CN103309352 B CN 103309352B
Authority
CN
China
Prior art keywords
arm
arm joint
angle
joint
coordinates
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
CN201310277361.6A
Other languages
English (en)
Other versions
CN103309352A (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.)
Zoomlion Heavy Industry Science and Technology Co Ltd
Original Assignee
Zoomlion Heavy Industry Science and Technology 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 Zoomlion Heavy Industry Science and Technology Co Ltd filed Critical Zoomlion Heavy Industry Science and Technology Co Ltd
Priority to CN201310277361.6A priority Critical patent/CN103309352B/zh
Publication of CN103309352A publication Critical patent/CN103309352A/zh
Application granted granted Critical
Publication of CN103309352B publication Critical patent/CN103309352B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Abstract

本发明公开了一种臂架智能控制装置、系统、方法和工程机械。所述臂架包括相互连接的多节臂节,所述装置包括:接收器,用于接收每节臂节的当前倾角、臂架末端的当前坐标和目标坐标;控制器,与接收器连接,用于根据臂架末端的当前坐标和目标坐标,确定预期的臂架末端的坐标变化量;根据预期的坐标变化量、每节臂节的当前倾角、预设的倾角改变次序、以及各倾角每次改变的最大允许值,计算需要被调整的臂节的倾角变化量;以及根据所述倾角变化量调整相应臂节。通过上述技术方案,在设定臂架末端的目标坐标之后,臂架可以自动展开到与该目标坐标对应的姿态,无需人工干预,减少机手的工作量,降低对机手操作水平和经验的要求,提高了工作效率。

Description

一种臂架智能控制装置、系统、方法和工程机械
技术领域
本发明涉及工程机械领域,具体地,涉及一种臂架智能控制装置、系统、方法和工程机械。
背景技术
混凝土泵车成为现代建筑施工广泛应用的工程机械,由于其应用特点和复杂性,需要由专业的机手来对其进行操控。目前机手通过遥控器对臂架运动进行操控,遥控器上设置不同的按键分别对不同的臂节进行控制,机手通过按键对臂架进行操作。当需要对臂架末端进行快速定位时,机手的经验和熟练程度就显得非常重要。当某一臂节在向某一方向运动时,需要机手一直按着相应的操控按键,这样虽然能够使得机手保持高度注意力,保证臂架安全运动,但是,确增加了机手的工作量。而且,在泵车施工中,有很多臂架姿态是经常用到的,因此,机手很多时候都在做一些重复性的工作,工作效率较低。
发明内容
本发明的目的是提供一种臂架智能控制装置、系统、方法和工程机械,以实现臂架展开的自动化控制,减少机手的工作量,提高工作效率。
为了实现上述目的,本发明提供一种臂架智能控制装置,该臂架包括相互连接的多节臂节,所述装置包括:接收器,用于接收每节臂节的当前倾角、臂架末端的当前坐标和目标坐标;控制器,与所述接收器连接,用于根据所述臂架末端的当前坐标和目标坐标,确定预期的所述臂架末端的坐标变化量;根据所述预期的坐标变化量、所述每节臂节的当前倾角、预设的倾角改变次序、以及各倾角每次改变的最大允许值,计算需要被调整的臂节的倾角变化量;以及根据所述倾角变化量调整相应臂节。
本发明还提供一种臂架智能控制系统,该系统包括:输入装置,用于输入臂架末端的目标坐标;检测装置,用于检测每节臂节的当前倾角和臂架末端的当前坐标;以及上述控制装置,与所述输入装置和所述检测装置连接。
本发明还提供一种包括上述系统的工程机械。
本发明还提供一种臂架智能控制方法,该臂架包括相互连接的多节臂节,所述方法包括:接收每节臂节的当前倾角、臂架末端的当前坐标和目标坐标;根据所述臂架末端的当前坐标和目标坐标,确定预期的所述臂架末端的坐标变化量;根据所述预期的坐标变化量、所述每节臂节的当前倾角、预设的倾角改变次序、以及各倾角每次改变的最大允许值,计算需要被调整的臂节的倾角变化量;以及根据所述倾角变化量调整相应臂节。
通过上述技术方案,机手在设定好臂架末端的目标坐标之后,臂架就可以自动展开到与臂架末端的目标坐标对应的姿态,无需人工干预,大大减少了机手的工作量,降低了对机手的操作水平和经验的要求,提高了工作效率。
本发明的其他特征和优点将在随后的具体实施方式部分予以详细说明。
附图说明
附图是用来提供对本发明的进一步理解,并且构成说明书的一部分,与下面的具体实施方式一起用于解释本发明,但并不构成对本发明的限制。在附图中:
图1是某一姿态下臂架结构示意图;
图2是臂架智能控制装置的结构图;
图3是臂架典型姿态展开方法的流程图;
图4是臂架任意姿态展开方法的流程图;
图5是用于计算臂节调整角度的优化算法的流程图;
图6是臂架收回方法的流程图;以及
图7是臂架智能控制系统的结构图。
具体实施方式
以下结合附图对本发明的具体实施方式进行详细说明。应当理解的是,此处所描述的具体实施方式仅用于说明和解释本发明,并不用于限制本发明。
图1示出了某一典型姿态下的臂架图示,其中,典型姿态通常可以指臂架在工作过程中经常用到的姿态。如图1所示,所述臂架可以包括相互连接的多节臂节,例如,一臂OA、二臂AB、三臂BC、四臂CD以及五臂DE。其中,α1为一臂与转台平面夹角(即与水平面夹角),α2、α3、α4、α5分别为二臂与一臂之间的夹角、三臂与二臂之间的夹角、四臂与三臂之间的夹角、五臂与四臂之间的夹角。α2H、α3H、α4H、α5H分别为二臂与水平面之间的夹角、三臂与水平面之间的夹角、四臂与水平面之间的夹角、五臂与水平面之间的夹角。各臂节与水平面的夹角也可被称之为倾角。α2H、α3H、α4H、α5H的符号的判断准则为从水平面开始,逆时针指向各节臂为正,当方向相反时,相应的取负值,如图1中的α4H和α5H即为负值。
结合图1,可以得出α2H、α3H、α4H、α5H的计算公式,如下:
α2H=α1-(π-α2)=α12-π(1)
α3H=α2H-(π-α3)=α123-2π(2)
α4H=α3H-(π-α4)=α1234-3π(3)
α5H=α4H-(π-α5)=α12345-4π(4)
臂架末端E点坐标(xE,yE)可以由下式计算得出:
xE=LOAcosα1+LABcosα2H+LBCcosα3H+LCDcosα4H+LDEcosα5H(5)
yE=LOAsinα1+LABsinα2H+LBCsinα3H+LCDsinα4H+LDEsinα5H(6)
其中,LOA为一臂臂长,LAB为二臂臂长,LBC为三臂臂长,LCD为四臂臂长,LDE为五臂臂长。
从以上公式可以看出,当臂架姿态一定时,即α1、α2、α3、α4、α5是确定值,就可以根据α1、α2、α3、α4、α5计算出各臂节的倾角和臂架末端的坐标。
因此,在本发明的一个实施方式中,可以将臂架经常用到的一些典型姿态存储下来(例如,存储在数据库中),包括存储在典型姿态下的各臂节的倾角(或夹角)和臂架末端坐标,由此,当需要将臂架展开到某一典型姿态下时,只需要调用所存储的与该典型姿态对应的各臂节的倾角(或夹角),然后将各臂节展开到对应的倾角(或夹角)即可。
为此,本发明提供了一种臂架智能控制装置。如图2所示,该装置10可以包括:接收器101,用于接收指示臂架的典型姿态的信号;控制器102,与所述接收器101连接,用于根据所述典型姿态,确定与所述典型姿态对应的每节臂节的倾角,并控制每节臂节展开到对应的倾角。
为了保证各节臂在展开过程中不发生干涉,避免臂节末端与泵车上装或其他臂节接触,从而防止臂架、油缸或泵车上装损坏,所述接收器101还可以接收指示相邻臂节之间不发生干涉的临界夹角的信号;以及控制器102还用于在控制每节臂节展开到对应的倾角之前,调整臂节使得相邻臂节之间的夹角大于或等于所述临界夹角。也就是说,如果各臂节之间的夹角小于对应的临界夹角,控制器102先将各臂节调整到对应的临界夹角,然后再根据典型姿态下的倾角(或夹角)展开各臂节。
其中,所述临界夹角是使得所述相邻臂节之间满足以下条件的夹角:前一臂节的末端距离水平面的高度大于后一臂节的臂节长度。
结合图1,上述条件可以被表示为:
LOAsinα1>LAB(7)
LOAsinα1+LABsinα2H>LBC(8)
LOAsinα1+LABsinα2H+LBCsinα3H>LCD(9)
LOAsinα1+LABsinα2H+LBCsinα3H+LCDsinα4H>LDE(10)
由此可得出:
α 1 > arcsin L AB L OA - - - ( 11 )
α 2 H > arcsin L BC - L OA sin α 1 L AB - - - ( 12 )
α 3 H > arcsin L CD - L OA sin α 1 - L AB sin α 2 H L BC - - - ( 13 )
α 4 H > arcsin L DE - L OA sin α 1 - L AB sin α 2 H - L BC sin α 3 H L CD - - - ( 14 )
首先由式(11)确定α1的临界值α10,然后由式(12)、(13)、(14)依次确定α2H、α3H、α4H的临界值α2H0、α3H0、α4H0。再结合式(1)、(2)、(3)分别确定二臂与一臂、三臂与二臂、四臂与三臂的临界夹角α20、α30、α40,如下:
α20=π-α102H0(15)
α30=2π-α10203H0(16)
α40=3π-α1020304H0(17)
由此就可以确定出临界夹角α10、α20、α30、α40
另外,所述控制器102还可以根据实际需要控制所有臂节同时展开、或按照预设的展开顺序依次展开,并且还可以控制所有臂节以相同或不同的速度展开。
上面的实施方式描述了在已存储了典型姿态的情况下,通过选择某一典型姿态,可将臂架自动展开到所需的姿态。下面参照图2和图3描述在尚未存储典型姿态的情况下,如何进行臂架自动展开的方法。
首先,可以设置各臂节之间不发生干涉的临界夹角、各臂节之间的最终夹角(或者倾角)、各臂节是同时展开还是按顺序展开、以及各臂节的展开速度(可以通过选择不同档位来设定不同展开速度)等信息。之后,接收器101可以接收上述信息,并将所述信息传送到控制器102。然后,控制器102先判断各臂节之间是否满足临界夹角条件,如果不满足,先将各臂节调整到临界夹角,然后再进行展开,否则,直接进行展开。控制器102按照臂节展开顺序、展开速度、和最终夹角将臂节展开到某一姿态。在完成展开后,控制器102可以将该姿态、和在该姿态下的各臂节的临界夹角、最终夹角(或者倾角)、展开顺序和展开速度等信息存储在数据库中,以便于之后进行选取和调用。在按照此方法存储了多个典型姿态后,可以按照上文所述根据典型姿态进行臂架展开的方法,实现臂架的自动展开。
此外,为了保证在臂架自动展开过程中的安全性,可在各臂节上安装障碍物检测装置。由此,所述接收器101还可以接收指示臂节周围存在障碍物的信号;以及所述控制器102还可以在接收到所述指示臂节周围存在障碍物的信号的情况下,输出报警信号,以警示机手。此外,还可以在各臂节上安装距离检测装置,来检测臂节距离障碍物的距离。由此,所述接收器101还可以接收指示臂节与障碍物之间的距离的信号;以及所述控制器102还可以在所述距离小于或等于一预设值的情况下,不仅发出报警信号,而且还停止臂节展开,由此确保臂架自动展开时的安全性。
由此,通过本发明提供的臂架智能控制装置,机手可以只通过选择臂架的某一典型姿态,臂架就可以自动展开到该姿态,无需人工干预,大大减少了机手的工作量,降低了对机手的操作水平和经验的要求,提高了工作效率。
本发明还基于上面描述的典型姿态,提出了一种实现臂架任意姿态展开的方法,下面将参考图2和图4详细描述该方法。
首先,机手可以根据想要到达的目标臂架末端坐标来选择一种典型姿态。然后,控制器102可根据该典型姿态,确定所述典型姿态下臂架末端的坐标,例如,E点坐标,记为(xE,yE)。
接收器101可以接收指示臂架末端的目标位置坐标的信号,例如记为(xE',yE')。然后,控制器102可根据该目标位置坐标(xE',yE')和之前确定出的典型姿态下臂架末端的坐标(xE,yE),计算出预期的臂架末端的坐标变化量,记为(ΔxE,ΔyE)。
根据上面等式(5)和(6)示出的末端坐标(xE,yE)与各臂节倾角α1、α2H、α3H、α4H、α5H之间的关系,可以得出目标坐标(xE',yE')与各臂节的目标倾角α1'、α2H'、α3H'、α4H'、α5H'之间的关系,如下面等式(15)和(16)所示:
xE'=LOAcosα1'+LABcosα2H'+LBCcosα3H'+LCDcosα4H'+LDEcosα5H'(15)
yE'=LOAsinα1'+LABsinα2H'+LBCsinα3H'+LCDsinα4H'+LDEsinα5H'(16)
将等式(15)与等式(5)相减,等式(16)与等式(6)相减,即可得到预期的坐标变化量(ΔxE,ΔyE)与各臂节的目标倾角α1'、α2H'、α3H'、α4H'、α5H'、以及典型姿态下的各臂节的倾角α1、α2H、α3H、α4H、α5H之间的关系。基于该关系、以及臂节调整顺序(各倾角改变次序)和各臂节的倾角每次改变的最大允许值,控制器102就可以计算出需要被调整的臂节的倾角变化量。
下面参照图5描述计算需要被调整的臂节的倾角变化量时可采取的优化算法。如图5所示,控制器102可以根据选择的典型姿态得到各臂节的倾角α1、α2H、α3H、α4H、α5H
假设各倾角每次改变的最大允许值分别为:Δα1max、Δα2max、Δα3max、Δα4max、Δα5max,每个最大允许值对应一个坐标变化量ΔxE1、ΔxE2、ΔxE3、ΔxE4、ΔxE5和ΔyE1、ΔyE2、ΔyE3、ΔyE4、ΔyE5。当在某一姿态下,若将一臂调整Δα1max,则末端坐标的ΔxE=ΔxE1,ΔyE=ΔyE1;若将一臂调整Δα1max,再将二臂调整Δα2max,则末端坐标的ΔxE=ΔxE1+ΔxE2,ΔyE=ΔyE1+ΔyE2。以此类推,当将所有臂节均调整其最大允许调整值时,末端坐标的ΔxE=ΔxE1+ΔxE2+ΔxE3+ΔxE4+ΔxE5,以及ΔyE=ΔyE1+ΔyE2+ΔyE3+ΔyE4+ΔyE5
控制器102可根据ΔxE和ΔyE判断是否需要对所有角度进行调整。即,判断ΔxE是否大于或等于ΔxE1+ΔxE2+ΔxE3+ΔxE4+ΔxE5,以及ΔyE是否大于或等于ΔyE1+ΔyE2+ΔyE3+ΔyE4+ΔyE5。若不是,则表明不需要对所有角度进行整体调整(也可称为全调整),此时可根据角度改变次序来确定需要被调整的臂节的倾角变化量。
例如,默认臂节调节次序为从最后一个臂节开始,依次向前进行调整。以图1中所示的臂架为例,在调整时,先调整五臂DE,在将五臂DE调整了Δα5max之后依然无法满足预期的(ΔxE,ΔyE)时,再调整四臂CD,以此类推。
如果将五臂DE调整Δα5max后的臂架末端的坐标变化量超过了预期的坐标变化量,则说明不需要再调整前面四节臂节,只需要调整该五臂DE即可,且该角度变化量不超过Δα5max。此时,可将前面根据等式(5)、(6)、(15)和(16)得出的预期的坐标变化量(ΔxE,ΔyE)与各臂节的目标倾角α1'、α2H'、α3H'、α4H'、α5H'、以及典型姿态下的各臂节的倾角α1、α2H、α3H、α4H、α5H之间的关系简化为如下:
ΔxE=LDE(cosα5H'-cosα5H)(17)
ΔyE=LDE(sinα5H'-sinα5H)(18)
由于α5H、ΔxE、ΔyE均已知,因此,可以通过上式(17)和(18)计算出五臂的目标倾角α5H',用该α5H'减去α5H即可得出五臂倾角的变化量。可替换地,也可对等式(17)和(18)进行变形,使之成为预期的坐标变化量、典型姿态下的五臂的倾角、以及五臂的倾角变化量之间的映射关系,在这种情况下,可以通过α5H、ΔxE、ΔyE直接计算出五臂倾角的变化量。
如果将五臂DE调整Δα5max后的臂架末端的坐标变化量还不满足预期的坐标变化量,则表明不仅需要将该五臂DE调整Δα5max,且还需要调整四臂。如果将四臂CD调整Δα4max后的臂架末端的坐标变化量超过了预期的坐标变化量,则说明不需要再调整前面三节臂节,只需要调整五臂DE和四臂CD即可。此时,α5H'=Δα5max5H,α5H、α4H、ΔxE、ΔyE均已知,因此,可求出四臂CD的目标倾角α4H',用该α4H'减去α4H即可得出四臂倾角的变化量。
计算三臂、二臂、一臂的倾角变化量的方法和上面所描述的方法原理一致,此处就不再赘述。
由此,可以求出在不需要进行全调整的情况下,需要被调整的臂节的倾角变化量。控制器102可以根据所计算出的倾角变化量,调整相应的臂节。
若根据ΔxE和ΔyE判断需要对所有角度进行调整,此时,控制器102将全调整次数记为n=1。控制器102以将五节臂调整其对应的最大允许调整值后为基准,继续按照如上方法判断是否还需要进行全调整,一旦需要就累积全调整次数n,直到不需要进行全调整为止。
控制器102将最终累积得到的n与允许的调整次数N进行比较,若n>N,则表明之前所选择的臂架的典型姿态不合理,应该重新进行选择,此时,控制器102可以输出指示重新进行典型姿态选择的信号。若n≤N,则表明进行全调整的次数在可接受的范围之内,然后,可以计算出需要被调整的臂节的倾角变化量。以五臂为例,其最终倾角变化量=n×Δα5max+Δα5final,其中,Δα5final为五臂从n次全调整之后的倾角位置到目标倾角位置的倾角变化量,该倾角变化量的计算方法和上文所述的在不需要进行全调整时计算需要被调整的臂节的倾角变化量的方法类似,此处就不再赘述。在计算出需要被调整的臂节的倾角变化量之后,控制器102可以根据所述需要被调整的臂节的倾角变化量来调整相应臂节。
由此,通过本发明提供的上述方法,可以在典型姿态的基础上,实现任意姿态的自动展开。实际操作中,也可以根据需要,在典型姿态的自动展开的基础上,通过遥控器进行姿态调整,即,手动进行调整,以此控制臂架展开到任意姿态。
可替换地,控制器102可以通过各臂节的当前倾角、臂架末端的当前坐标、目标坐标、以及预设的臂节调整顺序和各臂节的倾角每次改变的最大允许值,来计算出需要被调整的臂节的倾角变化量,以此将臂架直接从当前姿态展开到任意姿态,而无需在典型姿态的基础上进行展开。
例如,可以通过在各臂节上安装检测装置来检测各臂节的当前倾角和臂架末端的当前坐标。通过输入装置输入臂架末端的目标坐标。接收器101可以接收上述参数,并将其发送至控制器102。控制器102使用检测装置检测的实时参数来替代典型姿态库中存储的各参数,并基于与上面描述的用于计算在典型姿态的基础上需要被调整的臂节倾角变化量类似的方法,计算出需要被调整的臂节的倾角变化量。例如,当按照臂节调整顺序和各臂节的倾角每次改变的最大允许值,确定出仅需调整五臂即可到达目标位置时,控制器102可以利用式(17)和(18)来计算出五臂的目标倾角α5H',用该α5H'减去α5H即可得出五臂倾角的变化量。需要注意的是,与上述在典型姿态的基础上进行任意姿态的展开的方法不同的是,此方法没有最大允许的全调整次数的限制,也就是说,在当前姿态下,控制器102可根据计算出的倾角变化量来对臂节进行调整,直到臂架末端满足目标坐标为止。
在完成作业之后,需将臂架进行收回。由此,接收器101还可以接收指示收回臂节的信号;以及所述控制器102还可以在接收到所述指示收回臂节的信号的情况下,按照以下进行臂节收回(如图6所示):同时收回除第一臂节之外的其他臂节,例如,二臂至五臂;将臂架回转至初始位置;以及收回所述第一臂节。
此外,控制器102也可以在收回臂架之前,先判断当前相邻臂节之间的夹角(例如,可根据典型姿态确定)是否小于临界夹角,在所述当前相邻臂节之间的夹角小于所述临界夹角的情况下,所述控制器102调整臂节使得相邻臂节之间的夹角大于或等于所述临界夹角,并之后按照上面进行臂节收回,以防止各臂节之间发生干涉;以及在所述当前相邻臂节之间的夹角大于或等于所述临界夹角的情况下,直接进行臂架收回。此外,控制器102也可根据实际需要控制所有臂节以相同或不同的速度收回。
图7示出了根据本发明的实施方式臂架智能控制系统的结构图。如图7所示,该系统可以包括:输入装置20,用于选择臂架的典型姿态;以及上述臂架智能控制装置10,与所述输入装置20连接。需要注意的是,输入装置20不仅可以用于选择臂架的典型姿态,机手还可以利用该输入装置20输入其他信息,例如,各臂节的目标倾角或夹角、臂架末端的目标坐标、各臂节运动速度、各臂节调整次序等等。
此外,虽然没有被示出,但所述系统还可以包括:摄像装置,安装在最后一节臂节,用于采集臂架末端的运动状态信息、以及施工现场的工况信息;以及显示装置,用于显示所述摄像装置采集的所述运动状态信息和所述工况信息。由此,机手可以实时了解臂架末端及软管运动状态,在泵送时,还可以实时监测施工现场情况、布料、料况等,方便机手实时了解施工情况。显示装置还可以对监控视频进行设置,例如:缩放、重放、节选等。
本发明还将上述系统应用于工程机械。
本发明还提供一种臂架智能控制方法,其中所述臂架包括相互连接的多节臂节,所述方法包括:接收指示臂架的典型姿态的信号;根据所述典型姿态,确定与所述典型姿态对应的每节臂节的倾角;以及控制每节臂节展开到对应的倾角。
所述方法还可以包括:接收指示相邻臂节之间不发生干涉的临界夹角的信号;以及在控制所述每节臂节展开到对应的倾角之前,调整臂节使得相邻臂节之间的夹角大于或等于所述临界夹角,其中,所述相邻臂节之间的所述临界夹角使得所述相邻臂节之间满足以下条件:前一臂节的末端距离水平面的高度大于后一臂节的臂节长度。
所有臂节可以同时展开、或按照预设的展开顺序依次展开,以及所有臂节可以以相同或不同的速度展开。
所述方法还可以包括:接收指示臂节周围存在障碍物的信号;以及在接收到所述指示臂节周围存在障碍物的信号的情况下,进行报警。此外,所述方法还可以包括:接收指示臂节与障碍物之间的距离的信号;以及在所述距离小于或等于一预设值的情况下,停止臂节展开。
所述方法还可以包括:接收指示臂架末端的目标位置坐标的信号;根据所述典型姿态,确定所述典型姿态下臂架末端的坐标,并根据该坐标和所述目标位置坐标,确定预期的所述臂架末端的坐标变化量;根据所述预期的坐标变化量、所述典型姿态下的所述每节臂节的所述倾角、预设的倾角改变次序、以及各倾角每次改变的最大允许值,计算需要被调整的臂节的倾角变化量,并根据所述倾角变化量调整相应臂节。
其中,根据所述倾角变化量调整相应臂节可以包括:
根据所述预期的坐标变化量、所述典型姿态下的所述每节臂节的所述倾角、预设的倾角改变次序、以及各倾角每次改变的最大允许值,判断是否需要对所有臂节的倾角进行整体调整以及进行整体调整的次数;以及以下至少一者:在不需要对所有臂节的倾角进行整体调整或进行整体调整的次数小于未超过允许的整体调整次数的情况下,根据所述倾角变化量调整相应臂节;以及在所述整体调整的次数超过所述允许的整体调整次数的情况下,输出指示重新选择臂架的典型姿态的信号。
所述方法还可以包括:接收指示收回臂节以及相邻臂节之间不发生干涉的临界夹角的信号;以及在接收到所述指示收回臂节的信号的情况下:根据所述典型姿态确定相邻臂节之间的当前夹角;判断所述当前夹角是否小于所述临界夹角;在所述当前夹角小于所述临界夹角的情况下,调整臂节使得相邻臂节之间的夹角大于或等于所述临界夹角,并之后进行臂节收回;以及在所述当前夹角大于或等于所述临界夹角的情况下,直接进行臂架收回;其中,按照以下进行臂架收回:同时收回除第一臂节之外的其他臂节;将臂架回转至初始位置;以及收回所述第一臂节。
由此,通过本发明提供的臂架智能控制装置、系统、方法和工程机械,机手可以只通过选择臂架的某一典型姿态,臂架就可以自动展开到该姿态,无需人工干预,大大减少了机手的工作量,降低了对机手的操作水平和经验的要求,提高了工作效率。
以上结合附图详细描述了本发明的优选实施方式,但是,本发明并不限于上述实施方式中的具体细节,在本发明的技术构思范围内,可以对本发明的技术方案进行多种简单变型,这些简单变型均属于本发明的保护范围。
另外需要说明的是,在上述具体实施方式中所描述的各个具体技术特征,在不矛盾的情况下,可以通过任何合适的方式进行组合。为了避免不必要的重复,本发明对各种可能的组合方式不再另行说明。
此外,本发明的各种不同的实施方式之间也可以进行任意组合,只要其不违背本发明的思想,其同样应当视为本发明所公开的内容。

Claims (12)

1.一种臂架智能控制装置,该臂架包括相互连接的多节臂节,其特征在于,所述装置包括:
接收器,用于接收每节臂节的当前倾角、臂架末端的当前坐标和目标坐标;
控制器,与所述接收器连接,用于根据所述臂架末端的当前坐标和目标坐标,确定预期的所述臂架末端的坐标变化量;根据所述预期的坐标变化量、所述每节臂节的当前倾角、预设的倾角改变次序、以及各倾角每次改变的最大允许值,计算需要被调整的臂节的倾角变化量;以及根据所述倾角变化量调整相应臂节。
2.根据权利要求1所述的装置,其特征在于,
所述接收器还用于接收指示相邻臂节之间不发生干涉的临界夹角的信号;以及
所述控制器还用于在根据所述倾角变化量调整相应臂节之前,根据所述每节臂节的当前倾角计算相邻臂节之间的当前夹角,并在所述当前夹角小于所述临界夹角的情况下,调整臂节使得相邻臂节之间的夹角大于或等于所述临界夹角。
3.根据权利要求2所述的装置,其特征在于,所述相邻臂节之间的所述临界夹角使得所述相邻臂节之间满足以下条件:前一臂节的末端距离水平面的高度大于后一臂节的臂节长度。
4.根据权利要求1所述的装置,其特征在于,
所述接收器还用于接收指示收回臂节以及相邻臂节之间不发生干涉的临界夹角的信号;以及
所述控制器还用于在接收到所述指示收回臂节的信号的情况下:
根据所述每节臂节的当前倾角确定相邻臂节之间的当前夹角;
判断所述当前夹角是否小于所述临界夹角;
在所述当前夹角小于所述临界夹角的情况下,调整臂节使得相邻臂节之间的夹角大于或等于所述临界夹角,并之后进行臂节收回。
5.根据权利要求4所述的装置,其特征在于,按照以下方式进行臂架收回:
同时收回除第一臂节之外的其他臂节;
将臂架回转至初始位置;以及
收回所述第一臂节。
6.一种臂架智能控制系统,其特征在于,该系统包括:
输入装置,用于输入臂架末端的目标坐标;
检测装置,用于检测每节臂节的当前倾角和臂架末端的当前坐标;以及
根据权利要求1-5中任意一项权利要求所述的装置,与所述输入装置和所述检测装置连接。
7.一种包括权利要求6所述的系统的工程机械。
8.一种臂架智能控制方法,该臂架包括相互连接的多节臂节,其特征在于,所述方法包括:
接收每节臂节的当前倾角、臂架末端的当前坐标和目标坐标;
根据所述臂架末端的当前坐标和目标坐标,确定预期的所述臂架末端的坐标变化量;
根据所述预期的坐标变化量、所述每节臂节的当前倾角、预设的倾角改变次序、以及各倾角每次改变的最大允许值,计算需要被调整的臂节的倾角变化量;以及
根据所述倾角变化量调整相应臂节。
9.根据权利要求8所述的方法,其特征在于,该方法还包括:
接收指示相邻臂节之间不发生干涉的临界夹角的信号;以及
在根据所述倾角变化量调整相应臂节之前,根据所述每节臂节的当前倾角计算相邻臂节之间的当前夹角,并在所述当前夹角小于所述临界夹角的情况下,调整臂节使得相邻臂节之间的夹角大于或等于所述临界夹角。
10.根据权利要求9所述的方法,其特征在于,所述相邻臂节之间的所述临界夹角使得所述相邻臂节之间满足以下条件:前一臂节的末端距离水平面的高度大于后一臂节的臂节长度。
11.根据权利要求8所述的方法,其特征在于,该方法还包括:
接收指示收回臂节以及相邻臂节之间不发生干涉的临界夹角的信号;
在接收到所述指示收回臂节的信号的情况下:
根据所述每节臂节的当前倾角确定相邻臂节之间的当前夹角;
判断所述当前夹角是否小于所述临界夹角;
在所述当前夹角小于所述临界夹角的情况下,调整臂节使得相邻臂节之间的夹角大于或等于所述临界夹角,并之后进行臂节收回。
12.根据权利要求11所述的方法,其特征在于,按照以下方式进行臂架收回:
同时收回除第一臂节之外的其他臂节;
将臂架回转至初始位置;以及
收回所述第一臂节。
CN201310277361.6A 2013-07-03 2013-07-03 一种臂架智能控制装置、系统、方法和工程机械 Active CN103309352B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310277361.6A CN103309352B (zh) 2013-07-03 2013-07-03 一种臂架智能控制装置、系统、方法和工程机械

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310277361.6A CN103309352B (zh) 2013-07-03 2013-07-03 一种臂架智能控制装置、系统、方法和工程机械

Publications (2)

Publication Number Publication Date
CN103309352A CN103309352A (zh) 2013-09-18
CN103309352B true CN103309352B (zh) 2016-03-23

Family

ID=49134675

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310277361.6A Active CN103309352B (zh) 2013-07-03 2013-07-03 一种臂架智能控制装置、系统、方法和工程机械

Country Status (1)

Country Link
CN (1) CN103309352B (zh)

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103629176B (zh) * 2013-11-11 2015-11-11 湖南中联重科智能技术有限公司 运动部件协同动作控制方法、装置及系统
CN103572967B (zh) * 2013-11-12 2015-09-02 湖南中联重科智能技术有限公司 一种臂架控制设备、系统、方法和工程机械
CN103590606B (zh) * 2013-11-13 2015-10-28 三一汽车制造有限公司 一种臂架控制方法和装置及混凝土泵车及布料机
CN103792956B (zh) * 2014-01-26 2015-03-18 三一汽车制造有限公司 智能臂空间运动控制方法及装置
CN103853172B (zh) * 2014-01-26 2015-03-18 三一汽车制造有限公司 智能臂空间运动规划方法及装置
CN104018676B (zh) * 2014-03-04 2017-08-29 三一汽车制造有限公司 一种工程机械和臂架控制系统及方法
CN104950909A (zh) * 2014-03-26 2015-09-30 中集车辆(集团)有限公司 多节机械臂的控制系统及方法
CN104127977B (zh) * 2014-07-24 2017-04-05 长沙中联消防机械有限公司 消防车定点展开控制方法、设备、系统以及消防车
CN113445752B (zh) * 2021-05-25 2022-03-25 中联重科股份有限公司 臂架末端运动的控制方法、装置、系统、介质及工程机械
CN114404857B (zh) * 2021-12-30 2022-11-25 湖南中联重科应急装备有限公司 用于臂架的控制装置、臂架和消防车
CN114753640B (zh) * 2022-04-01 2023-04-07 中联重科股份有限公司 臂架末端运动规划方法、装置、控制系统及工程机械
CN116587291A (zh) * 2023-07-18 2023-08-15 三一海洋重工有限公司 一种运动控制方法、装置、设备以及工程机械

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2344923C1 (ru) * 2006-12-31 2009-01-27 Сани Хэви Индастри Ко., Лтд. Интеллектуальное устройство управления стрелой
CN102661049A (zh) * 2012-06-01 2012-09-12 中联重科股份有限公司 臂架防干涉装置和方法及包含该装置的臂架、泵车
EP2555067A1 (en) * 2010-03-30 2013-02-06 Hunan Sany Intelligent Control Equipment Co., Ltd Engineering machine and stability control system and control method thereof
CN103075011A (zh) * 2012-12-31 2013-05-01 中联重科股份有限公司 臂架轨迹优化方法、系统及包含该系统的工程机械
CN103147768A (zh) * 2013-03-15 2013-06-12 中联重科股份有限公司 一种臂架设备连杆机构控制装置、系统、方法和工程机械

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2344923C1 (ru) * 2006-12-31 2009-01-27 Сани Хэви Индастри Ко., Лтд. Интеллектуальное устройство управления стрелой
EP2555067A1 (en) * 2010-03-30 2013-02-06 Hunan Sany Intelligent Control Equipment Co., Ltd Engineering machine and stability control system and control method thereof
CN102661049A (zh) * 2012-06-01 2012-09-12 中联重科股份有限公司 臂架防干涉装置和方法及包含该装置的臂架、泵车
CN103075011A (zh) * 2012-12-31 2013-05-01 中联重科股份有限公司 臂架轨迹优化方法、系统及包含该系统的工程机械
CN103147768A (zh) * 2013-03-15 2013-06-12 中联重科股份有限公司 一种臂架设备连杆机构控制装置、系统、方法和工程机械

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
"混凝土泵车智能臂架控制系统研究";张之善;《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》;20130215;第4.1-5.2节 *

Also Published As

Publication number Publication date
CN103309352A (zh) 2013-09-18

Similar Documents

Publication Publication Date Title
CN103309352B (zh) 一种臂架智能控制装置、系统、方法和工程机械
CN103321428B (zh) 一种臂架智能控制装置、系统、方法和工程机械
CN103321427B (zh) 臂架展开、收回装置及方法、智能控制系统和工程机械
KR102290860B1 (ko) 복수의 표적을 선정하고 사격을 수행하는 원격 화기 제어 장치 및 방법
US8554462B2 (en) Unmanned aerial vehicle and method for controlling the unmanned aerial vehicle
CN107029428B (zh) 一种射击游戏的操控系统、方法及终端
CN102841566B (zh) 混凝土泵车监控方法、混凝土泵车监控系统及混凝土泵车
US9924098B2 (en) Electronic user interface and method for controlling precision guided firing of a rifle
CN105518702A (zh) 一种对目标物体的检测方法、检测装置以及机器人
JP2018053539A5 (zh)
CN104038692B (zh) 一种摄像机后焦调整方法和摄像机后焦调整装置
CN105245851B (zh) 一种视频监控系统及方法
JP2013059020A5 (zh)
CN103088779B (zh) 用于吹雪车吹嘴的控制方法、控制器、控制系统及吹雪车
CN104334805A (zh) 用于自动抖落杂质的铲斗运动控制装置及其方法
CN103663188A (zh) 动臂塔式起重机及其运行的控制方法、装置和系统
CN103556832B (zh) 一种臂架状态控制设备、方法、系统及工程机械
JP6798926B2 (ja) 車載カメラのキャリブレーション装置
CN105245853A (zh) 一种视频监控方法
WO2020056646A1 (zh) 无人机及其控制方法、控制装置和计算机可读存储介质
US9657654B2 (en) Engine speed controller of work machine
CN105865266B (zh) 头戴式水炮瞄准控制装置
WO2019183804A1 (zh) 一种机器人规避控制方法及相关装置
KR100907423B1 (ko) 좌표맵을 이용한 카메라 제어시스템, 좌표맵을 이용한 감시시스템 및 그 제어방법
US10662618B2 (en) Construction machine

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