饱和约束测量扩张状态滤波与无拖曳卫星位姿自抗扰控制

Extended State Filtering With Saturation-constrainted Observations and Active Disturbance Rejection Control of Position and Attitude for Drag-free Satellites

无拖曳卫星的本体姿态、卫星本体与测试质量间的相对位移及相对姿态的联合控制受到外部扰动、输入噪声、测量噪声及饱和约束、输入耦合以及状态耦合等因素的影响,控制器的设计面临挑战.本文采用基于扩张状态的卡尔曼滤波对系统状态和系统扰动进行实时估计,引入自抗扰控制策略进行了控制器设计.针对无拖曳控制子系统设计了测量饱和受限下的扩张状态估计算法,并进行了信息融合.在设计控制律时不仅考虑了对外部扰动的补偿,还将系统状态间的耦合关系看成内部扰动进行补偿,使得被控系统等价为“积分串联型系统”,在此基础上实现了无拖曳卫星的联合控制.数值仿真验证了方法的有效性和合理性.

The joint control of the drag-free satellite's attitude,the relative displacement and the relative attitude between the satellite body and the test mass is full of challenges because of the external disturbance,the input noise,the observation noise and the saturation constraint,the input coupling and the state coupling,etc.This paper introduces the extended state Kalman filter to estimate the system state and the system disturbance,and employs the active disturbance rejection control(ADRC)strategy to design the controller.For the drag-free control subsystem,the extended state estimation algorithm with saturationconstrainted observations is proposed,and then the multi-sensor information fusion algorithm is presented.Via compensating the external disturbance and regarding the coupling relationship among the system states as the internal disturbance to be also compensated,the control system is transformed to the“integral series system”and the joint control of the drag-free satellite is achieved.Numerical simulation is included to verify the effectiveness of the method.