CN103292706A - 动圈式平面电机动子三自由度位移测量方法 - Google Patents

动圈式平面电机动子三自由度位移测量方法 Download PDF

Info

Publication number
CN103292706A
CN103292706A CN2013101513946A CN201310151394A CN103292706A CN 103292706 A CN103292706 A CN 103292706A CN 2013101513946 A CN2013101513946 A CN 2013101513946A CN 201310151394 A CN201310151394 A CN 201310151394A CN 103292706 A CN103292706 A CN 103292706A
Authority
CN
China
Prior art keywords
coordinate system
planar motor
motor mover
vortex sensor
current vortex
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN2013101513946A
Other languages
English (en)
Other versions
CN103292706B (zh
Inventor
朱煜
张鸣
李敏
杨开明
蒋毅
余东东
李鑫
穆海华
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tsinghua University
U Precision Tech Co Ltd
Original Assignee
Tsinghua University
U Precision Tech Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Tsinghua University, U Precision Tech Co Ltd filed Critical Tsinghua University
Priority to CN201310151394.6A priority Critical patent/CN103292706B/zh
Publication of CN103292706A publication Critical patent/CN103292706A/zh
Application granted granted Critical
Publication of CN103292706B publication Critical patent/CN103292706B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Linear Motors (AREA)

Abstract

一种动圈式平面电机动子三自由度位移测量方法,该方法包括3个电涡流传感器、2个绝对直线光栅和信号处理系统;根据3个电涡流传感器的测量值和Ⅰ号绝对直线光栅的测量值求解平面电机动子在线缆台坐标系下的三自由度位移,再根据Ⅱ号绝对直线光栅的测量值求解线缆台坐标系与基台坐标系的转换矩阵,从而求解平面电机动子在基台坐标系下的三自由度位移,进一步可求解平面电机任意线圈中心在基台坐标系下的坐标。本发明为平面电机动子提供了一种结构简单、测量精度高、响应速度快的三自由度位移测量方法,并满足其大行程水平直线位移测量的需求。

Description

动圈式平面电机动子三自由度位移测量方法
技术领域
本发明涉及一种平面电机动子三自由度位移测量方法,特别涉及一种动圈式平面电机动子的三自由度位移测量方法。
背景技术
精密位移测量技术是与超大规模集成电路(IC)制造与封装、超精密加工、微机电系统(MEMS)装配与集成、光学仪器、细胞操纵、纳米材料制造、生物工程等诸多领域发展水平密切相关的高新技术。多自由度的位移(包括线位移和角位移)精密测量已经逐渐成为目前研究的最新领域。
在二维定位加工装置特别是现代半导体微细加工装备和其他超精密加工设备中,高精密运动通常由平面电机实现。由于平面电机具有反应快、灵敏度高和结构简单等优点,在学术界和工业界均受到广泛关注。
目前,平面电机动子的三自由度精密位移测量常采用光学测量法、电感测量法和电容测量法等,光学测量法与电容测量法相对比较成熟,是目前应用较广泛的精密位移测量方法。利用二维光栅进行平面电机动子的运动测量,需要在平面电机动子上安装面积较大的平面光栅来产生带有位移信息的光信号与光传感器进行通信,为防止光栅尺面被污染,对使用环境有的要求较高;采用激光位置传感器,通过激光三角测量法或回波分析原理实现平面电机动子位移的测量,测量精度受环境影响较大,大行程测量难以保证高精度,且信号处理很难保证简单快速。
因此,一种既能降低传感器的安装复杂性和环境要求,又能同时实现大行程水平直线位移高精度测量、信号处理简单快速的动圈式平面电机动子三自由度位移测量方法亟待提出。
发明内容
本发明的目的在于针对现有动圈式平面电机的技术要求,提供一种结构简单、测量精度高、响应速度快的三自由度位移测量方法,使其满足平面电机动子大行程水平直线位移测量的需求。
本发明的技术方案如下:
所涉及的动圈式平面电机动子三自由度位移测量方法,采用如下系统进行测量:该系统包括Ⅰ号电涡流传感器、Ⅱ号电涡流传感器、Ⅲ号电涡流传感器、Ⅰ号绝对直线光栅、Ⅱ号绝对直线光栅及信号处理系统;
所述Ⅰ号绝对直线光栅沿x向安装在L型线缆台上,L型线缆台在直线电机驱动下沿基台y向跟随平面电机动子运动;Ⅰ号绝对直线光栅读数头安装在L型线缆台的x向导轨上,且通过一柔性机构与平面电机动子连接,该柔性机构允许Ⅰ号绝对直线光栅读数头与平面电机动子在y向和θz向有微小的相对位移;
所述Ⅱ号绝对直线光栅沿y向安装在基台上,Ⅱ号绝对直线光栅读数头安装在直线电机动子上;
所述Ⅰ号电涡流传感器、Ⅱ号电涡流传感器和Ⅲ号电涡流传感器安装在平板上,平板与平面电机动子一侧固连,其中Ⅱ号电涡流传感器和Ⅲ号电涡流传感器安装在平板靠近直线电机的一侧,且关于平面电机动子的水平中心线对称布置;Ⅰ号电涡流传感器安装在平板靠近x向导轨的一侧;
所述方法包括如下步骤:
1)分别建立3个直角坐标系:平面电机动子坐标系O1-x1y1z1、线缆台坐标系O0-x0y0z0和基台坐标系O-xyz,平面电机动子坐标系原点位于平面电机动子的几何中心,在初始位置时,3个坐标系的原点重合;
2)令Ⅰ号绝对直线光栅的读数沿线缆台坐标系x0轴正方向逐渐减小,标记Ⅰ号绝对直线光栅读数头在线缆台坐标系下x0=0处的读数xref;令Ⅱ号绝对直线光栅的读数沿基台坐标系y轴正方向逐渐减小,标记Ⅱ号绝对直线光栅读数头在基台坐标系下y=0处的读数yref
3)Ⅰ号绝对直线光栅测量Ⅰ号绝对直线光栅读数头在线缆台坐标系下的x向位移,Ⅰ号电涡流传感器测量其安装点到L型线缆台的y向位移,Ⅱ号电涡流传感器和Ⅲ号电涡流传感器分别测量各自安装点到L型线缆台的x向位移;当平面电机动子运动过程中,在每个伺服周期,设Ⅰ号电涡流传感器的读数为y1,Ⅱ号电涡流传感器和Ⅲ号电涡流传感器的读数分别为x1和x2,Ⅰ号绝对直线光栅的读数为x3,则平面电机动子在线缆台坐标系下的三自由度位移(x0,y00)为:
x 0 = x ref - x 3 + ( f - e ) ( x 1 - x 2 ) 2 c + ( a - d ) ( x 1 - x 2 ) 2 + 2 c ( y 1 + b ) ( x 1 - x 2 ) - 4 c 2 d 2 c 4 c 2 + ( x 1 - x 2 ) 2 y 0 = e - a ( x 1 - x 2 ) + 2 c ( y 1 + b ) 4 c 2 + ( x 1 - x 2 ) 2 θ 0 = x 1 - x 2 2 c
其中,(a,b)为Ⅰ号电涡流传感器中心在平面电机动子坐标系下的平面坐标,c为Ⅱ号电涡流传感器中心到平面电机动子坐标系x1轴的距离,d为Ⅰ号绝对直线光栅读数头到平面电机动子坐标系y1轴的距离,e为L型线缆台靠近Ⅰ号电涡流传感器的侧面到线缆台坐标系x0轴的距离,f为Ⅰ号绝对直线光栅读数头到线缆台坐标系x0轴的距离;
4)Ⅱ号绝对直线光栅测量L型线缆台在基台坐标系下的y向位移,在与步骤3)相同的伺服周期,设Ⅱ号绝对直线光栅的读数为y2,则平面电机动子在线缆台坐标系下的三自由度位移(x0,y00)与在基台坐标系下的三自由度位移(x,y,θ)满足下式:
x = x 0 y = y 0 + y ref - y 2 θ = θ 0
故平面电机动子在基台坐标系下的三自由度位移(x,y,θ)为:
x = x ref - x 3 + ( f - e ) ( x 1 - x 2 ) 2 c + ( a - d ) ( x 1 - x 2 ) 2 + 2 c ( y 1 + b ) ( x 1 - x 2 ) - 4 c 2 d 2 c 4 c 2 + ( x 1 - x 2 ) 2 y = y ref - y 2 + e - a ( x 1 - x 2 ) + 2 c ( y 1 + b ) 4 c 2 + ( x 1 - x 2 ) 2 θ = x 1 - x 2 2 c .
上述技术方案中,设平面电机动子任意线圈中心在平面电机动子坐标系下的平面坐标为(l1,l2),根据平面电机动子在基台坐标系下的三自由度位移(x,y,θ),可求得该线圈中心在基台坐标系下的平面坐标为(xc,yc):
x c = 2 l 1 c - l 2 ( x 1 - x 2 ) ( 2 c ) 2 + ( x 1 - x 2 ) 2 + x y c = l 1 ( x 1 - x 2 ) + 2 l 2 c ( 2 c ) 1 + ( x 1 - x 2 ) 2 + y .
本发明所提供的一种动圈式平面电机动子三自由度位移测量方法与现有技术相比具有以下优点及突出性效果:传感器安装简单且对环境的要求较低,允许平面电机动子绕z轴有一定的转角,满足平面电机动子沿x轴和y轴的大行程位移测量的需求,同时,具有测量精度高、响应速度快、信号处理简单的特点,是实现平面电机动子三自由度位移测量的优良方法。
附图说明
图1是本发明平面电机动子三自由度位移测量系统示意图。
图2是本发明平面电机动子三自由度位移解算流程图。
图3是本发明信号处理系统的信号传输框图。
其中:1—第一线圈阵列;2—第二线圈阵列;3—第三线圈阵列;4—第四线圈阵列;5—平面电机动子;6—平板;7—基台;8—L型线缆台;9—直线电机;10—Ⅰ号电涡流传感器;11—Ⅱ号电涡流传感器;12—Ⅲ号电涡流传感器;13—Ⅰ号绝对直线光栅读数头;14—Ⅰ号绝对直线光栅;15—柔性机构;16—Ⅱ号绝对直线光栅读数头;17—Ⅱ号绝对直线光栅;18—x向导轨。
具体实施方式
以动子由4组线圈阵列驱动的动圈式平面电机为例,下面结合附图对本发明实施方式作进一步地详细描述。
图1为本发明平面电机动子三自由度位移测量系统示意图,包括Ⅰ号电涡流传感器10、Ⅱ号电涡流传感器11、Ⅲ号电涡流传感器12、Ⅰ号绝对直线光栅14、Ⅱ号绝对直线光栅17及信号处理系统;
第一线圈阵列1和第三线圈阵列3沿x向分布,为平面电机提供x向推力;第二线圈阵列2和第四线圈阵列4沿y向分布,为平面电机提供y向推力。为线圈供电的线缆连接到L型线缆台8,L型线缆台8在直线电机9的驱动下沿基台7的y向跟随平面电机动子5运动。所述Ⅰ号绝对直线光栅14沿x向安装在L型线缆台8上,安装在L型线缆台8的x向导轨18上的Ⅰ号绝对直线光栅读数头13通过一柔性机构15与平面电机动子5连接,该柔性机构15允许Ⅰ号绝对直线光栅读数头13与平面电机动子5在y向和θz向有微小的相对位移。所述Ⅱ号绝对直线光栅17沿y向安装在基台7上,Ⅱ号绝对直线光栅读数头16安装在直线电机9的动子上。所述Ⅰ号电涡流传感器10、Ⅱ号电涡流传感器11和Ⅲ号电涡流传感器12安装在平板6上,平板6与平面电机动子5的一侧固连,其中Ⅱ号电涡流传感器11和Ⅲ号电涡流传感器12安装在平板6靠近直线电机9的一侧,且关于平面电机动子5的水平中心线对称布置;Ⅰ号电涡流传感器10安装在平板6靠近x向导轨18的一侧。
图2是本发明平面电机动子三自由度位移解算流程图。所述的平面电机动子三自由度位移测量方法按如以下步骤进行:
1)如图1所示,分别建立3个直角坐标系:平面电机动子坐标系O1-x1y1z1、线缆台坐标系O0-x0y0z0和基台坐标系O-xyz,平面电机动子坐标系原点位于平面电机动子5的几何中心,在初始位置时,3个坐标系的原点重合。
2)令Ⅰ号绝对直线光栅14的读数沿线缆台坐标系x0轴正方向逐渐减小,标记Ⅰ号绝对直线光栅读数头13在线缆台坐标系下x0=0处的读数xref;令Ⅱ号绝对直线光栅17的读数沿基台坐标系y轴正方向逐渐减小,标记Ⅱ号绝对直线光栅读数头16在基台坐标系下y=0处的读数yref
3)Ⅰ号绝对直线光栅14测量Ⅰ号绝对直线光栅读数头13在线缆台坐标系下的x向位移,Ⅰ号电涡流传感器10测量其安装点到L型线缆台8的y向位移,Ⅱ号电涡流传感器11和Ⅲ号电涡流传感器12分别测量各自安装点到L型线缆台8的x向位移;根据3个电涡流传感器的测量值及Ⅰ号绝对直线光栅14的测量值解算平面电机动子5在线缆台坐标系下的三自由度位移(x0,y00):
当平面电机动子5运动过程中,在每个伺服周期,设Ⅰ号电涡流传感器10的读数为y1,Ⅱ号电涡流传感器11和Ⅲ号电涡流传感器12的读数分别为x1和x2,Ⅰ号绝对直线光栅14的读数为x3,则有
sin θ 0 = x 1 - x 2 ( 2 c ) 2 + ( x 1 - x 2 ) 2 cos θ 0 = 2 c ( 2 c ) 2 + ( x 1 - x 2 ) 2 tan θ 0 = x 1 - x 2 2 c - - - ( 1 )
其中,c为Ⅱ号电涡流传感器11的中心到平面电机动子坐标系x1轴的距离。对tanθ0采用一阶泰勒近似,取θ0≈(x1-x2)(2c),误差量级为
Figure BDA00003114648300042
Ⅰ号电涡流传感器10的中心在平面电机动子坐标系下的平面坐标为(a,b),由刚体坐标变换可得Ⅰ号电涡流传感器10的中心在线缆台坐标系中的平面坐标(x10,y10)满足式(2):
x 10 cos θ 0 + y 10 sin θ 0 - x 0 cos θ 0 - y 0 sin θ 0 = a - x 10 sin θ 0 + y 10 cos θ 0 + x 0 sin θ 0 - y 0 cos θ 0 = b - - - ( 2 )
其中,(x0,y0)是平面电机动子5在线缆台坐标系下的水平直线位移,θ0为平面电机动子5在线缆台坐标系下绕z0轴的转角。
由式(2)可得,
x 10 sin θ 0 cos θ 0 + y 10 sin 2 θ 0 - x 0 sin θ 0 cos θ 0 - y 0 sin 2 θ 0 = a sin θ 0 - x 10 sin θ 0 cos θ 0 + y 10 cos 2 θ 0 + x 0 sin θ 0 cos θ 0 - y 0 cos 2 θ 0 = b cos θ 0 - - - ( 3 )
从而有,
y10-y0=asinθ0+bcosθ0           (4)
由于L型线缆台靠近Ⅰ号电涡流传感器的侧面到线缆台坐标系x0轴的距离为e,则y1=(e-y10)cosθ0,故有
y0=e-y1cosθ0-asinθ0-bcosθ0         (5)
式(1)与式(5)联立,可得
y 0 = e - a ( x 1 - x 2 ) + 2 c ( y 1 + b ) ( 2 c ) 2 + ( x 1 - x 2 ) 2 - - - ( 6 )
Ⅰ号绝对直线光栅读数头13到平面电机动子坐标系y1轴的距离为d,由刚体坐标变换可得Ⅰ号绝对直线光栅读数头13在线缆台坐标系中的平面坐标(x30,y30)满足式(7):
x30cosθ0+y30sinθ0-x0cosθ0-y0sinθ0=d           (7)
由于Ⅰ号绝对直线光栅读数头13到线缆台坐标系x0轴的距离为f,则y30=f,故有
x 30 = 1 cos θ 0 ( d - f sin θ 0 + x 0 cos θ 0 + y 0 sin θ 0 ) - - - ( 8 )
则Ⅰ号绝对直线光栅14的读数x3满足式(9):
x 3 = x ref - x 30 = x ref - 1 cos θ 0 ( d - f sin θ 0 + x 0 cos θ 0 + y 0 sin θ 0 ) - - - ( 9 )
联立式(1)、式(6)与式(9),可得
x 0 = x ref - x 3 + ( f - e ) ( x 1 - x 2 ) 2 c + ( a - d ) ( x 1 - x 2 ) 2 + 2 c ( y 1 + b ) ( x 1 - x 2 ) - 4 c 2 d 2 c 4 c 2 + ( x 1 - x 2 ) 2 - - - ( 10 )
故平面电机动子在线缆台坐标系下的三自由度位移(x0,y00)为:
x 0 = x ref - x 3 + ( f - e ) ( x 1 - x 2 ) 2 c + ( a - d ) ( x 1 - x 2 ) 2 + 2 c ( y 1 + b ) ( x 1 - x 2 ) - 4 c 2 d 2 c 4 c 2 + ( x 1 - x 2 ) 2 y 0 = e - a ( x 1 - x 2 ) + 2 c ( y 1 + b ) 4 c 2 + ( x 1 - x 2 ) 2 θ 0 = x 1 - x 2 2 c - - - ( 11 )
4)Ⅱ号绝对直线光栅17测量L型线缆台8在基台坐标系下的y向位移,根据Ⅱ号绝对直线光栅17的测量值求解线缆台坐标系与基台坐标系的转换矩阵,从而解算平面电机动子5在基台坐标系下的三自由度位移(x,y,θ):
在与步骤3)相同的伺服周期,设Ⅱ号绝对直线光栅17的读数为y2,则平面电机动子5在线缆台坐标系下的三自由度位移(x0,y00)与在基台坐标系下的三自由度位移(x,y,θ)满足下式:
x = x 0 y = y 0 + y ref - y 2 θ = θ 0 - - - ( 12 )
故平面电机动子5在基台坐标系下的三自由度位移(x,y,θ)为:
x = x ref - x 3 + ( f - e ) ( x 1 - x 2 ) 2 c + ( a - d ) ( x 1 - x 2 ) 2 + 2 c ( y 1 + b ) ( x 1 - x 2 ) - 4 c 2 d 2 c 4 c 2 + ( x 1 - x 2 ) 2 y = y ref - y 2 + e - a ( x 1 - x 2 ) + 2 c ( y 1 + b ) 4 c 2 + ( x 1 - x 2 ) 2 θ = x 1 - x 2 2 c - - - ( 13 )
动圈式平面电机在运动控制中须知各线圈中心的相位信息,根据平面电机动子5在基台坐标系下的三自由度位移(x,y,θ),求解任意线圈中心在基台坐标系下的平面坐标(xc,yc):
平面电机动子5运动过程中,在与步骤3)相同的伺服周期,平面电机动子坐标系到基台坐标系的齐次变换矩阵为:
T = cos θ - sin θ x sin θ cos θ y 0 0 1 - - - ( 14 )
其中,(x,y,θ)为平面电机动子5在基台坐标系下的三自由度位移。
设平面电机动子5任意线圈中心在平面电机动子坐标系下的平面坐标为(l1,l2),则有
x c y c 1 = T l 1 l 2 1 cos θ - sin θ x sin θ cos θ y 0 0 1 l 1 l 2 1 - - - ( 15 )
其中,(xc,yc)为该线圈中心在基台坐标系下的平面坐标。从而有
x c = l 1 cos θ - l 2 sin θ + x y c = l 1 sin θ + l 2 cos θ + y - - - ( 16 )
由于θ=θ0,联立式(1)与式(17)可得该线圈阵列中心在基台坐标系下的平面坐标(xc,yc)为:
x c = 2 l 1 c - l 2 ( x 1 - x 2 ) ( 2 c ) 2 + ( x 1 - x 2 ) 2 + x - - - ( 17 )
y c = l 1 ( x 1 - x 2 ) + 2 l 2 c ( 2 c ) 2 + ( x 1 - x 2 ) 2 + y - - - ( 18 )
图3是本发明信号处理系统的信号传输框图。如图1所示,平面电机动子5由4个线圈阵列驱动,第一线圈阵列1和第三线圈阵列3沿x向分布,第二线圈阵列2和第四线圈阵列4沿y向分布。在运动控制中,需将第一线圈阵列1和第三线圈阵列3的x轴坐标、第二线圈阵列2和第四线圈阵列4的y轴坐标反馈给上位机和驱动器。如图3所示,3个电涡流传感器的测量值经A/D转换模块、2个绝对直线光栅的测量值经光栅数据接收模块后,传输给信号处理系统。该信号处理系统根据3个电涡流传感器、2个绝对直线光栅的测量值按照式(13)解算平面电机动子5在基台坐标系下的三自由度位移(x,y,θ);根据Ⅱ号电涡流传感器11的测量值x1、Ⅲ号电涡流传感器12的测量值x2及x按照式(17)解算第一线圈阵列1的任意线圈中心的x轴坐标xc1和第三线圈阵列3的任意线圈中心的x轴坐标xc3;根据Ⅱ号电涡流传感器11的测量值x1、Ⅲ号电涡流传感器12的测量值x2及y按照式(18)解算第二线圈阵列2的任意线圈中心的y轴坐标yc2和第四线圈阵列4的任意线圈中心的y轴坐标yc4。最后通过光栅数据发送模块将信号x、y、θ、xc1、yc2、xc3、yc4、y4传输给上位机,将信号xc1、yc2、xc3、yc4、y4传输给驱动器,从而实现平面电机动子5的高精度控制。

Claims (2)

1.一种动圈式平面电机动子三自由度位移测量方法,其特征在于所述方法采用如下系统进行测量:该系统包括Ⅰ号电涡流传感器、Ⅱ号电涡流传感器、Ⅲ号电涡流传感器、Ⅰ号绝对直线光栅、Ⅱ号绝对直线光栅及信号处理系统;
将所述Ⅰ号绝对直线光栅沿x向安装在L型线缆台上,L型线缆台在直线电机驱动下沿基台y向跟随平面电机动子运动;Ⅰ号绝对直线光栅读数头安装在L型线缆台的x向导轨上,并通过一柔性机构与平面电机动子连接,该柔性机构允许Ⅰ号绝对直线光栅读数头与平面电机动子在y向和θz向有微小的相对位移;
将所述Ⅱ号绝对直线光栅沿y向安装在基台上,Ⅱ号绝对直线光栅读数头安装在直线电机动子上;
将所述Ⅰ号电涡流传感器、Ⅱ号电涡流传感器和Ⅲ号电涡流传感器安装在平板上,平板与平面电机动子一侧固连,其中Ⅱ号电涡流传感器和Ⅲ号电涡流传感器安装在平板靠近直线电机的一侧,且关于平面电机动子的水平中心线对称布置;Ⅰ号电涡流传感器安装在平板靠近x向导轨的一侧;
所述方法包括如下步骤:
1)分别建立3个直角坐标系:平面电机动子坐标系O1-x1y1z1、线缆台坐标系O0-x0y0z0和基台坐标系O-xyz,平面电机动子坐标系原点位于平面电机动子的几何中心,在初始位置时,3个坐标系的原点重合;
2)令Ⅰ号绝对直线光栅的读数沿线缆台坐标系x0轴正方向逐渐减小,标记Ⅰ号绝对直线光栅读数头在线缆台坐标系下x0=0处的读数xref;令Ⅱ号绝对直线光栅的读数沿基台坐标系y轴正方向逐渐减小,标记Ⅱ号绝对直线光栅读数头在基台坐标系下y=0处的读数yref
3)Ⅰ号绝对直线光栅测量Ⅰ号绝对直线光栅读数头在线缆台坐标系下的x向位移,Ⅰ号电涡流传感器测量其安装点到L型线缆台的y向位移,Ⅱ号电涡流传感器和Ⅲ号电涡流传感器分别测量各自安装点到L型线缆台的x向位移;当平面电机动子运动过程中,在每个伺服周期,设Ⅰ号电涡流传感器的读数为y1,Ⅱ号电涡流传感器和Ⅲ号电涡流传感器的读数分别为x1和x2,Ⅰ号绝对直线光栅的读数为x3,则平面电机动子在线缆台坐标系下的三自由度位移(x0,y00)为:
x 0 = x ref - x 3 + ( f - e ) ( x 1 - x 2 ) 2 c + ( a - d ) ( x 1 - x 2 ) 2 + 2 c ( y 1 + b ) ( x 1 - x 2 ) - 4 c 2 d 2 c 4 c 2 + ( x 1 - x 2 ) 2 y 0 = e - a ( x 1 - x 2 ) + 2 c ( y 1 + b ) 4 c 2 + ( x 1 - x 2 ) 2 θ 0 = x 1 - x 2 2 c
其中,(a,b)为Ⅰ号电涡流传感器中心在平面电机动子坐标系下的平面坐标,c为Ⅱ号电涡流传感器中心到平面电机动子坐标系x1轴的距离,d为Ⅰ号绝对直线光栅读数头到平面电机动子坐标系y1轴的距离,e为L型线缆台靠近Ⅰ号电涡流传感器的侧面到线缆台坐标系x0轴的距离,f为Ⅰ号绝对直线光栅读数头到线缆台坐标系x0轴的距离;
4)Ⅱ号绝对直线光栅测量L型线缆台在基台坐标系下的y向位移,在与步骤3)相同的伺服周期,设Ⅱ号绝对直线光栅的读数为y2,则平面电机动子在线缆台坐标系下的三自由度位移(x0,y00)与在基台坐标系下的三自由度位移(x,y,θ)满足下式:
x = x 0 y = y 0 + y ref - y 2 θ = θ 0
故平面电机动子在基台坐标系下的三自由度位移(x,y,θ)为:
x = x ref - x 3 + ( f - e ) ( x 1 - x 2 ) 2 c + ( a - d ) ( x 1 - x 2 ) 2 + 2 c ( y 1 + b ) ( x 1 - x 2 ) - 4 c 2 d 2 c 4 c 2 + ( x 1 - x 2 ) 2 y = y ref - y 2 + e - a ( x 1 - x 2 ) + 2 c ( y 1 + b ) 4 c 2 + ( x 1 - x 2 ) 2 θ = x 1 - x 2 2 c .
2.根据权利要求1所述的动圈式平面电机动子三自由度位移测量方法,其特征在于:设平面电机动子任意线圈中心在平面电机动子坐标系下的平面坐标为(l1,l2),根据平面电机动子在基台坐标系下的三自由度位移(x,y,θ),求得该线圈中心在基台坐标系下的平面坐标为(xc,yc):
x c = 2 l 1 c - l 2 ( x 1 - x 2 ) ( 2 c ) 2 + ( x 1 - x 2 ) 2 + x y c = l 1 ( x 1 - x 2 ) + 2 l 2 c ( 2 c ) 1 + ( x 1 - x 2 ) 2 + y .
CN201310151394.6A 2013-04-27 2013-04-27 动圈式平面电机动子三自由度位移测量方法 Active CN103292706B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310151394.6A CN103292706B (zh) 2013-04-27 2013-04-27 动圈式平面电机动子三自由度位移测量方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310151394.6A CN103292706B (zh) 2013-04-27 2013-04-27 动圈式平面电机动子三自由度位移测量方法

Publications (2)

Publication Number Publication Date
CN103292706A true CN103292706A (zh) 2013-09-11
CN103292706B CN103292706B (zh) 2015-12-23

Family

ID=49093970

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310151394.6A Active CN103292706B (zh) 2013-04-27 2013-04-27 动圈式平面电机动子三自由度位移测量方法

Country Status (1)

Country Link
CN (1) CN103292706B (zh)

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103698700A (zh) * 2013-12-18 2014-04-02 中南大学 一种平面电机的检测装置
CN105549332A (zh) * 2016-01-14 2016-05-04 哈尔滨工业大学 一种工件台三自由度位移测量方法
CN107024170A (zh) * 2017-04-01 2017-08-08 清华大学 一种磁悬浮平面电机动子悬浮高度测量系统及方法
CN107063064A (zh) * 2017-04-01 2017-08-18 清华大学 一种大面积磁浮平面电机动子的三自由度位置测量方法
CN107063104A (zh) * 2017-04-01 2017-08-18 清华大学 基于光栅尺和二维psd的平面电机动子位置测量系统及方法
CN107830783A (zh) * 2017-09-29 2018-03-23 山东大学 面向微纳操控的三自由度位移测量装置和方法
CN109520407A (zh) * 2018-11-23 2019-03-26 中国船舶重工集团公司第七〇九研究所 一种扫掠式间距测量装置
CN113389728A (zh) * 2021-06-11 2021-09-14 浙江科技学院 涡旋压缩机及其平面运动主动控制方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6445093B1 (en) * 2000-06-26 2002-09-03 Nikon Corporation Planar motor with linear coil arrays
US20030102721A1 (en) * 2001-12-04 2003-06-05 Toshio Ueta Moving coil type planar motor control
CN101738163A (zh) * 2009-12-17 2010-06-16 上海交通大学 全光电式磁浮工件台六维位姿测量系统
CN102607388A (zh) * 2012-02-17 2012-07-25 清华大学 平面电机动子位移测量装置及方法
CN102607391A (zh) * 2012-03-01 2012-07-25 清华大学 一种平面电机动子位移的测量方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6445093B1 (en) * 2000-06-26 2002-09-03 Nikon Corporation Planar motor with linear coil arrays
US20030102721A1 (en) * 2001-12-04 2003-06-05 Toshio Ueta Moving coil type planar motor control
CN101738163A (zh) * 2009-12-17 2010-06-16 上海交通大学 全光电式磁浮工件台六维位姿测量系统
CN102607388A (zh) * 2012-02-17 2012-07-25 清华大学 平面电机动子位移测量装置及方法
CN102607391A (zh) * 2012-03-01 2012-07-25 清华大学 一种平面电机动子位移的测量方法

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103698700B (zh) * 2013-12-18 2016-06-01 中南大学 一种平面电机的检测装置
CN103698700A (zh) * 2013-12-18 2014-04-02 中南大学 一种平面电机的检测装置
CN105549332B (zh) * 2016-01-14 2017-11-03 哈尔滨工业大学 一种工件台三自由度位移测量方法
CN105549332A (zh) * 2016-01-14 2016-05-04 哈尔滨工业大学 一种工件台三自由度位移测量方法
CN107024170A (zh) * 2017-04-01 2017-08-08 清华大学 一种磁悬浮平面电机动子悬浮高度测量系统及方法
CN107063104A (zh) * 2017-04-01 2017-08-18 清华大学 基于光栅尺和二维psd的平面电机动子位置测量系统及方法
CN107063064A (zh) * 2017-04-01 2017-08-18 清华大学 一种大面积磁浮平面电机动子的三自由度位置测量方法
CN107063064B (zh) * 2017-04-01 2018-11-30 清华大学 一种大面积磁浮平面电机动子的三自由度位置测量方法
CN107063104B (zh) * 2017-04-01 2019-06-18 清华大学 基于光栅尺和二维psd的平面电机动子位置测量系统及方法
CN107830783A (zh) * 2017-09-29 2018-03-23 山东大学 面向微纳操控的三自由度位移测量装置和方法
CN107830783B (zh) * 2017-09-29 2019-12-03 山东大学 面向微纳操控的三自由度位移测量装置和方法
CN109520407A (zh) * 2018-11-23 2019-03-26 中国船舶重工集团公司第七〇九研究所 一种扫掠式间距测量装置
CN113389728A (zh) * 2021-06-11 2021-09-14 浙江科技学院 涡旋压缩机及其平面运动主动控制方法

