The present invention relates to methods of navigation, and in particular, methods of avionic navigation.
Existing requirements for providing precision approach and landing navigation during flight for both commercial and military aircraft include accuracy, integrity, availability, and continuity of function. Traditionally, location determination incorporates the use of global positioning system (GPS)-based satellite navigation that can provide accuracy down to the centimeter level. Integrity of the navigation system is typically expressed in terms of confidence levels. The higher the confidence level, the more reliable the information provided. Availability and continuity provide assurances that the system will be available not only at the beginning of the operation, but throughout the entire duration of the flight.
Meeting these requirements is especially crucial for autonomous shipboard landings on seaborne aircraft carriers. Proposals of using GPS to generate relative navigation and guidance to meet these challenges can provide the accuracy and integrity required, however, a shipboard approach and landing is more demanding than typical land-based approaches and landings. Aircraft navigation systems used in a shipboard approach and landing must continue to meet the requirements listed above even at sea under severe weather conditions and demanding electromagnetic environments. This is particularly important when landing on an aircraft carrier, where vertical landing errors of more than 0.3 meters is unacceptable and can result in unsafe landing conditions.
Some of the factors to consider during autonomous shipboard landings are a lack of visibility, operating under combat conditions, and a dynamically changing touchdown point. Another factor to consider is that any type of navigational aid must include velocity determination, since both the aircraft and the aircraft carrier are in motion relative to one another. In addition to low rate GPS measurement data other, higher rate, measurements are needed in order to evaluate the relative state between aircraft and aircraft carrier, i.e., the aircraft's position and velocity with respect to the moving runway and touchdown point, as accurately as possible during a precision approach and landing. Existing navigational aids include using an inertial navigation system (INS) to measure the position and altitude of the approaching aircraft in conjunction with GPS. With a combination GPS/INS solution, the short-term measurement data from the INS, which is susceptible to drift errors over time, is corrected by the exact location and time references provided by satellite navigation. In addition, since INS operates in reference to the inertial movements of the system, it is immune to detection or jamming.
GPS-only methods of relative navigation, however, are susceptible to jamming (intentional) and interference (unintentional) which can severely impact the operation. For example, loss of the GPS navigational signal as the aircraft is nearing the landing area could result in a devastating loss. Moreover, current ship-based methods do not always provide a secure transmission link, leaving either the aircraft or aircraft carrier vulnerable to detection.
For the reasons stated above and for other reasons stated below which will become apparent to those skilled in the art upon reading and understanding the specification, there is a need in the art for an improved method of avionic navigation.
In one embodiment, a method for providing relative navigation between two objects includes receiving navigation information from the first object, receiving navigation information from the second object, integrating the navigation information from the first object with the navigation information from the second object to determine a relative velocity and a relative position between the first and second objects, and propagating the relative velocity and the relative position forward in time for navigation purposes.
In another embodiment, a method for guiding the approach and landing of an aircraft is provided. The method involves receiving navigation information from the aircraft, receiving navigation information from an aircraft carrier, integrating the navigation information from the aircraft with the navigation information from the aircraft carrier to determine a relative velocity and a relative position between the aircraft and the aircraft carrier, and propagating the relative velocity and the relative position forward in time for navigation purposes.
In yet another embodiment, a computer-readable medium having computer-executable program instructions for a method for determining relative position and relative velocity between an aircraft and an aircraft carrier as the aircraft approaches the aircraft carrier is provided. The method includes integrating the attitude and position of the aircraft carrier with the attitude and position of the aircraft, integrating the velocity of the aircraft carrier with the velocity of the aircraft, and constructing the reference trajectories for relative position and velocity.
In yet another embodiment, an on-board navigational system for an aircraft is provided. The system includes a first processor adapted to perform real-time computations necessary for recording absolute measurements of the aircraft's position and velocity, wherein the processor is further adapted to integrate position and velocity measurements with respect to the aircraft, a second processor adapted to perform real-time computations necessary for receiving position and velocity measurements from an aircraft carrier, wherein the processor is further adapted to estimate position and velocity errors with respect to the aircraft, estimate position and velocity errors with respect to the aircraft carrier, and estimate the relative position and velocity between the aircraft carrier and the aircraft, one or more position sensors coupled to the first processor, the sensors adapted to detect the position of the aircraft, one or more inertial sensors coupled to the first processor; the sensors adapted to detect the inertial movements of the aircraft, and a navigation avionics platform, coupled to both the first and second processors, wherein the platform is further adapted to provide ship state and GPS measurement data from the aircraft carrier to the second processor, and to receive relative navigation data from the second processor.
In accordance with common practice, the various described features are not drawn to scale but are drawn to emphasize features relevant to the present invention. Reference characters denote like elements throughout figures and text.
In the following detailed description, reference is made to the accompanying drawings that form a part hereof, and in which is shown by way of illustration specific illustrative embodiments in which the invention may be practiced. These embodiments are described in sufficient detail to enable those skilled in the art to practice the invention, and it is to be understood that other embodiments may be utilized and that logical, mechanical and electrical changes may be made without departing from the spirit and scope of the present invention. The following detailed description is, therefore, not to be taken in a limiting sense.
Embodiments of the present invention may be implemented with present navigation avionics technologies as well as current satellite guidance and other forms of navigation technology. This description is presented with enough detail to provide an understanding of the present invention, and should not be construed to encompass all necessary elements in an avionic navigation system.
Although the examples of embodiments in this specification are described in terms of aircraft approach and landing aboard aircraft carriers, embodiments of the present invention are not limited to applications of aircraft approach and landing aboard aircraft carriers. Embodiments of the present invention are applicable to any aircraft approach and landing activity that requires the use of relative navigation to supplement a precision approach and landing of an aircraft when standard navigational aids become momentarily disrupted or are no longer made available. Alternate embodiments of the present invention to those described below utilize a method of relative navigation to determine the relative position and velocity between an aircraft and an aircraft carrier than can be propagated forward in time for navigation purposes.
Referring to the drawings,
In operation, as aircraft 102 enters an area where it has access to the inertial and GPS measurement data of aircraft carrier 104, position and velocity measurements of aircraft 102 are recorded by aircraft EGI navigator 108 using ranging data sent by at least one navigational satellite 1061 through 106N. Aircraft EGI navigator 108 receives shipboard sensor data from shipboard EGI navigator 110. Aircraft EGI navigator 108 processes the airborne and shipboard measurement data to determine a relative velocity and position between aircraft 102 and aircraft carrier 104. By determining a relative velocity and relative position, successful autonomous landings can be achieved even during momentary absence of satellite navigational signals.
Inertial sensor assembly 202 is communicatively coupled to absolute navigation processor 218 by sensor measurement transfer medium 206. In one embodiment, sensor measurement transfer medium 206 uses the EIA standard RS-422 protocol, or the like. Navigation avionics unit 204 is communicatively coupled to absolute navigation processor 218 by navigation interface transfer medium 208. In one embodiment, navigation interface transfer medium 208 uses the interface standard MIL-STD-1553 Bus, or the like. Navigation avionics unit 204 is also communicatively coupled to SRGPS processor 214 by SRGPS input data transfer medium 210 and SRGPS output data transfer medium 212. In one embodiment, both SRGPS input data transfer medium 210 and SRGPS output data transfer medium 212 uses the interface standard MIL-STD-1553 Bus, or the like. Absolute navigation processor 218 and SRGPS processor 214 are communicatively coupled by application communication transfer medium 216. In one embodiment, application communication transfer medium 216 uses a 1 mega-bit (MB) synchronous data link control (SDLC) RS-422 serial interface, or the like. Absolute navigation processor 218 is also communicatively coupled to EGR 220 by EGR output data transfer medium 224 and EGR input data transfer medium 226. In one embodiment, both EGR output data transfer medium 224 and EGR input data transfer medium 226 use dual port random access memory (DPRAM), or the like. EGR 220 is also communicatively coupled to the plurality of navigational satellites 1061 through 106N of
In operation, EGR 220 receives current GPS measurement data of aircraft 102 of
In one embodiment, the absolute navigation processor 218 processes aircraft GPS data and aircraft INS data in the aircraft Kalman filter block 302. In one embodiment, the aircraft Kalman filter block 302 is a standard implementation of a Kalman filter within aircraft EGI navigator 108 of
In one embodiment, relative vector stabilization block 318 stabilizes the relative position and velocity vectors provided by relative navigation algorithm block 320 between the ship touchdown (TD) point and the aircraft guidance and control point (GCP). Due to the complicated motions of both aircraft carrier 104 and aircraft 102 of
In one embodiment, DD integer ambiguity resolution block 316 resolves DD integer ambiguities with navigation avionics system 200 of
In one embodiment, filter propagation error equations block 314 is used in the process of resolving DD integer ambiguities in conjunction with DD integer ambiguity resolution block 316. In one embodiment, filter propagation error equations block 314 utilizes GPS double differenced carrier phase measurements as observables in the RNKF 315, where the RNKF 315 receives absolute solution error state and covariance data from aircraft Kalman filter 302. In one embodiment, the RNKF 315 makes use of a ship motion sensor (SMS) provided by aircraft carrier 104 and uses coordinates referenced in Earth Centered Earth Fixed (ECEF) coordinate frames. The ECEF coordinate system has its origin at the Earth's center and rotates with the Earth. The Earth's equator defines the x-y plane, the x-axis is through the Greenwich meridian, and the z-axis is through the North Pole. The y-axis completes the right-handed system (Y=Z×X).
In one embodiment, there are two major modes of operation of the RNKF 315, float mode and fixed mode, along with sub-modes of the major modes. In the float mode, the RNKF 315 runs when less than 3 DD integer ambiguities (wide lane or single frequency) have been resolved, or GPS carrier measurements have been lost after integer lock, or a cycle slip has been detected. In one embodiment, errors in the estimate of the DD integer ambiguities are included as states in the RNKF 315 float mode. The measurements driving the RNKF 315 in the float mode will determine the sub-modes. In one embodiment, the sub-modes and the measurements in each sub-mode for the float mode of the RKNF 315 include code differential, or DD narrow lane (NL) code (when no carrier measurements are available), DD NL code and DD wide lane (WL) carrier (carrier differential float). In one embodiment, if GPS carrier measurements are lost but GPS code measurements remain, the RNKF 315 in the float mode runs in the code differential sub-mode; if both code and carrier DDs are lost, the RNKF 315 equations of motion are integrated, but no measurement updates are performed. In one embodiment, the RNKF 315 is initialized and operating in the float mode as soon as one full ship state message from aircraft carrier 104 has been received.
In one embodiment, the fixed operational mode of the RNKF 315 starts operating with the DD WL integers subtracted from the DD WL carrier measurements as observations. In one embodiment, the errors in the DD integers are no longer estimated as states in the RNKF 315, only carrier DDs are used for measurements. In one embodiment, if carrier lock is lost, or a cycle slip is detected, the RNKF 315 in the fixed mode continues to integrate its respective equations of motion using the aircraft and ship inertial measurements. In one embodiment, the RKNF 315 is operating in the float mode to estimate and fix integers again before resuming operation in the fixed mode with measurement updates. In one embodiment, the sub-modes with the RKNF 315 operating in the fixed mode are: wide lane DD integers fixed (but L1 and L2 integers not fixed), where DD WL carrier minus wide lane integers are used as observations; L1 DD integers fixed (but not L2), where DD L1 carrier minus DD L1 integers are used as observations; L2 DD integers fixed (but not L1), where DD L2 carrier minus DD L2 integers are used as observations; and both L1 and L2 DD integers fixed, where both DD L1 carrier minus DD L1 integers and DD L2 carrier minus DD L2 integers are used as observations. In one embodiment, there is complete error state feedback in the RNKF. In one embodiment, while the fixed RNKF is operating, the float RNKF is also operating and is used as a check on the fixed solution if the wrong set of integers were selected. In one embodiment, when both the float and fixed RNKFs are operating, the feedback correction vector is provided by the fixed RNKF.
The operating modes of RNKF 315 in one embodiment are listed below in order of increasing relative navigation performance:
In one embodiment, transitions between modes 1-4 listed above are determined by:
Concerning the data link between aircraft carrier 104 and aircraft 102, one of the four conditions described in Table 1 always exists (a ✓ indicates the item is present, a indicates the item is not present):
where ship code represents GPS pseudo-range measurements for aircraft carrier 104, and ship carrier represents GPS carrier phase measurements for aircraft carrier 104.
In one embodiment, the navigation modes 0-4 are evaluated under each of the conditions A-D in Table 1 above. The transition between modes determined by the fixing (or loss of fix) affects Modes 3 and 4. The violation of the position error tolerance affects the transitions between Modes 2/3 and 1/0. To transition from Mode 0 to Mode 3, ship state information and ship GPS code and carrier must be available. While all three of these items are available (data link condition D), the RKNF 315 continues to operate in Mode 3. If the RNKF operating in Mode 3 fixes the DD integer ambiguities, operation of the RNKF 315 transitions to Mode 4. If ship GPS carrier is lost (data link condition C), operation of the RNKF 315 transitions to Mode 2. If all ship GPS measurements are lost (data link condition B) operation of RNKF 315 remains in Mode 3. In Mode 3, the RNKF 315 measurement updates can no longer be performed, but the covariance matrix is propagated forward. If this condition persists, operation of RNKF 315 remains in Mode 3 until the relative position uncertainty becomes so large that remaining in Mode 3 is no better than differencing absolute positions, at which point operation of RNKF 315 transitions to Mode 1.
In one embodiment, when a complete data link dropout occurs (data link condition A) without ship state information, the ship state is propagated forward based on the last known state. The ability to propagate the ship state forward allows the aircraft 102 to complete an autonomous shipboard landing without detection from an ‘unfriendly’, i.e. unwanted detection of either aircraft 102 or aircraft carrier 104 by jamming the signals provided by navigational satellites 1061 through 106N. In this condition, the RNKF 315 does not perform measurement updates, and the RNKF 315 covariance matrix terms are allowed to grow indefinitely. When the position uncertainty becomes too great and the aircraft carrier 104 position is still not available, operation of the RKNF 315 transitions to Mode 0 and reports that no relative navigation solution is possible.
In one embodiment, the float Kalman filter states is decomposed into fixed states and integer states as shown in Equation 1:
and is further decomposed as shown in Equation 2:
In one embodiment, the states of the float RNKF are as shown in Table 2 below:
In Table 2 above, Nsv is the number of visible GPS satellites above elevation mask with valid measurements.
In one embodiment, multiple relative navigation filters are maintained depending on the present GPS/INS measurements and the operations being conducted. In one embodiment, there are three solutions possible once the aircraft 102 enters the landing system service volume and has access to the aircraft carrier 104 GPS/INS measurement data. In one embodiment, the solution types, their states and the required measurement data for each are shown in Table 3:
As shown in Table 3 above, the fixed solution refers to the solution resulting when the GPS double differenced carrier phase wavelength integer ambiguities are resolved, as mentioned in the description of DD integer ambiguity resolution block 316 above.
In one embodiment, GPS measurement processing block 304 is adapted to receive the aircraft GPS position measurement and a broadcast of an aircraft carrier GPS position measurement. In one embodiment, GPS code and carrier double differences, Δ∇p and Δ∇φ, are formed each epoch for at least two navigation satellites 1061 through 106N that aircraft 102 and aircraft carrier 104 are mutually tracking. In one embodiment, both sets of GPS data, i.e. the GPS data of aircraft 102 and aircraft carrier 104, are initially uncorrected for atmospheric effects, allowing common tropospheric and ionospheric correction techniques to be applied. In one embodiment, the use of the uncorrected sets of GPS data allows common mode atmospheric errors to be eliminated during the double differencing process in DD integer ambiguity resolution block 316 described above. In one embodiment, no single navigation satellite 1061 through 106N is used as the reference, avoiding potential problems should the reference be dropped from the measurement set.
In one embodiment, the DD code measurements from DD integer ambiguity resolution block 316 represent the projections of a baseline relative position vector calculated by relative navigation algorithm block 320. In one embodiment, geometric relationships of at least two of navigation satellites 1061 through 106N are considered prior to pairing for maximizing baseline observability as shown in GPS predicted measurement block 306, where the value of G represents the geometry matrix of least two of navigation satellites 1061 through 106N and the baseline (relative position vector). By avoiding the pairing of navigation satellites 1061 through 106N that occupy similar elevations and portions of the sky, the maximum projection of the baseline vector onto the rows of G can be achieved.
In one embodiment, the uncorrected GPS code and carrier double differences from GPS measurement processing block 304 are combined with the predicted GPS code and carrier double differences from predicted GPS measurement processing block at summation point 308. The combined GPS code and carrier differences are transferred to measurement update block 312 to form the code and carrier GPS measurement predictions. Measurement update block 312, in conjunction with equations of relative motion block 310 and filter propagation error equations block 314, provide the relative velocity and position vectors to relative vector stabilization block 318. This sequence of operations provides a relative navigation solution between the ship touchdown (TD) point and the aircraft guidance and control point (GCP).
In one embodiment, the information provided to equations of relative motion block 310 includes acceleration, velocity, and position of aircraft carrier 104. In one embodiment, this information is available at 20 Hz. Further in one embodiment, the acceleration data of aircraft carrier 104 is provided to equations of relative motion block 310 in the ship north, east, down (NED) frame. In one embodiment, aircraft 102 delta velocity and delta rotation angles are provided to equations of relative motion block 310. In one embodiment, aircraft carrier 104 velocity is integrated in ECEF coordinates. Further in one embodiment, the integration of aircraft 102 position, velocity, and attitude and aircraft carrier 104 position, velocity, and attitude is performed as shown in Equations 3 to 7 below. In one embodiment, the acceleration provided is as seen from the NED frame of aircraft carrier 104, which requires the use of the second term in Equation 5:
In Equations 3 to 7 above, R represents the position vector, V represents the velocity vector, ωAB represents the angular rate vector of coordinate frame B with respect to coordinate frame A, g(R) represents the gravity vector at location R (where R is vector from Earth's center), and CAB represents a direction cosine matrix (DCM) to transform a vector from coordinate frame A to coordinate frame B. Subscript a represents the aircraft, subscript b represents body frame, subscript i represents the inertial frame that travels with the Earth's center, but does not rotate with the Earth, i.e., appears non-rotating with respect to the stars, subscript s represents the aircraft carrier (ship), and superscript E represents the ECEF frame. In particular, ωiEE represents the angular rate of an ECEF frame with respect to an inertial frame, resolved in ECEF frame coordinates, the value of which is shown in Equation 8 as:
In one embodiment, where the cross product of a pair of 3-vectors is described as a×b=Ab, the following notation of Equation 9 will be used to describe a vector cross product:
and {a} represents the skew-symmetric 3×3 matrix formed from the vector a=[a1 a2 a3]T.
The expression A=diag(a) creates a 3×3 diagonal matrix A from a 3 vector a=[a1 a2 a3]T according to Equation 10:
The expression A=sym(a) creates a 3×3 symmetric matrix A from a 3-vector a=[a1 a2 a3]T according to Equation 11:
A floating point number x is expressed as x=int[x]+frac[x], where frac[x] is the portion of the number after the decimal point, and int[x]=x−frac[x]. The vector quantity X is coordinatized (or resolved) in any coordinate frame. If there are two coordinate frames A and B, the representation of X in each of these frames is written as XA and XB. In one embodiment, one representation is written in terms of the other with the use of the Direction Cosine transformation Matrix (DCM). The DCM that transforms a vector originally resolved in the A frame into a vector expressed in the B frame is CAB and the two representations are related by the expressions in Equation 12:
XB=CABXA XA=CBAXB CAB=(CBA)T Equation 12
The vector RA,PB represents the position vector of a point P as seen from an observer fixed in frame A, and coordinatized in frame B. Moreover, if two frames A and B have a common origin RA,P=RB,P=RP (coordinatized in any frame), 2 subscripts will not be used for a position vector. When the “from an observer fixed in frame” subscript is omitted, the point P is viewed from the origin of the frame in which it is expressed (the superscript) as RA,PA=RPA. The vector RA,PQA=RPQA=RQA−RPA represents the relative position vector pointing from P to Q coordinatized in frame A. Further, RPQA or RA,PQA is used to express a position vector pointing from P to Q.
The vector VB,PA represents the velocity vector of a point P, as seen from an observer fixed in the B frame, and resolved in the A frame. In one embodiment, the vector VB,PQA=VB,QA−VB,PA represents the relative velocity vector of point P with respect to point Q, as seen by an observer fixed in the B frame, and resolved in the A frame. In one embodiment, a relative velocity vector is also represented by VPQA=VA,PQA.
Initialization and update of the equations of relative motion is performed by measurement update block 312. The measurement update block 312 provides the reference trajectories Δ{circumflex over (R)}E and Δ{circumflex over (V)}E and updates the code and carrier GPS measurement predictions used in equations of relative motion block 310. In one embodiment, the aircraft carrier 104 and aircraft 102 GPS measurements are synchronous with the top of the GPS epoch (the GPS second, or a rate of 1 Hz) for ease in synchronization of aircraft carrier 104 and aircraft 102 GPS measurements. In one embodiment, the aircraft carrier 104 GPS measurements are synchronous with respect to the 20 Hz ship state information of aircraft carrier 104, and the aircraft 102 GPS measurements are asynchronous with respect to the aircraft state measurements. In one embodiment, aircraft carrier 104 and aircraft 102 GPS code measurements are available at 2 Hz on both GPS L1 and L2 frequencies. In one embodiment, aircraft carrier 104 and aircraft 102 GPS carrier measurements are available at 2 Hz on both GPS L1 and L2 frequencies. In one embodiment, the Kalman filters that are implemented in filter propagation error equations block 314 include feedback, and the parameters that are input into the integration routines are corrected; this includes sensor errors as well as the dynamic state errors of position, velocity, and attitude. In one embodiment, the aircraft inertial measurement unit (IMU) measurements ΔVab
Initialization of the relative position and velocity reference trajectories Δ{circumflex over (R)}E, and Δ{circumflex over (V)}E are initialized in measurement update block 312. In one embodiment, Δ{circumflex over (R)}E is initialized by using double difference narrow lane pseudo-range processing, described in detail below, to generate a least squares solution to the problem as shown in Equations 13 and 14:
Δ∇{tilde over (p)}NL=HΔRGPSE=DDEΔRGPSE
Δ{circumflex over (R)}GPSE(0)=(HTH)−1HTΔ∇{tilde over (p)}NL Equations 13 and 14
where p represents the GPS pseudo-range or code measurement, H represents the Kalman filter measurement connection matrix, E represents the matrix of unit vectors, DD represents the GPS double difference matrix, and subscript NL represents narrow-lane DD integer ambiguities. In one embodiment, the baseline vector of Equation 7 points from the GPS antenna of aircraft carrier 104 to the GPS antenna of aircraft 102. In one embodiment, initialize the vector that points from the ship SMS of aircraft carrier 104 to the aircraft EGI of aircraft 102 must be initialized by correcting Δ{circumflex over (R)}GPSE(0) for the two lever arms as shown in Equation 15:
Cb
where the direction cosine matrices (DCMs) Cb
The construction of DCM Aircraft Body Frame ba to Aircraft Local Frame La is shown below. In one embodiment, aircraft body frame ba is fixed in aircraft 102 with an x-axis through the aircraft nose, y-axis through the right wing, and a z-axis through the bottom of the aircraft. In one embodiment, aircraft local frame La is a locally level, wander azimuth frame, with z-axis pointing down; the angle between true North and the y axis of Na is the aircraft's wander angle. This is the local level frame implemented by the advanced configurable EGI, and some of the needed aircraft state information is in this frame. When the wander angle for the aircraft provided by the advanced configurable EGI is zero, this frame is an NED frame. The wander angle is defined in the positive sense by a clock-wise rotation about the Down axis, i.e. brings the North axis into the East axis. In one embodiment, this matrix depends on aircraft 102 pitch θa, roll φa, and platform heading (not true heading) ψa as shown in Equation 16:
The matrix CL
ψtrue=ψa+α Equation 17
where α is the wander angle from the ACE.
The construction of DCM Aircraft Local Navigation Frame La to ECEF Frame E is shown below. In one embodiment, this matrix depends on aircraft latitude la, aircraft longitude La, and the wander angle αa as shown in Equation 18:
In one embodiment, the matrix CEL
The construction of DCM Aircraft Body Frame ba to ECEF Frame E is shown below. In one embodiment, this matrix is constructed from the previous two DCMs as shown in Equation 19:
Cb
This matrix is used in Equation 10 above. In one embodiment, the matrix CEb
The construction of DCM Ship Body Frame bs to Ship NED Frame NEDs is shown below. In one embodiment, the ship body frame bs is fixed in aircraft carrier 104 with x-axis through the bow, y-axis through the starboard side, and the z-axis through the bottom of the aircraft carrier. It is also referred to as the ship keel frame. In one embodiment, this transformation is a function of ship pitch θs, roll φs, and true heading ψs,true as shown in Equation 20:
In one embodiment, the matrix CNED
The construction of DCM Ship NED Frame NEDs to ECEF Frame E is shown below. In one embodiment, this is a function of ship latitude ls and ship longitude Ls as shown in Equation 21:
In one embodiment, the matrix CENED
The construction of DCM Ship Body Frame bs to ECEF Frame E is shown below. In one embodiment, this DCM can be constructed from the previous two DCMs as shown in Equation 22:
Cb
This matrix is used in Equation 19 above.
Initialization of the relative position reference trajectory Δ{circumflex over (R)}E continues with receiving position and attitude data for aircraft 102 from absolute navigation processor 218. In one embodiment, the position and attitude data for aircraft carrier 104 is broadcast to absolute navigation processor 218 and is constructed by the transformation matrices discussed above.
In one embodiment, relative velocity vector Δ{circumflex over (V)}E is initialized by converting the ship velocity of aircraft carrier 104 from the NED frame to the ECEF frame and subtract from the aircraft velocity, already in ECEF and available from absolute navigation processor 218, as shown in Equation 23:
Δ{circumflex over (V)}E(0)={circumflex over (V)}aE−CNED
where the matrix CNED
In one embodiment, prior to updating the relative position and relative velocity, aircraft carrier 104 acceleration and aircraft 102 delta-V must be coordinatized in the ECEF frame. In one embodiment, aircraft carrier 104 linear acceleration ãsNED
ãsE=CNED
In Equation 24, the Coriolis term has been used. In one embodiment, the Coriolis term is a standard application of the Coriolis Law, or effect of inertia. The term ωE,NED
ωE,NED
where M is a matrix containing Earth curvature information and VsNED
In one embodiment, aircraft 102 delta-V, or dVL, is computed at a rate of 200 Hz on absolute navigation processor 218 and communicated to relative navigation algorithm block 320. In one embodiment, this change in velocity is coordinatized in ECEF, requiring one application of Coriolis and a coordinate transformation. In one embodiment, the continuous-time equation that relates Earth relative acceleration as seen from the local frame to Earth relative acceleration as seen from the ECEF frame is shown in Equation 26:
{dot over (V)}L=ĊELVE+CEL{dot over (V)}E={ωELL}CELVE+CEL{dot over (V)}E={ωELL}VL+CEL{dot over (V)}E Equation 26
This provides the expression for {dot over (V)}E as shown in Equation 27:
{dot over (V)}E=CLE({dot over (V)}L−{ωELL}VL) Equation 27
In one embodiment, absolute navigation processor 218 calculates dVL, the change in Earth relative velocity as seen from the local frame, over one IMU cycle. In one embodiment, this provides dVE as (adding the ‘a’ subscript for aircraft) shown in Equation 28:
dVaE=CLE(dVaL−{ωELL}VaLΔtrate1) Equation 28
In one embodiment, at any aircraft 102 time ta,i, dVaE(ta,i) represents the change in velocity from the last 200 Hz time mark to ta,i (or from ta,i−1 to ta,i) as seen from ECEF and coordinatized in ECEF. In one embodiment, referring back to the previous figure, 11 delta-Vs are summed from ta,1 to ta,11. In one embodiment, to account for the overlap of these delta-V's with aircraft carrier 104 times, and to synchronize the sum with aircraft carrier 104 times, the sum is adjusted by subtracting a portion of dVaE(ta,1) and dVaE(ta,11). The aircraft delta-V representing the change in aircraft ECEF velocity from ts,1 to ts,2 is shown in Equation 29:
where all the times are as defined in Equation 28. The aircraft delta-V is approximated from ts,1 to ts,2 as shown in Equation 30:
Once the aircraft carrier 104 acceleration and the aircraft 102 ΔV are coordinatized in the ECEF frame, the relative position and velocity measurements provided to equations of relative motion block 310 can be updated in measurement update block 312. The update of relative velocity uses previous relative velocity, aircraft carrier 104 acceleration at ts,1 and ts,2 and the summed aircraft 102 delta-V in the ECEF frame over that interval as shown in Equation 31:
Trapezoidal integration of the ship acceleration is used as shown in Equation 31. This is valid for instantaneous aircraft carder 104 accelerations at ts,1 and ts,2. For average aircraft carrier 104 acceleration over the same interval, the relative velocity measurement should be updated as shown in Equation 32:
Δ{circumflex over (V)}E(ts,2)=Δ{circumflex over (V)}E(ts,1)+dVaE(ts,2)−ãsE(ts,1)[ts,2−ts,1] Equation 32
where ãsE(ts,1) is the average acceleration over the interval ts,1 to ts,2. The relative position measurement provided to equations of relative motion block 310 is updated in measurement update block 312 using a trapezoidal integration routine as shown in Equation 33:
The relative position and velocity vectors are constructed in equations of relative motion block 310 by interpolating aircraft 102 position and velocity to the nearest appropriate aircraft carrier 104 time. In one embodiment, aircraft times ta,0 and ta,1 are the times immediately before and after ship time ts. Using linear interpolation, aircraft position and velocity at ship time ts are calculated as shown in Equations 34 and 35:
The relative position and velocity vectors at ship time ts are as shown in Equations 36 and 37:
ΔRE(ts)=RsE(ts)−RaE(ts)
ΔVE(ts)=VsE(ts)−VaE(ts) Equations 36 and 37
In one embodiment, the position, track and horizontal velocity measurements of aircraft carrier 104 are provided once every 5 seconds, and the relative navigation solution is estimated for the 20 Hz update between ship state broadcasts. If GPS signals are lost at aircraft carrier 104 or aircraft 102, updating the reference trajectories Δ{circumflex over (R)}E and Δ{circumflex over (V)}E, and constructing the code and carrier GPS measurement predictions will continue to be performed by relative navigation algorithm block 320 and provide a graceful degradation in the estimates of the relative position and velocity vectors.
At block 401, the method begins receiving navigation information from the aircraft, and the method proceeds to block 402. In one embodiment, the navigation information is GPS/INS measurement data from the aircraft's on-board navigation system. At block 402, the method begins receiving navigation information from the aircraft carrier, and the method proceeds to block 404. In one embodiment, the navigation information is a broadcast of GPS/INS measurement data from the aircraft carrier's on-board navigation system. At block 404, the navigation information gathered from the aircraft in block 400 and the navigation information gathered in block 402 is integrated to determine a relative velocity and relative position between the aircraft and the aircraft carrier. In one embodiment, velocity and position vectors are constructed for both the aircraft and aircraft carrier. The position vector of the aircraft is differenced with the position vector of the aircraft carrier to determine the relative position, and the velocity vector of the aircraft is differenced with the velocity vector of the aircraft carrier to determine the relative velocity. Once the relative velocity and relative position is determined, the method proceeds to block 406. At block 406, the relative velocity and relative position is propagated forward in time for navigation purposes.
In view of the foregoing, it will be understood by those skilled in the art that the methods of the present invention can be implemented in combination with present navigation avionics technology. Variations and modifications may occur, which fall within the scope of the present invention, as set forth in the following claims.
This invention was made with government support under contract no. F33657-99-C-2040 awarded by the United States Army/Navy Sea Based JPALS/SBJPALS EGI Program. The government has certain rights in this invention.
Number | Name | Date | Kind |
---|---|---|---|
4032759 | Danik | Jun 1977 | A |
4232313 | Fleishman | Nov 1980 | A |
5432520 | Schneider et al. | Jul 1995 | A |
5438337 | Aguado | Aug 1995 | A |
5488563 | Chazelle et al. | Jan 1996 | A |
5570097 | Aguado | Oct 1996 | A |
5638282 | Chazelle et al. | Jun 1997 | A |
5702070 | Waid | Dec 1997 | A |
5757317 | Buchler et al. | May 1998 | A |
6246960 | Lin | Jun 2001 | B1 |
6598009 | Yang | Jul 2003 | B2 |
6831599 | Morgan | Dec 2004 | B2 |
6836707 | Sowada et al. | Dec 2004 | B2 |
20020029110 | Fukuda et al. | Mar 2002 | A1 |
20020033769 | Bass et al. | Mar 2002 | A1 |
20020050943 | Toda et al. | May 2002 | A1 |
20020120400 | Lin | Aug 2002 | A1 |
20020196185 | Bloy | Dec 2002 | A1 |
20030040852 | Green et al. | Feb 2003 | A1 |
20030154049 | Toda | Aug 2003 | A1 |
20040036650 | Morgan | Feb 2004 | A1 |
20050055143 | Doane | Mar 2005 | A1 |
20050114023 | Williamson et al. | May 2005 | A1 |
20050211083 | Waid et al. | Sep 2005 | A1 |
20060074558 | Williamson et al. | Apr 2006 | A1 |
Number | Date | Country | |
---|---|---|---|
20070016371 A1 | Jan 2007 | US |