[发明专利]一种位置未知条件下的星敏感器/加速度计粗对准方法

权利要求书

1.一种位置未知条件下的星敏感器/加速度计粗对准方法，其特征在于，包括以下几个步骤：

步骤一：采集安装于载体表面的加速度计的输出在载体坐标系投影f^b，采集星敏感器输出的载体坐标系b到惯性坐标系i的姿态转换矩阵其中，f表示加速度计测量输出，b表示载体坐标系；

步骤二：根据星敏感器输出的姿态转换矩阵将加速度计的输出在载体坐标系投影f^b转换为在惯性坐标系投影

步骤三：根据加速度计的输出在惯性坐标系投影fⁱ的信息特性，设计Butterworth低通滤波器，将加速度计的输出在惯性坐标系投影fⁱ通过Butterworth低通滤波器，得到滤波后的信息δfⁱ＝gⁱ，gⁱ为惯性坐标系下重力加速度；

步骤四：根据滤波后的信息δfⁱ，得到惯性坐标系旋转至导航坐标系的旋转角度α和β，确定惯性坐标系到导航坐标系的姿态转换矩阵

步骤五：根据惯性坐标系到导航坐标系的姿态转换矩阵和星敏感器输出的载体坐标系b到惯性坐标系i的姿态转换矩阵确定载体坐标系到导航坐标系的转换矩阵

步骤六：根据载体坐标系到导航坐标系的转换矩阵得到载体姿态角的粗略估计，完成粗对准过程；

所述的加速度计的输出在载体坐标系投影f^b为：

f^b＝g^b+a^b+Δ^b

其中，g表示重力加速度，a表示载体系泊状态下由升沉、振荡引起的载体周期振荡加速度，Δ表示加速度计零位偏置；

所述的加速度计在惯性坐标系投影惯性坐标系下重力加速度gⁱ的信息特性为常量，惯性坐标系下加速度aⁱ为周期振荡形式，惯性坐标系下零位偏置Δⁱ为周期振荡形式；

所述的Butterworth低通滤波器为：

其中，滤波器的截止频率为aHz，采样频率为b₁Hz，z为z变换的变量；e为数学自然常数，e≈2.71828；

所述的惯性坐标系旋转到导航坐标系的旋转角度α和β为：

其中，分别表示滤波后的信息δfⁱ在惯性坐标系系x、y和z轴的投影；

惯性坐标系到导航坐标系的姿态转换矩阵为：

所述的载体姿态角的粗略估计为：

其中，φ_x、φ_y、φ_z分别表示载体纵摇角、横摇角和航向角的估算结果，c_ij i,j＝1,2,3表示矩阵第i行、第j列矩阵元素。