发明名称 一种二维大行程精密工作台测量系统自标定方法
摘要 一种二维大行程精密工作台测量系统自标定方法,属于精密加工及测量领域。该方法利用自标定原理,通过使用带均匀栅格的玻璃板做辅助测量装置,将二维工作台按区域分别进行自标定,获取各区域的系统误差;对相应区域做系统误差补偿,获得标定坐标系的离散点坐标;对各区域离散点坐标进行线性拟合,得到标定坐标系网格;利用坐标系变换原理,分别对相领区域的标定坐标系进行坐标系转换,获得整个区域内统一的标定坐标系,最终完成二维大行程精密工作台测量系统自标定。本发明实现了二维工作台的大行程、高精度自标定,同时实现了利用低精度栅格玻璃板标定高精度二维工作台的功能,不需要高精度标定工具,标定精度高,适用于标定各种二维精密工作台。
申请公布号 CN104006777A 申请公布日期 2014.08.27
申请号 CN201410256318.6 申请日期 2014.06.10
申请人 清华大学;北京华卓精科科技有限公司 发明人 胡楚雄;朱煜;徐振源;杨进;张鸣;穆海华;胡金春;徐登峰;尹文生;杨开明;刘召;成荣
分类号 G01B21/00(2006.01)I 主分类号 G01B21/00(2006.01)I
代理机构 北京鸿元知识产权代理有限公司 11327 代理人 邸更岩
主权项 一种二维大行程精密工作台测量系统自标定方法,所述自标定方法包括以下步骤:1)准备一块正方形光学玻璃板(5),在该玻璃板的X方向和Y方向分别刻N条直线刻线,形成均匀等分的N×N的栅格刻线,其中N为正整数,栅格刻线与理想刻线间的偏差记为辅助误差A<sub>m,n</sub>,其中m,n为刻线交点的X,Y坐标;选取二维工作台运动行程内某个区域作为首个被标定局部区域,将光学玻璃板(5)固定放置于被标定的二维工作台(1)上,作为起始位姿;在被标定的二维工作台(1)的X方向上装有X轴位置传感器(2),Y方向上装有Y轴位置传感器(3),Z轴方向上装有光学显微镜测量系统(4),其中光学玻璃板(5)的栅格刻线精度等于或小于被标定的二维工作台(1)的测量精度;2)在起始位姿中,利用Z轴方向上的光学显微镜测量系统(4),寻找并对准该位姿下光学玻璃板(5)上每个栅格刻线相交形成的交点,同时记录该位置下二维工作台(1)上的X轴位置传感器(2)和Y轴位置传感器(3)的读数,所得测量读数与交点坐标准确值之间的偏差记为V<sub>0,m,n</sub>,也即起始位姿下自标定模型:V<sub>0,m,n</sub>=G<sub>0,m,n</sub>+A<sub>m,n</sub>+E<sub>0,m,n</sub>+r<sub>0,m,n</sub>,其中:V<sub>0,m,n</sub>的脚标0表示起始位姿,G<sub>0,m,n</sub>为系统误差,E<sub>0,m,n</sub>为调整误差,r<sub>0,m,n</sub>为随机测量噪声;同理,再将光学玻璃板(5)进行90°旋转,测量并记录在旋转位姿下光学玻璃板上每个由网格刻线交点所对应的X轴位置传感器(2)、Y轴位置传感器(3)的读数,获得旋转位姿下的自标定模型:V<sub>1,m,n</sub>=G<sub>1,m,n</sub>+A<sub>m,n</sub>+E<sub>1,m,n</sub>+r<sub>1,m,n</sub>,其中:V<sub>1,m,n</sub>的脚标1表示旋转位姿;再将光学玻璃板(5)进行一个单位的平移,测量并记录平移位姿下光学玻璃板上每个由网格刻线交点所对应的X轴位置传感器(2)、Y轴位置传感器(3)的读数,获得平移位姿下的自标定模型:V<sub>2,m,n</sub>=G<sub>2,m,n</sub>+A<sub>m,n</sub>+E<sub>2,m,n</sub>+r<sub>2,m,n</sub>,其中:V<sub>2,m,n</sub>的脚标2表示旋转位姿;3)针对步骤2)中三种位姿记录下来的自标定模型,结合系统的对称性建立系统误差方程:<maths num="0001" id="cmaths0001"><math><![CDATA[<mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>F</mi><mrow><mi>x</mi><mo>,</mo><mi>m</mi><mo>,</mo><mi>n</mi></mrow></msub><mo>-</mo><msub><mi>F</mi><mrow><mi>y</mi><mo>,</mo><mo>-</mo><mi>n</mi><mo>,</mo><mi>m</mi></mrow></msub><mo>=</mo><msub><mi>U</mi><mrow><mn>0</mn><mo>,</mo><mi>x</mi><mo>,</mo><mi>m</mi><mo>,</mo><mi>n</mi></mrow></msub><mo>-</mo><msub><mi>U</mi><mrow><mn>1</mn><mo>,</mo><mi>y</mi><mo>,</mo><mi>m</mi><mo>,</mo><mi>n</mi></mrow></msub><mo>-</mo><mn>2</mn><mi>O</mi><msub><mi>y</mi><mi>n</mi></msub><mo>-</mo><mn>2</mn><mi>R</mi><msub><mi>x</mi><mi>m</mi></msub></mtd></mtr><mtr><mtd><msub><mi>F</mi><mrow><mi>y</mi><mo>,</mo><mi>m</mi><mo>,</mo><mi>n</mi></mrow></msub><mo>+</mo><msub><mi>F</mi><mrow><mi>x</mi><mo>,</mo><mo>-</mo><mi>n</mi><mo>,</mo><mi>m</mi></mrow></msub><mo>=</mo><msub><mi>U</mi><mrow><mn>0</mn><mo>,</mo><mi>y</mi><mo>,</mo><mi>m</mi><mo>,</mo><mi>n</mi></mrow></msub><mo>+</mo><msub><mi>U</mi><mrow><mn>1</mn><mo>,</mo><mi>x</mi><mo>,</mo><mi>m</mi><mo>,</mo><mi>n</mi></mrow></msub><mo>-</mo><mn>2</mn><mi>O</mi><msub><mi>x</mi><mi>m</mi></msub><mo>+</mo><mn>2</mn><mi>R</mi><msub><mi>y</mi><mi>n</mi></msub></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000518506920000011.GIF" wi="976" he="162" /></maths>结合系统的传递性性构建方程:<maths num="0002" id="cmaths0002"><math><![CDATA[<mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>F</mi><mrow><mi>x</mi><mo>,</mo><mi>m</mi><mo>+</mo><mn>1</mn><mo>,</mo><mi>n</mi></mrow></msub><mo>-</mo><msub><mi>F</mi><mrow><mi>x</mi><mo>,</mo><mi>m</mi><mo>,</mo><mi>n</mi></mrow></msub><mo>=</mo><msub><mi>U</mi><mrow><mn>2</mn><mo>,</mo><mi>x</mi><mo>,</mo><mi>m</mi><mo>,</mo><mi>n</mi></mrow></msub><mo>-</mo><msub><mi>U</mi><mrow><mn>0</mn><mo>,</mo><mi>y</mi><mo>,</mo><mi>m</mi><mo>,</mo><mi>n</mi></mrow></msub><mo>-</mo><mrow><msub><mi>&xi;</mi><mi>x</mi></msub><mo>-</mo><msub><mi>&xi;</mi><mi>&theta;</mi></msub><msub><mi>y</mi><mi>n</mi></msub></mrow></mtd></mtr><mtr><mtd><msub><mi>F</mi><mrow><mi>y</mi><mo>,</mo><mi>m</mi><mo>+</mo><mn>1</mn><mo>,</mo><mi>n</mi></mrow></msub><mo>+</mo><msub><mi>F</mi><mrow><mi>y</mi><mo>,</mo><mi>m</mi><mo>,</mo><mi>n</mi></mrow></msub><mo>=</mo><msub><mi>U</mi><mrow><mn>2</mn><mo>,</mo><mi>y</mi><mo>,</mo><mi>m</mi><mo>,</mo><mi>n</mi></mrow></msub><mo>+</mo><msub><mi>U</mi><mrow><mn>0</mn><mo>,</mo><mi>x</mi><mo>,</mo><mi>m</mi><mo>,</mo><mi>n</mi></mrow></msub><mo>-</mo><msub><mi>&xi;</mi><mi>y</mi></msub><mo>+</mo><msub><mi>&xi;</mi><mi>&theta;</mi></msub><msub><mi>x</mi><mi>m</mi></msub></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000518506920000012.GIF" wi="921" he="165" /></maths>结合系统的误差特性:<maths num="0003" id="cmaths0003"><math><![CDATA[<mfenced open='{' close=''><mtable><mtr><mtd><munder><mi>&Sigma;</mi><mrow><mi>m</mi><mo>,</mo><mi>n</mi></mrow></munder><msub><mi>F</mi><mrow><mi>x</mi><mo>,</mo><mi>m</mi><mo>,</mo><mi>n</mi></mrow></msub><mo>=</mo><munder><mi>&Sigma;</mi><mrow><mi>m</mi><mo>,</mo><mi>n</mi></mrow></munder><msub><mi>F</mi><mrow><mi>x</mi><mo>,</mo><mi>m</mi><mo>,</mo><mi>n</mi></mrow></msub><msub><mi>x</mi><mi>m</mi></msub><mo>=</mo><munder><mi>&Sigma;</mi><mrow><mi>m</mi><mo>,</mo><mi>n</mi></mrow></munder><msub><mi>F</mi><mrow><mi>x</mi><mo>,</mo><mi>m</mi><mo>,</mo><mi>n</mi></mrow></msub><msub><mi>y</mi><mi>n</mi></msub><mo>=</mo><mn>0</mn></mtd></mtr><mtr><mtd><munder><mi>&Sigma;</mi><mrow><mi>m</mi><mo>,</mo><mi>n</mi></mrow></munder><msub><mi>F</mi><mrow><mi>y</mi><mo>,</mo><mi>m</mi><mo>,</mo><mi>n</mi></mrow></msub><mo>=</mo><munder><mi>&Sigma;</mi><mrow><mi>m</mi><mo>,</mo><mi>n</mi></mrow></munder><msub><mi>F</mi><mrow><mi>y</mi><mo>,</mo><mi>m</mi><mo>,</mo><mi>n</mi></mrow></msub><msub><mi>x</mi><mi>m</mi></msub><mo>=</mo><munder><mi>&Sigma;</mi><mrow><mi>m</mi><mo>,</mo><mi>n</mi></mrow></munder><msub><mi>F</mi><mrow><mi>y</mi><mo>,</mo><mi>m</mi><mo>,</mo><mi>n</mi></mrow></msub><msub><mi>y</mi><mi>n</mi></msub><mo>=</mo><mn>0</mn></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000518506920000021.GIF" wi="829" he="247" /></maths>其中,F<sub>m,n</sub>为残余误差,U<sub>m,n</sub>为调整位姿,x,y,ξ为误差调整项;利用三个测量位姿构造的冗余,基于最小二乘法解算求得残余误差F<sub>m,n</sub>,并根据G<sub>x,m,n</sub>=Oy<sub>n</sub>+Rx<sub>m</sub>+F<sub>x,m,n</sub>,G<sub>y,m,n</sub>=Ox<sub>m</sub>+Ry<sub>n</sub>+F<sub>y,m,n</sub>,解算出系统误差G<sub>m,n</sub>,其中:O为正交误差,R为尺度误差,从而获取被标定二维工作台测量系统局部区域的系统误差;其特征在于:4)根据步骤3)中获得的系统误差G<sub>m,n</sub>,对被标定区域进行系统误差补偿,即c<sub>m,n</sub>=c'<sub>m,n</sub>+G<sub>m,n</sub>,其中c<sub>m,n</sub>为离散点标定坐标系,c'<sub>m,n</sub>为离散点测量坐标系,补偿并获得相应的局部区域的离散点标定坐标系c;对该标定坐标系内的离散点进行线性拟合得到连续的标定坐标系网格,获得二维工作台(1)上某一个局部区域的连续点标定坐标系C,将该连续点标定坐标系作为大行程区域内标定的起始区域位置,记为C<sub>0,0</sub>;在大行程区域内任意一个局部区域的连续点标定坐标系用C<sub>i,j</sub>表示;5)将光学显微镜测量系统(4)移至与已完成标定的起始区域位置C<sub>0,0</sub>相邻的下一区域,重复步骤2)、步骤3)和步骤4),得到下一个局部区域的连续点标定坐标系C<sub>1,0</sub>;依此法不断重复直至覆盖到二维工作台的所有区域,即获得大行程二维工作台上各个局部区域的连续点标定坐标系C<sub>i,j</sub>;6)针对二维工作台(1)上获得的所有相互独立的局部区域的连续点标定坐标系C<sub>i,j</sub>,利用平面直角坐标系变换原理对相邻坐标系进行两两纠偏;首先,对起始区域位置C<sub>0,0</sub>与其相邻下一个局部区域的连续点标定坐标系C<sub>1,0</sub>进行坐标系纠偏,以坐标系C<sub>0,0</sub>为基准对C<sub>1,0</sub>进行坐标系变换,即C<sub>0,0</sub>=ΔC<sub>0</sub>+RO(θ)C<sub>1,0</sub>,该式写成:<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>x</mi><mn>0,0</mn></msub></mtd></mtr><mtr><mtd><msub><mi>y</mi><mn>0,0</mn></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>&Delta;</mi><msub><mi>x</mi><mn>0</mn></msub></mtd></mtr><mtr><mtd><mi>&Delta;</mi><msub><mi>y</mi><mn>0</mn></msub></mtd></mtr></mtable></mfenced><mo>+</mo><mi>RO</mi><mrow><mo>(</mo><mi>&theta;</mi><mo>)</mo></mrow><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>x</mi><mn>1,0</mn></msub></mtd></mtr><mtr><mtd><msub><mi>y</mi><mn>1,0</mn></msub></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000518506920000022.GIF" wi="587" he="164" /></maths>其中(x<sub>0,0</sub>,y<sub>0,0</sub>)为点在起始坐标系C<sub>0,0</sub>中的坐标,(x<sub>1,0</sub>,y<sub>1,0</sub>)为点在转换坐标系C<sub>1,0</sub>中的坐标,ΔC<sub>0</sub>为坐标系C<sub>1,0</sub>相对于坐标系C<sub>0,0</sub>的坐标平移矩阵,其中Δx<sub>0</sub>,Δy<sub>0</sub>为坐标系C<sub>1,0</sub>相对于坐标系C<sub>0,0</sub>的坐标平移,θ为坐标系C<sub>1,0</sub>相对于坐标系C<sub>0,0</sub>的偏转角,O为正交误差,R为尺度误差;由上式可得:<maths num="0005" id="cmaths0005"><math><![CDATA[<mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>x</mi><mn>0,0</mn></msub><mo>=</mo><mi>&Delta;</mi><msub><mi>x</mi><mn>0</mn></msub><mo>+</mo><msub><mi>Rx</mi><mn>1,0</mn></msub><mo>&CenterDot;</mo><mi>cos</mi><mi>&theta;</mi><mo>-</mo><mi>R</mi><msub><mi>y</mi><mn>1,0</mn></msub><mo>&CenterDot;</mo><mi>sin</mi><mi>&theta;</mi></mtd></mtr><mtr><mtd><msub><mi>y</mi><mn>0,0</mn></msub><mo>=</mo><mi>&Delta;</mi><msub><mi>y</mi><mn>0</mn></msub><mo>+</mo><msub><mi>Rx</mi><mrow><mn>1</mn><mo>,</mo><mn>0</mn></mrow></msub><mo>&CenterDot;</mo><mi>sin</mi><mi>&theta;</mi><mo>+</mo><msub><mi>Ry</mi><mn>1,0</mn></msub><mo>&CenterDot;</mo><mi>cos</mi><mi>&theta;</mi></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000518506920000031.GIF" wi="713" he="163" /></maths>利用两坐标系内多个点构造冗余,基于最小二乘法解算求得Δx<sub>0</sub>,Δ<sub>y0</sub>,θ以及R,从而获得坐标系C<sub>1,0</sub>相对于坐标系C<sub>0,0</sub>的平移、旋转和尺度误差关系,最终获得坐标系C<sub>1,0</sub>与坐标系C<sub>0,0</sub>的正交性和尺度性一致的统一坐标系;依照此法,对剩余局部区域的连续点标定坐标系进行坐标系纠偏,将不同区域间的坐标系统一成正交性和尺度性一致的坐标系,最终获得全局标定坐标系C<sub>A</sub>,从而完成大行程二维工作台的自标定工作。
地址 100084 北京市海淀区100084信箱82分箱清华大学专利办公室