CN108631682B - 一种挠性帆板驱动系统测角装置失效时的闭环控制方法 - Google Patents
一种挠性帆板驱动系统测角装置失效时的闭环控制方法 Download PDFInfo
- Publication number
- CN108631682B CN108631682B CN201810384059.3A CN201810384059A CN108631682B CN 108631682 B CN108631682 B CN 108631682B CN 201810384059 A CN201810384059 A CN 201810384059A CN 108631682 B CN108631682 B CN 108631682B
- Authority
- CN
- China
- Prior art keywords
- sailboard
- closed
- loop
- flexible
- driving system
- 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
Images
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/14—Estimation or adaptation of machine parameters, e.g. flux, current or voltage
- H02P21/18—Estimation of position or speed
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/06—Arrangements for speed regulation of a single motor wherein the motor speed is measured and compared with a given physical value so as to adjust the motor speed
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
本发明涉及一种挠性帆板驱动系统测角装置失效时的闭环控制方法,属于星载太阳帆板控制技术领域。该方法主要是针对采用永磁同步电机作为驱动元件的闭环控制太阳帆板驱动系统。本发明采用扩展Kalman滤波器(EKF)方法,根据帆板驱动过程中的电流和电压变化对帆板转速和转角进行实时估计,从而实现当帆板测角元件出现故障时的仍然能够维持闭环控制。相比帆板开环驱动方式,采用本发明的方法可有效提高帆板驱动系统在测角元件故障时的驱动平稳性,提高卫星的故障容错能力。
Description
技术领域
本发明涉及一种挠性帆板驱动系统测角装置失效时的闭环控制方法,属于星载太阳帆板控制技术领域。
背景技术
当前帆板驱动机构采用旋转变压器(旋变)作为帆板转角测量元件,采用具有平滑力矩输出的永磁同步电机作为驱动元件,对帆板的对日定向过程引入闭环控制,从而大幅提高了帆板驱动过程的速率稳定度水平,大大降低了帆板运动对整星姿态稳定度的影响。然而,作为帆板闭环驱动的关键环节,其测角元件可能会出现在轨故障。由于帆板驱动机构各元件一般无法进行备份(单点故障),因此如何在测角元件发生故障的情况下维持控制闭环的正常功能,是高稳帆板驱动机构必须解决的问题,也是提高遥感卫星在轨运行智能化水平的必然要求。
发明内容
本发明的技术解决问题是:克服现有技术的不足,针对闭环控制帆板驱动机构,提出一种挠性帆板驱动系统测角装置失效时的闭环控制方法,提高帆板驱动系统在测角元件故障时的驱动平稳性,提高卫星的故障容错能力。
本发明的技术解决方案是:一种挠性帆板驱动系统测角装置失效时的闭环控制方法,具体为:当测角装置失效之后,建立挠性帆板闭环驱动系统状态方程,基于挠性帆板闭环驱动系统状态方程的离散化形式,采用扩展Kalman滤波方法,根据帆板驱动过程中的电流和电压变化对帆板转速和转角进行实时估计。
所述帆板闭环驱动系统采用永磁同步电机作为驱动元件,闭环控制太阳帆板的转速和转角。
所述挠性帆板闭环驱动系统状态方程为:
其中,x为状态量,ωe为电角速度,ωe=npωm,np为三相永磁同步电机的极对数,ωm为帆板转速,即:电机转子机械角速度,θe为电角度,θe=npθm,θm为帆板转角,即:电机转子机械角度,iα、iβ为永磁同步电机三相电流经过Clark变换后得到的静止坐标系下的α相和β相电流;
u为输入控制量,u=[uα uβ]T,为永磁同步电机三相电压经过Clark变换后得到的静止坐标系下的α相和β相电压;
y为输出量,y=[iα iβ]T
式中,f(x)为状态转移矩阵;B为输入矩阵;C为输出矩阵;ψf为永磁体磁链,Ls为定子电感,R为定子电阻,J为帆板转动惯量,η为帆板一阶扭转模态,H为帆板振动与帆板转动的耦合系数;D为一阶扭转模态阻尼,K为一阶扭转模态刚度。
所述挠性帆板闭环驱动系统的状态方程的离散化形式:
其中,V(k)、W(k)为零均值白噪声,C(k)为第k个控制周期的输出矩阵,f(x(k))为第k个控制周期的状态转移矩阵、B(k)为第k个控制周期的输入矩阵、y(k)为第k个控制周期的输出量和u(k)为第k个控制周期的输入量、x(k+1)和x(k)分别为第k+1和第k个控制周期的状态量。
本发明与现有技术相比的有益效果是:
(1)、本发明的方法通过采用扩展卡尔曼滤波器根据电机绕组电流和控制电压实现对帆板转角和转速的在线估计,无须增加任何硬件设备即可维持系统的正常运行,因而具有极高的效能代价比;
(2)、相比同样可以不依赖于传感器的永磁同步电机开环控制方案,本方法保证了闭环控制能力,因而相比开环控制具有更低的速率波动水平,在传感器故障情况下,仍然能够获得较高的驱动稳定性,最大程度满足整星稳定度指标要求;
(3)、本发明基于EKF的高稳帆板驱动机构容错控制方法,帆板测角装置失效也能够获得帆板的转角信息,从而维持系统正常控制,提高了整星智能化控制水平和系统健壮性。
附图说明
图1为基于EKF的挠性帆板驱动系统组成框图;
图2为本发明闭环控制方法流程图;
图3(a)为采用本发明方法控制与含有转角测量时差分控制时转角对比图;图3(b)为采用本发明方法控制与含有转角测量时差分控制时转速对比图具体实施方式
以下结合附图和具体实施例对本发明进行详细说明。
本发明提供了一种挠性帆板驱动系统测角装置失效时的闭环控制方法,该方法在测角装置失效之后,建立挠性帆板闭环驱动系统状态方程,基于挠性帆板闭环驱动系统状态方程的离散化形式,采用扩展Kalman滤波方法,根据帆板驱动过程中的电流和电压变化对帆板转速和转角进行实时估计。
以下分别从挠性帆板闭环驱动系统建模、帆板状态预测和帆板状态校正三个方面对本发明进行详细介绍。
(1)、挠性帆板闭环驱动系统建模
图1为基于EKF的挠性帆板驱动系统组成框图,图中涉及三种坐标系,下标ABC表示永磁同步电机的自然坐标系下的分量(ABC三相),下标αβ表示静止坐标系下的分量,下标dq表示旋转坐标系下的分量,三种坐标系可以相互转换。
上述帆板闭环驱动系统采用永磁同步电机作为驱动元件,闭环控制太阳帆板的转速和转角。
永磁同步电机在静止坐标系下的电流方程为:
式中,iα、iβ为永磁同步电机三相电流经过Clark变换后得到的静止坐标系下的α相和β相电流;uα、uβ为永磁同步电机三相电压经过Clark变换后得到的静止坐标系下的α相和β相电压,ψf为永磁体磁链,Ls为定子电感,R为定子电阻,ωe为电角速度,ωe=npωm,np为三相永磁同步电机的极对数,ωm为帆板转速,即:电机转子机械角速度,θe为电角度,θe=npθm,θm为帆板转角,即:电机转子机械角度。
帆板对日稳定跟踪时的运动方程为:
则状态方程为
式中,δ=J-H2。设离散周期为ΔT,进一步可以得到挠性帆板闭环驱动系统的状态方程的离散化形式:
其中,V(k)、W(k)为零均值白噪声,C(k)为第k个控制周期的输出矩阵,f(x(k))为第k个控制周期的状态转移矩阵、B(k)为第k个控制周期的输入矩阵、y(k)为第k个控制周期的输出量和u(k)为第k个控制周期的输入量、x(k+1)和x(k)分别为第k+1和第k个控制周期的状态量。
其中,V(k)、W(k)为零均值白噪声,令V(k)和W(k)的协方差矩阵为分别为Q和P,那么:
(2)帆板状态预测
本步骤采用扩展卡尔曼滤波方法对帆板状态进行预测,其具体实现为:
(2.4)、计算扩展Kalman滤波的增益矩阵K(k+1),即:
(3)帆板状态校正
(3.2)、计算估计误差协方差矩阵,即:
在每一控制周期重复上述帆板状态预测和校正过程即可得到实现当帆板测角元件出现故障时的仍然能够维持闭环控制。相比帆板开环驱动方式,采用本发明的方法可有效提高帆板驱动系统在测角元件故障时的驱动平稳性,提高卫星的故障容错能力。
本发明采用扩展Kalman滤波器(EKF)对帆板转角和转速进行实时估计。EKF算法适用于高性能伺服系统,可以在很大的速度范围内工作,在很低的速度下也能完成帆板转速估计,从而确保旋变故障时的帆板驱动系统仍然能够实现闭环控制。
实施例
本发明具体方法如下:
(1)挠性帆板闭环驱动系统建模
设电机绕组电阻为R=68Ω,绕组电感Ls=0.2H,永磁磁链ψf=0.175Wb,极对数np=32;帆板转动惯量为J=28.7784kg·m2,一阶扭转模态耦合系数H=4.868742kg·0.5m,模态频率为f1=1.832541Hz,则刚度K=(2πf1)2,阻尼比为ξ1=0.008,则模态阻尼D=2ξ1(2πf1),则代入式(4)可得带挠性负载闭环驱动系统的状态空间模型。取离散周期ΔT=0.125秒,即可获得系统离散化模型。
(2)帆板状态预测
④由式(9)计算增益矩阵K(k+1)。
(3)帆板状态校正
(4)每一控制周期重复步骤(2)和步骤(3),以连续获得帆板运动状态
采用MATLAB软件环境进行仿真,并与帆板含有转角测量时的差分控制方法结果进行对比,比对结果如图3(a)和图3(b)所示。仿真表明,本发明的方法控制效果与差分控制基本相当。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。
Claims (2)
1.一种挠性帆板驱动系统测角装置失效时的闭环控制方法,其特征在于当测角装置失效之后,建立挠性帆板驱动系统状态方程,基于挠性帆板闭环驱动系统状态方程的离散化形式,采用扩展Kalman滤波方法,根据帆板驱动过程中的电流和电压变化对帆板转速和转角进行实时估计;所述帆板闭环驱动系统采用永磁同步电机作为驱动元件,闭环控制太阳帆板的转速和转角;
所述挠性帆板闭环驱动系统状态方程为:
其中,x为状态量,ωe为电角速度,ωe=npωm,np为三相永磁同步电机的极对数,ωm为帆板转速,即:电机转子机械角速度,θe为电角度,θe=npθm,θm为帆板转角,即:电机转子机械角度,iα、iβ为永磁同步电机三相电流经过Clark变换后得到的静止坐标系下的α相和β相电流;
u为输入控制量,u=[uα uβ]T,为永磁同步电机三相电压经过Clark变换后得到的静止坐标系下的α相和β相电压;
y为输出量,y=[iα iβ]T
式中,f(x)为状态转移矩阵;B为输入矩阵;C为输出矩阵;ψf为永磁体磁链,Ls为定子电感,R为定子电阻,J为帆板转动惯量,η为帆板一阶扭转模态,H为帆板振动与帆板转动的耦合系数;D为一阶扭转模态阻尼,K为一阶扭转模态刚度,δ=J-H2。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810384059.3A CN108631682B (zh) | 2018-04-26 | 2018-04-26 | 一种挠性帆板驱动系统测角装置失效时的闭环控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810384059.3A CN108631682B (zh) | 2018-04-26 | 2018-04-26 | 一种挠性帆板驱动系统测角装置失效时的闭环控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108631682A CN108631682A (zh) | 2018-10-09 |
CN108631682B true CN108631682B (zh) | 2020-07-14 |
Family
ID=63694615
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810384059.3A Active CN108631682B (zh) | 2018-04-26 | 2018-04-26 | 一种挠性帆板驱动系统测角装置失效时的闭环控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108631682B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110687886B (zh) * | 2019-09-16 | 2020-11-03 | 上海航天控制技术研究所 | 一种摆动式帆板驱动系统的故障诊断与重构方法 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103256946B (zh) * | 2013-05-23 | 2015-04-22 | 合肥工业大学 | 可故障在线检测和容错控制的旋转变压器数字转换器 |
EP2881744A1 (en) * | 2013-12-03 | 2015-06-10 | ABB Technology AG | Method and apparatus for determining a rotational speed of a synchronous machine |
CN204271969U (zh) * | 2014-12-16 | 2015-04-15 | 中国矿业大学 | 一种永磁同步电机驱动装置 |
CN105071736B (zh) * | 2015-08-11 | 2018-05-15 | 泰州职业技术学院 | 一种风机用永磁同步电机无传感器转子位置检测方法 |
DE102016224056A1 (de) * | 2015-12-15 | 2017-06-22 | Bayerische Motoren Werke Aktiengesellschaft | Anordnung, stationärer Energiewandler, Fortbewegungsmittel und Verfahren zur Rotorpositions- und/oder Drehzahlermittlung eines elektrischen Drehfeldmotors |
CN105871283B (zh) * | 2016-05-08 | 2019-01-22 | 浙江理工大学 | 传感器故障下车用永磁同步电机容错驱动系统及方法 |
CN106026817A (zh) * | 2016-08-04 | 2016-10-12 | 上海应用技术学院 | 一种基于采用卡尔曼滤波器的滑模观测器的无速度传感器控制系统 |
CN107592037A (zh) * | 2017-10-23 | 2018-01-16 | 哈尔滨理工大学 | 基于fpga的双系统无刷直流电机控制装置及方法 |
-
2018
- 2018-04-26 CN CN201810384059.3A patent/CN108631682B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN108631682A (zh) | 2018-10-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101335499B (zh) | 一种四相永磁容错电动机的控制方法 | |
CN108319148B (zh) | 一种控制力矩陀螺框架伺服系统低转速高精度控制方法 | |
CN105786036A (zh) | 一种抑制转子动不平衡扰动的控制力矩陀螺框架控制系统及方法 | |
CN108011554B (zh) | 永磁同步电机无速度传感器自适应转速跟踪控制系统及其设计方法 | |
CN103051274B (zh) | 基于变阻尼的二自由度永磁同步电机的无源性控制方法 | |
CN107612446B (zh) | 一种内置式永磁同步电机模型预测转矩控制方法 | |
CN107992110A (zh) | 一种基于谐波减速器的磁悬浮控制力矩陀螺框架角速率伺服系统 | |
CN108092567A (zh) | 一种永磁同步电动机转速控制系统及方法 | |
CN107577149B (zh) | 一种采用分数阶快速终端滑模控制的随动控制方法 | |
CN112217436B (zh) | 一种抑制电流测量误差引起的永磁同步电机转速脉动方法 | |
CN106374789A (zh) | 永磁无刷直流电机低转矩脉动霍尔容错控制方法 | |
CN104104301A (zh) | 一种无速度传感器的内插式永磁同步电机无源控制方法 | |
CN103647493B (zh) | 一种永磁同步电机的h无穷转速估计方法 | |
CN106849809A (zh) | 一种基于磁链误差矢量法的svm‑dtc电机控制算法 | |
CN103117702A (zh) | 一种高精度永磁同步电机的无速度传感器估计方法 | |
CN108631682B (zh) | 一种挠性帆板驱动系统测角装置失效时的闭环控制方法 | |
CN112187127A (zh) | 一种永磁同步电机控制方法 | |
CN105186958A (zh) | 基于神经网络逆系统的五相容错永磁电机内模控制方法 | |
CN106100480A (zh) | 基于干扰观测器的永磁同步电机三自由度内模控制方法 | |
CN109639199A (zh) | 三相不对称故障下的pmsm转速转矩脉动抑制方法 | |
CN109194224A (zh) | 基于扩张状态观测器的永磁同步电机无传感器控制方法 | |
Prabu et al. | Advanced direct torque control of induction motor | |
Divandari et al. | A novel dynamic observer and torque ripple minimization via fuzzy logic for SRM drives | |
CN112737435A (zh) | 一种基于t-s模糊滑模控制的步进电机抗干扰系统 | |
CN113726240A (zh) | 一种基于二阶自抗扰控制的永磁同步电机控制方法及系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |