魯 明,梁柱林,徐張凡

1.北京控制工程研究所，北京 100190 2.南京航空航天大學(xué)機械機構(gòu)力學(xué)及控制國家重點實驗室，南京 210016

0 引 言

控制力矩陀螺(control moment gyroscope，CMG)是航天器姿態(tài)控制的核心慣性執(zhí)行機構(gòu).CMG通過高速轉(zhuǎn)子高速恒速旋轉(zhuǎn)獲得角動量，通過框架電機調(diào)整轉(zhuǎn)子系統(tǒng)的角動量矢量方向輸出控制力矩，從而實現(xiàn)對航天器的姿態(tài)控制.可見，框架電機的伺服控制性能直接影響到控制力矩陀螺的力矩輸出性能.

CMG是星上主要的微振動源之一[1]，為避免微振動對星體敏感載荷的影響，CMG需要安裝在柔性隔振平臺上，抑制CMG的微振動干擾傳遞，保持星體的低擾振水平.而隔振平臺在抑制CMG微振動傳遞的同時，其自身在外部力矩激勵的作用下會發(fā)生形變，從而改變CMG系統(tǒng)角動量矢量方向，影響CMG輸出力矩的控制精度，進而影響航天器平臺的姿態(tài)控制精度和穩(wěn)定度.

文獻[2-4]較全面地分析了CMG的動力學(xué)不確定因素，文獻[5-9]從機械模型和電磁模型兩方面入手，建立了CMG的動力學(xué)模型，可以用來分析CMG的動力學(xué)行為并指導(dǎo)控制系統(tǒng)設(shè)計.但文獻[2-9]針對CMG框架控制系統(tǒng)的研究均為在剛性支撐基礎(chǔ)上的控制研究，并未考慮柔性支撐條件.文獻[10]研究了CMG集群隔振平臺的動力學(xué)及其對衛(wèi)星姿態(tài)控制的影響，給出在隔振條件下衛(wèi)星姿態(tài)控制系統(tǒng)的參數(shù)選擇方案.文獻[11]則研究了CMG加入單機隔振平臺后的動力學(xué)模型及其對衛(wèi)星姿態(tài)的影響.但文獻[10-11]的研究主要集中在CMG引入柔性支撐后對整星姿態(tài)控制的性能影響分析.文獻[12]分析了柔性支撐所引發(fā)的CMG角動量矢量的改變及其對CMG輸出力矩的影響，但其主要分析了柔性支撐條件下CMG整機的開環(huán)特性，未涉及柔性支撐對框架伺服系統(tǒng)閉環(huán)控制性能的影響分析和控制器設(shè)計.針對CMG自身動力學(xué)影響，尤其是柔性支撐對CMG自身控制性能影響的動力學(xué)分析及其控制策略，目前相關(guān)研究成果較少，亟需針對這一問題進行深入研究.

圖1 安裝在柔性隔振器的SGCMGFig.1 SGCMG installed on flexible vibration isolator

為抑制柔性隔振機構(gòu)引起的擾動對CMG框架控制性能的影響，本文以單框架控制力矩陀螺(single gimbal control moment gyroscope，SGCMG)為基礎(chǔ)，定義了4類坐標系，推導(dǎo)柔性支撐下SGCMG動力學(xué)模型及新增擾動力矩的模型，并設(shè)計了一種積分滑?？刂破鳎瑢崿F(xiàn)框架系統(tǒng)的高精度閉環(huán)穩(wěn)定控制.

1 坐標系建立

SGCMG安裝在具有4個柔性隔振器的底座平臺上，其動力學(xué)系統(tǒng)中涉及多部件的協(xié)同運動，需要建立以下坐標系對其運動進行描述：

圖2 坐標系的轉(zhuǎn)換Fig.2 Coordinate transmission

