CN106813638B - 一种3rps并联机器人几何参数辨识方法 - Google Patents

一种3rps并联机器人几何参数辨识方法 Download PDF

Info

Publication number
CN106813638B
CN106813638B CN201710156497.XA CN201710156497A CN106813638B CN 106813638 B CN106813638 B CN 106813638B CN 201710156497 A CN201710156497 A CN 201710156497A CN 106813638 B CN106813638 B CN 106813638B
Authority
CN
China
Prior art keywords
mrow
axis
moving platform
msub
error
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.)
Expired - Fee Related
Application number
CN201710156497.XA
Other languages
English (en)
Other versions
CN106813638A (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.)
Jilin University
Original Assignee
Jilin University
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 Jilin University filed Critical Jilin University
Priority to CN201710156497.XA priority Critical patent/CN106813638B/zh
Publication of CN106813638A publication Critical patent/CN106813638A/zh
Application granted granted Critical
Publication of CN106813638B publication Critical patent/CN106813638B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • 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

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)

Abstract

本发明提供一种3RPS并联机器人几何参数辨识方法,属于工业机器人的标定技术领域。构建与静平台相固联的工作参考系B‑xyz及与动平台相固联的局部参考系P‑x'y'z',构建以双轴倾角仪为测量仪器的标定坐标系O‑uvw,规划测量位形,构建参数辨识方程组相容的约束方程组;以MATLAB为工具解算待辨识参数值。本发明不仅避免了对动平台位姿信息全集的测量,且充分发挥了双轴倾角仪对动平台绕x、y轴转角的测量精度与其安装位置精度无关这一特点,降低了参数辨识精度对测量仪器安装位置的精度的依赖性。

Description

