CN103862465A - 多关节机械臂坐标校正方法和系统 - Google Patents
多关节机械臂坐标校正方法和系统 Download PDFInfo
- Publication number
- CN103862465A CN103862465A CN201410057866.6A CN201410057866A CN103862465A CN 103862465 A CN103862465 A CN 103862465A CN 201410057866 A CN201410057866 A CN 201410057866A CN 103862465 A CN103862465 A CN 103862465A
- Authority
- CN
- China
- Prior art keywords
- jib
- joint
- deformation quantity
- deflection
- mechanical arm
- 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.)
- Granted
Links
Images
Landscapes
- Jib Cranes (AREA)
Abstract
本发明公开了一种多关节机械臂坐标校正方法和系统。其中,多关节机械臂坐标校正方法包括如下步骤:接收多关节机械臂的初始参数,初始参数包括各节臂架的长度和质量;基于初始参数,计算每一臂架之后的臂架对该臂架产生的第一形变量、该臂架自身载荷所产生的第二形变量,以及,该臂架之前的臂架对该臂架所产生的第三形变量;并且,计算每一臂架总形变量,确定多关节机械臂末端形变量;基于各个关节臂根部的当前角度以及关节机械臂末端形变量,确定多关节机械臂的末端点坐标。本发明实现了通过对臂架末端的坐标进行准确定位,进而便于对多关节超长臂架的精确控制。
Description
技术领域
本发明涉及泵车技术领域,特别涉及一种多关节机械臂坐标校正方法和系统。
背景技术
多关节超长臂架属于非线性耦合系统,随着臂架长度的增长,其末端点的形变逐渐加大,多关节超长臂架之间彼此相互作用,应力、应变规律复杂,若不能解决超长臂架的形变问题,则臂架姿态无法得到真实反应,末端点坐标不能得到准确定位,对于多关节超长臂架的精确控制将无从谈起。
发明内容
有鉴于此,本发明提出一种多关节机械臂坐标校正方法和系统,以通过对臂架末端的坐标进行准确定位,实现对多关节超长臂架的精确控制。
第一方面,本发明公开了一种多关节机械臂坐标校正方法,包括如下步骤:初始参数输入步骤,接收多关节机械臂的初始参数,所述初始参数包括各节臂架的长度和质量;每一臂架总形变量计算步骤,基于所述初始参数,计算每一臂架之后的臂架对该臂架产生的第一形变量、该臂架自身载荷所产生的第二形变量,以及,该臂架之前的臂架对该臂架所产生的第三形变量;并且,计算每一臂架的总形变量,所述总形变量为所述第一形变量、所述第二形变量与所述第三形变量之和;臂架末端形变量计算步骤,基于每一臂架的总形变量,确定多关节机械臂末端形变量;坐标确定步骤,基于各个关节臂根部的当前角度以及关节机械臂末端形变量,确定多关节机械臂的末端点坐标。
进一步地,上述多关节机械臂坐标校正方法中,所述第一形变量通过如下步骤确定:第一挠度及转角确定步骤,根据各节臂架的质量,确定该臂架之后的所有臂架对该臂架所形成的集中作用力,所述集中作用力为该臂架之后所有臂架的重力之和;并且,依据所述集中作用力确定该臂架之后的所有臂架产生的第一挠度,以及由所述挠度产生的转角;第二挠度及转角确定步骤,根据各节臂架的质量和长度,以及臂架根部的转角,确定该臂架之后的所有臂架对该臂架的弯矩;并且,依据所述弯矩确定该臂架之后的所有臂架产生的第二挠度,以及由所述挠度产生的转角
进一步地,上述多关节机械臂坐标校正方法中,所述第二形变量通过如下步骤确定:根据该臂架本身的质量,确定该臂架的重力,并假设载荷均匀分布,基于该臂架的长度,确定由于该臂架自身的载荷所产生的第三挠度,以及由所述第三挠度产生的转角。
进一步地,上述多关节机械臂坐标校正方法中,所述第三形变量通过如下步骤确定:确定该臂架的前一臂架相对于该臂架的转角;依据该转角,确定由该臂架前一臂架的转动所产生的第四挠度;确定该臂架前一臂架相对于该臂架的平移,确定该平移对该臂架所产生的第五挠度。
进一步地,上述多关节机械臂坐标校正方法中,所述坐标确定步骤中,各个关节臂根部的当前角度由倾角传感器或编码器测得,所述倾角传感器或编码器设置于每节臂架的根部。
第二方面,本发明公开了一种多关节机械臂坐标校正装置,包括:初始参数输入模块、每一臂架总形变量计算模块、臂架末端形变量计算模块和坐标确定模块。其中,初始参数输入模块用于接收多关节机械臂的初始参数,所述初始参数包括各节臂架的长度和质量;每一臂架总形变量计算模块用于基于所述初始参数,计算每一臂架之后的臂架对该臂架产生的第一形变量、该臂架自身载荷所产生的第二形变量,以及,该臂架之前的臂架对该臂架所产生的第三形变量;并且,计算每一臂架的总形变量,所述总形变量为所述第一形变量、所述第二形变量与所述第三形变量之和;臂架末端形变量计算模块用于基于每一臂架的总形变量,确定多关节机械臂末端形变量;坐标确定模块用于基于各个关节臂根部的当前角度以及关节机械臂末端形变量,确定多关节机械臂的末端点坐标。
进一步地,上述多关节机械臂坐标校正装置中,所述每一臂架总形变量计算模块进一步包括:第一挠度及转角确定单元和第二挠度及转角确定单元。其中,第一挠度及转角确定单元用于根据各节臂架的质量,确定该臂架之后的所有臂架对该臂架所形成的集中作用力,所述集中作用力为该臂架之后所有臂架的重力之和;并且,依据所述集中作用力确定该臂架之后的所有臂架产生的第一挠度,以及由所述挠度产生的转角;第二挠度及转角确定单元用于根据各节臂架的质量和长度,以及臂架根部的转角,确定该臂架之后的所有臂架对该臂架的弯矩;并且,依据所述弯矩确定该臂架之后的所有臂架产生的第二挠度,以及由所述挠度产生的转角。
进一步地,上述多关节机械臂坐标校正装置中,所述每一臂架总形变量计算模块进一步包括第三挠度及转角确定单元,用于根据该臂架本身的质量,确定该臂架的重力,并假设载荷均匀分布,基于该臂架的长度,确定由于该臂架自身的载荷所产生的第三挠度,以及由所述第三挠度产生的转角。
进一步地,上述多关节机械臂坐标校正装置中,所述每一臂架总形变量计算模块进一步包括第四挠度及转角确定单元和第五挠度及转角确定单元。其中,第四挠度及转角确定单元,用于确定该臂架的前一臂架相对于该臂架的转角;依据该转角,确定由该臂架前一臂架的转动所产生的第四挠度;第五挠度及转角确定单元,用于确定该臂架前一臂架相对于该臂架的平移,确定该平移对该臂架所产生的第五挠度。
进一步地,上述多关节机械臂坐标校正装置中的所述坐标确定模块中,各个关节臂根部的当前角度由倾角传感器或编码器测得,所述倾角传感器或编码器设置于每节臂架的根部。
本发明基于如下原理:
第一、虽然,多关节机械臂之间相互耦合,关系复杂,但是,就某一节臂而言,不存在关节之间的作用关系,则相对简单。因此,可将多关节机械臂转化为标准的均匀简支梁,其形变的方向垂直于梁,形变的大小属于小形变。基于小形变理论,将复杂的多关节臂架分为若干段简支梁。
第二、多关节机械臂架相互之间铰接联接,臂架之间存在相互作用,利用等效理论,确定臂架与臂架的相互作用关系为:前面若干节臂架对本节臂架的平移及转动产生的形变、后面若干节臂架对本节臂架的弯曲及集中作用产生的形变、以及,本节臂架自身载荷作用产生的形变。
第三、采用多关节臂架分段叠加的思路分别求解超长臂架各节臂的形变,之后根据相互作用关系,求取总形变量。
具体实施时,只要输出多关节机械臂的初始参数,同时结合各个关节臂根部的当前角度即可准确确定臂架末端的坐标,因此,操作非常方便,适应性强。同时,由于将强耦合非线性问题分割转化为线性问题,且计算采用公式推导,可根据臂架载荷的不同,动态的计算形变大小,可靠性高。
附图说明
构成本发明的一部分的附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1为本发明多关节机械臂坐标校正方法的工作原理示意图;
图2为本发明多关节机械臂坐标校正方法的步骤流程图;
图3为本发明实施例中后面臂架对本节臂架集中作用力影响的示意图;
图4为本发明实施例中后面臂架对本节臂架弯矩影响的示意图;
图5为本发明实施例中本节臂架对自身弯矩影响的示意图;
图6为该节臂架前面臂架对本节臂架转动影响的示意图;
图7为该节臂架前面臂架对本节臂架平移影响的示意图;
图8A为本发明多关节机械臂坐标校正装置的工作原理图;
图8B为本发明多关节机械臂坐标校正装置与其他装置的相配合的工作原理示意图;
图9为本发明多关节机械臂坐标校正装置实施例的结构框图;
图10为本发明多关节机械臂坐标校正装置实施例中,每一臂架总形变量计算模块的结构框图。
具体实施方式
需要说明的是,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本发明。
本发明基于如下原理:
第一、虽然,多关节机械臂之间相互耦合,关系复杂,但是,就某一节臂而言,不存在关节之间的作用关系,则相对简单。因此,可将多关节机械臂转化为标准的均匀简支梁,其形变的方向垂直于梁,形变的大小属于小形变。基于小形变理论,将复杂的多关节臂架分为若干段简支梁。
第二、多关节机械臂架相互之间铰接联接,臂架之间存在相互作用,利用等效理论,确定臂架与臂架的相互作用关系为:前面若干节臂架对本节臂架的平移及转动产生的形变、后面若干节臂架对本节臂架的弯曲及集中作用产生的形变、以及,本节臂架自身载荷作用产生的形变。
第三、采用多关节臂架分段叠加的思路分别求解超长臂架各节臂的形变,之后根据相互作用关系,求取总形变量。
下面结合图1,对本发明多关节机械臂坐标校正方法的工作原理做进一步地说明。
首先,通过设置于各节臂架的位姿采集装置获得各节臂架根部的角度;
然后,确定多关节机械臂的基本参数,主要是每节臂架的质量m和长度l;
接着,将前述两步获得的结果,即各节臂架根部的角度、质量m和长度l输入到控制器中,控制器根据其中内置的算法,进行刚性机械臂坐标计算,以及坐标的校正计算,给出各节臂架的形变角、形变量及末端臂架的综合形变量,最终确定机械臂末端点的坐标值(X,Y,Z)。
对于本领域的技术人员而言,位姿采集装置获得各节臂架根部的角度对机械臂末端进行刚性坐标计算是本领域技术人员的所习知的,具体的方法不是本发明重点关注。而基于各节臂架的质量m和长度l进行坐标的校正计算,则是本发明的关键。即,内置于控制器中的算法是本发明所核心。
下面,结合图2,对本发明多关节机械臂坐标校正方法实施例的步骤流程图。本实施例包括如下步骤:
初始参数输入步骤S210,接收多关节机械臂的初始参数,初始参数包括各节臂架的长度和质量;
每一臂架总形变量计算步骤S220,基于初始参数,计算每一臂架之后的臂架对该臂架产生的第一形变量、该臂架自身载荷所产生的第二形变量,以及,该臂架之前的臂架对该臂架所产生的第三形变量;并且,计算每一臂架的总形变量,总形变量为第一形变量、第二形变量与第三形变量之和;
臂架末端形变量计算步骤S230,基于每一臂架的总形变量,确定多关节机械臂末端形变量;
坐标确定步骤S240,基于各个关节臂根部的当前角度以及关节机械臂末端形变量,确定多关节机械臂的末端点坐标。优选地,各个关节臂根部的当前角度由倾角传感器或编码器测得,所述倾角传感器或编码器设置于每节臂架的根部。
可以看出,本实施例提出了分段叠加求解超长臂架各节臂形变的方法。分段叠加求解即将多关节臂架分为若干节臂架,每节臂架基于小形变假设求解的方法。
每一节臂架都受到后面若干节臂架及前面若干节臂架的综合影响,本实施例将臂架的形变分解为前面若干节臂架对本节臂架的平移及转动形变、后面若干节臂架对本节臂架的弯曲及集中作用形变、本节臂架自身载荷作用形变。
下面,对这三种作用做进一步的说明。
(1)后面臂架对本节臂架的影响
参照图3,图3为后面臂架对本节臂架集中作用力影响的示意图。其中,F为本节臂架之后的所有臂架对该臂架所形成的集中作用力,集中作用力F的大小为该臂架之后所有臂架的重力之和,通过每节臂架的质量m即可获得。依据集中作用力F确定该臂架之后的所有臂架产生的第一挠度ωF,以及由所述挠度产生的转角θF。具体函数关系为:
参照图4,图4为后面臂架对本节臂架弯矩影响的示意图。其中,M为本节臂架之后的所有臂架对该臂架所形成的弯矩,弯矩M的大小为该臂架之后所有臂架的重力与力臂的乘积,通过每节臂架的质量m和长度l,以及每节臂架的当前角度即可获得。依据M确定该臂架之后的所有臂架产生由于弯矩M产生的第二挠度ωM,以及由挠度产生的转角θM。具体函数关系为:
(2)本节臂架自身载荷的影响
参照图5,图5为本节臂架对自身载荷影响的示意图。其中,q为均匀分布的载荷量大小。依据q确定该臂架由于自身载荷的产生的第三挠度ωq,以及由挠度产生的转角θq。具体函数关系为:
(3)前面臂架对本节臂架的影响
参照图6,图6为该节臂架前面臂架对本节臂架转动影响的示意图。其中,θ为前一臂架相对于本节臂架的转角。依据θ确定该臂架由于前面臂架的转动的产生的第四挠度ω转。具体函数关系为:
ω转=W3(l,θ)
参照图7,图7为该节臂架前面臂架对本节臂架平移影响的示意图。其中,W为前一臂架相对于本节臂架的平移。依据W确定该臂架由于前面臂架的平移产生的第五挠度ω平。具体函数关系为:
ω平=W4
因此,根据上述(1)、(2)和(3),确定:
对于非第一节臂和非末端节臂,每一节臂总形变量:
ω=ωq+ω平+ω转+ωM+ωF
对于第一节臂:
ω1=ωq+ωM+ωF
对于末端节臂,
ωn=ωq+ω平+ω转
因此:ωn=ωq+ω平+ω转
…………………………….
ω5=ωq+ω平+ω转+ωM+ωF
ω4=ωq+ω平+ω转+ωM+ωF
ω3=ωq+ω平+ω转+ωM+ωF
ω2=ωq+ω平+ω转+ωM+ωF
ω1=ωq+ωM+ωF
根据上述算式,可以确定,末端臂架总形变:
ω末端=ω1+ω2+ω3+ω4+ω5+ω6+....+ωn
因此,可以看出,本实施例只要输出多关节机械臂的初始参数,同时结合各个关节臂根部的当前角度即可准确确定臂架末端的坐标,因此,操作非常方便,适应性强。同时,由于将强耦合非线性问题分割转化为线性问题,且计算采用公式推导,可根据臂架载荷的不同,动态的计算形变大小,可靠性高。
第二方面,本发明还公开了一种多关节机械臂坐标校正装置。
参照图8A和图8B,示出了本发明多关节机械臂坐标校正装置的工作原理。即根据各节臂架的初始参数(质量和长度等)及根部角度,进行形变计算,然后获得臂架末端点的坐标。
参照图9,多关节机械臂坐标校正装置包括:初始参数输入模块9A、每一臂架总形变量计算模块9B、臂架末端形变量计算模块9C和坐标确定模块9D。
其中,初始参数输入模块9A用于接收多关节机械臂的初始参数,初始参数包括各节臂架的长度和质量;每一臂架总形变量计算模块9B用于基于初始参数,计算每一臂架之后的臂架对该臂架产生的第一形变量、该臂架自身载荷所产生的第二形变量,以及,该臂架之前的臂架对该臂架所产生的第三形变量;并且,计算每一臂架的总形变量,总形变量为第一形变量、第二形变量与第三形变量之和;臂架末端形变量计算模块9C用于基于每一臂架的总形变量,确定多关节机械臂末端形变量;坐标确定模块9D用于基于各个关节臂根部的当前角度以及关节机械臂末端形变量,确定多关节机械臂的末端点坐标。
进一步优选地,多关节机械臂坐标校正装置中,参照图10,每一臂架总形变量计算模块9B进一步包括第一挠度及转角确定单元B1、第二挠度及转角确定单元B2、第三挠度及转角确定单元B3、第四挠度及转角确定单元B4及第五挠度及转角确定单元B5。其中:
第一挠度及转角确定单元B1和第二挠度及转角确定单元B2用于计算由于某节臂架后面的臂架的存在对该臂架所产生的形变量。第三挠度及转角确定单元B3用于计算由于本身载荷所导致的本节臂架的形变量。第四挠度及转角确定单元B4和第五挠度及转角确定单元B5用于计算由于前面臂架的存在所导致的本节臂架的形变量。
具体而言,第一挠度及转角确定单元B1用于根据各节臂架的质量,确定该臂架之后的所有臂架对该臂架所形成的集中作用力,集中作用力为该臂架之后所有臂架的重力之和;并且,依据集中作用力确定该臂架之后的所有臂架产生的第一挠度,以及由挠度产生的转角。参照图3。
第二挠度及转角确定单元B2用于根据各节臂架的质量和长度,确定该臂架之后的所有臂架对该臂架的弯矩;并且,依据弯矩确定该臂架之后的所有臂架产生的第二挠度,以及由挠度产生的转角。参照图4。
第三挠度及转角确定单元B3用于根据该臂架本身的质量,确定该臂架的重力,并假设载荷均匀分布,基于该臂架的长度,确定由于该臂架自身的载荷所产生的第三挠度,以及由第三挠度产生的转角。参照图5。
第四挠度及转角确定单元B4用于确定该臂架的前一臂架相对于该臂架的转角;依据该转角,确定由该臂架前一臂架的转动所产生的第四挠度。参照图6。
第五挠度及转角确定单元B5用于确定该臂架前一臂架相对于该臂架的平移,确定该平移对该臂架所产生的第五挠度。参照图7。
并且,上述坐标确定模块9D中,各个关节臂根部的当前角度由倾角传感器或编码器测得,倾角传感器或编码器设置于每节臂架的根部。
本发明基于如下原理:
第一、虽然,多关节机械臂之间相互耦合,关系复杂,但是,就某一节臂而言,不存在关节之间的作用关系,则相对简单。因此,可将多关节机械臂转化为标准的均匀简支梁,其形变的方向垂直于梁,形变的大小属于小形变。基于小形变理论,将复杂的多关节臂架分为若干段简支梁。
第二、多关节机械臂架相互之间铰接联接,臂架之间存在相互作用,利用等效理论,确定臂架与臂架的相互作用关系为:前面若干节臂架对本节臂架的平移及转动产生的形变、后面若干节臂架对本节臂架的弯曲及集中作用产生的形变、以及,本节臂架自身载荷作用产生的形变。
第三、采用多关节臂架分段叠加的思路分别求解超长臂架各节臂的形变,之后根据相互作用关系,求取总形变量。
具体实施时,只要输出多关节机械臂的初始参数,同时结合各个关节臂根部的当前角度即可准确确定臂架末端的坐标,因此,操作非常方便,适应性强。同时,由于将强耦合非线性问题分割转化为线性问题,且计算采用公式推导,可根据臂架载荷的不同,动态的计算形变大小,可靠性高。
需要说明的是,本发明多关节机械臂坐标校正装置的原理与上述多关节机械臂坐标校正方法相似。相关之处可以互相参照。本发明在此不再赘述。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种多关节机械臂坐标校正方法,其特征在于,包括如下步骤:
初始参数输入步骤,接收多关节机械臂的初始参数,所述初始参数包括各节臂架的长度和质量;
每一臂架总形变量计算步骤,基于所述初始参数,计算每一臂架之后的臂架对该臂架产生的第一形变量、该臂架自身载荷所产生的第二形变量,以及,该臂架之前的臂架对该臂架所产生的第三形变量;并且,计算每一臂架的总形变量,所述总形变量为所述第一形变量、所述第二形变量与所述第三形变量之和;
臂架末端形变量计算步骤,基于每一臂架的总形变量,确定多关节机械臂末端形变量;
坐标确定步骤,基于各个关节臂根部的当前角度以及关节机械臂末端形变量,确定多关节机械臂的末端点坐标。
2.根据权利要求1所述的多关节机械臂坐标校正方法,其特征在于,
所述第一形变量通过如下步骤确定:
第一挠度及转角确定步骤,根据各节臂架的质量,确定该臂架之后的所有臂架对该臂架所形成的集中作用力,所述集中作用力为该臂架之后所有臂架的重力之和;并且,依据所述集中作用力确定该臂架之后的所有臂架产生的第一挠度,以及由所述挠度产生的转角;
第二挠度及转角确定步骤,根据各节臂架的质量和长度,以及臂架根部的转角,确定该臂架之后的所有臂架对该臂架的弯矩;并且,依据所述弯矩确定该臂架之后的所有臂架产生的第二挠度,以及由所述挠度产生的转角。
3.根据权利要求1所述的多关节机械臂坐标校正方法,其特征在于,
所述第二形变量通过如下步骤确定:
根据该臂架本身的质量,确定该臂架的重力,并假设载荷均匀分布,基于该臂架的长度,确定由于该臂架自身的载荷所产生的第三挠度,以及由所述第三挠度产生的转角。
4.根据权利要求1所述的多关节机械臂坐标校正方法,其特征在于,
所述第三形变量通过如下步骤确定:
确定该臂架的前一臂架相对于该臂架的转角;依据该转角,确定由该臂架前一臂架的转动所产生的第四挠度;
确定该臂架前一臂架相对于该臂架的平移,确定该平移对该臂架所产生的第五挠度。
5.根据权利要求1至4中任一项所述的多关节机械臂坐标校正方法,其特征在于,
所述坐标确定步骤中,各个关节臂根部的当前角度由倾角传感器或编码器测得,所述倾角传感器或编码器设置于每节臂架的根部。
6.一种多关节机械臂坐标校正装置,其特征在于,包括:
初始参数输入模块,用于接收多关节机械臂的初始参数,所述初始参数包括各节臂架的长度和质量;
每一臂架总形变量计算模块,用于基于所述初始参数,计算每一臂架之后的臂架对该臂架产生的第一形变量、该臂架自身载荷所产生的第二形变量,以及,该臂架之前的臂架对该臂架所产生的第三形变量;并且,计算每一臂架的总形变量,所述总形变量为所述第一形变量、所述第二形变量与所述第三形变量之和;
臂架末端形变量计算模块,用于基于每一臂架的总形变量,确定多关节机械臂末端形变量;
坐标确定模块,用于基于各个关节臂根部的当前角度以及关节机械臂末端形变量,确定多关节机械臂的末端点坐标。
7.根据权利要求6所述的多关节机械臂坐标校正装置,其特征在于,
所述每一臂架总形变量计算模块进一步包括:
第一挠度及转角确定单元,用于根据各节臂架的质量,确定该臂架之后的所有臂架对该臂架所形成的集中作用力,所述集中作用力为该臂架之后所有臂架的重力之和;并且,依据所述集中作用力确定该臂架之后的所有臂架产生的第一挠度,以及由所述挠度产生的转角;
第二挠度及转角确定单元,用于根据各节臂架的质量和长度,以及臂架根部的转角,确定该臂架之后的所有臂架对该臂架的弯矩;并且,依据所述弯矩确定该臂架之后的所有臂架产生的第二挠度,以及由所述挠度产生的转角。
8.根据权利要求6所述的多关节机械臂坐标校正装置,其特征在于,
所述每一臂架总形变量计算模块进一步包括:
第三挠度及转角确定单元,用于根据该臂架本身的质量,确定该臂架的重力,并假设载荷均匀分布,基于该臂架的长度,确定由于该臂架自身的载荷所产生的第三挠度,以及由所述第三挠度产生的转角。
9.根据权利要求6所述的多关节机械臂坐标校正装置,其特征在于,
所述每一臂架总形变量计算模块进一步包括:
第四挠度及转角确定单元,用于确定该臂架的前一臂架相对于该臂架的转角;依据该转角,确定由该臂架前一臂架的转动所产生的第四挠度;
第五挠度及转角确定单元,用于确定该臂架前一臂架相对于该臂架的平移,确定该平移对该臂架所产生的第五挠度。
10.根据权利要求6至9中任一项所述的多关节机械臂坐标校正装置,其特征在于,
所述坐标确定模块中,各个关节臂根部的当前角度由倾角传感器或编码器测得,所述倾角传感器或编码器设置于每节臂架的根部。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410057866.6A CN103862465B (zh) | 2014-02-20 | 2014-02-20 | 多关节机械臂坐标校正方法和装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410057866.6A CN103862465B (zh) | 2014-02-20 | 2014-02-20 | 多关节机械臂坐标校正方法和装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103862465A true CN103862465A (zh) | 2014-06-18 |
CN103862465B CN103862465B (zh) | 2016-12-07 |
Family
ID=50901789
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410057866.6A Active CN103862465B (zh) | 2014-02-20 | 2014-02-20 | 多关节机械臂坐标校正方法和装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103862465B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105643642A (zh) * | 2014-12-02 | 2016-06-08 | 宁夏巨能机器人系统有限公司 | 一种机器臂的定位方法 |
CN106671080A (zh) * | 2015-11-05 | 2017-05-17 | 财团法人工业技术研究院 | 校正方法与校正设备 |
CN112512758A (zh) * | 2018-05-11 | 2021-03-16 | 川崎重工业株式会社 | 挠曲量推断装置、机器人控制装置以及挠曲量推断方法 |
CN114112358A (zh) * | 2021-11-23 | 2022-03-01 | 武汉中科医疗科技工业技术研究院有限公司 | 机械臂的刚度测量方法和刚度测量系统 |
CN114227638A (zh) * | 2021-11-29 | 2022-03-25 | 中山大学 | 一种机器人操作杆和机器人的主从映射方法及校正方法 |
CN114562111A (zh) * | 2022-02-14 | 2022-05-31 | 三一汽车制造有限公司 | 臂架位置确定方法、装置、设备及作业机械 |
CN115416018A (zh) * | 2022-08-17 | 2022-12-02 | 雅客智慧(北京)科技有限公司 | 末端执行器形变补偿方法、装置、电子设备和存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE3907134A1 (de) * | 1989-03-06 | 1990-09-13 | Marco Systemanalyse Entw | Verfahren und vorrichtung zur lagebestimmung eines an dem freien ende des mehrgelenkigen auslegers angeordneten werkzeuges |
DE10240180A1 (de) * | 2002-08-27 | 2004-03-11 | Putzmeister Ag | Vorrichtung zur Betätigung eines Knickmasts |
CN101561832A (zh) * | 2009-05-21 | 2009-10-21 | 南京工业大学 | 一种塔式起重机臂架结构变形和应力的测算方法 |
CN102345390A (zh) * | 2011-07-21 | 2012-02-08 | 徐工集团工程机械股份有限公司江苏徐州工程机械研究院 | 一种混凝土泵车臂架变形量的补偿方法 |
CN103206090A (zh) * | 2012-12-27 | 2013-07-17 | 徐工集团工程机械股份有限公司江苏徐州工程机械研究院 | 一种混凝土泵车智能臂架控制及其变形补偿的方法 |
-
2014
- 2014-02-20 CN CN201410057866.6A patent/CN103862465B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE3907134A1 (de) * | 1989-03-06 | 1990-09-13 | Marco Systemanalyse Entw | Verfahren und vorrichtung zur lagebestimmung eines an dem freien ende des mehrgelenkigen auslegers angeordneten werkzeuges |
DE10240180A1 (de) * | 2002-08-27 | 2004-03-11 | Putzmeister Ag | Vorrichtung zur Betätigung eines Knickmasts |
CN101561832A (zh) * | 2009-05-21 | 2009-10-21 | 南京工业大学 | 一种塔式起重机臂架结构变形和应力的测算方法 |
CN102345390A (zh) * | 2011-07-21 | 2012-02-08 | 徐工集团工程机械股份有限公司江苏徐州工程机械研究院 | 一种混凝土泵车臂架变形量的补偿方法 |
CN103206090A (zh) * | 2012-12-27 | 2013-07-17 | 徐工集团工程机械股份有限公司江苏徐州工程机械研究院 | 一种混凝土泵车智能臂架控制及其变形补偿的方法 |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105643642A (zh) * | 2014-12-02 | 2016-06-08 | 宁夏巨能机器人系统有限公司 | 一种机器臂的定位方法 |
CN106671080A (zh) * | 2015-11-05 | 2017-05-17 | 财团法人工业技术研究院 | 校正方法与校正设备 |
CN112512758A (zh) * | 2018-05-11 | 2021-03-16 | 川崎重工业株式会社 | 挠曲量推断装置、机器人控制装置以及挠曲量推断方法 |
CN112512758B (zh) * | 2018-05-11 | 2023-06-23 | 川崎重工业株式会社 | 挠曲量推断装置、机器人控制装置以及挠曲量推断方法 |
CN114112358A (zh) * | 2021-11-23 | 2022-03-01 | 武汉中科医疗科技工业技术研究院有限公司 | 机械臂的刚度测量方法和刚度测量系统 |
CN114112358B (zh) * | 2021-11-23 | 2023-12-26 | 武汉中科医疗科技工业技术研究院有限公司 | 机械臂的刚度测量方法和刚度测量系统 |
CN114227638A (zh) * | 2021-11-29 | 2022-03-25 | 中山大学 | 一种机器人操作杆和机器人的主从映射方法及校正方法 |
CN114227638B (zh) * | 2021-11-29 | 2023-11-28 | 广州市微眸医疗器械有限公司 | 一种机器人操作杆和机器人的主从映射方法及校正方法 |
CN114562111A (zh) * | 2022-02-14 | 2022-05-31 | 三一汽车制造有限公司 | 臂架位置确定方法、装置、设备及作业机械 |
CN114562111B (zh) * | 2022-02-14 | 2023-09-08 | 三一汽车制造有限公司 | 臂架位置确定方法、装置、设备及作业机械 |
CN115416018A (zh) * | 2022-08-17 | 2022-12-02 | 雅客智慧(北京)科技有限公司 | 末端执行器形变补偿方法、装置、电子设备和存储介质 |
CN115416018B (zh) * | 2022-08-17 | 2024-03-15 | 雅客智慧(北京)科技有限公司 | 末端执行器形变补偿方法、装置、电子设备和存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN103862465B (zh) | 2016-12-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103862465A (zh) | 多关节机械臂坐标校正方法和系统 | |
CN104932506B (zh) | 基于快速终端滑模的轮式移动机器人轨迹跟踪方法 | |
CN105643641B (zh) | 力传感器标定装置、标定方法及力控制机器人 | |
CN104390612A (zh) | 用于Stewart平台构型的六自由度并联机器人基准位姿标定方法 | |
CN101804627A (zh) | 一种冗余度机械臂运动规划方法 | |
CN102189550A (zh) | 具有学习控制功能的机器人 | |
CN104070525B (zh) | 用于空间机械臂连续轨迹跟踪的方法 | |
CN105353725A (zh) | 用于工业机器人的过辅助点姿态空间圆弧插补方法 | |
CN106774350A (zh) | 双红外精确校准机器人与充电平台对接角度的机器人 | |
CN108204879B (zh) | 一种转动惯量的光学测量方法及系统 | |
CN107817682A (zh) | 一种基于手眼相机的空间机械臂在轨标定方法及系统 | |
EP2377653A1 (en) | Method and system for controlling large-scale engineering manipulator | |
CN105598984B (zh) | 一种冗余度机械臂加速度层运动规划的初始化方法 | |
US20200073395A1 (en) | Robot and method and apparatus of controlling movement of transport robot | |
CN114523477B (zh) | 关节位姿的校准方法、系统及存储介质 | |
CN103792956B (zh) | 智能臂空间运动控制方法及装置 | |
CN104260095A (zh) | 一种医疗机械臂的控制方法及装置 | |
CN105856231A (zh) | 一种特定构型六轴工业机器人的运动控制方法 | |
CN102252126B (zh) | 电液角位移伺服系统中伺服对象参数识别方法 | |
CN111547176B (zh) | 自平衡机器人控制方法、系统、自平衡机器人及介质 | |
CN103806665B (zh) | 泵车智能臂弹性形变的矫正方法及装置 | |
CN106444382A (zh) | 一种保证物理可行性的串联机器人动力学参数辨识方法 | |
CN101870104B (zh) | 机械手臂反向运动方法 | |
CN104270046A (zh) | 一种基于转速-电流二维模糊模型自学习的电机控制方法 | |
CN109571478B (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 |