CN113580142B - 基于旋量理论的机器人无冗余几何误差模型解析建模方法 - Google Patents
基于旋量理论的机器人无冗余几何误差模型解析建模方法 Download PDFInfo
- Publication number
- CN113580142B CN113580142B CN202110958529.4A CN202110958529A CN113580142B CN 113580142 B CN113580142 B CN 113580142B CN 202110958529 A CN202110958529 A CN 202110958529A CN 113580142 B CN113580142 B CN 113580142B
- Authority
- CN
- China
- Prior art keywords
- error
- geometric error
- establishing
- rotation
- chain
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 39
- 239000013598 vector Substances 0.000 claims description 48
- 239000011159 matrix material Substances 0.000 claims description 41
- 238000013507 mapping Methods 0.000 claims description 27
- 238000006073 displacement reaction Methods 0.000 claims description 21
- 230000009977 dual effect Effects 0.000 claims description 5
- 125000003275 alpha amino acid group Chemical group 0.000 claims description 4
- 150000001875 compounds Chemical class 0.000 claims description 4
- 238000013519 translation Methods 0.000 claims description 4
- 238000013138 pruning Methods 0.000 claims description 2
- 238000004804 winding Methods 0.000 claims description 2
- 238000013461 design Methods 0.000 abstract description 11
- 230000007246 mechanism Effects 0.000 description 12
- 238000010586 diagram Methods 0.000 description 6
- 238000010276 construction Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000012217 deletion Methods 0.000 description 1
- 230000037430 deletion Effects 0.000 description 1
- 230000002401 inhibitory effect Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 238000011426 transformation method Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1605—Simulation of manipulator lay-out, design, modelling of manipulator
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种基于旋量理论的机器人无冗余几何误差模型解析建模方法,包括:步骤一、建立串联支链全参数几何误差模型;步骤二、建立并联运动链全参数几何误差模型;步骤三、删减并联运动链中冗余几何误差参数,求解并联运动链最大可辨识几何误差参数的数目。本发明方法不仅适用并联构型机器人几何误差建模,同样适用于串并混联构型机器人几何误差建模,而且适用于任意构型机器人几何误差建模。本发明所建立的模型既无冗余误差参数,又可显式获取各类型机器人运动链中所有具有明确物理意义的相互独立的几何误差参数,还可同时指导机器人的精度设计和运动学标定工作。
Description
技术领域
本发明属于机器人领域,尤其涉及一种并联构型机器人以及其他机械装备的误差建模方法。
背景技术
目前,提升机器人精度的技术手段主要有两类:一是通过精度设计保证机器人的基础制造精度,二是通过运动学标定进一步提升机器人末端位姿精度。不论是精度设计还是运动学标定,都需要建立机器人无冗余几何误差模型。几何误差是机器人以及其他机械装备末端精度的重要影响因素,通过抑制几何误差源对末端位姿误差的影响可以有效提高***的精度性能。几何误差建模旨在建立机器人末端位姿误差与各关节几何误差之间的线性映射关系,为精度设计和运动学标定等精度保障手续提供必要的数学模型。现有的机器人几何误差建模方法包括矢量法、D-H法、齐次坐标变换法、旋量法、指数积方法、CPC法等,但存在两类局限性:现有建模方法无法有效处理机构运动空间与力空间的子空间之间的正交对偶关系,故难于采用解析手段获得无冗余几何误差模型,故所建模型不能直接用于机器人精度设计与运动学标定;在采用数值方法删减模型中的冗余误差参数时,可能会错误删减机器人驱动关节运动误差参数,并且删减后的模型往往失去了明确的物理意义,故无法用于机器人的精度设计与运动学标定工作。因此,建立一种既无冗余误差参数,又可显式获取机器人运动链中所有具有明确物理意义的相互独立的几何误差参数及其对末端位姿误差的线性映射规律,还可同时为机器人精度设计与运动学标定提供理论模型的机器人无冗余几何误差建模方法,是亟待解决的关键技术问题。
发明内容
针对上述现有技术,本发明提出一种既无冗余误差参数,又可显式获取机器人运动链中所有具有明确物理意义的相互独立的几何误差参数及其对末端位姿误差的线性映射规律,还可同时为机器人精度设计与运动学标定提供理论模型的基于旋量理论的机器人无冗余几何误差模型解析建模方法。
为了解决上述技术问题,本发明提出的一种基于旋量理论的机器人无冗余几何误差模型解析建模方法,步骤如下:
步骤一、建立n自由度串联运动链全参数几何误差模型,包括
步骤1-1)建立由n个单自由度关节和n+1个构件组成的n自由度串联运动链的坐标***,1≤n≤6;在机器人的机架上建立机架参考系{R0};在连架关节处建立连体参考系{R1};在第j个连杆的远架关节处建立连体系{Rj+1},j=1,2,…,n-1;在末端构件上建立工具参考系{Rn+1};建立原点与所述连体系{Rn+1}原点重合且方向与所述机架参考系{R0}一致的随动参考系{R′0};
步骤1-2)建立相邻坐标系间平动、转动误差矢量与末端构件参考点的位置误差、末端构件的姿态误差之间的全参数几何误差映射模型;其中:
相邻构件间相对位置误差、相对姿态误差,分别表示为:
jδrj+1/j=(jδxj+1 jδyj+1 jδzj+1)T (1)
jδθj+1/j=(jδαj+1 jδβj+1 jδγj+1)T (2)
式(1)和式(2)中,jδθj+1/j和jδrj+1/j分别为连体系{Rj+1}相对连体系{Rj}的转动和平动误差矢量在连体系{Rj}中的度量;jδxj+1、jδyj+1和jδzj+1分别为连体系{Rj+1}沿着连体系{Rj}中xj、yj和zj轴的平动误差;jδαj+1、jδβj+1和jδγj+1分别为连体系{Rj+1}绕着连体系{Rj}中xj、yj和zj轴转动误差;
末端构件参考点的位置误差、末端构件的姿态误差,分别表示为:
式(3)和式(4)中,0'pj/n+1为随动参考系{R′0}原点指向连体系{Rj}原点的位置矢量在随动参考系{R′0}中的度量;0'Rj为连体系{Rj}相对随动参考系{R′0}的姿态矩阵;
所述的全参数几何误差映射模型,表示为:
式(5)中:
式(5)至式(8)中,$t为末端位姿误差旋量;δξj为关节j的运动误差;δζj为相邻连体系{Rj}和{Rj+1}间的几何误差向量;为关节j的单位许动微小位移旋量;/>为连体系{Rj}关于随动参考系{R′0}的伴随变换矩阵;0′uj、0′vj和0′wj分别为连体系{Rj}中xj、yj和zj轴的单位矢量;
步骤二、建立并联运动链全参数几何误差模型,包括:
步骤2-1)建立串联支链全参数几何误差模型:
对于自由度为f≤6,含l条支链的并联运动链建立机架参考系{R0},建立第i条支链第j个关节的连体参考系{Rj,i},建立动平台参考系{Rt},建立随动参考系{R′0},使得随动参考系{R′0}的原点与动平台参考系{Rt}原点重合,所述的随动参考系{R′0}与机架参考系{R0}的各轴方向保持一致,建立支链i的全参数几何误差模型:
式(9)中,
式(9)至是(11)中,$t为末端位姿误差旋量;δξj,i和分别为支链i中关节j的运动误差和单位微小位移旋量;δξi为支链i的运动误差向量;/>为连体参考系{Rj,i}相对随动参考系{R′0}的伴随变换矩阵;Cj,i和δηj,i分别为支链i中关节j的运动误差映射矩阵和结构误差向量;δηi为支链i的结构误差参数向量;
步骤2-2)建立并联运动链全参数几何误差模型:
构造驱动力子空间矩阵Wa以及约束力子空间矩阵Wc:
式(13)和式(14)中,Wc,i为约束力子空间的基矩阵,i=1,2,…,l;为第k条支链中编号为gk的驱动关节的单位驱动力旋量,所述的第k条支链由nk个单自由度关节组成,k=1,2,…,f;gk=1,2,…,nk;/>为第i条支链的第gi个单位约束力旋量,i=1,2,…,l;gi=1,2,…,6-ni;
通过对式(9)两端分别左乘和/>分别建立并联运动链在许动与约束方向的几何误差映射关系:
式(14)和式(15)中,
式(14)至式(17)中,$t为末端位姿误差旋量;δξa为并联运动链运动误差向量;δηa为并联运动链主动支链结构误差向量;δηf+1为并联运动链恰约束从动支链结构误差向量;δηc为并联运动链结构误差向量;Wa,k为驱动力子空间的基矩阵,k=1,2,…,f;Ak为与Wa,k对应的许动微小位移旋量矩阵;为并联运动链中第k条支链沿/绕编号为gk的驱动关节运动方向的单位微小位移旋量;Ai为与Wc,i对应的受限微小位移旋量矩阵;
利用G-K公式以及力旋量和微小位移旋量空间为对偶空间的基本性质,建立并联运动链全参数几何误差模型:
$t=Taδξa+W-TGδη (18)
式(18)中,
式(18)至式(20)中,δη为并联运动链结构误差向量;Gc,1和Gc,2分别为与δηa和δηf+1对应的误差映射矩阵;
步骤三、删减步骤二得到的并联运动链全参数几何误差模型中冗余几何误差参数,求解该构型运动链最大可辨识几何误差参数的数目
基于两项冗余几何误差参数删减原则,从所述并联运动链全参数几何误差模型中删减并联运动链中所有被动关节的运动误差参数以及这些误差参数在映射矩阵W-TG中的对应列,得到并联运动链无冗余几何误差模型;
所述两项冗余几何误差参数删减原则包括:
原则1,支链k的驱动力旋量与该链中被动关节的许动微小位移旋量/>正交j=1,2,…,nk;j≠gk;
原则2,支链i的约束力旋量与该链中所有关节的许动微小位移旋量/>正交j=1,2,…,ni;
求解自由度为f的并联运动链中最大可辨识几何误差参数数量N:
或者/>
式(21)中,nr,i和np,i分别为支链i中转动关节和移动关节的数量;nr和np分别为并联运动链中转动关节和移动关节的数量。
机器人构型通常包括串联、并联和混联,上述实施例为混联机器人,混联机器人由串联和并联两部分组合而成,本发明提出的建模方法适用于串联或是并联构型的机器人几何误差建模。
与现有技术相比,本发明的有益效果是:
克服现有的机器人几何误差建模方法中存在的两种局限性:第一,现有建模方法无法有效处理机构运动空间与力空间的子空间之间的正交对偶关系,故难于采用解析手段获得无冗余几何误差模型,故所建模型不能直接用于机器人精度设计与运动学标定;第二,在采用数值方法删减模型中的冗余误差参数时,可能会错误删减机器人驱动关节运动误差参数,并且删减后的模型往往失去了明确的物理意义,故无法用于机器人的精度设计与运动学标定工作。本发明所述的基于旋量理论的机器人无冗余几何误差模型解析建模方法与现有方法相比,误差模型中不存在冗余误差参数,可显式获取机器人运动链中所有具有明确物理意义的相互独立的几何误差参数及其对末端位姿误差的线性映射规律,建模流程简明、清晰、易于编程实现,所建模型可同时用于指导机器人精度设计与运动学标定。
附图说明
图1为串联运动链坐标***示意图;
图2为并联运动链坐标***示意图;
图3为五自由度混联构型装备的一个方向的结构示意图;
图4为五自由度混联构型装备的另一个方向的结构示意图;
图5为五自由度混联联构型装备的结构简图与坐标***示意图。
图中,11-第一固定轴座,12-第一转动支架,13-第一长度调节装置,23-第二长度调节装置,24-第二铰链,33-第三长度调节装置,34-第三铰链,41-第二固定轴座,42-第二转动支架,43-第四长度调节装置,44-第四铰链,5-动平台,6-串联转头。
具体实施方式
下面结合附图及具体实施例对本发明做进一步的说明,但下述实施例绝非对本发明有任何限制。
本发明提出了一种基于旋量理论的机器人无冗余几何误差模型解析建模方法,该方法主要包括:建立串联支链全参数几何误差模型;建立并联运动链全参数几何误差模型;删减并联运动链中冗余几何误差参数,求解并联运动链最大可辨识几何误差参数的数目。本发明方法不仅适用并联构型机器人几何误差建模,同样适用于串并混联构型机器人几何误差建模,而且适用于任意构型机器人几何误差建模。
一、建立n自由度串联运动链全参数几何误差模型,步骤如下:
1)建立由n个单自由度关节和n+1个构件组成的n(1≤n≤6)自由度串联运动链的坐标***,如图1所示。在机架上建立机架参考系{R0};在连架关节处建立连体参考系{R1};在第j个连杆的远架关节处建立连体系{Rj+1}(j=1,2,…,n-1);在末端构件上建立工具参考系{Rn+1};建立原点与系{Rn+1}原点重合且方向与系{R0}一致的随动参考系{R′0}。
2)建立相邻坐标系间平动、转动误差矢量与末端构件参考点的位置误差、末端构件的姿态误差之间的全参数几何误差映射模型。其中:
所述相邻构件间相对位置误差、相对姿态误差,分别表示为:
jδrj+1/j=(jδxj+1 jδyj+1 jδzj+1)T
jδθj+1/j=(jδαj+1 jδβj+1 jδγj+1)T
其中,jδθj+1/j和jδrj+1/j分别为系{Rj+1}相对系{Rj}的转动和平动误差矢量在系{Rj}中的度量,jδxj+1、jδyj+1和jδzj+1分别为系{Rj+1}沿着系{Rj}中xj、yj和zj轴的平动误差,jδαj+1、jδβj+1和jδγj+1分别为系{Rj+1}绕着系{Rj}中xj、yj和zj轴转动误差。
所述末端构件参考点的位置误差、末端构件的姿态误差,分别表示为:
其中,0'pj/n+1为系{R′0}原点指向系{Rj}原点的位置矢量在系{R′0}中的度量,0'Rj为系{Rj}相对系{R′0}的姿态矩阵。
所述全参数几何误差映射模型,表示为:
式中
其中,$t为末端位姿误差(指末端构建的位置误差和姿态误差)旋量;δξj为关节j的运动误差;δζj为相邻连体参考系{Rj}和{Rj+1}间的几何误差向量;为关节j的单位许动微小位移旋量;/>为系{Rj}关于系{R′0}的伴随变换矩阵;0′uj、0′vj和0′wj分别为系{Rj}
中xj、yj和zj轴的单位矢量。
二、建立并联运动链全参数几何误差模型,步骤如下:
1)建立串联支链全参数几何误差模型。
对于自由度为f≤6,含l条支链的并联运动链。建立机架参考系{R0},建立第i条支链第j个关节的连体参考系{Rj,i},建立动平台参考系{Rt},建立随动参考系{R′0},使得系{R′0}的原点与系{Rt}原点重合,而系{R′0}与系{R0}的各轴方向保持一致,如图2所示。建立支链i的全参数几何误差模型:
式中
其中,$t为末端位姿误差旋量;δξj,i和分别为支链i中关节j的运动误差和单位微小位移旋量;δξi为支链i的运动误差向量;/>为系{Rj,i}相对系{R′0}的伴随变换矩阵;Cj,i和δηj,i分别为支链i中关节j的运动误差映射矩阵和结构误差向量;δηi为支链i的结构误差参数向量。
2)建立并联运动链全参数几何误差模型。
构造驱动力子空间矩阵Wa以及约束力子空间矩阵Wc:
式中,Wc,i为约束力子空间的基矩阵(i=1,2,…,l);为第k(k=1,2,…,f)条支链(由nk个单自由度关节组成)中编号为gk(gk=1,2,…,nk)的驱动关节的单位驱动力旋量;/>为第i(i=1,2,…,l)条支链的第gi个(gi=1,2,…,6-ni)单位约束力旋量。
通过对支链全参数几何误差模型两端分别左乘和/>分别建立并联运动链在许动与约束方向的几何误差映射关系:
式中
其中,$t为末端位姿误差旋量;δξa为并联运动链运动误差向量;δηa为并联运动链主动支链结构误差向量;δηf+1为并联运动链恰约束从动支链结构误差向量;δηc为并联运动链结构误差向量;Wa,k为驱动力子空间的基矩阵(k=1,2,…,f);Ak为与Wa,k对应的许动微小位移旋量矩阵;为并联运动链中第k条支链沿/绕驱动关节(编号为gk)运动方向的单位微小位移旋量;Ai为与Wc,i对应的受限微小位移旋量矩阵。
利用G-K公式以及力旋量和微小位移旋量空间为对偶空间的基本性质,建立并联运动链全参数几何误差模型:
$t=Taδξa+W-TGδη
式中
其中,δη为并联运动链结构误差向量;Gc,1和Gc,2分别为与δηa和δηf+1对应的误差映射矩阵。
三、删减并联运动链中冗余几何误差参数,求解并联运动链最大可辨识几何误差参数的数目。
基于两项冗余几何误差参数删减原则,从所述并联运动链全参数几何误差模型中删减并联运动链中所有被动关节的运动误差参数以及这些误差参数在映射矩阵W-TG中的对应列,得到并联运动链无冗余几何误差模型。所述两项冗余几何误差参数删减原则分别为:原则1,支链k的驱动力旋量与该链中被动关节的许动微小位移旋量/>(j=1,2,…,nk,j≠gk)正交;原则2,支链i的约束力旋量/>与该链中所有关节的许动微小位移旋量/>正交。
求解自由度为f的并联运动链中最大可辨识几何误差参数数量N:
或者/>
其中,nr,i和np,i分别为支链i中转动关节和移动关节的数量;nr和np分别为并联运动链中转动关节和移动关节的数量。
实施例:利用本发明建模方法,针对公开号为CN104985596A的专利文献中公开的一种含转动支架的五自由度混联构型装备的无冗余几何误差模型的解析建模。
(1)所述的五自由度混联联构型装备的结构,如图3和图4所示,该五自由度混联联构型装备由具有一个平动和二个转动的三自由度并联机构和与之串接的具有两个转动自由度的转头组成,转头6与动平台5串接。所述的串接在动平台5末端的串联转头6为二自由度A/C摆头。所述的三自由度并联机构包括第一长度调节装置13、第二长度调节装置23、第三长度调节装置33和第四长度调节装置43,以及第一转动支架12和第二转动支架42。所述第一转动支架12的两侧端分别各通过一自由度铰链旋转地连接有一个第一固定轴座11,所述第二转动支架42的两侧端分别各通过一自由度铰链旋转地连接有一个第二固定轴座41,所述第一长度调节装置13的一端贯穿所述第一转动支架12的中部与动平台5固定连接,所述第二长度调节装置23和第三长度调节装置33的一端分别贯穿所述第一转动支架12对应地通过第二铰链24和第三铰链34与动平台5连接,所述第二长度调节装置23和第三长度调节装置33对称地设置于第一长度调节装置13的两侧,所述第一长度调节装置13、第二长度调节装置23和第三长度调节装置33的中部分别各通过具有一个转动自由度的铰链连接在第一转动支架12上,所述第四长度调节装置43的一端贯穿第二转动支架42通过第四铰链44与动平台5连接,所述第四长度调节装置43设置在第一长度调节装置13的下方,所述第四铰链44为具有三个转动自由度的球铰链,且三个转动轴线不共线但相交于一点。所述第四长度调节装置43的中部通过具有一个转动自由度铰链旋转地连接在第二转动支架42上。
所述五自由度混联联构型装备由R(2-RPS&RP)&UPS并联机构和串联转头组成,且可拆分为4条串联运动链:将无约束支链UPS记为支链1,将RRPS支链记为支链i(i=2,3),将UP支链与三自由度转头构成的UPRR支链记为支链4。
(2)依据本发明的建模方法建立该五自由度混联联构型装备的坐标***,如图5所示:转动支架的连体参考系{R1,2}、{R1,3}和{R1,4}重合;并联机构各支链末端参考系{R7,i}(i=1,2,3)和{R4,4}重合,UP支链(RRP支链)的末端参考系{R4,4}与A/C转头近架关节的连体参考系重合;A/C转头的末端参考系{R6,4}与工具参考系{Rt}重合;系{R0}为机架的机架参考系;混联机器人整机关于工具参考系{Rt}的末端位姿误差在系{R′0}下度量,系{R′0}为原点与系{R6,4}重合,轴线方向与系{R0}平行的随动参考系(图5)。支链j中沿关节i运动轴线方向的单位矢量记为wj,i。
构造并联机构R(2-RPS&RP)&UPS的力旋量空间的基矩阵WP:
WP=[WP,a WP,c]
式中
其中,为第k(k=1,2,3)条支链(由nk个单自由度关节组成)中编号为gk(gk=1,2,…,nk)的驱动关节的单位驱动力旋量;/>为第i(i=4)条支链的第gi个(gi=1,2,…,6-ni)单位约束力旋量;pi/j为系{Ri}原点指向系{Rj}原点的位置矢量。
建立并联运动链全参数几何误差模型:
$P,t=TP,aδξP,a+APδηP,式中
其中,$P,t为并联机构末端位姿误差旋量;δξP,a为并联机构运动误差向量;δηP为并联机构结构误差向量;GP,a和GP,c分别为并联机构与许动和受限方向对应的误差映射矩阵。
建立串联转头全参数几何误差模型:
$S,t=TS,aδξS,a+ASδηS
式中
其中,$S,t为串联转头末端位姿误差旋量;δξS,a为串联转头运动误差向量;δηS为串联转头结构误差向量;AS为串联转头结构误差映射矩阵。
建立五自由度混联联构型装备全参数几何误差模型
$t=Taδξa+Aδη
式中
Ta=[TP,a TS,a],A=[AP AS],/>
其中,$t为五自由度混联联构型装备末端位姿误差旋量;δξa为五自由度混联联构型装备运动误差向量;δη为五自由度混联联构型装备结构误差向量;Ta和A分别为五自由度混联联构型装备的运动误差映射矩阵和结构误差映射矩阵。
删减冗余误差参数以及这些误差参数在结构误差映射矩阵A中的对应列,得到五自由度混联联构型装备无冗余几何误差模型。最大可辨识几何误差参数的数量为:N=4×14+2×4+6=70。
尽管上面结合附图对本发明进行了描述,但是本发明并不局限于上述的具体实施方式,上述的具体实施方式仅仅是示意性的,而不是限制性的,机器人构型通常包括串联、并联和混联,上述实施例为混联机器人,混联机器人由串联和并联两部分组合而成,因此,本领域的普通技术人员在本发明提出的建模方法的技术启示下,在不脱离本发明宗旨的情况下,可以针对串联或是并联构型的机器人几何误差建模,这些均属于本发明的保护之内。
Claims (3)
1.一种基于旋量理论的机器人无冗余几何误差模型解析建模方法,其特征在于,该方法包括以下步骤:
步骤一、建立n自由度串联运动链全参数几何误差模型,包括
步骤1-1)建立由n个单自由度关节和n+1个构件组成的n自由度串联运动链的坐标***,1≤n≤6;在机器人的机架上建立机架参考系{R0};在连架关节处建立连体参考系{R1};在第j个连杆的远架关节处建立连体系{Rj+1},j=1,2,…,n-1;在末端构件上建立工具参考系{Rn+1};建立原点与所述连体系{Rn+1}原点重合且方向与所述机架参考系{R0}一致的随动参考系{R′0};
步骤1-2)建立相邻坐标系间平动、转动误差矢量与末端构件参考点的位置误差、末端构件的姿态误差之间的全参数几何误差映射模型;其中:
相邻构件间相对位置误差、相对姿态误差,分别表示为:
jδrj+1/j=(jδxj+1 jδyj+1 jδzj+1)T (1)
jδθj+1/j=(jδαj+1 jδβj+1 jδγj+1)T (2)
式(1)和式(2)中,jδθj+1/j和jδrj+1/j分别为连体系{Rj+1}相对连体系{Rj}的转动和平动误差矢量在连体系{Rj}中的度量;jδxj+1、jδyj+1和jδzj+1分别为连体系{Rj+1}沿着连体系{Rj}中xj、yj和zj轴的平动误差;jδαj+1、jδβj+1和jδγj+1分别为连体系{Rj+1}绕着连体系{Rj}中xj、yj和zj轴转动误差;
末端构件参考点的位置误差、末端构件的姿态误差,分别表示为:
式(3)和式(4)中,0'pj/n+1为随动参考系{R′0}原点指向连体系{Rj}原点的位置矢量在随动参考系{R′0}中的度量;0'Rj为连体系{Rj}相对随动参考系{R′0}的姿态矩阵;
所述的全参数几何误差映射模型,表示为:
式(5)中:
式(5)至式(8)中,$t为末端位姿误差旋量;δξj为关节j的运动误差;δζj为相邻连体系{Rj}和{Rj+1}间的几何误差向量;为关节j的单位许动微小位移旋量;/>为连体系{Rj}关于随动参考系{R′0}的伴随变换矩阵;0′uj、0′vj和0′wj分别为连体系{Rj}中xj、yj和zj轴的单位矢量;
步骤二、建立并联运动链全参数几何误差模型,包括:
步骤2-1)建立串联支链全参数几何误差模型:
对于自由度为f≤6,含l条支链的并联运动链建立机架参考系{R0},建立第i条支链第j个关节的连体参考系{Rj,i},建立动平台参考系{Rt},建立随动参考系{R′0},使得随动参考系{R′0}的原点与动平台参考系{Rt}原点重合,所述的随动参考系{R′0}与机架参考系{R0}的各轴方向保持一致,建立支链i的全参数几何误差模型:
式(9)中,
式(9)至是(11)中,$t为末端位姿误差旋量;δξj,i和分别为支链i中关节j的运动误差和单位微小位移旋量;δξi为支链i的运动误差向量;/>为连体参考系{Rj,i}相对随动参考系{R′0}的伴随变换矩阵;Cj,i和δηj,i分别为支链i中关节j的运动误差映射矩阵和结构误差向量;δηi为支链i的结构误差参数向量;
步骤2-2)建立并联运动链全参数几何误差模型:
构造驱动力子空间矩阵Wa以及约束力子空间矩阵Wc:
式(13)和式(14)中,Wc,i为约束力子空间的基矩阵,i=1,2,…,l;为第k条支链中编号为gk的驱动关节的单位驱动力旋量,所述的第k条支链由nk个单自由度关节组成,k=1,2,…,f;gk=1,2,…,nk;/>为第i条支链的第gi个单位约束力旋量,i=1,2,…,l;gi=1,2,…,6-ni;
通过对式(9)两端分别左乘和/>分别建立并联运动链在许动与约束方向的几何误差映射关系:
式(14)和式(15)中,
式(14)至式(17)中,$t为末端位姿误差旋量;δξa为并联运动链运动误差向量;δηa为并联运动链主动支链结构误差向量;δηf+1为并联运动链恰约束从动支链结构误差向量;δηc为并联运动链结构误差向量;Wa,k为驱动力子空间的基矩阵,k=1,2,…,f;Ak为与Wa,k对应的许动微小位移旋量矩阵;为并联运动链中第k条支链沿/绕编号为gk的驱动关节运动方向的单位微小位移旋量;Ai为与Wc,i对应的受限微小位移旋量矩阵;
利用G-K公式以及力旋量和微小位移旋量空间为对偶空间的基本性质,建立并联运动链全参数几何误差模型:
$t=Taδξa+W-TGδη (18)
式(18)中,
式(18)至式(20)中,δη为并联运动链结构误差向量;Gc,1和Gc,2分别为与δηa和δηf+1对应的误差映射矩阵;
步骤三、删减步骤二得到的并联运动链全参数几何误差模型中冗余几何误差参数,求解该构型运动链最大可辨识几何误差参数的数目
基于两项冗余几何误差参数删减原则,从所述并联运动链全参数几何误差模型中删减并联运动链中所有被动关节的运动误差参数以及这些误差参数在映射矩阵W-TG中的对应列,得到并联运动链无冗余几何误差模型;
所述两项冗余几何误差参数删减原则包括:
原则1,支链k的驱动力旋量与该链中被动关节的许动微小位移旋量/>正交j=1,2,…,nk;j≠gk;
原则2,支链i的约束力旋量与该链中所有关节的许动微小位移旋量/>正交j=1,2,…,ni;
求解自由度为f的并联运动链中最大可辨识几何误差参数数量N:
式(21)中,nr,i和np,i分别为支链i中转动关节和移动关节的数量;nr和np分别为并联运动链中转动关节和移动关节的数量。
2.根据权利要求1所述的基于旋量理论的机器人无冗余几何误差模型解析建模方法,其特征在于,该方法适用于串联运动链构型的机器人几何误差模型解析建模。
3.根据权利要求2所述的基于旋量理论的机器人无冗余几何误差模型解析建模方法,其特征在于,该方法适用于串并混联运动链构型的机器人几何误差模型解析建模。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110958529.4A CN113580142B (zh) | 2021-08-20 | 2021-08-20 | 基于旋量理论的机器人无冗余几何误差模型解析建模方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110958529.4A CN113580142B (zh) | 2021-08-20 | 2021-08-20 | 基于旋量理论的机器人无冗余几何误差模型解析建模方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113580142A CN113580142A (zh) | 2021-11-02 |
CN113580142B true CN113580142B (zh) | 2023-10-13 |
Family
ID=78238640
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110958529.4A Active CN113580142B (zh) | 2021-08-20 | 2021-08-20 | 基于旋量理论的机器人无冗余几何误差模型解析建模方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113580142B (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104875196A (zh) * | 2015-06-10 | 2015-09-02 | 上海交通大学 | 具有三维转动特征动平台的空间调姿并联机构 |
CN106625614A (zh) * | 2017-03-01 | 2017-05-10 | 东莞松山湖国际机器人研究院有限公司 | 一种基于差速驱动结构的六自由度并联机构 |
CN108015808A (zh) * | 2017-12-07 | 2018-05-11 | 天津大学 | 一种混联机器人的运动学标定方法 |
CN111708322A (zh) * | 2020-06-12 | 2020-09-25 | 广州数控设备有限公司 | 三坐标***调姿运控方法、***、调姿控制器及存储介质 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105760576A (zh) * | 2016-01-27 | 2016-07-13 | 首都师范大学 | 一种基于共形几何代数的机械臂运动规划的形式化分析方法及*** |
CN106647282B (zh) * | 2017-01-19 | 2020-01-03 | 北京工业大学 | 一种考虑末端运动误差的六自由度机器人轨迹规划方法 |
-
2021
- 2021-08-20 CN CN202110958529.4A patent/CN113580142B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104875196A (zh) * | 2015-06-10 | 2015-09-02 | 上海交通大学 | 具有三维转动特征动平台的空间调姿并联机构 |
CN106625614A (zh) * | 2017-03-01 | 2017-05-10 | 东莞松山湖国际机器人研究院有限公司 | 一种基于差速驱动结构的六自由度并联机构 |
CN108015808A (zh) * | 2017-12-07 | 2018-05-11 | 天津大学 | 一种混联机器人的运动学标定方法 |
CN111708322A (zh) * | 2020-06-12 | 2020-09-25 | 广州数控设备有限公司 | 三坐标***调姿运控方法、***、调姿控制器及存储介质 |
Non-Patent Citations (1)
Title |
---|
基于旋量理论的数控机床几何误差分离与补偿方法研究;黄华;杨杰;侯宏天;郭润兰;;机械设计与研究(第06期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN113580142A (zh) | 2021-11-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Yang et al. | Feasibility study of a platform type of robotic manipulators from a kinematic viewpoint | |
CN109333547B (zh) | 一种多并联共融的大曲面零件加工装备和加工方法 | |
CN111300425B (zh) | 一种超冗余机械臂末端轨迹运动规划方法 | |
CN109176488B (zh) | 一种柔性机器人运动学标定方法及*** | |
CN101844350B (zh) | 一种三自由度并联机器人机构 | |
US11945111B2 (en) | Parallel mechanism with kinematically redundant actuation | |
CN108555889B (zh) | 含冗余约束的空间五自由度混联加工装备及其使用方法 | |
CN109877813B (zh) | 一种大转角2t2r四自由度并联机构 | |
CN108908347B (zh) | 一种面向冗余移动机械臂容错型重复运动规划方法 | |
CN114711966A (zh) | 机械臂、机器人、微创手术机器人***及机械臂的位姿确定方法 | |
CN109514596B (zh) | 一种双十字铰三自由度并联关节机构 | |
Wen et al. | Kinematically redundant hybrid robots with simple singularity conditions and analytical inverse kinematic solutions | |
CN113545851A (zh) | 重建器械术野中心的控制方法、***、设备和存储介质 | |
CN113580148A (zh) | 基于等效运动链的并联机器人运动学标定方法 | |
CN113580142B (zh) | 基于旋量理论的机器人无冗余几何误差模型解析建模方法 | |
CN107414791B (zh) | 一种面对称过约束混联机器人 | |
CN109079761B (zh) | 一种含闭环支链的两转一移的并联机器人 | |
CN114589701A (zh) | 一种基于阻尼最小二乘的多关节机械臂避障逆运动学方法 | |
CN215093584U (zh) | 具有连续转轴的三自由度并联机构 | |
CN116330267A (zh) | 一种基于工业机器人腕部奇异点计算的控制方法 | |
JP2007144538A (ja) | ロボットのティーチングデータ作成方法 | |
Rosenzveig et al. | Minimal representation for the control of the Adept Quattro with rigid platform via leg observation considering a hidden robot model | |
CN113334381A (zh) | 一种可运动解耦的连续体机器人控制方法 | |
CN110026986B (zh) | 多臂协同作业柔顺控制方法 | |
CN111430022A (zh) | 一种穿刺手术机器人穿刺算法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |