CN108563210A - 一种基于微分预测的零位自动标定方法 - Google Patents
一种基于微分预测的零位自动标定方法 Download PDFInfo
- Publication number
- CN108563210A CN108563210A CN201711292618.XA CN201711292618A CN108563210A CN 108563210 A CN108563210 A CN 108563210A CN 201711292618 A CN201711292618 A CN 201711292618A CN 108563210 A CN108563210 A CN 108563210A
- Authority
- CN
- China
- Prior art keywords
- zero
- controlled device
- bit
- differential
- closed loop
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B23/00—Testing or monitoring of control systems or parts thereof
- G05B23/02—Electric testing or monitoring
- G05B23/0205—Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults
- G05B23/0208—Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults characterized by the configuration of the monitoring system
- G05B23/0213—Modular or universal configuration of the monitoring system, e.g. monitoring system having modules that may be combined to build monitoring program; monitoring system that can be applied to legacy systems; adaptable monitoring system; using different communication protocols
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
Abstract
本发明提出了一种基于微分跟踪器的零位自动标定方法,通过微分跟踪算法从位置被控对象的位置反馈测量信号计算其导数,并综合位置对象物理特性、执行机构物理特性和位置对象零位特性获取执行机构零位特征数据,并使用比例‑积分控制算法控制对象的速度与位置,以重新标定位置系统的零位,解决由于零位漂移引起的控制不稳定和精度差的稳态。本发明具有运算量小、稳定性好、且在系统不需增加新的速度传感的情况下自动寻优标定系统零位以解决零位漂移问题。
Description
技术领域
本发明属于工程控制技术领域,具体的说是一种基于微分预测的零位自动标定方法。
背景技术
由于外部供电、传感器自身误差、控制器自身控制精度、被控对象摩擦系数的差异,会引起被控对象的位置零位漂移的问题。因此需要定期对位置零位进行标定,目前常用的标定方法存在以下两方面的不足。
一方面,现有位置控制系统实现零位标定功能时不仅需要位置感器,而且还需要速度传感器,从而使系统复杂性和重量增加。
另一方面,现有位置控制系统通常采用手动校准的方法以实现零位标定功能。手动标定的方法操作过程复杂,而且容易造成被控对象同外界环境的接触力过大,引起被控对象发生形变;或者是被控对象并未到达零位,而使控制误差增大,影响控制系统的一致性、重复性和精度等品质。
发明内容
发明目的:为了解决传统标定方法的不足,提出一种基于微分预测的零位自动标定方法。
技术方案:一种基于微分预测的零位自动标定方法;包括以下步骤:
1)、获取k时刻的位置信号S(k);
2)、采用预测算法计算k时刻的位置速度信号V(k);
3)、判断S(k)>GL是否成立;
4)、若3)成立执行步骤5),若3)不成立则执行步骤7);
5)、计算位置跟踪加速度误差ev,其中,ev=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)、计算位置误差es,其中,es=S1–S(k);
11)、对计算位置S进行闭环反馈控制,使被控对象的位置稳定在S1;
12)、被控对象的位置稳定在S1,即接触力F∈[5 100]N时,记录连续10次位置数据S0、S1、...、S9,并计算其均值Sm,并将Sm作为位置控制系统的新零位;
其中:
X:状态计数器标识被控对象是否与外界环境发生硬接触,X=1表示硬接触;
GL:维护人员根据控制系统的安装误差预留的标定范围,GL∈[0 1.0];
S:电位计采集的角位置;
V:微分预测预测的角速度;
S1:被控对象与环境硬接触时刻位置传感器记录的采集值,同时也是位置闭环PI控制的角位置期望值;
V1:速度闭环PI控制的期望角速度值;
es:位置误差,es=S1–S;
es:速度误差,vs=v1–v;
vx:是综合被控对象物理特性、执行机构物理特性和位置对象零位特性,通过试验获取的零位特征速度数据。
有益技术效果
1、使得外场维护人员的维护时间明显减少。
2、使系统零位标定的重复性和精度大大提高。
3、使控制系统减少了一个速度传感器及线缆,从而使系统重量显著减轻。
4、确保接触力远小于100N,防止了被控对象在大作用力下的形变。
附图说明
图1方法实现流程图
图2台架试验18V供电电压下的自动标定试验数据
图3台架试验24V供电电压下的自动标定试验数据
图4台架试验28V供电电压下的自动标定试验数据图
图5台架试验32V供电电压下的自动标定试验数据图
图6台架试验28V供电电压下PWM偏差2%的自动标定试验数据
具体实施方式
以某位置调节系统零位标定为例,具体实施步骤如下:
1)、获取k时刻的位置信号S(k);
2)、采用预测算法计算k时刻的位置速度信号V(k);
3)、判断S(k)>1.0是否成立;
4)、若3)不成立执行步骤5),否则执行步骤7);
5)、计算位置跟踪加速度误差ev,其中,ev=-0.55–v;
6)、采用比例-积分(PI)控制算法对计算位置跟踪加速度v进行闭环反馈控制,使被控对象的速度稳定在V1,返回步骤1);
7)、判断(v(k)>=-0.45&&连续15ms)是否成立;
8)、若7)不成立,执行步骤5),否则执行步骤9);
9)、记录当7)成立时刻的位置值并将其作为基值S*(k)=0.01,以此计算位置闭环的目标值S1=S*(k)+β,其中β是被控对象的位置稳态误差ess的函数,这里取β=2*ess,ess=0.25;
10)、计算位置误差es,其中,es=0.01+0.5–S(k);
11)、采用比例-积分(PI)控制算法对计算位置S进行闭环反馈控制,使被控对象的位置稳定在S1;
12)、位置闭环PI控制稳定后,记录连续10次位置数据S0、S1、...、S9,并计算其均值Sm,并将Sm作为位置控制系统的新零位,如表1。
表1试验数据1
S0 | S1 | S2 | S3 | S4 | S5 | S6 | S7 | S8 | S9 | Sm |
0.512 | 0.507 | 0.506 | 0.516 | 0.514 | 0.511 | 0.508 | 0.508 | 0.507 | 0.512 | 0.5101 |
在上述方法的基础上,预测算法采用微分跟踪器算法(TD算法)实现,具体计算方法如下:离散化形式的数字方程如式1,2所示:
x1(k+1)=x1(k)+h*x2(k) (l)
其中:
u0:被跟踪的输入信号,在此即为电位计采集的进排气门位置信号;
x1:被跟踪信号u0的估计跟踪位置值;
x2:被跟踪信号u0的估计跟踪位置值的微分;
h:离散化采样步长;
fst:为微分跟踪非线性函数;
r:滤波因子。
附图2到图6的试验数据进行特征数据统计,统计结果如表2所示。
表2试验数据2
序号 | 供电电压 | 稳态PWM | S1值 | 位置稳态值 | 接触力 |
1 | 18V | 45.17 | 0.513 | 0.516 | 40N |
2 | 24V | 46.45 | 0.512 | 0.514 | 30N |
3 | 28V | 46.96 | 0.509 | 0.512 | 13N |
4 | 32V | 47.33 | 0.507 | 0.506 | 9N |
5 | 28V+2%PWM | 46.67 | 0.508 | 0.507 | 16N |
由不同试验环境下的实验结果发现,本发明提出的零位标定算法一致性和重复性非常好,而且控制精度高,不仅能够保证被控对象与外部环境接触,而且能确保接触力远小于100N,防止了被控对象在大作用力下的形变。
Claims (3)
1.一种基于微分预测的零位自动标定方法;其特征在于:包括以下步骤:
1)、获取k时刻的位置信号S(k);
2)、采用预测算法计算k时刻的位置速度信号V(k);
3)、判断S(k)>GL是否成立;
4)、若3)成立执行步骤5),若3)不成立则执行步骤7);
5)、计算位置跟踪加速度误差ev,其中,ev=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)、计算位置误差es,其中,es=S1–S(k);
11)、对计算位置S进行闭环反馈控制,使被控对象的位置稳定在S1;
12)、被控对象的位置稳定在S1,即接触力F∈[5 100]N时,记录连续10次位置数据S0、S1、...、S9,并计算其均值Sm,并将Sm作为位置控制系统的新零位;
其中:
X:状态计数器标识被控对象是否与外界环境发生硬接触,X=1表示硬接触;
GL:维护人员根据控制系统的安装误差预留的标定范围,GL∈[0 1.0];
S:电位计采集的角位置;
V:微分预测预测的角速度;
S1:被控对象与环境硬接触时刻位置传感器记录的采集值,同时也是位置闭环PI控制的角位置期望值;
V1:速度闭环PI控制的期望角速度值;
es:位置误差,es=S1–S;
es:速度误差,vs=v1–v;
vx:是综合被控对象物理特性、执行机构物理特性和位置对象零位特性,通过试验获取的零位特征速度数据。
2.根据权利要求1所述的一种基于微分预测的零位自动标定方法;其特征在于:所述预测算法采用微分跟踪器算法实现,具体计算方法如下:离散化形式的数字方程如式(1)、(2)所示:
x1(k+1)=x1(k)+h*x2(k) (1)
x2(k+1)=x2(k)+h*fst(x1(k),x2(k),u0(k),r,h) (2)
其中:
u0:被跟踪的输入信号,在此即为电位计采集的进排气门位置信号;
x1:被跟踪信号u0的估计跟踪位置值;
x2:被跟踪信号u0的估计跟踪位置值的微分;
h:离散化采样步长;
fst:为微分跟踪非线性函数;
r:滤波因子。
3.据权利要求1所述的一种基于微分预测的零位自动标定方法;其特征在于:所述闭环反馈控制采用比例-积分(PI)控制算法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711292618.XA CN108563210B (zh) | 2017-12-07 | 2017-12-07 | 一种基于微分预测的零位自动标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711292618.XA CN108563210B (zh) | 2017-12-07 | 2017-12-07 | 一种基于微分预测的零位自动标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108563210A true CN108563210A (zh) | 2018-09-21 |
CN108563210B CN108563210B (zh) | 2020-11-13 |
Family
ID=63529272
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711292618.XA Active CN108563210B (zh) | 2017-12-07 | 2017-12-07 | 一种基于微分预测的零位自动标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108563210B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101900573A (zh) * | 2010-07-15 | 2010-12-01 | 北京理工大学 | 一种实现陆用惯性导航系统运动对准的方法 |
CN103591965A (zh) * | 2013-09-12 | 2014-02-19 | 哈尔滨工程大学 | 一种舰载旋转式捷联惯导系统在线标定的方法 |
CN103759742A (zh) * | 2014-01-22 | 2014-04-30 | 东南大学 | 基于模糊自适应控制技术的捷联惯导非线性对准方法 |
CN105180968A (zh) * | 2015-09-02 | 2015-12-23 | 北京天航华创科技股份有限公司 | 一种imu/磁强计安装失准角在线滤波标定方法 |
CN107102295A (zh) * | 2017-04-13 | 2017-08-29 | 杭州电子科技大学 | 基于glmb滤波的多传感器tdoa无源定位方法 |
-
2017
- 2017-12-07 CN CN201711292618.XA patent/CN108563210B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101900573A (zh) * | 2010-07-15 | 2010-12-01 | 北京理工大学 | 一种实现陆用惯性导航系统运动对准的方法 |
CN103591965A (zh) * | 2013-09-12 | 2014-02-19 | 哈尔滨工程大学 | 一种舰载旋转式捷联惯导系统在线标定的方法 |
CN103759742A (zh) * | 2014-01-22 | 2014-04-30 | 东南大学 | 基于模糊自适应控制技术的捷联惯导非线性对准方法 |
CN105180968A (zh) * | 2015-09-02 | 2015-12-23 | 北京天航华创科技股份有限公司 | 一种imu/磁强计安装失准角在线滤波标定方法 |
CN107102295A (zh) * | 2017-04-13 | 2017-08-29 | 杭州电子科技大学 | 基于glmb滤波的多传感器tdoa无源定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108563210B (zh) | 2020-11-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109543143B (zh) | 非线性带偏差系统的多传感器融合估计方法 | |
CN101256417B (zh) | 比例阀门对精密气压控制装置 | |
CN102032640A (zh) | 工业环境高精度空调的模糊pid控制方法及装置 | |
CN205373627U (zh) | 电梯导轨直线度测量装置 | |
CN103425131B (zh) | 基于非光滑控制和扰动观测的农用拖拉机导航控制方法 | |
CN102768049A (zh) | 一种智能化差压式流量传感装置及其设计方法 | |
CN104166373A (zh) | 数控机床加工误差在线检测方法及系统 | |
CN108958212A (zh) | 校准作业辅助装置、校准作业辅助方法和记录介质 | |
CN110985541B (zh) | 一种用于控制主动磁悬浮轴承系统的控制器及其控制方法 | |
CN105890713A (zh) | 一种流量计校准系统 | |
CN108563210A (zh) | 一种基于微分预测的零位自动标定方法 | |
CN1687718A (zh) | 一种流量计校准方法及其使用的流量计校准系统 | |
CN103279030A (zh) | 基于贝叶斯框架的动态软测量建模方法及装置 | |
Damak et al. | Observer design and sensor location in distributed parameter bioreactors | |
CN109933031A (zh) | 一种根据化验数据自动校正软测量仪表的系统及方法 | |
CN110614636A (zh) | 一种视觉伺服机器人测量时滞补偿方法 | |
CN103413029B (zh) | 具有多速率采样连续搅拌釜式反应器的滚动时域估计方法 | |
CN113778141B (zh) | 一种分段pid控制的流体管道流量控制系统 | |
CN100441327C (zh) | 立式车轮轧机辊系调整仪器及其调整方法 | |
Fischer et al. | Implementation of feedback control in kitchen sink production | |
CN111043999A (zh) | 一种大口径管道测径系统及其测量方法 | |
CN106826837B (zh) | 一种水下机器人非视距控制系统 | |
RU2605785C2 (ru) | Способ измерения и регулирования несоосности | |
CN103105860A (zh) | 计算机液位控制系统及其控制方法 | |
CN109085418A (zh) | 电子油门检测方法及电子油门检测系统和设备 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |