CN102589493B - 臂架系统、工程机械和臂架系统末端位置参数获取方法 - Google Patents

臂架系统、工程机械和臂架系统末端位置参数获取方法 Download PDF

Info

Publication number
CN102589493B
CN102589493B CN201210027237.XA CN201210027237A CN102589493B CN 102589493 B CN102589493 B CN 102589493B CN 201210027237 A CN201210027237 A CN 201210027237A CN 102589493 B CN102589493 B CN 102589493B
Authority
CN
China
Prior art keywords
joint
boom system
joint arm
bracing wire
linear transducer
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
CN201210027237.XA
Other languages
English (en)
Other versions
CN102589493A (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 Heavy Industry Co Ltd
Original Assignee
Sany Heavy Industry 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 Heavy Industry Co Ltd filed Critical Sany Heavy Industry Co Ltd
Priority to CN201210027237.XA priority Critical patent/CN102589493B/zh
Priority to US14/376,748 priority patent/US9187916B2/en
Priority to PCT/CN2012/074171 priority patent/WO2013117050A1/zh
Publication of CN102589493A publication Critical patent/CN102589493A/zh
Application granted granted Critical
Publication of CN102589493B publication Critical patent/CN102589493B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B66HOISTING; LIFTING; HAULING
    • B66CCRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES
    • B66C23/00Cranes comprising essentially a beam, boom, or triangular structure acting as a cantilever and mounted for translatory of swinging movements in vertical or horizontal planes or a combination of such movements, e.g. jib-cranes, derricks, tower cranes
    • B66C23/88Safety gear
    • B66C23/90Devices for indicating or limiting lifting moment
    • B66C23/905Devices for indicating or limiting lifting moment electrical
    • 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B21/00Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
    • G01B21/16Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring distance of clearance between spaced objects
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B21/00Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
    • G01B21/22Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring angles or tapers; for testing the alignment of axes

Abstract

本发明提供了一种臂架系统,包括多节通过水平铰接轴顺序铰接相连的节臂,还包括:在每节节臂上安装两个长度传感器,其中一个长度传感器测量相对应节臂在形变后的长度,另一长度传感器测量其与相应节臂末端之间的长度,两个长度传感器之间存在预设距离;在每个节臂上安装一个倾角传感器,获取两个长度传感器之间的连线与参考平面之间的夹角;处理器根据倾角传感器和长度传感器的检测结果,获得臂架系统末端位置参数。根据本发明的臂架系统,对于单节臂采用单倾角传感器和双拉线编码器来获取节臂的末端位置参数,可以更准确地获得臂架系统末端位置参数。本发明还提供了一种工程机械和一种臂架系统末端位置参数获取方法。

Description

臂架系统、工程机械和臂架系统末端位置参数获取方法
技术领域
本发明涉及臂架控制技术领域,具体而言,涉及臂架系统、工程机械和臂架系统末端位置参数获取方法。
背景技术
多关节机械臂作为流动性物料输送装备,因其通用性强、作业范围广、操作灵活等优点,广泛应用于混凝土输送、高空消防作业、港口油料补给等领域,成为国家建设中不可缺少的高端技术装备。
臂架系统一般包括多节节臂,第一节臂的大头端与预定的底盘通过一个竖向轴铰接相连;其他节臂的大头端与相邻的节臂的小头端通过水平铰接轴铰接;这样,多节节臂通过水平铰接轴顺序铰接相连,最末端的节臂向外伸出,该节臂称为末节臂,末节臂的外端形成臂架系统末端;相邻的节臂之间设置有液压缸等驱动机构,以使相邻的节臂之间角度产生预定的变化,使臂架系统末端的位置改变,以将物料或物品运送到预定的位置。
由于机械臂受自重和施工姿态的影响,刚柔耦合的机械臂形变复杂,严重影响其末端定位精度。为了获取机械臂的姿态,实现对机械臂末端的精确定位,通常在控制系统中建立适当的坐标系,并通过该坐标系的坐标参数确定机械臂各节臂铰接点的位置,并考虑各节臂的形变,最终确定机械臂实际的末端位置,该末端位置的坐标参数称为位置参数。
另外,在利用臂架系统进行工作的过程中,每节臂均要承受相应负载,产生相应形变;多节臂形变的累积会导致臂架系统末端的位置参数与目标位置参数之间具有很大的偏差。
为了减小由于机械臂形变导致的臂架系统末端的位置参数的偏差,相关技术中获取末端位置参数的一种方式是,利用两个倾角传感器获得相应节臂的形变量,再根据该形变量对节臂的位置参数进行修正。该方式虽然能够提高臂架系统末端位置参数的准确性,但由于受到倾角传感器测量精度的限制,臂架系统末端的位置参数与目标位置参数之间的偏差仍然较大,无法满足对臂架系统末端的准确定位和控制的需要。
因此,如何提高臂架系统末端位置参数的准确度,仍然是本领域技术人员需要解决的技术问题。
发明内容
考虑到上述背景技术,本发明所要解决的一个技术问题是提供一种臂架系统,本发明所要解决的另一个技术问题是提供一种具有上述臂架系统的工程机械,本发明所要解决的又一个技术问题是提供一种臂架系统末端位置参数获取方法,可以更准确地获得臂架系统末端位置参数。
根据本发明的一个方面,提供了一种臂架系统,包括n节通过水平铰接轴顺序铰接相连的节臂,还包括:处理器、n个倾角传感器和2n个长度传感器,所述n为正整数,其中,在每节节臂上安装第一长度传感器和第二长度传感器;在第i节节臂上,所述第二长度传感器与所述第一长度传感器之间的预设距离为Lai,通过所述第一长度传感器获取形变后第i节节臂的长度Lbi,通过所述第二长度传感器获取所述第二长度传感器与形变后第i节节臂末端之间的长度Lci;在每节节臂上各安装1个所述倾角传感器,获取所述第一长度传感器和所述第二长度传感器之间的连线与参考平面之间的夹角αi,其中,i=1、2、......n;所述处理器根据所述倾角传感器和所述长度传感器的检测结果,获得臂架系统末端位置参数(x′Tip,y′Tip):
x Tip ′ = Σ i = 1 n L bi · cos ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) ,
y Tip ′ = Σ i = 1 n L bi · sin ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) .
在上述技术方案中,优选地,所述第一长度传感器、所述第二长度传感器之间的连线垂直于相应各臂架延伸方向,所述倾角传感器安装在两个长度传感器之间。
在上述技术方案中,优选地,所述第一长度传感器为第一拉线编码器,第一拉线编码器的本体和拉线外端分别与相应各节臂的两端相连。拉线编码器具有更高的精度,可以准确测量相应节臂的长度,进而能够更准确地获得臂架系统末端位置参数。
在上述技术方案中,优选地,所述第二长度传感器为第二拉线编码器,第二拉线编码器的本体和拉线外端分别与相应各节臂的两端相连;第一拉线编码器的本体的基准轴线、第二拉线编码器的本体的基准轴线之间的垂线,与第一拉线编码器的拉线相垂直,且两个拉线编码器的拉线外端连接于同一固定点。
在上述技术方案中,优选地,所述第一拉线编码器的本体的基准轴线与相应节臂一端的铰接轴线重合,所述拉线外端的固定点与相应节臂另一端的铰接轴线重合;或者,所述第一拉线编码器的本体的基准轴线与相应节臂一端的铰接轴线之间具有预定距离,所述拉线外端的固定点与相应节臂另一端的铰接轴线重合。
在上述技术方案中,优选地,所述倾角传感器安装在第一拉线编码器的本体、第二拉线编码器的本体之间,且所述倾角传感器的基准轴线与该端的铰接轴线之间相交并垂直。这样可以使获得的节臂的倾斜角度更准确,能够更准确地获得臂架系统末端位置参数。
在上述技术方案中,优选地,所述倾角传感器分别安装在相应各节臂的大头端。这样可以避免一臂本身重力导致形变产生的误差。
在上述技术方案中,优选地,所述处理器还预置有臂架系统中各节臂的设计长度Lir;所述处理器在获得臂架系统末端位置参数之后,按照下述公式获取所述臂架系统的形变量Δx和Δy:
Δx = x Tip ′ - x ′ , x ′ = Σ i = 1 n L i · sin α i ,
Δy = y Tip ′ - y ′ , y ′ = Σ i = 1 n L i · cos α i ,
所述Li为通过所述第一长度传感器获取第i节节臂在形变前的测量长度,(x′,y′)为臂架系统在形变前的末端位置参数;按照下述公式获取修正后所述臂架系统末端位置参数(xTip,yTip):
x Tip = Σ i = 1 n L ir · cos ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) + Δx ,
y Tip = Σ i = 1 n L ir · sin ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) + Δy .
根据本发明的另一方面,还提供了一种工程机械,包括机械本体和臂架系统,所述臂架系统通过回转机构安装在机械本体上,所述臂架系统为上述任一技术方案中描述的臂架系统。
根据本发明的又一方面,还提供了一种臂架系统末端位置参数获取方法,包括以下步骤:每节节臂上,第一长度传感器和第二长度传感器之间的预设距离为Lai,通过所述第一长度传感器获取形变后第i节节臂的长度Lbi,通过所述第二长度传感器获取所述第二长度传感器与形变后第i节臂末端之间的长度Lci,获取所述第一长度传感器和所述第二长度传感器之间的连线与参考平面之间的夹角αi,其中,i=1、2、......n;通过下述公式获取所述臂架系统末端位置参数(x′Tip,y′Tip):
x Tip ′ = Σ i = 1 n L bi · cos ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) ,
y Tip ′ = Σ i = 1 n L bi · sin ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) .
上述方案采用单个传感器来检测相应节臂的倾斜角度,两个长度传感器和节臂的末端构成三角形,两个长度传感器检测三角形的相邻两边,从而利用三角形原理计算出节臂的末端位置参数,这样不仅可以避免现有技术中由于倾角传感器精度产生的累积误差,且通过适当的长度传感器检测节臂形变前后的长度,容易保证节臂长度的检测精度,进而能够更加精确地获取臂架系统末端的位置参数。
在上述技术方案中,优选地,在获得臂架系统末端位置参数之后还包括以下步骤:按照下述公式获取所述臂架系统的形变量Δx和Δy:
Δx=x′Tip-x′, x ′ = Σ i = 1 n L i · sin α i ,
Δy=y′Tip-y′, y ′ = Σ i = 1 n L i · cos α i ,
所述Li为第i节节臂在形变前时的测量长度,(x′,y′)为臂架系统在形变前的末端位置参数;根据获取的形变量获取修改正后所述臂架系统的末端位置参数(xTip,yTip),Lir为第i节节臂的设计长度:
x Tip = Σ i = 1 n L ir · cos ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) + Δx ,
y Tip = Σ i = 1 n L ir · sin ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) + Δy .
采用上述方案可以确定节臂变形后的形变量,以节臂的实际设计长度为基础获得臂架系统末端的位置参数,可以避免长度传感器的测量长度与相应节臂的设计长度之间的偏差导致数据的偏差,进而能够更加精确地获取臂架系统末端位置参数。
在提供上述获得臂架系统末端位置参数的方法的基础上,本发明提供的臂架系统能够实施上述方法,同样能够产生相对应的技术效果。
在上述技术方案中,优选地,所述Lbi为形变后第i节节臂的两端的铰接点之间的测量长度,所述Lci为所述第二长度传感器与第i节节臂的末端铰接点之间的测量长度,所述Li为在形变前第i节节臂两端的铰接点之间的测量长度,所述Lir为第i节节臂两端的铰接点之间的设计长度。
根据本发明的技术方案,采用三定点测量(第一拉线编码器的安装定点、第二拉线编码器的安装定点和小头端的铰接点)获取臂架系统的末端位置参数,采用了单个倾角传感器,减小了由于倾角传感器的测量误差而产生的误差,利用拉线编码传感器获取形变前后机械臂的长度,检测精度高,解决了传统机械臂形变无法准确测量的技术问题,并可通过获取形变量实现末端位置的精确稳定控制。
附图说明
图1示出了根据本发明的实施例的传感器安装在单节臂上的示意图;
图2示出了根据本发明的实施例的臂架系统中控制部分的示意图;
图3示出了根据本发明的实施例的单节臂形变示意图;
图4示出了根据本发明的实施例的五节臂形变示意图。
具体实施方式
为了能够更清楚地理解本发明的上述目的、特征和优点,下面结合附图和具体实施方式对本发明进行进一步的详细描述。
在下面的描述中阐述了很多具体细节以便于充分理解本发明,但是,本发明还可以采用其他不同于在此描述的其他方式来实施,因此,本发明并不限于下面公开的具体实施例的限制。
为了更清楚地描述本发明提供的技术方案,本部分先对提供的臂架系统进行描述,在对臂架系统描述的基础上对获得臂架系统末端位置参数的方法进行描述;获得臂架系统末端位置参数的方法可以应用本发明的提供臂架系统实施,但实施该方法不限于本发明提供的臂架系统。
首先,结合图1和图2详细说明根据本发明的臂架系统,图1示出了根据本发明的实施例的传感器安装在单节臂上的示意图,图2示出了根据本发明的实施例的臂架系统中控制部分的示意图。
根据本发明的实施例的臂架系统,包括n节通过水平铰接轴顺序铰接相连的节臂,还包括:处理器200、n个倾角传感器106和2n个长度传感器,n为正整数,其中,
在每节节臂上安装第一长度传感器102和第二长度传感器104(参见图1),在第i节节臂上的第二长度传感器104与第一长度传感器102之间的预设距离为Lai,即对于每一个节臂,两个长度传感器之间均有一个固定距离,通过第一长度传感器102获取形变后第i节臂的长度为Lbi并将长度数据传送至处理器200,通过第二长度传感器104获取第二长度传感器104与形变后第i节臂末端之间的长度为Lci并将长度数据传送至处理器200;在每节节臂上安装1个倾角传感器106,获取所述第一长度传感器102和所述第二长度传感器106之间的连线与参考平面之间的夹角αi(即对于每个节臂都安装有一个倾角传感器106,测出该节臂与参考平面之间的夹角)并将角度数据传送至处理器200,其中,i=1、2、......n;
处理器200根据倾角传感器106和长度传感器的检测结果,获得臂架系统末端位置参数(x′Tip,y′Tip):
x Tip ′ = Σ i = 1 n L bi · cos ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) ,
y Tip ′ = Σ i = 1 n L bi · sin ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) .
利用余弦定理可以获取每个节臂的末端位置参数,根据臂架系统中节臂的节数,将多个节臂的末端位置参数相加,可以计算出最后一节节臂的末端位置参数。
上述方案采用单个传感器来检测相应节臂的倾斜角度,两个长度传感器和节臂的末端构成三角形,两个长度传感器检测三角形的相邻两边,从而利用三角形原理计算出节臂的末端位置参数,这样不仅可以避免现有技术中由于倾角传感器精度产生的累积误差,且通过适当的长度传感器检测节臂形变前后的长度,容易保证节臂长度的检测精度,进而能够使臂架系统末端的位置参数更准确。
在上述结构基础上,第一长度传感器102、第二长度传感器104之间的连线垂直于相应各臂架延伸方向,倾角传感器106安装在两个长度传感器之间。
第一长度传感器102为第一拉线编码器,第一拉线编码器的本体和拉线外端分别与相应各节臂的两端相连;第二长度传感器104为第二拉线编码器,第二拉线编码器的本体和拉线外端分别与相应各节臂的两端相连;第一拉线编码器的本体的基准轴线、第二拉线编码器的本体的基准轴线之间的垂线,与第一拉线编码器的拉线相垂直,且两个拉线编码器的拉线外端连接于同一固定点。
在一种优选实施例中,如图1所示,第一长度传感器102安装于相对应节臂的大头端,第一拉线编码器的本体的基准轴线与相应节臂大头端的铰接轴线118之间具有预定的距离,拉线外端的固定点与相应节臂小头端的铰接轴线重合;在优选技术方案中,也可以使第一拉线编码器的本体的基准轴线与相应节臂大头端的铰接轴线118保持重合,拉线外端的固定点与相应节臂小头端的铰接轴线重合。这样,通过第一拉线编码器可以直接地获得该节臂形变后的长度。当然,由于节臂两端部分形变很小,也可以根据实际需要选择适当的部分作为测量对象,获得节臂形变后的长度。
第二长度传感器104安装在相应节臂的大头端,且两个拉线编码器的本体的基准轴线之间的垂线与第一拉线编码器的拉线相垂直,并且第二编码器的拉线外端与相应节臂小头端的铰接轴线重合。
倾角传感器106可以安装在第一拉线编码器的本体、第二拉线编码器的本体之间,且倾角传感器106的基准轴线与该端的铰接轴线之间相交并垂直。具体的,倾角传感器106可以安装在第一拉线编码器的本体与第二拉线编码器的本体之间连线的中点位置,可以使检测获得的倾斜角度与一相应节臂的实际倾斜角度更接近,减小数据误差,提高臂架系统末端位置参数的准确性。上述实施例中,将倾角传感器106安装在相应节臂的大头端时,可以避免一臂本身重力导致形变产生的误差。同样,测量其他节臂的倾斜角度时,也可以根据实际需要将相应的倾角传感器安装在相应节臂的预定位置。
可以理解,当两个拉线编码器的本体安装在相应节臂的小头端,倾角传感器106安装在相应节臂的小头端,同样可以获得该臂的倾斜角度。
如图1所示的具体实施例中,为了满足检测一臂长度的需要,第一拉线编码器102除了包括自身拉线外,还设置有第一延长拉线114,该第一延长拉线114内端与该第一拉线编码器102自身拉线的外端相接,相接点如图1中标注的110。本例中,在一臂延伸方向上,第一拉线编码器102的本体的基准轴线与一臂大头端的铰接轴线之间具有预定距离,第一延长拉线114外端与一臂小头端铰接点108连接。同理,第二拉线编码器104除了包括自身拉线外,还设置有第二延长拉线116,该第二延长拉线116内端与该第二拉线编码器104自身拉线的外端相接,相接点如图1中标注的112,第二延长拉线116外端与一臂小头端铰接点108连接。
如图1所示,当节臂发生形变时,与第一拉线编码器对应的拉线外端连接点110和与第二拉线编码器对应的拉线外端连接点112是移动的,随着节臂的变形,第一拉线编码器和第二拉线编码器的测量值随之改变,因此,相应的连接点也随之移动,这样的做法是考虑到实际中的节臂长度超过拉线编码器的量程,所以增加了一个固定不变的延长拉线,当然,如果拉线编码器的量程足够测量节臂的长度,那么就无需增加该延长拉线,也就没有相应的连接点。
图1中的Lbhi即第一延长拉线114的长度值,Lchi即第二延长拉线116的长度值,Lbgi即第一长度传感器102的测量值,Lcgi即第二长度传感器104的测量值,因此,Lbi=Lbgi+Lbhi,Lci=Lcgi+Lchi。而倾角传感器106安装于第一长度传感器102和第二长度传感器104的连线中点,用于测量固定边(第一长度传感器102与第二长度传感器104之间的连线)与参考平面(例如水平面)的夹角,因此,当机械臂处于水平姿态时,其标度为零。
在此,需说明的是,图2示出了臂架系统中的控制部分的框图,在该控制部分只示出了单节臂的情况,本领域内的技术人员应该理解,在多节臂的情况下,可以有多个倾角传感器106和多个第一长度传感器102和多个第二长度传感器104,这些倾角传感器和长度传感器将测量值发送给处理器200,由该处理器200运算出每节节臂的末端位置参数,最终获取臂架系统的末端位置参数(即最后一节机械臂的末端位置参数)。
在上述实施例中,第一拉线编码器、第二拉线编码器和相应节臂小头端的铰接点构成一个三角形,在理论上该第一拉线编码器测量的长度为该节臂两个铰接点之间的距离,第二拉线编码器测量该三角形的另一条边的长度,根据余弦定理最终确定节臂末端位置的参数。但是,由于机械结构原因,第一拉线编码器无法与相应节臂的大头端铰接点直接重合,第一拉线编码器的拉线外端也无法与相应节臂的小头端铰接点直接重合,其测量出的长度不是相应节臂的设计长度(所述设计长度定义为:设计时节臂两端铰接轴线之间的距离),从而引入末端位置参数的计算误差,因此,采用补偿法对机械臂的形变量进行补偿,以消除该误差,使得最终获取的节臂末端位置参数更精确。
处理器200预置有臂架系统中各节臂的设计长度Lir;处理器200在获得臂架系统末端位置参数之后,按照下述公式获取臂架系统的形变量Δx和Δy:
Δx=x′Tip-x′, x ′ = Σ i = 1 n L i · sin α i ,
Δy=y′Tip-y′, y ′ = Σ i = 1 n L i · cos α i ,
Li为根据第一长度传感器获取第i节节臂在形变前的测量长度,(x′,y′)为臂架系统在形变前的末端位置参数;
按照下述公式获取修正后臂架系统末端位置参数(xTip,yTip):
x Tip = Σ i = 1 n L ir · cos ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) + Δx ,
y Tip = Σ i = 1 n L ir · sin ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) + Δy .
首先计算出臂架系统的形变量,然后将根据实际节臂设计长度得到的末端位置参数加上形变量,即可以得到补偿后的准确的臂架末端位置参数。采用上述方案可以确定节臂变形后的形变量,以节臂的实际设计长度为基础获得臂架系统末端的位置参数,可以避免长度传感器的测量长度与相应节臂的设计长度之间的偏差导致数据的偏差,进而提高臂架系统末端位置参数的准确性。
根据本发明的工程机械,包括机械本体和臂架系统,臂架系统通过回转机构安装在机械本体上,臂架系统为上述任一技术方案中描述的臂架系统。在此,应该理解,该工程机械可以是具有臂架系统的任何一种工程机械,例如混凝土泵车、登高设备、高空消防设备等。
下面,在预设的优选坐标系中,对本发明臂架系统末端位置参数获取方法进行详细说明。
图3中,X轴和Y轴形成直角坐标系YOX,其中X轴与水平面平行,Y轴与水平面垂直,YOX形成的平面与一臂两端的铰接轴线保持垂直。一臂的大头端的铰接轴线与坐标原点O重合,A为形变前一臂的小头端的铰接轴线在直角坐标系YOX中的位置,A’为发生了形变后一臂的小头端的铰接轴线在直角坐标系的位置。
以臂架系统的第1节节臂为例,如图3所示,原点O为第一拉线编码器的安装位置,B为第二拉线编码器的安装位置,倾角传感器106安装在O与B连线的中点位置。A为第1节节臂在变形前的末端位置,设A的坐标参数为(xA,yA),OA的长度值L1为臂架在形变前的长度;A’为发生了形变的第1节节臂的末端位置,设A’的坐标参数为(xA′,yA′),OA’为臂架形变下OA的有效长度Lb1;∠AOB为直角,∠XOB的角度值α1由倾角传感器106测量得到。
这样,臂架形变前O、B、A构成RTΔOAB,上述O、B、A’构成臂架形变后的三角形的三个顶点,两个三角形中OB是长度固定不变的边,通过拉线编码器的测量,可以知道该三角形的三条边长度,结合余弦定理可以计算出形变后该节臂的末端位置参数。
第1节节臂在形变前的末端位置参数(xA,yA)可以按照下述方法得到:
xA=L1×sinα1;yA=L1×cosα1
OA’为臂架形变下OA的有效长度Lb1=Lbg1+Lbh1,为第一延长拉线114长度和第一拉线编码器测量值的和。A’B为臂架形变下AB的有效长度Lc1=Lcg1+Lch1,为第二延长拉线116的长度和第二拉线编码器测量值的和,那么OA’与X轴的夹角为∠β1
∠ β 1 =arccos O A ′ 2 + O B 2 - A ′ B 2 2 × O A ′ × OB - α 1 = arccos ( L bg 1 + L bh 1 ) 2 + L a 1 2 - ( L cg 1 + L ch 1 ) 2 2 × ( L bg 1 + L bh 1 ) × L a 1 - α 1 .
然后,按照测量值计算出的该单节臂末端A的坐标为:
x A ′ = L b 1 × cos β 1 = ( L bg 1 + L bh 1 ) × cos ( arccos ( L bg 1 + L bh 1 ) 2 + L a 1 2 - ( L cg 1 + L ch 1 ) 2 2 × ( L bg 1 + L bh 1 ) × L a 1 - α 1 ) ,
y A ′ = L c 1 × sin β 1 = ( L bg 1 + L bh 1 ) × sin ( arccos ( L bg 1 + L bh 1 ) 2 + L a 1 2 - ( L cg 1 + L ch 1 ) 2 2 × ( L bg 1 + L bh 1 ) × L a 1 - α 1 ) .
上面所描述的是确定单节臂的末端位置参数的示例,同理可以得到其他节臂的末端位置参数。
下面参考图4,该实施例提供的臂架系统包括5节通过水平铰接轴顺序铰接相连的节臂;5节节臂分别称为一臂、二臂、三臂、四臂和五臂;一臂安装在相应机械本体的底盘上,五臂为末节臂;各节臂中,靠近机械本体一端为大头端,相反的另一端为小头端;大头端和小头端分别形成相应的铰接轴线,那么相应地,在该示例中与处理器200连接的长度传感器有10个,与处理器200连接的倾角传感器有5个,5个倾角传感器分别安装在该五节臂的每一节臂上。
假设五节臂的倾角传感器测量的角度分别为α1、α2、α3、α4、α5,形变前的各节臂架的长度(第一拉线编码器测量的形变前实际安装点之间的距离)分别为L1、L2、L3、L4、L5,变形后各节臂架的测量长度(第一拉线编码器102测取的形变后实际安装点之间的距离)分别为Lb1、Lb2、Lb3、Lb4、Lb5(对应于第一个实施例中的Lbi,第一节臂对应Lb1),根据上述示例中单节臂的计算方式可以得到多节臂末端的坐标(按照测量值计算得到的节臂末端位置参数)如下:
xTip=Lb1·cosβ1+Lb2·cosβ2+Lb3·cosβ3+Lb4·cosβ4+Lb5·cosβ5
yTip=Lb1·sinβ1+Lb2·sinβ2+Lb3·sinβ3+Lb4·sinβ4+Lb5·sinβ5,其中,
∠ β 1 = arccos ( L bg 1 + L bh 1 ) 2 + L a 1 2 - ( L cg 1 + L ch 1 ) 2 2 × ( L bg 1 + L bh 1 ) × L a 1 - α 1 ,
∠ β 2 = arccos ( L bg 2 + L bh 2 ) 2 + L a 2 2 - ( L cg 2 + L ch 2 ) 2 2 × ( L bg 2 + L bh 2 ) × L a 2 - α 2 ,
∠ β 3 = arccos ( L bg 3 + L bh 3 ) 2 + L a 3 2 - ( L cg 3 + L ch 3 ) 2 2 × ( L bg 3 + L bh 3 ) × L a 3 - α 3 ,
∠ β 4 = arccos ( L bg 4 + L bh 4 ) 2 + L a 4 2 - ( L cg 4 + L ch 4 ) 2 2 × ( L bg 4 + L bh 4 ) × L a 4 - α 4 ,
∠ β 5 = arccos ( L bg 5 + L bh 5 ) 2 + L a 5 2 - ( L cg 5 + L ch 5 ) 2 2 × ( L bg 5 + L bh 5 ) × L a 5 - α 5 .
此外,因为机械结构的原因,第一拉线编码器无法非常接近节臂的铰接点,因此,会引入末端位置参数的计算误差,下面将采用补偿算法来避免这样的计算误差。
1)首先计算出臂架系统的形变量:
对于五节臂来说,形变后的末端位置参数可以按照下述公式得到(x′Tip,y′Tip):
x′Tip=Lb1×cosβ1+Lb2×cosβ2+Lb3×cosβ3+Lb4×cosβ4+Lb5×cosβ5
y′Tip=Lb1×sinβ1+Lb2×sinβ2+Lb3×sinβ3+Lb4×sinβ4+Lb5×sinβ5
在变形前的末端位置参数为(x′,y′):
x′=L1×sinα1+L2×sinα2+L3×sinα3+L4×sinα4+L5×sinα5
y′=L1×cosα1+L2×cosα2+L3×cosα3+L4×cosα4+L5×cosα5
按照下述公式得到臂架系统的形变量(即将按照测量值得到的形变后末端位置参数减去按照测量值得到的形变前的末端位置参数,就是臂架系统的形变量):
Δx=x′Tip-x′,Δt=y′Tip-y′。
2)根据形变量对实际理论值进行补偿,获取准确的臂架系统末端位置参数。
假设每节臂铰接点之间的长度(铰接点之间的设计长度)分别为:L1r、L2r、L3r、L4r、L5r,则获取精确的臂架系统末端位置坐标为(xTip,yTip):
xTip=L1r×cosβ1+L2r×cosβ2+L3r×cosβ3+L4r×cosβ4+L5r×cosβ5+Δx,
yTip=L1r×sinβ1+L2r×sinβ2+L3r×sinβ3+L4r×sinβ4+L5r×sinβ5+Δy。
这样获取得到的臂架系统末端位置参数,去除了由于第一拉线编码器无法准确与铰接点重合而引入的误差(即根据第一拉线编码器测量值得到的节臂长度与节臂的实际设计长度与实际的节臂设计长度是有误差的),并且采用单倾角传感器(倾角传感器本身也有测量误差),也进一步减少了测量误差,提高了机械臂末端位置参数的测量精度。
应该理解,检测各节臂产生形变前后长度的装置不限于拉线编码器,也可以是其他长度传感器;只要是通过长度传感器能够检测各节臂产生形变前后长度,就能够实现本发明的目的。
应该理解,确定臂架系统末端的位置参数的坐标系中,坐标轴不限于与水平面平行或垂直,也可以根据实际需要设定相应坐标系,使预定坐标轴与预定参考平面平行;通过对倾角传感器输出角度值的适当换算,就可以获得相应各节臂与预定参考平面之间的夹角。
基于上述对臂架系统的描述,根据本发明的实施例的臂架系统末端位置参数获取方法,包括以下步骤:每节节臂上,第一长度传感器和第二长度传感器之间的预设距离为Lai,通过所述第一长度传感器获取形变后第i节节臂的长度Lbi,通过第二长度传感器获取第二长度传感器与形变后第i节节臂末端之间的长度为Lci,获取第一长度传感器和第二长度传感器之间的连线与参考平面之间的夹角αi,其中,i=1、2、......n;
通过下述公式获取直角坐标系YOX中的臂架系统末端位置参数(x′Tip,y′Tip):
x Tip ′ = Σ i = 1 n L bi · cos ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) ,
y Tip ′ = Σ i = 1 n L bi · sin ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) .
上述方案采用单个传感器来检测节臂的倾斜角度,两个长度传感器和节臂的末端构成三角形,两个长度传感器检测三角形的相邻两边,从而利用确定的三角形计算出节臂的末端位置参数,这样不仅可以避免由于倾角传感器精度产生的累积误差,且通过适当的长度传感器检测节臂形变前后的长度,容易保证节臂长度的检测精度,进而能够使臂架系统末端的位置参数更准确。
由于机械结构原因,第一拉线编码器无法与相应节臂的大头端铰接点直接重合,第一拉线编码器的拉线外端也无法与相应节臂的小头端铰接点直接重合,会引入末端位置参数的计算误差,因此,采用补偿法对机械臂的形变量进行补偿。该补偿法包括以下步骤:按照下述公式获取臂架系统的形变量Δx和Δy:
Δx=x′Tip-x′, x ′ = Σ i = 1 n L i · sin α i ,
Δy=y′Tip-y′, y ′ = Σ i = 1 n L i · cos α i ,
Li为根据第一长度传感器获取第i节节臂在形变前的测量长度,(x′,y′)为臂架系统在形变前的末端位置参数;
根据获取的形变量获取修正后臂架系统的末端位置参数(xTip,yTip),Lir为第i节节臂的设计长度:
x Tip = Σ i = 1 n L ir · cos ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) + Δx ,
y Tip = Σ i = 1 n L ir · sin ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) + Δy .
所以,以节臂的实际设计长度为基础获得臂架系统末端的位置参数,可以避免长度传感器的测量长度与相应节臂的设计长度之间的偏差导致数据的偏差,进而提高臂架系统末端位置参数的准确性。
在上述技术方案中,Lbi为形变后第i节节臂的两端的铰接点之间的测量长度,Lci为第二长度传感器与第i节臂的末端铰接点之间的测量长度,Li为在形变前第i节臂两端的铰接点之间的测量长度,Lir为第i节节臂两端的铰接点之间的设计长度。
根据本发明的技术方案,采用三定点测量(第一拉线编码器的安装定点、第二拉线编码器的安装定点和小头端的铰接点)获取臂架系统的末端位置参数,采用了单个倾角传感器,减小了由于倾角传感器测量误差而产生的误差,利用拉线编码传感器获取形变前后机械臂的长度,检测精度高,解决了传统机械臂形变无法准确测量的技术问题,并可通过获取形变量实现末端位置的精确稳定控制。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。

Claims (12)

1.一种臂架系统,包括n节通过水平铰接轴顺序铰接相连的节臂,其特征在于,还包括:处理器(200)、n个倾角传感器(106)和2n个长度传感器,所述n为正整数,其中,
在每节节臂上安装第一长度传感器(102)和第二长度传感器(104);在第i节节臂上,所述第二长度传感器(104)与所述第一长度传感器(102)之间的预设距离为Lai,通过所述第一长度传感器(102)获取形变后第i节节臂的长度Lbi,通过所述第二长度传感器(104)获取所述第二长度传感器(104)与形变后第i节节臂末端之间的长度Lci
在每节节臂上各安装1个所述倾角传感器(106),获取所述第一长度传感器(102)和所述第二长度传感器(106)之间的连线与参考平面之间的夹角αi,其中,i=1、2、……n;
所述处理器(200)根据所述倾角传感器(106)和所述长度传感器的检测结果,获得臂架系统末端位置参数(x'Tip,y'Tip):
x Tip ′ = Σ i = 1 n L bi · cos ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) ,
y Tip ′ = Σ i = 1 n L bi · sin ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) .
2.根据权利要求1所述的臂架系统,其特征在于,所述第一长度传感器(102)、所述第二长度传感器(104)之间的连线垂直于相应各臂架延伸方向,所述倾角传感器(106)安装在两个长度传感器之间。
3.根据权利要求2所述的臂架系统,其特征在于,所述第一长度传感器(102)为第一拉线编码器,第一拉线编码器的本体和拉线外端分别与相应各节臂的两端相连。
4.根据权利要求3所述的臂架系统,其特征在于,所述第二长度传感器(104)为第二拉线编码器,第二拉线编码器的本体和拉线外端分别与相应各节臂的两端相连;
所述第一拉线编码器的本体的基准轴线、所述第二拉线编码器的本体的基准轴线之间的垂线,与所述第一拉线编码器的拉线相垂直,且两个拉线编码器的拉线外端连接于同一固定点。
5.根据权利要求3所述的臂架系统,其特征在于,所述第一拉线编码器的本体的基准轴线与相应节臂一端的铰接轴线重合,所述拉线外端的固定点与相应节臂另一端的铰接轴线重合;或者,所述第一拉线编码器的本体的基准轴线与相应节臂一端的铰接轴线之间具有预定距离,所述拉线外端的固定点与相应节臂另一端的铰接轴线重合。
6.根据权利要求4所述的臂架系统,其特征在于,所述倾角传感器(106)安装在所述第一拉线编码器的本体、所述第二拉线编码器的本体之间,且所述倾角传感器(106)的基准轴线与相应节臂一端的铰接轴线之间相交并垂直。
7.根据权利要求6所述的臂架系统,其特征在于,所述倾角传感器(106)分别安装在相应各节臂的大头端。
8.根据权利要求1至7任一项所述的臂架系统,其特征在于,所述处理器(200)还预置有臂架系统中各节臂的设计长度Lir
所述处理器(200)还在获得臂架系统末端位置参数之后,按照下述公式获取所述臂架系统的形变量Δx和Δy:
Δx = x Tip ′ - x ′ , x ′ = Σ i = 1 n L i · sin α i ,
Δy = y Tip ′ - y ′ , y ′ = Σ i = 1 n L i · cos α i ,
所述Li为通过所述第一长度传感器(102)获取第i节节臂在形变前的测量长度,(x',y')为臂架系统在形变前的末端位置参数;
按照下述公式获取修正后所述臂架系统末端位置参数(xTip,yTip):
x Tip = Σ i = 1 n L ir · cos ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) + Δx ,
y Tip = Σ i = 1 n L ir · sin ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) + Δy .
9.一种工程机械,包括机械本体和臂架系统,所述臂架系统通过回转机构安装在机械本体上,其特征在于,所述臂架系统为权利要求1至8任一项所述的臂架系统。
10.一种臂架系统末端位置参数获取方法,其特征在于,包括以下步骤:
每节节臂上,第一长度传感器和第二长度传感器之间的预设距离为Lai,通过所述第一长度传感器获取形变后第i节节臂的长度Lbi,通过所述第二长度传感器获取所述第二长度传感器与形变后第i节臂末端之间的长度Lci,获取所述第一长度传感器和所述第二长度传感器之间的连线与参考平面之间的夹角αi,其中,i=1、2、……n;
通过下述公式获取所述臂架系统末端位置参数(x'Tip,y'Tip):
x Tip ′ = Σ i = 1 n L bi · cos ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) ,
y Tip ′ = Σ i = 1 n L bi · sin ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) .
11.根据权利要求10所述的臂架系统末端位置参数获取方法,其特征在于,在获得臂架系统末端位置参数之后还包括以下步骤:
按照下述公式获取所述臂架系统的形变量Δx和Δy:
Δx = x Tip ′ - x ′ , x ′ = Σ i = 1 n L i · sin α i ,
Δy = y Tip ′ - y ′ , y ′ = Σ i = 1 n L i · cos α i ,
所述Li为第i节节臂在形变前的测量长度,(x',y')为臂架系统在形变前的末端位置参数;
根据获取的形变量获取修正后所述臂架系统的末端位置参数(xTip,yTip),Lir为第i节节臂的设计长度:
x Tip = Σ i = 1 n L ir · cos ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) + Δx ,
y Tip = Σ i = 1 n L ir · sin ( arccos L bi 2 + L ai 2 - L ci 2 2 L ai · L bi _ α i ) + Δy .
12.根据权利要求11所述的臂架系统末端位置参数获取方法,其特征在于,所述Lbi为形变后第i节节臂的两端的铰接点之间的测量长度,所述Lci为所述第二长度传感器与第i节节臂的末端铰接点之间的测量长度,所述Li为在形变前第i节节臂两端的铰接点之间的测量长度,所述Lir为第i节节臂两端的铰接点之间的设计长度。
CN201210027237.XA 2012-02-08 2012-02-08 臂架系统、工程机械和臂架系统末端位置参数获取方法 Active CN102589493B (zh)

Priority Applications (3)

Application Number Priority Date Filing Date Title
CN201210027237.XA CN102589493B (zh) 2012-02-08 2012-02-08 臂架系统、工程机械和臂架系统末端位置参数获取方法
US14/376,748 US9187916B2 (en) 2012-02-08 2012-04-17 Boom system, engineering machinery, and a method for acquiring boom system distal end position parameter
PCT/CN2012/074171 WO2013117050A1 (zh) 2012-02-08 2012-04-17 臂架系统、工程机械和臂架系统末端位置参数获取方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201210027237.XA CN102589493B (zh) 2012-02-08 2012-02-08 臂架系统、工程机械和臂架系统末端位置参数获取方法

Publications (2)

Publication Number Publication Date
CN102589493A CN102589493A (zh) 2012-07-18
CN102589493B true CN102589493B (zh) 2014-05-21

Family

ID=46478485

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201210027237.XA Active CN102589493B (zh) 2012-02-08 2012-02-08 臂架系统、工程机械和臂架系统末端位置参数获取方法

Country Status (3)

Country Link
US (1) US9187916B2 (zh)
CN (1) CN102589493B (zh)
WO (1) WO2013117050A1 (zh)

Families Citing this family (28)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103015729B (zh) * 2012-12-19 2014-12-24 中联重科股份有限公司 臂架振动控制设备、方法、系统及工程机械
CN103575249B (zh) * 2013-11-08 2016-07-27 中联重科股份有限公司 回转装置的回转角度检测设备、系统、方法和工程机械
CN103590606B (zh) * 2013-11-13 2015-10-28 三一汽车制造有限公司 一种臂架控制方法和装置及混凝土泵车及布料机
CN104950909A (zh) * 2014-03-26 2015-09-30 中集车辆(集团)有限公司 多节机械臂的控制系统及方法
CN104567762B (zh) * 2014-12-23 2018-02-02 中联重科股份有限公司 工程机械臂架在线监测方法、设备以及系统
CN104495623B (zh) * 2014-12-30 2018-07-03 中联重科股份有限公司 起重机伸缩臂控制装置和方法以及起重机
DE102015108473A1 (de) * 2015-05-28 2016-12-01 Schwing Gmbh Großmanipulator mit schnell ein- und ausfaltbarem Knickmast
DE102016106406A1 (de) * 2016-04-07 2017-10-12 Schwing Gmbh Kartesische Steuerung einer Mastspitze eines Großmanipulators
CN105865401B (zh) * 2016-05-13 2018-11-20 北汽福田汽车股份有限公司 用于可伸缩臂架的形变量检测方法和装置
CN106115492A (zh) * 2016-08-31 2016-11-16 润邦卡哥特科工业有限公司 一种用于起重机的三维坐标定位系统
CN108106583A (zh) * 2018-02-14 2018-06-01 山东建筑大学 一种数控装置末端位置实时测量系统和测量方法
CN110940257B (zh) * 2018-09-25 2021-09-24 国核电站运行服务技术有限公司 一种测量管道倾角变化的装置及方法
CN113001537B (zh) * 2019-12-20 2022-08-02 深圳市优必选科技股份有限公司 机械臂控制方法、机械臂控制装置及终端设备
CN111174718B (zh) * 2020-01-09 2021-10-01 徐工消防安全装备有限公司 一种偏摆量的测量装置、测量方法及剪叉车
CN111761574B (zh) * 2020-05-28 2022-08-02 中联重科股份有限公司 判断臂架可进行的操作的安全性的方法和装置及工程机械
CN112049427A (zh) * 2020-08-31 2020-12-08 三一汽车制造有限公司 臂架控制系统、方法和作业车辆
CN112127630A (zh) * 2020-09-14 2020-12-25 广东博智林机器人有限公司 一种布料机系统及其控制方法
CN112520584A (zh) * 2020-11-13 2021-03-19 南京中船绿洲机器有限公司 Profinet编码器在船用折臂起重机上的运用方法
CN114687561B (zh) * 2020-12-31 2023-06-06 三一汽车制造有限公司 作业机械的控制方法、装置和作业机械
CN113062598B (zh) * 2021-03-19 2022-02-15 中联重科股份有限公司 臂架回转振动控制系统、方法、介质及工程机械
CN113280805B (zh) * 2021-04-14 2023-03-17 中联重科股份有限公司 用于识别臂架姿态的方法、处理器、装置及工程机械
CN113804107A (zh) * 2021-08-19 2021-12-17 中联重科股份有限公司 用于吊臂的检测方法、控制器、用于吊臂的检测装置和工程机械
CN114112358B (zh) * 2021-11-23 2023-12-26 武汉中科医疗科技工业技术研究院有限公司 机械臂的刚度测量方法和刚度测量系统
CN114135224B (zh) * 2021-11-30 2024-02-02 江苏徐工工程机械研究院有限公司 岩土工程机械及其工作臂挠度补偿方法
CN114800502A (zh) * 2022-04-25 2022-07-29 上海睿尤准智控技术有限公司 臂架形变补偿方法、补偿控制系统及工程机械设备
CN114777726B (zh) * 2022-05-05 2024-01-26 上海睿尤准智控技术有限公司 臂架的形变量确定方法、装置、臂架系统及工程机械设备
CN115571670B (zh) * 2022-12-09 2023-02-28 石家庄博德宁机械设备有限公司 货物装载控制方法、装置及终端设备
CN116907412B (zh) * 2023-09-12 2023-11-17 农业农村部南京农业机械化研究所 农机的行距偏差检测方法、装置及系统

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US3896885A (en) * 1970-12-11 1975-07-29 Skanska Cementgjuteriet Ab System for automatically aligning and/or moving in a parallel movement path a guide seating structure adapted for guiding the movement of a tool mounted thereon
US4856199A (en) * 1987-02-18 1989-08-15 Merrill Engineering Laboratories, Inc. Single contact point distance measuring for plane determination
CN101525944A (zh) * 2009-03-31 2009-09-09 北京易斯路电子有限公司 混凝土泵车智能臂架控制系统及其控制方法
CN101870110A (zh) * 2010-07-01 2010-10-27 三一重工股份有限公司 一种机械铰接臂的控制方法及控制装置
CN101993008A (zh) * 2009-08-12 2011-03-30 中国船舶重工集团公司第七一三研究所 一种确定起重机吊钩位置的测量方法及其系统

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0742077B2 (ja) * 1990-02-09 1995-05-10 極東開発工業株式会社 高所作業車の作業範囲規制装置
JP3238300B2 (ja) 1995-05-12 2001-12-10 株式会社ショーライト 焼結軸受の製造方法
US6473679B1 (en) * 1999-12-10 2002-10-29 Caterpillar Inc. Angular velocity control and associated method for a boom of a machine
JP2009030235A (ja) * 2007-07-24 2009-02-12 Kobelco Contstruction Machinery Ltd ショベル
CN101306789A (zh) 2008-05-08 2008-11-19 江阴市华澄特种机械工程有限公司 高空作业平台工作斗垂直升降与水平移动的控制方法
CN101348216B (zh) * 2008-09-05 2010-06-02 湖南三一起重机械有限公司 一种起重机安全保护系统及其起重机
US7852229B1 (en) * 2008-09-15 2010-12-14 Gohl Russell R Excavation equipment alarm system
CN102032884B (zh) * 2009-09-27 2012-06-06 徐州重型机械有限公司 工程机械及其臂架工作幅度的测量方法和测量装置
CN101750620A (zh) 2009-12-25 2010-06-23 三一重工股份有限公司 臂架系统的定位方法、定位装置及混凝土泵车
CN101804945B (zh) * 2010-05-07 2012-09-26 三一汽车起重机械有限公司 一种单缸插销式伸缩臂装置及其臂节位置检测系统
CN101891125B (zh) * 2010-08-03 2012-07-11 上海三一科技有限公司 一种起重机超起配重偏离的检测装置及方法
CN102338191B (zh) * 2011-07-01 2013-06-05 三一重工股份有限公司 臂架振动抑制方法、系统及臂架式工程机械
CN102322497A (zh) * 2011-07-01 2012-01-18 三一重工股份有限公司 臂架振动抑制方法、系统及臂架式工程机械

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US3896885A (en) * 1970-12-11 1975-07-29 Skanska Cementgjuteriet Ab System for automatically aligning and/or moving in a parallel movement path a guide seating structure adapted for guiding the movement of a tool mounted thereon
US4856199A (en) * 1987-02-18 1989-08-15 Merrill Engineering Laboratories, Inc. Single contact point distance measuring for plane determination
CN101525944A (zh) * 2009-03-31 2009-09-09 北京易斯路电子有限公司 混凝土泵车智能臂架控制系统及其控制方法
CN101993008A (zh) * 2009-08-12 2011-03-30 中国船舶重工集团公司第七一三研究所 一种确定起重机吊钩位置的测量方法及其系统
CN101870110A (zh) * 2010-07-01 2010-10-27 三一重工股份有限公司 一种机械铰接臂的控制方法及控制装置