一种3RPS并联机器人几何参数辨识方法
技术领域
本发明属于工业机器人的标定技术领域,具体涉及一种3RPS并联机器人的几何参数辨识方法。
背景技术
与传统串联机器人相比,由于并联机器人具有刚度重量比大,响应速度快、无末端误差累积等优点,所以在当今科学研究、工业生产等领域中,后者得到了广泛的研究与应用。继六自由度并联机器人的研究热潮之后,由于少自由度并联机器人相较于六自由度并联机器人具有结构简单,及控制算法简便等特点,因此日渐成为国际机构混联机床和机器人领域的研究热点,其中以三自由度的3RPS并联机构作为少自由度并联机构的典型代表。
运动精度作为衡量所有机器人工作性能的一项重要指标,在众多影响3RPS并联机器人末端动平台的位姿精度的误差源中,由零部件制造、装配引起的几何误差源是影响其运动精度的主要原因。运动学标定是提高并联机器人末端运动精度最为有效、经济的方式,而3RPS并联机器人运动学标定的核心内容在于如何准确、高效地实现对其实际几何参数的辨识过程。
几何参数辨识的基本原理在于:依据辨识模型中理想参数与实际检测参数之间的残差构建误差泛函,即参数辨识方程组,进而由辨识方程组解算出实际几何参数值。根据检测方法的不同可将标定方法分为自标定及外标定方法两大类。
自标定方法:通过在3RPS并联机器人被动关节铰链处安装冗余传感器以获取被动关节运动参数,依据该检测参数与理想参数之间的残差建立辨识方程组,进而以该方程组的极小范数解作为参数辨识结果。该方法避免了对动平台位姿信息的直接检测,具有易于实现运动误差的在线补偿等优点。然而冗余传感器的安装位置通常需要在设计阶段予以考虑,故无法适用于已生产成型的设备。
外标定方法:通过外部检测仪器直接或间接地测量并联机器人动平台全部或部分位姿参数,进而依据实际测量参数和理想正解间的残差构造参数辨识方程组,进而以该方程组的极小范数解作为几何参数的辨识结果。该类标定方法具有原理简单、标定效果好等优点,然而要想直接获取高精度的空间刚体的位姿信息是非常困难的。
以激光追踪仪直接测量3RPS并联机器人末端位姿为代表的外标定方法,尽管可以直接、有效地获取动平台的位姿信息,但是高昂的设备费用及复杂的检测过程使得大多数中、小型企业望而却步。
以双球杆仪间接测量3RPS并联机器人动平台位姿信息的外标定方法,尽管有效地避免了对动平台位姿信息的直接测量,但是由于双球杆仪自身结构的局限性,使得其可检测空间受到了较大限制,因此需要通过静磁座的多个安装位置来扩大检测范围,该过程不仅人为的增加了参数辨识过程的复杂性,而且加剧了参数辨识效果对静磁座的安装位置精度的依赖性。
由于并联机器人在其参考坐标系中沿、绕任意坐标轴的运动,为关节空间所有伺服运动的非线性映射。该性质决定了所有几何参数的误差源均可反映到末端位姿误差中的任一分量中。因此可以认为仅检测3RPS并联机器人动平台的部分位姿误差,便可辨识出系统的全部几何参数。
为突破自标定方法应用的局限性,及尽可能的降低辨识结果对测量仪器安装精度的依赖性,结合3RPS并联机器人结构特点,提出以双轴倾角仪为测量仪器,通过在各规划位形下检测动平台绕x、y轴的实际转角信息与理论转角信息之间的残差构建参数辨识方程组,进而实现3RPS并联机器人的参数辨识。
图1示出了以双轴倾角仪为测量仪器对3RPS并联机器人动平台绕x、y轴实际转角进行测量的结构图:其中3RPS并联机器人主要由静平台、以电动推杆为主动关节的驱动杆、动平台三大部分组成。各驱动杆与静平台之间以转动铰链连接,驱动杆与动平台之间以球铰连接;双轴倾角仪与定位板之间固定连接,通过调整定位板在动平台上的安装位置,使双轴倾角仪可以获得动平台绕x、y轴的实际转角信息。
发明内容
本发明提供一种3RPS并联机器人几何参数辨识方法,是一种以双轴倾角仪为测量仪器,基于3RPS并联机器人动平台位姿误差子集信息的几何参数辨识方法,目的是有效降低了参数辨识结果对检测仪器位置精度的依赖性、避免了对3RPS并联机器人末端动平台位姿误差信息全集的测量。
本发明采取的技术方案是,3RPS并联机器人已完成初始位形零点的标定工作,且在3RPS并联机器人位于初始位形时静平台与动平台具有相同的姿态,包括下列步骤:
步骤(1):构建与静平台相固联的工作参考系B-xyz及与动平台相固联的局部参考系P-x'y'z',简化待辨识几何误差源;
步骤(2):调整双轴倾角仪在双轴倾角仪安装定位板上的安装位置,以下均以定位板代称双轴倾角仪安装定位板,以及定位板在动平台上的安装位置,构建以双轴倾角仪为测量仪器的标定坐标系O-uvw,使得3RPS并联机器人位于初始位形时,工作参考系B-xyz与标定坐标系O-uvw具有相同的姿态信息;
步骤(3):规划测量位形,并在各规划位形下,以双轴倾角仪检测动平台绕x、y轴的实际转角信息,进而依据动平台的位姿误差子集信息,即动平台绕x、y轴的误差构建误差泛函,获得规划测量位形下的参数辨识方程组;
步骤(4):结合双轴倾角仪测量特点,将约束方程组划分为两类,以千分表为工具检测标定坐标系O-uvw与工作参考系B-xyz之间的姿态误差,构建与步骤(3)中的参数辨识方程组相容的约束方程组;
步骤(5):结合前述步骤(3)和步骤(4),构建完备辨识方程组,以MATLAB为工具解算待辨识参数值。
本发明所述的步骤(1)中包含如下内容:
首先,构建固联于静平台的空间直角坐标系B-xyz作为3RPS并联机器人工作参考系:定义z轴沿重力反方向且通过由静平台三个转动铰链B1,B2,B3所确定的△B1B2B3的几何形心;B-xy平面垂直于z轴,且包含转铰中心点B1;原点B位于z轴与B-xy平面的交点处;x轴方向沿B指向转铰中心B1的方向;y轴方向依据右手定则予以确定;
其次,构建固联于动平台的参考系P-x'y'z':定义原点P位于动平台3个球铰中心P1,P2,P3所确定的△P1P2P3的几何形心P处;x'轴方向由P指向球铰中心P1;且z'轴垂直于三个球铰中心所确定的平面P1P2P3且沿背离动平台的方向;y'轴由右手定则予以确定;
最终,简化3RPS并联机器人的几何误差源:
3RPS并联机器人几何误差源△ε=[△b1 △b2 △b3 △p1 △p2 △p3 △η △q]T;其中△ε包括工作参考系B-xyz下各转铰B1、B2、B3的位置误差△b1=[△b1x △b1y △b1z]T、△b2=[△b2x △b2y △b2z]T、△b3=[△b3x △b3y △b3z]T;动平台参考系P-x'y'z'下各球铰P1、P2、P3的位置误差△p1=[△p1x' △p1y' △p1z']T、△p2=[△p2x' △p2y' △p2z']T、△p3=[△p3x' △p3y' △p3z']T;驱动杆Q1与转铰B1许动轴线间的垂直度误差△η1、驱动杆Q2与转铰B2许动轴线间的垂直度误差△η2、驱动杆Q3与转铰B3许动轴线间的垂直度误差△η3,记△η=[△η1 △η2 △η3]T;以及与驱动杆Q1,Q2,Q3相对应的定位误差△q1、△q2、△q3,记△q=[△q1 △q2 △q3]T,共计24项误差元素;通过坐标系B-xyz和P-x'y'z'的设置,则有在B-xyz坐标系下几何误差元素△b1y=△b1z=0;在P-x'y'z'坐标系下有几何误差元素△p1y'=△p1z'=△p2z'=△p3z'=0,因此待辨识误差元素的数目为18。
本发明所述步骤(2)包含如下内容:
首先,调整双轴倾角仪在定位板上的安装位置,具有如下要求:由双轴倾角仪两正交测量轴所确定的平面与定位板c面具有高精度的平行关系,其中定位板c面为定位板与动平台之间的安装面;双轴倾角仪测量轴2与定位板a面具有高精度的平行关系;且定位板面a和c面交线与测量轴2之间具有高精度平行关系;
其次,调整定位板在动平台上的安装位置,构建标定坐标系O-uvw:在3RPS并联机器人位于初始位形时,调整定位板在动平台上的安装位置,使得定位板c面平行于由动平台的三个球铰中心P1,P2,P3所确定的平面P1P2P3,且双轴倾角仪测量轴2与PP1连线方向具有高精度平行关系;构建以双轴倾角仪为测量仪器的标定坐标系O-uvw,定义原点O与此时动平台的几何形心P重合,O-uv平面与定位板c面平行,且u轴与测量轴1平行,v轴与测量轴2平行。
本发明所述步骤(3)包含如下内容:
首先,依据动平台位姿误差子集信息即绕x,y轴的转角误差,构建如公式(1)所示参数辨识模型:
其中:△α为动平台绕x轴的转角误差,Jα为与转角误差△α对应的映射矢量;
△β为动平台绕y轴的转角误差,Jβ为与转角误差△β对应的映射矢量;
其次,规划测量位形,以双轴倾角仪检测动平台绕x、y轴的实际转角信息,进而依据动平台的位姿误差子集信息,即动平台绕x、y轴的误差构建误差泛函,获得规划测量位形下的参数辨识方程组:
将3RPS并联机器人工作空间沿z轴方向分别在z=zi,i=1,…,m处划分为m组测量位形,其中m∈N,且m≥2;于第i组测量位形中,在动平台绕y轴转角为0的初始角度下,控制动平台绕x轴转至规划转角αj处,j=1,…,n,且n∈N,n≥2,以双轴倾角仪检测动平台的实际转角信息,进而获得动平台绕x轴的定位误差△αi,j(x)及绕y轴的转角误差△βi,j(x);依据动平台位姿误差子集信息△αi,j(x)和△βi,j(x),构建如公式(2)所示参数辨识方程组:
△θ(x)=Hx·△ε……………………(2)
其中:
△θi(x)为在第i组测量位形中,由各测量位形下动平台位姿误差子集△αi,j(x)和△βi,j(x),j=1,…,n,信息组成的列矢量;
△θ(x)是由m组测量位形中△θi(x)组成的列矢量;
Jα_i,j(x)为在第i组测量位形中第j测量位形下,与动平台与绕x轴的定位转角误差对应的误差映射矢量;
Jβ_i,j(x)为在第i组测量位形中第j测量位形下,与动平台与绕y轴的转角误差对应的误差映射矢量;
Hx,i为第i组测量位形中,与△θi(x)中各元素所对应的误差映射矢量组成的矩阵;
Hx是由各测量位形下Hx,i组成的矩阵;
同样的,在z=zi时,即在第i组测量位形中,在绕x轴转角为0的初始角度下,控制动平台绕y轴转至规划转角βk处,k=1,2,…,l,其中有l∈N,且N≥2,
以双轴倾角仪检测动平台的实际转角信息,进而获得动平台绕y轴的定位转角误差△βi,k(y)及绕x轴的转角误差△αi,k(y),依据动平台位姿误差子集信息△βi,k(y)和△αi,k(y),构建参数辨识方程,其数学描述如公式(3)所示;
△θ(y)=Hy·△ε……………………(3)
其中:
△θi(y)为在第i组测量位形中,由各测量位形下动平台姿态误差子集△βi,k(y)和△αi,k(y),k=1,2,…,l,信息组成的列矢量;
△θ(y)是由m组测量位形中△θi(y)组成的列矢量;
Jα_i,k(y)为第i组测量位形中第k测量位形下,与动平台绕x轴的转角误差对应的误差映射矢量;
Jβ_i,k(y)为第i组测量位形中第k测量位形下,与动平台绕y轴的定位转角误差对应的误差映射矢量;
Hy,i为第i组测量位形中,由与△θi(y)中各元素所对应的误差映射矢量组成的矩阵;
Hy是由各测量位形下Hy,i组成的矩阵;
m,n,l之间满足:m×(n+l)>>rank(ε),其中rank(ε)为待辨识参数的独立个数。
本发明所述步骤(4)中所述约束方程组的构建,包含如下内容:
首先,依据标定坐标系O-uvw与工作参考系B-xyz间的位置关系建立第一类约束方程,由于双轴倾角仪安装的位置精度对于动平台绕x,y轴的转角信息的测量精度并无影响,因此可以认为标定坐标系O-uvw与工作坐标系B-xyz之间无位置误差,则第一类约束方程组如公式(4)所示:
0=Jr0·△ε……………………(4)
其中:
Jr0为在初始位形下,并联机器人末端运动平台的位置误差映射矩阵;
其次,依据标定坐标系O-uvw与工作参考系B-xyz间的姿态关系构建第二类约束方程,以千分表为检测工具,通过千分表表头在定位板两个表面沿某轴向移动过程中的变化量,得到标定坐标系O-uvw与工作参考系B-xyz之间的姿态误差为△α0,△β0,△γ0,由此构建如公式(5)所示的第二组约束方程:
△θ0=Jθ0·△ε……………………(5)
其中:
△θ0=[△α0 △β0 △γ0]T
Jθ0为初始位形下,3RPS并联机器人动平台姿态误差映射矩阵。
本发明所述千分表为检测工具,计算得到标定坐标系O-uvw与工作参考系B-xyz之间的姿态误差为△α0,△β0,△γ0,包含如下内容:
以千分表表头接触定位板a面,沿y方向运动距离△sa,y,千分表表头在沿x方向的增量为△xa,y;以千分表表头接触定位板b面,沿x方向运动距离△sb,x,千分表表头在沿z方向的增量为△zb,x;以千分表表头接触定位板b面,沿y方向运动距离△sb,y,千分表表头在沿z方向的增量为△zb,y
令标定坐标系O-uvw与工作参考系B-xyz之间的姿态误差为△α0,△β0,△γ0,依据刚体位姿变换关系,可以得出公式(6)
由此综合公式(4)、(5)、(6),得到如公式(7)所示的约束方程组,由于约束方程组是基于标定坐标系O-uvw与工作参考系B-xyz之间实际刚体位移信息而构建的,因此该约束方程与辨识方程组具有相容性;
△x0=H0·△ε……………………(7)
其中:
本发明所述步骤(5)包含如下内容:
结合前述步骤(3)和(4),构建包含辨识方程方程组和约束方程组的完备辨识方程组,其数学描述如公式(8)所示:
△x=H·△ε……………………(8)
其中:
解算该完备参数辨识方程组,可获得如下公式(9)待辨识参数的极小范数解:
△ε=CT·(BT·H·CT)-1·BT……………………(9)
其中:H=B·C即B、C为H的一个满秩分解。
本发明要实现以双轴倾角仪对动平台绕x、y轴的实际转角参数的高精度测量,只需要保证双轴倾角仪的两个测量轴与x、y具有高精度的平行关系即可,而对于双轴倾角仪的位置精度并没有依赖性,因此降低了辨识结果对测量仪器安装位置精度的依赖性。
本发明有效避免了对3RPS并联机器人运动平台位姿信息全集的检测,并克服了辨识效果对检测仪器安装的位置精度的依赖性,通过仿真分析验证,该方法可以有效地获取3RPS并联机器人待辨识几何参数,且具有较高的精度及鲁棒性和明显的有效性。
附图说明
图1是以双轴倾角仪为测量仪器对3RPS并联机器人几何参数进行辨识的结构图;
图2是3RPS并联机器人的结构示意图及相关参考系;
图3是以双轴倾角仪于安装定位板的安装结构图;
图4是以双轴倾角仪为测量仪器的标定坐标系示意图;
图5是约束方程组的有无与相容性对于参数辩识结果的影响图。
具体实施方式
3RPS并联机器人已完成初始位形零点的标定工作,且在3RPS并联机器人位于初始位形时静平台与动平台具有相同的姿态,包括下列步骤:
步骤(1):构建与静平台相固联的工作参考系B-xyz及与动平台相固联的局部参考系P-x'y'z',简化待辨识几何误差源;
步骤(2):调整双轴倾角仪在双轴倾角仪安装定位板上的安装位置,以下均以定位板代称双轴倾角仪安装定位板,以及定位板在动平台上的安装位置,构建以双轴倾角仪为测量仪器的标定坐标系O-uvw,使得3RPS并联机器人位于初始位形时,工作参考系B-xyz与标定坐标系O-uvw具有相同的姿态信息;
步骤(3):规划测量位形,并在各规划位形下,以双轴倾角仪检测动平台绕x、y轴的实际转角信息,进而依据动平台的位姿误差子集信息,即动平台绕x、y轴的误差构建误差泛函,获得规划测量位形下的参数辨识方程组;
步骤(4):结合双轴倾角仪测量特点,将约束方程组划分为两类,以千分表为工具检测标定坐标系O-uvw与工作参考系B-xyz之间的姿态误差,构建与步骤(3)中的参数辨识方程组相容的约束方程组;
步骤(5):结合前述步骤(3)和步骤(4),构建完备辨识方程组,以MATLAB为工具解算待辨识参数值。
本发明所述的步骤(1)中包含如下内容:
首先,构建固联于静平台的空间直角坐标系B-xyz作为3RPS并联机器人工作参考系:定义z轴沿重力反方向且通过由静平台三个转动铰链B1,B2,B3所确定的△B1B2B3的几何形心;B-xy平面垂直于z轴,且包含转铰中心点B1;原点B位于z轴与B-xy平面的交点处;x轴方向沿B指向转铰中心B1的方向;y轴方向依据右手定则予以确定;
其次,构建固联于动平台的参考系P-x'y'z':定义原点P位于动平台3个球铰中心P1,P2,P3所确定的△P1P2P3的几何形心P处;x'轴方向由P指向球铰中心P1;且z'轴垂直于三个球铰中心所确定的平面P1P2P3且沿背离动平台的方向;y'轴由右手定则予以确定;
最终,简化3RPS并联机器人的几何误差源:
3RPS并联机器人几何误差源△ε=[△b1 △b2 △b3 △p1 △p2 △p3 △η △q]T;其中△ε包括工作参考系B-xyz下各转铰B1、B2、B3的位置误差△b1=[△b1x △b1y △b1z]T、△b2=[△b2x △b2y △b2z]T、△b3=[△b3x △b3y △b3z]T;动平台参考系P-x'y'z'下各球铰P1、P2、P3的位置误差△p1=[△p1x' △p1y' △p1z']T、△p2=[△p2x' △p2y' △p2z']T、△p3=[△p3x' △p3y' △p3z']T;驱动杆Q1与转铰B1许动轴线间的垂直度误差△η1、驱动杆Q2与转铰B2许动轴线间的垂直度误差△η2、驱动杆Q3与转铰B3许动轴线间的垂直度误差△η3,记△η=[△η1 △η2 △η3]T;以及与驱动杆Q1,Q2,Q3相对应的定位误差△q1、△q2、△q3,记△q=[△q1 △q2 △q3]T,共计24项误差元素;通过坐标系B-xyz和P-x'y'z'的设置,则有在B-xyz坐标系下几何误差元素△b1y=△b1z=0;在P-x'y'z'坐标系下有几何误差元素△p1y'=△p1z'=△p2z'=△p3z'=0,因此待辨识误差元素的数目为18。
本发明所述步骤(2)包含如下内容:
首先,调整双轴倾角仪在定位板上的安装位置,具有如下要求:由双轴倾角仪两正交测量轴所确定的平面与定位板c面具有高精度的平行关系,其中定位板c面为定位板与动平台之间的安装面;双轴倾角仪测量轴2与定位板a面具有高精度的平行关系;且定位板面a和c面交线与测量轴2之间具有高精度平行关系;
其次,调整定位板在动平台上的安装位置,构建标定坐标系O-uvw:在3RPS并联机器人位于初始位形时,调整定位板在动平台上的安装位置,使得定位板c面平行于由动平台的三个球铰中心P1,P2,P3所确定的平面P1P2P3,且双轴倾角仪测量轴2与PP1连线方向具有高精度平行关系;构建以双轴倾角仪为测量仪器的标定坐标系O-uvw,定义原点O与此时动平台的几何形心P重合,O-uv平面与定位板c面平行,且u轴与测量轴1平行,v轴与测量轴2平行。
本发明所述步骤(3)包含如下内容:
首先,依据动平台位姿误差子集信息即绕x,y轴的转角误差,构建如公式(1)所示参数辨识模型:
其中:△α为动平台绕x轴的转角误差,Jα为与转角误差△α对应的映射矢量;
△β为动平台绕y轴的转角误差,Jβ为与转角误差△β对应的映射矢量;
其次,规划测量位形,以双轴倾角仪检测动平台绕x、y轴的实际转角信息,进而依据动平台的位姿误差子集信息,即动平台绕x、y轴的误差构建误差泛函,获得规划测量位形下的参数辨识方程组:
将3RPS并联机器人工作空间沿z轴方向分别在z=zi,i=1,…,m处划分为m组测量位形,其中m∈N,且m≥2;于第i组测量位形中,在动平台绕y轴转角为0的初始角度下,控制动平台绕x轴转至规划转角αj处,j=1,…,n,且n∈N,n≥2,以双轴倾角仪检测动平台的实际转角信息,进而获得动平台绕x轴的定位误差△αi,j(x)及绕y轴的转角误差△βi,j(x);依据动平台位姿误差子集信息△αi,j(x)和△βi,j(x),构建如公式(2)所示参数辨识方程组:
△θ(x)=Hx·△ε……………………(2)
其中:
△θi(x)为在第i组测量位形中,由各测量位形下动平台位姿误差子集△αi,j(x)和△βi,j(x),j=1,…,n,信息组成的列矢量;
△θ(x)是由m组测量位形中△θi(x)组成的列矢量;
Jα_i,j(x)为在第i组测量位形中第j测量位形下,与动平台与绕x轴的定位转角误差对应的误差映射矢量;
Jβ_i,j(x)为在第i组测量位形中第j测量位形下,与动平台与绕y轴的转角误差对应的误差映射矢量;
Hx,i为第i组测量位形中,与△θi(x)中各元素所对应的误差映射矢量组成的矩阵;
Hx是由各测量位形下Hx,i组成的矩阵;
同样的,在z=zi时,即在第i组测量位形中,在绕x轴转角为0的初始角度下,控制动平台绕y轴转至规划转角βk处,k=1,2,…,l,其中有l∈N,且N≥2,
以双轴倾角仪检测动平台的实际转角信息,进而获得动平台绕y轴的定位转角误差△βi,k(y)及绕x轴的转角误差△αi,k(y),依据动平台位姿误差子集信息△βi,k(y)和△αi,k(y),构建参数辨识方程,其数学描述如公式(3)所示;
△θ(y)=Hy·△ε……………………(3)
其中:
△θi(y)为在第i组测量位形中,由各测量位形下动平台姿态误差子集△βi,k(y)和△αi,k(y),k=1,2,…,l,信息组成的列矢量;
△θ(y)是由m组测量位形中△θi(y)组成的列矢量;
Jα_i,k(y)为第i组测量位形中第k测量位形下,与动平台绕x轴的转角误差对应的误差映射矢量;
Jβ_i,k(y)为第i组测量位形中第k测量位形下,与动平台绕y轴的定位转角误差对应的误差映射矢量;
Hy,i为第i组测量位形中,由与△θi(y)中各元素所对应的误差映射矢量组成的矩阵;
Hy是由各测量位形下Hy,i组成的矩阵;
m,n,l之间满足:m×(n+l)>>rank(ε),其中rank(ε)为待辨识参数的独立个数。
本发明所述步骤(4)中所述约束方程组的构建,包含如下内容:
首先,依据标定坐标系O-uvw与工作参考系B-xyz间的位置关系建立第一类约束方程,由于双轴倾角仪安装的位置精度对于动平台绕x,y轴的转角信息的测量精度并无影响,因此可以认为标定坐标系O-uvw与工作坐标系B-xyz之间无位置误差,则第一类约束方程组如公式(4)所示:
0=Jr0·△ε……………………(4)
其中:
Jr0为在初始位形下,并联机器人末端运动平台的位置误差映射矩阵;
其次,依据标定坐标系O-uvw与工作参考系B-xyz间的姿态关系构建第二类约束方程,以千分表为检测工具,通过千分表表头在定位板两个表面沿某轴向移动过程中的变化量,得到标定坐标系O-uvw与工作参考系B-xyz之间的姿态误差为△α0,△β0,△γ0,由此构建如公式(5)所示的第二组约束方程:
△θ0=Jθ0·△ε……………………(5)
其中:
△θ0=[△α0 △β0 △γ0]T
Jθ0为初始位形下,3RPS并联机器人动平台姿态误差映射矩阵。
本发明所述千分表为检测工具,计算得到标定坐标系O-uvw与工作参考系B-xyz之间的姿态误差为△α0,△β0,△γ0,包含如下内容:
以千分表表头接触定位板a面,沿y方向运动距离△sa,y,千分表表头在沿x方向的增量为△xa,y;以千分表表头接触定位板b面,沿x方向运动距离△sb,x,千分表表头在沿z方向的增量为△zb,x;以千分表表头接触定位板b面,沿y方向运动距离△sb,y,千分表表头在沿z方向的增量为△zb,y
令标定坐标系O-uvw与工作参考系B-xyz之间的姿态误差为△α0,△β0,△γ0,依据刚体位姿变换关系,可以得出公式(6)
由此综合公式(4)、(5)、(6),得到如公式(7)所示的约束方程组,由于约束方程组是基于标定坐标系O-uvw与工作参考系B-xyz之间实际刚体位移信息而构建的,因此该约束方程与辨识方程组具有相容性;
△x0=H0·△ε……………………(7)
其中:
本发明所述步骤(5)包含如下内容:
结合前述步骤(3)和(4),构建包含辨识方程方程组和约束方程组的完备辨识方程组,其数学描述如公式(8)所示:
△x=H·△ε……………………(8)
其中:
解算该完备参数辨识方程组,可获得如下公式(9)待辨识参数的极小范数解:
△ε=CT·(BT·H·CT)-1·BT……………………(9)
其中:H=B·C即B、C为H的一个满秩分解。
以下结合附图对本发明做进一步详细描述;
参见附图2‐4,一种基于末端动平台位姿误差子集信息的3RPS并联机器人几何参数辨识方法,该方法通过在各规划位形下,以双轴倾角仪检测动平台绕x、y轴的实际转角信息,进而构建参数辨识方程组;结合双轴倾角仪测量特点,构建与参数辨识方程组相容的约束方程;最终获得具有相容性的完备辨识方程组,以MATLAB为工具解算得到待辨识参数的极小范数解,该辨识方法具体有以下步骤;
步骤(1):如图2所示,构建固联于静平台的空间直角坐标系B-xyz作为3RPS并联机器人工作参考系:定义z轴沿重力反方向且通过由静三个转动铰链中心B1,B2,B3所确定的三角形B1B2B3的几何形心;B-xy平面垂直于z轴且包含转铰B1;原点B位于z轴与B-xy平面的交点处;x轴方向由B指向转铰中心B1;y轴方向依据右手定则予以确定。
构建固联于动平台的参考坐标系P-x'y'z':定义原点P位于动平台3个球铰中心P1,P2,P3所确定的△P1P2P3的几何形心处;x'轴方向由P指向球铰中心P1;z'轴垂直于三个球铰中心所确定的平面P1P2P3且沿背离动平台的方向;y'轴由右手定则予以确定。
步骤(2):要实现以双轴倾角仪对动平台绕x、y轴的实际转角参数的高精度测量,只需要保证双轴倾角仪的两个测量轴1、2与x、y具有高精度的平行关系即可,该测量精度对于双轴倾角仪的位置精度并没有依赖性。
如图3所示,双轴倾角仪与双轴倾角仪安装定位板固定连接,其中要求双轴倾角仪的测量轴2与定位板a面具有高精度的平行关系,且由两正交测量轴所确定的平面与定位板c面具有高精度的平行关系,其中定位板c面为定位板与动平台之间的安装面,且定位板面a和c面交线与测量轴2之间具有高精度平行关系。
如图4所示,在3RPS并联机器人位于初始位形时,构建以双轴倾角仪为测量仪器的标定坐标系O-uvw:定义原点O与此时动平台的几何形心P重合,O-uv平面与定位板c面平行,且u轴与测量轴1平行,v轴与测量轴2平行;调整定位板在动平台上的安装位置,使得定位板c面平行于由动平台的三个球铰中心所确定的平面P1P2P3,且测量轴2与OP1连线方向具有高精度平行关系。
综合步骤(1)、(2),在3RPS并联机器人位于初始位形时,工作参考系B-xyz、动平台参考系P-x'y'z'、标定坐标系O-uvw具有相同的姿态关系。因此有理由认为双轴倾角仪可获得动平台绕x,y轴转角信息,且具有较高精度。其中工作参考系B-xyz、标定坐标系O-uvw为空间固定坐标系,动平台参考系P-x'y'z'为活动参考系。
步骤(3):以3RPS并联机器人末端动平台误差子集(绕x,y轴的转角误差)构建参数辨识模型,其数学描述形式如下公式(1)所示:
其中:△α为3RPS并联机器人末端运动平台绕x轴的转角误差;
Jα为转角误差△α的映射矢量;
△β为3RPS并联机器人末端运动平台绕y轴的转角误差;
Jβ为转角误差△β映射矢量,△ε为3RPS并联机器人几何误差源。
规划测量位形,将3RPS并联机器人工作空间沿z轴方向分别于z=zi,i=1,…,m处划分为m组测量位形,其中m∈N,且m≥2。于第i组测量位形中,在动平台绕y轴转角为0的初始角度下,控制动平台绕x轴转动规划转角αj,j=1,…,n,且n∈N,n≥2,以双轴倾角仪检测动平台的实际转角信息,进而获得动平台绕x轴的定位误差△αi,j(x)及绕y轴的转角误差△βi,j(x);依据动平台位姿误差子集信息△αi,j(x)和△βi,j(x),构建参数辨识方程,其数学描述如公式(2)所示;
△θ(x)=Hx·△ε……………………(2)
其中:
△θi(x)为在第i组测量位形中,由各测量位形下动平台姿态误差子集△αi,j(x)和△βi,j(x),j=1,…,n,信息组成的列矢量;
△θ(x)是由m组测量位形中△θi(x)组成的列矢量;
Jα_i,j(x)为在第i组测量位形中第j测量位形下,与动平台与绕x轴的定位转角误差对应的误差映射矢量;
Jβ_i,j(x)为在第i组测量位形中第j测量位形下,与动平台与绕y轴的转角误差对应的误差映射矢量;
Hx,i为第i组测量位形中,与△θi(x)中各元素所对应的误差映射矢量组成的矩阵;
Hx是由各测量位形下Hx,i组成的矩阵;
同样的,在z=zi时,即在第i组测量位形中,在绕x轴转角为0的初始角度下,控制动平台绕y轴转动规划转角βk,k=1,2,…,l,其中有l∈N,且l≥2,
以双轴倾角仪检测动平台的实际转角信息,进而获得动平台绕y轴的转角定位误差△βi,k(y)及绕x轴的转角误差△αi,k(y)。依据动平台位姿误差子集信息△βi,k(y)和△αi,k(y),构建参数辨识方程,其数学描述如公式(3)所示;
△θ(y)=Hy·△ε……………………(3)
其中:
其中:
△θi(y)为在第i组测量位形中,由各测量位形下动平台姿态误差子集△βi,k(y)和△αi,k(y),k=1,2,…,l,信息组成的列矢量;
△θ(y)是由m组测量位形中△θi(y)组成的列矢量;
Jα_i,k(y)为第i组测量位形中第k测量位形下,与动平台绕x轴的转角误差对应的误差映射矢量;
Jβ_i,k(y)为第i组测量位形中第k测量位形下,与动平台绕y轴的定位转角误差对应的误差映射矢量;
Hy,i为第i组测量位形中,由与△θi(y)中各元素所对应的误差映射矢量组成的矩阵;
Hy是由各测量位形下Hy,i组成的矩阵;
m,n,l之间满足:m×(n+l)>>rank(ε),其中rank(ε)为待辨识参数的独立个数。
步骤(4):由于在辨识方程组中仅描述了动平台绕x,y轴的转角信息,因此缺乏描述标定坐标系O-uvw与工作坐标系B-xyz之间的刚体位移信息,在此构建约束方程以描述该刚体位移信息。值得指出的是,约束方程组与辨识方程组之间的相容性对辨识结果的精度具有较大影响,因此在本步骤中结合双轴倾角仪测量特点,构建与辨识方程组相容的约束方程组:
由于双轴倾角仪安装的位置精度对于动平台绕x,y轴的转角信息的测量精度并无影响,因此可以认为标定坐标系O-uvw与工作坐标系B-xyz之间无位置误差,则第一类约束方程组描述如公式(4)所示
0=Jr0·△ε……………………(4)
其中:
Jr0为在初始位形下,并联机器人末端运动平台的位置误差映射矩阵;
由于双轴倾角仪安装的姿态精度对于动平台绕x,y轴的转角信息的测量精度具有绝对的影响,因此需要确切的测量O-uvw与B-xyz之间的姿态关系;
令标定坐标系O-uvw与工作参考系B-xyz之间的姿态误差为△α0,△β0,△γ0,由此构建第二组约束方程(6)
△θ0=Jθ0·△ε……………………(5)
其中:
△θ0=[△θ(x) △θ(y) △θ(z)]T
Jθ0为初始位形下,3RPS并联机器人动平台姿态误差映射矩阵。
为测量O-uvw与B-xyz之间的姿态误差,以千分表表头接触定位板a面,沿y方向运动距离△sa,y,千分表表头在沿x方向的增量为△xa,y;以千分表表头接触定位板b面,沿x方向运动距离△sb,x,千分表表头在沿z方向的增量为△zb,x;以千分表表头接触定位板b面,沿y方向运动距离△sb,y,千分表表头在沿z方向的增量为△zb,y;依据刚体位姿变换关系,可以得出(6)
由此综合公式(4)、(5)和(6),得到如公式(7)所示的完整约束方程组
△x0=H0·△ε……………………(7)
其中:
步骤(5):结合前述步骤(四)和(五),构建如公式(8)所示的完备辨识方程组以该约束方程及规划测量位形下的辨识方程构成相容的标定方程组,其数学描述形如:
△x=H·△ε……………………(8)
其中:
解算该完备参数辨识方程组,可获得如下公式(9)待辨识参数的极小范数解:
△ε=CT·(BT·H·CT)-1·BT……………………(9)
其中:H=B·C即B、C为H的一个满秩分解。
为验证该参数辨识方法的有效性及鲁棒性,结合实验室五轴混联机床,该机床3RPS并联机构部分即为典型的3RPS并联机器人,对该3RPS并联机构进行仿真分析,其工作空间及主要几何参数如下表1所示。
表1:五轴混联机床3RPS并联机构部分工作空间及主要几何参数
由于3RPS并联机器人通常在工作空间边缘部位精度表现较差,因此测量位形的选择具有非均匀的特点,在工作空间边缘部位选择较多的测量位形。在此,将3RPS并联机器人工作空间沿z轴方向分别于z1=560,z2=620,z3=680处划分为3组测量位形。分别在第i组测量位形中,在绕y轴转角为0的初始角度下,控制3RPS并联机器人动平台绕x轴逐次转至规划转角αj处,j=1,…,n,具体转角规划如下表2所示;依据步骤(3)中公式(2)构建参数辨识方程组△θ(x)=Hx·△ε。
表2:第i组测量位形中,动平台绕x轴转角αj规划
同样的,在第i组测量位形中,在绕x轴转角为0的初始角度下,控制3RPS并联机器人动平台绕y轴逐次转动规划转角βk,k=1,…,l,具体转角规划如下表3所示;依据步骤(3)中公式(3)构建参数辨识方程组△θ(y)=Hy·△ε
表3:第i组测量位形中,动平台绕y轴转角βk规划
依据在各测量位形下构建的参数辨识方程组,结合约束方程组△x0=H0·△ε,得到完备约束方程组△x=H·△ε。为逼近真实环境下双轴倾角仪对动平台绕x,y轴的转角的测量过程,在仿真过程中在△x=[△θ(x) △θ(y) △x0]T中加入标准差大小为各误差绝对值的5%,均值为0的正态分布的随机噪声,并以10次均值作为的△x,作为测量环境对检测结果的影响。最终,误差源△ε中待辨识误差元素的设定值与辨识结果如表4所示;
表4:3RPS并联机器人几何参数仿真辨识结果
为更直观的体现该辨识方法中约束方程组与规划位形下参数辨识方程组的相容性的重要性,分别以完备辨识方程组中约束方程组的有无及类型,进行参数辨识效果的对比,以辨识结果与设定值之间残差与设定值大小的比值作为辨识效果的衡量标准,图5中示出了不包含约束方程组、采用传统非相容性的约束方程组(认为标定坐标系与工作参考系之间无位姿误差而建立的约束方程组)、采用本发明所述具有相容性的约束方程组的对比辨识效果。结果显示采用本发明中具有相容性的约束方程组进行参数辨识,各误差元素的辨识结果与设定值之间的最大偏差不超过10%,且相较于不采用约束方程组和采用传统非相容性的约束方程组,具有更高的辨识精度。
本发明有效避免了对3RPS并联机器人运动平台位姿信息全集的检测,并克服了辨识效果对检测仪器安装的位置精度的依赖性,且通过构建与辨识方程组相容的约束方程组提高了辨识结果的精度,且该方法具有较高的精度、鲁棒性及有效性。

