[发明专利]一种二维大行程精密工作台测量系统自标定方法有效

专利信息
申请号: 201410256318.6 申请日: 2014-06-10
公开(公告)号: CN104006777B 公开(公告)日: 2017-06-13
发明(设计)人: 胡楚雄;朱煜;徐振源;杨进;张鸣;穆海华;胡金春;徐登峰;尹文生;杨开明;刘召;成荣 申请(专利权)人: 清华大学;北京华卓精科科技有限公司
主分类号: G01B21/00 分类号: G01B21/00
代理公司: 北京鸿元知识产权代理有限公司11327 代理人: 邸更岩
地址: 100084 北京市海淀区1*** 国省代码: 北京;11
权利要求书: 查看更多 说明书: 查看更多
摘要:
搜索关键词: 一种 二维 行程 精密 工作台 测量 系统 标定 方法
【权利要求书】:

1.一种二维大行程精密工作台测量系统自标定方法,所述自标定方法包括以下步骤:

1)准备一块正方形光学玻璃板(5),在该玻璃板的X方向和Y方向分别刻N条直线刻线,形成均匀等分的N×N的栅格刻线,其中N为正整数,栅格刻线与理想刻线间的偏差记为辅助误差Am,n,其中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)的读数,所得测量读数与交点坐标准确值之间的偏差记为V0,m,n,也即起始位姿下自标定模型:V0,m,n=G0,m,n+Am,n+E0,m,n+r0,m,n,其中:V0,m,n的脚标0表示起始位姿,G0,m,n为起始位姿的系统误差,E0,m,n为起始位姿的调整误差,r0,m,n为起始位姿的随机测量噪声;同理,再将光学玻璃板(5)进行90°旋转,测量并记录在旋转位姿下光学玻璃板上每个由网格刻线交点所对应的X轴位置传感器(2)、Y轴位置传感器(3)的读数,获得旋转位姿下的自标定模型:V1,m,n=G1,m,n+Am,n+E1,m,n+r1,m,n,其中:V1,m,n的脚标1表示旋转位姿,G1,m,n为旋转位姿的系统误差,E1,m,n为旋转位姿的调整误差,r1,m,n为旋转位姿的随机测量噪声;再将光学玻璃板(5)进行一个单位的平移,测量并记录平移位姿下光学玻璃板上每个由网格刻线交点所对应的X轴位置传感器(2)、Y轴位置传感器(3)的读数,获得平移位姿下的自标定模型:V2,m,n=G2,m,n+Am,n+E2,m,n+r2,m,n,其中:V2,m,n的脚标2表示平移位姿,G2,m,n为平移位姿的系统误差,E2,m,n为平移位姿的调整误差,r2,m,n为平移位姿的随机测量噪声;

3)针对步骤2)中三种位姿记录下来的自标定模型,结合系统的对称性建立系统误差方程:

<mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><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><msub><mi>Oy</mi><mi>n</mi></msub><mo>-</mo><mn>2</mn><msub><mi>Rx</mi><mi>m</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><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><msub><mi>Ox</mi><mi>m</mi></msub><mo>+</mo><mn>2</mn><msub><mi>Ry</mi><mi>n</mi></msub></mrow></mtd></mtr></mtable></mfenced>

结合系统的传递性构建方程:

<mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><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>x</mi><mo>,</mo><mi>m</mi><mo>,</mo><mi>n</mi></mrow></msub><mo>+</mo><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><mrow><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>y</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></mrow></mtd></mtr></mtable></mfenced>

结合系统的误差特性:

<mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><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></mrow></mtd></mtr><mtr><mtd><mrow><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></mrow></mtd></mtr></mtable></mfenced>

其中,Fm,n为残余误差,Um,n为调整位姿,x,y,ξ为误差调整项;利用三个测量位姿构造的冗余,基于最小二乘法解算求得残余误差Fm,n,并根据Gx,m,n=Oyn+Rxm+Fx,m,n,Gy,m,n=Oxm+Ryn+Fy,m,n,解算出系统误差Gm,n,其中:O为正交误差,R为尺度误差,从而获取被标定二维工作台测量系统局部区域的系统误差;

其特征在于:

4)根据步骤3)中获得的系统误差Gm,n,对被标定区域进行系统误差补偿,即cm,n=c'm,n+Gm,n,其中cm,n为离散点标定坐标系,c'm,n为离散点测量坐标系,补偿并获得相应的局部区域的离散点标定坐标系c;对该标定坐标系内的离散点进行线性拟合得到连续的标定坐标系网格,获得二维工作台(1)上某一个局部区域的连续点标定坐标系C,将该连续点标定坐标系作为大行程区域内标定的起始区域位置,记为C0,0;在大行程区域内任意一个局部区域的连续点标定坐标系用Ci,j表示;

5)将光学显微镜测量系统(4)移至与已完成标定的起始区域位置C0,0相邻的下一区域,重复步骤2)、步骤3)和步骤4),得到下一个局部区域的连续点标定坐标系C1,0;依此法不断重复直至覆盖到二维工作台的所有区域,即获得大行程二维工作台上各个局部区域的连续点标定坐标系Ci,j

6)针对二维工作台(1)上获得的所有相互独立的局部区域的连续点标定坐标系Ci,j,利用平面直角坐标系变换原理对相邻坐标系进行两两纠偏;首先,对起始区域位置C0,0与其相邻下一个局部区域的连续点标定坐标系C1,0进行坐标系纠偏,以坐标系C0,0为基准对C1,0进行坐标系变换,即C0,0=ΔC0+RO(θ)C1,0,该式写成:

<mrow><mfenced open = "[" close = "]"><mtable><mtr><mtd><msub><mi>x</mi><mrow><mn>0</mn><mo>,</mo><mn>0</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>y</mi><mrow><mn>0</mn><mo>,</mo><mn>0</mn></mrow></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><msub><mi>&Delta;x</mi><mn>0</mn></msub></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>&Delta;y</mi><mn>0</mn></msub></mrow></mtd></mtr></mtable></mfenced><mo>+</mo><mi>R</mi><mi>O</mi><mrow><mo>(</mo><mi>&theta;</mi><mo>)</mo></mrow><mfenced open = "[" close = "]"><mtable><mtr><mtd><msub><mi>x</mi><mrow><mn>1</mn><mo>,</mo><mn>0</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>y</mi><mrow><mn>1</mn><mo>,</mo><mn>0</mn></mrow></msub></mtd></mtr></mtable></mfenced></mrow>

其中(x0,0,y0,0)为点在起始坐标系C0,0中的坐标,(x1,0,y1,0)为点在转换坐标系C1,0中的坐标,ΔC0为坐标系C1,0相对于坐标系C0,0的坐标平移矩阵,其中Δx0,Δy0为坐标系C1,0相对于坐标系C0,0的坐标平移,θ为坐标系C1,0相对于坐标系C0,0的偏转角,O为正交误差,R为尺度误差;

由上式可得:

利用两坐标系内多个点构造冗余,基于最小二乘法解算求得Δx0,Δy0,θ以及R,从而获得坐标系C1,0相对于坐标系C0,0的平移、旋转和尺度误差关系,最终获得坐标系C1,0与坐标系C0,0的正交性和尺度性一致的统一坐标系;依照此法,对剩余局部区域的连续点标定坐标系进行坐标系纠偏,将不同区域间的坐标系统一成正交性和尺度性一致的坐标系,最终获得全局标定坐标系CA,从而完成大行程二维工作台的自标定工作。

下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。

该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于清华大学;北京华卓精科科技有限公司,未经清华大学;北京华卓精科科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服

本文链接:http://www.vipzhuanli.com/pat/books/201410256318.6/1.html,转载请声明来源钻瓜专利网。

×

专利文献下载

说明:

1、专利原文基于中国国家知识产权局专利说明书;

2、支持发明专利 、实用新型专利、外观设计专利(升级中);

3、专利数据每周两次同步更新,支持Adobe PDF格式;

4、内容包括专利技术的结构示意图流程工艺图技术构造图

5、已全新升级为极速版,下载速度显著提升!欢迎使用!

请您登陆后,进行下载,点击【登陆】 【注册】

关于我们 寻求报道 投稿须知 广告合作 版权声明 网站地图 友情链接 企业标识 联系我们

钻瓜专利网在线咨询

周一至周五 9:00-18:00

咨询在线客服咨询在线客服
tel code back_top