Also Published As

Publication number Publication date
US20150081164A1 (en) 2015-03-19
CN102589493A (zh) 2012-07-18
US9187916B2 (en) 2015-11-17
WO2013117050A1 (zh) 2013-08-15

Similar Documents

Publication Publication Date Title
CN102589493B (zh) 臂架系统、工程机械和臂架系统末端位置参数获取方法
CN104776822B (zh) 多节臂架的姿态检测系统和方法
CN102346025B (zh) 获得臂架系统末端位置参数的方法、臂架系统及工程机械
KR101222298B1 (ko) 2-륜 이동 로봇의 오도메트리 오차 보정 방법
CN102126162B (zh) 一种数控机床加工在线测量方法
EP2381214A1 (en) Optical measurement system
WO2019080888A1 (zh) 多轴激光位移测量系统中干涉仪的安装偏差标定方法
WO2020073929A1 (zh) 作业台车及其机械臂光学标靶定位装置和定位方法
CN102608351B (zh) 机械臂三维姿态的检测方法和系统、及控制其运行的系统
CN104563469A (zh) 一种用于墙面抹灰机器人的垂直度测量与补偿系统及方法
CN104848826A (zh) 形状测量设备和形状测量误差校正方法
CN106097395A (zh) 一种基于直线位移传感器的工业机器人运动学参数的标定算法
CN111485879A (zh) 一种掘进机车体及其截割滚筒的定位方法及定位系统
CN107726982A (zh) 一种激光测距传感器安装位置误差标定方法
CN102346024B (zh) 获得臂架系统末端位置参数的方法、臂架系统及工程机械
CN103808256A (zh) 一种非接触式物体平面运动测量装置及实现方法
CN105180962A (zh) 一种基于空间两点投影的协同机器人基座标系标定方法
CN105572679A (zh) 一种二维扫描型激光雷达的扫描数据修正方法及系统
CN106671081B (zh) 一种基于单目视觉的少自由度机器人运动学标定方法
CN105865401B (zh) 用于可伸缩臂架的形变量检测方法和装置
CN202614200U (zh) 臂架系统和工程机械
CN103913179A (zh) 舰载单轴旋转调制捷联惯导姿态角修正方法
CN105444722A (zh) 检测平台姿态变化的方法
CN103759922A (zh) 一种航天遥感器二维指向镜指向精度测量方法
CN105547215A (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