一种基于卡尔曼滤波的双读数头光电编码器角度估计方法技术

本发明专利技术属于光电编码器调试技术领域，具体涉及一种基于卡尔曼滤波的双读数头光电编码器角度估计方法，该方法包括：对双读数头光电编码器的两个读数头获得的角度信息分别通过滑动均值插值微分得到角速度信息，利用电机电流，利用角速度、电机电流和角度的关系对编码器角度信息进行卡尔曼滤波，根据滤波完的数据求两组角度值的自适应加权平均滤波值作为预估角度；本发明专利技术提升了光电编码器的角度测量精度，增加所测角度信息的可靠性。增加所测角度信息的可靠性。增加所测角度信息的可靠性。

【技术实现步骤摘要】
一种基于卡尔曼滤波的双读数头光电编码器角度估计方法


[0001]本专利技术属于光电编码器调试
，具体涉及一种基于卡尔曼滤波的双读数头光电编码器角度估计方法。

技术介绍

[0002]光电编码器是一种通过光电转换将输出轴上的机械几何位移量转换成脉冲或数字量的传感器；由于光电编码器具有易小型化和较强环境适应力，因此该器件被广泛应用于电机转子位置检测的传感器中。一般的光电编码器主要由光栅盘和光电探测装置组成。在伺服系统中，由于光电码盘与电动机同轴，电动机旋转时，光栅盘与电动机同速旋转.经发光二极管等电子元件组成的检测装置检测输出若干脉冲信号。通过计算每秒光电编码器输出脉冲的个数就能反映当前电动机的转速。为判断旋转方向，码盘还可提供相位相差90
°
的2个通道的光码输出，根据双通道光码的状态变化确定电机的转向。
[0003]目前，为了提高光电编码器的精度，一般采用中值滤波和均值滤波对光电编码器测量的数据进行滤波，虽然该方法能提高光电编码器的精度；但是该方法的延时较高，影响角度的响应速度，难以适用于高角度刷新频率的场合，无法克服由于轴系装配引起的偏心以及轴承跳动带来的测量误差。

技术实现思路

