专利名称：基于星敏感器的天文自主导航方法
技术领域：
本发明涉及天文导航技术，具体说就是一种基于星敏感器的天文自主导航方法。 背景技术：
上世纪六十年代末七十年代初，惯性技术开始应用于各种测绘工作。美国研制出 了惯性定位定向系统，简称PADS系统。装有惯性定位定向系统的运载汽车在地面行使了一 段曲折路程之后，由系统确定的水平位置精度为20米，高度均方根误差为10米。这一技术 成果对惯性技术的应用来说显然具有重大意义。惯性定位定向系统研制成功后，美国陆军先后又研制了惯性定位系统(Inertial Position System, IPS系统)。惯性定位系统研制的目的是在惯性定位定向系统的基础上 进一步提高定位精度。惯性定位系统确定方位是在陀螺罗盘指北的基础上由光电经纬仪实 现的，该系统与外界不发生任何光、电联系。因此隐蔽性好，工作不受环境条件的限制。它 可以提供初始对准所需要的方位基准。然而，用这种方法确定的方位基准精度主要取决于 陀螺和加速度计的水平，一般只能达到几角分，其位置误差会随时间积累而增大。这对短距 离的导航系统来说可以满足要求；而对长距离的导航系统就不能满足精度要求了。因此单 纯地依靠提高惯性仪表精度来提高定位精度非常困难。无线电导航系统利用无线电引导飞行器沿着规定航线、在规定时间达到目的地的 航行技术。典型的导航系统有罗兰A、罗兰C、奥米加、测向仪等。这些系统利用无线电波的 传播特性可测定载体的导航参量(方位、距离和速度)，算出与规定航线的偏差，从而使载 体消除偏差以保持正确航线。但是无线电导航系统作用距离有限、存在服务盲区、远程导航 精度较低、易于遭受攻击，其应用和发展受到局限。卫星导航作为现代导航的主要方式，大大推进了科学技术的发展。其优点是无线 电波的传播基本不受地面气象、地形等因素的影响，台站的建立也不受地理条件的限制，距 离也不受限制，因此可以很容易地建立起一个全球导航系统。然而卫星导航的共同特征是 由特定信标以特定频率发播特定格式的导航电文，其导航信号极其微弱。“三定一弱”决定 了卫星导航系统易受攻击和操控的技术特征。全球定位系统(Global Position System, GPS)是美国研制的一种可以定时和测 距的空间交会定点的导航系统，可向全球用户提供连续、实时、高精度的三维位置、三维速 度和时间信息。然而GPS信号是从空间传向地面的，它并不是万无一失，还是能够被干扰和破坏 的。在“盟军行动”中，GPS信号可能受到了美军电子战飞机(如EA-6B)和无人驾驶干扰机 的非故意干扰，美国军事部门正在设法克服这个问题。这说明只要采取合适的措施就可干 扰GPS系统，降低其定位精度，使依赖GPS进行导航定位或制导的武器系统偏离航向。俄罗 斯在1997年莫斯科航展上展出了一种GPS干扰机，这种干扰机能干扰GPS和GL0NASS卫星 信号，能抑制数百公里以内接收机的正常工作。同时随着对GPS的依赖程度越来越大，也必然会越来越担心其GPS卫星受到攻击。GPS卫星没有采取防核效应加固和防激光武器保护手段，没有防碰撞探测器，也没有机动变 轨能力。所以比较容易受到攻击，随着其作用的增大，它也必然会成为被攻击的目标。此外GPS由美国军方控制，其军码加密程度高，无法利用；其民码虽然可用，但抗 干扰能力差；新研制的GPS卫星可能具有局部地区关闭功能。因而GPS的利用受到美国制 约。天文导航的重要部件是星敏感器。星敏感器作为一种精度较高的姿态敏感器，被 广泛应用于各种航天器上。与惯性导航和GPS等其它卫星导航相比，具备的许多优点，比如 精度高，不需要长时间的地面定位定向；而且，星敏感器在抗干扰方面有着GPS导航所不具 备的优点。因此目前大部分学者采用利用天文参数修正测角陀螺的漂移；或者由惯导系统 提供惯导信息，GPS提供位置或位置与速度信息，天文导航(星敏感器)提供姿态信息，将 这些信息简单组合起来就得到组合导航信息，从而实现导航系统。然而这些系统仅仅利用 了星敏感器输出高精度的姿态信息，也只能作为惯性导航的校准设备使用，没有作为一种 独立的导航手段使用。为了充分利用星敏感器高精度信息。很多学者采用惯性设备提供水平基准来实现 一些天文自主定位，由于惯性设备部件的限制以及平台控制方法的限制，很难动态控制平 台基准完全水平，从而降低了水平基准的精度。水平基准的误差降低导致导航精度的降低。 这与高精度导航的客观要求不相适应。受水平基准限制已经成为天文导航向高精度发展的 瓶颈。近些年，出现了基于星敏感器的星光折射自主导航。该导航方式基本原理如下在 星敏感器上同时观测两颗恒星，一颗恒星的星光高度远大于大气层的高度，星光未受折射， 另一颗恒星的星光受到大气折射，这样两束星光之间的角距将不同于标称值，此角距的变 化量即为星光折射角。利用星光折射角与大气密度的关系和大气密度随高度变化也有现成 的数学模型，从而确定出星光在大气层中的高度，这个高度反映了载体与地球之间的几何 关系。这种导航方式要求大气密度随高度变化的数学模型比较精确。然而，受大气层的影 响、季节的变化以及气候等因素的影响，国际上很难建立比较精确的大气数学模型。而且采 用该导航方法必须视场内部分恒星星光穿过大气层，造成这些恒星在星敏感器像平面的位 置存在偏差，从而降低了星敏感器的输出姿态。
发明内容
本发明的目的在于提供一种实时输出三轴姿态、实时输出载体在地理坐标系下的 经纬度的基于星敏感器的天文自主导航方法。本发明的目的是这样实现的所述的基于星敏感器的天文自主导航方法，步骤如 下步骤一计算星敏感器输出基于地心惯性坐标系的姿态信息；步骤二 根据姿态信息计算基于地心惯性坐标系下的光轴指向；步骤三把基于地心惯性坐标系下的光轴指向转换为基于WGS84坐标系下的光轴 指向；从激光水平仪中读取星敏感器X和Y方向与水平方向的夹角和β。步骤四根据α Q和β Q计算光轴指向与水平垂直时在WGS84坐标系下的指向；步骤五计算载体地下点S的经度α和纬度β ；
步骤六输出载体在地心惯性坐标系下的姿态q以及地下点经度α和纬度β。本发明基于星敏感器的天文自主导航方法，采用光电传感器来测量载体平台(即 天文导航系统平台)与水平面的夹角，这样避免了由于水平基准平台带来的测量和控制误 差，从而提高了测量精度。实时输出三轴姿态的同时，也能够实时输出载体在地理坐标系下 的经度和纬度，所以完全实现天文自主导航。
图1为本发明的系统原理图；图2为本发明基于星敏感器的天文自主导航方法工作流程图；图3为本发明的采用某型号卫星星敏感器测试结果波形图；图4为本发明的根据星敏感器连续输出三轴姿角和测角器件计算的当地经度和 纬度误差；图5为本发明应用于某载体的工作流程框图；图6为本发明应用于某载体的示意图，Os-XsYsZs:星敏感器像空间坐标系， Os' -Xs' Ys, Zs'星敏感器像空间坐标系的平移，其中0/是点Os在地表面上的投影点， OhXhYhZh 以0S’为原点的一个水平坐标系。
具体实施例方式下面结合附图举例对本发明作进一步说明。实施例1 结合图1、图2本发明一种基于星敏感器的天文自主导航方法，步骤如 下步骤一计算星敏感器输出基于地心惯性坐标系的姿态信息；步骤二 根据姿态信息计算基于地心惯性坐标系下的光轴指向；步骤三把基于地心惯性坐标系下的光轴指向转换为基于WGS84坐标系下的光轴 指向；从激光水平仪中读取星敏感器X和Y方向与水平方向的夹角和β。步骤四根据α Q和β Q计算光轴指向与水平垂直时在WGS84坐标系下的指向；步骤五计算载体地下点S的经度α和纬度β ；步骤六输出载体在地心惯性坐标系下的姿态q以及地下点经度α和纬度β。实施例2 结合图1-图4，天文导航系统要真正实现自主导航，主要解决的问题是 摆脱由惯性设备提供水平基准的束缚和求载体导航信息的量测物理量。由此可见，摆脱水 平基准的制约，另外寻求载体导航信息的量测物理量，是实现高精度天文导航的必然。本发 明的目的是建立基于星敏感器的天文自主导航系统。整个系统如图1所示。各个坐标系 定义如下地心惯性坐标系OcrxciyciZci 坐标原点Otl在地球质量中心，X0轴指向Ttl时刻的平春 分点，Ztl轴指向Ttl时刻的平极，Y0轴在Ttl时刻的平赤道面内，向东组成右手坐标系。经常采 用贝塞耳年(Bessel年，或称为假年。其长度为平回归年的长度，即365. 2421988平太阳日。 常用的贝塞耳历元是指太阳平黄经等于280的时刻，例如1950.0，并不是1950年1月1日 0时，而是1949年12月31日22时09分2秒)首作为Τ。，例如施密松星表(Smi thsonian AstrophysicalObservatory Star Catalog)采用 2000. 为 TQ，称为历元 2000. 0 (简称J2000. 0)。本方案采用J2000. 0惯性坐标系。WGS-84坐标系0w_Xwywzw坐标原点Ow为地球质心，其地心空间直角坐标系的Zw轴 指向BIH(国际时间)1984. 0定义的协议地球极(CTP)方向，Xw轴指向BIH 1984. 0的零子 午面和CTP赤道的交点，yw轴与Zw轴、Xw轴垂直构成右手坐标系；地理坐标系(东北天坐标系)0e-xeyeze 坐标原点Oe运动物体和地球中心连线与 地球表面交点(或取运动体在地球表面上的投影点)，&轴在当地水平面内指向东，轴在 当地水平面内指向北，％轴沿当地地垂线方向并且指向天顶。是地平面或水平面；星敏感器像空间坐标系0s-xsyszs =Os为星敏感器像平面中心，xs、ys分别为平行于 像平面坐标的两个轴，xs> ys> Zs构成右手定则。设载体地下点S的经度a(0<a<23i;i0<a<Ji时为东经，当π彡a <271时为西经。下同)和纬度β (-JI/2彡β < JI/2;当-JI/2彡β <0时为南纬，当 0彡β < π/2时为北纬。下同)。那么S在WGS-84坐标系下的方向矢量为 根据星敏感器的识别结果以及激光水平测量部件分别测量星敏感器的两个像平 面轴Xs和[与水平方向的夹角分别为a C1和β 0。来推导出计算载体在WGS-84坐标系下 的方向矢量的数学模型，再根据(1)即可求出载体地表面点S的经度α和纬度β，从而实现对载体的定位。所以 该系统输出载体姿态的同时，又可以输出载体的位置。本发明提出基于星敏感器的天文自主导航方法，主要内容如下对于同一参考坐标系，由于载体(一般指飞行器)姿态是唯一确定的，姿态参数描 述体现在参考坐标轴方向的物理量，称为姿态参数，有多种形式。最一般性的姿态参数是本 体坐标轴与参考坐标轴之间的方向余弦Α。根据方向余弦的定义，载体坐标系在参考坐标系中的几何方向可确定为
其中下标ο，0表示载体坐标系和参考坐标系, 在载体三轴姿态确定问题中，因为矩阵A完全确定了载体在参考坐标系中的状 态，故称方向余弦矩阵A为姿态矩阵。各种形式的姿态参数之间可以相互转换。因此方向余弦矩阵A又可以表示如下
6
其中q = qii+q2j+q3k+q4,是星敏感器在地心惯性坐标系下的姿态信息。所以星敏感器光轴指向在地心惯性坐标系下的单位矢量为 计算星敏感器光轴指向在WGS84坐标系下矢量 其中[ER]是地球自转矩阵，表示为 其中Rz( θ ζ)表示绕ζ轴旋转θ ζ角的坐标变换矩阵。
θ g(单位弧度)是真恒星时，可表示为
(9)
g是平黄赤交角，计算公式为
JD(t)表示计算时刻t对应的儒略天。 Θ,(单位弧度)格林尼治平恒星时，计算公式如下
( Tu 时间。再根据载体两轴与水平面的夹角分别为α。和β C1，可计算光轴垂直于水平面时在 WGS84坐标系下的指向矢量
(15)其中Rx(Ptl)表示绕χ轴旋转角的坐标变换矩阵。即
Δ ε , Δ ψ分别是交角章动和黄经章动。计算表达式如下
其中Ai, A' ^Bi5B' ^kij是常数，可在IAU1980章动序列表中查到。t是载体 根据之,+，就可以计算载体地表面点S的经度α和纬度β。主要性能指标我们选用某型号卫星星敏感器作为天文导航系统的姿态输出部件(表中四元数 为q = q0*i+q1*j+q2*k+q3)，采用XXX型号的激光水平测角部件来测量星敏感器X轴和Y轴 与水平方向的夹角。由于星敏感器可以直接输出载体的三轴姿态，星敏感器系统本身决定了姿态的精 度和可靠性，采用某型号的导航设备分别在某观测站进行了外场实验。利用这些实验结果 分别计算出当地地表的经度和纬度，为了验证这些数据的可行性和可靠性，把该导航系统 放置于某地，长时间运行后，保存测试数据。在某观测站连续1046秒实验，经分析，该导航 系统在经度和纬度方向的精度分别为0. 9637281519" (3 σ )和1. 3609644735" (3 σ )。实施例3 结合图5、图6，本发明一种基于星敏感器的天文自主导航方法，包含三 个子系统星敏感器系统和两个激光水平测量系统。星敏感器主要载体的三轴姿态；两个 激光水平测量系统主要测量载体两轴与水平面的夹角。工作过程恒星通过星敏感器光学镜头，成像在星敏感器像平面上(比如C⑶或者 APS)，成像电路把像平面中恒星的电信号转化为一幅完整的星图，并保存在存储器中；星像 提取软件读取存储器中的星图数据，并从星图中提取星像坐标；星图识别软件采用全天球 识别算法根据保存在星敏感器中的星表信息，对这些星像坐标进行识别(如果星敏感器有 先验信息，星图识别软件采用星跟踪算法)；姿态计算软件采用相应的姿态计算算法和识 别结果，并根据这些星图识别结果，并利用已识别的观测星，计算星敏感器在地心惯性坐标 系下的姿态信息q。根据激光水平测量部件分别测量星敏感器的两个像平面轴与水平方向 的夹角，计算光轴垂直于水平面时在WGS84坐标系下的指向矢量。并输出该矢量和星敏感 器在地心惯性坐标系下的姿态信息。这些信息就是自主导航信息。本发明提出的基于星敏感器的天文自主导航方法是根据星敏感器的识别结果，可 以计算星敏感器Os-Zs轴在地球惯性坐标系下的方向矢量之,，经坐标转换即可得在WGS-84 坐标系下的方向矢量乏 ,。利用激光水平测量部件分别测量星敏感器的两个像平面轴Xs和 ys与水平方向的夹角分别为^和^^。方向矢量之分别绕xs轴和ys轴旋转β C1和a ^角 度后的方向矢量^Jt是S在WGS-84坐标系下的方向矢量，再代入(1)即可求出载体地表面 点S的经度α和纬度β，从而实现对载体的定位。所以，该导航系统不但输出载体三轴姿 态，而且输出载体的位置。从而实现天文自主导航。
8
权利要求
一种基于星敏感器的天文自主导航方法，其特征在于步骤如下步骤一计算星敏感器输出基于地心惯性坐标系的姿态信息；步骤二根据姿态信息计算基于地心惯性坐标系下的光轴指向；步骤三把基于地心惯性坐标系下的光轴指向转换为基于WGS84坐标系下的光轴指向；从激光水平仪中读取星敏感器X和Y方向与水平方向的夹角α0和β0；步骤四根据α0和β0计算光轴指向与水平垂直时在WGS84坐标系下的指向；步骤五计算载体地下点S的经度α和纬度β；步骤六输出载体在地心惯性坐标系下的姿态q以及地下点经度α和纬度β。
全文摘要
本发明提供一种基于星敏感器的天文自主导航方法。步骤如下计算星敏感器输出基于地心惯性坐标系的姿态信息；计算基于地心惯性坐标系下的光轴指向；把基于地心惯性坐标系下的光轴指向转换为基于WGS84坐标系下的光轴指向；从激光水平仪中读取星敏感器X和Y方向与水平方向的夹角α0和β0；计算光轴指向与水平垂直时在WGS84坐标系下的指向；计算载体地下点S的经度α和纬度β；输出载体在地心惯性坐标系下的姿态q以及地下点经度a和纬度β。本发明避免了由于水平基准平台带来的测量和控制误差，提高测量精度，实时输出三轴姿态的同时，实时输出载体在地理坐标系下的经度和纬度，完全实现天文自主导航。
文档编号G01C21/02GK101893440SQ201010176280
公开日2010年11月24日 申请日期2010年5月19日 优先权日2010年5月19日
发明者刘睿, 李清华, 李葆华, 王�：� 申请人:哈尔滨工业大学
专业数控铣床产品供应商
20年生产经验，实力工厂，精工品质，质量有保障
