[发明专利]一种基于微分预测的零位自动标定方法

说明书

本发明提出了一种基于微分跟踪器的零位自动标定方法，通过微分跟踪算法从位置被控对象的位置反馈测量信号计算其导数，并综合位置对象物理特性、执行机构物理特性和位置对象零位特性获取执行机构零位特征数据，并使用比例‑积分控制算法控制对象的速度与位置，以重新标定位置系统的零位，解决由于零位漂移引起的控制不稳定和精度差的稳态。本发明具有运算量小、稳定性好、且在系统不需增加新的速度传感的情况下自动寻优标定系统零位以解决零位漂移问题。

技术领域

本发明属于工程控制技术领域，具体的说是一种基于微分预测的零位自动标定方法。

背景技术

由于外部供电、传感器自身误差、控制器自身控制精度、被控对象摩擦系数的差异，会引起被控对象的位置零位漂移的问题。因此需要定期对位置零位进行标定，目前常用的标定方法存在以下两方面的不足。

一方面，现有位置控制系统实现零位标定功能时不仅需要位置感器，而且还需要速度传感器，从而使系统复杂性和重量增加。

另一方面，现有位置控制系统通常采用手动校准的方法以实现零位标定功能。手动标定的方法操作过程复杂，而且容易造成被控对象同外界环境的接触力过大，引起被控对象发生形变；或者是被控对象并未到达零位，而使控制误差增大，影响控制系统的一致性、重复性和精度等品质。

发明内容

发明目的：为了解决传统标定方法的不足，提出一种基于微分预测的零位自动标定方法。

技术方案：一种基于微分预测的零位自动标定方法；包括以下步骤：

1)、获取k时刻的位置信号S(k)；

2)、采用预测算法计算k时刻的位置速度信号V(k)；

3)、判断S(k)GL是否成立；

4)、若3)成立执行步骤5)，若3)不成立则执行步骤7)；

5)、计算位置跟踪加速度误差e_v，其中，e_v＝v1–v；

6)、对计算位置跟踪加速度v进行闭环反馈控制，使被控对象的速度稳定在V1，返回步骤1)；

7)、判断(v(k)＝v1-vx且持续3次)是否成立；

8)、若7)不成立，执行步骤5)，否则执行步骤9)；

9)、记录当前时刻的位置值并将其作为基值S*(k)，以此计算位置闭环的目标值S1＝S*(k) +β，β是被控对象的位置稳态误差ess的函数，取β＝2*ess；

10)、计算位置误差e_s，其中，e_s＝S1–S(k)；

11)、对计算位置S进行闭环反馈控制，使被控对象的位置稳定在S1；

12)、被控对象的位置稳定在S1，即接触力F∈[5 100]N时，记录连续10次位置数据S₀、 S₁、...、S₉，并计算其均值S_m，并将S_m作为位置控制系统的新零位；

其中：

GL：维护人员根据控制系统的安装误差预留的标定范围，GL∈[0 1.0]°；

S：电位计采集的角位置；

V：微分预测的角速度；

S1：被控对象与环境硬接触时刻位置传感器记录的采集值，同时也是位置闭环PI控制的角位置期望值；

V1：速度闭环PI控制的期望角速度值；