[发明专利]连续运动高精度全参数检测方法

权利要求书

1.一种连续运动高精度全参数检测方法，其特征是利用光电编码器作为基本检测元件，配以高精度计时器作为检测函数建立和检测采样时刻的计时工具，通过以下步骤分别完成运动位置、速度和加速度的高精度测算：

首先，采用脉冲计数器对光电编码器输出的脉冲信号进行计数，记录下本次检测开始时的脉冲数N_i-1以及经过给定的检测周期后检测结束时的脉冲数N_i，并用高精度计时器测算出以编码器脉冲边沿为界的本次检测的实际检测周期T_s(i)；

其次，将所测得的值代入下式计算出该检测周期内的速度V_i：

Vi=δP(Ni-Ni-1)Ts(i)]]>

式中，δ_P——光电编码器的脉冲当量；

N_i——检测周期结束时的脉冲数；

N_i-1——检测周期开始时的脉冲数；

T_s(i)——检测周期；

第三步，建立速度预测函数：

重复第一、第二步测算出一系列速度数据(V_i-n…，V_i-2，V_i-1，V_i)，并根据所测得的速度数据拟合出速度预测函数v(t)；

第四步，运动位置测算：

以最近收到的编码器脉冲信号的上升沿对应的位置为参考位置，根据速度预测函数v(t)与积分计算原理按以下公式计算确定位置：

S=S0+∫TaTpv(t)dt]]>

式中，S₀——参考位置；

v(t)——速度预测函数；

T_P——采样时刻；

T_a——最近的脉冲上升沿时刻；

第五步，瞬时运动速度测算：

将高精度计时器测出的时间T_p代入第三步建立的速度预测函数中，即可计算出采样信号到达时刻T_P对应的速度；

第六步，加速度测算：

将检测周期T_s(i)内开始和结束时测算的速度差与检测周期T_s(i)相比即可得到加速度值：

Ai=Vi-Vi-1Ts(i)]]>

式中，V_i、V_i-1——检测周期结束和开始时的速度测算值；T_s(i)——检测周期；

第七步，建立加速度预测函数：

重复第六步得到一系列加速度测算历史数据(A_i-n…，A_i-2，A_i-1，A_i)，然后拟合出加速度预测函数a(t)；

第八步，瞬时加速度测算：

将高精度计时器测出的采样时刻T_p代入第七步建立的加速度预测函数中，即可计算出采样信号到达时刻T_p对应的加速度作为检测结果输出即可获得所需的瞬时加速度。