双检验质量无拖曳卫星鲁棒控制.pdf

双检验质量无拖曳卫星鲁棒控制范一迪，王鹏程，卢 苇，安 轲，张永合（中国科学院 微小卫星创新研究院，上海 201304）摘 要：针对地心轨道的双检验质量无拖曳双星编队系统的姿态与无拖曳控制问题，设计了用于惯性拖曳效应验证任务、重力场测量任务和引力波探测任务科学测量模式的控制方案，并提出了一种具有抗干扰能力的鲁棒控制器。结合科学任务需求和地心轨道特点设计了科学测量模式的配置方案，以实现科学探测任务目标；基于动力学耦合特性和控制时频特性要求对复杂系统动力学进行解耦，得到卫星姿态、无拖曳和静电悬浮3个控制回路，实现控制模型降维，并结合任务指标要求确定各控制回路的控制指标；基于控制指标的频域形式，采用H鲁棒控制理论的混合灵敏度方法，结合外部扰动和量测噪声的频谱模型，明确各控制回路的灵敏度函数和补灵敏度函数设计边界，选择合适的权函数设计H鲁棒控制器；数值仿真结果表明：所设计的鲁棒控制器保证了双星星间指向误差水平、检验质量位置姿态误差控制水平、检验质量敏感轴方向残余加速度水平均满足指标要求，验证了控制器的有效性。关键词：无拖曳控制；地心轨道；H鲁棒控制；混合灵敏度中图分类号：V448.22 文献标识码：A 文章编号：2096-9287（2023）03-0310-12DOI:10.15982/j.issn.2096-9287.2023.20230037引用格式：范一迪，王鹏程，卢苇，等.双检验质量无拖曳卫星鲁棒控制J.深空探测学报（中英文），2023，10（3）：310-321.Reference format:FAN Y D，WANG P C，LU W，et al.Robust controller design for drag-free satellites withtwo test massesJ.Journal of Deep Space Exploration，2023，10（3）：310-321.引言105 103m/s21010m/s2在轨卫星承受着引力场、热辐射、空间磁场、太阳风粒子、大气阻力、微陨石等复杂空间环境干扰的影响，加之卫星内部结构的振动、姿控扰动以及各分系统之间的耦合作用，常规卫星的残余加速度一般为量级1，而空间基础物理研究如引力理论验证、地球重力场测量、引力波探测等任务中往往要求测量频段内卫星的残余加速度小于甚至更低2-3，常规卫星无法满足平台稳定度的要求。无拖曳控制技术利用微推力器主动施加控制以抵消卫星受到的非保守力，从而实现具有高精度、高稳定度和高微重力水平的超静平台，在上述空间基础物理研究中发挥着举足轻重的作用。无拖曳控制的基本思想是：以位于卫星内部封闭真空腔内的检验质量为惯性参考基准，通过高精度传感器检测卫星与检验质量之间的相对位移并反馈给控制器，从而控制微推力器的输出以实现卫星跟踪检验质量4-5。依据控制原理，无拖曳控制可分为位移模式和加速度模式（如图1所示），位移模式中检验质量处于自由悬浮状态，依据卫星平台与检验质量之间的位移变化，利用微推力器控制卫星平台跟踪检验质量，实现检验质量无拖曳。由于位移模式中检验质量不受控制作用，最大程度减小了其受到的扰动，因此能够提供更高的控制精度，但有限的电极笼空间限制了检验质量的运动范围，使得无拖曳控制带宽相对较窄，且对扰动的抑制能力较弱。位移模式无拖曳控制通常被应用于要求更低噪声水平的引力波探测6-7、等效原理验证8、测地线效应和参考系拖曳效应验证9等基础物理实验任务中。加速度计模式中检验质量在静电控制作用下跟踪卫星平台运动，并通过微推力器施加控制力抵消卫星受到的非保守力。该模式中检验质量作为加速度计使用，静电力的作用使得该模式具有较大的控制带宽，但伴随的噪声和刚度给检验质量引入了附加的扰动，因此加速度计模式一般应用于非保守力较大、卫星姿态变化较大的情况，如重力场测量任务等10。凭借提供超低扰动的优越性能，无拖曳控制技术在理论研究和工程应用两方面得到了迅猛发展。重力实验卫星GP-B采用LQR方法设计了检验质量悬浮控制系统，并将经典PID控制器作为备份9。Prieto等11将低 收稿日期：2023-04-01 修回日期：2023-05-24基金项目：国家重点研发计划（2021YFC2202602）第 10 卷 第 3 期深 空 探 测 学 报（中英文）Vol.10 No.32023 年 6 月Journal of Deep Space ExplorationJune 2023轨重力测量卫星GOCE的姿态与无拖曳控制问题转化为多目标优化问题，利用LMI设计了H控制器。Canuto12-13针对GOCE卫星的姿态与无拖曳控制系统提出了嵌入式模型控制方法（Embedded Mode Control，EMC），在传统离散状态观测器的基础上引入外界环境状态量的预测反馈，将被控系统模型和外界扰动模型直接嵌入控制器中，进行全状态预测与反馈，实现了对扰动的超高精度抑制。Fichter等6,14基于H回路成形方法设计了LISA Pathfinder卫星的姿态和无拖曳控制器，考虑到该卫星运行于地日L1点，轨道和姿态运动缓慢，受到的环境扰动主要来自于太阳辐射，因此直接基于噪声源频域特性针对单自由度回路设计了控制器。此外，模型预测控制技术、有限时间Lyapunov稳定理论、自抗扰控制等方法也被应用于无拖曳控制研究15-17。与较为干净的日心轨道环境不同，地心轨道卫星面临着太阳方位相对于轨道面的周期性变化带来的光压摄动，稀薄大气造成的阻力影响以及地磁场干扰，给无拖曳控制带来了极大的挑战。而双检验质量无拖曳卫星复杂的系统模型和检验质量间明显的重力加速度差，进一步加剧了控制策略设计的困难。本文针对地心轨道的双检验质量无拖曳卫星，从工作模式和控制器设计两方面开展深入研究。首先，结合科学任务需求和地心轨道特点详细设计了科学测量模式的控制方案；其次，基于动力学耦合特性和控制时频特性要求对复杂系统动力学模型进行解耦，得到卫星姿态、无拖曳和静电悬浮3个控制回路，实现控制模型降维，并结合任务指标要求确定各控制回路的控制指标；然后，考虑到无拖曳控制的频域指标以及系统对于鲁棒稳定性和抗干扰能力的需求，采用H鲁棒控制理论的混合灵敏度方法，基于科学指标和扰动的频谱模型构建了灵敏度函数与补灵敏度函数的约束边界，并提出了一种具有抗干扰能力的无拖曳鲁棒控制器；最后，通过数值仿真验证了所设计的控制器的有效性。1 无拖曳控制方案设计XbYbxiyizitxityitzii=1,2本文针对双检验质量无拖曳双星编队系统，面向惯性拖曳效应验证任务、重力场测量任务和引力波探测任务，分别设计科学测量模式的无拖曳控制方案。图2给出了单个卫星的结构示意图，其中双望远镜双惯性参考传感器呈60夹角配置，望远镜1为主望远镜，两个立方体检验质量分别位于两个惯性参考传感器内，推力器簇在卫星本体、方向对称安装，每个推力器簇由4个呈“X”形安装的推力器构成。为了便于后文叙述，两个检验质量分别记为TM1和TM2，、（）分别表示两个检验质量的三轴平动和转动自由度。卫星结构望远镜1望远镜2YbXbZbXb 图 2 卫星结构示意图Fig.2 Structure diagram of spacecraft检验质量激光干涉位移信号无拖曳控制算法电容传感位移信号微推力器微推力器微推力器微推力器静电力闭环控制静电力闭GRS电子学微推力器微推力器微推力器微推力器推力指令信号推力指令信号检验质量GRS电子学无拖曳控制算法相对加速度信号微推力器微推力器微推力器微推力器微推力器微推力器微推力器微推力器推力指令信号推力指令信号（a）无拖曳控制的位移模式（b）加速度计模式环控制 图 1 无拖曳控制的位移模式与加速度计模式Fig.1 Drag-free control system with displacement mode andacceleration mode第 3 期范一迪，等：双检验质量无拖曳卫星鲁棒控制31131014ms2Hz1/2对于引力波探测任务，需要双星的检验质量在激光链路方向的残余加速度水平不高于，因此设计配置方案A1（单轴位移无拖曳控制）：两星的主望远镜保持激光对准（如图3所示），卫星姿态保持激光跟瞄，两星本体z轴保持同向平行，主望远镜的检验质量x轴方向采用位移模式无拖曳控制，y、z轴方向采用静电悬浮控制，另一检验质量采用静电悬浮控制，如图4所示，其中红色箭头表示无拖曳控制自由度，黑色箭头表示静电控制自由度。TM1TM2TM2望远镜1望远镜2望远镜2望远镜1TM1卫星B卫星A 图 3 科学模式下的两星构型Fig.3 Configuration of two spacecraft in science mode ZscXscYscscscscTM1TM2121212Z2Z1Y1Y2X2X1 图 4 A1方案中检验质量的控制方式Fig.4 Control scheme of two test masses in case A1 对于惯性拖曳效应验证任务，仅依赖单检验质量即可完成，所以设计配置方案A2（三轴位移无拖曳控制）：两星的主望远镜保持激光对准（如图3所示），卫星姿态保持激光跟瞄，两星本体z轴保持同向平行，每个卫星的主望远镜的检验质量采用正交三轴位移模式无拖曳控制，另一检验质量采用静电悬浮控制，如图5所示。该方案仅使用双星的一个检验质量，TM1与TM2互为备份，卫星三轴平动用于无拖曳，TM1受控制作用力较小，TM2较大。该方案一般应用于科学测量编队系统，如欧洲航天局（European Space Agency,ESA）和美国国家航空航天局（National Aeronauticsand Space Administration,NASA）联合提出的下一代卫星重力任务计划（NGGM）。ZscXscYscscscscTM1TM2121212Z2Z1Y1Y2X2X1 图 5 A2方案中检验质量的控制方式Fig.5 Control scheme of two test masses in case A2 对于重力场测量任务，星间连线方向检验质量残余加速度水平要求较低，可以考虑使用星间连线方向的单轴无拖曳控制（方案A1）或三轴加速度计模式部分补偿外部扰动，或考虑静电悬浮控制，即不进行无拖曳，仅读出各轴加速度，在数据后处理阶段扣除。因此设计方案A3和A4。A3方案（加速度计无拖曳控制）：两星的主望远镜保持激光对准，卫星姿态保持激光跟瞄，两星本体z轴保持同向平行，两个检验质量的控制方式与A2方案类似，区别是主望远镜的检验质量采用正交三轴加速度计模式无拖曳控制；A4方案（非无拖曳控制）：两星的主望远镜保持激光对准，卫星姿态保持激光跟瞄，两星本体z轴保持同向平行，双检验质量均采用静电悬浮控制。2 控制模型与指标分解 2.1 控制模型对于第1节所设计的A1A4子模式，当A2可实现时，其余子模式均可实现，而对于A2模式，虽然各模式中无拖曳控制自由度与卫星姿态不同，但各自由度所受的外扰量级相同，因此在控制器设计过程中针对各自由度统一考虑。本文以A2子模式为例进行控制器设计与仿真。图6给出了卫星平台与检验质量之间的力学关系图，基于刚体动力学理论可以建立双质量块无拖曳卫星的动力学模型18M x=Mx+Bu+Fd(1)x=rB,B,r1,1,r2,2Trii（i=B,1,2）i=Bi=1,2u=fFEEP,IFEEP,f1a,I1a,f2a,I2aTfiIi(i=其中：状态量，其中 和，分别表示卫星平台（）和检验质量（）的三轴平动位移和三轴转动角度；控制输入，其 中和，312深空探测学报（中英文）2023年FEEP,1a,2a)分别表示微推力器和惯性传感器的输出控制力和力矩；d为扰动，包括环境扰动和执行机构噪声；矩阵F表示扰动对状态量影响；M表示系统惯性矩阵；表示检验质量的加速度和位移之间的耦合刚度矩阵；B为控制输入的系数矩阵，形式如式（2）、（3）所示=06606606606610660660662(2)B=E6606120126hIS(3)hIS其中，表示不同自由度之间静电驱动作用的串扰。A2子模式中，卫星平台的平动运动不受控，假设卫星姿态变化和检验质量相对卫星平台的姿态运动均为小量。方程（1）两边均除以惯性矩阵M可以得到 x=x+M1Bu+M1Fd(4)M1B33BSC123BDFBSUS由于静电驱动执行力远小于微推力器的输出，因此在控制器设计过程中忽略静电力对平台姿态的影响，则提取矩阵中表示微推力器输出力矩对平台姿态影响的元素组成矩阵，提取表示微推力器输出力对检验质量状态影响的元素组成矩阵，提取表示静电驱动对检验质量状态影响的元素组成12 12矩阵，则方程（4）可以改写为xSCxTM=033031201231212xSCxTM+033BSC0312BDF0123BSUSfFEEPIFEEPfIa+M1Fd(5)xSCxTMfIa其中：表示卫星姿态；表示检验质量状态量；表示静电驱动作用（力/力矩）。xTM针对检验质量状态量的控制方式将拆分为无拖xDFxSUSSDFSSUS曳控制自由度和静电悬浮控制自由度，并引入无拖曳控制回路与静电悬浮控制回路的选择矩阵和SDF=E3039(6)SSUS=093E9(7)则根据动力学方程（5）可以得到系统的控制方程 xSC=BSCuSC xDFDFxDF=(SDFBDF)uDF xSUSSUSxSUS=(SSUSBSUS)uSUS(8)uSCIFEEPuDFfFEEPuSUSDFSUS其中：对应微推力器执行力矩；对应微推力器执行力；则对应惯性传感器执行力/力矩；和分别为无拖曳和静电悬浮控制自由度对应的刚度矩阵。上述3个方程分别对应卫星姿态控制回路、无拖曳控制回路和静电悬浮控制回路。采用输入解耦方法对3个回路的各通道进行解耦，设控制输入分别为uSC=B1SCSC(9)uDF=(SDFBDF)1DF(10)uSUS=(SSUSBSUS)1SUS(11)SCDFSUSB1SC(SDFBDF)1(SSUSBSUS)1其中：、和别为3个回路的虚拟控制信号；、和分别为对应回路的控制解耦矩阵，虚拟控制信号通过解耦矩阵得到真实的控制信号。将式（9）、（10）和（11）代入控制方程（8）可得 xSC=SC xDFDFxDF=DF xSUSSUSxSUS=SUS(12)通过拉氏变换得到3个控制回路的单通道被控对象传递函数分别为GSC=1s2GDF=1s22p,DFGSUS=1s22p,SUS(13)2p,DF2p,SUSDFSUS其中，和分别为刚度矩阵和的主对角线值。KSCKDFKSUS由此可以得到3个回路的闭环控制系统结构如图7所示，、和分别表示3个回路的控制器。扰动扰动微推驱动微推驱动静电驱动TMSC 图 6 力学关系耦合图Fig.6 Mechanical diagram第 3 期范一迪，等：双检验质量无拖曳卫星鲁棒控制313无拖曳控制器无拖曳模型1s2姿态模型姿态控制器KSCKDFSCDFuSCuDFSUSuSUSBSC1BSCSDFBDFSSUSBSUS(SDFBDF)1KDF(SSUSBSUS)11s22p,DF1s22p,SUS静电悬浮控制器静电悬浮模型KSUS 图 7 卫星姿态、无拖曳和静电悬浮控制回路结构图Fig.7 Structure diagram for control loops of spacecraft attitude,drag-freeand suspension 2.2 控制指标分解31012ms2Hz1/2无拖曳控制系统的主要功能是根据敏感器、执行机构以及外部扰动环境的特性，设计合适的无拖曳控制方案及控制算法，一方面实现双星之间高精度指向控制及星间激光链路保持，同时降低外界扰动对检验质量敏感轴方向残余加速度的影响，满足检验质量敏感轴方向残余加速度不大于的水平；另一方面，系统能够根据科学目标的需求，实现不同模式多自由度控制。由于每个检验质量敏感轴方向的扰动加速度同时受到其它5个自由度的加速度耦合影响，因此，有必要对系统各控制自由度的扰动水平进行抑制。1 mHz 0.1 Hz依据科学探测指标、轨道特点和编队构型，将总残余加速度指标分解到各控制自由度，得到编队测量条件下频段内各控制自由度的控制指标，如表13所示。表 1 卫星姿态控制指标Table 1 Control specifications for satellite attitude物理量值指向角位置误差100 nradHz1/2指向角速度误差100 nrads1Hz1/2残余角加速度10 nrads2Hz1/2 3 控制器设计针对控制模型（12），本节基于H鲁棒控制理论的混合灵敏度方法分别对3自由度姿态控制、3自由度无拖曳控制与9自由度静电悬浮控制进行控制器设计。G(s)K(s)r(s)u(s)d(s)(s)针对每一回路，控制器设计归结为扰动抑制与量测噪声压制问题。各回路闭环系统可描述为如图8所示结构。其中为被控对象物理模型，为连续型控制器，、和分别表示被跟踪加速度信号、控制器输出、扰动和量测噪声。y(s)u(s)根据图8可以推导得到输出和控制器输出表 2 单检验质量正交三轴位移模式无拖曳控制指标Table 2 Drag-free control specifications for orthogonal three-axis displacement mode of a single test mass控制自由度位移控制误差等效残余加速度x19109m/Hz1/23.61014m/s2/Hz1/2y190109m/Hz1/2181014m/s2/Hz1/2z190109m/Hz1/2181014m/s2/Hz1/2tx1500109rad/Hz1/22109rad/s2/Hz1/2ty1300109rad/Hz1/21109rad/s2/Hz1/2tz1300109rad/Hz1/21109rad/s2/Hz1/2x290109m/Hz1/251010m/s2/Hz1/2y290109m/Hz1/251010m/s2/Hz1/2z290109m/Hz1/251010m/s2/Hz1/2tx2500109rad/Hz1/22109rad/s2/Hz1/2ty2300109rad/Hz1/21109rad/s2/Hz1/2tz2300109rad/Hz1/21109rad/s2/Hz1/2表 3 双检验质量非正交三轴位移模式无拖曳控制指标Table 3 Drag-free control specifications for orthogonal three-axis displacement mode of a single test mass控制自由度位移控制误差等效残余加速度x19109m/Hz1/23.61014m/s2/Hz1/2y190109m/Hz1/251010m/s2/Hz1/2z190109m/Hz1/2181014m/s2/Hz1/2tx1500109rad/Hz1/22109rad/s2/Hz1/2ty1300109rad/Hz1/21109rad/s2/Hz1/2tz1300109rad/Hz1/21109rad/s2/Hz1/2x29109m/Hz1/23.61014m/s2/Hz1/2y290109m/Hz1/251010m/s2/Hz1/2z290109m/Hz1/251010m/s2/Hz1/2tx2500109rad/Hz1/22109rad/s2/Hz1/2ty2300109rad/Hz1/21109rad/s2/Hz1/2tz2300109rad/Hz1/21109rad/s2/Hz1/2被控模型G扰动d+控制器K量测噪声输出y控制输出u参考信号r误差e 图 8 单回路闭环系统Fig.8 Illustration of a single closed-loop system314深空探测学报（中英文）2023年r(s)d(s)(s)与参考信号、扰动、量测噪声之间的关系为y(s)=G(s)1+K(s)G(s)(d(s)+r(s)K(s)G(s)1+K(s)G(s)(s)(14)u(s)=K(s)G(s)1+K(s)G(s)(d(s)+r(s)+(s)G(s)(15)S(s)T(s)定义灵敏度函数与补偿灵敏度函数分别为S(s)=11+K(s)G(s)(16)T(s)=K(s)G(s)1+K(s)G(s)(17)S(s)d(s)y(s)S(s)e(s)r(s)S(s)T(s)y(s)r(s)T(s)S(s)T(s)显然，灵敏度函数是扰动与输出之间的传递函数，表征了系统对于干扰的抑制能力，同时也是误差与参考输入之间的传递函数矩阵，决定了系统的跟踪能力，因此以作为闭环系统对干扰抑制能力的度量；补灵敏度函数是系统输出与参考信号之间的传递函数，表征了系统受到因模型不确定性产生的复合干扰的影响，因此是对乘性摄动鲁棒性的一种测度。根据控制指标和噪声模型可以根据式（18）及式（19）得到与的约束|SBound|?yreqGWd?(18)|TBound|?yreqW?(19)yreqWdW其中：为控制回路输出的指标要求；和分别表示扰动和量测噪声的频域模型。Ws(s)WT(s)K(s)H混合灵敏度方法引入加权函数和，寻找合适的控制器使得系统闭环稳定且满足?Ws(s)S(s)WT(s)T(s)?1(20)3.1 无拖曳控制回路y(s)考虑到各回路的指标要求，首先设计最重要的无拖曳控制器，然后设计具有足够抗扰能力的静电悬浮回路控制器，最后设计要求较低的平台姿态控制器。A2子模式中，检验质量1的三轴平动采用位移无拖曳控制，此时，无拖曳控制对扰动的压制能力由位移误差与静电刚度之积决定，因此该回路的控制目标是尽可能降低相对位移误差水平。d(s)无拖曳控制回路的控制模型中，外扰主要为空间环境扰动，主导量为大气阻力、太阳光压、重力梯0.1106NHz1/2(s)x13109mHz1/2y1z130109mHz1/2度波动、卫星姿态加速度引起的电极笼平动扰动与微推力器噪声，其中空间扰动功率谱密度特性如图911所示，而微推力器噪声水平高频段不高于，频率特性如图12所示。量测噪声为电容传感噪声，其中检验质量方向的噪声功率谱密度不高于，、方向不高于，均视为白噪声。102103104106108104102100100101大气阻力扰动/（ms2/Hz）频率/Hz 图 9 大气阻力扰动频域特性Fig.9 Noise model of aerodynamic drag 太阳光压力噪声/（ms2/Hz）频率/Hz102103104106105109108107100101 图 10 太阳光压噪声频域特性Fig.10 Noise model of solar pressure 剩磁力矩扰动/（s2/Hz）1021031041061081010104102100101频率/Hz 图 11 剩磁力矩扰动频域特性Fig.11 Noise model of residual magnetic第 3 期范一迪，等：双检验质量无拖曳卫星鲁棒控制315微推力器推力噪声/（ms2/Hz）102103104105106105106108107104103100101频率/Hz 图 12 微推力器噪声频域特性Fig.12 Noise model of FEEP d(s)r(s)S(s)60 dB/dec首先，考虑对全频段扰动的压制能力，则尽可能提高控制带宽。由于干扰与跟踪信号集中于中低频，因此设计灵敏度函数具有高通特性，在中频段有较大上升斜率，不低于。(s)y(s)T(s)60 dB/dec其次，为了减小量测噪声对输出误差的影响，尽可能降低控制带宽。同时为了避免推力器指令超过推力范围，则在高频段设计补灵敏度函数急速降低，斜率不高于。然后，考虑每个控制回路的稳定裕度与鲁棒性要求，设计全频段内约束为|S(j)|9.6 dB(21)|T(j)|9.6 dB(22)因此，设计加权函数WS(s)=0.333 3(s+0.433 6)4(s+0.004 3)4(23)WT(s)=3.333 3105(s+3.769 9)3(s+376.99)3(24)SDesign(s)TDesign(s)x1x1y1z1最终的设计结果与如图13所示。由于方向为科学测量敏感轴方向，控制指标要求更高，同时也是大气阻力的主要扰动方向，对于推力范围要求更为苛刻，因此方向和、方向分别设计。3.2 静电悬浮控制回路A2模式中，检验质量2的平动和两个检验质量的转动自由度均采用静电悬浮控制，此时检验质量在静电控制力/力矩作用下实现对卫星姿态的跟踪。静电悬浮控制的目的在于保证姿态高精度跟踪同时降低静电控制力矩。在无拖曳控制与卫星平台精确指向控制的作用下，平台的残余加速度和角加速度较小，因此静电悬d(s)200109radHz1/2100109radHz1/2100109radHz1/2r(s)浮控制回路的外扰可忽略，三轴的静电驱动力矩噪声功率谱密度分别为、，均视为白噪声。被跟踪信号为卫星姿态加速度扰动。而在高精度跟瞄控制时，该扰动在卫星残余角加速度指标之下。此时，对该信号低频部分的跟踪保证了检验质量姿态的高精度跟随，而对高频部分的压制隔离则进一步降低静电控制力矩。因此，在该回路的控制器设计过程中，一方面尽可能降低控制带宽，使其靠近轨道2倍频处；另一方面，考虑到静电刚度为负值，被控系统不稳定，因此设计控制带宽高于2倍系统特征频率，以保证系统的稳定性。基于以上考虑进行控制器设计，与无拖曳控制回路的设计过程类似，选取加权函数WS(s)=0.333 3(s+0.251 3)2(s+0.003 8)2(25)WT(s)=3.333 3103(s+0.565 5)2(s+56.548 7)2(26)（a）x1方向幅值/dBSBoundTBoundSDesignTDesignSBoundTBoundSDesignTDesign（b）y1、z1方向频率/Hz10210310410510121010108106104102100102幅值/dB10121010108106104102100102100101101频率/Hz102103104105100101101 图 13 无拖曳控制回路设计结果Fig.13 Design result for drag-free control loop316深空探测学报（中英文）2023年SDesign(s)TDesign(s)最终得到的与设计结果如图14所示。（a）tx1方向（b）ty1方向（c）tz1方向幅值/dB频率/Hz102102103103104104105100100101101101频率/Hz102103104105100101101频率/Hz102103104105100101101101幅值/dB102103104100101101幅值/dB102103104105106100101101SBoundTBoundSDesignTDesignSBoundTBoundSDesignTDesignSBoundTBoundSDesignTDesign 图 14 静电悬浮控制回路设计结果Fig.14 Design result of the suspension control loop 3.3 卫星姿态控制回路依据系统动力学模型中各自由度间的耦合关系可知，卫星无拖曳控制平动加速度与静电悬浮反作用力对卫星姿态影响极小，可近似忽略。因此首先针对进行激光精确指向的卫星3自由度姿态控制回路设计控制器。100 nradHz1/2100 nrads1Hz1/210 nrads2Hz1/20.1 Hz100 nradHz1/20.1 Hz25 nradHz1/2由于科学任务对于2自由度指向控制精度、稳定度和姿态加速度残差有极高要求，即指向误差不高于、指向残余角速度不高于、残余角加速度不高于，将指向残余角速度与角加速度残差折合到角度误差后，得到指向精度要求约为以下时不高于，在以上不高于。r(s)d(s)(s)10 nradHz1/2卫星姿态控制回路中，被跟踪加速度信号为编队坐标系转动加速度，扰动包括环境扰动和执行器噪声，分别为卫星剩磁力矩扰动、由于形心与质心不一致引起的气阻与光压力矩、以及微推力器噪声，频域特性分别如图912所示。量测噪声为差分波前测角噪声，为功率谱密度不高于的白噪声。与无拖曳控制器设计过程类似，选择加权函数WS(s)=0.5(s+0.081 7)4(s+1.225104)4(27)WT(s)=9.876 5106(s+0.942 6)4(s+62.842 0)4(28)SDesign(s)TDesign(s)得到最终的设计结果和如图15所示。幅值/dB频率/Hz10210310410510121010108106104102100102100101101SBoundTBoundSDesignTDesign 图 15 卫星姿态控制回路设计结果Fig.15 Design result of spacecraft attitude control loop 4 仿真验证本文基于simulink仿真平台构建双星系统，以A2模式为例验证对所设计的H无拖曳控制器进行闭环全系统数值仿真验证。仿真参数见表4，扰动与噪声基于图912由单位白噪声通过低通滤波器进行建模。仿真结果如图16 23所示。第 3 期范一迪，等：双检验质量无拖曳卫星鲁棒控制317表 4 仿真参数Table 4 Simulation parameters部件参数值卫星平台质量700 kg转动惯量Ib=450450450kgm2检验质量质量1.96 kg转动惯量Itm=6.9136.9136.913104kgm2相对平台质心位置rbtm1=0.346 4,0.2,0 mrbtm2=0.346 4,0.2,0 m/仿真时间12 000 s/进入科学模式时刻4 000 s（a）卫星A姿态4 000 5 000 6 000 7 000 8 000 9 000 10 000 11 000 12 000时间/s4 000 5 000 6 000 7 000 8 000 9 000 10 000 11 000 12 000时间/s2101221012 A星指向误差/108 radyzyz（b）卫星B姿态B星指向误差/108 rad 图 16 双星y、z方向姿态控制误差时间曲线Fig.16 Time histories of axis y and z control errors of twospacecraft attitudes（a）A星的TM1位姿（b）B星的TM1位姿505位置误差/108 mx1y1z1x1y1z13210123姿态误差/107 mtx1ty1tz1tx1ty1tz1505位置误差/108 m202姿态误差/107 m4 000 5 000 6 000 7 000 8 000 9 000 10 000 11 000 12 000时间/s4 000 5 000 6 000 7 000 8 000 9 000 10 000 11 000 12 000时间/s4 000 5 000 6 000 7 000 8 000 9 000 10 000 11 000 12 000时间/s4 000 5 000 6 000 7 000 8 000 9 000 10 000 11 000 12 000时间/s（a）A星的TM1位姿（b）B星的TM1位姿505位置误差/108 mx1y1z1x1y1z13210123姿态误差/107 mtx1ty1tz1tx1ty1tz1505位置误差/108 m202姿态误差/107 m4 000 5 000 6 000 7 000 8 000 9 000 10 000 11 000 12 000时间/s4 000 5 000 6 000 7 000 8 000 9 000 10 000 11 000 12 000时间/s4 000 5 000 6 000 7 000 8 000 9 000 10 000 11 000 12 000时间/s4 000 5 000 6 000 7 000 8 000 9 000 10 000 11 000 12 000时间/s 图 17 双星双检验质量的位姿控制误差时间曲线Fig.17 Time histories of pose control errors of TM1 intwo spacecraft（a）卫星A的TM1（b）卫星B的TM11021031041010101510101015100101SC A ax1 m/s2 HzSC B ax1 m/s2 Hz频率/Hz102103104100101频率/Hz 图 18 双星双检验质量x方向残余加速度的功率谱密度Fig.18 PSD of the residual acceleration of TM1s axis x intwo spacecraft（a）A星y、z方向姿态控制误差（b）B星y、z方向姿态控制误差tz1 rad/Hzty1 rad/Hztz1 rad/Hzty1 rad/Hz102103104101100101频率/Hz102103104101100101频率/Hz102103104101100101频率/Hz1021031041010108106101010810610101081061010108106101100101频率/Hz318深空探测学报（中英文）2023年（a）A星y、z方向姿态控制误差（b）B星y、z方向姿态控制误差tz1 rad/Hzty1 rad/Hztz1 rad/Hzty1 rad/Hz102103104101100101频率/Hz102103104101100101频率/Hz102103104101100101频率/Hz1021031041010108106101010810610101081061010108106101100101频率/Hz 图 19 两星y、z方向姿态控制误差功率谱密度Fig.19 PSD of axis y and z control errors of twospacecraft attitudes（a）x方向位移（b）x方向姿态（c）y方向位移（d）y方向姿态（e）z方向位移（f）z方向姿态102104100频率/Hz102104101010510101051010105100频率/Hz102104100频率/Hz102104100频率/Hz102104100频率/Hz102104100频率/Hz101010810610101081061010108106tx1 rad/Hzty1 rad/Hztz1 rad/Hzx1 rad/Hzy1 rad/Hzz1 rad/Hz 图 20 A星的检验质量1的位姿控制误差功率谱密度Fig.20 PSD of pose control errors of TM1 in spacecraft A（a）x方向位移102104100频率/Hz102104100频率/Hz102104100频率/Hz（c）y方向位移（e）z方向位移（b）x方向姿态（d）y方向姿态（f）z方向姿态102104100频率/Hz102104100频率/Hz102104100频率/Hz101010510101051010105101010810610101081061010108106tx1 rad/Hzty1 rad/Hztz1 rad/Hzx1 rad/Hzy1 rad/Hzz1 rad/Hz（a）x方向位移102104100频率/Hz102104100频率/Hz102104100频率/Hz（c）y方向位移（e）z方向位移（b）x方向姿态（d）y方向姿态（f）z方向姿态102104100频率/Hz102104100频率/Hz102104100频率/Hz101010510101051010105101010810610101081061010108106tx1 rad/Hzty1 rad/Hztz1 rad/Hzx1 rad/Hzy1 rad/Hzz1 rad/Hz 图