主权项: |
一种估计飞行器(1)的姿态角(θ、)的方法,其中:通过对来自惯性测量单元(6)的具有捷联分量的测量值进行算法积分(3)而产生相对于导航轴线(N、E、D)表述的所述姿态角(θ、)的估计值、航向角(ψ)的估计值以及线速度矢量的估计值,所述测量值指代所述飞行器(1)的角速度和线加速度所述算法积分还具有用于对所述惯性测量值进行校正的输入(21、22、23),所述输入相对于所述导航轴线(N、E、D)由两个水平分量和一个垂直分量所表述并用于校正:角加速度角速度以及线加速度通过从所述飞行器(1)的来自线速度传感器(8)并且相对于所述导航轴线(N、E、D)表述的线速度测量值中减去由所述算法积分(3)所产生的所述估计线速度形成类似地相对于所述导航轴线(N、E、D)表述的线速度差;从测得的绕垂直导航轴线的角速度进行估计(15)而形成所述飞行器(1)的转速的估计值,其中所述估计(15)使用作为所述姿态角(θ、φ)函数的投影算子;所述角加速度角速度以及线加速度的校正量的两个水平分量中的每个水平分量是所述速度差的如下两个水平分量的线性组合:平行于所述校正量的分量和与所述校正量不共线的另一水平分量;藉此在所述水平轴线之间获得交叉系数;以及所述线性组合的每个系数是时间的连续函数,并且取决于所述估计转速;从而包括所述飞行器转动时,估计的姿态角是稳定的。FSA00000433637300011.tif,FSA00000433637300012.tif,FSA00000433637300013.tif,FSA00000433637300014.tif,FSA00000433637300015.tif,FSA00000433637300016.tif,FSA00000433637300017.tif,FSA00000433637300018.tif,FSA00000433637300019.tif,FSA000004336373000110.tif,FSA000004336373000111.tif,FSA000004336373000112.tif |