CN103470744B - 一种消除传动齿轮间隙影响的控制方法及*** - Google Patents
一种消除传动齿轮间隙影响的控制方法及*** Download PDFInfo
- Publication number
- CN103470744B CN103470744B CN201310446168.0A CN201310446168A CN103470744B CN 103470744 B CN103470744 B CN 103470744B CN 201310446168 A CN201310446168 A CN 201310446168A CN 103470744 B CN103470744 B CN 103470744B
- Authority
- CN
- China
- Prior art keywords
- theta
- centerdot
- gamma
- kappa
- gear
- 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.)
- Active
Links
- 230000005540 biological transmission Effects 0.000 title claims abstract description 45
- 238000000034 method Methods 0.000 title claims abstract description 38
- 238000006073 displacement reaction Methods 0.000 claims description 9
- 230000009466 transformation Effects 0.000 claims description 9
- 230000009467 reduction Effects 0.000 claims description 6
- 239000003638 chemical reducing agent Substances 0.000 claims description 4
- 230000008859 change Effects 0.000 claims description 3
- 239000013643 reference control Substances 0.000 claims description 3
- 230000000694 effects Effects 0.000 claims 4
- 238000011217 control strategy Methods 0.000 abstract description 5
- 238000013459 approach Methods 0.000 abstract description 2
- 230000011664 signaling Effects 0.000 abstract 1
- 238000004364 calculation method Methods 0.000 description 4
- 238000012938 design process Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000007547 defect Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000009347 mechanical transmission Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000035939 shock Effects 0.000 description 1
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明提供了一种消除传动齿轮间隙影响的控制方法及***,所述方法包含:步骤101)为齿轮间隙建立光滑模型;步骤102)将建立的光滑模型引入智能控制算法,得到齿轮传动***的驱动侧的输入转矩;步骤103)采用得到的输入转矩控制传动齿轮的驱动侧,使驱动侧的输出力矩平滑传递至负载侧,同时保证驱动侧的位置输出以所需的精度跟踪期望的位置信号。1)克服了传统齿轮间隙模型的不光滑特性;2)使避免使用逆模型补偿和建立多模型开关***策略成为可能,简化了齿轮间隙控制策略的设计,便于工程化实现;3)使得***驱动输出力矩平滑传递;4)将带有齿轮间隙的级联***转化为一般的被控对象,拓宽了控制器设计可以采用的策略。
Description
技术领域
本发明涉及一种伺服齿轮传动***高精度定位的控制方法,特别是涉及传动齿轮间隙的建模方法,即本发明涉及一种消除传动齿轮间隙影响的控制方法及***。
背景技术
齿轮间隙是由于伺服齿轮传动***中运动部件之间通过齿轮驱动而产生的,它既是机械传动过程正常进行不可缺少的一种非线性传动机制,也是影响***动态性能和稳态精度的一个重要的非线性因素。现有的对齿轮间隙的建模是死区模型,该模型是通过***驱动和从动部分的传输力矩和相对位移来描述齿轮间隙非线性的,数学描述如下式:
其中,θ为齿轮前后的相对转动位移,2α(α>0)为齿轮间隙的间距,γ(γ>0)为齿轮的刚度系数,Told为齿轮的传输力矩。该模型在物理上十分符合实际,因此被广泛采用。上述各参数含义也可以参见表1。
对于该模型,现有的控制方法包含两类:一是逆模型补偿,在其方法策略中假定***驱动部分在间隙中间能实现瞬间跳跃,才能获得其方法的结论。在实际的物理伺服齿轮传动***中死区模型的输入描述的是两个实体间的转动位移差,由于实体惯量的存在,齿隙间不可能实现瞬间跳跃,故采用逆模型补偿的方法在实际中是不可操作的;二是建立多模型开关***,即将整个***划分为间隙模式和接触模式,分别设计控制策略及切换控制算法,这就使得传动***的复杂度大大增加,同时稳定性也不易保证,不适合工程应用。
造成现有解决齿轮间隙影响的技术方案局限在上述两类策略中的主要原因在于齿轮间隙的死区模型描述的不光滑特性,使得对其补偿变得十分困难,从而也增加了传动***控制的复杂程度,如果不能消除间隙非线性的影响,传动***性能会因极限环或齿轮接触冲击而降低甚至变得不稳定,同时,轮齿间的碰撞会产生严重的震荡和噪音。
发明内容
本发明的目的在于,为克服上述问题,本发明提供了一种消除传动齿轮间隙影响的控制方法及***。
为了实现上述目的,本发明提供了一种消除传动齿轮间隙影响的控制方法,所述方法包含:
步骤101)采用如下公式为齿轮间隙建立光滑模型:
其中,θ为齿轮前后的相对转动位置角信号,2α为齿轮间隙的间距,γ为齿轮的刚度系数,Tnew为光滑模型的输出,κ为可调参数;
步骤102)基于建立的光滑模型得到对象状态空间描述,再依据对象状态空间描述得到齿轮传动***的驱动侧的输入转矩;
步骤103)采用得到的输入转矩控制传动齿轮的驱动侧,使驱动侧的输出力矩平滑传递至负载侧,同时保证驱动侧的位置输出以所需的精度跟踪期望的位置信号。
采用智能控制算法得到对象状态空间描述,所述智能控制算法包含反步控制算法或状态反馈线性化控制算法。
可选的,当采用反步控制算法时,所述步骤102)进一步包含:
首先,定义状态变量x=[x1x2x3x4]T=[θlωlθmωm]T,通过引入光滑的齿轮间隙模型将受控对象转化为如下状态空间形式:
基于上述对象数学描述,进行反步控制算法确定驱动侧的输入转矩,具体步骤如下:
步骤1,定义输出跟踪误差为:e1=θr-θl=θr-x1;
依据定义的跟踪误差选取Lyapunov函数,该函数形式为:进而解算出虚拟控制量x2的期望值为c1为可调的正常数;
步骤2,定义x2的误差为e2=μ1-x2,依据定义的误差选取Lyapunov函数进而解算出虚拟控制量(nγ/Jl)x3的期望值为 其中c2为可调的正常数;
步骤3,定义x3的跟踪误差为e3=μ2-(nγ/Jl)x3,依据定义的误差选取Lyapunov函数进而解算出虚拟控制量nγ(2+λ(xθ))x4/2Jl的期望值为 c3为可调的正常数;
步骤4,定义x4的跟踪误差为e4=μ3-nγ(2+λ(xθ))x4/2Jl,依据定义的跟踪误差选取Lyapunov函数依据上述定义的x1、x2、x3和x4的值并基于Lyapunov稳定性原理解算得到驱动侧的输入转矩u为:
其中,c4为可调的正常数;Jm表示驱动侧转动惯量,Jl表示负载侧转动惯量,n表示减速器的减速比,γ表示齿轮刚度系数,xθ表示齿轮前后相对转动角位移θ的状态变量;λ(xθ)、τ(xθ)表示自定义函数;b1、b2、b3、b4、b5表示自定义参数;表示期望角位置信号θr的一阶微分信号;表示θr的二阶微分信号;表示θr的三阶微分信号;表示θr的四阶微分信号;φ1(x)表示自定义函数;φ2(x)表示自定义函数;x1、x2、x3、x4分别表示θl、ωl、θm、ωm的状态变量。
当采用状态反馈线性化控制算法时,所述步骤102)进一步包含:
首先,定义状态变量x,通过引入光滑的齿轮间隙模型将受控对象转化为如下状态空间形式:
其中,
基于上述对象数学描述,进行状态反馈线性化控制算法确定驱动侧的输入转矩,具体步骤如下:
步骤1)通过分析,给出一个微分同胚坐标变换如下:
其中, 可求得
进而可求得,
可知,所给的坐标变换是一个全局微分同胚;
步骤2)基于所设计的状态变换,令则式(5.1)可转化为
其中,
(5.4)即为原***(5.1)经坐标变换(5.2)转化后的***数学描述,v为中间控制量;
步骤3)令中间控制量v取:
v=HZ+vr(5.5)其中,H=[h1h2h3h4]为控制器参数向量,其值的选择满足(A+bH)为Hurwitz阵, 为参考控制输入;
步骤4)定义误差σ1=z1-θr, 误差向量为σ=[σ1σ2σ3σ4]T,根据(5.4)—(5.5),则误差动态方程为
由于(A+bH)是Hurwitz阵,根据线性***稳定性判据可知,误差向量σ是全局渐近稳定的,即z1能够全局渐近稳定跟踪期望的位置信号θr,由于(5.2)是全局微分同胚,则经过坐标逆变换后可知输出信号θl能够渐近稳定跟踪期望的位置信号θr;
通过设计的中间控制量v的表达式,反推驱动侧的输入转矩u:
其中,
其中,上述各参数的含义可以参考表1,计算符号的含义也可参考当采用反步控制算法时涉及的各计算符号的含义,即表示期望角位置信号θr的一阶微分信号;表示θr的二阶微分信号,表示θr的三阶微分信号;表示θr的四阶微分信号。
所述控制参数的取值策略包含:
策略一,将控制参数都设置为1;或
策略二,控制器参数ci>0且满足c1=min(ci),并通过多元函数求极值的方法使下式中“ξ(c1,c2,c3,c4)/c1”项最小进而确定ci的取值,其中,i=1…4;
所述模型参数κ应在控制器参数ci>0确定后,根据伺服齿轮传动***对负载侧输出角度的精度要求,依据误差精度上限确定。
为了实现上述方法,本发明还提供了一种消除齿轮间隙影响的控制***,所述***包含:
光滑模型建立模块,用于采用如下公式为齿轮间隙建立光滑模型:
其中,θ为齿轮前后的相对转动位置角信号,2α为齿轮间隙的间距,γ为齿轮的刚度系数,Tnew为光滑模型的输出,κ为可调参数;
驱动侧输入转矩确定模块,用于将建立的光滑模型引入智能控制算法,得到齿轮传动***的驱动侧的输入转矩;和
控制模块,用于采用得到的输入转矩控制传动齿轮,使驱动侧的输出力矩平滑传递至负载侧。
上述智能控制算法包含反步控制算法或状态反馈线性化控制算法。
上述驱动侧输入转矩确定模块进一步包含:
比较模块,用于将期望输出的位置与实际输出位置进行比较判决,输出角位置偏差信号;
对象状态空间描述信息获取模块,用于对建立的齿轮间隙的光滑模型和比较模块输入的角位置偏差、模型偏差及光滑间隙模型信息进行处理,最后输出带有光滑齿轮间隙和模型误差的对象状态空间描述;
第一处理模块,用于基于所述对象状态空间描述信息获取模块输出的带有光滑齿轮间隙和模型误差的对象状态空间描述信息,进行基于Lyapunov稳定性原理的反步控制处理,最终输出第二虚拟控制量x2信息;
第二处理模块,用于基于第一处理模块输出的第二虚拟控制量x2信息,进行基于Lyapunov稳定性原理的反步控制处理,并输出第三虚拟控制量x3信息;
第三处理模块,用于基于第二处理模块输出的第三虚拟控制量x3信息,进行基于Lyapunov稳定性原理的反步控制处理处理,并输出第四虚拟控制量x4信息;和
第四处理模块,用于基于第三处理模块输入的第四虚拟控制量x4信息,采用如下公式得到驱动侧的输入转矩u:
策略一,将控制参数都设置为1;或
策略二,控制器参数ci>0且满足c1=min(ci),并通过多元函数求极值的方法使下式中“ξ(c1,c2,c3,c4)/c1”项最小进而确定ci的取值,其中,i=1…4;
所述模型参数κ应在控制器参数ci>0确定后,根据伺服齿轮传动***对负载侧输出角度的精度要求,依据误差精度上限确定。
上述自定义的函数和参数的类型及取值可以参考具体实施方式部分的内容。
与现有技术相比,本发明的技术优势在于:
1)克服了传统齿轮间隙模型的不光滑特性;2)使避免使用逆模型补偿和建立多模型开关***策略成为可能,简化了齿轮间隙控制策略的设计,便于工程化实现;3)克服现有技术方案的缺陷,使得***驱动输出力矩平滑传递;4)将带有齿轮间隙的级联***转化为一般的被控对象,拓宽了控制器设计可以采用的策略。
附图说明
图1是伺服齿轮传动***示意图;
图2是本发明提供的消除传动齿轮间隙影响的控制方法流程图;
图3是本发明提供的基于反步控制算法得到的驱动侧输入转矩确定模块的组成框图;
图4是本发明提供的基于状态反馈控制算法得到的驱动侧输入转矩确定模块的组成框图。
具体实施方式
下面结合附图和实施例对本发明所述方法进行详细说明。
为克服现有解决齿轮间隙影响技术的不足,本发明提出了一种光滑的齿轮间隙模型的描述方法:
其中,θ为齿轮前后的相对转动位移,2α为齿轮间隙的间距,γ为齿轮的刚度系数,Tnew为齿轮的传输力矩,κ为新模型的可调参数,也是新模型的特征参数。上述各参数含义也可以参见表1。该模型的函数特性随着κ的增大逐渐逼近传统的齿轮间隙模型,且其是光滑的。
为说明上述光滑模型的特性,定义模型误差E(θ)=Told-Tnew,根据式(1)和式(2),则有:
为进一步分析式(3),定义函数则有
因此,函数Π(θ)是随自变量θ递减的。进而可推导出式(3)满足下述不等式
根据式(5),进一步可得,
由式(6)可以推出也就是说随着κ的增大,本发明提出的齿轮间隙模型可以以任意精度逼近传统的齿轮间隙的死区模型描述,同时又保留模型光滑的特性。
基于建立的光滑模型本发明的消除传动齿轮间隙影响的控制方法包含如下步骤,如图2所示:
步骤101)为齿轮间隙建立光滑模型,所述光滑模型为:
其中,各参数含义参见表1。步骤102)将建立的光滑模型引入智能控制算法,得到齿轮传动***的驱动侧的输入转矩;
步骤103)采用得到的输入转矩控制传动齿轮,使驱动侧的输出力矩平滑传递至负载侧。
实施例1,
以反步控制算法为例,阐述本发明的消除传动齿轮间隙影响的控制方法,并以伺服齿轮传动***的高精度位置控制器设计为例来说明所发明的齿轮间隙模型的有益效果。
伺服齿轮传动***的数学描述为
其中,Jm和Jl为驱动侧和负载侧的转动惯量;θm和θl别为驱动侧和负载侧的输出角位置信号,θ=θm-nθl为相对角位移;bm和bl别为驱动轴和负载轴的粘性摩擦系数,ωm和ωl别为驱动侧和负载侧的角速度信号;2α和γ分别为齿隙的间距和刚度系数;Told为传输转矩,n为减速器的减速比,u为驱动侧的控制输入力矩。上述各参数含义也可以参见表1。
定义x=[x1x2x3x4]T=[θlωlθmωm]T,xθ=x3-nx1,根据模型误差E(θ)=Told-Tnew,则式(4.1)可转化为如下状态空间形式:
其中,
下面说明如何设计驱动侧控制输入力矩u,来消除齿轮间隙的影响使负载侧的角位置输出θl能够以任意精度跟踪期望的角位置信号θr。
步骤1定义输出跟踪误差为:
e1=θr-θl=θr-x1(4.4)
选取Lyapunov函数令虚拟控制量x2的期望值为c1为可调的正常数,定义x2的误差为e2=μ1-x2,根据式(4.2),则V1的微分为
步骤2为求得下一步的虚拟控制量x3,需先求得e2对时间t的导数,根据e2的定义和式(4.2),可求得
选取Lyapunov函数令虚拟控制量(nγ/Jl)x3的期望值为c2为可调的正常数,定义x3的跟踪误差为e3=μ2-(nγ/Jl)x3,根据式(4.5)和式(4.6),则V2的微分为
步骤3为求得下一步的虚拟控制量x4,需先求得φ1(x)对时间t的导数,定义函数λ(xθ)=tanh(κ(xθ-α))-tanh(κ(xθ+α)),根据函数Π(xθ)的定义以及式(4.2)和式(4.4),可求得
进一步可求得e3对时间t的导数为
选取Lyapunov函数令虚拟控制量nγ(2+λ(xθ))x4/2Jl(很容易验证2+λ(xθ)>0)的期望值为 c3为可调的正常数。定义x4的跟踪误差为e4=μ3-nγ(2+λ(xθ))x4/2Jl,根据式(4.7)和式(4.9),则V3的微分为
步骤4为求得真正的***控制量u,需先求得e4对时间t的导数,定义函数 可求得
根据式(4.2)和式(4.8),进一步可求得
其中,b1=c1+c3+c1c2c3,b2=2+c1c2+c1c3+c2c3,b3=c1+c2+c3,b5=c1+c2+c3-bl/Jl,b4=(bl/Jl-c1-c2)(c3-bl/Jl)-c1c2-2。
令驱动侧的控制输入力矩u为
其中c4为可调的正常数。
选取Lyapunov函数根据式(4.10)至式(4.13)可求得V4的微分为
根据式(6),式(4.14)满足
定义函数 则式(4.15)可化为
定义新误差 误差向量e=[e1ζ2ζ3ζ4]T,控制器参数ci>0(i=1…4)的选取满足c1=min(ci),则式(4.16)可转化为
令 当 成立时,有下式成立
因此,误差向量最终会进入并保持在下述误差界中
由于函数ξ1(κ)是随κ增大而衰减到零的函数,当控制器参数ci>0(i=1…4)的选取满足c1=min(ci),通过选择合适的模型参数κ可以使误差界Ω任意小,进而可知跟踪误差e1可以任意小。
通过上述控制器的设计过程可知,基于新建的齿轮间隙模型,将不光滑的齿轮间隙的控制转化为光滑齿轮模型和模型误差的形式,进而采用反步控制策略所设计的输入控制力矩式(4.13)能够保证伺服齿轮传动***的输出角位置信号θl以任意精度跟踪光滑的期望角位置信号θr,消除了齿轮间隙的影响,使得驱动侧的输出力矩平滑地传递到负载侧,消除了轮齿间的碰撞所产生的震荡和噪音,具有很大的工程应用价值。
(一)参数选取原则
本发明的实施方案中涉及的待确定参数有控制器中可调参数c1、c2、c3、c4和齿轮间隙模型参数κ,其参数选取的一般原则如下:
1)控制器参数ci>0(i=1…4)的选取满足c1=min(ci),同时通过多元函数求极值的方法可以使式(4.19)中ξ(c1,c2,c3,c4)/c1项最小来确定ci的取值,这样在同等误差精度的要求下可以降低对模型参数κ的要求;另外一种简单的参数配置方法是将控制器参数都设置为1。
2)齿轮间隙模型参数κ应在控制器参数ci>0确定后,根据伺服齿轮传动***对负载侧输出角度的精度要求,参照误差精度上限计算公式(4.19)来最终确定。
实施例2
为了更好地说明基于所建光滑的齿轮间隙模型的优势,针对伺服齿轮传动***的数学描述(4.1),给出状态反馈控制算法设计过程如下:
采用本发明中光滑的齿轮间隙模的另一种形式来说明本方案的有效性,
下述推到过程中使用的符号具有全文一致性,则式(4.1)可转化为如下状态空间形式:
其中,
下面说明如何通过状态反馈控制算法设计驱动侧控制输入力矩u。
步骤1通过分析,给出了一个微分同胚坐标变换如下:
其中, 可求得
进而可求得,
可知,所给的坐标变换是一个全局微分同胚。
步骤2基于所设计的状态变换,令则式(5.1)可转化为
其中,
(5.4)即为原***(5.1)经坐标变换(5.2)转化后的***数学描述,v为中间控制量。
步骤3令中间控制量v取
v=HZ+vr(5.5)
其中,H=[h1h2h3h4]为控制器参数向量,其值的选择满足(A+bH)为Hurwitz阵, 为参考控制输入。
步骤4定义误差σ1=z1-θr, 误差向量为σ=[σ1σ2σ3σ4]T,根据(5.4)—(5.5),则误差动态方程为
由于(A+bH)是Hurwitz阵,根据线性***稳定性判据可知,误差向量σ是全局渐近稳定的。即z1能够全局渐近稳定跟踪期望的位置信号θr,由于(5.2)是全局微分同胚,则经过坐标逆变换后可知输出信号θl能够渐近稳定跟踪期望的位置信号θr。
通过已设计的中间控制量v的表达式,可以反推出真正的控制量u
其中,
通过上述控制器的设计过程可知,基于光滑的齿轮间隙模型,采用状态反馈线性化控制策略所设计的输入控制力矩式(5.7)能够保证伺服齿轮传动***的输出角位置信号θl以任意精度跟踪光滑的期望角位置信号θr,消除了齿轮间隙的影响,使得驱动侧的输出力矩平滑地传递到负载侧,消除了轮齿间的碰撞所产生的震荡和噪音,具有很大的工程应用价值。
上述状态反馈控制算法的信号流程图如图4所示。
(二)参数选取原则
本发明的实施方案2中涉及的待确定参数有控制器中可调参数H=[h1h2h3h4]和齿轮间隙模型参数κ,其参数选取的一般原则如下:
1)H=[h1h2h3h4]的选择要满足(A+bH)为Hurwitz阵,可以采用极点配置法来实施;
2)齿轮间隙模型参数κ的选择,首先配置为0.1。如果***位置跟踪误差精度满足要求,则配置完成;如果***位置跟踪误差精度不满足要求,则增大κ的值,直到***位置跟踪误差精度满足要求,则结束配置。
表1参数说明
最后所应说明的是,以上实施例仅用以说明本发明的技术方案而非限制。尽管参照实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,对本发明的技术方案进行修改或者等同替换,都不脱离本发明技术方案的精神和范围,其均应涵盖在本发明的权利要求范围当中。
Claims (9)
1.一种消除传动齿轮间隙影响的控制方法,其特征在于,所述方法包含:
步骤101)采用如下公式为齿轮间隙建立光滑模型:
其中,θ为齿轮前后的相对转动位置角信号,2α为齿轮间隙的间距,γ为齿轮的刚度系数,Tnew为光滑模型的输出,κ为可调参数;
步骤102)基于建立的光滑模型得到对象状态空间描述,再依据对象状态空间描述得到齿轮传动***的驱动侧的输入转矩;
步骤103)采用得到的输入转矩控制传动齿轮的驱动侧,使驱动侧的输出力矩平滑传递至负载侧,同时保证驱动侧的位置输出以所需的精度跟踪期望的位置信号。
2.根据权利要求1所述的消除传动齿轮间隙影响的控制方法,其特征在于,采用智能控制算法得到对象状态空间描述,所述智能控制算法包含反步控制算法或状态反馈线性化控制算法。
3.根据权利要求2所述的消除传动齿轮间隙影响的控制方法,其特征在于,当采用反步控制算法时,所述步骤102)进一步包含:
首先,定义状态变量x=[x1x2x3x4]T=[θlωlθmωm]T,通过引入光滑的齿轮间隙模型将受控对象转化为如下状态空间形式:
基于上述对象数学描述,进行反步控制算法确定驱动侧的输入转矩,具体步骤如下:
步骤1,定义输出跟踪误差为:e1=θr-θl=θr-x1;
依据定义的跟踪误差选取Lyapunov函数,该函数形式为:进而解算出虚拟控制量x2的期望值为c1为可调的正常数;
步骤2,定义x2的误差为e2=μ1-x2,依据定义的误差选取Lyapunov函数进而解算出虚拟控制量(nγ/Jl)x3的期望值为 其中c2为可调的正常数;
步骤3,定义x3的跟踪误差为e3=μ2-(nγ/Jl)x3,依据定义的误差选取Lyapunov函数进而解算出虚拟控制量nγ(2+λ(xθ))x4/2Jl的期望值为 c3为可调的正常数;
步骤4,定义x4的跟踪误差为e4=μ3-nγ(2+λ(xθ))x4/2Jl,依据定义的跟踪误差选取Lyapunov函数依据上述定义的x1、x2、x3和x4的值并基于Lyapunov稳定性原理解算得到驱动侧的输入转矩u为:
其中,c4为可调的正常数;Jm表示驱动侧转动惯量,Jl表示负载侧转动惯量,n表示减速器的减速比,γ表示齿轮刚度系数,xθ表示齿轮前后相对转动角位移θ的状态变量;λ(xθ)、τ(xθ)表示自定义函数;b1、b2、b3、b4、b5表示自定义参数;表示期望角位置信号θr的一阶微分信号;表示θr的二阶微分信号;表示θr的三阶微分信号;表示θr的四阶微分信号;φ1(x)表示自定义函数;φ2(x)表示自定义函数;x1、x2、x3、x4分别表示θl、ωl、θm、ωm的状态变量。
4.根据权利要求3所述的消除传动齿轮间隙影响的控制方法,其特征在于,
控制参数控制参数的取值策略包含:
策略一,将控制参数都设置为1;或
策略二,控制参数ci>0且满足c1=min(ci),并通过多元函数求极值的方法使下式中“ξ(c1,c2,c3,c4)/c1”项最小进而确定ci的取值,其中,i=1…4;
所述模型参数κ应在控制参数ci>0的取值确定后,根据伺服齿轮传动***对负载侧输出角度的精度要求,依据误差精度上限确定。
5.根据权利要求2所述的消除传动齿轮间隙影响的控制方法,其特征在于,当采用状态反馈线性化控制算法时,所述步骤102)进一步包含:
首先,定义状态变量x,通过引入光滑的齿轮间隙模型将受控对象转化为如下状态空间形式:
其中,
基于上述对象数学描述,进行状态反馈线性化控制算法确定驱动侧的输入转矩,具体步骤如下:
步骤1)通过分析,给出一个微分同胚坐标变换如下:
其中, 可求得
进而可求得,
可知,所给的坐标变换是一个全局微分同胚;
步骤2)基于所设计的状态变换,令则式(5.1)可转化为
其中,
(5.4)即为原***(5.1)经坐标变换(5.2)转化后的***数学描述,v为中间控制量;
步骤3)令中间控制量v取:
v=HZ+vr(5.5)
其中,H=[h1h2h3h4]为控制参数向量,其值的选择满足(A+bH)为Hurwitz阵, 为参考控制输入;
步骤4)定义误差σ1=z1-θr, 误差向量为σ=[σ1σ2σ3σ4]T,根据(5.4)—(5.5),则误差动态方程为
由于(A+bH)是Hurwitz阵,根据线性***稳定性判据可知,误差向量σ是全局渐近稳定的,即z1能够全局渐近稳定跟踪期望的位置信号θr,由于(5.2)是全局微分同胚,则经过坐标逆变换后可知输出信号θl能够渐近稳定跟踪期望的位置信号θr;
通过设计的中间控制量v的表达式,反推驱动侧的输入转矩u:
其中,
6.一种消除齿轮间隙影响的控制***,所述***包含:
光滑模型建立模块,用于采用如下公式为齿轮间隙建立光滑模型:
其中,θ为齿轮前后的相对转动位置角信号,2α为齿轮间隙的间距,γ为齿轮的刚度系数,Tnew为光滑模型的输出,κ为可调参数;
驱动侧输入转矩确定模块,用于将建立的光滑模型引入智能控制算法,得到齿轮传动***的驱动侧的输入转矩;和
控制模块,用于采用得到的输入转矩控制传动齿轮,使驱动侧的输出力矩平滑传递至负载侧。
7.根据权利要求6所述的消除齿轮间隙影响的控制***,其特征在于,所述智能控制算法包含反步控制算法或状态反馈线性化控制算法。
8.根据权利要求6所述的消除齿轮间隙影响的控制***,其特征在于,所述驱动侧输入转矩确定模块进一步包含:
比较模块,用于将期望输出的位置与实际输出位置进行比较判决,输出角位置偏差信号;
对象状态空间描述信息获取模块,用于对建立的齿轮间隙的光滑模型和比较模块输入的角位置偏差、模型偏差及光滑间隙模型信息进行处理,最后输出带有光滑齿轮间隙和模型误差的对象状态空间描述;
第一处理模块,用于基于所述对象状态空间描述信息获取模块输出的带有光滑齿轮间隙和模型误差的对象状态空间描述信息,进行基于Lyapunov稳定性原理的反步控制处理,最终输出第二虚拟控制量x2信息;
第二处理模块,用于基于第一处理模块输出的第二虚拟控制量x2信息,进行基于Lyapunov稳定性原理的反步控制处理,并输出第三虚拟控制量x3信息;
第三处理模块,用于基于第二处理模块输出的第三虚拟控制量x3信息,进行基于Lyapunov稳定性原理的反步控制处理处理,并输出第四虚拟控制量x4信息;和
第四处理模块,用于基于第三处理模块输入的第四虚拟控制量x4信息,采用如下公式得到驱动侧的输入转矩u:
9.根据权利要求8所述的消除齿轮间隙影响的控制***,其特征在于,所述驱动侧输入转矩确定模块还包含参数确定模块,所述参数确定模块依据如下策略确定控制参数和模型参数的取值:
策略一,将控制参数都设置为1;或
策略二,控制参数ci>0且满足c1=min(ci),并通过多元函数求极值的方法使下式中“ξ(c1,c2,c3,c4)/c1”项最小进而确定ci的取值,其中,i=1…4;
所述模型参数κ应在控制参数ci>0的取值确定后,根据伺服齿轮传动***对负载侧输出角度的精度要求,依据误差精度上限确定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310446168.0A CN103470744B (zh) | 2013-09-26 | 2013-09-26 | 一种消除传动齿轮间隙影响的控制方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310446168.0A CN103470744B (zh) | 2013-09-26 | 2013-09-26 | 一种消除传动齿轮间隙影响的控制方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103470744A CN103470744A (zh) | 2013-12-25 |
CN103470744B true CN103470744B (zh) | 2016-07-20 |
Family
ID=49795727
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310446168.0A Active CN103470744B (zh) | 2013-09-26 | 2013-09-26 | 一种消除传动齿轮间隙影响的控制方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103470744B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103486239A (zh) * | 2013-09-26 | 2014-01-01 | 中国航天科工信息技术研究院 | 一种消除传动齿轮间隙影响的控制方法及*** |
CN108361365B (zh) * | 2017-11-28 | 2020-02-04 | 中车戚墅堰机车车辆工艺研究所有限公司 | 一种含加工误差的摆线针轮传动啮合状态补偿方法 |
CN108303871B (zh) * | 2018-01-02 | 2021-02-09 | 海南大学 | 一种掘进机刀盘驱动***转速的分数阶控制方法 |
CN113010975B (zh) * | 2021-01-21 | 2022-09-13 | 北京航空航天大学 | 一种综合考虑加工成本与运动平稳性的齿轮间隙优化设计方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010215213A (ja) * | 2009-03-16 | 2010-09-30 | Hyundai Motor Co Ltd | ハイブリッド車両用駆動系でのギアバックラッシュ振動を低減させるための方法 |
CN103092075A (zh) * | 2012-12-31 | 2013-05-08 | 上海师范大学 | 一种含有间隙特性的机械传动***模型参数确定方法 |
CN103161921A (zh) * | 2013-03-20 | 2013-06-19 | 王少夫 | 一种单级直齿轮传动***混沌现象抑制方法 |
CN103207939A (zh) * | 2013-04-19 | 2013-07-17 | 北京工业大学 | 一种基于变传动比摆线齿锥齿轮动力学建模方法 |
CN103267087A (zh) * | 2013-05-30 | 2013-08-28 | 王少夫 | 一种单级齿轮传动***谐波抑制简易方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103486239A (zh) * | 2013-09-26 | 2014-01-01 | 中国航天科工信息技术研究院 | 一种消除传动齿轮间隙影响的控制方法及*** |
-
2013
- 2013-09-26 CN CN201310446168.0A patent/CN103470744B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010215213A (ja) * | 2009-03-16 | 2010-09-30 | Hyundai Motor Co Ltd | ハイブリッド車両用駆動系でのギアバックラッシュ振動を低減させるための方法 |
CN103092075A (zh) * | 2012-12-31 | 2013-05-08 | 上海师范大学 | 一种含有间隙特性的机械传动***模型参数确定方法 |
CN103161921A (zh) * | 2013-03-20 | 2013-06-19 | 王少夫 | 一种单级直齿轮传动***混沌现象抑制方法 |
CN103207939A (zh) * | 2013-04-19 | 2013-07-17 | 北京工业大学 | 一种基于变传动比摆线齿锥齿轮动力学建模方法 |
CN103267087A (zh) * | 2013-05-30 | 2013-08-28 | 王少夫 | 一种单级齿轮传动***谐波抑制简易方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103470744A (zh) | 2013-12-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104260107B (zh) | 一种实现空间机械臂柔性关节齿隙补偿的方法 | |
CN104238361B (zh) | 电机伺服***自适应鲁棒位置控制方法与*** | |
Yao et al. | Adaptive robust control of DC motors with extended state observer | |
CN104317299B (zh) | 一种基于轮式移动机器人轨迹跟踪的混合控制方法 | |
CN103470744B (zh) | 一种消除传动齿轮间隙影响的控制方法及*** | |
CN102385342B (zh) | 虚拟轴机床并联机构运动控制的自适应动态滑模控制方法 | |
CN110673472B (zh) | 基于神经网络补偿死区反演误差的自适应鲁棒控制方法 | |
CN106067747A (zh) | 一种用于伺服***控制的滑模扰动观测器的设计方法 | |
CN104723340A (zh) | 基于连接和阻尼配置的柔性关节机械臂的阻抗控制方法 | |
CN104614984B (zh) | 一种电机位置伺服***的高精度控制方法 | |
Bazaz et al. | Minimum time on-line joint trajectory generator based on low order spline method for industrial manipulators | |
CN104252134A (zh) | 基于扩张状态观测器的电机伺服***自适应鲁棒位置控制方法 | |
CN105159077B (zh) | 直驱电机***干扰补偿的有限时间连续滑模控制方法 | |
CN104267595A (zh) | 具有时变输出约束的电机伺服***自适应鲁棒位置控制方法 | |
CN107390525B (zh) | 一种应用于混联机构的控制***参数整定方法 | |
KR20140053239A (ko) | 제어 방법 및 제어 장치 | |
CN103433924A (zh) | 串联机器人高精度位置控制方法 | |
CN105772917A (zh) | 一种三关节点焊机器人轨迹跟踪控制方法 | |
Deng et al. | Adaptive inverse control for gripper rotating system in heavy-duty manipulators with unknown dead zones | |
CN104270053A (zh) | 基于状态估计的电机位置伺服***的输出反馈控制方法 | |
Li et al. | A modified predictive functional control with sliding mode observer for automated dry clutch control of vehicle | |
CN105790668A (zh) | 一种能克服传动间隙非线性的双环自抗扰控制器 | |
Poonawala et al. | Time-optimal velocity tracking control for differential drive robots | |
CN109227545A (zh) | 一种基于可达集估计的柔性机械臂目标追踪控制方法 | |
CN111736472B (zh) | 一种基于rise的电机自适应预设性能渐近控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |