[发明专利]平面光栅六自由度位移测量系统中误差分离与补偿方法有效
申请号: | 201910156641.9 | 申请日: | 2019-03-01 |
公开(公告)号: | CN110057304B | 公开(公告)日: | 2020-10-20 |
发明(设计)人: | 胡金春;朱煜;田畅;张鸣;尹文生;成荣;王磊杰;韩如锦;徐登峰 | 申请(专利权)人: | 清华大学 |
主分类号: | G01B11/03 | 分类号: | G01B11/03 |
代理公司: | 北京鸿元知识产权代理有限公司 11327 | 代理人: | 邸更岩 |
地址: | 100084 北京市海淀区1*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 平面 光栅 自由度 位移 测量 系统 误差 分离 补偿 方法 | ||
1.一种平面光栅六自由度位移测量系统中误差分离与补偿方法,所述的平面光栅六自由度位移测量系统包括运动台(1)、安装在固定机架的平面光栅(2)、安装在运动台(1)上的第一测量读数头(31)、第二测量读数头(32)和第三测量读数头(33),其特征在于所述方法包含以下步骤:
第一步,建立固定于机架上的固定坐标系O-XYZ和固定于运动台(1)上的运动坐标系O’-X’Y’Z’,初始时刻两坐标系重合,坐标原点位于运动台(1)的上表面几何中心,X轴与X’轴、Y轴与Y’轴分别与平面光栅(2)的栅格周期方向平行;
第二步,在运动台(1)上安装至少一个附加读数头(34),…,(3m),m为包含测量读数头和附加读数头在内的读数头总个数,m≥4;
第三步,建立包含待分离误差与运动台六自由度位移的测量模型:
Yik=fik(Δx,Δy,Δz,θx,θy,θz,e1,...,ej,...,en)
式中:Yik为读数头(3i)的第k路测量信号;fik为读数头(3i)的第k路测量信号与运动台的位移及待分离误差之间的函数关系;ej为待分离的误差,Δx、Δy、Δz分别为运动台在X、Y、Z方向上的平动位移,θx、θy、θz分别为运动台绕X、Y、Z轴的转动位移,i=1,2,3,4,...,m,k=1,2,j=1,2...n,n为待分离误差个数;
第四步,运动台运动至任意N个位置点,获得2×m×N个测量信号,根据第三步中的测量模型建立2×m×N个方程,联立形成方程组:
其中,为第r个位置点处读数头(3i)的第1路测量信号的测量值,为第r个位置点处读数头(3i)的第2路测量信号的测量值,Δxr、Δyr、Δzr分别为运动台在第r个位置点处在X、Y、Z方向上的平动位移,θxr、θyr、θzr分别为运动台在第r个位置点处绕X、Y、Z轴的转动位移,i=1,2,3,4,...,m,r=1,2...N,N应满足2×m×N≥6N+n;
第五步,利用非线性方程组求解方法求解第四步中的方程组,得到位移与待分离误差的解算值;
第六步,将第五步中待分离误差的解算值作为已知量代入第三步所建立的测量模型中,得到补偿后的六自由度位移测量模型:
式中,ej*为第五步中待分离误差的解算值,fik*为补偿后的函数关系,i=1,2,3,4,...,m,k=1,2,j=1,2...n。
2.如权利要求1所述的一种平面光栅六自由度位移测量系统中误差分离与补偿方法,其特征在于:第五步中非线性方程组求解方法采用数值迭代法、卡尔曼滤波法、遗传算法或粒子群算法。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于清华大学,未经清华大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910156641.9/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种直线位移测量装置
- 下一篇:一种测量钢轨位移量的测量系统