CN110955176A - 一种基于模型跟踪控制的伺服系统末端残余振动抑制方法 - Google Patents
一种基于模型跟踪控制的伺服系统末端残余振动抑制方法 Download PDFInfo
- Publication number
- CN110955176A CN110955176A CN201911122365.0A CN201911122365A CN110955176A CN 110955176 A CN110955176 A CN 110955176A CN 201911122365 A CN201911122365 A CN 201911122365A CN 110955176 A CN110955176 A CN 110955176A
- Authority
- CN
- China
- Prior art keywords
- controller
- model
- servo system
- ideal
- input
- 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
Images
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/0423—Input/output
-
- 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/25—Pc structure of the system
- G05B2219/25257—Microcontroller
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
技术领域
本发明涉及振动控制技术领域,尤其涉及一种基于模型跟踪控制的伺服系统末端残余振动抑制方法。
背景技术
为了达到高负载比的性能,一些弹性连接装置常被用到伺服系统中(如图3所示,为典型双惯量机械传动装置模型),这些弹性装置会导致位置传输的滞后误差,当伺服系统由高转速突然停止,对目标位置进行定位时,其负载末端会发生强烈的抖振现象,影响伺服系统的稳定性和快速定位性能。
输入整形法是将输入信号与一系列脉冲信号进行卷积,从而对其进行修正得到整形后的信号输入系统从而抑制一定频率末端振动的方法,输入整形技术由于其原理简单,实施性强等优点被广泛应用于振动抑制中,但是输入整形对模型偏差很敏感,当系统参数出现较大变化时不能进行有效抑制,并且在运行过程中不断调整整形器参数需要牺牲系统的响应时间,振动抑制速度变慢。模型跟踪控制方法简单,由理想模型、实际模型和补偿控制器组成,通过设计补偿控制器可以对系统参数变化引起的误差进行有效抑制,效果优良,适用范围较广。将输入整形与模型跟踪控制相结合,可以快速有效抑制由系统参数变化引起的振动。
现有类似已公开的专利:一种基于输入整形器的机器人关节末端残余振动抑制方法(CN107738273A)华南理工大学,该专利的技术方案包括:
步骤一:获取机器人系统无阻尼固有频率ω0和阻尼比ζ;
步骤二:建立关于输入整形器脉冲幅值参数的线性规划问题数学模型;
步骤三:采用拉格朗日乘子法解出脉冲幅值表达式,迭代求得脉冲幅值最优解;
步骤四:将脉冲幅值最优解与脉冲发生时间结合组成控制误差优化输入整形器;
步骤五:将参考信号与控制误差优化输入整形器做卷积运算得到新的整形信号,对其做预测路径规划处理后,再利用该信号去驱动系统以抑制机器人末端残余振动。
现有技术存在的不足:现有方法在重复型伺服系统中,当系统模型参数存在偏差时,不能快速进行末端振动抑制。
输入整形法作为前馈控制能在误差产生之前对振动进行抑制,但是当参数发生较大范围变化时,输入整形器振动抑制效果差,并且在运行过程中不断调整整形器参数需要牺牲系统的响应时间,振动抑制速度变慢。在重复型伺服系统中,需要快速有效的振动抑制方法来保证实际生产的效率和质量。
发明内容
为了解决上述问题,本发明提供了一种基于模型跟踪控制的伺服系统末端残余振动抑制方法,主要包括以下步骤:
S101:对伺服系统进行建模,得到伺服系统的理想模型;所述伺服系统为带有弹性连接装置的伺服系统;
S102:根据所述理想模型,计算获得伺服系统的系统自然频率和阻尼比;
S103:根据所述系统自然频率和所述阻尼比设计输入整形器,并经过第一PD控制器得到控制输出,进而利用设计好的输入整形器构建负载端理想位置输出;
S104:设计补偿控制器,并将所述负载端理想位置输出和负载端实际位置输出的差值作为设计好的补偿控制器的输入,得到补偿输入;所述负载端实际位置输出的初始值为0;
S105:将所述补偿输入和所述控制输出的和作为驱动信号驱动伺服系统的实际模型,并得到实际模型的负载端实际位置输出,进而将得到的负载端实际位置输出返回至步骤S104,用于下一时刻的控制。
进一步地,步骤S101中,在时域下建立伺服系统的微分方程,并通过拉普拉斯变换将其变换到s域下,得到伺服系统的理想模型;所述理想模型的表达式如公式(1)所示:
上式中,JM为电机转动惯量、θM为电机位置、TM为电磁转矩、ωM为电机角速度、JL为负载端转动惯量、θL为负载位置、TL为负载端转矩、ωL为负载端角速度、Tw为弹簧的弹性转矩、Cw为弹簧的阻尼系数、Kw为弹簧的刚度系数。
进一步地,步骤S102中,根据所述理想模型,计算获得伺服系统的系统自然频率和阻尼比;具体如下:
将公式(1)经过变换,得到公式(2):
进一步地,步骤S103中,根据所述系统自然频率和所述阻尼比设计输入整形器,并经过第一PD控制器得到控制输出,进而利用设计好的输入整形器构建负载端理想位置输出;具体包括如下步骤:
S201:采用ZV整形器作为输入整形器,具体表达式如公式(3)所示:
S202:给定理想输入θM *(t),并将θM *(t)输入至所述输入整形器,得到整形后的信号θZV(t);
S203:将θZV(t)与理想模型输出的理想电机位置θM(t)的差值θZV(t)-θM(t)作为第一PD控制器的输入,得到控制输出V(t);所述第一PD控制器为预先将参数调节好的PD控制器(离线调节所述第一PD控制器的P参数和D参数,当θL *(t)达到零残余振动时,得到调节好的PD控制器);
S204:将V(t)作为所述理想模型的输入,得到负载端理想位置输出θL *(t)和理想电机位置θM(t),同时将理想电机位置θM(t)反馈至步骤S203,用于下一时刻的控制。
进一步地,步骤S104中,设计补偿控制器,并将所述负载端理想位置输出和负载端实际位置输出的差值作为设计好的补偿控制器的输入,得到补偿输入;具体如下:
所述补偿控制器采用第二PD控制器,并对所述第二PD控制器的参数进行在线优化,得到优化后的第二PD控制器;
将所述负载端理想位置输出θL *(t)和负载端实际位置输出θL(t)的差值θL *(t)-θL(t)作为所述优化后的第二PD控制器的输入,得到补偿输入VC(t)。
进一步地,采用黄金分割搜索方法对所述第二PD控制器的参数进行在线优化,得到优化后的第二PD控制器;具体步骤包括:
S301:将所述第二PD控制器的P参数固定,并给定D参数一个预设的初始值;
S302:判断条件S≤δ是否成立?若是,则保持所述第二PD控制器的D参数不变,并到步骤S304;否则,到步骤S303;其中,S为伺服系统的负载周期位置误差平方和,表达式如公式(4)所示,δ为根据预设的实际模型的残余振动百分比阈值求得的负载周期位置误差平方和阈值:
上式中,N=T/Ts,T为伺服系统的工作周期时间,Ts为预设的采样时间;V(ω′n,ζ)为实际模型的残余振动百分比;A↑(k)为无输入整形时实际系统在第k个采样时刻的振动幅值;
根据实际需求,预设一个实际模型的残余振动百分比阈值ε,进而将ε带入公式(4)中,得到负载周期位置误差平方和阈值δ;
实际模型的残余振动百分比V(ω′n,ζ)的表达式如公式(5)所示:
S304:结束此次优化,得到优化后的第二PD控制器。
进一步地,步骤S303中,采用黄金分割搜索方法对所述第二PD控制器的D参数进行调整,得到调整后的D参数,进而得到优化后的第二PD控制器;具体步骤包括:
S401:采用离线方法给定D参数一个初始范围[min,max];并预设精度要求tol和黄金分割系数;其中,黄金分割系数为0.618;
S402:根据公式(6)计算low(k)和high(k):
上式中,k的初始值为1;
S403:将low(k)和high(k)分别作为第二PD控制器的D参数,并分别运行伺服系统,得到low(k)和high(k)各自对应的负载周期位置误差平方和:S(low(k))和S(high(k));S(low(k))和S(high(k))的具体计算公式如公式(7):
S404:判断条件S(low(k))≤S(high(k))是否成立?若是,则到步骤S405;否则,到步骤S407;
S405:判断条件S(low(k))≤δ是否成立?若是,则D参数等于low(k),到步骤S409;否则,将k更新为k+1,并到步骤S406;
S406:令:
min(k)=min(k-1)
max(k)=high(k-1)
low(k)=min(k)+0.618×(max(k)-min(k))
high(k)=max(k)-0.618×(max(k)-min(k));并返回步骤S402;
S407:判断条件S(high(k))≤δ是否成立?若是,则D参数等于high(k),到步骤S409;否则,将k更新为k+1,并到步骤S408;
S408:令:
min(k)=low(k-1)
max(k)=max(k-1)
low(k)=min(k)+0.618×(max(k)-min(k))
high(k)=max(k)-0.618×(max(k)-min(k));并返回步骤S402;
S409:结束,将此时的第二PD控制器作为优化后的第二PD控制器。
本发明提供的技术方案带来的有益效果是:本发明所提出的技术方案针对现有方法中采用的传统输入整形法对参数误差敏感的情况,当系统参数发生较大范围变化时,本专利在输入整形法的基础上,提出加入自调整参数模型跟踪控制,选取周期位置误差平方和为目标函数,黄金分割法为参数寻优搜索方法,对模型跟踪控制中补偿控制器的参数进行在线调整,从而达到快速有效的振动抑制效果。
附图说明
下面将结合附图及实施例对本发明作进一步说明,附图中:
图1是本发明实施例中一种基于模型跟踪控制的伺服系统末端残余振动抑制方法的流程图;
图2是本发明实施例中输入整形+模型跟踪控制的控制结构图;
图3是本发明实施例中典型双惯量机械传动装置模型的示意图。
具体实施方式
为了对本发明的技术特征、目的和效果有更加清楚的理解,现对照附图详细说明本发明的具体实施方式。
本发明的实施例提供了一种基于模型跟踪控制的伺服系统末端残余振动抑制方法。
请参考图1,图1是本发明实施例中一种基于模型跟踪控制的伺服系统末端残余振动抑制方法的流程图;具体包括如下步骤:
S101:对伺服系统进行建模,得到伺服系统的理想模型;所述伺服系统为带有弹性连接装置的伺服系统;
S102:根据所述理想模型,计算获得伺服系统的系统自然频率和阻尼比;
S103:根据所述系统自然频率和所述阻尼比设计输入整形器,并经过第一PD控制器得到控制输出,进而利用设计好的输入整形器构建负载端理想位置输出;
S104:设计补偿控制器,并将所述负载端理想位置输出和负载端实际位置输出的差值作为设计好的补偿控制器的输入,得到补偿输入;所述负载端实际位置输出的初始值为0;
S105:将所述补偿输入和所述控制输出的和作为驱动信号驱动伺服系统的实际模型,并得到实际模型的负载端实际位置输出,进而将得到的负载端实际位置输出返回至步骤S104,用于下一时刻的控制。
步骤S101中,在时域下建立伺服系统的微分方程,并通过拉普拉斯变换将其变换到s域下,得到伺服系统的理想模型;所述理想模型的表达式如公式(1)所示:
上式中,JM为电机转动惯量、θM为电机位置、TM为电磁转矩、ωM为电机角速度、JL为负载端转动惯量、θL为负载位置、TL为负载端转矩、ωL为负载端角速度、Tw为弹簧的弹性转矩、Cw为弹簧的阻尼系数、Kw为弹簧的刚度系数。
步骤S102中,根据所述理想模型,计算获得伺服系统的系统自然频率和阻尼比;具体如下:
将公式(1)经过变换,得到公式(2):
当伺服系统出现参数变化或外界扰动时,将理想模型与实际模型的输出误差输入补偿控制器来进行补偿输入,使伺服系统能够适应自身和外界变化增强鲁棒性。采用PD控制器作为补偿控制器,输入整形与模型跟踪控制结合进行振动抑制的原理如图2所示。从图2中可以看出,通过输入整形技术对电机位置输入信号进行处理并输入理想模型,抑制由弹性负载引起的末端振动,得到一个理想的负载位置输出信号,然后将此理想输出作为实际模型的参考位置输入信号,一旦模型参数在运行环境中出现变化或出现外界扰动,输入整形器不能完全抑制振动,位置误差e将不等于零,此时利用PD型补偿控制器来提高振动抑制效果。
步骤S103中,根据所述系统自然频率和所述阻尼比设计输入整形器,并经过第一PD控制器得到控制输出,进而利用设计好的输入整形器构建负载端理想位置输出;具体包括如下步骤:
S201:采用ZV整形器作为输入整形器,具体表达式如公式(3)所示:
S202:给定理想输入θM *(t),并将θM *(t)输入至所述输入整形器,得到整形后的信号θZV(t);
S203:将θZV(t)与理想模型输出的理想电机位置θM(t)的差值θZV(t)-θM(t)作为第一PD控制器的输入,得到控制输出V(t);所述第一PD控制器为预先将参数调节好的PD控制器(离线调节所述第一PD控制器的P参数和D参数,当θL *(t)达到零残余振动时,得到调节好的PD控制器);
S204:将V(t)作为所述理想模型的输入,得到负载端理想位置输出θL *(t)和理想电机位置θM(t),同时将理想电机位置θM(t)反馈至步骤S203,用于下一时刻的控制。
步骤S104中,设计补偿控制器,并将所述负载端理想位置输出和负载端实际位置输出的差值作为设计好的补偿控制器的输入,得到补偿输入;具体如下:
所述补偿控制器采用第二PD控制器,并对所述第二PD控制器的参数进行在线优化,得到优化后的第二PD控制器;
将所述负载端理想位置输出θL *(t)和负载端实际位置输出θL(t)的差值θL *(t)-θL(t)作为所述优化后的第二PD控制器的输入,得到补偿输入VC(t)。
在本发明实施例中,采用黄金分割搜索方法对所述第二PD控制器的参数进行在线优化,得到优化后的第二PD控制器;具体步骤包括:
S301:将所述第二PD控制器的P参数固定,并给定D参数一个预设的初始值;
S302:判断条件S≤δ是否成立?若是,则保持所述第二PD控制器的D参数不变,并到步骤S304;否则,到步骤S303;其中,S为伺服系统的负载周期位置误差平方和,表达式如公式(4)所示,δ为根据预设的实际模型的残余振动百分比阈值求得的负载周期位置误差平方和阈值:
上式中,N=T/Ts,T为伺服系统的工作周期时间,Ts为预设的采样时间;V(ω′n,ζ)为实际模型的残余振动百分比;A↑(k)为无输入整形时实际系统在第k个采样时刻的振动幅值(此幅值与输入信号有关);
根据实际需求,预设一个实际模型的残余振动百分比阈值ε,进而将ε带入公式(4)中,得到负载周期位置误差平方和阈值δ;
实际模型的残余振动百分比V(ω′n,ζ)的表达式如公式(5)所示:
S303:采用黄金分割搜索方法对所述第二PD控制器的D参数进行调整,得到调整后的D参数,进而得到优化后的第二PD控制器,并到步骤S304;
S304:结束此次优化,得到优化后的第二PD控制器。
步骤S303中,采用黄金分割搜索方法对所述第二PD控制器的D参数进行调整,得到调整后的D参数,进而得到优化后的第二PD控制器;具体步骤包括:
S401:采用离线方法给定D参数一个初始范围[min,max];并预设精度要求tol和黄金分割系数;其中,黄金分割系数为0.618;
S402:根据公式(6)计算low(k)和high(k):
上式中,k的初始值为1;
S403:将low(k)和high(k)分别作为第二PD控制器的D参数,并分别运行伺服系统,得到low(k)和high(k)各自对应的负载周期位置误差平方和:S(low(k))和S(high(k));S(low(k))和S(high(k))的具体计算公式如公式(7)(由于运行时的第二PD控制器的D参数不一样,所以两次运行所产生的负载周期误差位置平方和也不一样):
S404:判断条件S(low(k))≤S(high(k))是否成立?若是,则到步骤S405;否则,到步骤S407;
S405:判断条件S(low(k))≤δ是否成立?若是,则D参数等于low(k),到步骤S409;否则,将k更新为k+1,并到步骤S406;
S406:令:
min(k)=min(k-1)
max(k)=high(k-1)
low(k)=min(k)+0.618×(max(k)-min(k))
high(k)=max(k)-0.618×(max(k)-min(k));并返回步骤S402;
S407:判断条件S(high(k))≤δ是否成立?若是,则D参数等于high(k),到步骤S409;否则,将k更新为k+1,并到步骤S408;
S408:令:
min(k)=low(k-1)
max(k)=max(k-1)
low(k)=min(k)+0.618×(max(k)-min(k))
high(k)=max(k)-0.618×(max(k)-min(k));并返回步骤S402;
S409:结束,将此时的第二PD控制器作为优化后的第二PD控制器。
在本发明实施例中,负载周期误差位置平方和的原理如下:
对于一个欠阻尼二阶系统,系统的脉冲响应为:
无输入整形时在t=0时施加单个单位幅值脉冲得到的残余振动幅值为:
其中:
则在有输入整形和无输入整形的情况下,系统残余振动百分比为:
针对零振荡输入整形器,假设系统理想模型频率为ωn,实际模型自然频率为ω′n,系统阻尼比不变,实际模型的残余振动百分比表达式为:
当ζ=0,c=1时,V(ω′n,ζ)=0,当ζ=0,c≠1时,分析可知当实际模型频率与理想模型频率相同时,零振荡输入整形器可以达到零残余振动的效果,但当实际模型频率与理想模型频率相差较大时,输入整形器效果将大大降低。
采用周期位置误差平方和作为目标函数,当残余振动百分比超出一定范围值后,认为系统参数发生了变化导致振动频率变化。假设系统工作周期时间为T,采样时间为Ts,每个周期采样数为N=T/Ts。那么在每个周期末的负载位置误差平方和为当确定期望残余振动百分比值后,通过公式反推可以得到理论上期望实际频率变化值,然后根据此实际频率、输入信号和采样数,得到期望周期负载位置误差平方和的值,将理想周期位置误差平方和的值作为判断是否进行搜索的条件,将每个周期得到的实际周期位置误差平方和作为下一步骤中参数优化的比较条件。
本发明的有益效果是:本发明所提出的技术方案针对现有方法中采用的传统输入整形法对参数误差敏感的情况,当系统参数发生较大范围变化时,本专利在输入整形法的基础上,提出加入自调整参数模型跟踪控制,选取周期位置误差平方和为目标函数,黄金分割法为参数寻优搜索方法,对模型跟踪控制中补偿控制器的参数进行在线调整,从而达到快速有效的振动抑制效果。具有以下优点:
1)在输入整形法的基础上,加入自调整参数模型跟踪控制,通过优化补偿控制器参数来抑制由系统参数变化引起的振动。
2)在系统模型参数发生不同程度变化时,利用黄金分割法来寻找模型跟踪控制中补偿控制器的优化参数,使其适用于大范围频率振动情况,增强系统的鲁棒性。
以上所述仅为本发明的较佳实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (7)
1.一种基于模型跟踪控制的伺服系统末端残余振动抑制方法,其特征在于:包括以下步骤:
S101:对伺服系统进行建模,得到伺服系统的理想模型;所述伺服系统为带有弹性连接装置的伺服系统;
S102:根据所述理想模型,计算获得伺服系统的系统自然频率和阻尼比;
S103:根据所述系统自然频率和所述阻尼比设计输入整形器,并经过第一PD控制器得到控制输出,进而利用设计好的输入整形器构建负载端理想位置输出;
S104:设计补偿控制器,并将所述负载端理想位置输出和负载端实际位置输出的差值作为设计好的补偿控制器的输入,得到补偿输入;所述负载端实际位置输出的初始值为0;
S105:将所述补偿输入和所述控制输出的和作为驱动信号驱动伺服系统的实际模型,并得到实际模型的负载端实际位置输出,进而将得到的负载端实际位置输出返回至步骤S104,用于下一时刻的控制。
4.如权利要求3所述的一种基于模型跟踪控制的伺服系统末端残余振动抑制方法,其特征在于:步骤S103中,根据所述系统自然频率和所述阻尼比设计输入整形器,并经过第一PD控制器得到控制输出,进而利用设计好的输入整形器构建负载端理想位置输出;具体包括如下步骤:
S201:采用ZV整形器作为输入整形器,具体表达式如公式(3)所示:
S202:给定理想输入θM *(t),并将θM *(t)输入至所述输入整形器,得到整形后的信号θZV(t);
S203:将θZV(t)与理想模型输出的理想电机位置θM(t)的差值θZV(t)-θM(t)作为第一PD控制器的输入,得到控制输出V(t);所述第一PD控制器为预先将参数调节好的PD控制器(离线调节所述第一PD控制器的P参数和D参数,当θL *(t)达到零残余振动时,得到调节好的PD控制器);
S204:将V(t)作为所述理想模型的输入,得到负载端理想位置输出θL *(t)和理想电机位置θM(t),同时将理想电机位置θM(t)反馈至步骤S203,用于下一时刻的控制。
5.如权利要求4所述的一种基于模型跟踪控制的伺服系统末端残余振动抑制方法,其特征在于:步骤S104中,设计补偿控制器,并将所述负载端理想位置输出和负载端实际位置输出的差值作为设计好的补偿控制器的输入,得到补偿输入;具体如下:
所述补偿控制器采用第二PD控制器,并对所述第二PD控制器的参数进行在线优化,得到优化后的第二PD控制器;
将所述负载端理想位置输出θL *(t)和负载端实际位置输出θL(t)的差值θL *(t)-θL(t)作为所述优化后的第二PD控制器的输入,得到补偿输入VC(t)。
6.如权利要求5所述的一种基于模型跟踪控制的伺服系统末端残余振动抑制方法,其特征在于:采用黄金分割搜索方法对所述第二PD控制器的参数进行在线优化,得到优化后的第二PD控制器;具体步骤包括:
S301:将所述第二PD控制器的P参数固定,并给定D参数一个预设的初始值;
S302:判断条件S≤δ是否成立?若是,则保持所述第二PD控制器的D参数不变,并到步骤S304;否则,到步骤S303;其中,S为伺服系统的负载周期位置误差平方和,表达式如公式(4)所示,δ为根据预设的实际模型的残余振动百分比阈值求得的负载周期位置误差平方和阈值:
上式中,N=T/Ts,T为伺服系统的工作周期时间,Ts为预设的采样时间;V(ω′n,ζ)为实际模型的残余振动百分比;A↑(k)为无输入整形时实际系统在第k个采样时刻的振动幅值;
根据实际需求,预设一个实际模型的残余振动百分比阈值ε,进而将ε带入公式(4)中,得到负载周期位置误差平方和阈值δ;
实际模型的残余振动百分比V(ω′n,ζ)的表达式如公式(5)所示:
S303:采用黄金分割搜索方法对所述第二PD控制器的D参数进行调整,得到调整后的D参数,进而得到优化后的第二PD控制器,并到步骤S304;
S304:结束此次优化,得到优化后的第二PD控制器。
7.如权利要求6所述的一种基于模型跟踪控制的伺服系统末端残余振动抑制方法,其特征在于:步骤S303中,采用黄金分割搜索方法对所述第二PD控制器的D参数进行调整,得到调整后的D参数,进而得到优化后的第二PD控制器;具体步骤包括:
S401:采用离线方法给定D参数一个初始范围[min,max];并预设精度要求tol和黄金分割系数;其中,黄金分割系数为0.618;
S402:根据公式(6)计算low(k)和high(k):
上式中,k的初始值为1;
S403:将low(k)和high(k)分别作为第二PD控制器的D参数,并分别运行伺服系统,得到low(k)和high(k)各自对应的负载周期位置误差平方和:S(low(k))和S(high(k));S(low(k))和S(high(k))的具体计算公式如公式(7):
S404:判断条件S(low(k))≤S(high(k))是否成立?若是,则到步骤S405;否则,到步骤S407;
S405:判断条件S(low(k))≤δ是否成立?若是,则D参数等于low(k),到步骤S409;否则,将k更新为k+1,并到步骤S406;
S406:令:
min(k)=min(k-1)
max(k)=high(k-1)
low(k)=min(k)+0.618×(max(k)-min(k))
high(k)=max(k)-0.618×(max(k)-min(k));并返回步骤S402;
S407:判断条件S(high(k))≤δ是否成立?若是,则D参数等于high(k),到步骤S409;否则,将k更新为k+1,并到步骤S408;
S408:令:
min(k)=low(k-1)
max(k)=max(k-1)
low(k)=min(k)+0.618×(max(k)-min(k))
high(k)=max(k)-0.618×(max(k)-min(k));并返回步骤S402;
S409:结束,将此时的第二PD控制器作为优化后的第二PD控制器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911122365.0A CN110955176B (zh) | 2019-11-15 | 2019-11-15 | 一种基于模型跟踪控制的伺服系统末端残余振动抑制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911122365.0A CN110955176B (zh) | 2019-11-15 | 2019-11-15 | 一种基于模型跟踪控制的伺服系统末端残余振动抑制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110955176A true CN110955176A (zh) | 2020-04-03 |
CN110955176B CN110955176B (zh) | 2020-10-09 |
Family
ID=69977571
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911122365.0A Active CN110955176B (zh) | 2019-11-15 | 2019-11-15 | 一种基于模型跟踪控制的伺服系统末端残余振动抑制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110955176B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114218718A (zh) * | 2022-02-22 | 2022-03-22 | 河北工业大学 | 一种s形轨迹柔性振动抑制可靠性分析方法 |
CN114291159A (zh) * | 2022-02-09 | 2022-04-08 | 广州小鹏自动驾驶科技有限公司 | 基于输入整形器的电动助力转向系统控制方法及装置 |
CN114310907A (zh) * | 2022-01-25 | 2022-04-12 | 佛山智能装备技术研究院 | 一种多工况自适应的工业机器人末端振动抑制方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1529946A2 (de) * | 2003-11-07 | 2005-05-11 | Siemens Aktiengesellschaft | Dämpfungssystem mit einem LOLIMOT-Modell gegen Antriebsstrangschwingungen |
JP2009303432A (ja) * | 2008-06-17 | 2009-12-24 | Hitachi Industrial Equipment Systems Co Ltd | モータによる位置制御装置 |
US8803466B2 (en) * | 2011-09-01 | 2014-08-12 | Kabushiki Kaisha Yaskawa Denki | Motor control apparatus |
CN104993766A (zh) * | 2015-08-05 | 2015-10-21 | 南京埃斯顿自动控制技术有限公司 | 一种二质量系统谐振抑制方法 |
CN105305912A (zh) * | 2015-09-29 | 2016-02-03 | 芯荣半导体有限公司 | 音圈马达的输入信号整形方法、驱动电路及其驱动方法 |
CN105429540A (zh) * | 2015-12-08 | 2016-03-23 | 南京埃斯顿自动控制技术有限公司 | 一种基于模型跟踪控制的交流伺服电机振动抑制方法 |
CN107370433A (zh) * | 2017-09-05 | 2017-11-21 | 南京工程学院 | 基于pid自学习时滞补偿器的电流谐波补偿方法 |
CN107450322A (zh) * | 2017-09-04 | 2017-12-08 | 中国地质大学(武汉) | 基于中立模型的钻柱系统的粘滑振动抑制方法及系统 |
CN108418487A (zh) * | 2018-02-11 | 2018-08-17 | 东南大学 | 一种用于电动汽车的速度脉动抑制方法 |
-
2019
- 2019-11-15 CN CN201911122365.0A patent/CN110955176B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1529946A2 (de) * | 2003-11-07 | 2005-05-11 | Siemens Aktiengesellschaft | Dämpfungssystem mit einem LOLIMOT-Modell gegen Antriebsstrangschwingungen |
JP2009303432A (ja) * | 2008-06-17 | 2009-12-24 | Hitachi Industrial Equipment Systems Co Ltd | モータによる位置制御装置 |
US8803466B2 (en) * | 2011-09-01 | 2014-08-12 | Kabushiki Kaisha Yaskawa Denki | Motor control apparatus |
CN104993766A (zh) * | 2015-08-05 | 2015-10-21 | 南京埃斯顿自动控制技术有限公司 | 一种二质量系统谐振抑制方法 |
CN105305912A (zh) * | 2015-09-29 | 2016-02-03 | 芯荣半导体有限公司 | 音圈马达的输入信号整形方法、驱动电路及其驱动方法 |
CN105429540A (zh) * | 2015-12-08 | 2016-03-23 | 南京埃斯顿自动控制技术有限公司 | 一种基于模型跟踪控制的交流伺服电机振动抑制方法 |
CN107450322A (zh) * | 2017-09-04 | 2017-12-08 | 中国地质大学(武汉) | 基于中立模型的钻柱系统的粘滑振动抑制方法及系统 |
CN107370433A (zh) * | 2017-09-05 | 2017-11-21 | 南京工程学院 | 基于pid自学习时滞补偿器的电流谐波补偿方法 |
CN108418487A (zh) * | 2018-02-11 | 2018-08-17 | 东南大学 | 一种用于电动汽车的速度脉动抑制方法 |
Non-Patent Citations (1)
Title |
---|
赵志刚 等: "改进型负输入整形与最优控制结合的振动抑制方法", 《振动与冲击》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114310907A (zh) * | 2022-01-25 | 2022-04-12 | 佛山智能装备技术研究院 | 一种多工况自适应的工业机器人末端振动抑制方法 |
CN114310907B (zh) * | 2022-01-25 | 2024-01-16 | 佛山智能装备技术研究院 | 一种多工况自适应的工业机器人末端振动抑制方法 |
CN114291159A (zh) * | 2022-02-09 | 2022-04-08 | 广州小鹏自动驾驶科技有限公司 | 基于输入整形器的电动助力转向系统控制方法及装置 |
CN114291159B (zh) * | 2022-02-09 | 2023-04-07 | 广州小鹏自动驾驶科技有限公司 | 基于输入整形器的电动助力转向系统控制方法及装置 |
CN114218718A (zh) * | 2022-02-22 | 2022-03-22 | 河北工业大学 | 一种s形轨迹柔性振动抑制可靠性分析方法 |
CN114218718B (zh) * | 2022-02-22 | 2022-05-06 | 河北工业大学 | 一种s形轨迹柔性振动抑制可靠性分析方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110955176B (zh) | 2020-10-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110955176B (zh) | 一种基于模型跟踪控制的伺服系统末端残余振动抑制方法 | |
CN108363301B (zh) | 基于干扰观测滑模变结构的轮廓误差交叉耦合控制方法 | |
US8090455B2 (en) | Motion control servo loop apparatus | |
CN107394784B (zh) | 一种陷波滤波器在线谐振抑制参数优化方法 | |
CN107121932B (zh) | 电机伺服系统误差符号积分鲁棒自适应控制方法 | |
CN110071676B (zh) | 一种柔性机器人关节伺服系统的振动抑制方法和装置 | |
CN106774379B (zh) | 一种智能超螺旋强鲁棒姿态控制方法 | |
CN104993766B (zh) | 一种二质量系统谐振抑制方法 | |
CN105932930B (zh) | 电动机控制装置 | |
CN113759721B (zh) | 一种永磁同步电动机l1自适应迭代学习控制方法 | |
CN108919652B (zh) | 一种自适应抗扰整形控制方法与系统 | |
CN111176306B (zh) | 一种水下航行器变增益自抗扰纵向控制方法 | |
CN115202216A (zh) | 考虑输入约束的机械臂抗干扰有限时间控制方法 | |
CN110968037A (zh) | 一种减小多轴运动系统轮廓误差的控制方法 | |
CN110955192B (zh) | 伺服控制装置、机器人及伺服控制方法 | |
CN110842913A (zh) | 一种单关节机械臂的自适应滑模迭代学习控制方法 | |
CN108563123B (zh) | 直线电机x-y的自适应迭代学习鲁棒控制系统及设计方法 | |
CN111046510B (zh) | 一种基于轨迹分段优化的柔性机械臂的振动抑制方法 | |
CN114223129A (zh) | 电动机控制装置及其自动调整方法 | |
WO2019087554A1 (ja) | フィードバック制御方法、及びモータ制御装置 | |
CN112859594B (zh) | 一种用于永磁球形电机轨迹跟踪的终端滑模控制方法 | |
CN112372639B (zh) | 一种机械臂系统的二重相位超前补偿迭代学习控制方法 | |
Ito et al. | Fast and precise positioning of rotary table systems by feedforward disturbance compensation considering interference force | |
Zhang et al. | Position control of XY precision planar motion table based on input shaping filter | |
CN110625616A (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 |