APP下载

一种基于快速正切算法的捷联寻北解算方法*

2012-12-10周召发王振业郭晓松魏皖宁

弹箭与制导学报 2012年3期

周召发,王振业,郭晓松,魏皖宁

(1西北工业大学,西安 710072;2第二炮兵工程学院,西安 710025)

0 引言

正切法常用于轴角测量[1]、光栅测角[2]、同步机角度测量[3]等高精测角场合。由于正切函数的在区间内的严格单调性,故其计算可靠性较高,因此正切法也广泛应用于捷联寻北中。传统正切法有两种实现方式,一种是直接查表方式,这种方式应用于捷联寻北中;另一种采用八区间查表法来实现。不论采用哪种方式在建立表格时都需要占用较大的存储空间,且在查询时代码执行效率较低,因此较难以用普通的单片机来实现。基于此不足,文中提出了一种基于最小二乘原理的快速正切算法,下面将详细介绍算法的实现过程。

图1 理想状态下载体方位角的解算模型

1 捷联寻北原理

当陀螺仪工作于理想状态(静基座、无倾角、无误差)时,可以通过陀螺敏感轴上的输出与陀螺方位角之间的正切关系解算出陀螺的方位角,从而确定载体与真北方向的夹角。设地球坐标系(n系)xnynzn为东北天坐标系OENT,静基座下陀螺坐标系(g系)xgygzg和载体坐标系(b系)xbybzb重合,zg轴与OT轴平行也指向天顶。地球自转角速度ωie在n系中的投影为=[0 ωiecosφ ωiesinφ]T,其中φ为载体所在纬度。理想状态下载体无倾角,设载体的方位角为φ,ωie的北向分量ωiecosφ在g系中的投影如图1所示,此时ωx=ωNcosφ,ωy= ωNsinφ,其中 ωx、ωy为陀螺两敏感轴 x轴和y轴的轴向输出,可以通过传感器测量输出,如果不考虑漂移等误差影响,载体方位角 φ =

2 八区间正切查表法

由上面的分析可知,理想状态下,方位角φ与陀螺输出ωx、ωy成简单的正切关系,方位角φ的变化范围为极性将方位角φ定位在小于的区间内,实现八细分,如表1和图2所示。……

登录APP查看全文