CN105093927A - 电动舵机死区换向替代补偿方法 - Google Patents
电动舵机死区换向替代补偿方法 Download PDFInfo
- Publication number
- CN105093927A CN105093927A CN201510449762.4A CN201510449762A CN105093927A CN 105093927 A CN105093927 A CN 105093927A CN 201510449762 A CN201510449762 A CN 201510449762A CN 105093927 A CN105093927 A CN 105093927A
- Authority
- CN
- China
- Prior art keywords
- controller
- steering wheel
- ema
- speed
- output
- 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
Abstract
电动舵机死区换向替代补偿方法属于电动舵机伺服控制技术领域,该方法是在电动舵机伺服系统控制器中加入补偿控制器,将电动舵机位置偏转误差e、舵机正常工作下的PWM值、舵机方向信号输入补偿控制器,其输出为▽m;当e>θ0且舵机位置发生换向时,▽m=uv0,代替速度PI控制器上一时刻的输出uv(k-1),得出舵机速度环当前输出为uv(k)=uv0+(kpv+kiv)ev(k)-kpvev(k-1);当e<-θ0且舵机位置发生换向时,▽m=uv1,代替速度PI控制器上一时刻的输出uv(k-1),得出舵机速度环当前输出为uv(k)=uv1+(kpv+kiv)ev(k)-kpvev(k-1)。本发明不需要精确的补偿值▽m,经控制器几次迭代运算后便能快速启动舵机,消除死区的影响,同时也避免因频繁补偿而导致的稳态抖动问题。
Description
技术领域
本发明属于电动舵机伺服控制技术领域,具体涉及一种电动舵机死区换向替代补偿方法。
背景技术
电动舵机(EMA)因其体积小、成本低、易于控制等优点,在国内外飞行器上得到较为广泛的应用。但舵机系统不可避免的存在死区(摩擦、间隙等),在死区不太严重且控制指标要求不严格的情况下,可以忽略。但是,在做高精度、高带宽的位置跟踪时,忽略死区效应将产生严重的“平顶”问题,严重影响舵机系统的跟踪精度及带宽,甚至造成飞行器的航迹抖动,破坏飞行器的稳定性。因此,针对死区的补偿和控制方法必不可少。
目前,不少学者采用变结构控制、神经网络控制、粒子算法等先进控制理论取得较好的成果,较好的解决了舵机死区带来的“平顶”问题。但其缺点是:算法较为复杂、运算周期较长,不易工程化实现,对微处理芯片要求较高;传统的补偿控制器对补偿量的精度要求较高,导致工程化后补偿效果大大降低;克服死区问题的同时又引入了新的问题。
发明内容
为了解决现有技术对存在死区的舵机位置跟踪系统,做小角度位置正弦跟踪时,舵机系统存在较大的“平顶”问题,造成较大的位置跟踪误差,进而引发飞行器航迹剧烈抖动的技术问题,本发明提供了一种简单可靠、易于工程化实现、提高控制精度及速度的电动舵机死区换向替代补偿方法。该方法在伺服系统控制器中加入死区换向替代补偿控制器,有效的改善位置跟踪“平顶”问题,提高跟踪精度;由于补偿方式、补偿位置及补偿精度,将直接影响“平顶”削弱效果和舵机系统的其他性能指标,在设计死区换向补偿控制算法时,结合舵机旋转方向及偏转误差,在速度环采用换向替代补偿的方式。
本发明解决技术问题所采取的技术方案如下:
电动舵机死区换向替代补偿方法,其包括如下步骤:在电动舵机伺服系统控制器中加入补偿控制器,将电动舵机位置偏转误差e、舵机正常工作下的PWM值、舵机方向信号输入补偿控制器,其输出为▽m;当舵机位置偏转误差e>θ0(θ0是一个大于零极小值,可根据稳态精度要求进行调整),且舵机位置发生换向时,▽m=uv0(uv0为舵机正常运转下的正向PWM码值),代替电动舵机伺服系统控制器中速度PI控制器上一时刻的输出uv(k-1),得出舵机速度环当前输出为uv(k)=uv0+(kpv+kiv)ev(k)-kpvev(k-1);当舵机位置偏转误差e<-θ0,且舵机位置发生换向时,▽m=uv1(uv1为舵机正常运转下的负向PWM码值),代替速度PI控制器上一时刻的输出uv(k-1),得出舵机速度环当前输出为uv(k)=uv1+(kpv+kiv)ev(k)-kpvev(k-1);在|e|≤|θ0|或者舵机位置未发生换向时,补偿控制器输出▽m为速度PI控制器上一时刻的输出uv(k-1)。
本发明的有益效果如下:
1、本发明通过对舵机死区进行补偿,有效地改善了小角度位置正弦跟踪存在的“平顶”现象,解决了因“平顶”问题而引发的飞行器指令高频颤抖问题。
2、本发明采用换向替代补偿的方式,每次换向仅做一次补偿,有效地避免了传统补偿算法因控制器的频繁补偿而影响舵机系统其他性能指标的问题。
3、本发明采用的替换补偿方法对补偿量的精度要求低,可以直接使用舵机正常运行时PWM值作为补偿值,算法简单、可靠、工程量小,且易于工程化实现,具有较广的适用范围。
附图说明
图1是本发明的电动舵机系统结构框图。
图2是本发明的舵机伺服系统控制器工作原理图。
图3是本发明的舵机伺服系统控制器计算流程图。
图4是本发明的换向替代补偿控制器流程图。
图5是引入舵机死区换向替代补偿控制器前后0.1°、4Hz小角度正弦跟踪的对比图。
具体实施方式
下面结合附图和实施例对本发明做进一步说明。
如图1所示,本发明的电动舵机系统包括舵机伺服系统控制器、PWM功率模块、无刷直流电机、减速器、速度传感器和位置传感器;舵机伺服系统控制器接收舵机偏转指令,同时通过速度传感器和位置传感器实时采集舵机的速度和位置信号,并经舵机伺服系统控制器的处理后,输出PWM码值至PWM功率模块,驱动无刷直流电机,进而带动舵面偏转,实现舵机系统的高精度位置跟踪。
如图1和图2所示,本发明的舵机伺服系统控制器主要包括位置环控制器、速度环控制器和补偿控制器三部分;位置环为外环,采用PI控制器,输入量为舵机偏转指令、位置反馈信号,输出量为速度环的速度指令;速度环为内环,采用PI控制器,输入量为速度指令、速度反馈信号、补偿控制器的补偿值,输出量为PWM码值,通过脉宽调制实现速度大小及方向的控制;补偿控制器的输入量为当前舵机位置偏转误差、舵机正常工作下的PWM码值、舵机旋转方向,补偿控制器的输出量为▽m,用于替代速度环控制器上一时刻的输出PWM(k-1)。舵机伺服系统控制器的工作过程,当位置环控制器接收到舵机偏转指令θ和舵偏角反馈值θ'后,输出速度偏转指令v,同时向补偿控制器输出位置跟踪误差e;补偿控制器接收舵机位置偏转误差e,同时根据电动舵机的旋转方向及其正常工作下的PWM值,输出粗略的补偿值▽m,来替代PWM(k-1);速度环控制器根据接收到的速度指令v、速度反馈v'和补偿值▽m,计算出新的PWM(k)值。此方法不需要精确的补偿值▽m,经控制器几次迭代运算后便能快速启动舵机,消除死区的影响,同时也避免因频繁补偿而导致的稳态抖动问题。
如图3所示,其为本发明的舵机伺服系统控制器计算流程。舵机位置换向时,由于离散控制器的迭代计算和静摩擦等作用,致使舵机速度换向在时间上滞后于舵机换向,同时在静摩擦作用范围内出现位置“平顶”现象,严重影响跟踪精度。
位置环PI离散控制器如下:
其中,kp、ki为位置环PI控制器参数,可根据系统性能指标求得。θ(k)为当前位置指令,θ'(k)为当前位置反馈,ep(k)为当前位置偏转误差,ep(k-1)为上一时刻位置偏转误差,up(k)为当前时刻位置PI控制器输出。
将舵机偏转指令θ(k)及舵机位置反馈θ'(k)输入位置环控制器,经位置环控制器运算输出速度指令up(k)至速度环控制器。
速度环PI离散控制器如下:
其中,kpv、kiv为速度环PI控制器参数,可根据系统性能指标求得。up(k)为当前速度指令,v'(k)为当前速度反馈,ev(k)为当前速度误差,ev(k-1)为上一时刻速度误差,uv(k)为当前时刻位置PI控制器输出,uv(k-1)为上一时刻位置PI控制器输出。
速度PI控制器接收速度指令up(k)、速度反馈值v'(k)、补偿控制器的补偿值,通过速度PI控制器计算输出PWM,实现脉宽调制。因速度、位置离散控制器迭代项uv(k-1)和up(k-1)的影响,位置换向即ep(k)方向发生变化时,uv(k)符号方向不能及时发生改变,存在较大的延迟,导致位置发生换向时速度环不能及时换向,同时由于静摩擦影响,使得系统速度环存在死区,为此加入死区补偿控制器。
图4为本发明所设计的换向替代补偿控制器流程图。将电动舵机位置偏转误差e、控制器输出的PWM值、舵机方向信号输入舵机死区补偿控制器,其输出为▽m。当舵机位置偏转误差e>θ0(θ0为一个大于零的极小值,可根据稳态精度的要求进行调整),且舵机位置发生换向时,▽m=uv0(uv0为舵机正常运转下的正向PWM码值),代替速度PI控制器上一时刻的输出uv(k-1),即得出舵机速度环当前输出为uv(k)=uv0+(kpv+kiv)ev(k)-kpvev(k-1);当舵机位置偏转误差e<-θ0,且舵机位置发生换向时,▽m=uv1(uv1为舵机正常运转下的负向PWM码值),代替速度PI控制器上一时刻的输出uv(k-1),即得出舵机速度环当前输出为uv(k)=uv1+(kpv+kiv)ev(k)-kpvev(k-1);在舵机位置跟踪误差较小及舵机位置未发生换向情况下,死区换向替代补偿控制器则不起作用。这样,既可以有效补偿舵机死区消除位置跟踪“平顶”问题,又可以避免因频繁补偿控制参数而引发控制的不连续性。
图5为引入舵机死区替换补偿控制器前后,电动舵机做0.1°、4Hz小角度正弦位置跟踪对比图。可以看出,引入替换补偿控制器之前,由于控制器迭代的延迟、静摩擦等因素影响,做小角度正弦跟踪时,存在50ms的速度死区,位置出现较严重“平顶”现象,平顶时间约为62ms,跟踪误差为0.12°;引入替换补偿控制器之后,速度死区为8ms,位置平顶时间为18ms,跟踪误差为0.05°,跟踪精度及响应速度得到较大的提高。本发明的电动舵机死区换向替代补偿方法,在克服舵机死区影响的同时不影响其他指标,并且不需要精确的补偿量、算法简单易于工程实现。
Claims (1)
1.电动舵机死区换向替代补偿方法,其特征在于,该方法包括如下步骤:在电动舵机伺服系统控制器中加入补偿控制器,将电动舵机位置偏转误差e、舵机正常工作下的PWM值、舵机方向信号输入补偿控制器,其输出为当舵机位置偏转误差e>θ0(θ0为一个大于零的极小值,可根据稳态精度的要求进行调整),且舵机位置发生换向时,(uv0为舵机正常运转下的正向PWM码值),代替电动舵机伺服系统控制器中速度PI控制器上一时刻的输出uv(k-1),得出舵机速度环当前输出为uv(k)=uv0+(kpv+kiv)ev(k)-kpvev(k-1);当舵机位置偏转误差e<-θ0,且舵机位置发生换向时,(uv1为舵机正常运转下的负向PWM码值),代替速度PI控制器上一时刻的输出uv(k-1),得出舵机速度环当前输出为uv(k)=uv1+(kpv+kiv)ev(k)-kpvev(k-1);在|e|≤|θ0|或者舵机位置未发生换向时,补偿控制器输出为速度PI控制器上一时刻的输出uv(k-1)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510449762.4A CN105093927B (zh) | 2015-07-28 | 2015-07-28 | 电动舵机死区换向替代补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510449762.4A CN105093927B (zh) | 2015-07-28 | 2015-07-28 | 电动舵机死区换向替代补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105093927A true CN105093927A (zh) | 2015-11-25 |
CN105093927B CN105093927B (zh) | 2017-07-25 |
Family
ID=54574633
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510449762.4A Active CN105093927B (zh) | 2015-07-28 | 2015-07-28 | 电动舵机死区换向替代补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105093927B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106341065A (zh) * | 2016-10-12 | 2017-01-18 | 闽江学院 | 超声波电机伺服控制系统速度死区补偿控制装置及方法 |
CN106681134A (zh) * | 2017-01-10 | 2017-05-17 | 广东石油化工学院 | 一种高精度舵机位置控制方法 |
CN107065943A (zh) * | 2017-05-02 | 2017-08-18 | 南京工程学院 | 一种直驱转台位置控制系统及控制方法 |
CN108803357A (zh) * | 2018-09-03 | 2018-11-13 | 中国科学院长春光学精密机械与物理研究所 | 一种pid和改进滑模的电动舵机混合控制方法及系统 |
CN109976371A (zh) * | 2019-04-22 | 2019-07-05 | 朴敏楠 | 飞行器巡航段时姿态极限环的抑制方法、装置和设备 |
CN110109348A (zh) * | 2019-05-13 | 2019-08-09 | 河南工学院 | 一种基于深度的液压比例阀双向死区补偿方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5301101A (en) * | 1990-06-21 | 1994-04-05 | Honeywell Inc. | Receding horizon based adaptive control having means for minimizing operating costs |
CN1800781A (zh) * | 2004-12-30 | 2006-07-12 | 中国科学院自动化研究所 | 一种航迹自动舵控制系统及其方法 |
CN101488010A (zh) * | 2009-03-06 | 2009-07-22 | 北京理工大学 | 一种伺服系统本质非线性补偿控制器 |
CN202379084U (zh) * | 2011-11-25 | 2012-08-15 | 北京自动化控制设备研究所 | 一种快速响应电动舵机用多回路控制与大功率驱动电路 |
CN103207568A (zh) * | 2013-03-18 | 2013-07-17 | 哈尔滨工程大学 | 一种抗舵机饱和的船舶航向自适应控制方法 |
-
2015
- 2015-07-28 CN CN201510449762.4A patent/CN105093927B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5301101A (en) * | 1990-06-21 | 1994-04-05 | Honeywell Inc. | Receding horizon based adaptive control having means for minimizing operating costs |
CN1800781A (zh) * | 2004-12-30 | 2006-07-12 | 中国科学院自动化研究所 | 一种航迹自动舵控制系统及其方法 |
CN101488010A (zh) * | 2009-03-06 | 2009-07-22 | 北京理工大学 | 一种伺服系统本质非线性补偿控制器 |
CN202379084U (zh) * | 2011-11-25 | 2012-08-15 | 北京自动化控制设备研究所 | 一种快速响应电动舵机用多回路控制与大功率驱动电路 |
CN103207568A (zh) * | 2013-03-18 | 2013-07-17 | 哈尔滨工程大学 | 一种抗舵机饱和的船舶航向自适应控制方法 |
Non-Patent Citations (5)
Title |
---|
张明月,等: "改进自抗扰控制谐波式电动舵机伺服系统", 《光学精密工程》 * |
张明月,等: "电动舵机速度环改进自抗扰控制研究", 《计算机测量与控制》 * |
朱钰: "船舶变频液压舵机控制策略研究", 《船舶工程》 * |
肖亮,等: "基于高效率SVPWM控制的电动舵机", 《电力电子》 * |
肖前进,等: "电动舵机伺服系统非线性辨识及补偿", 《光学精密工程》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106341065A (zh) * | 2016-10-12 | 2017-01-18 | 闽江学院 | 超声波电机伺服控制系统速度死区补偿控制装置及方法 |
CN106681134A (zh) * | 2017-01-10 | 2017-05-17 | 广东石油化工学院 | 一种高精度舵机位置控制方法 |
CN107065943A (zh) * | 2017-05-02 | 2017-08-18 | 南京工程学院 | 一种直驱转台位置控制系统及控制方法 |
CN107065943B (zh) * | 2017-05-02 | 2019-09-20 | 南京工程学院 | 一种直驱转台位置控制系统及控制方法 |
CN108803357A (zh) * | 2018-09-03 | 2018-11-13 | 中国科学院长春光学精密机械与物理研究所 | 一种pid和改进滑模的电动舵机混合控制方法及系统 |
CN109976371A (zh) * | 2019-04-22 | 2019-07-05 | 朴敏楠 | 飞行器巡航段时姿态极限环的抑制方法、装置和设备 |
CN110109348A (zh) * | 2019-05-13 | 2019-08-09 | 河南工学院 | 一种基于深度的液压比例阀双向死区补偿方法 |
CN110109348B (zh) * | 2019-05-13 | 2023-03-10 | 河南工学院 | 一种基于深度的液压比例阀双向死区补偿方法 |
Also Published As
Publication number | Publication date |
---|---|
CN105093927B (zh) | 2017-07-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105093927A (zh) | 电动舵机死区换向替代补偿方法 | |
CN103231798B (zh) | 一种利用数字电动舵机控制装置的控制方法 | |
CN103701386B (zh) | 基于观测磁链误差的异步电机无速度传感器的全阶磁链观测器的获取方法 | |
CN103213666B (zh) | 一种基于位置环换向的电动舵机装置和控制方法 | |
CN105932918A (zh) | 高精数控机床的控制直线伺服系统运行速度的方法及装置 | |
CN103303454A (zh) | 一种基于速度环换向的电动舵机装置及其控制方法 | |
CN108336935B (zh) | 一种反步控制协同eso的直线电机控制方法 | |
CN103281020A (zh) | 一种用于电动舵机的四象限控制装置及其方法 | |
CN103516280B (zh) | 一种永磁同步电机电流环调节器的改进方法 | |
CN103309254A (zh) | 一种闸机电机控制系统 | |
CN103607149B (zh) | 一种超声电机舵伺服系统及其控制方法 | |
CN205334227U (zh) | 一种舵轮agv控制装置、控制系统 | |
CN203786565U (zh) | 一种基于位置环控制的电动舵机系统 | |
CN103312248B (zh) | 一种基于dsp的直线加减速拐点误差补偿方法 | |
CN104635621A (zh) | 基于现场总线的xy工作台过象限凸起补偿方法 | |
CN204810188U (zh) | 基于模型预测控制的三相感应电机直接转矩控制系统 | |
CN108599659B (zh) | 基于实时运动控制平台以及fpga的伺服系统及其控制方法 | |
CN106788014A (zh) | 步进电机极速驱动方法 | |
CN108803357B (zh) | 一种pid和改进滑模的电动舵机混合控制方法及系统 | |
CN102541098A (zh) | 一种电液线位移伺服系统 | |
CN104476744A (zh) | 一种注塑机节能伺服控制系统 | |
CN201427265Y (zh) | 一种刀具补偿系统 | |
WO1988003282A1 (en) | Negative feedback control system | |
CN102468794A (zh) | 电动自行车位置电流双闭环控制器 | |
CN201792465U (zh) | 一种注塑机节能控制系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20210120 Address after: 266111 No.17, Hongxiang 2nd Road, Jihongtan street, Chengyang District, Qingdao City, Shandong Province Patentee after: Zhongtian Changguang (Qingdao) equipment Technology Co.,Ltd. Address before: 130033, 3888 southeast Lake Road, Jilin, Changchun Patentee before: Changchun Institute of Optics, Fine Mechanics and Physics, Chinese Academy of Sciences |