[发明专利]一种基于直线磁钢阵列的运动平台一维定位方法

说明书

技术领域

本发明涉及一种包含直线磁钢阵列的运动部件的测量方法，特别涉及一种利用线性霍尔传感器进行测量的方法，属于测量及数据处理技术领域。

背景技术

直线电机是一种将电磁能直接转换成直线运动机械能的电磁装置，它具有结构简单、定位精度高、响应速度快等优点，可以直接驱动工作台，这样就取消了驱动电机和工作台之间的一切中间传动环节，从而克服了传统驱动方式的传动环节带来的缺点，因而广泛地应用于工业直线驱动、交通运输、军事装备等众多领域。

在运用直线电机的运动系统中，一般采用高精度光栅尺作为位置检测元件，定位精度取决于光栅的分辨率。专利200720002447.8中，描述了利用光栅位置检测编码器进行位置检测，专利200610033455中，描述了利用光栅编码器进行位置实时反馈来进行定位。以上专利技术所运用的元器件，测量精度虽然较高，但需要较为复杂的电路与光学设备并且成本较高。而在实际运动过程中，若直接用霍尔传感器进行位置测量，测量信号本身及采样过程都会存在噪声而导致测量精度损失。

发明内容

本发明的目的提供一种基于直线磁钢阵列的运动平台一维定位方法，并不局限于直线电机，当定子磁钢阵列布置得当，就能产生在运动方向上呈正弦分布的磁场，在磁场分布明确的前提下，即可利用与运动部件相关的磁通密度测量值进行位置确定。该方法针对包含直线磁钢阵列的运动系统，利用多个传感器的数据融合，提供一种简单、便捷、鲁棒的平台定位方法，从而达到降低成本及降低噪声对测量精度影响的目的。

为达到上述发明目的，本发明采取的技术方案是：一种基于直线磁钢阵列的运动平台一维定位方法的运动系统，包括定子平台、相对定子平台运动的运动平台，定子平台上有N极、S极交替放置的直线磁钢阵列，它们之间由气隙隔开，运动平台面积小于定子平台。

一种基于直线磁钢阵列的运动平台一维定位方法，所述方法包括以下步骤：

1)选定运动系统中运动平台表面运动方向上的直线磁钢阵列一个或者多个极距内任意n个不同位置，每个位置放置1个线性霍尔传感器，其中，不同极距内相同相位的位置被认为是同一位置，而且n至少等于2；

2)根据运动系统中直线磁钢阵列确定磁通密度分布模型公式：B_z＝A×sin(X+α+α₀)；

其中，B_z表示直线磁钢阵列磁通密度，A表示磁通密度分布模型幅值分量，X表示要解算的运动平台质心相位，α表示线性霍尔传感器安装位置相对运动平台质心的相位，α₀表示初始相位；

3)在运动平台运动前，测量步骤1)中线性霍尔传感器的安装位置S_αi，其中，i＝1，2…，n，并转化为相对运动平台质心的相位α_i，其中，i＝1，2…，n；

4)在运动平台工作过程中，记录步骤3)中各个线性霍尔传感器磁通密度测量值B_zi，其中，i＝1，2…，n；

5)将步骤4)中测量值作为观测量，将步骤2)中直线磁钢阵列磁通密度分布模型作为计算模型，通过数学算法解算出运动平台的质心相位X，该质心相位X为相对相位；

6)根据步骤5)中解算出的运动平台质心相位X，进一步确定运动平台质心相对于初始相位的位置S_x，所述的初始相位由在运动平台上安装的机械零位给出。

上述技术方案中，步骤3)中所述的线性霍尔传感器相对运动平台质心的相位α_i与安装位置S_αi的关系如下：

其中，τ为定子平台直线磁钢阵列的极距。

本发明对步骤5)中所得到的运动平台质心相位X，还需要进行以下处理：

设X_r为运动平台质心相对于初始相位的相位，N为运动方向上相对于初始相位的跳跃周期数，则：X_r＝N×2π+X，得到运动平台质心相对于初始相位的相位，进而得到运动平台质心相对于初始相位的位置，即：

本发明步骤5)中所述的数学算法采用无迹卡尔曼滤波、非线性最小二乘、扩展卡尔曼滤波算法进行。

本发明的技术特征还在于，所述的相对于初始相位的跳跃周期数的确定方法如下：

a.设X_n为当前时刻解算出的运动平台质心相位，X_n-1为上个时刻解算出的运动平台质心相位，N_n为当前时刻相对于初始相位的跳跃周期数，N_n-1为上个时刻相对于初始相位的跳跃周期数；