一种伺服系统摩擦的处理方法与流程

文档序号:11928904阅读:来源:国知局

技术特征:

1.一种基于库伦模型和补偿法的伺服系统摩擦处理方法,其特征在于,包括以下步骤:

步骤一:通过速度指令规划单元为伺服系统规划出带有时间间隔的两段速度指令;

步骤二:摩擦模型测试单元在步骤一所述的两端速度指令时间内,分别在电机转速为正的半个周期内和负的半个周期内在线测试给定转矩,测试出初始摩擦模型F′c

步骤三:库伦模型辨识单元根据步骤二测试得到的初始摩擦模型,经过数学处理,辨识得到库伦模型Fc

步骤四:库伦模型前馈单元根据步骤三得到的库伦模型,利用电机的转矩系数,得到模型前馈电流Ic,电机转速与给定转速的差值传输到速度控制器中,输出调节电流Iω

步骤五:电流指令生成单元和第一补偿方程单元、补偿单元、第二补偿方程单元形成的反馈环中,电流指令单元接收第二补偿方程的补偿电流Ib,并接收步骤四得到的模型前馈电流Ic和输出调节电流Iω,生成下一时刻电流指令传输至电机中,所述电流指令经过第一补偿方程输入至补偿单元,同时电机转速也传输至补偿单元,补偿单元的输出信号经过第二补偿方程生成新的补偿电流Ib+1

2.根据权利要求1所述的基于库伦模型和补偿法的伺服系统摩擦处理方法,其特征在于,步骤一的带有时间间隔的两段速度指令的数学形式为频率不等的正弦波,幅值和频率的比值相等,两段转速指令分别为(a11)和(a22),式中a1和a2分别表示两段转速指令的幅值,ω1和ω2分别表示两段转速指令的频率。

3.根据权利要求1或2所述的基于库伦模型和补偿法的伺服系统摩擦处理方法,其特征在于,步骤二的测试方法具体为:

在速度指令为正的和负的时,分别通过电机驱动器的数据记录功能测试此时的电机给定转矩,并将测试得到的速度、给定转矩数据予以保存,令F′c为这一步骤得到的初始摩擦模型。

4.根据权利要求3所述的基于库伦模型和补偿法的伺服系统摩擦处理方法,其特征在于,步骤三具体为:

令给定转速信号为(a11)时电机工作在正向时的半个周期起始和结束时间为(t11,t12),同理信号(a22)对应时间区间为(t21,t22),

当电机转速为正时,在此区间内对步骤三测试得到的初始摩擦模型积分为:

<mrow> <msub> <mi>S</mi> <mn>1</mn> </msub> <mo>=</mo> <msubsup> <mo>&Integral;</mo> <msub> <mi>t</mi> <mn>11</mn> </msub> <msub> <mi>t</mi> <mn>12</mn> </msub> </msubsup> <msubsup> <mi>F</mi> <mi>c</mi> <mo>&prime;</mo> </msubsup> <mo>=</mo> <msub> <mi>F</mi> <mi>c</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>t</mi> <mn>12</mn> </msub> <mo>-</mo> <msub> <mi>t</mi> <mn>11</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>BA</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>T</mi> <mi>L</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>t</mi> <mn>12</mn> </msub> <mo>-</mo> <msub> <mi>t</mi> <mn>11</mn> </msub> <mo>)</mo> </mrow> </mrow>

<mrow> <msub> <mi>S</mi> <mn>2</mn> </msub> <mo>=</mo> <msubsup> <mo>&Integral;</mo> <msub> <mi>t</mi> <mn>21</mn> </msub> <msub> <mi>t</mi> <mn>22</mn> </msub> </msubsup> <msubsup> <mi>F</mi> <mi>c</mi> <mo>&prime;</mo> </msubsup> <mo>=</mo> <msub> <mi>F</mi> <mi>c</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>t</mi> <mn>22</mn> </msub> <mo>-</mo> <msub> <mi>t</mi> <mn>21</mn> </msub> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>BA</mi> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>T</mi> <mi>L</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>t</mi> <mn>22</mn> </msub> <mo>-</mo> <msub> <mi>t</mi> <mn>21</mn> </msub> <mo>)</mo> </mrow> </mrow>

式中,A1和A2分别为第一段速度指令在时间区间(t11,t12)的累积位移和第二段速度指令在时间区间(t21,t22)的累积位移,满足A1=A2,B为电机的粘滞摩擦系数,TL为负载转矩,S1和S2分别为带有时间间隔的两段速度指令,(a11)和(a22)为正时的初始摩擦积分值,Fc+为得到的速度指令为正时的库伦模型。将两式相减得到:

<mrow> <msub> <mi>F</mi> <mrow> <mi>c</mi> <mo>+</mo> </mrow> </msub> <mo>=</mo> <mfrac> <mrow> <msub> <mi>S</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>S</mi> <mn>1</mn> </msub> </mrow> <mrow> <msub> <mi>t</mi> <mn>22</mn> </msub> <mo>-</mo> <msub> <mi>t</mi> <mn>21</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <msub> <mi>t</mi> <mn>12</mn> </msub> <mo>-</mo> <msub> <mi>t</mi> <mn>11</mn> </msub> <mo>)</mo> </mrow> </mrow> </mfrac> <mo>-</mo> <msub> <mi>T</mi> <mi>L</mi> </msub> </mrow>

如果对电机转速为负时也仿照此操作,假设转速为负时的两组时间区间为(t′11,t′12)和(t′21,t′22)。得到速度指令为负时的库伦模型Fc-

<mrow> <msub> <mi>F</mi> <mrow> <mi>c</mi> <mo>-</mo> </mrow> </msub> <mo>=</mo> <mo>-</mo> <mfrac> <mrow> <msubsup> <mi>S</mi> <mn>2</mn> <mo>&prime;</mo> </msubsup> <mo>-</mo> <msub> <mi>S</mi> <mn>1</mn> </msub> </mrow> <mrow> <msubsup> <mi>t</mi> <mn>22</mn> <mo>&prime;</mo> </msubsup> <mo>-</mo> <msubsup> <mi>t</mi> <mn>21</mn> <mo>&prime;</mo> </msubsup> <mo>-</mo> <mrow> <mo>(</mo> <msubsup> <mi>t</mi> <mn>12</mn> <mo>&prime;</mo> </msubsup> <mo>-</mo> <msubsup> <mi>t</mi> <mn>11</mn> <mo>&prime;</mo> </msubsup> <mo>)</mo> </mrow> </mrow> </mfrac> <mo>+</mo> <msub> <mi>T</mi> <mi>L</mi> </msub> </mrow>

式中,S′1和S′2分别为转速信号(a11)和(a22)且速度为负时的初始摩擦积分值,将Fc+和Fc-取平均,辨识得到库伦模型Fc为:

<mrow> <msub> <mi>F</mi> <mi>c</mi> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <mo>&lsqb;</mo> <mfrac> <mrow> <msub> <mi>S</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>S</mi> <mn>1</mn> </msub> </mrow> <mrow> <msub> <mi>t</mi> <mn>22</mn> </msub> <mo>-</mo> <msub> <mi>t</mi> <mn>21</mn> </msub> <mo>-</mo> <mrow> <mo>(</mo> <msub> <mi>t</mi> <mn>12</mn> </msub> <mo>-</mo> <msub> <mi>t</mi> <mn>11</mn> </msub> <mo>)</mo> </mrow> </mrow> </mfrac> <mo>-</mo> <mfrac> <mrow> <msubsup> <mi>S</mi> <mn>2</mn> <mo>&prime;</mo> </msubsup> <mo>-</mo> <msubsup> <mi>S</mi> <mn>1</mn> <mo>&prime;</mo> </msubsup> </mrow> <mrow> <msubsup> <mi>t</mi> <mn>22</mn> <mo>&prime;</mo> </msubsup> <mo>-</mo> <msubsup> <mi>t</mi> <mn>21</mn> <mo>&prime;</mo> </msubsup> <mo>-</mo> <mrow> <mo>(</mo> <msubsup> <mi>t</mi> <mn>12</mn> <mo>&prime;</mo> </msubsup> <mo>-</mo> <msubsup> <mi>t</mi> <mn>11</mn> <mo>&prime;</mo> </msubsup> <mo>)</mo> </mrow> </mrow> </mfrac> <mo>&rsqb;</mo> <mo>.</mo> </mrow>

5.根据权利要求4所述的基于库伦模型和补偿法的伺服系统摩擦处理方法,其特征在于,步骤四具体为:

令电机转矩系数Kt=npψf,式中np为电机极对数,ψf为电机转子磁链。根据步骤三得到的库伦模型Fc,得到模型前馈电流为:

<mrow> <msub> <mi>I</mi> <mi>c</mi> </msub> <mo>=</mo> <mfrac> <mrow> <msub> <mi>F</mi> <mi>c</mi> </msub> <mi>sgn</mi> <mrow> <mo>(</mo> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mo>)</mo> </mrow> </mrow> <msub> <mi>K</mi> <mi>t</mi> </msub> </mfrac> </mrow>

电机转速与给定转速的差值传输到速度控制器中,输出调节电流Iω

6.根据权利要求5所述的基于库伦模型和补偿法的伺服系统摩擦处理方法,其特征在于,步骤五具体为:

建立电机转速方程为:

<mrow> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mo>=</mo> <mfrac> <mrow> <msub> <mi>n</mi> <mi>p</mi> </msub> <msub> <mi>&psi;</mi> <mi>f</mi> </msub> <msub> <mi>i</mi> <mi>q</mi> </msub> </mrow> <mi>J</mi> </mfrac> <mo>-</mo> <mfrac> <msub> <mi>F</mi> <mi>f</mi> </msub> <mi>J</mi> </mfrac> <mo>-</mo> <mfrac> <msub> <mi>T</mi> <mi>L</mi> </msub> <mi>J</mi> </mfrac> </mrow>

式中,ω为电机转速,为电机转速的导数,iq为电机交轴电流,Ff为实际摩擦力矩,J为电机转动惯量,令过渡项a(t)为:

a(t)=-(Ff-Fc)/J-TL/J+(b-b0)iq

其中b=npψf/J为过渡系数,b0为过渡系数的标称值;将过渡项代入电机转速方程,可得到电机转速方程的简化形式为:

<mrow> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mo>=</mo> <msub> <mi>b</mi> <mn>0</mn> </msub> <msub> <mi>i</mi> <mi>q</mi> </msub> <mo>+</mo> <mi>a</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow>

建立如下形式的补偿方程:

<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <msub> <mover> <mi>z</mi> <mo>&CenterDot;</mo> </mover> <mn>1</mn> </msub> <mo>=</mo> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>-</mo> <msub> <mi>&beta;</mi> <mn>1</mn> </msub> <mo>(</mo> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>-</mo> <mi>&omega;</mi> <mo>)</mo> <mo>+</mo> <msub> <mi>b</mi> <mn>0</mn> </msub> <msub> <mi>i</mi> <mi>q</mi> </msub> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mover> <mi>z</mi> <mo>&CenterDot;</mo> </mover> <mn>2</mn> </msub> <mo>=</mo> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>-</mo> <msub> <mi>&beta;</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>-</mo> <mi>&omega;</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <msub> <mover> <mi>z</mi> <mo>&CenterDot;</mo> </mover> <mn>3</mn> </msub> <mo>=</mo> <mo>-</mo> <msub> <mi>&beta;</mi> <mn>3</mn> </msub> <mo>(</mo> <msub> <mi>z</mi> <mn>1</mn> </msub> <mo>-</mo> <mi>&omega;</mi> <mo>)</mo> </mtd> </mtr> </mtable> </mfenced>

式中,z1、z2、z3分别为中间变量1、中间变量2和中间变量3;分别为z1、z2、z3的导数;β1、β2、β3分别为补偿系数1、补偿系数2和补偿系数3,

将z2和过渡系数做除法,得到补偿电流Ib即为:

<mrow> <msub> <mi>I</mi> <mi>b</mi> </msub> <mo>=</mo> <mo>-</mo> <mfrac> <msub> <mi>z</mi> <mn>2</mn> </msub> <msub> <mi>b</mi> <mn>0</mn> </msub> </mfrac> </mrow>

最终电流指令为:

<mrow> <msubsup> <mi>I</mi> <mi>q</mi> <mo>*</mo> </msubsup> <mo>=</mo> <msub> <mi>I</mi> <mi>&omega;</mi> </msub> <mo>+</mo> <msub> <mi>I</mi> <mi>c</mi> </msub> <mo>+</mo> <msub> <mi>I</mi> <mi>b</mi> </msub> </mrow>

式中,Iω为速度环调节器得到的速度调节电流,Ic为模型前馈电流,Ib为补偿电流。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1