[发明专利]具有参数注入功能的星敏感器模拟方法

权利要求书

1.具有参数注入功能的星敏感器模拟方法，其特征在于它是基于星敏感器模拟器实现的，所述星敏感器模拟器由DSP(1)、FPGA(2)、第一RS485收发器(3-1)、第二RS485收发器(3-2)、第一RS422收发器(4-1)和第二RS422收发器(4-2)组成，所述DSP(1)的数据输入/输出端与所述FPGA(2)的数据输入/输出端相连，所述第一RS485收发器(3-1)的串行通讯口与FPGA(2)的第一RS485串行通讯口相连，所述第二RS485收发器(3-2)的串行通讯口与FPGA(2)的第二RS485串行通讯口相连，第一RS422收发器(4-1)的串行通讯口与FPGA(2)的第一RS422串行通讯口相连，第二RS422收发器(4-2)的串行通讯口与FPGA(2)的第二RS422串行通讯口相连；

具有参数注入功能的星敏感器模拟方法具体如下：所述FPGA(2)内部固化有正常定位数据存储区(a)、故障数据存储区(b)、姿态四元数发送请求计数器(c)、应答信息发送请求计数器(d)和七个逻辑状态机，所述七个逻辑状态机分别为：正常姿态四元数接收状态机(2-1)、故障数据接收状态机(2-2)、模拟器工作状态管理状态机(2-3)、命令接收及应答信息发送请求状态机(2-4)、姿态四元数同步发送请求状态机(2-5)、姿态四元数自由发送请求状态机(2-6)和应答信息及姿态四元数发送状态机(2-7)，所述七个逻辑状态机工作时钟频率为57.6MHz，DSP(1)用于从FPGA(2)中读取正常姿态四元数和故障姿态四元数并进行四元数乘法，还用于将所述四元数乘法结果发送给FPGA(2)，正常定位数据存储区(a)用于存储正常定位数据，故障数据存储区(b)用于存储故障数据，第一RS485收发器(3-1)用于接收正常姿态四元数参数并发送给FPGA(2)，第二RS485收发器(3-2)用于接收故障姿态四元数参数、故障类型参数和故障持续时间参数并发送给FPGA(2)。

2.根据权利要求1所述的具有参数注入功能的星敏感器模拟方法，其特征在于正常姿态四元数接收状态机(2-1)包括三个状态：等待状态、接收正常姿态四元数状态和数据存储状态；

在等待状态，等待第一RS485收发器(3-1)发送数据，若检测到第一RS485收发器(3-1)发送数据，则所述正常姿态四元数接收状态机(2-1)将转换到接收正常姿态四元数状态；

在接收正常姿态四元数状态，接收第一RS485收发器(3-1)发送的数据，当数据接收完毕后，正常姿态四元数接收状态机(2-1)转换到数据存储状态；

在数据存储状态，将接收的数据存入正常定位数据存储区(a)；若数据存储完毕，正常姿态四元数接收状态机(2-1)将转换到等待状态。

3.根据权利要求1所述的具有参数注入功能的星敏感器模拟方法，其特征在于故障数据接收状态机(2-2)包括四个状态：等待状态、接收故障数据状态、数据存储状态和故障数据到达信号发送状态；

在等待状态，等待第二RS485收发器(3-2)发送数据，若检测到第二RS485收发器(3-2)发送数据，则故障数据接收状态机(2-2)将转换到接收故障数据状态；

在接收故障数据状态，接收第二RS485收发器(3-2)发送的数据，若数据接收完毕，故障数据接收状态机(2-2)将转换到数据存储状态，

在数据存储状态，将接收的数据存入故障数据存储区(b)，所述故障数据包括故障类型、故障持续时间和故障姿态四元数数据；若数据存储完毕，故障数据接收状态机(2-2)将转换到故障数据到达信号发送状态；

在故障数据到达信号发送状态，发送故障数据到达信号，若故障数据到达信号发送完毕，故障数据接收状态机(2-2)将转换到等待状态。

4.根据权利要求1所述的具有参数注入功能的星敏感器模拟方法，其特征在于模拟器工作状态管理状态机(2-3)包括两个状态：等待故障数据到达状态和读取故障数据状态；

在等待故障数据到达状态，检测故障数据到达信号，当检测到所述故障数据到达信号时，模拟器工作状态管理状态机(2-3)转换到读取故障数据状态；

在读取故障数据状态，从故障数据存储区(b)中读取故障类型数据和故障持续时间数据，并根据所述故障类型数据和故障持续时间设置模拟器工作状态管理状态机(2-3)的工作状态及状态持续时间；读取完数据后，模拟器工作状态管理状态机(2-3)转换到等待故障数据到达状态。