首页> 中国专利> 一种无接触式粗精动叠层定位系统及其运动控制方法

一种无接触式粗精动叠层定位系统及其运动控制方法

摘要

一种无接触式粗精动叠层定位系统及其运动控制方法,该定位装置包括一个微动台和对称布置在微动台两侧的两个粗动台,微动台利用音圈电机悬浮在两个粗动台上方,各粗动台之间、各粗动台与微动台之间无机械连接。微动台能够实现六自由度运动,两个粗动台沿Y轴方向运动。沿Y轴方向运动的控制方法中,以激光尺信号为微动台沿Y轴方向位置反馈,利用音圈电机驱动实现微动台沿Y轴方向运动。以电涡流传感器信号为粗动台与微动台之间沿Y轴方向位置偏差,以该偏差为控制器反馈实现粗动台与微动台沿Y轴方向的同步运动。

著录项

  • 公开/公告号CN102722088A

    专利类型发明专利

  • 公开/公告日2012-10-10

    原文格式PDF

  • 申请/专利权人 清华大学;

    申请/专利号CN201210180140.2

  • 申请日2012-06-01

  • 分类号G03F7/20(20060101);G01B11/00(20060101);G01B11/02(20060101);G01B7/00(20060101);G01B7/30(20060101);

  • 代理机构11327 北京鸿元知识产权代理有限公司;

  • 代理人邸更岩

  • 地址 100084 北京市海淀区北京市100084信箱82分箱清华大学专利办公室

  • 入库时间 2023-12-18 06:47:36

法律信息

  • 法律状态公告日

    法律状态信息

    法律状态

  • 2015-11-25

    专利权的转移 IPC(主分类):G03F7/20 登记生效日:20151102 变更前: 变更后: 申请日:20120601

    专利申请权、专利权的转移

  • 2014-06-18

    授权

    授权

  • 2012-12-05

    实质审查的生效 IPC(主分类):G03F7/20 申请日:20120601

    实质审查的生效

  • 2012-10-10

    公开

    公开

说明书

技术领域

本发明涉及一种无接触式粗精动叠层定位装置运动控制系统,属于半导体光刻设备领域。

背景技术

具有纳米级运动定位精度的超精密微动台是半导体装备关键部件之一,如光刻机中的硅 片台、掩模台等。为实现超精密定位要求,以气浮和磁浮约束为支撑方式的执行单元作为一 种超精密运动台被广泛应用。气浮约束作为支撑和导向作用时,减小了机械结构传动引起的 摩擦力等作用,提高了系统运动定位精度。以直线电机为驱动单元时,由通电线圈在永磁阵 列气隙磁场中产生的洛仑兹力提供驱动力,通过控制线圈中电流大小来改变执行单元的推力, 具有结构简单等优点。

目前光刻设备中通常采用粗精动叠层的结构,包括两个粗动台和一个微动台,两个粗动 台之间通过一个横梁连接,微动台安装在横梁上,通过横梁实现两个粗动台与微动台的同步 运动。一方面连接横梁增加了结构设计的复杂性,增加了系统结构质量,较大的质量将影响 系统运动响应性能,另一方面,当结构运动时,如果两个粗动台沿Y轴方向存在位置偏差, 由于连接梁的作用,使得两个粗动平台之间产生作用力与反作用力的耦合,使得两个粗动平 台的性能相互影响,将影响系统的运动定位精度。因此设计出无机械连接的粗精动叠层定位 装置并设计出针对该定位装置的控制方法具有重要意义。

发明内容

本发明的目的是提供一种应用于半导体装备的定位装置以及位置测量与运动控制算法, 不仅满足六自由度运动定位要求,同时解决目前掩模台粗精动叠层结构中由机械结构耦合作 用引起的结构复杂、运动性能相互影响等问题。

本发明的技术方案如下:

一种无接触式粗精动叠层定位系统,该控制系统包括定位装置、位置测量装置、驱动装 置和控制单元;

定位装置包括基架、一个微动台和两个对称布置在微动台两侧的粗动台,两个粗动台之 间、粗动台与微动台之间无机械连接;

位置测量装置包括:

1)一个激光尺,用于测量微动台质心沿Y轴的绝对位置;

2)两个光栅测量装置,每个光栅测量装置包括一个光栅尺和一个读数头,用于测量粗动 台沿Y轴方向的位移;

3)七个电涡流传感器,其中:

第一电涡流传感器和第二电涡流传感器安装在第一粗动台上,布置于一条沿Y轴的直线 上,用于测量微动台沿X轴与粗动台的相对位置,第一和第二电涡流传感器测量值的差动作 为微动台绕Z轴的转角;

第三电涡流传感器安装在第一粗动台上,测量第一粗动台与微动台之间沿Y轴方向的相 对位置;第四电涡流传感器安装在第二粗动台上,测量第二粗动台与微动台之间沿Y轴方向 的相对位置;

第五电涡流传感器和第六电涡流传感器安装在第一粗动台上,且位于一条沿Y轴的直线 上,第七电涡流传感器安装在第二粗动台上,且与第五电涡流传感器位于一条沿X轴的直线 上;该三个电涡流传感器用于测量微动台沿Z轴的绝对位置,第五电涡流传感器和第六电涡 流传感器测量值的差动作为微动台绕X轴的转角,第五电涡流传感器和第七电涡流传感器测 量值的差动作为微动台绕Y轴的转角;

驱动装置包括:

1)十个音圈电机

微动台包括四个沿Y轴方向驱动的音圈电机、两个沿X轴方向驱动的音圈电机和四个沿 Z轴方向驱动的音圈电机;第一音圈电机、第二音圈电机、第五音圈电机的线圈组件固定在 第一粗动台上,永磁体组件固定在微动台上,第三音圈电机、第四音圈电机、第六音圈电机 的线圈组件固定在第二粗动台上,永磁体组件固定在微动台上;

第七音圈电机、第八音圈电机、第九音圈电机、第十音圈电机结构相同,包括外磁环、 内磁环、圆柱线圈组件、重力平衡磁柱;外磁环与内磁环的轴线沿Z轴方向,外磁环与内磁 环充磁方向相同,沿径向方向且由圆环外表面指向圆心;圆柱线圈位于内磁环与外磁环之间, 绕线轴线沿Z轴方向;磁柱的轴线沿Z轴方向,充磁方向沿Z轴正方向;第七音圈电机、第 八音圈电机的圆柱线圈组件固定在第一粗动台上,第九音圈电机、第十音圈电机的圆柱线圈 组件固定在第二粗动台上;

2)两个直线电机

两个直线电机分别用于驱动第一粗动台和第二粗动台;

所述控制单元包括含有控制程序的工控机、计数卡、A/D卡、D/A卡和驱动器,计数卡 采集光栅尺和激光尺的增量信号,A/D卡采集电涡流传感器的信号,计数卡和A/D卡将采集 到的信号输入至工控机,工控机以所述信号作为位置反馈信号对微动台以及粗动台进行控制, 控制指令通过D/A卡输出至驱动器,驱动力输出电流给电机,实现微动台以及粗动台的运动。

基于所述的粗精动叠层定位系统,采用了一种运动控制方法,该控制方法包括如下步骤:

1)在伺服周期开始,设定微动台的六自由度位移量,其中xd为沿X轴的位移量,yd为 沿Y轴的位移量,zd为沿Z轴的位移量,θxd为绕X轴的转角位移量,θyd为绕Y轴的转角 位移量,θzd为绕Z轴的转角位移量;然后将计数卡采集的激光尺信号和A/D卡采集的电涡 流传感器信号作为微动台控制环路的反馈信号,将A/D卡采集的电涡流传感器信号作为粗动 台控制环路的反馈信号;

2)根据设定的微动台六自由度位移量以及反馈信号求解每个音圈电机相应出力,其中第 一音圈电机、第二音圈电机、第三音圈电机和第四音圈电机控制微动台沿Y方向移动和绕Z 轴旋转的自由度,第五音圈电机和第六音圈电机控制微动台沿X方向移动的自由度,第七音 圈电机、第八音圈电机、第九音圈电机和第十音圈电机控制微动台沿Z方向移动、绕X轴旋 转和绕Y轴旋转的自由度,电机输出力按以下公式计算:

F301=F302=kp301ey+kd301e·y+c301·e·y+a301ey|e·y+ey|+b301+k301eθz+k301e·θz

F303=F304=kp303ey+kd303e·y+c303·e·y+a303ey|e·y+ey|+b303-k303eθz-k303e·θz

F305=F306=kp305ex+kd305e·x+c305·e·x+a305ex|e·x+a305ex|+b305

F307=kp307ez+kd307e·y+c307·e·z+a307ez|e·z+a307ey|+b307+k307eθx+k307e·θx+k307eθy+k307e·θy

F308=kp308ez+kd308e·z+c308·e·z+a308ez|e·z+a308ez|+b308+k308eθx+k308e·θx-k308eθy-k308e·θy

F309=kp309ez+kd309e·z+c309·e·z+a309ez|e·z+a309ez|+b309-k309eθx-k309e·θx+k309eθy+k309e·θy

F3010=kp3010ez+kd3010e·z+c3010·e·z+a3010ez|e·z+a3010ez|+b3010-k3010eθx-k3010e·θx-k3010eθy-k3010e·θy

其中:F301为第一音圈电机输出力,F302为第二音圈电机输出,F303为第三音圈电机输出 力,F304为第四音圈电机输出力,F305为第五音圈电机输出力,F306为第六音圈电机输出,F307为第七音圈电机输出力,F308为第八音圈电机输出力,F309为第九音圈电机输出力,F3010为第 十音圈电机输出力;

kp301、kp303、kp305、kp307、kp308、kp309、kp3010、kd301、kd303、kd305、kd307、kd308、kd309、 kd3010、c301、c303、c305、c307、c308、c309、c3010、a301、a303、a305、a307、a308、a309、a3010、 b301、b303、b305、b307、b308、b309、b3010、k301、k303、k305、k307、k308、k309、k3010为控制器 比例系数;

ey=yd-y,yd为微动台沿Y轴方向目标位置,y为激光尺反馈信号,为ey对时间的 一阶导数;ex=xd-x,xd为微动台沿X轴的目标位置,x为反馈信号,为ex对时间的一阶 倒数;ez=zd-z,zd为微动台沿Z轴的目标位置,z为反馈信号,为ez对时间的一阶倒数; θxd为微动台绕X轴的目标位置,θx为反馈信号,为对时间的一阶倒数; θyd为微动台绕Y轴的目标位置,θy为反馈信号,为对时间的一阶倒数; θzd为微动台绕Z轴的目标转角,θz为反馈信号,为对时间的一阶倒数;

粗动台仅具有y方向的自由度,其控制系统要保持粗动台与微动台在y方向的相对位置 不变,设第一粗动台与微动台相对位置保持ycd1不变,第二粗动台与微动台相对位置保持ycd2不变。在两个粗动台的运动控制方法中,第一粗动台以第一音圈电机和第二音圈电机的输出 力作为前馈,第三电涡流传感器信号为微动台与第一粗动台之间的位置偏差,以该偏差为反 馈实现第一粗动台沿Y轴的运动;第二粗动台以第三音圈电机和第四音圈电机的输出力作为 前馈,第四电涡流传感器信号为微动台与第二粗动台之间的位置偏差,以该偏差为反馈实现 第二粗动台沿Y轴的运动,粗动台直线电机输出力按照以下公式计算:

F1001=F302+F301+kp1001ey1001+kd1001e·y1001+c1001·e·y1001+a1001ey1001|e·y1001+a1001ey1001|+b1001

F1002=F304+F303+kp1002ey1002+kd1002e·y1002+c1002·e·y1002+a1002ey1002|e·y1002+a1002ey1002|+b1002

其中:F1001为第一粗动台直线电机输出力、F1002为第二粗动台直线电机输出力;

kp1001、kp1002、kd1001、kd1002、c1001、c1002、a1001、a1002、b1001、b1002为控制器比例系数;

ey1001=ycd1-yc1,ycd1为第一粗动台与微动台目标相对位置,yc1第三电涡流传感器反馈 信号;为ey1001第三电涡流传感器信号对时间的导数;

ey1002=ycd2-yc2,ycd2为第二粗动台与微动台目标相对位置,yc2第四电涡流传感器反馈 信号;为ey1002对时间的导数;

3)根据求解的每个驱动电机的输出力得到每个电机的控制指令,该控制指令由D/A卡进 行数模转换后输入至驱动器,驱动器成比例地输出电流驱动相应电机,进而实现微动台以及 粗动台的运动。

本发明具有以下优点及突出性的技术效果:本发明解决了目前粗精动叠层结构中有机械 结构耦合作用引起的结构复杂、运动性能相互影响等问题,所设计的叠层定位装置结构简单, 无接触消除了摩擦,同时本发明提供了六自由度结算方法,以及一种控制方法,具有较好的 控制效果。

附图说明

图1为本发明定位装置结构原理示意图(轴测图)。

图2为本发明粗动台轴测图。

图3为本发明粗动台侧视图。

图4为本发明微动台结构示意图(轴测图)。

图5为本发明第一音圈电机剖视图。

图6为本发明第五音圈电机结构示意图(轴测图)。

图7为第五音圈电机剖视图。

图8为本发明第七音圈电机结构示意图(轴测图)。

图9为本发明第七音圈电机外磁环图。

图10为本发明第七音圈电机内磁环图。

图11为本发明第七音圈电机磁柱图。

图12为本发明音圈电机线圈位置示意图。

图13为本发明光栅尺示意图(轴测图)。

图14为本发明光栅尺主视图。

图15为本发明第一电涡流传感器-第四电涡流传感器位置示意图。

图16为本发明第五电涡流传感器-第七电涡流传感器位置示意图。

图17为本发明激光尺位置示意图。

图18为本发明激光尺测量示意图。

图19为本发明激光尺测量示意图。

图20为本发明控制原理流程图。

图中:

001-基架;

1001-第一粗动台,1002-第二粗动台

101-直线电机,102-支撑元件,103-导向元件,104-连接元件

200-微动台

201-第一音圈电机,202-第二音圈电机,203-第三音圈电机,204-第四音圈电机

211-第一线圈组件,212-第一永磁体组件,213-第二永磁体组件

2121-第一主永磁体,2142-第二主永磁体,2125第三主永磁体,2131-第四主永磁体, 2133-第五主永磁体,2135-第六主永磁体,2122-第一附永磁体,2124-第二附永磁体,2132- 第三附永磁体,2134-第四附永磁体,2142-第一铁轭

205-第五音圈电机,206-第六音圈电机

221-第二线圈组件,222-第三永磁体组件,223第四永磁体组件,2221-第七主永磁体, 2222-第八主永磁体,2231-第九主永磁体,2232-第十主永磁体,2241-第三铁轭,2242-第四 铁轭

207-第七音圈电机,208-第八音圈电机,209-第九音圈电机,2010第十音圈电机

231-第三线圈组件,232-外磁环,233-内磁环,234磁柱

401-第一电涡流传感器,402-第二电涡流传感器,403-第三电涡流传感器,404-第四电 涡流传感器,405-第五电涡流传感器,406-第六电涡流传感器,407-第七电涡流传感器

300-光栅尺测量系统

301-光栅尺,301-光栅尺安装架,302-光栅尺调整装置,303-光栅尺,304-读数头,305- 光栅尺零点标记

900-激光尺,901-反射镜

具体实施方式

下面结合附图对本发明的原理、结构和工作过程来进一步说明本发明。

图1为本发明定位装置的结构示意图(轴测图)。本发明定位装置包括基架001、一个微 动平台200、第一粗动台1001、第二粗动台1002,该两个粗动台对称布置在微动平台200两 侧。

第一粗动台1001与第二粗动台1002结构相同,图2为第二粗动台1002结构轴测图,图 3为第二粗动台1002侧视图。第二粗动1002包括一个直线电机101、一个连接元件104、一 个气浮支撑元件102和一个气浮导向元件103。连接元件104与直线电机固接,气浮支撑元 件102与直线电机固连,气浮导向元件103与气浮支撑元件102固连。

气浮支撑元件102的下表面与基架001的上表面正面相对,支撑元件102下表面有气孔, 气孔轴线沿Z轴方向,气浮支撑元件102与基架001之间形成沿Z轴方向的气浮支撑,气浮 支撑方式采用真空预载的方式;气浮导向元件103的侧面与基架001的侧面正面相对,气浮 导向元件103的侧面有气孔,气孔的轴线沿X轴方向,气浮导向元件103与基架001之间形 成气浮导向,导向方向沿Y轴方向,气浮方式为真空预载的方式。

图4为微动台200结构轴测图,微动台200由沿Y轴方向驱动的第一音圈电机201、第 二音圈电机202、第三音圈电机203、第四音圈电机204实现沿Y轴方向的运动及绕Z轴的转 动。由沿X轴方向驱动的第五音圈电机205、第六音圈电机206实现沿X轴的运动。由沿Z 轴驱动的第七音圈电机207、第八音圈电机208、第九音圈电机209、第十音圈电机2010实 现微动台200沿Z轴的运动和绕X轴、Y轴的转动。因此通过这十个音圈电机实现微动平台 200的六自由度运动。

第一音圈电机201、第二音圈电机202、第三音圈电机203、第四音圈电机204结构相同, 图5为第一音圈电机201结构剖视图。第一音圈电机201包括第一永磁体组件212、第二永 磁体组件213、第一线圈组件211。第一线圈组件211位于第一永磁体组件212与第二永磁体 组件213之间,并保留间隙。

如图12所示,第一音圈电机201与第二音圈电机202的线圈组件固定在第一粗动台1001 上,第一音圈电机201与第二音圈电机202的永磁体组件固定在微动平台200上。第三音圈 电机203与第四音圈电机204的线圈组件固定在第二粗动台1002上,第三音圈电机203与第 四音圈电机204的永磁体组件固定在微动平台200上。当第一音圈电机201、第二音圈电机 202、第三音圈电机203、第四音圈电机204沿Y轴方向驱动力相同时,实现微动平台200沿 Y轴运动,当该四个音圈电机沿Y轴方向驱动力不相同时,实现微动平台200绕Z轴的转动。

如图4所示,第五音圈电机205与第六音圈电机206结构相同,且位于沿X轴的同一条 直线上。图6为第五音圈电机220轴测图,图7为第五音圈电机220剖视图。如图12所示, 第五音圈电机205的线圈组件固定在第一粗动台1001上,其永磁体组件固定在微动台200上, 第六音圈电机206的线圈组件固定在第二粗动台1002上,其永磁体组件固定在微动台200上。 线圈通电时,第五音圈电机205与第六音圈电机206驱动微动台200沿X轴方向运动。

第七音圈电机207、第八音圈电机208、第九音圈电机209、第十音圈电机2010的结构 相同。图8为第七音圈电机207结构轴测图。第七音圈电机207包括外磁环232、内磁环233、 圆柱线圈组件231、重力平衡磁柱234。