Claims (7)

1.一种3RPS并联机器人几何参数辨识方法,3RPS并联机器人已完成初始位形零点的标定工作,且在3RPS并联机器人位于初始位形时静平台与动平台具有相同的姿态,其特征在于,包括下列步骤:
步骤(1):构建与静平台相固联的工作参考系B-xyz及与动平台相固联的局部参考系P-x'y'z',简化待辨识几何误差源;
步骤(2):调整双轴倾角仪在双轴倾角仪安装定位板上的安装位置,以下均以定位板代称双轴倾角仪安装定位板,以及定位板在动平台上的安装位置,构建以双轴倾角仪为测量仪器的标定坐标系O-uvw,使得3RPS并联机器人位于初始位形时,工作参考系B-xyz与标定坐标系O-uvw具有相同的姿态信息;
步骤(3):规划测量位形,并在各规划位形下,以双轴倾角仪检测动平台绕x、y轴的实际转角信息,进而依据动平台的位姿误差子集信息,即动平台绕x、y轴的误差构建误差泛函,获得规划测量位形下的参数辨识方程组;
步骤(4):结合双轴倾角仪测量特点,将约束方程组划分为两类,以千分表为工具检测标定坐标系O-uvw与工作参考系B-xyz之间的姿态误差,构建与步骤(3)中的参数辨识方程组相容的约束方程组;
步骤(5):结合前述步骤(3)和步骤(4),构建完备辨识方程组,以MATLAB为工具解算待辨识参数值。
2.根据权利要求1所述的一种3RPS并联机器人几何参数辨识方法,其特征在于,所述的步骤(1)中包含如下内容:
首先,构建固联于静平台的空间直角坐标系B-xyz作为3RPS并联机器人工作参考系:定义z轴沿重力反方向且通过由静平台三个转动铰链B1,B2,B3所确定的△B1B2B3的几何形心;B-xy平面垂直于z轴,且包含转铰中心点B1;原点B位于z轴与B-xy平面的交点处;x轴方向沿B指向转铰中心B1的方向;y轴方向依据右手定则予以确定;
其次,构建固联于动平台的参考系P-x'y'z':定义原点P位于动平台3个球铰中心P1,P2,P3所确定的△P1P2P3的几何形心P处;x'轴方向由P指向球铰中心P1;且z'轴垂直于三个球铰中心所确定的平面P1P2P3且沿背离动平台的方向;y'轴由右手定则予以确定;
最终,简化3RPS并联机器人的几何误差源:
3RPS并联机器人几何误差源△ε=[△b1 △b2 △b3 △p1 △p2 △p3 △η △q]T;其中△ε包括工作参考系B-xyz下各转铰B1、B2、B3的位置误差△b1=[△b1x △b1y △b1z]T、△b2=[△b2x △b2y △b2z]T、△b3=[△b3x △b3y △b3z]T;动平台参考系P-x'y'z'下各球铰P1、P2、P3的位置误差△p1=[△p1x' △p1y' △p1z']T、△p2=[△p2x' △p2y' △p2z']T、△p3=[△p3x'△p3y' △p3z']T;驱动杆Q1与转铰B1许动轴线间的垂直度误差△η1、驱动杆Q2与转铰B2许动轴线间的垂直度误差△η2、驱动杆Q3与转铰B3许动轴线间的垂直度误差△η3,记△η=[△η1 △η2 △η3]T;以及与驱动杆Q1,Q2,Q3相对应的定位误差△q1、△q2、△q3,记△q=[△q1 △q2 △q3]T,共计24项误差元素;通过坐标系B-xyz和P-x'y'z'的设置,则有在B-xyz坐标系下几何误差元素△b1y=△b1z=0;在P-x'y'z'坐标系下有几何误差元素△p1y'=△p1z'=△p2z'=△p3z'=0,因此待辨识误差元素的数目为18。
3.根据权利要求1所述的一种3RPS并联机器人几何参数辨识方法,其特征在于,所述步骤(2)包含如下内容:
首先,调整双轴倾角仪在定位板上的安装位置,具有如下要求:由双轴倾角仪两正交测量轴所确定的平面与定位板c面具有高精度的平行关系,其中定位板c面为定位板与动平台之间的安装面;双轴倾角仪第二测量轴(2)与定位板a面具有高精度的平行关系;且定位板面a和c面交线与第二测量轴(2)之间具有高精度平行关系;
其次,调整定位板在动平台上的安装位置,构建标定坐标系O-uvw:在3RPS并联机器人位于初始位形时,调整定位板在动平台上的安装位置,使得定位板c面平行于由动平台的三个球铰中心P1,P2,P3所确定的平面P1P2P3,且双轴倾角仪第二测量轴(2)与PP1连线方向具有高精度平行关系;构建以双轴倾角仪为测量仪器的标定坐标系O-uvw,定义原点O与此时动平台的几何形心P重合,O-uv平面与定位板c面平行,且u轴与第一测量轴(1)平行,v轴与第二测量轴(2)平行。
4.根据权利要求1所述的一种3RPS并联机器人几何参数辨识方法,其特征在于,所述步骤(3)包含如下内容:
首先,依据动平台位姿误差子集信息即绕x,y轴的转角误差,构建如公式(1)所示参数辨识模型:
<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>&amp;Delta;</mi> <mi>&amp;alpha;</mi> </mtd> </mtr> <mtr> <mtd> <mi>&amp;Delta;</mi> <mi>&amp;beta;</mi> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>J</mi> <mi>&amp;alpha;</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>J</mi> <mi>&amp;beta;</mi> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>&amp;CenterDot;</mo> <mi>&amp;Delta;</mi> <mi>&amp;epsiv;</mi> <mn>...</mn> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>
其中:△α为动平台绕x轴的转角误差,Jα为与转角误差△α对应的映射矢量;
△β为动平台绕y轴的转角误差,Jβ为与转角误差△β对应的映射矢量;
其次,规划测量位形,以双轴倾角仪检测动平台绕x、y轴的实际转角信息,进而依据动平台的位姿误差子集信息,即动平台绕x、y轴的误差构建误差泛函,获得规划测量位形下的参数辨识方程组:
将3RPS并联机器人工作空间沿z轴方向分别在z=zi,i=1,…,m处划分为m组测量位形,其中m∈N,且m≥2;于第i组测量位形中,在动平台绕y轴转角为0的初始角度下,控制动平台绕x轴转至规划转角αj处,j=1,…,n,且n∈N,n≥2,以双轴倾角仪检测动平台的实际转角信息,进而获得动平台绕x轴的定位误差△αi,j(x)及绕y轴的转角误差△βi,j(x);依据动平台位姿误差子集信息△αi,j(x)和△βi,j(x),构建如公式(2)所示参数辨识方程组:
△θ(x)=Hx·△ε……………………(2)
其中:
△θi(x)为在第i组测量位形中,由各测量位形下动平台位姿误差子集△αi,j(x)和△βi,j(x),j=1,…,n,信息组成的列矢量;
△θ(x)是由m组测量位形中△θi(x)组成的列矢量;
Jα_i,j(x)为在第i组测量位形中第j测量位形下,与动平台与绕x轴的定位转角误差对应的误差映射矢量;
Jβ_i,j(x)为在第i组测量位形中第j测量位形下,与动平台与绕y轴的转角误差对应的误差映射矢量;
Hx,i为第i组测量位形中,与△θi(x)中各元素所对应的误差映射矢量组成的矩阵;
Hx是由各测量位形下Hx,i组成的矩阵;
同样的,在z=zi时,即在第i组测量位形中,在绕x轴转角为0的初始角度下,控制动平台绕y轴转至规划转角βk处,k=1,2,…,l,其中有l∈N,且N≥2,
以双轴倾角仪检测动平台的实际转角信息,进而获得动平台绕y轴的定位转角误差△βi,k(y)及绕x轴的转角误差△αi,k(y),依据动平台位姿误差子集信息△βi,k(y)和△αi,k(y),构建参数辨识方程,其数学描述如公式(3)所示;
△θ(y)=Hy·△ε……………………(3)
其中:
△θi(y)为在第i组测量位形中,由各测量位形下动平台姿态误差子集△βi,k(y)和△αi,k(y),k=1,2,…,l,信息组成的列矢量;
△θ(y)是由m组测量位形中△θi(y)组成的列矢量;
Jα_i,k(y)为第i组测量位形中第k测量位形下,与动平台绕x轴的转角误差对应的误差映射矢量;
Jβ_i,k(y)为第i组测量位形中第k测量位形下,与动平台绕y轴的定位转角误差对应的误差映射矢量;
Hy,i为第i组测量位形中,由与△θi(y)中各元素所对应的误差映射矢量组成的矩阵;
Hy是由各测量位形下Hy,i组成的矩阵;
m,n,l之间满足:m×(n+l)>>rank(ε),其中rank(ε)为待辨识参数的独立个数。
5.根据权利要求1所述的一种3RPS并联机器人几何参数辨识方法,其特征在于,所述步骤(4)中所述约束方程组的构建,包含如下内容:
首先,依据标定坐标系O-uvw与工作参考系B-xyz间的位置关系建立第一类约束方程,由于双轴倾角仪安装的位置精度对于动平台绕x,y轴的转角信息的测量精度并无影响,因此可以认为标定坐标系O-uvw与工作坐标系B-xyz之间无位置误差,则第一类约束方程组如公式(4)所示:
0=Jr0·△ε……………………(4)
其中:
Jr0为在初始位形下,并联机器人末端运动平台的位置误差映射矩阵;
其次,依据标定坐标系O-uvw与工作参考系B-xyz间的姿态关系构建第二类约束方程,以千分表为检测工具,通过千分表表头在定位板两个表面沿某轴向移动过程中的变化量,得到标定坐标系O-uvw与工作参考系B-xyz之间的姿态误差为△α0,△β0,△γ0,由此构建如公式(5)所示的第二组约束方程:
△θ0=Jθ0·△ε……………………(5)
其中:
△θ0=[△α0 △β0 △γ0]T
Jθ0为初始位形下,3RPS并联机器人动平台姿态误差映射矩阵。
6.根据权利要求5所述的一种3RPS并联机器人几何参数辨识方法,其特征在于,所述千分表为检测工具,计算得到标定坐标系O-uvw与工作参考系B-xyz之间的姿态误差为△α0,△β0,△γ0,包含如下内容:
以千分表表头接触定位板a面,沿y方向运动距离△sa,y,千分表表头在沿x方向的增量为△xa,y;以千分表表头接触定位板b面,沿x方向运动距离△sb,x,千分表表头在沿z方向的增量为△zb,x;以千分表表头接触定位板b面,沿y方向运动距离△sb,y,千分表表头在沿z方向的增量为△zb,y
令标定坐标系O-uvw与工作参考系B-xyz之间的姿态误差为△α0,△β0,△γ0,依据刚体位姿变换关系,可以得出公式(6)
<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>&amp;Delta;&amp;gamma;</mi> <mn>0</mn> </msub> <mo>=</mo> <mo>-</mo> <mfrac> <mrow> <msub> <mi>&amp;Delta;x</mi> <mrow> <mi>a</mi> <mo>,</mo> <mi>y</mi> </mrow> </msub> </mrow> <mrow> <msub> <mi>&amp;Delta;s</mi> <mrow> <mi>a</mi> <mo>,</mo> <mi>y</mi> </mrow> </msub> </mrow> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>&amp;Delta;&amp;beta;</mi> <mn>0</mn> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mrow> <msup> <mrow> <mo>(</mo> <msub> <mi>&amp;Delta;&amp;gamma;</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <mn>1</mn> </mrow> </mfrac> <mo>&amp;CenterDot;</mo> <mrow> <mo>(</mo> <msub> <mi>&amp;Delta;&amp;gamma;</mi> <mn>0</mn> </msub> <mo>&amp;CenterDot;</mo> <mfrac> <mrow> <msub> <mi>&amp;Delta;z</mi> <mrow> <mi>b</mi> <mo>,</mo> <mi>y</mi> </mrow> </msub> </mrow> <mrow> <msub> <mi>&amp;Delta;s</mi> <mrow> <mi>b</mi> <mo>,</mo> <mi>y</mi> </mrow> </msub> </mrow> </mfrac> <mo>-</mo> <mfrac> <mrow> <msub> <mi>&amp;Delta;z</mi> <mrow> <mi>b</mi> <mo>,</mo> <mi>x</mi> </mrow> </msub> </mrow> <mrow> <msub> <mi>&amp;Delta;s</mi> <mrow> <mi>b</mi> <mo>,</mo> <mi>x</mi> </mrow> </msub> </mrow> </mfrac> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>&amp;Delta;&amp;alpha;</mi> <mn>0</mn> </msub> <mo>=</mo> <mfrac> <mrow> <msub> <mi>&amp;Delta;z</mi> <mrow> <mi>b</mi> <mo>,</mo> <mi>y</mi> </mrow> </msub> </mrow> <mrow> <msub> <mi>&amp;Delta;s</mi> <mrow> <mi>b</mi> <mo>,</mo> <mi>y</mi> </mrow> </msub> </mrow> </mfrac> <mo>-</mo> <mfrac> <mrow> <msub> <mi>&amp;Delta;&amp;gamma;</mi> <mn>0</mn> </msub> </mrow> <mrow> <msup> <mrow> <mo>(</mo> <msub> <mi>&amp;Delta;&amp;gamma;</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <mn>1</mn> </mrow> </mfrac> <mo>&amp;CenterDot;</mo> <mrow> <mo>(</mo> <msub> <mi>&amp;Delta;&amp;gamma;</mi> <mn>0</mn> </msub> <mo>&amp;CenterDot;</mo> <mfrac> <mrow> <msub> <mi>&amp;Delta;z</mi> <mrow> <mi>b</mi> <mo>,</mo> <mi>y</mi> </mrow> </msub> </mrow> <mrow> <msub> <mi>&amp;Delta;s</mi> <mrow> <mi>b</mi> <mo>,</mo> <mi>y</mi> </mrow> </msub> </mrow> </mfrac> <mo>-</mo> <mfrac> <mrow> <msub> <mi>&amp;Delta;z</mi> <mrow> <mi>b</mi> <mo>,</mo> <mi>x</mi> </mrow> </msub> </mrow> <mrow> <msub> <mi>&amp;Delta;s</mi> <mrow> <mi>b</mi> <mo>,</mo> <mi>x</mi> </mrow> </msub> </mrow> </mfrac> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mn>...</mn> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>
由此综合公式(4)、(5)、(6),得到如公式(7)所示的约束方程组,由于约束方程组是基于标定坐标系O-uvw与工作参考系B-xyz之间实际刚体位移信息而构建的,因此该约束方程与辨识方程组具有相容性;
△x0=H0·△ε……………………(7)
其中:
7.根据权利要求1所述的一种3RPS并联机器人几何参数辨识方法,其特征在于,所述步骤(5)包含如下内容:
结合前述步骤(3)和(4),构建包含辨识方程方程组和约束方程组的完备辨识方程组,其数学描述如公式(8)所示:
△x=H·△ε……………………(8)
其中:
解算该完备参数辨识方程组,可获得如下公式(9)待辨识参数的极小范数解:
△ε=CT·(BT·H·CT)-1·BT……………………(9)
其中:H=B·C即B、C为H的一个满秩分解。
CN201710156497.XA 2017-03-15 2017-03-15 一种3rps并联机器人几何参数辨识方法 Expired - Fee Related CN106813638B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710156497.XA CN106813638B (zh) 2017-03-15 2017-03-15 一种3rps并联机器人几何参数辨识方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710156497.XA CN106813638B (zh) 2017-03-15 2017-03-15 一种3rps并联机器人几何参数辨识方法

Publications (2)

Publication Number Publication Date
CN106813638A CN106813638A (zh) 2017-06-09
CN106813638B true CN106813638B (zh) 2018-05-18

Family

ID=59115056

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710156497.XA Expired - Fee Related CN106813638B (zh) 2017-03-15 2017-03-15 一种3rps并联机器人几何参数辨识方法

Country Status (1)

Country Link
CN (1) CN106813638B (zh)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110815206B (zh) * 2018-08-14 2022-11-29 中国科学院沈阳自动化研究所 一种Stewart型并联机器人运动学标定方法
CN110532618B (zh) * 2019-07-29 2022-05-31 中国科学院长春光学精密机械与物理研究所 一种基于约束最优化方法的大刚体位移参量计算方法
CN110977940B (zh) * 2019-11-28 2021-04-23 清华大学 并混联机器人的几何误差建模方法及装置
CN111716331A (zh) * 2020-06-28 2020-09-29 中国科学院长春光学精密机械与物理研究所 一种六自由度并联机构参数标定装置及方法
CN112775935B (zh) * 2020-12-14 2022-03-15 华南理工大学 一种基于末端误差检测信息子集的并联机器人标定方法
CN113119126B (zh) * 2021-04-19 2021-11-23 广东工业大学 基于灵敏度迭代步长规划的运动学标定方法及标定系统
CN113514017B (zh) * 2021-05-06 2022-08-16 南京理工大学 一种并联驱动机构动平台位姿测量方法
CN114683249B (zh) * 2022-03-07 2024-03-22 诺创智能医疗科技(杭州)有限公司 并联机构的位姿确定方法及装置
CN115953477B (zh) * 2022-12-20 2024-05-14 苏州方石科技有限公司 坐标数据处理方法和装置

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN203662948U (zh) * 2013-04-15 2014-06-25 萨班吉大学 不触地、可穿戴且可重构的脚踝治疗和测量外骨骼装置
ES1096032Y (es) * 2013-05-15 2014-03-11 Sabanci Univ (100 0%) Dispositivo de exoesqueleto de medición y terapia para el tobillo, reconfigurable
CN106599371B (zh) * 2016-11-16 2020-04-24 北京科诺博奥机器人科技有限公司 一般三支链并联机构全参数标定方法

Also Published As

Publication number Publication date
CN106813638A (zh) 2017-06-09

Similar Documents

Publication Publication Date Title
CN106813638B (zh) 一种3rps并联机器人几何参数辨识方法
CN107042528B (zh) 一种工业机器人的运动学标定系统及方法
CN103389038B (zh) 激光跟踪仪定目标多站测量的数控机床几何精度检测方法
CN105945948B (zh) 一种应用于工业机器人的tcp在线快速标定方法及装置
CN106625573B (zh) 一种五自由度混联机器人直接误差补偿技术
CN105136031A (zh) 一种五轴联动机床旋转轴的几何误差连续测量方法
CN100504687C (zh) 用于测量、补偿和测试数控机床头和/或工作台的系统和方法
CN109822574A (zh) 一种工业机器人末端六维力传感器标定的方法
CN107042527A (zh) 一种基于三维力传感器的工业机器人标定装置及标定方法
CN109238199B (zh) 一种机器人旋转轴运动学参数标定方法
CN109304730A (zh) 一种基于激光测距仪的机器人运动学参数标定方法
Zhang et al. A general strategy for geometric error identification of multi-axis machine tools based on point measurement
CN106078359B (zh) 一种龙门式多主轴制孔组合机床的零点定义与标定方法
CN105960571A (zh) 通过使用惯性传感器校准运动系统的位置
CN103499293B (zh) 一种数控机床的激光跟踪仪虚拟多站式测量方法
CN108890645A (zh) 一种五自由度混联机器人驱动关节零点误差的补偿方法
CN204893581U (zh) 一种五轴联动机床旋转轴的几何误差连续测量装置
CN106097395B (zh) 一种基于直线位移传感器的工业机器人运动学参数的标定方法
CN103234496B (zh) 一种三坐标测量机二维平台误差的高精度校正方法
CN103673976A (zh) 复合式精度测量坐标系的转换与统一方法及系统
CN104890013A (zh) 一种基于拉线编码器的工业机器人标定算法
CN104308657A (zh) 一种基于球杆仪测量的机床旋转轴几何误差六圈辨识方法
CN108340210A (zh) 一种基于球杆仪测量的多轴机床几何误差辨识方法
CN103206932A (zh) 五轴工具机械的几何误差评估方法
CN105371793A (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
CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20180518

Termination date: 20190315