1)基座坐標系Obxbybzb：基座坐標系xb軸和yb軸垂直且皆位于4個隔振器的支撐面，其中yb軸正向為SGCMG框架軸正向方向，zb軸垂直于xbyb軸平面并滿足右手法則.

2)零位置坐標系Osxsyszs：零系與本體系固連，原點位于SGCMG質(zhì)心.忽略零系和基座坐標系的位置矢量，考慮柔性支撐的柔性，零位坐標系由基座坐標系沿X-Y-Z順序旋轉(zhuǎn)(α-β-γ)角度得到.

2 柔性支撐SGCMG動力學(xué)建模

假設(shè)基座與地面固連，考慮柔性支撐的柔性形變，基于拉格朗日方程建立柔性支撐條件下的SGCMG框架動力學(xué)模型.

在慣性系Obxbybzb上SGCMG系統(tǒng)的動能為

W=Wr+Wg+Ws=

(1)

式中，Ir=diag{Irx,Iry,Irz}、Ig=diag{Igx,Igy,Igz}和Is=diag{Isx,Isy,Isz}分別為高速轉(zhuǎn)子、框架和柔性支撐的慣性張量，Ir、Ig、Is的取值可由有限元計算或?qū)嶒灉y量得到.wr，wg，ws分別是慣性坐標系下高速轉(zhuǎn)子、框架和柔性支撐的轉(zhuǎn)速，Wr、Wg、Ws分別為高速轉(zhuǎn)子、框架和柔性支撐的動能.

系統(tǒng)勢能為隔振機構(gòu)柔性形變引起的彈性勢能，其表達式為

(2)

式中，q=[αβγ]T是由柔性支撐三軸形變組成的廣義矩陣變量，K=diag{kx,ky,kz}為柔性支撐的彈性剛度矩陣.

系統(tǒng)阻尼采用線性粘性阻尼模型，阻尼力與廣義速度成正比，此時瑞利耗散函數(shù)為

(3)

式中，C=diag{cx,cy,cz}為柔性支撐的阻尼矩陣.

基于能量法，采用拉格朗日方程建立動力學(xué)方程.綜合式(1)至式(3)，計算得拉格朗日函數(shù)為L=W-V,代入拉格朗日方程中得

(4)

式中，TQ=[TQxTQyTQz]T為作用在柔性支撐上的廣義力矩，

(5)

其中，Tm為柔性支撐SGCMG框架電機啟動力矩，

(6)

式中，Te為框架電機電磁力矩，Tf為框架摩擦力矩，摩擦力矩采用LuGre模型表征[15].kD為框架阻尼系數(shù).

Td為動不平衡力矩

(7)

式中，Ud為高速轉(zhuǎn)子動不平衡量，φr為高速轉(zhuǎn)子初始相位.

Tg為陀螺力矩，可由動量矩守恒定理計算得出.在高速轉(zhuǎn)子坐標系Orxryrzr上，高速轉(zhuǎn)子的轉(zhuǎn)動慣量為I=diag{Ix,Iy,Iz}，由于高速轉(zhuǎn)子的對稱結(jié)構(gòu)，轉(zhuǎn)子的赤道轉(zhuǎn)動慣量Ix=Iy，Iz為極轉(zhuǎn)動慣量.令高速轉(zhuǎn)子的動量矩為H，則有

(8)

綜合式(1)-(8)，計算可得

(9)

其中

(10)

根據(jù)式(9)可解出柔性支撐三軸角位移α、β、γ，進而獲得柔性支撐在框架軸引起的擾動力矩Tgy的解析模型如下：

(11)

3 柔性支撐影響分析

柔性支撐的三軸形變改變了SGCMG角動量矢量的方向，在低速框架軸方向產(chǎn)生干擾力矩分量Tgy，同時其自身柔性運動與框架系統(tǒng)產(chǎn)生動力學(xué)耦合，導(dǎo)致框架系統(tǒng)參數(shù)攝動，改變框架軸的動力學(xué)特性.

