主权项 |
一种关节式坐标测量机的高精度标定方法,所述标定方法包括如下步骤:以六自由度关节式坐标测量机作为待标定机,以测量机的基座为原点建立笛卡尔坐标系,以测量机的基座中心为圆心,将整圈圆周等分为多条等分线,多块标定板分别对应地摆放在所述多条等分线上;测量机对每个标定板上的多对锥孔中的每一个以不同姿态各采集多次数据,每个姿态对应得到一组关节角度和一个测头坐标,如此获得多组关节角度向量和多个测头坐标;根据测量得到的多个测头坐标值,分别计算各个标定板上的每对锥孔之间的两点点距数值;所述测头坐标是对应姿态的角度向量值与待标定机的结构参数向量的函数,因此,用θ<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><mrow><msub><mi>θ</mi><mrow><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>,</mo><mi>A</mi></mrow><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><mrow><msub><mi>θ</mi><mrow><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>,</mo><mi>A</mi></mrow><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><mrow><msub><mi>θ</mi><mrow><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mo>,</mo><mi>A</mi></mrow><mo>)</mo></mrow></mrow></mtd></mtr></mtable></mfenced><mo>...</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow><mo>;</mo></mrow>]]></math><img file="FDA0001187862750000011.GIF" wi="1654" he="230" /></maths>根据以上测点坐标方程,可写出每个测点x、y、z坐标的标准差公式:<maths num="0002"><math><![CDATA[<mrow><msub><mi>σ</mi><mi>x</mi></msub><mo>=</mo><msup><mrow><mo>[</mo><mfrac><mrow><munderover><mi>Σ</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>n</mi></munderover><msup><mrow><mo>(</mo><mrow><msub><mi>x</mi><mi>i</mi></msub><mo>-</mo><msub><mi>x</mi><mi>r</mi></msub></mrow><mo>)</mo></mrow><mn>2</mn></msup></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><mi>Σ</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>n</mi></munderover><msup><mrow><mo>(</mo><mrow><msub><mi>y</mi><mi>i</mi></msub><mo>-</mo><msub><mi>y</mi><mi>r</mi></msub></mrow><mo>)</mo></mrow><mn>2</mn></msup></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><mi>Σ</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>n</mi></munderover><msup><mrow><mo>(</mo><mrow><msub><mi>z</mi><mi>i</mi></msub><mo>-</mo><msub><mi>z</mi><mi>r</mi></msub></mrow><mo>)</mo></mrow><mn>2</mn></msup></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><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow><mo>;</mo></mrow>]]></math><img file="FDA0001187862750000012.GIF" wi="1710" he="299" /></maths>其中x<sub>r</sub>,y<sub>r</sub>,z<sub>r</sub>是测点i在x、y、z三坐标方向上的坐标真值,将全部m个测点的标准差求和,即<maths num="0003"><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>m</mi></munderover><mrow><mo>(</mo><msubsup><mi>σ</mi><mi>x</mi><mi>i</mi></msubsup><mo>+</mo><msubsup><mi>σ</mi><mi>y</mi><mi>i</mi></msubsup><mo>+</mo><msubsup><mi>σ</mi><mi>z</mi><mi>i</mi></msubsup><mo>)</mo></mrow><mo>...</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow><mo>;</mo></mrow>]]></math><img file="FDA0001187862750000013.GIF" wi="1470" he="127" /></maths>将各个标定板在测点i处的两点点距值L<sub>i</sub>与点距真值L<sub>r</sub>相减,求标准差并求和,公式如下:<maths num="0004"><math><![CDATA[<mrow><msub><mi>σ</mi><mi>L</mi></msub><mo>=</mo><msup><mrow><mo>[</mo><mfrac><mrow><munderover><mi>Σ</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>n</mi></munderover><msup><mrow><mo>(</mo><msub><mi>L</mi><mi>i</mi></msub><mo>-</mo><msub><mi>L</mi><mi>r</mi></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow><mi>n</mi></mfrac><mo>]</mo></mrow><mrow><mn>1</mn><mo>/</mo><mn>2</mn></mrow></msup><mo>,</mo><msub><mi>δ</mi><mi>L</mi></msub><mo>=</mo><munderover><mi>Σ</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>m</mi></munderover><msubsup><mi>σ</mi><mi>L</mi><mi>i</mi></msubsup><mo>...</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow><mo>;</mo></mrow>]]></math><img file="FDA0001187862750000014.GIF" wi="1548" he="453" /></maths>其中,n为每一测点处测量得到的测头坐标数,m为测点数量,最终将δ<sub>xyz</sub>与δ<sub>L</sub>相加作为二次非线性规划问题的目标函数,即:<maths num="0005"><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><mi>A</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>δ</mi><mi>L</mi></msub><mrow><mo>(</mo><mi>A</mi><mo>)</mo></mrow></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><mo>...</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow><mo>;</mo></mrow>]]></math><img file="FDA0001187862750000021.GIF" wi="1565" he="174" /></maths>利用序列二次规划算法即可求出关节式坐标测量机的结构参数误差值,然后即可根据所得到的结构参数误差值,进行标定。 |