发明名称 基于动态摩擦补偿的永磁球形电机转子自适应控制系统
摘要 本发明公开了一种基于动态摩擦补偿的永磁球形电机转子自适应控制系统,其特征是:以永磁球形电机转子为被控对象,设置控制系统包括参数自适应调整模块、动态摩擦状态观测模块、动态摩擦前馈补偿模块和计算力矩模块。参数自适应调整模块采用自适应算法实时计算获得计算力矩模块和动态摩擦前馈补偿模块的调整参数;动态摩擦状态观测模块由两个动态项不同的状态观测器构成,实时计算动态摩擦模型中的状态量估计值;动态摩擦前馈补偿模块实时计算获得摩擦补偿力矩τ<sub>fc</sub>;计算力矩模块计算获得主控制力矩τ<sub>c</sub>;设置被控对象的总控制力矩τ为:τ=τ<sub>fc</sub>+τ<sub>c</sub>。本发明实现了永磁球形电机转子的动态摩擦补偿,从而提高控制精度,减少起动力矩。
申请公布号 CN103780188B 申请公布日期 2016.02.24
申请号 CN201410035175.6 申请日期 2014.01.23
申请人 安徽大学 发明人 过希文;王群京;文彦;钱喆;周睿;赵双双;赵元;尹雅芹
分类号 H02P21/13(2006.01)I 主分类号 H02P21/13(2006.01)I
代理机构 安徽省合肥新安专利代理有限责任公司 34101 代理人 何梅生
主权项 一种基于动态摩擦补偿的永磁球形电机转子自适应控制系统,其特征是:以永磁球形电机转子为被控对象,检测获得电机转子的实际位置测量值q,令q<sub>d</sub>为电机转子的期望位置,位置跟踪误差e为:e=q‑q<sub>d</sub>;设置所述控制系统包括参数自适应调整模块、动态摩擦状态观测模块、动态摩擦前馈补偿模块和计算力矩模块;所述参数自适应调整模块是以位置跟踪误差e、电机转子的实际转速测量值<img file="FDA0000805409880000011.GIF" wi="38" he="61" />以及动态摩擦前馈补偿模块输出的摩擦补偿力矩τ<sub>fc</sub>为输入变量,结合永磁球形电机转子数学模型和LuGre动态摩擦模型的结构信息分别构造线性回归矩阵<img file="FDA0000805409880000012.GIF" wi="270" he="63" />Y<sub>qr</sub>、<img file="FDA0000805409880000013.GIF" wi="59" he="71" />和<img file="FDA0000805409880000014.GIF" wi="77" he="71" />根据所述线性回归矩阵<img file="FDA0000805409880000015.GIF" wi="271" he="63" />Y<sub>qr</sub>、<img file="FDA0000805409880000016.GIF" wi="57" he="69" />和<img file="FDA0000805409880000017.GIF" wi="52" he="68" />以及位置跟踪误差e计算自适应律,利用所述自适应律在线计算获得计算力矩模块和动态摩擦前馈补偿模块的调整参数<img file="FDA0000805409880000018.GIF" wi="238" he="79" />和<img file="FDA0000805409880000019.GIF" wi="71" he="78" />并将所述调整参数<img file="FDA00008054098800000110.GIF" wi="235" he="79" />和<img file="FDA00008054098800000111.GIF" wi="46" he="71" />分别输出给计算力矩模块和动态摩擦前馈补偿模块;所述计算力矩模块根据位置跟踪误差e和参数自适应调整模块输出的调整参数<img file="FDA00008054098800000112.GIF" wi="62" he="71" />实时计算获得主控制力矩τ<sub>c</sub>;所述动态摩擦状态观测模块根据位置跟踪误差e和电机转子的实际转速测量值<img file="FDA00008054098800000113.GIF" wi="59" he="60" />实时计算电机转子动态摩擦模型中的状态量估计值<img file="FDA00008054098800000114.GIF" wi="48" he="63" />和<img file="FDA00008054098800000115.GIF" wi="63" he="62" />并将所述状态量估计值<img file="FDA00008054098800000116.GIF" wi="47" he="63" />和<img file="FDA00008054098800000117.GIF" wi="42" he="63" />输出至动态摩擦前馈补偿模块;所述动态摩擦前馈补偿模块根据参数自适应调整模块输出的调整参数<img file="FDA00008054098800000118.GIF" wi="146" he="77" />和<img file="FDA00008054098800000119.GIF" wi="53" he="70" />以及动态摩擦状态观测模块输出的状态量估计值<img file="FDA00008054098800000120.GIF" wi="48" he="58" />和<img file="FDA00008054098800000121.GIF" wi="70" he="60" />实时计算获得摩擦补偿力矩τ<sub>fc</sub>;设置所述永磁球形电机转子的总控制力矩τ为:τ=τ<sub>fc</sub>+τ<sub>c</sub>;所述动态摩擦状态观测模块由两个动态项不同的状态观测器构成;所述两个动态项不同的状态观测器按如下方法构造:a、采用LuGre动态摩擦模型描述永磁球形电机定子与转子接触面间的摩擦力矩τ<sub>f</sub>,如式(1):<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><mfrac><mrow><mi>d</mi><mi>z</mi></mrow><mrow><mi>d</mi><mi>t</mi></mrow></mfrac><mo>=</mo><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mo>-</mo><mi>&Psi;</mi><mi>z</mi></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>&tau;</mi><mi>f</mi></msub><mo>=</mo><msub><mi>Q</mi><mn>0</mn></msub><mi>z</mi><mo>+</mo><msub><mi>Q</mi><mn>1</mn></msub><mfrac><mrow><mi>d</mi><mi>z</mi></mrow><mrow><mi>d</mi><mi>t</mi></mrow></mfrac><mo>+</mo><msub><mi>Q</mi><mn>2</mn></msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00008054098800000122.GIF" wi="957" he="236" /></maths>式(1)中,z为状态量,表示永磁球形电机定子与转子接触面之间弹性鬓毛的平均形变,Q<sub>0</sub>、Q<sub>1</sub>和Q<sub>2</sub>为动态摩擦参数矩阵,分别为弹性鬓毛偏移强度、滑动阻尼系数和粘滞摩擦系数,非线性函数矩阵Ψ为Stribeck效应方程矩阵;结合拉格朗日第二方程以及坐标变换,则基于LuGre动态摩擦模型的永磁球形电机转子数学模型如式(2)所示:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mi>M</mi><mrow><mo>(</mo><mi>q</mi><mo>)</mo></mrow><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mo>+</mo><mi>C</mi><mrow><mo>(</mo><mi>q</mi><mo>,</mo><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mo>)</mo></mrow><mo>+</mo><msub><mi>Q</mi><mn>3</mn></msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mo>+</mo><msub><mi>Q</mi><mn>0</mn></msub><mi>z</mi><mo>-</mo><msub><mi>Q</mi><mn>1</mn></msub><mi>&Psi;</mi><mi>z</mi><mo>=</mo><msub><mi>&tau;</mi><mi>i</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000805409880000021.GIF" wi="1171" he="69" /></maths>式(2)中,<img file="FDA0000805409880000022.GIF" wi="38" he="61" />为电机转子的实际加速度测量值,M(q)为电机转子数学模型的惯性矩阵,<img file="FDA0000805409880000023.GIF" wi="136" he="63" />为哥式力和向心力矩阵,τ<sub>i</sub>为电机转子数学模型中的输入力矩,整合后的动态摩擦参数矩阵Q<sub>3</sub>为:Q<sub>3</sub>=Q<sub>1</sub>+Q<sub>2</sub>;b、引入参考变量<img file="FDA00008054098800000226.GIF" wi="76" he="56" /><img file="FDA00008054098800000227.GIF" wi="310" he="71" /><img file="FDA00008054098800000228.GIF" wi="64" he="71" />为电机转子的期望速度,Λ为正定的反馈增益对角矩阵,设置参考误差e<sub>r</sub>为:<img file="FDA0000805409880000025.GIF" wi="247" he="66" />c、构造两个动态项不同的状态观测器:采用参考误差e<sub>r</sub>作为其中一个状态观测器的动态项,以Ψe<sub>r</sub>作为另一个状态观测器的动态项;分别以所述状态量估计值<img file="FDA0000805409880000026.GIF" wi="50" he="71" />和<img file="FDA0000805409880000027.GIF" wi="41" he="70" />作为两个状态观测器的观测值,根据LuGre动态摩擦模型的结构信息和动态项e<sub>r</sub>、Ψe<sub>r</sub>分别设计状态观测器的更新律如式(3)和式(4)所示:<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mfrac><mrow><mi>d</mi><msub><mover><mi>z</mi><mo>^</mo></mover><mn>0</mn></msub></mrow><mrow><mi>d</mi><mi>t</mi></mrow></mfrac><mo>=</mo><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mo>-</mo><mi>&Psi;</mi><msub><mover><mi>z</mi><mo>^</mo></mover><mn>0</mn></msub><mo>-</mo><msub><mi>e</mi><mi>r</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000805409880000028.GIF" wi="686" he="119" /></maths><maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mfrac><mrow><mi>d</mi><msub><mover><mi>z</mi><mo>^</mo></mover><mn>1</mn></msub></mrow><mrow><mi>d</mi><mi>t</mi></mrow></mfrac><mo>=</mo><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mo>-</mo><mi>&Psi;</mi><msub><mover><mi>z</mi><mo>^</mo></mover><mn>1</mn></msub><mo>+</mo><msub><mi>&Psi;e</mi><mi>r</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000805409880000029.GIF" wi="686" he="117" /></maths>利用所述状态观测器的更新律分别构造两个动态项不同的状态观测器;所述参数自适应调整模块是采用自适应算法,并利用不同的自适应律实时计算获得调整参数<img file="FDA00008054098800000210.GIF" wi="244" he="78" />和<img file="FDA00008054098800000211.GIF" wi="77" he="71" />所述调整参数<img file="FDA00008054098800000212.GIF" wi="235" he="79" />和<img file="FDA00008054098800000213.GIF" wi="53" he="79" />的自适应律按如下方法确定:a、定义线性回归矩阵<img file="FDA00008054098800000214.GIF" wi="270" he="60" />是将电机转子数学模型线性化,得到式(5):<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><mi>M</mi><mrow><mo>(</mo><mi>q</mi><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>r</mi></msub><mo>+</mo><mi>C</mi><mrow><mo>(</mo><mi>q</mi><mo>,</mo><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>r</mi></msub><mo>=</mo><mi>Y</mi><mrow><mo>(</mo><mi>q</mi><mo>,</mo><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>r</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>r</mi></msub><mo>)</mo></mrow><mi>&zeta;</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00008054098800000215.GIF" wi="1149" he="71" /></maths>式(5)中,ξ为电机转子数学模型的动力学参数;将电机转子的转动惯量I<sub>d</sub>、I<sub>q</sub>和I<sub>p</sub>等效为ξ=[I<sub>dq</sub> I<sub>p</sub>]<sup>T</sup>,其中,I<sub>d</sub>、I<sub>q</sub>和I<sub>p</sub>分别为电机转子在动坐标系dqp下相对惯性主轴d轴、q轴和p轴的转动惯量,I<sub>d</sub>=I<sub>q</sub>=I<sub>dq</sub>,在式(5)中,用估计矩阵<img file="FDA00008054098800000216.GIF" wi="116" he="69" />和<img file="FDA00008054098800000217.GIF" wi="132" he="71" />分别代替M(q)和<img file="FDA00008054098800000218.GIF" wi="159" he="59" />得到式(6):<maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><mover><mi>M</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>q</mi><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>r</mi></msub><mo>+</mo><mover><mi>C</mi><mo>^</mo></mover><mrow><mo>(</mo><mi>q</mi><mo>,</mo><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>r</mi></msub><mo>=</mo><mi>Y</mi><mrow><mo>(</mo><mi>q</mi><mo>,</mo><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>r</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>r</mi></msub><mo>)</mo></mrow><mover><mi>&xi;</mi><mo>^</mo></mover><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00008054098800000219.GIF" wi="1160" he="79" /></maths>式(6)中,<img file="FDA00008054098800000220.GIF" wi="38" he="76" />为电机转子数学模型的调整参数;b、定义线性回归矩阵Y<sub>qr</sub>、<img file="FDA00008054098800000221.GIF" wi="61" he="76" />和<img file="FDA00008054098800000222.GIF" wi="75" he="78" />是将LuGre动态摩擦模型线性化,并用动态摩擦状态观测模块输出的状态量估计值<img file="FDA00008054098800000223.GIF" wi="50" he="62" />和<img file="FDA00008054098800000224.GIF" wi="43" he="62" />代替LuGre动态摩擦模型中两种不同位置上的状态量z,得到式(7):<maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><msub><mi>&tau;</mi><mrow><mi>f</mi><mi>c</mi></mrow></msub><mo>=</mo><msub><mi>Y</mi><mrow><mi>q</mi><mi>r</mi></mrow></msub><msub><mover><mi>&theta;</mi><mo>^</mo></mover><mn>3</mn></msub><mo>+</mo><msub><mover><mi>Z</mi><mo>^</mo></mover><mn>0</mn></msub><msub><mover><mi>&theta;</mi><mo>^</mo></mover><mn>0</mn></msub><mo>-</mo><mi>&Psi;</mi><msub><mover><mi>Z</mi><mo>^</mo></mover><mn>1</mn></msub><msub><mover><mi>&theta;</mi><mo>^</mo></mover><mn>1</mn></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>7</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00008054098800000225.GIF" wi="805" he="79" /></maths>式(7)中,Y<sub>qr</sub>、<img file="FDA0000805409880000031.GIF" wi="60" he="77" />和<img file="FDA0000805409880000032.GIF" wi="50" he="78" />分别为LuGre动态摩擦模型的线性回归矩阵,<img file="FDA0000805409880000033.GIF" wi="148" he="71" />和<img file="FDA0000805409880000034.GIF" wi="50" he="70" />分别为LuGre动态摩擦模型的调整参数;c、根据Lyapunov稳定性原理,确定调整参数<img file="FDA0000805409880000035.GIF" wi="235" he="72" />和<img file="FDA0000805409880000036.GIF" wi="53" he="71" />的自适应律分别如式(8)、式(9)、式(10)和式(11)所示:<maths num="0008" id="cmaths0008"><math><![CDATA[<mrow><mover><mover><mi>&xi;</mi><mo>^</mo></mover><mo>&CenterDot;</mo></mover><mo>=</mo><mo>-</mo><msup><mi>&Gamma;</mi><mi>T</mi></msup><mi>Y</mi><msup><mrow><mo>(</mo><mi>q</mi><mo>,</mo><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>r</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>r</mi></msub><mo>)</mo></mrow><mi>T</mi></msup><msub><mi>e</mi><mi>r</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>8</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000805409880000037.GIF" wi="781" he="87" /></maths><maths num="0009" id="cmaths0009"><math><![CDATA[<mrow><msub><mover><mover><mi>&theta;</mi><mo>^</mo></mover><mo>&CenterDot;</mo></mover><mn>0</mn></msub><mo>=</mo><mo>-</mo><msubsup><mi>&Gamma;</mi><mn>0</mn><mi>T</mi></msubsup><msubsup><mover><mi>Z</mi><mo>^</mo></mover><mn>0</mn><mi>T</mi></msubsup><msub><mi>e</mi><mi>r</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>9</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000805409880000038.GIF" wi="774" he="86" /></maths><maths num="0010" id="cmaths0010"><math><![CDATA[<mrow><msub><mover><mover><mi>&theta;</mi><mo>^</mo></mover><mo>&CenterDot;</mo></mover><mn>1</mn></msub><mo>=</mo><msubsup><mi>&Gamma;</mi><mn>1</mn><mi>T</mi></msubsup><msubsup><mover><mi>Z</mi><mo>^</mo></mover><mn>1</mn><mi>T</mi></msubsup><msub><mi>&Psi;e</mi><mi>r</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>10</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000805409880000039.GIF" wi="798" he="85" /></maths><maths num="0011" id="cmaths0011"><math><![CDATA[<mrow><msub><mover><mover><mi>&theta;</mi><mo>^</mo></mover><mo>&CenterDot;</mo></mover><mn>3</mn></msub><mo>=</mo><mo>-</mo><msubsup><mi>&Gamma;</mi><mn>3</mn><mi>T</mi></msubsup><msubsup><mi>Y</mi><mrow><mi>q</mi><mi>r</mi></mrow><mi>T</mi></msubsup><msub><mi>e</mi><mi>r</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>11</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA00008054098800000310.GIF" wi="794" he="93" /></maths>Γ、Γ<sub>0</sub>、Γ<sub>1</sub>和Γ<sub>3</sub>均为正定的增益对角矩阵。
地址 230039 安徽省合肥市蜀山区肥西路3号