公开/公告号CN107528514A
专利类型发明专利
公开/公告日2017-12-29
原文格式PDF
申请/专利权人 西北机电工程研究所;
申请/专利号CN201710981166.X
申请日2017-10-20
分类号
代理机构西北工业大学专利中心;
代理人顾潮琪
地址 712099 陕西省咸阳市渭城区毕塬东路5号
入库时间 2023-06-19 04:09:28
法律状态公告日
法律状态信息
法律状态
2020-03-03
授权
授权
2018-01-26
实质审查的生效 IPC(主分类):H02P21/00 申请日:20171020
实质审查的生效
2017-12-29
公开
公开
技术领域
本发明属于火炮随动系统领域,主要涉及需要精确跟踪的随动驱动调速系统对参数变化和负载扰动不敏感的鲁棒控制方法。
背景技术
火炮随动系统尤其是高炮随动系统要求随动驱动调速系统具有快速响应指令的能力和对指令精确跟踪的能力。由于PI控制器控制策略结构简单,易于调节,传统的驱动调速系统的电流环和速度环控制器常采用PI控制器。电流环常采用时域的最佳模原则、频域的幅值裕度和相位裕度要求进行设计PI控制参数,速度环也常采用频域的理想中频宽原则设计合适的PI控制器参数。但是驱动调速系统的被控对象或者是随动系统的执行机构交流永磁同步电机(PMSM)是强耦合的非线性系统,且参数会随环境温度变化而变化,常常有难以预测的外部扰动和复杂的未建模状态,仅仅采用PI控制难以获得高性能。为了弥补PI经典控制理论对非线性系统调节能力不足的问题,国内外学者将模型参考自适应(MARS)、反步控制(back_step)、二自由度控制及滑模变结构控制等用于电机控制,以期望获得良好的静态和动态性能。但是有的算法在离散状态的研究和应用并不成熟。
滑模变结构控制由于对内部参数摄动和外部干扰具有较强的鲁棒性和较高的控制精度,且实现简单,故成为提高永磁同步电机控制系统的有效手段之一。传统滑模变结构控制常采用是线性滑模s=CX,其中C为滑模系数,X为状态,如角速度、速度、加速度等。该类滑模控制系统稳定性分析简单、便捷,参数设计相对容易,滑模系数可以采用最优化控制法、极点配置法等进行设计,但线性滑模在非线性动态系统中的的收敛速度不够,无法使系统在有限时间内收敛到平衡点,对抑制不确定的鲁棒性难以发挥,故在复杂非线性系统中的应用则控制能力则明显不足,限制了在随动驱动调速系统中的应用。
发明内容
为了克服现有技术的不足,本发明提供一种PMSM调速系统的近似离散快速终端滑模控制方法,能够提升随动调速系统的控制性能和鲁棒性。
本发明解决其技术问题所采用的技术方案包括以下步骤:
(1)等待速度指令ω*(k),速度指令到达后进入步骤(2),k为控制的步数;
(2)提取电机角速度反馈ω(k);
(3)计算速度误差的一阶导数deω(k):
eω(k-1)=ω*(k-1)-ω(k-1)
eωz(k-1)=zω0(k-1)-eω(k-1)
zω0(k)=zω0(k-1)+Ts(zω1(k-1)-λω1|eωz(k-1)|1/2sgn(eωz(k-1)))
zω1(k)=zω1(k-1)+Tsλω2sgn(-λω1|eωz(k-1)|1/2sgn(eωz(k-1)))
deω(k)=zω1(k)
其中,Ts为计算周期;eω(k-1)为速度误差;eωz(k-1)为速度误差的估计误差;zω0(k)为速度误差的估计值;zω1(k)为速度误差一阶导数deω(k)的估计值;λω1与λω2分别为微分估计器一阶、二阶增益;sgn(·)为符号函数;
(4)计算速度环的快速终端滑模面
(5)计算调速系统的电流环指令
其中,
(6)采集线电流ia(k),ib(k),计算PMSM在dq坐标下的交直轴电流id(k),iq(k):
(7)计算PMSM在dq坐标下的交直轴电流误差的一阶变化量ded(k),deq(k)
ed(k-1)=-id(k-1)
edz(k-1)=zd0(k-1)-ed(k-1)
zd0(k)=zd0(k-1)+Ts(zd1(k-1)-λd1|edz(k-1)|1/2sgn(edz(k-1)))
zd1(k)=zd1(k-1)+Tsλd2sgn(-λd1|edz(k-1)|1/2sgn(edz(k-1)))
ded(k)=zd1(k)
eqz(k-1)=zq0(k-1)-eq(k-1)
zq0(k)=zq0(k-1)+Ts(zq1(k-1)-λq1|eqz(k-1)|1/2sgn(eqz(k-1)))
zq1(k)=zq1(k-1)+Tsλq2sgn(-λq1|eqz(k-1)|1/2sgn(eqz(k-1)))
deq(k)=zq1(k)
其中,ed(k-1)和eq(k-1)分别为dq轴电流误差;edz(k-1)和eqz(k-1)分别为dq轴电流误差的估计误差;zd0(k)和zq0(k)分别为dq轴电流误差的估计值;zd1(k)和zq1(k)分别为dq轴电流误差一阶导数ded(k)、deq(k)的估计值;λd1与λd2分别为d轴微分估计器一阶、二阶增益;λq1与λq2分别为d轴微分估计器一阶、二阶增益;
(8)计算dq轴电流环的快速终端滑模面sd(k),sq(k)
其中,αd与βd是d轴电流环快速终端滑模面sd(k)的系数,且αd>0,βd>0;qd与pd是奇数,pd>qd>0;αq与βq是q轴电流环快速终端滑模面sq(k)的系数,且αq>0,βq>0;qq与pq是奇数,pd>qd>0;
(9)计算的电流环d轴电压控制量ud(k)
ud(k)=udeq(k)+udsw(k)
其中,umax和umin分别电压控制量ud(k)、uq(k)的最大值和最小值;L为PMSM电机dq轴交直轴电感;Rs为电机定子电阻;udsw(k)为滑模积分控制分量;udeq(k)为等效控制分量;ηd与kd分别为指数趋近率的系数,且ηd>0,kd>0;
(10)计算电流环q轴电压控制量uq(k)
uq(k)=uqeq(k)+uqsw(k)
其中,uqsw(k)为滑模积分控制分量;uqeq(k)为等效控制分量;ηq与kq分别为指数趋近率的系数,且ηω>0,kω>0;
(11)将dq轴电压控制量ud(k),uq(k)作为PMSM的逆park变换的输入来完成电机的k步控制。
本发明的有益效果是:在电流环实现电流前馈的解耦控制,并对反电动势进行补偿,提升电流环的动态控制精度;提升了随动调速系统的控制鲁棒性,对电机参数的变化和外部力矩干扰不敏感,增强了系统的环境适应能力;速度环和电流环控制项都采用积分对滑模变结构切换相进行平滑处理,避免了传统的线性滑模的控制抖振。
附图说明
图1是本发明的控制原理图;
图2本发明的计算流程图。
具体实施方式
下面结合附图和实施例对本发明进一步说明,本发明包括但不仅限于下述实施例。
本发明能够解决火炮随动系统传统PI控制器的性能对执行机构PMSM参数(如定子永磁磁链ψf、定子电阻Rs,交直轴电感Ld,Lq随环境变化而变化,以及外部力矩干扰等鲁棒性不强,实现高性能的高控制效果具有很大难度的问题。针对火炮随动系统常采用的隐极电机(交直轴电感相等,Ld=Lq=L),采用快速终端滑模变结构控制方法来设计速度环和电流环控制器,并采用一阶欧拉离散化来近似实现,以提升随动调速系统的控制性能和鲁棒性。其方案有如下步骤:
(1)判断速度指令ω*(k)是否到?是,进入步骤(2),否则就等待,k为控制的步数;
(2)提取电机角速度反馈ω(k);
(3)计算速度误差的一阶导数deω(k):
eω(k-1)=ω*(k-1)-ω(k-1)
eωz(k-1)=zω0(k-1)-eω(k-1)
zω0(k)=zω0(k-1)+Ts(zω1(k-1)-λω1|eωz(k-1)|1/2sgn(eωz(k-1)))
zω1(k)=zω1(k-1)+Tsλω2sgn(-λω1|eωz(k-1)|1/2sgn(eωz(k-1)))
deω(k)=zω1(k)
其中:Ts为计算周期;eω(k-1)为速度误差;eωz(k-1)为速度误差的估计误差;zω0(k)为速度误差的估计值;zω1(k)为速度误差一阶导数deω(k)的估计值;λω1与λω2分别为微分估计器一阶、二阶增益;sgn(·)为符号函数;
(4)计算速度环的快速终端滑模面sω(k):
其中:αω与βω是快速终端滑模面sω(k)的系数,且αω>0,βω>0;qω与pω是奇数,pω>qω>0;
(5)计算调速系统的电流环指令
其中:
(6)采集线电流ia(k),ib(k)计算PMSM在dq坐标下的交直轴电流id(k),iq(k)
(7)计算PMSM在dq坐标下的交直轴电流误差的一阶变化量ded(k),deq(k)
ed(k-1)=-id(k-1)
edz(k-1)=zd0(k-1)-ed(k-1)
zd0(k)=zd0(k-1)+Ts(zd1(k-1)-λd1|edz(k-1)|1/2sgn(edz(k-1)))
zd1(k)=zd1(k-1)+Tsλd2sgn(-λd1|edz(k-1)|1/2sgn(edz(k-1)))
ded(k)=zd1(k)
eqz(k-1)=zq0(k-1)-eq(k-1)
zq0(k)=zq0(k-1)+Ts(zq1(k-1)-λq1|eqz(k-1)|1/2sgn(eqz(k-1)))
zq1(k)=zq1(k-1)+Tsλq2sgn(-λq1|eqz(k-1)|1/2sgn(eqz(k-1)))
deq(k)=zq1(k)
其中:ed(k-1)和eq(k-1)分别为dq轴电流误差;edz(k-1)和eqz(k-1)分别为dq轴电流误差的估计误差;zd0(k)和zq0(k)分别为dq轴电流误差的估计值;zd1(k)和zq1(k)分别为dq轴电流误差一阶导数ded(k)、deq(k)的估计值;λd1与λd2分别为d轴微分估计器一阶、二阶增益;λq1与λq2分别为d轴微分估计器一阶、二阶增益;
(8)计算dq轴电流环的快速终端滑模面sd(k),sq(k)
其中:αd与βd是d轴电流环快速终端滑模面sd(k)的系数,且αd>0,βd>0;qd与pd是奇数,pd>qd>0;αq与βq是q轴电流环快速终端滑模面sq(k)的系数,且αq>0,βq>0;qq与pq是奇数,pd>qd>0;
(9)计算的电流环d轴电压控制量ud(k)
ud(k)=udeq(k)+udsw(k)
其中:umax和umin分别电压控制量ud(k)、uq(k)的最大值和最小值;L为PMSM电机dq轴交直轴电感;Rs为电机定子电阻;udsw(k)为滑模积分控制分量;udeq(k)为等效控制分量;ηd与kd分别为指数趋近率的系数,且ηd>0,kd>0;
(10)计算电流环q轴电压控制量uq(k)
uq(k)=uqeq(k)+uqsw(k)
其中:uqsw(k)为滑模积分控制分量;uqeq(k)为等效控制分量;ηq与kq分别为指数趋近率的系数,且ηω>0,kω>0;
(11)将dq轴电压控制量ud(k),uq(k)作为PMSM的逆park变换的输入来完成电机的k步控制。
本发明实施例的控制原理见图1。图中在一般的火炮随动隐极PMSM驱动驱动原理图,将传统的PI控制器采用快速终端滑模变结构控制器取代。该控制方法大致步骤:首先,接收角速率主令ω*(k),提取电机角速度反馈ω(k),计算速度误差的一阶导数deω(k);然后,计算速度环的快速终端滑模面sω(k),计算调速系统的电流环指令
根据隐极PMSM误差连续状态方程:
其中:d轴电流误差
分别对以上滑模面求导,分别采用指数趋近率
其中Vd,Vq,Vω分别为dq和速率滑模面能量函数。由于控制周期Ts为0.1ms,时间非常短,利用一阶欧拉离散化近似实现连续状态快速终端滑模控制是可行的。
实施该控制方法的火炮随动驱动调速系统,该计算平台是以DSP28335为核心的控制板。功率驱动采用IPM驱动,选用PMSM电机,母线电压为56VDC,极对数np=3,转矩系数ψf=0.368Wb,定子电阻Rs=0.008Ω,交直轴电感L=0.2mH,功率3Kw,可过载2倍,额定转速3500RPM,电机转子等效转动惯量J为0.0006329kg·m2。
图2为本发明控制方法的计算流程图,下面将结合流程图详述具体实施过程:
(1)判断速度指令ω*(k)是否到?是,进入步骤(2),否则就等待,k为控制的步数;
(2)提取电机角速度反馈ω(k);
(3)计算速度误差的一阶导数deω(k):
eω(k-1)=ω*(k-1)-ω(k-1)
eωz(k-1)=zω0(k-1)-eω(k-1)
zω0(k)=zω0(k-1)+Ts(zω1(k-1)-λω1|eωz(k-1)|2/3sgn(eωz(k-1)))
zω1(k)=zω1(k-1)+Tsλω2sgn(-λω1|eωz(k-1)|1/2sgn(eωz(k-1)))
deω(k)=zω1(k)
其中:计算周期Ts=1ms;速度误差的估计值初值zω0(0)=0;速度误差一阶导数deω(k)的估计值初值zω1(0)=0;微分估计器一阶增益λω1=5.84、二阶增益λω2=15;
(4)计算速度环的快速终端滑模面sω(k):
其中:是快速终端滑模面sω(k)的系数αω=300,βω=90;奇数qω=3,奇数pω=5;
(5)计算调速系统的电流环指令
其中:电流指令
(6)采集线电流ia(k),ib(k)计算PMSM在dq坐标下的交直轴电流id(k),iq(k)
(7)计算PMSM在dq坐标下的交直轴电流误差的一阶变化量ded(k),deq(k)
ed(k-1)=-id(k-1)
edz(k-1)=zd0(k-1)-ed(k-1)
zd0(k)=zd0(k-1)+Ts(zd1(k-1)-λd1|edz(k-1)|1/2sgn(edz(k-1)))
zd1(k)=zd1(k-1)+Tsλd2sgn(-λd1|edz(k-1)|1/2sgn(edz(k-1)))
ded(k)=zd1(k)
eqz(k-1)=zq0(k-1)-eq(k-1)
zq0(k)=zq0(k-1)+Ts(zq1(k-1)-λq1|eqz(k-1)|1/2sgn(eqz(k-1)))
zq1(k)=zq1(k-1)+Tsλq2sgn(-λq1|eqz(k-1)|1/2sgn(eqz(k-1)))
deq(k)=zq1(k)
其中:dq轴电流误差的估计值初值分别为zd0(k)=0,zq0(k)=0;dq轴电流误差一阶导数ded(k)、deq(k)的估计值初值zd1(0)=0,zq1(k)=0;d轴微分估计器一阶增益λd1=6.52、二阶增益λd2=24;分别为d轴微分估计器一阶增益λq1=6.52,二阶增益λq2=24;
(8)计算dq轴电流环的快速终端滑模面sd(k),sq(k)
其中:d轴电流环快速终端滑模面sd(k)的系数分别为αd=450,βd=150;奇数qd=3,奇数pd=5;q轴电流环快速终端滑模面sq(k)的系数分别为αq=450,βq=150;奇数qq=3,奇数pq=5;
(9)计算的电流环d轴电压控制量ud(k)
ud(k)=udeq(k)+udsw(k)
其中:电压控制量的最大值umax=32,最小值umin=-32;PMSM电机dq轴交直轴电感L=0.2mH;电机定子电阻Rs=0.008;指数趋近率的系数分别为ηd=9000,kd=80000;
(10)计算电流环q轴电压控制量uq(k)
uq(k)=uqeq(k)+uqsw(k)
其中:指数趋近率的系数分别为ηq=9000,kq=80000;
(11)将dq轴电压控制量ud(k),uq(k)作为PMSM的逆park变换的输入来完成电机的k步控制。
本发明所需要参数见表1。
表1本发明所需要参数取值表
机译: 一种执行离散余弦变换的近似和量化以及逆量化和离散余弦逆变换的近似的方法。
机译: 快速离散余弦变换的近似方法
机译: 离散空间显微镜方法求解对称路径销售商问题的快速近似求解方法