[发明专利]动圈式平面电机动子三自由度位移测量方法

权利要求书

1.一种动圈式平面电机动子三自由度位移测量方法，其特征在于所述方法采用如下系统进行测量：该系统包括Ⅰ号电涡流传感器、Ⅱ号电涡流传感器、Ⅲ号电涡流传感器、Ⅰ号绝对直线光栅、Ⅱ号绝对直线光栅及信号处理系统；

将所述Ⅰ号绝对直线光栅沿x向安装在L型线缆台上，L型线缆台在直线电机驱动下沿基台y向跟随平面电机动子运动；Ⅰ号绝对直线光栅读数头安装在L型线缆台的x向导轨上，并通过一柔性机构与平面电机动子连接，该柔性机构允许Ⅰ号绝对直线光栅读数头与平面电机动子在y向和θ_z向有微小的相对位移；

将所述Ⅱ号绝对直线光栅沿y向安装在基台上，Ⅱ号绝对直线光栅读数头安装在直线电机动子上；

将所述Ⅰ号电涡流传感器、Ⅱ号电涡流传感器和Ⅲ号电涡流传感器安装在平板上，平板与平面电机动子一侧固连，其中Ⅱ号电涡流传感器和Ⅲ号电涡流传感器安装在平板靠近直线电机的一侧，且关于平面电机动子的水平中心线对称布置；Ⅰ号电涡流传感器安装在平板靠近x向导轨的一侧；

所述方法包括如下步骤：

1）分别建立3个直角坐标系：平面电机动子坐标系O₁-x₁y₁z₁、线缆台坐标系O₀-x₀y₀z₀和基台坐标系O-xyz，平面电机动子坐标系原点位于平面电机动子的几何中心，在初始位置时，3个坐标系的原点重合；

2）令Ⅰ号绝对直线光栅的读数沿线缆台坐标系x₀轴正方向逐渐减小，标记Ⅰ号绝对直线光栅读数头在线缆台坐标系下x₀=0处的读数x_ref；令Ⅱ号绝对直线光栅的读数沿基台坐标系y轴正方向逐渐减小，标记Ⅱ号绝对直线光栅读数头在基台坐标系下y=0处的读数y_ref；

3）Ⅰ号绝对直线光栅测量Ⅰ号绝对直线光栅读数头在线缆台坐标系下的x向位移，Ⅰ号电涡流传感器测量其安装点到L型线缆台的y向位移，Ⅱ号电涡流传感器和Ⅲ号电涡流传感器分别测量各自安装点到L型线缆台的x向位移；当平面电机动子运动过程中，在每个伺服周期，设Ⅰ号电涡流传感器的读数为y₁，Ⅱ号电涡流传感器和Ⅲ号电涡流传感器的读数分别为x₁和x₂，Ⅰ号绝对直线光栅的读数为x₃，则平面电机动子在线缆台坐标系下的三自由度位移（x₀,y₀,θ₀）为：

x0=xref-x3+(f-e)(x1-x2)2c+(a-d)(x1-x2)2+2c(y1+b)(x1-x2)-4c2d2c4c2+(x1-x2)2y0=e-a(x1-x2)+2c(y1+b)4c2+(x1-x2)2θ0=x1-x22c]]>

其中，（a，b）为Ⅰ号电涡流传感器中心在平面电机动子坐标系下的平面坐标，c为Ⅱ号电涡流传感器中心到平面电机动子坐标系x₁轴的距离，d为Ⅰ号绝对直线光栅读数头到平面电机动子坐标系y₁轴的距离，e为L型线缆台靠近Ⅰ号电涡流传感器的侧面到线缆台坐标系x₀轴的距离，f为Ⅰ号绝对直线光栅读数头到线缆台坐标系x₀轴的距离；

4）Ⅱ号绝对直线光栅测量L型线缆台在基台坐标系下的y向位移，在与步骤3）相同的伺服周期，设Ⅱ号绝对直线光栅的读数为y₂，则平面电机动子在线缆台坐标系下的三自由度位移（x₀,y₀,θ₀）与在基台坐标系下的三自由度位移（x,y,θ）满足下式：

x=x0y=y0+yref-y2θ=θ0]]>

故平面电机动子在基台坐标系下的三自由度位移（x,y,θ）为：

x=xref-x3+(f-e)(x1-x2)2c+(a-d)(x1-x2)2+2c(y1+b)(x1-x2)-4c2d2c4c2+(x1-x2)2y=yref-y2+e-a(x1-x2)+2c(y1+b)4c2+(x1-x2)2θ=x1-x22c.]]>

2.根据权利要求1所述的动圈式平面电机动子三自由度位移测量方法，其特征在于：设平面电机动子任意线圈中心在平面电机动子坐标系下的平面坐标为（l₁,l₂），根据平面电机动子在基台坐标系下的三自由度位移（x,y,θ），求得该线圈中心在基台坐标系下的平面坐标为（x_c,y_c）：

xc=2l1c-l2(x1-x2)(2c)2+(x1-x2)2+xyc=l1(x1-x2)+2l2c(2c)1+(x1-x2)2+y.]]>