柔性支撐SGCMG框架系統(tǒng)PID控制仿真系統(tǒng)如圖3所示.其中，SGCMG框架采用永磁同步電機(PMSM)直接驅(qū)動，干擾力矩包括摩擦干擾、高速轉(zhuǎn)子動不平衡干擾和柔性支撐引起的干擾力矩，控制對象模型中考慮柔性支撐引入的耦合動力學(xué)，控制策略采用PID控制.分析PID控制策略下柔性支撐對控制系能的影響.系統(tǒng)模型參數(shù)如表1所示.

圖3 柔性支撐SGCMG框架系統(tǒng)PID控制框圖Fig.3 PID controller for SGCMG gimbal system with flexible support

表1 系統(tǒng)模型參數(shù)表Table 1 System model parameters

在PID控制策略下，柔性支撐在三軸方向上的形變?nèi)鐖D4.當在框架速度為1°/s時，X、Z軸形變最大幅值分別為0.001°和0.000 16°，Y軸的形變量最小.三軸形變的幅值不同是由于柔性支撐三軸的剛度不同引起.柔性支撐的三軸形變量隨著框架位置的變化而變化，周期與框架位置變化周期一致.

圖4 柔性支撐三軸形變角位移Fig.4 Threeaxis angular displacement of flexible support

引入柔性支撐后SGCMG框架軸新增干擾力矩曲線如圖5.框架轉(zhuǎn)速為1°/s時，柔性支撐引起的擾動力矩最大幅值為0.037 9 N·m，周期為180.0 s；框架轉(zhuǎn)速為2°/s時，擾動力矩最大幅值為0.152 N·m，周期為90.0s.可見，在柔性支撐下，框架轉(zhuǎn)動速度越大，擾動幅值越大.當SGCMG支撐為絕對剛性時，該擾動分量為零.

圖5 不同框架轉(zhuǎn)速時柔性支撐在框架軸的引起擾動力矩Fig.5 Disturbance torque of flexible support on gimbal axis under different gimbal speed

引入柔性支撐前后框架速度階躍響應(yīng)對比曲線如圖6.引入柔性支撐前，框架速度階躍響應(yīng)無超調(diào)，穩(wěn)定時間為0.41 s；引入柔性支撐后，若PID參數(shù)不變，階躍響應(yīng)性能變差，優(yōu)化參數(shù)后，超調(diào)量變?yōu)?.96%；穩(wěn)定時間為1.31 s，是引入柔性支撐前的穩(wěn)定時間的3倍.

圖6 引入柔性支撐前后PID控制框架速度階躍響應(yīng)Fig.6 Gimbal speed step response of PID control before and after introducing flexible support

可見，SGCMG框架系統(tǒng)引入柔性支撐后，框架系統(tǒng)的動力學(xué)特性發(fā)生變化，同時新增了干擾力矩，傳統(tǒng)的PID控制難以同時兼顧框架轉(zhuǎn)速的動態(tài)性能和穩(wěn)態(tài)性能，導(dǎo)致框架速度控制性能下降.

4 滑?？刂破髟O(shè)計與仿真分析

具有滑動模態(tài)的滑模控制策略對系統(tǒng)的參數(shù)攝動和力矩干擾具有較強的魯棒性，可以通過滑動模態(tài)的設(shè)計使系統(tǒng)軌跡快速進入滑模面，提升系統(tǒng)的動態(tài)性能，進入滑模面后通過變結(jié)構(gòu)切換控制保證系統(tǒng)的穩(wěn)態(tài)性能.因此，滑?？刂撇呗栽诩骖櫛ＷC動態(tài)性能魯棒性和穩(wěn)態(tài)性能魯棒性方面具有優(yōu)勢[14].

在柔性支撐SGCMG系統(tǒng)動力學(xué)模型的基礎(chǔ)上，設(shè)計一種積分滑?？刂破?sliding mode control，SMC)實現(xiàn)系統(tǒng)閉環(huán)穩(wěn)定控制.

綜合前文推導(dǎo)，可知伺服系統(tǒng)模型為

(12)

式中，J=Iy+Igy為框架電機轉(zhuǎn)動慣量，ΔJ、ΔkD為柔性支撐在框架軸引起的參數(shù)攝動.

取式(12)的標稱模型，可得

(13)

其中，Tn=Tf+Tdy+Tgy為框架軸集總干擾力矩.框架電機電磁力矩Te=kTi，kT為電機轉(zhuǎn)矩系數(shù)，i為電機力矩電流，其表達式由下式微分方程計算

(14)

式中，r、L分別為電機電阻和電感，ke為電機反電勢系數(shù).

綜合式(13)和(14)，可求

(15)

(ke+rkD/kT)ω+rTn/kT

(16)

kT(ke+rkD/kT)ω/LJ+rTn/LJ

(17)

(18)

進而可求

kT(ke+rkD/kT)ω/LJ+rTn/LJ

(19)

則可求得等效控制ueq為

(ke+rkD/kT)ω+rTn/kT

(20)

滑?？刂破鞑捎弥笖?shù)趨近律，則可求電機控制電壓為

u=ueq+ks+δsat(s)=

(ke+rkD/kT)ω+rTn/kT+ks+δsat(s)

(21)

式中，k>0,δ>0,Φ>0.sat(s)函數(shù)用于降低系統(tǒng)軌跡進入滑動模態(tài)后趨近律中的符號函數(shù)切換引起的高頻抖振.

滑模系統(tǒng)控制框圖如圖7所示，將PID控制器替換為滑?？刂破鳎渌抡鏃l件與第3節(jié)一致.在動力學(xué)特性變化和新增干擾力矩的影響下，對比滑?？刂撇呗栽谝肴嵝灾吻昂蟮目刂菩阅埽徊⒃谌嵝灾螚l件下，與PID控制策略的控制性能進行對比.

如圖8所示，在柔性支撐干擾力矩、摩擦干擾力矩、動不平衡干擾力矩的影響下，PID控制的階躍響應(yīng)上升時間為0.14 s，SMC的上升時間為0.07 s，相比PID提升了50.0%，可見，SMC具有較優(yōu)的動態(tài)性能.進入穩(wěn)態(tài)階段后，PID控制器對擾動力矩具有一定的抑制效果，框架轉(zhuǎn)速在0.995°/s到1.005°/s間波動，波動量為0.5%；SMC控制策略的穩(wěn)態(tài)波動在0.999 9°/s到1.001 1°/s間波動，最大波動量為0.1%，穩(wěn)態(tài)性能比PID控制提高了5倍.

圖7柔性支撐SGCMG框架伺服系統(tǒng)控制框圖Fig.7 SMC controller for SGCMG gimbal system with flexible support

圖8 柔性支撐SGCMG框架速度控制階躍響應(yīng)Fig.8 Step response of SGCMG gimbal system with flexible support

綜上，相對傳統(tǒng)的PID控制，本文設(shè)計的SMC控制策略具有良好的動態(tài)響應(yīng)性能和穩(wěn)態(tài)性能，能夠有效抑制柔性支撐擾動等干擾力矩的影響，提高SGCMG框架系統(tǒng)的控制精度.

5 結(jié) 論

本文首先通過拉格朗日方程建立柔性支撐條件下SGCMG的動力學(xué)模型，并給出柔性支撐引入干擾力矩的解析模型.然后，在PID控制策略下分析了動力學(xué)變化和新增干擾力矩對控制性能的影響.據(jù)此，設(shè)計了一種積分滑模控制器，相比傳統(tǒng)的PID控制具有更好的動態(tài)過程和穩(wěn)態(tài)性能，提升了柔性支撐下控制力矩陀螺框架速度的閉環(huán)控制性能.