Also Published As

Publication number Publication date
CN103292706B (zh) 2015-12-23

Similar Documents

Publication Publication Date Title
CN103292706B (zh) 动圈式平面电机动子三自由度位移测量方法
CN103292707B (zh) 一种动圈式平面电机动子三自由度位移测量方法
CN101769981B (zh) 一种采用线性霍尔阵列的永磁平面电机寻相检测方法
CN103543613B (zh) 一种动铁式无线缆的六自由度磁浮运动平台
CN103546067B (zh) 一种大角度旋转的大行程磁浮运动平台
CN104061864A (zh) 一种基于平面光栅的硅片台大行程运动测量系统
CN102607388A (zh) 平面电机动子位移测量装置及方法
CN107063104B (zh) 基于光栅尺和二维psd的平面电机动子位置测量系统及方法
CN105443930A (zh) 一种xy精密定位平台
CN102136300A (zh) 三段组合式超精密定位台及其定位方法
CN106430088A (zh) 一种大行程六自由度磁浮磁驱纳米定位平台
CN103868453A (zh) 一种直驱光栅尺自动检测装置
CN101750548B (zh) 一种采用开关霍尔阵列的永磁平面电机寻相检测方法
CN111490642B (zh) 一种基于霍尔效应传感器和平面电机的位移装置
CN103901734A (zh) 一种工件台线缆装置
CN103543612A (zh) 一种带真空罩的动铁式无线缆六自由度磁浮运动平台
CN102800368A (zh) 一种气浮平面电机初始零位的定位方法
CN104949610B (zh) 磁浮线缆台电机磁对准系统及其对准方法
CN102722086A (zh) 一种无接触式单自由度定位装置及其同步运动控制方法
CN209767305U (zh) 一种基于混合位移传感器和平面电机的位移装置
CN109660064B (zh) 一种基于混合位移传感器和平面电机的位移装置
CN105656282B (zh) 一种具有嵌入式位置检测装置的直线永磁伺服电机
CN111564953A (zh) 平面电机位移装置
US10451982B2 (en) Actuator assembly including magnetic sensor system for vibrationless position feedback
CN104007622B (zh) 一种掩模台垂直运动分量的测量方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
C56 Change in the name or address of the patentee
CP01 Change in the name or title of a patent holder

Address after: 100084 Haidian District, Beijing,,, Tsinghua University, the 100084 letter box office

Patentee after: Tsinghua University

Patentee after: U-PRECISION TECH CO., LTD.

Address before: 100084 Haidian District, Beijing,,, Tsinghua University, the 100084 letter box office

Patentee before: Tsinghua University

Patentee before: U-Precision Tech Co., Ltd.