US20080269965A1 - Calibration of ship attitude reference - Google Patents

Abstract

A ship includes a star tracker mounted on a platform stabilized in ENU by the inertial navigation system (INS). The line-of-sight (LOS) of the star tracker is directed toward two separated stars, and the LOS difference angles are noted. The angles are processed to generate vector triads representing geodetic (ephemeris) and navigation system attitude. The triads are processed to generate a coordinate transformation matrix. The transformation matrix is separated into systematic error and reference attitude error. The reference attitude error is summed with the inertial navigation system attitude to generate corrected ENU attitude. The corrected attitude is used as a reference for shipboard sensors, to reduce errors when the sensor data is linked to other platforms.

Description

FIELD OF THE INVENTION
• This invention relates generally to calibration of a ship's attitude determination system to true geodetic attitude.
BACKGROUND OF THE INVENTION
• Naval ships have in the past been used in attack modes, which is to say for striking at the ships, aircraft and terrain of hostile powers. In conjunction with Ballistic Missile Defense (BMD) efforts, ships are increasingly being adapted for defense of a territory against ballistic missiles by being outfitted with equipment for surveillance, ballistic missile target tracking, target discrimination, target typing, and target cueing. In many cases, ships are provided with anti-ballistic-missile capabilities, such as antimissiles for destroying missiles, including intercontinental missiles, which are a threat to friendly territory. Various ballistic missile detection, tracking, and antimissile guidance systems are described in U.S. patent application Ser. Nos. 11/356,675 filed Feb. 16, 2006 in the name of Denis et al., 11/430,535 filed May 9, 2006 in the name of Pedersen et al., 11/430,644 filed May 9, 2006 in the name of Pedersen, and 11/430,647 filed May 9, 2006 in the name of Pedersen et al.
• Among the more recent improvements in defense against ballistic missiles is that of communicating missile tracking information among a plurality of sites, which sites may be land-based, ships at sea, aircraft and satellites. This communication allows a sensor(s) at a first site, as for example sensors at a picket ship near a hostile shore, to sense the launch of a hostile missile from the hostile territory. The picket ship may attempt to engage and destroy the hostile missile, but may be unable to because of the head start of the hostile missile before it is initially detected. By sending the picket ship's sensed data, or processed sensed data, to antimissile-equipped platforms farther out to sea, the antimissile defenses of these additional assets can be brought to bear against the hostile missile, with a probability of success which is increased by virtue of the advance or early knowledge of the location, heading and speed of the hostile missile.
• When a single ship or other platform performs the detection of the hostile missile and also engages the missile with its antimissile defenses, all of the sensing can be done in a local or ship's reference frame. However, when sensed information from a picket ship is sent to other ships or platforms, there is a potential for error attributable to undesired differences between the local reference frames and a true reference frame or geodetic coordinates. These differences, if not taken into account, can result incorrect interpretation of the data at the remote or data-receiving site, which in turn may cause the antimissile launched by the remote site to initially be directed incorrectly. If the antimissile is initially launched in an incorrect direction, it may not be possible to correct the heading of the antimissile in time to destroy the hostile missile or target. The problem has been solved in the past by relative gridlock techniques. “Relative Gridlock” is known in the art and is described in, for example, R. E. Helmick, J. E. Conte, T. R. Rice, Absolute Alignment of Sensors, NSWCDD/TR-96/46, Dahlgren Div., Surface Warfare Center, and H. O. Ladd, An Optimal Gridlock Solution in Closed Form That can be Implemented Recursively, Lockheed Martin Technical Report, CS-Z-MIS-A-2141, June 1997. The relative gridlock technique is cumbersome.
• In general, the attitude reference for a ship is provided by an inertial navigation system (INS), which attempts to provide attitude information or data in terms of local east-north-up (ENU) coordinates. Such inertial navigation systems are subject to drift and bias errors, so the data indicative of attitude may be incorrect on each intercommunicating ship. The INS is initially calibrated to the true North in-port by star sighting on Polaris on a clear night. This procedure is lengthy, and may take as much as 72 hours due to the need for correction of the gyros for the Earth's rotation, which is at a relatively slow rate. At sea, an accurate “local level” can be maintained by corrections available from bathometric data tables for compensation of the inertial gyro vertical deflection error attributable to uneven mass distribution at the sea bottom. “East” and “Up” of the inertial navigation system are not calibrated in port, but instead are calibrated in a laboratory.
• A significant improvement in the coordinate transformation accuracy of the ship target data to the earth-centered-fixed (ECEF) coordinates can be achieved by reducing the attitude misalignment between the East-North-Up (ENU) reference established by the ship's inertial navigation unit and true geodetic ENU reference. At sea following the static calibration, recalibration of the inertial navigation system is not performed for lack of a suitable calibration method. Thus, the inertial navigation systems of each of the ships involved in a multiple-platform defense against hostile ballistic-type missiles tend to drift relative to each other, giving rise to unwanted errors which cumulatively may degrade antimissile defense.
SUMMARY OF THE INVENTION
• A method according to an aspect of invention is for calibration of an attitude reference apparatus. The method comprises the steps of providing an inertial navigation system for a surface ship, which navigation system provides local reference of ship's attitude relative to East, North, and UP. The method also includes the step of providing a star tracker camera mounted on a platform stabilized by the local reference of ship's attitude. The star tracker compares azimuth and elevation angles between lines-of-sight between the star tracker camera and each of two selected stars, to thereby generate first and second azimuth and elevation difference angles. The line-of-sight of the star tracker is controlled in response to ephemeris of the two selected stars. The azimuth and elevation difference angles are processed to thereby determine first and second vector triads representing ephemeris attitude and navigation system attitude. The first and second triads are processed to determine a coordinate transformation matrix, which in general will comprise small rotation angles. The coordinate transformation matrix is separated into systematic error and reference attitude error. The calibrated navigation system attitude is determined. This may be accomplished by measured sequence of the reference attitude error samples averaged by estimation process to generate calibrated navigation system attitude.
• In one embodiment of the invention, sensed data, such as target data, is referenced to the corrected navigation system attitude. This may be accomplished by generating sensed data referenced to said navigation system attitude, and correcting the sensed data by the coordinate transformation matrix.
• According to an aspect of the invention, the step of processing the azimuth and elevation angles to determine first and second vector triads representing ephemeris and the navigation system attitude comprises the steps of (a) determining the star tracker local azimuth and elevation angles, (b) determining the star tracker attitude triad from the local azimuth and elevation angles, and (c) determining the geodetic reference attitude triad from ephemeris and the local azimuth and elevation angles.
• In one aspect, a method according to an aspect of the invention, the step of determining the star tracker local azimuth and elevation angles comprises computing
• 
  Az _s ^o =Az _e ^o +ΔAz _s ^o
• 
  El _s ^o =El _e ^o +ΔEl _s ^o  (11)
• where:
• ΔAz_s ^o is the azimuth difference angle measured by the star tracker between the star tracker line-of-sight to one star; and
• ΔEl_s ^o is the elevation difference angle measured by the star tracker between the star tracker line-of-sight to that one star. The step of determining the star tracker attitude triad from the local azimuth and elevation angles comprises computing
• 
  q=v
• 
  r=q×u/∥q×u∥  (20)
