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

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

Info

Publication number
CN103292707B
CN103292707B CN201310151501.5A CN201310151501A CN103292707B CN 103292707 B CN103292707 B CN 103292707B CN 201310151501 A CN201310151501 A CN 201310151501A CN 103292707 B CN103292707 B CN 103292707B
Authority
CN
China
Prior art keywords
coordinate system
motor rotor
planar motor
linear grating
absolute linear
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.)
Active
Application number
CN201310151501.5A
Other languages
English (en)
Other versions
CN103292707A (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 CN201310151501.5A priority Critical patent/CN103292707B/zh
Publication of CN103292707A publication Critical patent/CN103292707A/zh
Application granted granted Critical
Publication of CN103292707B publication Critical patent/CN103292707B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Abstract

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

Description

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

Priority Applications (1)

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

Applications Claiming Priority (1)

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

Publications (2)

Publication Number Publication Date
CN103292707A CN103292707A (zh) 2013-09-11
CN103292707B true CN103292707B (zh) 2016-02-03

Family

ID=49093971

Family Applications (1)

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

Country Status (1)

Country Link
CN (1) CN103292707B (zh)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103745735A (zh) * 2013-12-26 2014-04-23 镇江晶鑫电子科技有限公司 一种激光头的全自动调整系统
CN104634249B (zh) * 2015-02-06 2017-08-29 南京理工大学 推进剂加注过程中运载火箭运动信号探测定位方法
CN107063064B (zh) * 2017-04-01 2018-11-30 清华大学 一种大面积磁浮平面电机动子的三自由度位置测量方法
CN107063104B (zh) * 2017-04-01 2019-06-18 清华大学 基于光栅尺和二维psd的平面电机动子位置测量系统及方法
CN107024170B (zh) * 2017-04-01 2018-10-30 清华大学 一种磁悬浮平面电机动子悬浮高度测量系统及方法
CN111665723B (zh) * 2020-06-19 2022-09-20 深圳大学 一种基于轨迹梯度软约束的平面电机的控制方法

Citations (4)

* 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
CN101738163A (zh) * 2009-12-17 2010-06-16 上海交通大学 全光电式磁浮工件台六维位姿测量系统
CN102607388A (zh) * 2012-02-17 2012-07-25 清华大学 平面电机动子位移测量装置及方法
CN102607391A (zh) * 2012-03-01 2012-07-25 清华大学 一种平面电机动子位移的测量方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20030102721A1 (en) * 2001-12-04 2003-06-05 Toshio Ueta Moving coil type planar motor control

Patent Citations (4)

* 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
CN101738163A (zh) * 2009-12-17 2010-06-16 上海交通大学 全光电式磁浮工件台六维位姿测量系统
CN102607388A (zh) * 2012-02-17 2012-07-25 清华大学 平面电机动子位移测量装置及方法
CN102607391A (zh) * 2012-03-01 2012-07-25 清华大学 一种平面电机动子位移的测量方法

Also Published As

Publication number Publication date
CN103292707A (zh) 2013-09-11

Similar Documents

Publication Publication Date Title
CN103292706B (zh) 动圈式平面电机动子三自由度位移测量方法
CN103292707B (zh) 一种动圈式平面电机动子三自由度位移测量方法
CN102607388B (zh) 平面电机动子位移测量装置及方法
CN102221323B (zh) 一种基于平面电容的六自由度位移测量方法
CN101769981B (zh) 一种采用线性霍尔阵列的永磁平面电机寻相检测方法
CN105690423A (zh) 机器人零位标定装置及方法
CN103454619A (zh) 一种星载微波跟瞄雷达的电轴光学标定系统及其标定方法
CN103543613B (zh) 一种动铁式无线缆的六自由度磁浮运动平台
CN104102222A (zh) 一种agv精确定位的方法
CN104061864A (zh) 一种基于平面光栅的硅片台大行程运动测量系统
CN103307984A (zh) 一种用于可调桨叶片的激光测量装置、系统及方法
CN109764806B (zh) 用于激光跟踪仪的动静态校准装置及动、静态校准方法
CN107063104B (zh) 基于光栅尺和二维psd的平面电机动子位置测量系统及方法
CN102136300A (zh) 三段组合式超精密定位台及其定位方法
CN105443930A (zh) 一种xy精密定位平台
CN106871859A (zh) 一种刚体空间定轴转动角度检测方法
Shimizu et al. Design and testing of a four-probe optical sensor head for three-axis surface encoder with a mosaic scale grating
CN103808256A (zh) 一种非接触式物体平面运动测量装置及实现方法
CN105424024A (zh) 一种基于全站仪的空间目标的位置和朝向标定方法
CN103196371A (zh) 一种主动实时三维测量大型车厢的方法及系统
CN102722086A (zh) 一种无接触式单自由度定位装置及其同步运动控制方法
CN103134428A (zh) 一种分布式平面六自由度位姿快速精密测量装置与方法
CN103900603A (zh) 平面或曲面内无导轨二维运动物体的位移和姿态的非接触测量方法
CN105403140B (zh) 一种基于磁场的六自由度位移测量方法
CN105278255A (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
CB02 Change of applicant information

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

Applicant after: Tsinghua University

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

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

Applicant before: Tsinghua University

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

COR Change of bibliographic data
C14 Grant of patent or utility model
GR01 Patent grant