一种直流电机驱动的飞轮系统转速控制方法
【专利摘要】本发明提供了一种直流电机驱动的飞轮系统转速控制方法，先由给定的目标转速和实际转速计算误差量，然后计算滑动模态变量；将滑动模态变量经低通滤波器调制后得到等效控制信号，以等效控制信号为输入，设计双层自适应算法在线调整控制增益；将滑动模态变量和控制增益输入到设计的超螺旋控制算法中，获得控制电压。由该方法控制的闭环系统能够在有限时间内稳定调节至目标转速，具有良好的鲁棒性和控制精度。为飞轮系统高精度转速控制的工程实现提供了有效的手段。
【专利说明】
-种直流电机驱动的飞轮系统转速控制方法
技术领域
[0001] 本发明设及自动控制技术领域，具体的设及一种直流电机驱动的飞轮系统转速控 制方法。
【背景技术】
[0002] 飞轮系统是得到广泛应用的主动控制系统。现代航天器对姿态控制系统的精度、 寿命和可靠性要求越来越高，通常采用飞轮系统组成的Ξ轴稳定系统来满足其性能要求。 飞轮系统不消耗工质，只消耗电能;能够产生较精确的控制力矩，控制精度较推力器高出一 个数量级;适于吸收周期性干扰的影响。因此，目前在中、高轨道上长期工作的航天器，都是 安装了飞轮系统的Ξ轴稳定航天器。
[0003] 飞轮系统的工作原理就是"动量矩定理"，即航天器的总动量矩矢量对时间的导 数，等于作用在航天器上的外力矩矢量之和。通过改变航天器上飞轮系统的高速旋转部件 (即转子)的动量矩矢量，从而产生与转子动量矩变化率成正比的控制力矩，作用于航天器 基座上，使其动量矩相应的变化，运一过程称为动量矩交换。
[0004] 根据结构特点和工作方式，飞轮系统可W分为:惯性轮、控制力矩巧螺和框架动量 轮Ξ种类型。如果飞轮系统的支承与航天器固连，飞轮转子的旋转轴相对航天器基座不变， 但转子的转速可W变化，运样的飞轮就称为"惯性轮"。如果转子保持匀速旋转并被安装在 框架上，而框架又可W相对航天器基座转动，就称运种飞轮为"控制力矩巧螺"。如果在控制 力矩巧螺的基础上，使转子的转速可W变化，就得到了 "框架动量轮"。
[0005] 从飞轮系统的工作原理和工作方式可W看出，转子的转速是实现动量矩交换的关 键物理量。转子在电机的驱动下高速旋转，根据工作方式的不同，保持恒定转速或跟踪变化 的目标转速。因此，需要对转子的转速进行有效控制。目前，对转速的控制方法主要有PID (比例、积分和微分)控制和滑模控制。PID控制通过测量转速误差，经并联的比例、积分和微 分通道后产生电机驱动力矩，作用在转子上实现转速控制。控制效果则取决于是否选取了 合适的"比例增益、积分增益和微分增益"Ξ个控制参数。PID控制具有计算简单、易于工程 实现的优点，得到了广泛的应用。但是从理论上来讲，PID控制效果至多能达到"渐近稳定"， 即实际转速只能无限接近于目标转速，但不能完全等于目标转速。特别地，转子在实际工作 环境中必然会受到干扰力矩的影响，比如，转轴与支撑间存在摩擦，或者转子磁化后在航天 器电磁环境中受到电磁力作用等。此时，PID控制效果只能达到"一致有界"，即实际转速只 能进入包含目标转速的一个邻域内，控制误差将一直存在。为此，部分研究者开始尝试采用 滑模控制方法对转子转速进行控制。滑模控制通过构造滑模变量，迫使转子运动状态进入 滑模动态，进入滑模动态后转子的运动将不受干扰力矩的影响，可W在有限时间内使实际 转速等于目标转速。但是滑模控制律中包含开关项函数，当转子运动进入滑模动态后，控制 器将产生不连续的高频抖振信号，不仅带来了工程实现上的困难，还增加了控制所需的能 耗。
【发明内容】
[0006] 为解决上述技术问题，本发明提供了一种直流电机驱动的飞轮系统转速控制方 法。
[0007] 本发明提供方法的控制系统结构如图1所示，其W直流电机驱动下的飞轮系统为 被控对象，控制目标是使飞轮系统旋转部件的实际转速与期望的目标转速一致。设计了一 种超螺旋控制算法，产生的控制电压作为驱动电机的控制输入信号，实现了对模型不确定 性和外界扰动的鲁棒控制;为有效抑制开关项函数引起的抖振，同时使超螺旋控制算法中 的控制参数实现自适应调节，W低通滤波器输出的等效控制信号为输入，W超螺旋控制算 法的控制增益为输出，设计了双层自适应算法，通过低通滤波器对滑动模态变量的采样滤 波，在线调整控制增益;其中，滑动模态变量根据误差量计算，误差量为目标转速与实际转 速之差。由该方法控制的闭环系统能够在有限时间内稳定调节至目标转速，具有良好的鲁 棒性和控制精度。为飞轮系统高精度转速控制的工程实现提供了有效的手段。
[000引本发明提供了一种直流电机驱动的飞轮系统转速控制方法，包括W下步骤：
[0009] 步骤S100:由目标转速和测量得到的实际转速计算目标转速和实际转速的误差量 e，然后计算滑动模态变量；
[0010] 步骤S200:将滑动模态变量经低通滤波器调制后得到等效控制信号，W等效控制 信号为输入，W控制增益为输出，通过双层自适应算法选择自适应参数，得到控制增益;其 中此步骤称为双层自适应算法设计，所得双层自适应算法流程如图2所示。
[0011] 步骤S300:建立直流电机驱动的飞轮系统转速模型，W步骤S200中所述的滑动模 态变量为输入，结合所得所述的控制增益，设计超螺旋控制算法，调整控制参数，得到电机 的控制电压;此步骤S300为超螺旋控制算法设计。
[0012] 实际应用中，飞轮转子的实际转速由转速传感器测量测到，将有该方法计算得到 的控制电压输入到驱动电机，电机带动飞轮转子即可实现转速控制。
[0013] 其中，在步骤S100中所述的目标转速与实际转速之间的误差量，其计算方法为：
[0014] 6=Ω(；-Ω (1)
[0015] Ω e为目标转速，Ω为实际转速。
[0016] 其中，在步骤S200中所述的滑动模态变量，其计算方法为
[0017]
猫
[0018] 函数sgn(e)为符号函数，定义为
[0019]
(3)
[0020] 参数k为大于零的常数。
[0021] 其中，在步骤S200中所述的设计双层自适应算法，其方法如下：
[0022] 1)计算等效控制信号
[0023] 利用低通滤波器获得等效控制信号，其计算方法如下：
[0024]
(4)
[0025] 式中，τ为滤波器时间常数，取值满足〇<T<<l，s为步骤S200中所述的滑动模态变 量，σ为低通滤波信号，sgn(s)为符号函数，为步骤S200中所述的等效控制信号，iKt)和K (t)为时变控制参数，计算方法如下
[0026] β(?) =1(?)β〇 巧）
[0027] K(t) =L^(t)K〇 (6)
[002引 β0和κ0为控制参数。
[0029] 2)设计双层自适应算法
[0030] 式(5)和(6)中的L(t)为步骤S200中所述的控制增益，其计算方法如下
[0031] L(t) = l〇+l(t) (7)
[0032] 式中，1〇为大于0的常值自适应参数，l(t)为时变自适应参数，其计算方法如下
[003；3] /:(〇 二/,(/)=-抑./)巧n(()、) 脚
[0034] 式中，δ的计算方法如下
[0035]
(9)
[0036] 其中，a〉0为常值自适应参数，同时满足0<3β〇<1，β〇即是式(5)中的控制参数；ε〉〇为 非常小的常值自适应参数;式(8)中的P(t)的计算方法如下
[0037] p(t) =r〇+r(t) (10)
[0038] r〇〉0为常值自适应参数;时变部分r (t)的计算方法为
[0039] Γ的= HW)I (叫
[0040] 丫〉0为常值自适应参数。
[0041] 本发明中双层自适应算法的计算流程如图2所示。
[0042] 其中，在步骤S300中所述的设计超螺旋控制算法，其方法如下：
[0043] 1)建立直流电机驱动的飞轮系统转速模型
[0044] 直流电机驱动的飞轮系统结构如图4所示，其工作原理如图5所示。图4中电机驱动 转轴，转轴上套设有转子，转轴驱动转子，转子的另一端设置支承转轴的轴承类构件。图5 中，负载为与电机输出轴相连接的转子、转轴和支承构件，电机为直流电机，包括依次与电 源相串联的电感、电阻和电枢。所用电源的电压可控。设计目的为设计控制电压，实现对电 机转子转速的控制。根据图4和图5,可W推导出飞轮系统的转速微分方程为：
[0045]
(]：.)
[0046] 式中，Ua为输入到电机的控制电压，Me为折合到电动机轴上的总负载转矩，Ai。为折 合到电动机轴上的总负载转矩的一阶微分，Ω为转速的一阶微分，?为转速的二阶微分，Τι 和Τ2为电动机的机电时间常数，其计算方法如下
[0047]
(13)
[0048]
(14)
[0049] Km、Kl和Κ2为电机传递系数，其计算方法如下
[0053] 公式（13)至公式（17)中，Ra是电枢电路的电阻，La是电枢电路的电感，Jm是电机和 负载折合到电机轴上的转动惯量，fm是电机和负载折合到电机轴上的黏性摩擦系数，Cm是电 机转矩系数，Ce是电机反电势系数。
[0054] 2)设计超螺旋控制算法
[0055] 式（12)表示的转速微分方程即为直流电机驱动的飞轮系统转速模型，运是一个二 阶线性微分方程，在实际工程中，1'1、了2、1(。、1(1、1(2、1。和姑。运些模型参数和扰动均不能准确 获得，因此必须考虑参数和扰动的不确定性设计转速控制算法，得到控制电压。
[0056] 利用步骤S200中的滑动模态变量S，设计如下超螺旋控制算法：
[0化7]
(1巧
[005引式中，7；'和<分别为机电时间常数Τι和电机传递系数Km的标称值，由电机生产厂 商提供，时变控制参数e(t)和K(t)的计算方法如公式(5)和(6)所述，a(t)和ri(t)的计算方 法如下
[00化]控制增益L(t)和￡的根据步骤S200进行计算。
[0066] 本发明中超螺旋控制算法计算流程如图3所示;直流电机驱动的飞轮系统结构如 图4所示;直流电机驱动的飞轮系统原理图如图5所示。
[0067] 控制工程师在应用过程中可W根据实际飞轮系统的任务需求给定任意的目标转 速，并将由该方法得到的控制电压传输至直流电机实现转速控制。
[0068] 本发明的技术效果：
[0069] 1)本发明提供的直流电机驱动的飞轮系统转速控制方法，W飞轮转速模型为被控 对象，考虑了模型参数不确定性和负载转矩不确定性的禪合作用，提高了系统的适应性；
[0070] 2)本发明提供的直流电机驱动的飞轮系统转速控制方法中采用了具有二阶滑模 特性的超螺旋算法，使得闭环系统对被控对象的参数不确定性和外界扰动具有良好的鲁棒 性；
[0071] 3)本发明提供的直流电机驱动的飞轮系统转速控制方法，通过使用了超螺旋算 法，相比已有的滑模控制，可W产生连续的控制信号，解决了滑模控制中存在的抖振现象；
[0072] 4)本发明提供的直流电机驱动的飞轮系统转速控制方法中设计了针对飞轮系统 的双层自适应算法，可W自适应调节控制增益，在保持滑模运动存在的同时，使得控制增益 的取值尽量地小，进而使得控制能耗较低。
[0073] 具体请参考根据本发明的直流电机驱动的飞轮系统转速控制方法提出的各种实 施例的如下描述，将使得本发明的上述和其他方面显而易见。
【附图说明】
[0074] 图1为本发明提供的直流电机驱动的飞轮系统转速控制方法的控制系统结构示意 图；
[0075] 图2为本发明提供的直流电机驱动的飞轮系统转速控制方法中双层自适应算法的 流程示意图；
[0076] 图3为本发明提供的直流电机驱动的飞轮系统转速控制方法中超螺旋控制算法流 程示意图；
[0077] 图4为本发明提供的直流电机驱动的飞轮系统转速控制方法中所控制的直流电机 驱动的飞轮系统结构图；
[0078] 图5为本发明提供的直流电机驱动的飞轮系统转速控制方法中所处理直流电机驱 动的飞轮系统原理图；
[0079] 图6为采用PID控制算法对直流电机驱动的飞轮系统转速控制结果图；
[0080] 图7为采用滑模控制算法对直流电机驱动的飞轮系统转速控制结果图；
[0081 ]图8为本发明优选实施例对直流电机驱动的飞轮系统转速超螺旋控制结果图。 [0082]图、文中符号说明如下：
[008引 Ω功飞轮转子的目标转速；
[0084] Ω为飞轮转子的实际转速；
[0085] e为目标转速与实际转速之间的误差量；
[0086] S为滑动模态变量；
[0087] 为等效控制信号；
[0088] L(t)为控制增益；
[0089] Z(〇为控制增益的一阶微分；
[0090] Ua为驱动电机的控制电压；
[0091] τ为低通滤波器的时间常数；
[0092] a、e、丫、ro和1〇为自适应参数；
[OOW] α〇、η〇、β日和κ〇为控制参数；
[0094] If和心分别为机电时间常数和电机传递系数的标称值。
[00巧]Σ为求和运算；
[0096] /为积分运算；
[0097] k为滑模系数；
[0098] 加/化为微分运算；
[0099] II为绝对值运算；
[0100] sgn( ·)为符号运算；
[0101] /|ue(t)|化表示对控制电压Ue的绝对值求积分，可用于度量控制方法的能耗。
【具体实施方式】
[0102] 构成本申请的一部分的附图用来提供对本发明的进一步理解，本发明的示意性实 施例及其说明用于解释本发明，并不构成对本发明的不当限定。
[0103] W下结合具体实例，对本发明提供的方法进行详细说明。
[0104] -种直流电机驱动的飞轮系统转速控制方法，其具体步骤如下：
[0105] 步骤一:给定目标转速并测量实际转速
[0106]给定目标转速为〇G=lrad，初始时刻实际转速为Ω =化ad。
[0107] 步骤二:误差量计算
[0108] 计算目标转速与实际转速直接的误差量:e= Ω(]-Ω。
[0109] 步骤Ξ:滑动模态变量计算
[0110] 计算滑动模态变量:间"2蝶nk) +知j f本实施例中取k = 2。
[0111] 步骤四：双层自适应算法设计
[0112] 1)计算等效控制信号
[0113]
(23)
[0114] 本实施例中取τ = 1〇-3。
[0115] 2)设计双层自适应算法
[0116]
(24)
[0117] 本实施例中，取l〇 = 0.1，r〇 = 0.1，丫 =10，曰=0.8636,6=0.05。由此获得了时变的 控制增益L(t)。
[0118] 步骤五:超螺旋控制算法设计
[0119] 1)建立直流电机驱动的飞轮系统转速模型
[0120]
脚
[0121 ]在本实施例中，飞轮系统转速模型通过数值仿真实现，仿真模型中参数的取值为
[0124] 公式(23)和(26)中出现的控制参数α〇、β〇、ιι日和K0的取值要满足约束条件
[0125]
[0126] 在本实施例中，取
α"二2~/^，―0日=1.1，11日=〇.5，1〇日=68.75，由此获得了控 制电压Ua(t)。
[0127] 为了与本发明的控制方法进行对比，在相同条件下，分别采用与本发明提供方法 不同的PID控制方法和滑模控制方法对直流电机驱动的飞轮系统模型进行控制仿真。其中 PID控制算法为：
[0128]
(27)
[0129] 本对比例 1 中取 Kp = 50，Ki = 10，Kd = 0.1。
[0130] 滑模控制算法为：
[0131] Ua(t)=^s+km sgn(s) (28)
[0132] 本对比例2中，取λ= 1,km二10。
[0133] W上实施例和对比文件1~2所得直流电机驱动的飞轮系统转速控制结果如图6~ 8所示。图6给出了采用PID控制算法(公式(27))的控制结果，图7给出了采用滑模控制算法 (公式(28))的控制结果，图8给出了采用本发明提出的双层自适应算法和超螺旋控制算法 的控制结果。由图8可见:本发明所提出的转速控制方法能够使飞轮系统转速准确地调节到 目标转速，说明了该方法的有效性;通过与图6和图7进行对比可见:本发明提供的方法动态 响应平稳，控制精度高，产生的控制信号连续光滑，有效消除了抖振现象，控制所需的能耗 也最少。
[0134] 本领域技术人员将清楚本发明的范围不限制于W上讨论的示例，有可能对其进行 若干改变和修改，而不脱离所附权利要求书限定的本发明的范围。尽管己经在附图和说明 书中详细图示和描述了本发明，但运样的说明和描述仅是说明或示意性的，而非限制性的。 本发明并不限于所公开的实施例。
[0135] 通过对附图，说明书和权利要求书的研究，在实施本发明时本领域技术人员可W 理解和实现所公开的实施例的变形。在权利要求书中，术语"包括"不排除其他步骤或元素， 而不定冠词"一个"或"一种"不排除多个。在彼此不同的从属权利要求中引用的某些措施的 事实不意味着运些措施的组合不能被有利地使用。权利要求书中的任何参考标记不构成对 本发明的范围的限制。
【主权项】
1. 一种直流电机驱动的飞轮系统转速控制方法，其特征在于，包括以下步骤： 步骤S100:由目标转速和测量得到的实际转速计算目标转速和实际转速的误差量e，然 后计算滑动模态变量； 步骤S200:将滑动模态变量经低通滤波器调制后得到等效控制信号，以等效控制信号 为输入，以控制增益为输出，构建双层自适应算法并设定自适应参数，得到控制增益 步骤S300:建立直流电机驱动的飞轮系统转速模型，以步骤S200中的滑动模态变量为 输入，结合所得所述的控制增益，构建超螺旋控制算法，调整控制参数，得到电机的控制电 压； 所述步骤S200中所述双层自适应算法按以下步骤获得： 1) 计算等效控制信号 利用低通滤波器获得等效控制信号：式中，τ为滤波器时间常数，取值满足〇〈t<<1，s为步骤S200中所述的滑动模态变量，σ 为低通滤波信号，sgn(s)为符号函数，为步骤S200中所述的等效控制信号，iKt)和K(t)为 时变控制参数，按公式(5)~(6)计算： β(?) =L(t)Po (5) κ(?) = L2(t)K〇 (6) β〇和为控制参数； 2) 构建双层自适应算法 式(5)和(6)中的L(t)为步骤S200中所述的控制增益，按公式(7)计算： L(t) = l〇+l(t) (7) 式中，1〇为大于〇的常值自适应参数，l(t)为时变自适应参数，按公式(8)计算： /(/) = L{1) = -p(.〇sgn(d') (S) 式中，δ按公式(9)计算：其中，a>0为常值自适应参数，同时满足0〈afo〈 1，Μ卩是式(5)中的控制参数;ε>〇为非常 小的常值自适应参数； 式(8)中的P(t)按公式(10)计算： p(t) =r〇+r(t) (10) r〇>0为常值自适应参数;时变部分r(t)按公式（11)计算： r(t) = r\S(t)\ (11) γ >〇为常值自适应参数； 所述步骤S300中所述超螺旋控制算法通过以下步骤得到： 1)建立直流电机驱动的飞轮系统转速模型 根据所处理直流电机驱动的飞轮系统的结构推导出飞轮系统的转速微分方程为： τβ+ 7；Ω + Ω - Kji：! -ΚιΜ￡ - K2Mt (12) 式中，ua为输入到电机的控制电压，Μ。为折合到电动机轴上的总负载转矩，< 为折合到 电动机轴上的总负载转矩的一阶微分，0为转速的一阶微分，Α为转速的二阶微分，TjPT2 为电动机的机电时间常数按公式(13)计算：^:和心为电机传递系数按公式丨^彡~丨^八十算：在公式（13)至公式（17)中，Ra是电枢电路的电阻，La是电枢电路的电感，Jm是电机和负 载折合到电机轴上的转动惯量，fm是电机和负载折合到电机轴上的黏性摩擦系数，Cm是电机 转矩系数，是电机反电势系数； 2)设计构建超螺旋控制算法 根据步骤S200中的滑动模态变量s，得到如公式(18)所示的超螺旋控制算法：式中，If和 < 分别为机电时间常数1\和电机传递系数1^的标称值，时变控制参数i3(t)和 4t)的计算方法如公式(5)和(6)所述，a(t)和ri(t)按公式(19)~(20)计算：n(t)=L(t)n〇 (20) 常值控制参数α〇、β〇、no和KQ的取值要满足如公式(21)所示的约束条件： α〇>51/4,η〇>〇,β〇>1,其中，控制增益L(t)和根据步骤S200计算得到。2.根据权利要求1所述的直流电机驱动的飞轮系统转速控制方法，其特征在于，所述步 骤S100中所述目标转速与所述实际转速之间的误差量，按公式(1)计算： e= Ω c~ Ω (1) 其中，为目标转速，Ω为实际转速。3.根据权利要求1所述的直流电机驱动的飞轮系统转速控制方法，其特征在于，所述步 骤S200中所述的滑动模态变量按公式(2)计算：其中，参数k为大于零的常数。
【文档编号】H02P7/00GK106059413SQ201610370518
【公开日】2016年10月26日
【申请日】2016年5月30日
【发明人】杨雅君, 廖瑛, 文援兰, 季海雨, 龚轲杰
【申请人】中国人民解放军国防科学技术大学