SimuLink仿真星敏感器像平面误差下的卫星姿态控制.pdfVIP

SimuLink 仿真星敏感器像平面误差下 的卫星姿态控制 孙亚辉，易涛 哈尔滨工业大学卫星技术研究所 syhhit@ 2014 年4 月14 日 目录 SimuLink 仿真星敏感器像平面误差下的卫星姿态控制 1 1. 姿态控制模块的组成 1 2. 动力学模块的建立2 3. 运动学模块的建立6 4. 角速度陀螺模块的建立 10 5. 星敏感器模块的建立 11 6. 控制目标模块的建立 17 7. 控制模块的建立 19 8. 执行机构模块的建立 20 9. 观测器Scope 的添加 20 10. M 文件的代码 22 1. 姿态控制模块的组成 卫星姿态控制的SimuLink 模块如下图所示。 其中： Dynamics 模块是动力学模块，它的输入是控制力矩T ，输出是卫星的本体坐标系相对 1 惯性系的角速度在本体坐标系下的值Wbi。 Kinematics 模块是运动学模块，它引入Wbi 然后输出体坐标系下的姿态四元数Qbo 和 卫星本体在体坐标系下的角速度Wbo。 StarSensor 模块是星敏感器模块，它引入姿态四元数Qbo，加入星敏感器噪声后输出 测量姿态四元数Qbo_m 。 Gyro 模块是陀螺模块，它引入Wbo，然后加入陀螺噪声得到测量的角速度Wbo_m 。 Target 模块是控制 标模块，它输入测量四元数Qbo_m，输出姿态误差四元数的矢部 qe 。 q Controller 模块是控制模块，它输入姿态误差四元数的矢部 和姿态角速度的测量值 e Wbo_m，输出控制信号T_Signal 。控制率为PD 控制率：T (K q K w) p e d Actuator 模块是执行机构模块，它输入控制信号，输出控制力矩T ，然后将T 引入动力 学模块。 卫星姿态控制的SimuLink 模块即建立完成。 2. 动力学模块的建立 卫星动力学方程如下： 模型中T 为体坐标系下的力矩，H 为体坐标系下的角动量，w 为体坐标系相对于惯性坐标系的角速度在在体坐标系下的量wb ） bi 动力学模块如下图所示： 2 先引入控制力矩T 。再添加add 模块。得到dH，引入Integrator 模块得到H。 Integrator 模块的初值是积分的初值，即为初始角动量在体坐标系下的值HB0 （由体坐标系 相对于惯性坐标系的初始角速度在在体坐标系下的量决定，在m 文件中给出。） 利用Gain 模块乘以转动惯量矩阵I 的逆invIB 来得到w 。修改gain 模式为 Matrix(u*K)。I 的逆最好在m 文件中计算出来 SimuLink 从Workspace 中调用），这样减少 计算量。 将H 与w 引入CrossProduct 模块 叉乘模块）。 右键Subsystem 模块- “Create Mask ”来修改模块的外貌。 为模块起