图9为第七音圈电机207中外磁环232主视图。图10为第七音圈电机207中内磁环233 主视图。图11为第七音圈电机207中磁柱234主视图。外磁环232与内磁环233的轴线沿Z 轴方向,外磁环232与内磁环233充磁方向相同,沿径向方向且由圆环外表面指向圆心。圆 柱线圈231位于内磁环233与外磁环232之间,绕线轴线沿Z轴方向。磁柱234的轴线沿Z 轴方向,充磁方向沿Z轴正方向。如图4所示,第七音圈电机207与第八音圈电机208的线 圈组件固定于第一粗动台1001上,且位于同一条沿Y轴的直线上,第九音圈电机209与第十 音圈电机2010的线圈组件固定于第二粗动台1002上,且位于同一条沿Y轴的直线上。该四 个音圈电机的外磁环232、内磁环233和磁柱234固定在微动平台200上。圆柱线圈231通 电时,通电线圈231与内磁环233、外磁环232之间产生洛仑兹力,当该四个音圈电机产生 的沿Z轴洛仑兹力大小相同时,实现微动平台200沿Z轴方向运动,当该四个音圈电机产生 的洛仑兹力大小不同时,实现微动平台200绕X轴转动与绕Y轴转动。线圈通电时,通电线 圈231与磁柱234之间产生洛仑兹力,改变电流的大小使得产生的洛仑兹力与微动台200的 重力相等,达到微动台200重力平衡的目的。

第一粗动台1001、第二粗动台1002、微动台200的位置测量方案如下:

光栅尺测量装置包括结构相同的第一光栅尺3001测量装置和第二光栅尺测量装置3002, 图13为第一光栅尺测量装置3001轴测图,图14为第一光栅尺测量装置3001主视图。该两 个光栅测量装置沿X轴方向对称布置在两个粗动台的两侧。每个光栅测量装置包括一个光栅 尺303、一个光栅尺安装架301、一个读数头304和光栅尺调整装置302。光栅尺调整装置302 固定于基架001上,光栅尺安装架301与光栅尺调整装置302固定连接,通过调整光栅尺调 整架302使光栅尺安装架301的长边方向沿Y轴方向。光栅尺303粘贴固定于光栅尺安装架 301表面上,光栅条纹沿Y轴方向。光栅读数头304与直线电机101连接,当直线电机101 沿Y轴运动时,光栅尺测量装置用来检测第一粗动台1001与第二粗动台1002沿Y轴方向的 位置。

如图15、图16所示,微动台200与第一粗动台1001、第二粗动台1002的相对位置测量 系统中包括七个电涡流传感器,每个电涡流传感器安装在第一粗动台1001、第二粗动台1002 上,测量金属导体安装在微动台200上。第一电涡流传感器401、第二电涡流传感器402安 装在第一粗动台1001上,并位于沿Y轴的一条直线上,测量微动台200与粗动台100之间 沿x轴方向相对距离,第一电涡流传感器401与第二电涡流传感器402信号的差动可测量微 动台200与两个粗动台之间绕Z轴的相对转角。第三电涡流传感器403、第四电涡流传感器 404分别安装在第一粗动台1001与第二粗动台1002上,并位于一条沿X轴方向的直线上, 分别测量微动台200相对于第一粗动台1001、第二粗动台1002沿Y轴方向的距离。第五电 涡流传感器405、第六电涡流传感器406安装在第一粗动台1001上,并位于一条沿Y轴方向 的直线上,第七电涡流传感器407安装在第二粗动台1002上,且与第五电涡流传感器405位 于一条沿X轴的直线上。第五电涡流传感器405、第六电涡流传感器406、第七电涡流传感 器407用于测量微动台200与第一粗动台1001、第二粗动台1002之间沿Z轴方向距离,第 五电涡流传感器405与第六电涡流传感器406的差动测量微动台200绕X轴转角,第五电涡 流传感器405、第七电涡流传感器407的差动测量微动台200绕Y轴的转角。

图17为激光测量装置示意图,激光尺900测量微动台200沿Y轴方向绝对位置。

两个粗动台以光栅尺测量装置为测量传感器,将整体定位装置移动到光栅尺零点标记305 处,如图18所示,以此时微动台200的质心为坐标系并记录激光尺读数A。

微动台200六自由度位置计算如下:

Y轴方向位置:微动台200沿Y轴位置采用激光尺测量,如图19所示,当微动台由初始 点运动到某一位置时,激光尺读数为B,则微动台200在全局坐标系下的沿Y轴方向位置为

