主权项 |
一种关节式坐标测量机的高精度标定方法,所述标定方法包括如下步骤:第一步,采样:1)将待标定机平稳安放在高精度正交式三坐标测量机工作平台上,使标定机置于高精度三坐标测量机的测量空间中;2)以待标定机基座中心为原点,以第1级关节的光栅编码器的零位指向作为x轴,建立待标定机的测头坐标系o<sub>0</sub>x<sub>0</sub>y<sub>0</sub>,利用高精度三坐标测量机建立工件坐标系,即基准坐标系o<sub>w</sub>x<sub>w</sub>y<sub>w</sub>,使其与o<sub>0</sub>x<sub>0</sub>y<sub>0</sub>原点大致重合;3)将以关节式坐标测量机基座中心为圆心,以第1级关节的零位指向作为0度的圆等分,将多块标定板对应地分别摆放在多条等分线上;4)在每个标定板上选一或多个锥孔,将测头探入锥孔,使测头球与锥孔壁完全接触,然后在关节活动范围内任意旋转6个关节,使测量机能够以不同姿态多次测量作为测点的每一个锥孔,每个姿态对应得到由六个关节角度构成的一组关节角度和一个测头坐标,如此获得每个测点的关节角度向量及测头坐标;5)使用正交坐标测量机测量当前被测锥孔的坐标,作为采样数据中的基准坐标;第二步,数据处理:1)测头在待标定机坐标系下的测头坐标是对应姿态的角度向量值与测量机结构参数向量的函数,因此,用θ<sub>i,j</sub>表征测点i第j次测量的角度向量,A表征结构参数向量,则测点i在第j次测量的测头坐标表示为:<maths num="0001"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msubsup><mi>l</mi><mrow><mi>i</mi><mo>,</mo><mi>j</mi></mrow><mi>x</mi></msubsup><mo>=</mo><msub><mi>f</mi><mi>x</mi></msub><mrow><mo>(</mo><msub><mi>θ</mi><mrow><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>,</mo><mi>A</mi><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>l</mi><mrow><mi>i</mi><mo>,</mo><mi>j</mi></mrow><mi>y</mi></msubsup><mo>=</mo><msub><mi>f</mi><mi>y</mi></msub><mrow><mo>(</mo><msub><mi>θ</mi><mrow><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>,</mo><mi>A</mi><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>l</mi><mrow><mi>i</mi><mo>,</mo><mi>j</mi></mrow><mi>z</mi></msubsup><mo>=</mo><msub><mi>f</mi><mi>z</mi></msub><mrow><mo>(</mo><msub><mi>θ</mi><mrow><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>,</mo><mi>A</mi><mo>)</mo></mrow></mrow></mtd></mtr></mtable></mfenced><mn>...</mn><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow><mo>;</mo></mrow>]]></math><img file="FDA0001128756310000011.GIF" wi="1646" he="386" /></maths>2)将使得待标定机的测头坐标系与正交式三坐标测量机的基准坐标系两者进行坐标转换的旋转平移矩阵T、以及从角度编码器偏心参数向量中剔除与结构参数重合的参数后的偏心参数向量P<sup>*</sup>,代入测量机的运动学方程进行补偿,因此,在此测点的测头坐标与基准坐标在x、y、z方向的坐标误差可表示为<maths num="0002"><math><![CDATA[<mrow><mtable><mtr><mtd><mrow><msubsup><mi>Δ</mi><mrow><mn>1</mn><mo>,</mo><mn>1</mn></mrow><mi>x</mi></msubsup><mo>=</mo><msub><mi>f</mi><mi>x</mi></msub><mrow><mo>(</mo><msub><mi>θ</mi><mrow><mn>1</mn><mo>,</mo><mn>1</mn></mrow></msub><mo>,</mo><msup><mi>P</mi><mo>*</mo></msup><mo>,</mo><mi>T</mi><mo>,</mo><mi>A</mi><mo>)</mo></mrow><mo>-</mo><msubsup><mi>x</mi><mi>T</mi><mi>i</mi></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>Δ</mi><mrow><mn>1</mn><mo>,</mo><mn>1</mn></mrow><mi>y</mi></msubsup><mo>=</mo><msub><mi>f</mi><mi>y</mi></msub><mrow><mo>(</mo><msub><mi>θ</mi><mrow><mn>1</mn><mo>,</mo><mn>1</mn></mrow></msub><mo>,</mo><msup><mi>P</mi><mo>*</mo></msup><mo>,</mo><mi>T</mi><mo>,</mo><mi>A</mi><mo>)</mo></mrow><mo>-</mo><msubsup><mi>y</mi><mi>T</mi><mi>i</mi></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>Δ</mi><mrow><mn>1</mn><mo>,</mo><mn>1</mn></mrow><mi>z</mi></msubsup><mo>=</mo><msub><mi>f</mi><mi>z</mi></msub><mrow><mo>(</mo><msub><mi>θ</mi><mrow><mn>1</mn><mo>,</mo><mn>1</mn></mrow></msub><mo>,</mo><msup><mi>P</mi><mo>*</mo></msup><mo>,</mo><mi>T</mi><mo>,</mo><mi>A</mi><mo>)</mo></mrow><mo>-</mo><msubsup><mi>z</mi><mi>T</mi><mi>i</mi></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>Δ</mi><mrow><mn>1</mn><mo>,</mo><mn>2</mn></mrow><mi>x</mi></msubsup><mo>=</mo><msub><mi>f</mi><mi>x</mi></msub><mrow><mo>(</mo><msub><mi>θ</mi><mrow><mn>1</mn><mo>,</mo><mn>2</mn></mrow></msub><mo>,</mo><msup><mi>P</mi><mo>*</mo></msup><mo>,</mo><mi>T</mi><mo>,</mo><mi>A</mi><mo>)</mo></mrow><mo>-</mo><msubsup><mi>x</mi><mi>T</mi><mi>i</mi></msubsup></mrow></mtd></mtr><mtr><mtd><mn>......</mn></mtd></mtr><mtr><mtd><mrow><msubsup><mi>Δ</mi><mrow><mn>6</mn><mo>,</mo><mn>50</mn></mrow><mi>x</mi></msubsup><mo>=</mo><msub><mi>f</mi><mi>x</mi></msub><mrow><mo>(</mo><msub><mi>θ</mi><mrow><mn>6</mn><mo>,</mo><mn>50</mn></mrow></msub><mo>,</mo><msup><mi>P</mi><mo>*</mo></msup><mo>,</mo><mi>T</mi><mo>,</mo><mi>A</mi><mo>)</mo></mrow><mo>-</mo><msubsup><mi>x</mi><mi>T</mi><mi>i</mi></msubsup></mrow></mtd></mtr></mtable><mn>...</mn><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow><mo>,</mo></mrow>]]></math><img file="FDA0001128756310000021.GIF" wi="1950" he="726" /></maths><img file="FDA0001128756310000022.GIF" wi="334" he="87" />表示第i个测点在x、y、z方向的基准坐标;3)对方程组(2)求解可得出待标定机的结构参数向量A、角度编码器偏心参数向量P<sup>*</sup>、旋转平移矩阵T,具体步骤为:根据以上测点坐标方程,可写出每个测点x、y、z坐标的标准差公式:<maths num="0003"><math><![CDATA[<mrow><msub><mi>σ</mi><mi>x</mi></msub><mo>=</mo><msup><mrow><mo>[</mo><mfrac><mrow><munderover><mo>Σ</mo><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>n</mi></munderover><msubsup><mi>Δ</mi><mi>x</mi><mn>2</mn></msubsup></mrow><mrow><mi>n</mi><mo>-</mo><mn>1</mn></mrow></mfrac><mo>]</mo></mrow><mrow><mn>1</mn><mo>/</mo><mn>2</mn></mrow></msup><mo>,</mo><msub><mi>σ</mi><mi>y</mi></msub><mo>=</mo><msup><mrow><mo>[</mo><mfrac><mrow><munderover><mo>Σ</mo><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>n</mi></munderover><msubsup><mi>Δ</mi><mi>y</mi><mn>2</mn></msubsup></mrow><mrow><mi>n</mi><mo>-</mo><mn>1</mn></mrow></mfrac><mo>]</mo></mrow><mrow><mn>1</mn><mo>/</mo><mn>2</mn></mrow></msup><mo>,</mo><msub><mi>σ</mi><mi>z</mi></msub><mo>=</mo><msup><mrow><mo>[</mo><mfrac><mrow><munderover><mo>Σ</mo><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>n</mi></munderover><msubsup><mi>Δ</mi><mi>x</mi><mn>2</mn></msubsup></mrow><mrow><mi>n</mi><mo>-</mo><mn>1</mn></mrow></mfrac><mo>]</mo></mrow><mrow><mn>1</mn><mo>/</mo><mn>2</mn></mrow></msup><mn>...</mn><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow><mo>,</mo></mrow>]]></math><img file="FDA0001128756310000023.GIF" wi="1699" he="334" /></maths>将测点的标准差求和,即<maths num="0004"><math><![CDATA[<mrow><msub><mi>δ</mi><mrow><mi>x</mi><mi>y</mi><mi>z</mi></mrow></msub><mo>=</mo><munderover><mo>Σ</mo><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>n</mi></munderover><mrow><mo>(</mo><msubsup><mi>σ</mi><mi>x</mi><mi>i</mi></msubsup><mo>(</mo><mrow><msup><mi>P</mi><mo>*</mo></msup><mo>,</mo><mi>T</mi><mo>,</mo><mi>A</mi></mrow><mo>)</mo><mo>)</mo></mrow><mo>+</mo><mrow><mo>(</mo><msubsup><mi>σ</mi><mi>y</mi><mi>i</mi></msubsup><mo>(</mo><mrow><msup><mi>P</mi><mo>*</mo></msup><mo>,</mo><mi>T</mi><mo>,</mo><mi>A</mi></mrow><mo>)</mo><mo>)</mo></mrow><mo>+</mo><mrow><mo>(</mo><msubsup><mi>σ</mi><mi>z</mi><mi>i</mi></msubsup><mo>(</mo><mrow><msup><mi>P</mi><mo>*</mo></msup><mo>,</mo><mi>T</mi><mo>,</mo><mi>A</mi></mrow><mo>)</mo><mo>)</mo></mrow><mo>...</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow><mo>,</mo></mrow>]]></math><img file="FDA0001128756310000024.GIF" wi="1957" he="143" /></maths>在n个测点中,取任意两个点i、j的平均计算坐标值,计算两点间距离L<sub>ij</sub>,与基准坐标系下获得的点距真值相减可获得长度误差值,求标准差并求和,公式如下:<maths num="0005"><math><![CDATA[<mrow><msub><mi>δ</mi><mi>L</mi></msub><mo>=</mo><munderover><mo>Σ</mo><mrow><mi>i</mi><mo>,</mo><mi>j</mi><mo>=</mo><mn>1</mn></mrow><mi>n</mi></munderover><mrow><mo>(</mo><msub><mi>L</mi><mrow><mi>i</mi><mi>j</mi></mrow></msub><mo>(</mo><mrow><msup><mi>P</mi><mo>*</mo></msup><mo>,</mo><mi>T</mi><mo>,</mo><mi>A</mi></mrow><mo>)</mo><mo>-</mo><msubsup><mi>L</mi><mrow><mi>i</mi><mi>j</mi></mrow><mi>T</mi></msubsup><mo>)</mo></mrow><mo>,</mo><mi>i</mi><mo>≠</mo><mi>j</mi><mo>...</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow><mo>,</mo></mrow>]]></math><img file="FDA0001128756310000025.GIF" wi="1838" he="151" /></maths>其中<img file="FDA0001128756310000031.GIF" wi="61" he="78" />为点距真值,最终将δ<sub>xyz</sub>与δ<sub>L</sub>相加作为二次型非线性规划问题的目标函数,即:<maths num="0006"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><mi>minδ</mi><mrow><mi>x</mi><mi>y</mi><mi>z</mi></mrow></msub><mrow><mo>(</mo><msup><mi>P</mi><mo>*</mo></msup><mo>,</mo><mi>T</mi><mo>,</mo><mi>A</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>δ</mi><mi>L</mi></msub><mrow><mo>(</mo><msup><mi>P</mi><mo>*</mo></msup><mo>,</mo><mi>T</mi><mo>,</mo><mi>A</mi><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msubsup><mi>P</mi><mi>min</mi><mo>*</mo></msubsup><mo>≤</mo><msup><mi>P</mi><mo>*</mo></msup><mo>≤</mo><msubsup><mi>P</mi><mi>max</mi><mo>*</mo></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>T</mi><mi>min</mi></msub><mo>≤</mo><mi>T</mi><mo>≤</mo><msub><mi>T</mi><mi>max</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>A</mi><mi>min</mi></msub><mo>≤</mo><mi>A</mi><mo>≤</mo><msub><mi>A</mi><mi>max</mi></msub></mrow></mtd></mtr></mtable></mfenced><mn>...</mn><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow><mo>,</mo></mrow>]]></math><img file="FDA0001128756310000032.GIF" wi="1838" he="447" /></maths>再利用序列二次规划算法对待标定量进行无约束非线性规划最小二乘求解,即可求出关节式坐标测量机的结构参数以及角度编码器偏心参数向量;根据所得到的结构参数以及角度编码器偏心参数向量,进行标定。 |