基于分数阶控制器的直线电机点位控制装置及方法与流程

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

技术特征:

1.一种基于分数阶控制器的直线电机点位控制装置,其特征在于:所述装置包括分数阶控制器、驱动模块、直线电机和传感模块;

所述分数阶控制器的输入端为所述装置的输入端,所述分数阶控制器的输出端与所述驱动模块的输入端连接,所述驱动模块的输出端与所述直线电机的输入端连接,所述直线电机的输出端与所述传感模块的输入端连接,所述传感模块的输出端与所述分数阶控制器的输入端连接。

2.根据权利要求1所述的基于分数阶控制器的直线电机点位控制装置,其特征在于:所述分数阶控制器包括跟踪微分器、第一作差模块、分数阶比例微分器、第二作差模块和状态观测器;所述跟踪微分器的输入端为所述分数阶控制器的输入端,所述跟踪微分器的输出端与所述第一作差模块的输入端连接,所述第一作差模块的输出端与所述分数阶比例微分器的输入端连接,所述分数阶比例微分器的输出端与所述第二作差模块的输入端连接,所述第二作差模块的输出端分别与所述驱动模块的输入端和所述状态观测器的输入端连接,所述状态观测器的输入端与所述传感模块的输出端连接,所述状态观测器的输出端分别与所述第一作差模块和所述第二作差模块的输入端连接。

3.根据权利要求1或2所述的基于分数阶控制器的直线电机点位控制装置,其特征在于:所述第一作差模块包括三个输入端,所述第一作差模块的三个输入端分别接收所述直线电机的目标位置信号和所述状态观测器的两个输出信号。

4.基于分数阶控制器的直线电机点位的控制方法,其特征在于:具体包括以下步骤:

A、传感模块采集直线电机的实际运动位置x;

B、分数阶控制器接收直线电机的目标位置xd,利用步骤A中所述直线电机实际运动位置x和所述目标位置xd,分数阶控制器输出控制量u;

C、将步骤B所述控制量u发送到驱动模块,所述驱动模块控制直线电机的运行。

5.根据权利要求4所述的基于分数阶控制器的直线电机点位控制方法,其特征在于:所述分数阶控制器包括跟踪微分器、第一作差模块、分数阶比例微分器、第二作差模块和状态观测器;

步骤B具体包括以下步骤:

a、跟踪微分器接收被跟踪的直线电机的目标位置xd并进行处理,所述跟踪微分器处理公式为式1:

<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>h</mi> <mo>&CenterDot;</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>h</mi> <mo>&CenterDot;</mo> <mi>f</mi> <mi>h</mi> <mi>a</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>-</mo> <msub> <mi>x</mi> <mi>d</mi> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>,</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>,</mo> <mi>r</mi> <mo>,</mo> <msub> <mi>h</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced>

其中,xd为目标位置,k为第k个采样时刻,h为采样周期,x1为目标位置xd的过渡过程,x2为x1的微分,fhan(x1(k)-xd(k),x2(k),r,h0)的表达式为式2:

<mrow> <mi>f</mi> <mi>h</mi> <mi>a</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>-</mo> <msub> <mi>x</mi> <mi>d</mi> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>,</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>,</mo> <mi>r</mi> <mo>,</mo> <msub> <mi>h</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mo>-</mo> <mi>r</mi> <mo>&CenterDot;</mo> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <mi>a</mi> <mo>)</mo> </mrow> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <mrow> <mo>|</mo> <mi>a</mi> <mo>|</mo> </mrow> <mo>&gt;</mo> <mi>d</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mi>r</mi> <mo>&CenterDot;</mo> <mfrac> <mi>a</mi> <mi>d</mi> </mfrac> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <mrow> <mo>|</mo> <mi>a</mi> <mo>|</mo> </mrow> <mo>&le;</mo> <mi>d</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow>

其中,r和h0是参数,d和a的表达式为式3:

<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>d</mi> <mo>=</mo> <mi>r</mi> <mo>&CenterDot;</mo> <msub> <mi>h</mi> <mn>0</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>d</mi> <mn>0</mn> </msub> <mo>=</mo> <msub> <mi>h</mi> <mn>0</mn> </msub> <mo>&CenterDot;</mo> <mi>d</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>=</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mi>x</mi> <mi>d</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>h</mi> <mn>0</mn> </msub> <mo>&CenterDot;</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>a</mi> <mn>0</mn> </msub> <mo>=</mo> <msqrt> <mrow> <msup> <mi>d</mi> <mn>2</mn> </msup> <mo>+</mo> <mn>8</mn> <mi>r</mi> <mo>&CenterDot;</mo> <mrow> <mo>|</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>|</mo> </mrow> </mrow> </msqrt> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>a</mi> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>+</mo> <mfrac> <mrow> <mo>(</mo> <msub> <mi>a</mi> <mn>0</mn> </msub> <mo>-</mo> <mi>d</mi> <mo>)</mo> </mrow> <mn>2</mn> </mfrac> <mo>&CenterDot;</mo> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <mrow> <mo>|</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>|</mo> </mrow> <mo>&gt;</mo> <msub> <mi>d</mi> <mn>0</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>x</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>+</mo> <mfrac> <msub> <mi>y</mi> <mn>0</mn> </msub> <msub> <mi>h</mi> <mn>0</mn> </msub> </mfrac> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <mrow> <mo>|</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> <mo>|</mo> </mrow> <mo>&le;</mo> <msub> <mi>d</mi> <mn>0</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>.</mo> </mrow>

b、状态观测器计算z1、z2和z3,具体计算公式为式4;

<mrow> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>e</mi> <mo>=</mo> <msub> <mi>z</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>-</mo> <mi>x</mi> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>z</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>z</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>h</mi> <mo>&CenterDot;</mo> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>2</mn> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>-</mo> <msub> <mi>&beta;</mi> <mn>01</mn> </msub> <mo>&CenterDot;</mo> <mi>e</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>z</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>z</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>+</mo> <mi>h</mi> <mo>&CenterDot;</mo> <mrow> <mo>(</mo> <msub> <mi>z</mi> <mn>3</mn> </msub> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>-</mo> <msub> <mi>&beta;</mi> <mn>02</mn> </msub> <mo>&CenterDot;</mo> <mi>f</mi> <mi>a</mi> <mi>l</mi> <mo>(</mo> <mrow> <mi>e</mi> <mo>,</mo> <mn>0.5</mn> <mo>,</mo> <mi>&delta;</mi> </mrow> <mo>)</mo> <mo>+</mo> <mi>b</mi> <mo>&CenterDot;</mo> <mi>u</mi> <mo>(</mo> <mi>k</mi> <mo>)</mo> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>z</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>+</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>z</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>-</mo> <mi>h</mi> <mo>&CenterDot;</mo> <msub> <mi>&beta;</mi> <mn>03</mn> </msub> <mo>&CenterDot;</mo> <mi>f</mi> <mi>a</mi> <mi>l</mi> <mrow> <mo>(</mo> <mi>e</mi> <mo>,</mo> <mn>0.25</mn> <mo>,</mo> <mi>&delta;</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>,</mo> </mrow>

其中,k为第k个采样时刻,h为采样周期,u为控制量,x为直线电机实际运动位置,z1、z2和z3分别为直线电机实际运动位置的估计值、直线电机实际运动速度的估计值和系统总和扰动的估计值,e为z1和x之间的误差,b为控制量增益,β01、β02和β03为扩张状态观测器增益,δ为fal(e0,α,δ)中线性段的区间长度;

公式4中非线性函数fal(e0,α,δ)的表达式为式5:

<mrow> <mi>f</mi> <mi>a</mi> <mi>l</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mn>0</mn> </msub> <mo>,</mo> <mi>&alpha;</mi> <mo>,</mo> <mi>&delta;</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>e</mi> <mn>0</mn> </msub> <mo>&CenterDot;</mo> <msup> <mi>&delta;</mi> <mrow> <mi>&alpha;</mi> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <mrow> <mo>|</mo> <msub> <mi>e</mi> <mn>0</mn> </msub> <mo>|</mo> </mrow> <mo>&le;</mo> <mi>&delta;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msup> <mrow> <mo>|</mo> <msub> <mi>e</mi> <mn>0</mn> </msub> <mo>|</mo> </mrow> <mi>&alpha;</mi> </msup> <mo>&CenterDot;</mo> <mi>sgn</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mn>0</mn> </msub> <mo>)</mo> </mrow> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <mrow> <mo>|</mo> <msub> <mi>e</mi> <mn>0</mn> </msub> <mo>|</mo> </mrow> <mo>&gt;</mo> <mi>&delta;</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow>

式中,α为幂指数,sgn(·)为符号函数;

c、分数阶比例微分器进行中间控制量输出,具体计算公式为式6:

u0=Kp·e1+Kdsμ·e2

其中,u0为数阶比例微分器的输出,KP和Kd为控制器参数,s为拉普拉斯算子,μ是取值为0到1之间的实数,e1为x1和z1之间的误差,e2为x2和z2之间的误差;

d、第二作差模块接收状态观测器的输出量z3,计算输出控制量u,具体计算公式为式7:

u=(u0-z3)/b

其中,b为控制量增益。

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