y=B-A

X轴方向位置:微动台200沿X轴方向位置由第一电涡流传感器401、第二电涡流传感器 402测得,第一电涡流传感器401信号为x401,第二电涡流传感器402信号为x402,微动台200 沿X轴方向位置为:

X=(x401+x402)/2

Z轴方向位置:微动台200沿Z轴方向位置由第五电涡流传感器405、第六电涡流传感器 406与第七电涡流传感器407测得,第五电涡流传感器405信号为x405,第六电涡流传感器 406信号为x406,第七电涡流传感器407信号为x407,即微动台200沿Z轴方向位置为:

Z=(x405+x406+x407)/3

绕X轴转角:以逆时针为正,微动台200绕X轴转角由第五电涡流传感器405、第六电 涡流传感器406测得,即:

θX=(x406-x405)/L2

绕Y轴转角:以逆时针为正,微动台200绕Y轴转角由第五电涡流传感器405、第七电 涡流传感器407测得,即:

θY=(x407-x405)/L3

绕Z轴转角:以逆时针为正,微动台200绕Z轴转角由第一电涡流传感器401、第二电 涡流传感器402测得,即:

θZ=(x402-x401)/L1

第一粗动台1001与微动台200之间沿Y轴相对位置由第三电涡流传感器403测得,即:

x相1=x403

第二粗动台1002与微动台200之间沿Y轴相对位置由第四电涡流传感器404测得,即:

x相2=x404

各粗动台与微动台200的控制框图如图所示。测量装置测量得到的信号通过A/D转化将 数字量输入到计算机中,利用设计的控制方法处理这些数字信号,并将计算得到的数字量输 出给D/A卡,经过D/A转化后的模拟量输入到各音圈电机和直线电机的驱动器中,驱动器根 据这些模拟量值给各音圈电机的线圈输入电流,根据洛仑兹力法则各音圈电机和直线电机驱 动微动台和各粗动台运动,微动台与各粗动台的位置由测量装置测量得到。

在微动台以及粗动台的运动控制中,采用了一种运动控制方法,该控制方法包括如下步 骤:

1)在伺服周期开始,设定微动台的六自由度位移量,其中xd为沿X轴的位移量,yd为 沿Y轴的位移量,zd为沿Z轴的位移量,θxd为绕X轴的转角位移量,θyd为绕Y轴的转角 位移量,θzd为绕Z轴的转角位移量;然后将计数卡采集的激光尺信号和A/D卡采集的电涡 流传感器信号作为微动台控制环路的反馈信号,将A/D卡采集的电涡流传感器信号作为粗动 台控制环路的反馈信号;

2)根据设定的微动台六自由度位移量以及反馈信号求解每个音圈电机相应出力,其中第 一音圈电机、第二音圈电机、第三音圈电机和第四音圈电机控制微动台沿Y方向移动和绕Z 轴旋转的自由度,第五音圈电机和第六音圈电机控制微动台沿X方向移动的自由度,第七音 圈电机、第八音圈电机、第九音圈电机和第十音圈电机控制微动台沿Z方向移动、绕X轴旋 转和绕Y轴旋转的自由度,电机输出力按以下公式计算:

F301=F302=kp301ey+kd301e·y+c301·e·y+a301ey|e·y+ey|+b301+k301eθz+k301e·θz

F303=F304=kp303ey+kd303e·y+c303·e·y+a303ey|e·y+ey|+b303-k303eθz-k303e·θz

F305=F306=kp305ex+kd305e·x+c305·e·x+a305ex|e·x+a305ex|+b305

F307=kp307ez+kd307e·y+c307·e·z+a307ez|e·z+a307ey|+b307+k307eθx+k307e·θx+k307eθy+k307e·θy

F308=kp308ez+kd308e·z+c308·e·z+a308ez|e·z+a308ez|+b308+k308eθx+k308e·θx-k308eθy-k308e·θy

F309=kp309ez+kd309e·z+c309·e·z+a309ez|e·z+a309ez|+b309-k309eθx-k309e·θx+k309eθy+k309e·θy

