CN109491277A - 一种消除导引头伺服系统在位置回路中抖动的方法 - Google Patents
一种消除导引头伺服系统在位置回路中抖动的方法 Download PDFInfo
- Publication number
- CN109491277A CN109491277A CN201710811428.8A CN201710811428A CN109491277A CN 109491277 A CN109491277 A CN 109491277A CN 201710811428 A CN201710811428 A CN 201710811428A CN 109491277 A CN109491277 A CN 109491277A
- Authority
- CN
- China
- Prior art keywords
- ring correction
- correction module
- speed
- servo
- signal
- 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.)
- Pending
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
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/042—Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
- G05B19/0428—Safety, monitoring
-
- 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
- G05B2219/00—Program-control systems
- G05B2219/20—Pc systems
- G05B2219/26—Pc applications
- G05B2219/2609—Process control
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Control Of Position Or Direction (AREA)
Abstract
本发明公开了一种消除导引头伺服系统在位置回路中抖动的方法,本发明方法首先构建伺服系统位置回路抖动消除系统,所构建的系统包括:速度环校正模块和位置环校正模块,通过速度环校正模块进行速度环校正,通过位置环校正模块进行位置环校正。本发明方法具有不改变系统带宽及增益即可消除位置环抖动的优点,能够有效提高系统的控制精度。
Description
技术领域
本发明涉及一种消除伺服系统在位置回路中抖动的方法,特别是一种消除导引头伺服系统在位置回路中抖动的方法。
背景技术
由于现有的伺服系统采用技术成熟的大齿圈结构,系统机械结构存在的死区、齿隙和摩擦等非线性因素会对伺服系统的精度产生影响,同时采用的电机本身也存在一定的死区,导致系统本身具有一定的非线性误差,若系统位置回路中的速度环参数配置不合理,该系统在位置回路中容易出现抖动现象。但对于结构复杂的大齿圈结构,只通过调节速度环参数很难使系统达到最优状态。
伺服系统采用I型控制系统,无负载时,力矩电机的启动电压为0.8V左右,由于伺服系统需要带动负载,以及非线性死区环节的存在,实际的启动电压要比0.8V大一些,当放大器输出电压小于电机启动电压时,电机不转,由于调节器的积分作用,误差电压不断积分,当电压值积分到一定时间,放大器输出电压大于电机启动电压时,电机转动,当误差电压为负时,由于积分速度很慢,积分输出还没来得及反向,电机继续转动;当积分下降到一定值时,积分电压小于电机启动电压,此时电机停止运转,但负的误差电压继续积分到电机启动电压,电机反向转动,从而造成伺服系统工作在位置回路时会出现小幅抖动现象。现有技术中缺乏针对位置回路的抖动消除方法。
发明内容
本发明目的在于提供一种消除导引头伺服系统在位置回路抖动的方法,解决现有技术中缺乏针对位置回路的抖动消除方法的问题。
一种消除导引头伺服系统在位置回路中抖动的方法的具体步骤为:
第一步搭建导引头伺服系统位置回路抖动消除系统
伺服系统位置回路抖动消除系统,包括:速度环校正模块和位置环校正模块。所述:
速度环校正模块的功能:进行速度环校正;
位置环校正模块的功能:进行位置环校正。
第二步速度环校正模块进行速度环校正
电流环由电机、非线性环节和负载顺次串联构成,为消除因电机非线性及结构摩擦阻尼造成的位置回路抖动,速度环校正模块将旋变数字转换器对负载旋变信号进行处理后生成的速度信号与角度输入信号合并,其残差信号作为电流环输入信号,速度环校正模块通过滞后‐超前校正网络对电流环输入信号进行校正,其中滞后‐超前校正网络传递函数为:
其中K为增益,T1、T2为时间常数。
速度环校正模块通过提高增益K,增大时间常数T1,使系统带宽增大,增益变大,然后进行以下判定:当伺服系统抖动已消除,则判定速度环校正有效;当伺服系统抖动没有明显改善时,则判定速度环校正较差。
第三步位置环校正模块进行位置环校正
当速度环校正效果较差时,位置环校正模块增加前馈补偿环节,前馈补偿环节通过DSP实现,前馈传递函数Gb(s)近似为:
Gb(s)=1/G2(s)
未加前馈补偿环节的位置环闭环函数为:G(s)=G1(s)G2(s)/(1+G1(s)G2(s)),增加前馈补偿环节的位置环闭环函数近似为:G(s)=1,其中G1(s)为位置环校正函数、G2(s)为速度回路传递函数。
位置环校正模块首先将旋变数字转换器输出的位置信号与角度输入信号进行合并,对该合并信号进行位置环校正函数G1(s)校正,同时位置环校正模块对角度输入信号进行前馈补偿环节处理,最后位置环校正模块将位置环校正函数校正后的信号与前馈补偿环节处理后的信号进行合并,经DA转换后作为速度环角度输入信号,该信号与速度信号合并并通过滞后‐超前校正网络进行速度环校正后输至电流环。
至此,消除了导引头伺服系统位置回路中的抖动。
本发明方法具有不改变系统带宽及增益即可消除位置环抖动的优点。
具体实施方式
一种消除导引头伺服系统在位置回路中抖动的方法的具体步骤为:
第一步搭建导引头伺服系统位置回路抖动消除系统
伺服系统位置回路抖动消除系统,包括:速度环校正模块和位置环校正模块。所述:
速度环校正模块的功能:进行速度环校正;
位置环校正模块的功能:进行位置环校正。
第二步速度环校正模块进行速度环校正
电流环由电机、非线性环节和负载顺次串联构成,为消除因电机非线性及结构摩擦阻尼造成的位置回路抖动,速度环校正模块将旋变数字转换器对负载旋变信号进行处理后生成的速度信号与角度输入信号合并,其残差信号作为电流环输入信号,速度环校正模块通过滞后‐超前校正网络对电流环输入信号进行校正,其中滞后‐超前校正网络传递函数为:
其中K为增益,T1、T2为时间常数。
速度环校正模块通过提高增益K,增大时间常数T1,使系统带宽增大,增益变大,然后进行以下判定:当伺服系统抖动已消除,则判定速度环校正有效;当伺服系统抖动没有明显改善时,则判定速度环校正较差。
第三步位置环校正模块进行位置环校正
当速度环校正效果较差时,位置环校正模块增加前馈补偿环节,前馈补偿环节通过DSP实现,前馈传递函数Gb(s)近似为:
Gb(s)=1/G2(s)
未加前馈补偿环节的位置环闭环函数为:G(s)=G1(s)G2(s)/(1+G1(s)G2(s)),增加前馈补偿环节的位置环闭环函数近似为:G(s)=1,其中G1(s)为位置环校正函数、G2(s)为速度回路传递函数。
位置环校正模块首先将旋变数字转换器输出的位置信号与角度输入信号进行合并,对该合并信号进行位置环校正函数G1(s)校正,同时位置环校正模块对角度输入信号进行前馈补偿环节处理,最后位置环校正模块将位置环校正函数校正后的信号与前馈补偿环节处理后的信号进行合并,经DA转换后作为速度环角度输入信号,该信号与速度信号合并并通过滞后‐超前校正网络进行速度环校正后输至电流环。
至此,消除了导引头伺服系统位置回路中的抖动。
Claims (1)
1.一种消除导引头伺服系统在位置回路中抖动的方法,其特征在于具体步骤为:
第一步 搭建导引头伺服系统位置回路抖动消除系统
伺服系统位置回路抖动消除系统,包括:速度环校正模块和位置环校正模块;所述:
速度环校正模块的功能:进行速度环校正;
位置环校正模块的功能:进行位置环校正;
第二步 速度环校正模块进行速度环校正
电流环由电机、非线性环节和负载顺次串联构成,为消除因电机非线性及结构摩擦阻尼造成的位置回路抖动,速度环校正模块将旋变数字转换器对负载旋变信号进行处理后生成的速度信号与角度输入信号合并,其残差信号作为电流环输入信号,速度环校正模块通过滞后‐超前校正网络对电流环输入信号进行校正,其中滞后‐超前校正网络传递函数为:
其中K为增益,T1、T2为时间常数;
速度环校正模块通过提高增益K,增大时间常数T1,使系统带宽增大,增益变大,然后进行以下判定:当伺服系统抖动已消除,则判定速度环校正有效;当伺服系统抖动没有明显改善时,则判定速度环校正较差;
第三步 位置环校正模块进行位置环校正
当速度环校正效果较差时,位置环校正模块增加前馈补偿环节,前馈补偿环节通过DSP实现,前馈传递函数Gb(s)近似为:
Gb(s)=1/G2(s)
未加前馈补偿环节的位置环闭环函数为:G(s)=G1(s)G2(s)/(1+G1(s)G2(s)),增加前馈补偿环节的位置环闭环函数近似为:G(s)=1,其中G1(s)为位置环校正函数、G2(s)为速度回路传递函数;
位置环校正模块首先将旋变数字转换器输出的位置信号与角度输入信号进行合并,对该合并信号进行位置环校正函数G1(s)校正,同时位置环校正模块对角度输入信号进行前馈补偿环节处理,最后位置环校正模块将位置环校正函数校正后的信号与前馈补偿环节处理后的信号进行合并,经DA转换后作为速度环角度输入信号,该信号与速度信号合并并通过滞后‐超前校正网络进行速度环校正后输至电流环;
至此,消除了导引头伺服系统位置回路中的抖动。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710811428.8A CN109491277A (zh) | 2017-09-11 | 2017-09-11 | 一种消除导引头伺服系统在位置回路中抖动的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710811428.8A CN109491277A (zh) | 2017-09-11 | 2017-09-11 | 一种消除导引头伺服系统在位置回路中抖动的方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109491277A true CN109491277A (zh) | 2019-03-19 |
Family
ID=65687503
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710811428.8A Pending CN109491277A (zh) | 2017-09-11 | 2017-09-11 | 一种消除导引头伺服系统在位置回路中抖动的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109491277A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110798116A (zh) * | 2019-09-27 | 2020-02-14 | 清华大学 | 一种基于电枢模型独立前馈补偿的电机矢量复合控制器 |
CN112034889A (zh) * | 2020-09-10 | 2020-12-04 | 中国人民解放军海军航空大学 | 一种采用非线性超前网络的飞行器过载控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102009597A (zh) * | 2010-11-03 | 2011-04-13 | 北京航空航天大学 | 一种磁悬浮控制力矩陀螺框架与锁紧控制系统 |
CN104111664A (zh) * | 2014-07-18 | 2014-10-22 | 零八一电子集团有限公司 | 在速度环克服电机死区提高雷达跟踪精度的方法 |
CN105007011A (zh) * | 2015-08-11 | 2015-10-28 | 南京理工大学 | 高精度的机载稳定平台数字控制系统 |
CN106482735A (zh) * | 2016-10-14 | 2017-03-08 | 中国科学院光电技术研究所 | 一种提高快反镜稳定平台扰动抑制能力的控制方法 |
CN106898229A (zh) * | 2017-03-30 | 2017-06-27 | 南京航空航天大学 | 一种自动控制原理实验平台 |
-
2017
- 2017-09-11 CN CN201710811428.8A patent/CN109491277A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102009597A (zh) * | 2010-11-03 | 2011-04-13 | 北京航空航天大学 | 一种磁悬浮控制力矩陀螺框架与锁紧控制系统 |
CN104111664A (zh) * | 2014-07-18 | 2014-10-22 | 零八一电子集团有限公司 | 在速度环克服电机死区提高雷达跟踪精度的方法 |
CN105007011A (zh) * | 2015-08-11 | 2015-10-28 | 南京理工大学 | 高精度的机载稳定平台数字控制系统 |
CN106482735A (zh) * | 2016-10-14 | 2017-03-08 | 中国科学院光电技术研究所 | 一种提高快反镜稳定平台扰动抑制能力的控制方法 |
CN106898229A (zh) * | 2017-03-30 | 2017-06-27 | 南京航空航天大学 | 一种自动控制原理实验平台 |
Non-Patent Citations (3)
Title |
---|
巨林仓主编: "《自动控制原理》", 31 December 2007, 中国电力出版社 * |
张东云: "跟踪雷达天线伺服系统研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
杨晓钧,李兵编著: "《工业机器人技术》", 31 August 2015, 哈尔滨工业大学出版社 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110798116A (zh) * | 2019-09-27 | 2020-02-14 | 清华大学 | 一种基于电枢模型独立前馈补偿的电机矢量复合控制器 |
CN110798116B (zh) * | 2019-09-27 | 2021-12-07 | 清华大学 | 一种基于电枢模型独立前馈补偿的电机矢量复合控制器 |
CN112034889A (zh) * | 2020-09-10 | 2020-12-04 | 中国人民解放军海军航空大学 | 一种采用非线性超前网络的飞行器过载控制方法 |
CN112034889B (zh) * | 2020-09-10 | 2022-09-30 | 中国人民解放军海军航空大学 | 一种采用非线性超前网络的飞行器过载控制方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109491277A (zh) | 一种消除导引头伺服系统在位置回路中抖动的方法 | |
CN105301957B (zh) | 一种新型的抗积分饱和pid控制方法 | |
JP2005278222A5 (zh) | ||
CN104932252A (zh) | 一种改进的自抗扰与pid的串级控制方法 | |
US3941103A (en) | Method and apparatus for changing the spark advance of internal combustion engines | |
CN105372987A (zh) | 一种位置伺服闭环控制系统及其使用方法 | |
CN108549214A (zh) | 一种高性能pid控制方法 | |
CN107919821A (zh) | 一种天线跟踪双电机消隙系统 | |
CN108023531B (zh) | 一种用于闭环位置伺服的可测量速度扰动的补偿方法 | |
CN104977851B (zh) | 一种含微分线性系统的pid参数整定方法 | |
CN105093923A (zh) | 一种基于模糊控制的足球机器人底层控制的方法 | |
CN102591202A (zh) | 改进的积分分离式pid控制方法 | |
JP2013157790A5 (zh) | ||
CN107565877B (zh) | 用于控制电机的方法和设备 | |
JPH03213323A (ja) | 射出成形機の圧力制御方法 | |
JP2019148212A (ja) | 舶用主機関の制御システム | |
CN109687699B (zh) | 一种数字电压电流环实时跟踪输出状态软调整的控制方法 | |
CN104063005B (zh) | 一种等离子体负载电路自动控制方法 | |
US10171013B2 (en) | Servomotor control device | |
CN107991651B (zh) | 一种雷达伺服系统的预定角度自适应步进控制方法 | |
CN107559816B (zh) | 循环流化床机组的控制方法和装置、存储介质、处理器 | |
CN108388111B (zh) | 一种批次过程二维预测函数控制方法 | |
CN108919638A (zh) | 一种基于频域的高阶系统模型降阶及pid控制方法 | |
JP7381270B2 (ja) | サーボモータの制御装置 | |
CN107942761A (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 | ||
WD01 | Invention patent application deemed withdrawn after publication | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20190319 |