[0004]为解决以上现有技术存在的问题，本专利技术提出了一种基于卡尔曼滤波的双读数头光电编码器角度估计方法，该方法包括：
[0005]S1：采用两个读数头分别获取电机的角度信息和电流；
[0006]S2：采用滑动均值插值微分的方法分别计算两个读数头采集到的电机角度信息，得到电机的角速度；
[0007]S3：将两个读数头采集到的角度信息、电流以及计算得到的角速度分别进行卡尔曼滤波处理，得到两组滤波后的数据；
[0008]S4：对两组滤波后的数据进行自适应加权平均滤波处理，得到预测角度。
[0009]优选的，采用滑动均值插值微分的方法计算电机的角度信息的公式为：
[0010][0011]进一步的，角度均值的公式为：
[0012][0013]优选的，光电编码器的角度、角速度和角加速度关系为：
[0014][0015]进一步的，光电编码器的角加速度公式为：
[0016][0017]优选的，采用卡尔曼滤波方程对获取的数据进行滤波处理；卡尔曼滤波方程包括系统方程和观测方程；
[0018]系统方程为：
[0019]x
k
＝Ax
k
‑1+Bu
k
‑1+w
k
‑1[0020]观测方程为：
[0021]y
k
＝Cx
k
+v
k
[0022]优选的，对两组滤波后的数据进行自适应加权平均滤波处理的过程包括：计算系统的自适应加权系数K1和K2；设置加权系数阈值；判断自适应加权系数K1和K2与设置的判断阈值的大小，当K1或K2大于10％且小于90％时，通过自适应加权系数K1和K2对两组滤波后的数据进行加权处理；当K1或K2大于90％时，判断K1和K2的大小，选取自适应加权系数大的读数头数值作为测得的角度值。
[0023]进一步的，自适应加权系数K1和K2的表达式如下：
[0024][0025]在计算自适应加权系数时，e1和e2的初始值为读数头的误差方差，对读数头误差的方差值更新的公式为：
[0026][0027]进一步的，预测角度的公式为：
[0028][0029]本专利技术通过卡尔曼滤波的方法对双读数头光电编码器中采集的数据进行滤波处理，不仅提高了光电编码器的精度，而且降低了时延，调高了角度的响应速度；本专利技术通过对滤波后的数据进行自适应加权平均滤波处理，降低了由于轴系装配引起的偏心以及轴承跳动带来的测量误差，还能自适应调节由于读数头精度下降引起的测量误差。
附图说明
[0030]图1为本专利技术的双读数头光电编码器结构示意图；
[0031]图2为本专利技术的角度信息估计方法示意图；
[0032]图3为本专利技术的第一读数头滤波前后角度曲线对比图；
[0033]图4为本专利技术的第二读数头滤波前后角度曲线对比图；
[0034]图5为本专利技术的两组角度信息自适应加权平均滤波前后误差曲线。
具体实施方式
[0035]下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。
[0036]如图1所示，本专利技术的光电编码器结构包括：第一读数头、第二读数头以及码盘；所述第一读数头和所述第二读数头均设置在码盘上，且第一读数头和第二读数头对称。
[0037]一种基于卡尔曼滤波的双读数头光电编码器角度估计方法，如图2所示，该方法包括：
[0038]S1：采用两个读数头分别获取电机的角度信息和电流；
[0039]S2：采用滑动均值插值微分的方法分别计算两个读数头采集到的电机角度信息，得到电机的角速度；
[0040]S3：将两个读数头采集到的角度信息、电流以及计算得到的角速度分别进行卡尔曼滤波处理，得到两组滤波后的数据；
[0041]S4：对两组滤波后的数据进行自适应加权平均滤波处理，得到预测角度。
[0042]采用滑动均值插值微分的方法计算电机的角度信息的公式为：
[0043][0044]其中，表示k时刻电机的滑动均值角度，表示k
‑
N时刻电机的滑动均值角度，表示k
‑
2N时刻电机的角度，N表示每个T周期角度更新数，T表示编码器刷新周期。
[0045]其中，角度均值的公式为：
[0046][0047]其中，和表示k时刻最新六个角度值的最小值和最大值。
[0048]根据电机的角度信息计算光电编码器的角度、角速度和角加速度关系为：
[0049][0050]其中，θ
k
表示k时刻电机的角度，ω
k
表示k时刻电机的角速度，T表示编码器刷新周期，a
k
表示k时刻角加速度。
[0051]光电编码器的角加速度公式为：
[0052][0053]其中，I
k
表示k时刻电机的电流，K
e
表示电机力矩系数，J表示转动惯量。
[0054]对光电编码器测量的数据进行卡尔曼滤波处理的过程包括：建立系统方程和观测方程，根据建立的系统方程对获取的数据进行预测和测量更新处理，得到预测角度。建立的系统方程和观测方程的表达式为：
[0055]系统方程为：
[0056]x
k
＝Ax
k
‑1+Bu
k
‑1+w
k
‑1[0057]观测方程为：
[0058]y
k
＝Cx
k...

【技术保护点】

【技术特征摘要】
观测方程的表达式为：y
k
＝Cx
k
+v
k
其中，x
k
表示系统的状态变量，A表示系统状态转移矩阵，B表示控制矩阵，u
k
‑1表示系统的控制量，w
k
‑1表示系统噪声，y
k
表示角度测量值，C表示测量矩阵，v
k
表示测量噪声。7.根据权利要求1所述的一种基于卡尔曼滤波的双读数头光电编码器角度估计方法，其特征在于，对两组滤波后的数据进行自适应加权平均滤波处理的过程包括：计算系统的自适应加权系数K1和K2；设置加权系数阈值；判断自适应加权系数K1和K2与设置的判断阈值的大小，当K1或K2大于10％且小于90％时，通过自适应加权系数K1和K2对两组滤波后的数据...

【专利技术属性】
技术研发人员：向云飞，李梦男，吴孟桦，杜刚，高惟鹰，郭茂，张倩，
申请(专利权)人：东方红卫星移动通信有限公司，
类型：发明
国别省市：