• 
  s=q×r
• where
  u, v are the unit LOS vectors to selected stars
  q, r, s are unit vectors representing the orthogonal attitude triad
  where
• $\begin{array}{cc}\begin{array}{ccccc}v=\left[\begin{array}{c}X1\\ Y1\\ Z1\end{array}\right];& u=\left[\begin{array}{c}X2\\ Y2\\ Z2\end{array}\right];& q=\left[\begin{array}{c}{q}_x\\ q_y\\ q_z\end{array}\right];& r=\left[\begin{array}{c}{r}_x\\ r_y\\ r_z\end{array}\right];& s=\left[\begin{array}{c}{s}_x\\ s_y\\ s_z\end{array}\right]\end{array},& \left(21\right)\\ \begin{array}{cc}X1=\mathrm{Cos}\left(\mathrm{Elv}\right)\mathrm{Sin}\left(\mathrm{Azv}\right)& X2=\mathrm{Cos}\left(\mathrm{Elu}\right)\mathrm{Sin}\left(\mathrm{Azu}\right)\\ Y1=\mathrm{Cos}\left(\mathrm{Elv}\right)\mathrm{Cos}\left(\mathrm{Azv}\right)& Y2=\mathrm{Cos}\left(\mathrm{Elu}\right)\mathrm{Cos}\left(\mathrm{Azu}\right)\\ Z1=\mathrm{Sin}\left(\mathrm{Elv}\right)& Z2=\mathrm{Sin}\left(\mathrm{Elu}\right).\end{array}& \left(22\right),\end{array}$
• The step of determining the geodetic reference attitude triad from ephemeris and the local azimuth and elevation angles is performed by computing attitude matrix M_R
• $\begin{array}{cc}{M}_R=\left[\begin{array}{ccc}{q}_{\mathrm{Rx}}& r_{\mathrm{Rx}}& s_{\mathrm{Rx}}\\ q_{\mathrm{Ry}}& r_{\mathrm{Ry}}& s_{\mathrm{Ry}}\\ q_{\mathrm{Rz}}& r_{\mathrm{Rz}}& s_{\mathrm{Rz}}\end{array}\right]& \left(23\right)\end{array}$
• and matrix M_S:
• $\begin{array}{cc}{M}_S=\left[\begin{array}{ccc}{q}_{\mathrm{Sx}}& r_{\mathrm{Sx}}& s_{\mathrm{Sx}}\\ q_{\mathrm{Sy}}& r_{\mathrm{Sy}}& s_{\mathrm{Sy}}\\ q_{\mathrm{Sz}}& r_{\mathrm{Sz}}& s_{\mathrm{Sz}}\end{array}\right]& \left(24\right)\end{array}$
• related by the transformation:
• 
  AM_R=M_S  (25).
• According to a hypostasis of the invention, the step of combining the reference attitude error with the navigation system attitude to generate calibrated navigation system attitude comprises the step of computing matrix
• $\begin{array}{cc}{\stackrel{\_}{A}}_{ENU}=1\text{/}N\sum _{i=1}^NA_{ENU,i}& \left(34\right)\end{array}$
• where
  Ā_ENU is the averaged value of the skew-symmetric matrix over the batch interval.