F3010=kp3010ez+kd3010e·z+c3010·e·z+a3010ez|e·z+a3010ez|+b3010-k3010eθx-k3010e·θx-k3010eθy-k3010e·θy

其中:F301为第一音圈电机输出力,F302为第二音圈电机输出,F303为第三音圈电机输出 力,F304为第四音圈电机输出力,F305为第五音圈电机输出力,F306为第六音圈电机输出,F307为第七音圈电机输出力,F308为第八音圈电机输出力,F309为第九音圈电机输出力,F3010为第 十音圈电机输出力;

kp301、kp303、kp305、kp307、kp308、kp309、kp3010、kd301、kd303、kd305、kd307、kd308、kd309、 kd3010、c301、c303、c305、c307、c308、c309、c3010、a301、a303、a305、a307、a308、a309、a3010、 b301、b303、b305、b307、b308、b309、b3010、k301、k303、k305、k307、k308、k309、k3010为控制器 比例系数;

ey=yd-y,yd为微动台沿Y轴方向目标位置,y为激光尺反馈信号,为ey对时间的 一阶导数;ex=xd-x,xd为微动台沿X轴的目标位置,x为反馈信号,为ex对时间的一阶 倒数;ez=zd-z,zd为微动台沿Z轴的目标位置,z为反馈信号,为ez对时间的一阶倒数; θxd为微动台绕X轴的目标位置,θx为反馈信号,为对时间的一阶倒数; θyd为微动台绕Y轴的目标位置,θy为反馈信号,为对时间的一阶倒数; θzd为微动台绕Z轴的目标转角,θz为反馈信号,为对时间的一阶倒数;

粗动台仅具有y方向的自由度,其控制系统要保持粗动台与微动台在y方向的相对位置 不变,设第一粗动台与微动台相对位置保持ycd1不变,第二粗动台与微动台相对位置保持ycd2不变。在两个粗动台的运动控制方法中,第一粗动台以第一音圈电机和第二音圈电机的输出 力作为前馈,第三电涡流传感器信号为微动台与第一粗动台之间的位置偏差,以该偏差为反 馈实现第一粗动台沿Y轴的运动;第二粗动台以第三音圈电机和第四音圈电机的输出力作为 前馈,第四电涡流传感器信号为微动台与第二粗动台之间的位置偏差,以该偏差为反馈实现 第二粗动台沿Y轴的运动,粗动台直线电机输出力按照以下公式计算:

F1001=F302+F301+kp1001ey1001+kd1001e·y1001+c1001·e·y1001+a1001ey1001|e·y1001+a1001ey1001|+b1001

F1002=F304+F303+kp1002ey1002+kd1002e·y1002+c1002·e·y1002+a1002ey1002|e·y1002+a1002ey1002|+b1002

其中:F1001为第一粗动台直线电机输出力、F1002为第二粗动台直线电机输出力;

kp1001、kp1002、kd1001、kd1002、c1001、c1002、a1001、a1002、b1001、b1002为控制器比例系数;

ey1001=ycd1-yc1,ycd1为第一粗动台与微动台目标相对位置,yc1第三电涡流传感器反馈 信号;为ey1001第三电涡流传感器信号对时间的导数;

ey1002=ycd2-yc2,ycd2为第二粗动台与微动台目标相对位置,yc2第四电涡流传感器反馈 信号;为ey1002对时间的导数;

3)根据求解的每个驱动电机的输出力得到每个电机的控制指令,该控制指令由D/A卡进 行数模转换后输入至驱动器,驱动器成比例地输出电流驱动相应电机,进而实现微动台以及 粗动台的运动。

去获取专利,查看全文>

相似文献

  • 专利
  • 中文文献
  • 外文文献
获取专利

客服邮箱:kefu@zhangqiaokeyan.com

京公网安备:11010802029741号 ICP备案号:京ICP备15016152号-6 六维联合信息科技 (北京) 有限公司©版权所有
  • 客服微信

  • 服务号