《多关节坐标测量机的误差模型.doc》由会员分享，可在线阅读，更多相关《多关节坐标测量机的误差模型.doc（7页珍藏版）》请在金锄头文库上搜索。
1、多关节坐标测量机的误差模型叶东黄庆成车仁生摘要：按Denavit-Hartenberg方法，建立了多关节坐标测量机末端测头中心相对于机座参考坐标系的测量运动的数学模型。在此基础上，运用矩阵函数的全微分方法，建立起末端测头中心坐标误差与测量运动模型参数误差之间的传递关系。为进一步研究多关节坐标测量机的标定和补偿奠定了理论基础。关键词：坐标测量机关节误差模型A Error Model for Multi-joint Coordinate Measuring MachineYE Dong,HUANG ,（Dept. of Precision Instruments, Harbin Institute
2、 of Technology,Harbin 150001)Qing-Cheng（Dept. of Precision Instruments, Harbin Institute of Technology,Harbin 150001)CHE Ren-Sheng（Dept. of Precision Instruments, Harbin Institute of Technology,Harbin 150001)Abstract：By using homogenous coordinate transformation principle and Denavit-Hartenberg anal
3、ysis method，a measurement kinematics model and a error model for multi-joint coordinate measuring machine，of which the movement of the probe center is relative to machine reference frame，is constructed. And the model is validated by contrast between the theory calculation and actual errors. It estab
4、lishes firm theory base for deeply developing calibration method for multi-joint coordinate measuring machine.Key words：Coordinate measuring machine，Joints，Kinematics model， Error model1引言多关节坐标测量机是一种新型的非笛卡尔式的坐标测量机1，2。与普通的笛卡尔式三坐标测量机相比，具有机械结构简单、体积小、测量范围大和灵活方便等特点，主要应用在逆向工程中作为三维数字化工具，以及在现场对大型零部件的几何尺寸测量等
5、领域。尽管多关节坐标测量机是一种非常有前途的便携式坐标测量机，但测量精度低是其非常致命的弱点，在很大程度上，影响了多关节坐标测量机广泛应用。产生误差的主要原因如下：.多关节坐标测量机是仿照人的腰关节、肩关节、肘关节和腕关节结构，将一系列杆件通过旋转关节串联连接，以角度测量基准取代长度基准；.由于各杆件、关节等零部件存在加工工艺误差，仪器装配后，多关节坐标测量机结构参数偏离理论设计值比较大，且很难将参数误差控制在一定范围内；.这种旋转关节和长杆件结构，对于各杆件参数误差在传递到末端测头上时具有很大的放大作用。 因此，研究并建立起末端测头中心坐标误差与各杆件和关节的参数误差之间的传递关系是必要的。
6、这将为进一步提高多关节坐标测量机的测量精度奠定理论基础。本文将在建立起多关节坐标测量机测量运动模型基础上，运用矩阵全微分方法，来分析误差，建立误差模型，最后通过计算机仿真验证该误差模型的正确性。2杆件间相对位姿的描述 多关节坐标测量机是多杆件串联系统，两杆件间的相对位姿描述是最终求得测头位姿矩阵的基础。它取决于两杆件之间的结构参数、运动形式和运动参数。为分析两相邻杆件的相互关系，首先建立杆件的坐标系。 Denavit和Hartenberg在1955年提出了对两个相互连接且相对运动的构件建立两个特殊坐标系的方法，给两杆件相对运动的研究带来方便3。如图1所示，设杆件i，其与杆件i-1通过关节i相连
7、，与杆件i+1通过关节i+1相连。按Denavit-Hartenberg（简称D-H）的方法，杆件i坐标系OiXiYiZi的坐标原点设在关节i的轴线和关节i+1的轴线的公垂线DiOi与关节i+1的轴线相交处，Zi轴与关节i+1的轴线重合，Xi轴与上述公垂线重合，且方向从关节i指向关节i+1，Yi轴按右手法则确定。由图1可以看出，一个杆件有四个参数。其中两个参数为杆件本身参数，一个是两关节轴线沿公垂线的距离ai，称为杆件长度；另一个是垂直于ai的平面内两个关节轴线的夹角ai，称为杆件扭角。还有两个参数表示相邻杆件的相互关系，一个是沿关节i轴线的两个公垂线的距离i；另一个是垂直于关节i轴线的平面内
8、两公垂线的夹角qi，即Xi 和Xi-1之间的夹角。Fig.1Interrelation of Arms在用D-H法建立了杆件坐标系后，Oi-1Xi-1Yi-1Zi-1与OiXiYiZi之间的变换可以用坐标系的平移、旋转来实现。可先令Oi-1Xi-1Yi-1Zi-1绕Zi-1轴旋转i角，再沿轴Zi-1平移di，然后沿Xi轴移动ai，最后绕Xi轴旋转ai角，使Oi-1Xii-1Yi-1Zi-1与OiXiYiZi重合。用变换矩阵表示，则有（1）式中，Ri和qi分别是33旋转矩阵、31平移矢量。3测量运动模型多关节坐标测量机从机械结构上可以看成是一个开式运动链，它是六个杆件和一个测杆通过六个旋转关节串
9、联而成。开链的一端固定在机座上，另一端是自由的，安装测头，其结构简图如图2所示。Fig.2Diagram of Multi-joint coordinate measuring machine图中，各杆件坐标系按D-H方法建立。O0X0Y0Z0是机座参考坐标系,杆件1相对于机座参考坐标系O0X0Y0Z0的位姿矩阵记作T01。杆件2相对于杆件1坐标系O1X1Y1Z1的位姿矩阵记作T12。杆件2相对于机座参考坐标系O0X0Y0Z0的位姿矩阵是T01和T12乘积，记作T02。依此类推，测头坐标系相对于机座参考坐标系O0X0Y0Z0的位姿矩阵记作T07，一个44齐次矩阵，即T07T01T12T23T3
10、4T45T56T67（2）式中，T01，T67由式（1）确定。多关节坐标测量机的结构是特殊的，即相邻关节轴线相互垂直且相交于一点，因此，参数ai、i、di都是固定的常数，称为杆件结构参数，而i是变化的，称为关节变量。在式（2）中，T07反映了测头在空间相对于基坐标系的坐标位置和姿态。对于多关节坐标机来说，我们只关心测头在空间的坐标位置矢量，而不需要了解测头的空间姿态。这里，设测头中心位置矢量记作P=（x，y，z）T。根据式（1）和式（2）可以写出测头中心位置的测量运动方程：P（R1R2R3R4R5R6）q7+(R1R2R3R4R5）q6+(R1R2R3R4）q5（R1R2R3）q4+(R1R2
11、）q3R1q2q1（3）式（3）测量运动方程包括三个坐标分量方程，他们都是各杆件的结构参数和各关节变量的函数，因此，式（3）可简写成矢量函数形式，即P=f(a,d,，）（4）这里，a=(a1a2a3a4a5a6）T，d(d1d2d3d4d5d6d7）T（123456）T，（123456）TP（pxpypz)Tf（fxfyfz)T4误差模型多关节坐标测量机测头中心的坐标误差P主要是由各杆件的结构参数误差（di，i，i）和关节变量误差i所决定的。i是由于在多关节坐标测量机装配过程中，角度光学编码器的零位与理论模型中关节旋转零位不重合而产生的零位偏置误差；di反映的是杆件长度误差；ai是由于相邻关节
12、的旋转轴线不相交于一点而产生的误差；i是两相邻杆件不垂直产生的角度误差。假设这些参数误差足够小，对式（4）进行全微分，可近似得到测头的空间坐标误差方程（5）其中，将式（5）用矩阵方式简单描述，即PJ（6）这里，P（pxpypz)TJ是一个325的误差系数矩阵，即（7）是一个251的误差参数矢量，即（16d1d7616）T（8）5仿真验证为了验证误差模型的正确性，采用计算机仿真方法，步骤如下：（1） 设定各杆件结构参数的理论值和误差值，如表1所示。Table 1Normal parameters and actual errors of linkslinkNo.aimmaimmdimmdimmi
13、radiradirad100.10100-0.05-/20.00100.001420-0.08150 0.11/2 0.0014-0.002330-0.124500.06/2-0.00120.0017400.03100 0.13-/20.00170.001050 0.07350-0.04-/20.0010-0.001460-0.141000.05/2-0.00100.0010700150-0.03000（2） 取20组关节变量的组合，要求保证末端测头在整个测量空间尽可能地均匀分布。（3） 将表1中各杆件的理论参数、实际参数和20组关节变量分别代入式（3），计算20组理论坐标值和实际坐标值，并计
14、算出实际的空间坐标误差。（4） 将表1中的理论参数、参数误差和20组关节变量分别代入式（6）、（7）和（8），计算出测头的空间坐标误差。经过以上四步计算，其结果列于表2中。 Table 2Simulation resultsNo.Joint variable （） normal coordinates actual error error model（123456）P (mm) E(mm) P(mm)1（0 0 0 0 0 0） (0 150 1050)3.6483.6502(-90 10 10 90 10 10)(66.53 403.646 636.53) 3.9423.9523(-90 0 0 90 0 0)(150 500 550)4.0294.0414(90 90 90 90 90 90)(200 350 150)0.9490.9275(10 80 30 150 30 140)(211.979 145.894 287.833)1.3111.2936(90 70 90 130 40 30)(213.24 119.589 169.9