BRIEF DESCRIPTION OF THE DRAWING
• FIG. 1 is a simplified perspective or isometric view of a ship bearing a star tracker, illustrating the star tracker field of view and a star within the field of view;
• FIG. 2 is a simplified diagram of a system according to an aspect of the invention, illustrating a star tracker camera mounted on a stabilized platform, and processing blocks for processing inertial navigation and star tracker data to generate true geodetic NEU attitude;
• FIG. 3 is a notional representation of star tracker camera lines-of-sight and field-of-view, and some relevant angles;
• FIG. 4 is a diagram illustrating unit vector triads related to attitude.
DESCRIPTION OF THE INVENTION
• According to one aspect of the invention, a star tracker camera is mounted on a “gimbal” platform which is stabilized against attitude motion by the ship's local inertial navigation system (INS). The star tracker camera is directed toward first and second selected stars using a suitable ephemeris, and the azimuth and elevation error between each of the stars and the “boresight” or line-of-sight of the star tracker is noted. A vector triad is formed representing the attitude of the ephemeris, and another vector triad is formed representing the inertial navigation system attitude. These triads are processed together to determine the coordinate transformation matrix between the inertial navigation attitude and the ephemeris attitude. The coordinate transformation matrix is utilized with the inertial navigation attitude to generate calibrated attitude information. The hostile missile tracking information is either generated using the calibrated attitude information or is converted using the coordinate transformation matrix before being conveyed to other ships or platforms. Ideally the coordinate transformation matrix is processed to separate systematic error from reference attitude error, and the systematic error component is subtracted from the coordinate transformation matrix to yield reference attitude error. Star tracker measurements include both the ENU attitude errors and ship systematic errors. To estimate the ENU error, the known or determined systematic errors are known are subtracted from the star tracker measurements.
• One purpose for adding a star tracking system in the particular case of Aegis ships is to provide means for alignment at-sea of the ship-maintained east-north-up (ENU) reference to the standard geodetic ENU reference frame. The ship's inertial navigation (WSN-7) optical gyros drift and are subject to latitude bias errors which can result in attitude error. These errors, if not corrected, can significantly degrade the accuracy of the Aegis target data fed into the ballistic missile defense (BMD) system command and control, battle management and communication system (C²BMC) and fire control information provided to the ground-based midcourse defense (GBMD) system. The star tracking capability improves accuracy of the target data conversion from the ship's ENU to earth-centered-earth-fixed (ECEF) reference, and also improves the accuracy of the ship's inertial navigation system calibration using satellites (SCUS). The use of a star tracker for ENU calibration of the inertial navigation system is independent of global positioning system (GPS). The star tracker system can also provide additional means for tracking satellites and typing plume characteristic of threat targets, in that a camera is mounted on the director. Furthermore, accurate alignment of stable reference to true geodetic standard reference with the aid of a star tracker eliminates need for the cumbersome “relative gridlock” process when conducting cooperative engagements capability (CEC) engagements with Aegis ships.
• FIG. 1 is a simplified perspective or isometric view of an Aegis ship 10, showing a first triad of mutually orthogonal geodetic vectors X₀, Y₀, and Z₀ illustrated by dash lines and a second triad of mutually orthogonal ship gyro or inertial navigation system vectors X_S, Y_S, and Z_S illustrated by solid lines. FIG. 1 also illustrates a star tracker platform 12. The star tracker field-of-view (FOV) is designated 14.
• FIG. 2 is a simplified diagram, partially in block form and partially in perspective or isometric view, of a ship inertial navigation system together with ancillary elements according to an aspect of the invention. In FIG. 2, the Aegis inertial navigation system (INS) is designated 16. Those skilled in the art will understand that it is not necessary to the invention that it be mounted on or associated with an Aegis ship, but instead that the Aegis description relates to one possible embodiment. The inertial navigation system 16 produces signals on a path 16 o 1 representing ship navigation data (heading, latitude, and longitude, and signals on a path 16 o 2 representing ship motion, including attitude motion. The attitude motion signals are applied to an Aegis Director Control and Stabilizer illustrated as a block 18, which generates signals on a path 18 o representing illuminator antenna director 12 stabilization signals, so as to maintain the illuminator antenna director 12 stable in an attitude sense. With the illuminator antenna director 12 attitude-stabilized under control of the inertial navigation system 16, the illuminator antenna 22 is held so as to continuously point at whatever angle is commanded. The commands for directing the illuminator antenna 22 depend upon the mission, and may come from a radar system, but are ultimately applied to the director 12 in conjunction with the attitude stabilization commands. In the Aegis system, illuminator pointing commands are derived from target track data provided by the SPY radar, and the illuminator beam pointing is space stabilized by the ship gyro (WSN-&) data. Of course, the description of this particular embodiment is by way of example only.
• FIG. 2 also illustrates a modification of an element found on Aegis ships, together with additional elements which are not currently found on an Aegis ship, but which are provided pursuant to the invention. A star “tracker” or camera illustrated as 24 is mounted on the illuminator antenna director 12 so as to be stabilized therewith. This arrangement is completely optional, in that a separate stabilized platform could be provided to support the star tracker or camera 24. In the case of Aegis, such a stabilized platform already exists in the form of the illuminator antenna director 12, and its presence is taken advantage of. As illustrated in FIG. 2, the star tracker 24 is mounted behind an aperture 22 a defined in the illuminator antenna 22, which aperture allows the star tracker 24 to view the field of view 14.
• Star “tracker” or camera 24 can be any one of a number currently available which are capable of night sighting of stars. Preferably, the star tracker 24 also has the capability of tracking stars during daylight hours, to thereby allow attitude calibration at any time, rather than just at night. Such star trackers are under development by TREX Enterprises Corp., of San Diego, Calif., and operate in the near-red and red portions of the light spectrum. Ideally, the star tracker, whether night-only or day-night, would be of the “image dissector” type which measures the angular deviation of the line-of-sight to the star in question (within the field of view of the star tracker camera) relative to the line-of-sight of the camera itself.
• Ship navigational information flows from inertial navigation system 16 of FIG. 2 to a star ephemeris program 34 such as System to Estimate Latitude and Longitude Astronomically (STELLA), which stores information relating to the vector to selected stars from the ship's position, based on true NEU attitude. Stella was developed by US Naval Observatory, and is available to Department of Defense users. Any ephemeris program may be used, however. Ship local latitude, longitude, UTC time and date are needed as inputs to the ephemeris program. This information is available from the ship's inertial navigation system. The ephemeris program selects the best stars for the viewing and computes their LOS angles in the local ENU reference frame. The pointing vector to the selected star is applied from ephemeris 34 by way of a path 34 o ₁ to the illuminator antenna director control block 18, which directs the star tracker camera 24 toward the nominal position of the selected star. The true ENU attitude reference information is applied from ephemeris block 34 by way of a path 34 o ₂ to an attitude correction block illustrated as 32. Aegis ship INS comprises WSN-7 and GPS, and latitude, longitude and UTC time information are available from both WSN-7 and GPS. In the star tracker INS alignment system according to an aspect of the invention, that information used by the STELLA astronomical software package, which is not currently part of the Aegis system.
• Star tracker 24 of FIG. 2 is commanded (by way of commands to the illuminator antenna director) to direct its line-of-sight LOS_st toward a selected star, such as star 1 of FIG. 2. Because of system errors, including attitude errors, the line-of-sight LOS_st of the star tracker 24 does not fall on or coincide with the selected star 1. Instead, the star tracker line-of-sight LOS_st deviates from the star 1 line-of-sight LOS_s1. The star tracker 24 generates images which include the difference angle ΔLOS between the LOS_st and LOS_s1 It should be noted that star tracker pointing accuracy is not critical, since the lens of the star tracker camera can be selected to assure containment of the expected deviation of the star image within the field of view. This Star LOS Error information is transmitted from star tracker camera 24 over a path 24 o to a star image processor and attitude computation illustrated as a block 30. Block 30 processes the star tracker camera 24 video data to determine LOS angles, which provides the measured attitude triad, so block 30 may be considered to be part of the star tracker. Those skilled in the art will recognize that it may be desirable to filter the camera signals before processing to reduce noise, such as might be occasioned by residual ship motion or vibration of director 12. The length of time required to generate LOS information for one star is expected to be less than 30 seconds, and during such a short time disturbances, such as those attributable to ship and Earth motion, are expected to be small and decoupled from the star tracker camera's pointing. Star image processor and attitude compensator block 30 produces measured ENU attitude information on its output data path 30 o.
• Attitude correction algorithm block 32 receives true ENU attitude information from STELLA by way of data path 34 o 2 and also receives measured ENU attitude information from star image processor and attitude compensator 30 by way of data path 30 o. Attitude correction algorithm block 32 determines the INS reference attitude correction and couples the correction by way of data path 32 o back to the inertial navigation system 16, where the INS correction can be incorporated
• The measurements of the star tracker LOS include, beside misalignment of ENU references, contributions from other systematic error sources such as the measurement accuracy of the attitude sensors, director pointing accuracy, and misalignment of reference between the ship's elements involved in the star tracking process. The misalignment between the ship ENU and reference ENU can be estimated from the attitude difference between their respective attitude triads, established using vectors from sighting at two stars. Since the ENU error mostly contain bias, the star tracker measurements can be separated into two skew-symmetric error matrices, so that the ENU error estimation can be performed simply by a batch least squares or averaging process. Kalman filter method can be utilized if the empirical data obtained from the test on the physical systems indicates a need for such a filter. The accuracy of the batch averaging estimation is expected to be adequate, since the values of the systematic errors in the system are known form past error analyses and battery alignment procedures such as those performed for the AEGIS combat system. The knowledge of the systematic error values can be improved further by a registration process and establishing of adaptation tables for the individual ships. The estimation process corrects the ship-established ENU references in a form of a small angle rotation matrix which can be applied to the coordinate transformation of the ship's ENU-to-ECEF reference and ENU-to-ship-deck reference.
• The misalignment of the ship's ENU reference from the true geodetic ENU reference is caused by the ship's navigation errors, such as INS bias errors in alignment to true North and measurement of the local gravity vector (vertical deflection). However, the star tracker measurements also include ship systematic errors which are, to the extent possible, excluded from the ENU error estimation.
• FIG. 3 illustrates details of star image offset from the center of the star tracker camera field of view (FOV). The star tracking process utilizes the star ephemeris program to select stars and provides input to computation of the camera pointing commands. The ship's inertial navigation system (INS) and fire control systems (FCS) will provide the camera stabilization and control camera pointing. To determine the error due to ENU reference misalignment, the star tracker LOS vectors are determined from the star tracker measurements. Those LOS vectors are used to establish the unit vector attitude triad for comparison with the similar triad derived from the ephemeris data. The relation between those triads can be shown to be related by a small angle rotation matrix. That matrix can be expressed as the sum of symmetric and skew-symmetric parts. The skew-symmetric part is used to estimate the needed ENU misalignment correction by Batch Least Squares or Kalman Filter estimation process utilizing modeled non-ENU errors.
• Ship sensor and alignment errors cause the LOS of the camera director to deviate from the true line-of-sight (LOS) to the selected star based on ephemeris data. That deviation is measured by the star tracker as the star image offset from the center of star tracker's field-of-view (FOV). The star tracker error sources are depicted in the error decomposition diagram of FIG. 3. Star Tracker Pointing Error Equations are developed as follows:
• True LOS vector to star:
• 
  {right arrow over (X)}_s ^los=T_d ^losT_o ^d{right arrow over (X)}_s ^o  (1)
• Local LOS vector measured with star tracker:
• 
  {right arrow over ({circumflex over (X)} _s ^los=(I+{tilde over (ε)} _ss ^los)T _d ^los(I+{tilde over (ε)}_ship ^d)T _o ^d(I+{tilde over (ε)}_enu ^o){right arrow over (X)} _s ^o+{right arrow over ({circumflex over (η)}_fn ^los  (2)
• where
• 
  (I+{tilde over (ε)}_ss ^los)=(I+{tilde over (ε)}_refrac ^los+{tilde over (ε)}_camera ^los)
• 
  (I+{tilde over (ε)}_ship ^d)=(I+{tilde over (ε)}_diralign ^d+{tilde over (ε)}_dirpoint ^d)(I+{tilde over (ε)}_gyroalign ^d+{tilde over (ε)}_gyroattitud ^d)
• 
  (I+{tilde over (ε)}_enu ^d)=(I+{tilde over (ε)}_vert ^o+{tilde over (ε)}_eph ^o+{tilde over (ε)}_nav ^o)
• Star tracker pointing error vector (error measured by the star tracker camera) is:
• $\begin{array}{cc}\begin{array}{c}\partial {\widehat{\stackrel{\rightharpoonup }{X}}}_s^{los}={\widehat{\stackrel{\rightharpoonup }{X}}}_s^{los}-{\stackrel{\rightharpoonup }{X}}_s^{los}\\ =\left(I+{\tilde{\varepsilon }}_{\mathrm{ss}}^{los}\right)T_d^{los}\left(I+{\tilde{\varepsilon }}_{\mathrm{ship}}^d\right)T_o^d\left(I+{\tilde{\varepsilon }}_{enu}^o\right){\stackrel{\rightharpoonup }{X}}_s^o-\\ T_d^{los}T_o^d{\stackrel{\rightharpoonup }{X}}_s^o+{\widehat{\stackrel{\rightharpoonup }{\eta }}}_{\mathrm{fn}}^{los}\end{array}& \left(3\right)\end{array}$
• To determine the contribution to the camera LOS error vector from the ENU reference misalignment alone, the equation (3) can be rearranged as follows:
• $\begin{array}{cc}{\stackrel{\rightharpoonup }{X}}_s^o=\left(I-{\tilde{\varepsilon }}_{enu}^o\right){\widehat{\stackrel{\rightharpoonup }{X}}}_s^o& \left(4\right)\end{array}$
• where
  {tilde over (ε)}_enu ^o is the required correction
  When the right side of Equation 4 is expanded gives equation (5)
• 
  (I+{tilde over (ε)}_enu ^o){right arrow over (X)} _s ^o =T _d ^o(I−{tilde over (ε)}_ship ^d)T _los ^d(I−{tilde over (ε)}_ss ^los)(Δ{right arrow over ({circumflex over (X)} _s ^los +T _d ^los T _o ^d {right arrow over (X)} _s ^o−{right arrow over ({circumflex over (η)}_fn ^los)  (5)
• 
  or
• 
  (I+{tilde over (ε)}_enu ^o){right arrow over (X)} _s ^o ={right arrow over ({circumflex over (X)} _s ^o′
• where
• 
  {right arrow over ({circumflex over (X)} _s ^o′ =T _d ^o(I−{tilde over (ε)}_ship ^d)T _los ^d(I−{tilde over (ε)}_ss ^los)(Δ{right arrow over ({circumflex over (X)} _s ^los +T _d ^los T _o ^d {right arrow over (X)} _s ^o−{right arrow over ({circumflex over (η)}_fn ^los)  (6)
• {right arrow over (X)}_s ^o=true LOS vector to star in geodetic ENU frame
  {right arrow over ({circumflex over (X)}_s ^o′=LOS vector to star in ship-established ENU frame
  {right arrow over (X)}_s ^los=true LOS vector to star in star tracker LOS frame (from ephemeris tables)
  {right arrow over ({circumflex over (X)}_s ^los=star LOS vector measured by star tracker camera in Star tracker LOS frame
  ∂{right arrow over ({circumflex over (X)}_s ^los=star tracker pointing error vector LOS frame (measured by star camera)
  T_d ^los=coordinate transformation from ship deck to star tracker LOS
  T_o ^d=coordinate transformation from ENU to ship deck
  I=unitary matrix
• $\tilde{\varepsilon }=\mathrm{skew}\text{-}\mathrm{symmetric}\mathrm{error}\mathrm{matrix}=\left[\begin{array}{ccc}0& -{\varepsilon }_z& {\varepsilon }_y\\ {\varepsilon }_z& 0& -{\varepsilon }_x\\ -{\varepsilon }_y& {\varepsilon }_x& 0\end{array}\right]$
• where
  δ_xyz are small angular errors about xyz axes
  {tilde over (ε)}_eph ^o=Ephemeris errors in local ENU frame
  {tilde over (ε)}_vert ^o=Deflection of local vertical in ENU frame
  {tilde over (ε)}_nav ^o=Navigation errors of ship INS in ENU frame
  {tilde over (ε)}_diralign ^d=Errors in alignment of director to deck reference
  {tilde over (ε)}_dirpoint ^los=Director pointing servo errors in director LOS frame
  {tilde over (ε)}_gyroalign ^d=Ship gyro alignment errors in deck reference axes
  {tilde over (ε)}_gyroattitude ^d=Ship gyro attitude measurement errors in deck reference axes
  {tilde over (ε)}_refrac ^los=Atmospheric refraction of camera LOS in camera LOS frame
  {tilde over (ε)}_camera ^los=Camera resolution and alignment to director LOS in camera LOS axes
  {tilde over (ε)}_ss ^los=Star tracker errors combined in camera LOS frame
  {tilde over (ε)}_ship ^los=Ship gyro and director errors combined in deck frame
  {tilde over (ε)}_enu ^o=Combined navigation errors in ENU frame
• 
  {right arrow over ({circumflex over (η)}_fn ^o={right arrow over ({circumflex over (η)}_ffloor ^o+{right arrow over ({circumflex over (η)}_fbias ^o
• {right arrow over ({circumflex over (η)}_ffloor ^o=Star tracker data filter noise floor in ENU reference frame
  {right arrow over ({circumflex over (η)}_fbias ^o=Star tracker data filter bias in ENU reference frame
• The image dissector type of star sensor camera or star tracker provides measurements directly applicable to determination of the ship's reference correction. The star tracker measures ΔAz_LOS and ΔEl_LOS offset angles of the star image from the center of star tracker FOV as illustrated in FIG. 3. Those offset angles are used to compute the star tracker LOS angles relative to the star LOS angles computed from the ephemeris data. Because other non-ENU errors contribute to the above offset, the ENU misalignment can not be directly determined from the star tracker measurements. It is desirable to define a unit vector attitude triad for the ephemeris reference and for that measured by the star tracker and to compare the three-axis attitudes. An estimation process, applied to the results obtained from comparison of the two triads, is used to determine the misalignment of the ship's ENU reference.
• In FIG. 3,
• 
  ΔAz _LOS=Tan⁻¹(d/f)  (7)
• 
  ΔEl _LOS=Tan⁻¹((h/f)Cos ΔAz _LOS)  (8)
• f=focal length of camera lens
  The above difference angles (Δ's) should be available directly from the processing of the star tracker camera output by the video processor 30 of FIG. 2.
  Given the ΔAz_LOS and ΔEl_LOS, the error vector representing the deviation of the star image from the tracker camera's LOS is computed as:
• $\begin{array}{cc}\partial {\stackrel{\rightharpoonup }{X}}_s^{los}=\left[\begin{array}{c}\Delta X_{LOS}\\ \Delta Y_{LOS}\\ \Delta Z_{LOS}\end{array}\right]=\left[\begin{array}{c}\mathrm{Cos}\Delta El_{LOS}\mathrm{Sin}\Delta {\mathrm{Az}}_{LOS}\\ \mathrm{Cos}\Delta El_{LOS}\mathrm{Cos}\Delta {\mathrm{Az}}_{LOS}\\ \mathrm{Sin}\Delta El_{LOS}\end{array}\right]& \left(9\right)\end{array}$
• where
  ∂{right arrow over (X)}_s ^los is the LOS error vector measured by the star tracker.
• The reference matrix M_R, described below in conjunction with FIG. 4, is computed directly from the star LOS angles (Az_e ^o, El_e ^o) determined by the star ephemeris program. To determine the unit vector attitude triad matrix M_s for the star tracker LOS, the corresponding ΔAz_s ^o, ΔEl_s ^o angles are computed using the star tracker measurements of the angular difference between the camera's LOS and the star image in the camera's FOV. The star camera is mounted on the director with azimuth and elevation degrees of freedom only. Thus, the Δ-LOS errors measured relative to the cross-hair axes of the camera lens rotates away from the true ENU alignment when the ship rolls. The Δ-LOS must be corrected for the ship's roll before it can be added to ephemeris-derived LOS angles, by a rotation through the φ-angle about the star tracker LOS axis as follows:
• 
  Δ{right arrow over (X)}_s ^o=T_los ^oΔ{right arrow over (X)}_s ^los
• Where, Δ{right arrow over (X)}_s ^o is Δ-LOS error vector in true ENU frame
• Δ{right arrow over (X)}_s ^los is Δ-LOS error vector relative to camera LOS
• $\begin{array}{cc}\begin{array}{c}{T}_{\mathrm{los}}^o=\left[\begin{array}{ccc}C{\phi }_s& 0& S{\phi }_s\\ 0& 1& 0\\ -S{\phi }_s& 0& C{\phi }_s\end{array}\right]\\ =\mathrm{rotation}\mathrm{about}\mathrm{camera}\mathrm{LOS}\mathrm{axis}\end{array}& \left(10\right)\end{array}$
Where
• 
  |φ_s|=(Cos⁻¹({right arrow over (u)} _x ^los •{right arrow over (n)})/|{right arrow over (n)}|)
• 
  {right arrow over (n)}={right arrow over (u)} _y ^los ×{right arrow over (u)} _z ^o
• {right arrow over (u)}_y ^los is unit vector along camera LOS axis.
  {right arrow over (u)}_z ^o is unit vector along ENU ephemeris axis.
  Thus, the star tracker LOS angles are:
• 
  Az _s ^o =Az _e ^o +ΔAz _s ^o
• 
  El _s ^o =El _e ^o +ΔEl _s ^o  (11)
• and the corresponding star tracker LOS vector in ENU is:
• $\begin{array}{cc}{\stackrel{\rightharpoonup }{X}}_s^o=\left[\begin{array}{c}{X}_s^o\\ Y_s^o\\ Z_s^o\end{array}\right]=\left[\begin{array}{c}\mathrm{Cos}E1_s^o\mathrm{Sin}{\mathrm{Az}}_s^o\\ \mathrm{Cos}E1_s^o\mathrm{Cos}Az_s^o\\ \mathrm{Sin}E1_s^o\end{array}\right]& \left(12\right)\end{array}$
• where:
  Az_s ^o, El_s ^o are azimuth and elevation angles of the star tracker LOS in ENU reference frame;
  Az_e ^o, El_e ^o are azimuth and elevation angles of the star LOS based on ephemeris data in ENU reference frame;
  ΔAz_s ^o, ΔEl_s ^o are azimuth and elevation difference angles between the star image and star tracker LOS in camera FOV in ENU reference frame.
• Angles ΔAz_s ^o, ΔEl_s ^o are computed as follows:
• {right arrow over (X)}_s ^o is the star tracker LOS vector in ENU reference frame
• 
  Δ{right arrow over (X)}_s ^o=T_d ^oT_los ^dΔ{right arrow over (X)}_los  (13)
• 
  ΔAz _s ^o=Tan⁻¹(Δ{right arrow over (X)} _s ^o /Δ{right arrow over (Y)} _s ^o)  (14)
• 
  ΔEl _s ^o=Tan⁻¹(ΔZ _s ^o/((ΔX _s ^o)²+(ΔY _s ^o)²)^1/2)  (15)
• ∂{right arrow over (X)}_s ^o is the star-tracker-measured error vector converted to ENU reference frame. Deck-to-ENU and star-tracker-LOS-to-deck coordinate transformations are T_d ^o, T_los ^d
• where T_los ^d is computed with Az_los ^d, El_los ^d director pointing angles.
• The star and star tracker LOS vectors are computed for each star using the star ephemeris Az_e ^o, El_e ^o and star tracker Az_s ^o, El_s ^o LOS angles:
• $\begin{array}{cc}{\stackrel{\rightharpoonup }{e}}_1=\left[\begin{array}{c}{X}_{e1}^o\\ Y_{e1}^o\\ Z_{e1}^o\end{array}\right]=\left[\begin{array}{c}\mathrm{Cos}E1_{e1}^o\mathrm{Sin}{\mathrm{Az}}_{e1}^o\\ \mathrm{Cos}E1_{e1}^o\mathrm{Cos}{\mathrm{Az}}_{e1}^o\\ \mathrm{Sin}E1_{e1}^o\end{array}\right]& \left(16\right)\\ {\stackrel{\rightharpoonup }{e}}_2=\left[\begin{array}{c}{X}_{e2}^o\\ Y_{e2}^o\\ Z_{e2}^o\end{array}\right]=\left[\begin{array}{c}\mathrm{Cos}E1_{e2}^o\mathrm{Sin}{\mathrm{Az}}_{e2}^o\\ \mathrm{Cos}E1_{e2}^o\mathrm{Cos}{\mathrm{Az}}_{e2}^o\\ \mathrm{Sin}E1_{e2}^o\end{array}\right],\mathrm{error}\mathrm{correction}& \left(17\right)\\ {\stackrel{\rightharpoonup }{s}}_1=\left[\begin{array}{c}{X}_{s1}^o\\ Y_{s1}^o\\ Z_{s1}^o\end{array}\right]=\left[\begin{array}{c}\mathrm{Cos}E1_{s1}^o\mathrm{Sin}{\mathrm{Az}}_{s1}^o\\ \mathrm{Cos}E1_{s1}^o\mathrm{Cos}{\mathrm{Az}}_{s1}^o\\ \mathrm{Sin}E1_{s1}^o\end{array}\right]& \left(18\right)\\ {\stackrel{\rightharpoonup }{s}}_2=\left[\begin{array}{c}{X}_{s2}^o\\ Y_{s2}^o\\ Z_{s2}^o\end{array}\right]=\left[\begin{array}{c}\mathrm{Cos}E1_{s2}^o\mathrm{Sin}{\mathrm{Az}}_{s2}^o\\ \mathrm{Cos}E1_{s2}^o\mathrm{Cos}{\mathrm{Az}}_{s2}^o\\ \mathrm{Sin}E1_{s2}^o\end{array}\right]& \left(19\right)\end{array}$
• where
  {right arrow over (e)}₁, {right arrow over (e)}₂ are LO{right arrow over (S)} vectors to two ephemeris stars
  {right arrow over (s)}₁, {right arrow over (s)}₂ are vectors along two corresponding star tracker LOS directions
  El_e1 ^o, El_e2 ^o, Az_e1 ^o, Az_e2 ^o are ephemeris LOS angles of two stars in ENU reference
  El_s1 ^o, El_s2 ^o, Az_s1 ^o, Az_s2 ^o are corresponding star tracker LOS angles in ENU reference frame
• The three-axis attitude can be determined. FIG. 4 is a diagram showing decomposition of the star tracker error equations. The LOS vectors to two stars (separated in angle) at a given time allows establishing the unit vector triad defining the three-dimensional attitude of a body relative to a reference coordinate system. The general form of mathematical derivations of the attitude triads from the star LOS data are described in conjunction with FIG. 4. In FIG. 4, X, Y, and Z are the local inertial reference frame (ENU), and Az and El are the local (ENU) angles to a star. At a given time, for two v and u star LOS vectors, the unit vector attitude triad is computed as:
• 
  q=v
• 
  r=q×u/∥q×u∥
• 
  s=q×r  (20)
• where
  u, v are the unit LOS vectors to selected stars
  q, r, s are unit vectors representing the orthogonal attitude triad
  where
• $\begin{array}{cc}v=\left[\begin{array}{c}X1\\ Y1\\ Z1\end{array}\right];u=\left[\begin{array}{c}X2\\ Y2\\ Z2\end{array}\right];q=\left[\begin{array}{c}{q}_x\\ q_y\\ q_z\end{array}\right];r=\left[\begin{array}{c}{r}_x\\ r_y\\ r_z\end{array}\right];s=\left[\begin{array}{c}{s}_x\\ s_y\\ s_z\end{array}\right],& \left(21\right)\\ X1=\mathrm{Cos}\left(\mathrm{Elv}\right)\mathrm{Sin}\left(\mathrm{Azv}\right)X2=\mathrm{Cos}\left(\mathrm{Elu}\right)\mathrm{Sin}\left(\mathrm{Azu}\right)Y1=\mathrm{Cos}\left(\mathrm{Elv}\right)\mathrm{Cos}\left(\mathrm{Azv}\right)Y2=\mathrm{Cos}\left(\mathrm{Elu}\right)\mathrm{Cos}\left(\mathrm{Azu}\right)Z1=\mathrm{Sin}\left(\mathrm{Elv}\right)Z2=\mathrm{Sin}\left(\mathrm{Elu}\right),& \left(22\right)\end{array}$
• X1, Y1, Z1 and X2, Y2, Z2 are components of v and u vectors, respectively, in true geodetic ENU frame, and Azv, Azu, Elv, Elu angles are the Azimuth and Elevation angles.
• Applying the above definition to the reference and star tracker triad results in the following relations:
• The orientation of the unit vector attitude triad relative to the geodetic reference coordinate frame is defined as the elements of a 3×3 attitude matrix M_R:
• $\begin{array}{cc}{M}_R=\left[\begin{array}{ccc}{q}_{\mathrm{Rx}}& r_{\mathrm{Rx}}& s_{\mathrm{Rx}}\\ q_{\mathrm{Ry}}& r_{\mathrm{Ry}}& s_{\mathrm{Ry}}\\ q_{\mathrm{Rz}}& r_{\mathrm{Rz}}& s_{\mathrm{Rz}}\end{array}\right]& \left(23\right)\end{array}$
• The orientation of the star tracker LOS attitude triad relative to the ship gyro reference is defined by a similar 3×3 matrix M_S:
• $\begin{array}{cc}{M}_S=\left[\begin{array}{ccc}{q}_{\mathrm{Sx}}& r_{\mathrm{Sx}}& s_{\mathrm{Sx}}\\ q_{\mathrm{Sy}}& r_{\mathrm{Sy}}& s_{\mathrm{Sy}}\\ q_{\mathrm{Sz}}& r_{\mathrm{Sz}}& s_{\mathrm{Sz}}\end{array}\right]& \left(24\right)\end{array}$
• Since both matrices M_R and M_S define orthogonal coordinate systems, they can be related by the following transformation:
• 
  AM_R=M_S  (25)
• 
  And thus
• 
  A=M_SM_R ⁻¹=M_SM_R ^T  (26)
• where T signifies transpose.
  For this application, coordinate transformation matrix A is a 3×3 matrix representing the coordinate transformation between the true geodetic and star tracker LOS attitude triads expressed in the local-topocentric ENU coordinates. In this context, the word topocentric refers to the local horizon and vertical on an elliptic Earth model.
• The star tracker measurements, besides the actual ENU misalignment error, will include all other non-navigation errors due to Fire Control System computations and star tracker stabilization and pointing controls. The actual attitude misalignment between the ship-maintained and true geodetic ENU reference is for the most part due to navigation errors caused by ship gyro attitude biases attributable to latitude and vertical deflection of the gravity vector. The gyro attitude drift contributes in a lesser way because its drift is averaged by gyro indexing. To estimate the actual misalignment between the ENU references, the skew-symmetric part of the A coordinate transformation matrix of equation (26) is obtained, and an estimation process is performed on its elements. The skew symmetric error matrix is obtained from the A matrix (of equation 26) as follows:
• For a matrix A which has the inverse:
• 
  A=A _S +A _SK  (27)
• 
  A _S=(A+A ^T)/2 is the symmetric matrix  (28)
• 
  A _SK=(A−A ^T)/2 is the skew-symmetric matrix  (29)
• and superscript T signifies matrix transpose.
  A_SK is of the form
• $\begin{array}{cc}{A}_{\mathrm{SK}}=\left[\begin{array}{ccc}0& -a_z& a_y\\ a_z& 0& -a_x\\ -a_y& a_x& 0\end{array}\right]& \left(30\right)\\ \mathrm{where}a_x=e_{x1}+e_{x2}+\dots +e_{\mathrm{xn}}a_y=e_{y1}+e_{y2}+\dots +e_{\mathrm{yn}}a_z=e_{z1}+e_{z2}+\dots +e_{\mathrm{zn}}& \left(31\right)\end{array}$
• where
  e_xi, e_yi, and e_zi are errors from individual sources included in the star tracker's measurements of the camera's LOS angle relative to LOS to the star.
• The error model can take into account known error estimates. If e_x1, e_y1, and e_z1, in equation (31) are the error components representing the misalignment between the ENU references, the rest of the errors can be combined into a single value by Root-Sum-Square (RSS) method. The RSS'ed values can be represented by their RMS values to better represent the effect of their random and bias parts (assuming that the random part of the error is represented by the noise filter floor). For the above assumptions, the elements of the error model for the skew symmetric error matrix can be represented as
• 
  a _x =e _xenu +e _xest
• where e_xenu is the actual ENU error along x-axis.
  e_xest=SQR(Σe_rms ²), is RSS of RMS values of known estimates of total systematic errors along the x-axis.
  e_xrms=SQR(σ²+b²), is RMS of systematic errors along x-axis
  where σ is random error and b is bias error
  Similarly, the a_y and a_z components are computed for the y-axis and Z-axis respectively.
• The ENU bias can be estimated. The A_SK matrix can be computed. The navigation data (latitude, longitude and UTC time) provided by the Aegis weapon control system (WCS) to the ephemeris computations is expected to be relatively noise-free. The star camera measurement noise attributable to vibration of the director can be reduced by additional filtering at the star tracker output. Since the star tracker camera is mounted on a space stabilized platform, and the residual ship motion occurs with a very large period, it can be assumed that all errors are constant within the sample interval of interest. Under those conditions, a batch least squares or averaging estimator should be sufficient to determine the alignment error between the ENU references. To compute the ENU misalignment, A_SK error matrix in equation (30) can be rewritten as:
• 
  A _SK =A _ENU +A _EST  (32)
• 
  Or
• 
  A _ENU =A _SK −A _EST  (33)
• where
  A_ENU is the skew symmetric error matrix representing misalignment of ENU references, and
  A_EST is the skew symmetric error matrix representing the non-ENU errors present in the star tracker measurements of the camera LOS. Those errors are assumed to remain constant over the batch sample.
• Since stars can be treated as stationary objects over the batch processing period and star tracker camera is mounted on the stable platform, a batch least squares or averaging process should be adequate for the determination of misalignment between the ENU references and for obtaining a “fix” sufficient for alignment of the ship's ENU reference. The correction of the ENU reference is applied as the small angle rotation matrix A_ENU to the coordinate transformations from the ship's-ENU-to-ECEF and ENU-to-ship-deck reference coordinates
• $\begin{array}{cc}{\stackrel{\_}{A}}_{\mathrm{ENU}}=1/N\sum _{i=1}^NA_{\mathrm{ENU},i}& \left(34\right)\end{array}$
• where
  A_ENU is the averaged value of the skew-symmetric error matrix over the batch interval of star tracker measurements.
  The estimated attitude correction required to align the ship E_SN_SU_S reference to the true geodetic E_RN_RU_R coordinates is obtained by the following coordinate transformation
• 
  (E _R ,N _R ,U _R)^T=(I+Ā _ENU)(E _S N _S U _S)^T
• where:
• I is the 3×3 unit matrix and T signifies transpose.
• As an example, the following transformation converts the target track data obtained in the ship ENU reference to the true local geodetic ENU coordinates
• $\begin{array}{cc}\left(\begin{array}{c}{X}_R^0\\ Y_R^0\\ Z_R^0\end{array}\right)=\left(I+{\stackrel{\_}{A}}_{\mathrm{ENU}}\right)\left(\begin{array}{c}{X}_S^0\\ Y_S^0\\ Z_S^0\end{array}\right)& \left(36\right)\end{array}$
• where:
• X_s ^o, Y_s ^o, and Z_s ^o is the target position measured in ship local ENU coordinates;
• X_s ^o, X_s ^o, and X_s ^o is the target position in local true (geodetic) ENU coordinates.
• Coordinate transformation from the local ENU to ship deck axes (T_o ^d) is given by
• $\begin{array}{cc}{T}_o^d=\left[\begin{array}{ccc}C\psi C\phi -S\psi S\theta S\phi & S\psi C\phi +C\psi S\theta S\phi & C\theta S\phi \\ -S\psi C\theta & C\psi C\theta & -S\theta \\ -C\psi S\phi +S\psi S\theta C\phi & C\psi S\theta C\phi -S\psi S\theta & C\theta C\phi \end{array}\right]& \left(37\right)\end{array}$
• where C=Cos, S=Sin and Ψ,θ,φ are ship attitude angles measured by the ship gyro.
• Coordinate Transformation from ship deck to director LOS axes (T_d ^los) is given by
• $\begin{array}{cc}{T}_d^{\mathrm{los}}=\left[\begin{array}{ccc}{\mathrm{CAz}}_d& -{\mathrm{Saz}}_d& 0\\ {\mathrm{SAz}}_d{\mathrm{CEl}}_d& {\mathrm{CAz}}_d{\mathrm{CEl}}_d& -{\mathrm{SEl}}_d\\ {\mathrm{SAz}}_d{\mathrm{SEl}}_d& {\mathrm{CAz}}_d{\mathrm{SEl}}_d& {\mathrm{CEl}}_d\end{array}\right]& \left(38\right)\\ {\mathrm{Az}}_d={\mathrm{Tan}}^{-1}\left(\mathrm{Xd}/\mathrm{Yd}\right)& \left(39\right)\\ {\mathrm{El}}_d={\mathrm{Tan}}^{-1}\left(\mathrm{zd}/{\left({\mathrm{<figure-callout\; id="2"\; label="Xd"\; filenames="US20080269965A1-20081030-D00004.png"\; state="\{\{state\}\}">Xd</figure-callout>}}^2+{\mathrm{Yd}}^2\right)}^{1/2}\right)& \left(40\right)\end{array}$
• where:
• Az_d, El_d are star LOS angles in deck reference axes; and
• Xd, Yd, Zd are star LOS vector components in deck coordinates.
• In operation of a ship inertial navigation system ENU calibration arrangement according to an aspect of the invention, a star tracker camera is mounted on a platform stabilized by the ship's inertial navigation system. In the context of an Aegis ship, the stabilized platform may be the illumination director. A star ephemeris program selects stars and provides data for computation of the camera pointing. The camera pointing in an Aegis context is provided by the fire control system (FCS). Ideally, the star tracker camera is capable of tracking stars in daylight, as well as at night. To determine the error due to ENU reference misalignment, the star tracker LOS vectors are determined from the star tracker measurements, and those LOS vectors are used to establish the unit vector attitude triad for comparison with the similar triad derived from the ephemeris data. The triads are related by a small angle rotation matrix. That matrix can be expressed as the sum of symmetric and skew-symmetric parts. The skew-symmetric part is used to estimate the ENU misalignment correction. The estimation may be by Batch Least Squares or Kalman Filter estimation process utilizing modeled non-ENU errors.
• Thus, a method according to an aspect of invention is for calibration of an attitude reference apparatus (16). The method comprises the steps of providing an inertial navigation system (16) for a surface (or surfaced) ship (10), which navigation system (16) provides local reference of ship's attitude relative to East, North, and UP. The method also includes the step of providing a star tracker camera (24) mounted on a platform (12) stabilized by the local reference of ship's attitude (16, 18). The star tracker (24, 30) compares azimuth (Az) and elevation (El) angles between lines-of-sight (LOS) between the star tracker (24, 30) and each of two selected stars, to thereby generate first and second azimuth (ΔAz) and elevation (ΔEl) difference angles. The line-of-sight of the star tracker is controlled in response to ephemeris (from 34) of the two selected stars. The azimuth and elevation difference angles (ΔAz, ΔEl) are processed to determine the star tracker local azimuth and elevation angle (equation 11) to thereby determine the star tracker attitude triad, (represented by the matrix (M_S)). The geodetic reference attitude triad matrix (M_R) is derived from the star local azimuth and elevation angles (Az, El) provided by the star ephemeris program. The M_S and M_R matrices are processed (Equations 25, 26) to determine A-matrix (which in general will be a small angle) representing the coordinate transformation between the M_S and M_R matrices. The A-matrix can be separated into the ENU reference and systematic error parts (Equation 27). The ship's ENU attitude calibration to true geodetic reference can be estimated (Equation 36) from the ENU error A_ENU by batch least squares or averaging process (equation 34) applied to a time sequence of A_ENU samples. The calibrated navigation system attitude is used as a reference for all sensed data relating to targets which is transmitted to other platforms.

Claims (6)

1. A method for calibration of an attitude reference apparatus, said method comprising the steps of:

providing an inertial navigation system for a surface ship, which navigation system provides local reference of the ship's attitude relative to East, North, and UP;

providing a star tracker mounted on a platform stabilized by said local reference of the ship's attitude, said star tracker being for comparing the azimuth and elevation angles between the line-of-sight of said star tracker and each of two selected stars, to thereby generate first and second azimuth and elevation differences;

controlling said line-of-sight of said star tracker in response to ephemeris of said two selected stars;

processing said azimuth and elevation angles to determine first and second vector triads representing ephemeris and the navigation system attitude;

processing said first and second triads to determine a coordinate transformation matrix;

separating said coordinate transformation matrix into systematic error and reference attitude error; and

combining the reference attitude error with the navigation system attitude to generate calibrated navigation system attitude.

2. A method for calibration according to claim 1, further comprising the steps of:

generating sensed data referenced to said calibrated navigation system attitude; and

transmitting said sensed data referenced to said calibrated navigation system attitude to a remote location.

3. A method according to claim 1, wherein said step of processing said azimuth and elevation angles to determine first and second vector triads representing ephemeris and the navigation system attitude comprises the steps of:

determining the star tracker local azimuth and elevation angles;

determining the star tracker attitude triad from the local azimuth and elevation angles; and

determining the geodetic reference attitude triad from ephemeris and the local azimuth and elevation angles.

4. A method according to claim 3, wherein:

said step of determining the star tracker local azimuth and elevation angles comprises computing

Az _s ^o =Az _e ^o +ΔAz _s ^o

El _s ^o =El _e ^o +ΔEl _s ^o  (11)

where:

ΔAz_s ^o is the azimuth difference angle measured by the star tracker between the star tracker line-of-sight to one star; and

ΔEl_s ^o is the elevation difference angle measured by the star tracker between the star tracker line-of-sight to that one star.

said step of determining the star tracker attitude triad from the local azimuth and elevation angles comprises computing

q=v

r=q×u/∥q×u∥

s=q×r  (20)

where

u, v are the unit LOS vectors to selected stars

q, r, s are unit vectors representing the orthogonal attitude triad

where

$\begin{array}{cc}v=\left[\begin{array}{c}X1\\ Y1\\ Z1\end{array}\right];u=\left[\begin{array}{c}X2\\ Y2\\ Z2\end{array}\right];q=\left[\begin{array}{c}{q}_x\\ q_y\\ q_z\end{array}\right];r=\left[\begin{array}{c}{r}_x\\ r_y\\ r_z\end{array}\right];s=\left[\begin{array}{c}{s}_x\\ s_y\\ s_z\end{array}\right],& \left(21\right)\\ X1=\mathrm{Cos}\left(\mathrm{Elv}\right)\mathrm{Sin}\left(\mathrm{Azv}\right)X2=\mathrm{Cos}\left(\mathrm{Elu}\right)\mathrm{Sin}\left(\mathrm{Azu}\right)Y1=\mathrm{Cos}\left(\mathrm{Elv}\right)\mathrm{Cos}\left(\mathrm{Azv}\right)Y2=\mathrm{Cos}\left(\mathrm{Elu}\right)\mathrm{Cos}\left(\mathrm{Azu}\right)Z1=\mathrm{Sin}\left(\mathrm{Elv}\right)Z2=\mathrm{Sin}\left(\mathrm{Elu}\right),& \left(22\right)\end{array}$

and said step of determining the geodetic reference attitude triad from ephemeris and the local azimuth and elevation angles is performed by computing attitude matrix M_R

$\begin{array}{cc}{M}_R=\left[\begin{array}{ccc}{q}_{\mathrm{Rx}}& r_{\mathrm{Rx}}& s_{\mathrm{Rx}}\\ q_{\mathrm{Ry}}& r_{\mathrm{Ry}}& s_{\mathrm{Ry}}\\ q_{\mathrm{Rz}}& r_{\mathrm{Rz}}& s_{\mathrm{Rz}}\end{array}\right]& \left(23\right)\end{array}$

and matrix M_S:

$\begin{array}{cc}{M}_S=\left[\begin{array}{ccc}{q}_{\mathrm{Sx}}& r_{\mathrm{Sx}}& s_{\mathrm{Sx}}\\ q_{\mathrm{Sy}}& r_{\mathrm{Sy}}& s_{\mathrm{Sy}}\\ q_{\mathrm{Sz}}& r_{\mathrm{Sz}}& s_{\mathrm{Sz}}\end{array}\right]& \left(24\right)\end{array}$

related by the transformation:

AM_R=M_S  (25).

5. A method according to claim 1, wherein said step of combining the reference attitude error with the navigation system attitude to generate calibrated navigation system attitude comprises the steps of computing matrix

$\begin{array}{cc}{\stackrel{\_}{A}}_{\mathrm{ENU}}=1/N\sum _{i=1}^NA_{\mathrm{ENU},i}& \left(34\right)\end{array}$

where

A _ENUi =A _SKi −A _EST, i=1 . . . n

for correcting the ship ENU to geodetic ENU.

6. A method for calibration of an attitude reference apparatus, said method comprising the steps of:

providing an inertial navigation system for a surface ship, which navigation system provides local reference of the ship's attitude relative to East, North, and UP;

providing a star tracker mounted on a platform stabilized by said local reference of the ship's attitude, said star tracker being for comparing the azimuth and elevation angles between the line-of-sight of said star tracker and each of two selected stars, to thereby generate first and second azimuth and elevation differences;

controlling said line-of-sight of said star tracker in response to ephemeris of said two selected stars;

processing said azimuth and elevation angles to determine first and second vector triads representing ephemeris and the navigation system attitude, respectively;

processing said first and second triads to determine a coordinate transformation matrix;

separating said coordinate transformation matrix into systematic error and reference attitude error;

generating sensed data referenced to said navigation system attitude; and

correcting said sensed data by said coordinate transformation matrix.

Images