NAVIGATION MODE SELECTION APPARATUS

Abstract: An aircraft navigation system supporting a plurality of navigation modes. An error estimator (l7) for each navigation mode (l0-l6) provides an estimated navmode error signal representative of an estimate of the error in the position signal generated by the associated navmode. A navigation mode selector (l9) enables the navmode having the smallest estimated navmode error signal that is consistent with procedure specified navaid criteria. The navmode computed position signal is processed through a low pass position filter (26). The estimated navmode error signal associated with the selected navmode is processed through a low pass position error filter (28) having the same time constant as the low pass position filter (26) to provide an estimated position error. The estimated position error is utilised to correct INS and DEAD RECKONING navigation as well as to set a threshold for navigation sensor data validation.

Description: The invention relates to a navigation system according to the preamble of claim 1 particularly with respect to multiple mode, multiple sensor area navigation systems (RNAV) for aircraft. Navigation systems for aircraft traditionally utilise a plurality of navigation sensors (navaids) and operate in a plurality of navigation modes (navmodes). For example, radio aids such as FOR (VHF Omni Range) and DME (Distance Measuring Equipment) for airport-to-airport navigation and localisers for terminal guidance are utilised. The aircraft is often equipped with onside (leftside) radio receivers and offside (rightside) receivers for these radio navaids. Additionally, the navigation system aboard present day aircraft often includes an inertial navigation system (INS) or an inertial reference system (IRS). Such navigation systems operate in a plurality of modes variously utilising the navaid sensor complement. Such traditional modes include RHO-RHO, BEELINE, RHO-THETA LEFT, RHO-THETA RIGHT, LOCALIZER LEFT, LOCALIZER RIGHT, INS and DEAD RECKONING. In RHO-RHO and BEELINE navigation, the aircraft position is determined utilising two DME distances where each DME sensor provides range from a known reference point. In the RHO-THETA LEFT navigation mode, the aircraft position is generated utilising the VOR bearing and DME distance from a known reference point, the bearing and distance data being provided by the leftside VOR and DME sensors. The RHO-THETA RIGHT navigation mode is similar to the RHO-THETA LEFT mode except that the bearing and distance data is provided by the rightside VOR and DME sensors. In the LOCALISER modes, lateral displacement from a localiser beam is provided by beam error data from the onside or offside localiser in accordance with the navigation mode utilised. In the INS navmode, the aircraft position is set equal to the position output of the INS. In the DEAD RECKONING mode, the aircraft position is set equal to the position determined from the DEAD RECKONING algorithm utilised. Such multiple-mode, multiple-sensor navigation systems traditionally select the sensors and modes to be utilised in position computations in accordance with a predetermined procedure. In the prior art, a fixed hierarchy of priorities is established for navigation mode selection and sensor usage. For example, in an aircraft navigation system, having two VOR/DME sensors and one inertial navigation unit, the hierarchy of navigation modes and sensor usage might be established in the following order: RHO-RHO, RHO-THETA LEFT, RHO-THETA RIGHT, and INS. For each navigation mode and sensor combination, a set of minimum requirements must be fulfilled before the mode is effected. For example, RHO-THETA LEFT navigation cannot be enabled without valid bearing and distance data from the left-side colocated VOR/DME navaid. Essentially, in prior art multiple-mode, multiple-sensor navigation systems, the navigation mode and sensor combination having the highest priority for which minimum requirements are fulfilled is selected. It was assumed in the prior art that the fixed hierarchy selection would result in the navigation mode and sensor combination providing the optimum position estimate. It has been determined, however, that under commonly occurring conditions, this assumption is incorrect whereby inaccurate navaid data is utilised even though more accurate data is available. For example, the performance of the system described above, in a typical departure scenerio for a commercial airliner is considered. Immediately prior to take-off, the flight crew aligns the INS. Shortly after the aircraft becomes airborne, the leftside VOR and DME sensors receive valid radio navigation distance and bearing data from a single distant VOR/DME station. Under the fixed hierarchy described above, the RHO-THETA LEFT mode is selected as the highest priority navigation mode. This is undesirable because RHO-THETA navigation performed using a distant VOR/DME station typically results in a position computation that is less accurate than the position provided by a recently aligned INS. The INS, however, tends to drift with time. It is very accurate at the beginning of a flight, but tends to become increasingly more inaccurate as time increases. Therefore, if a long period of time has elapsed since the INS was last aligned or corrected, resulting in a degradation in the accuracy of the INS system, RHO-THETA navigation may or may not provide a more accurate position estimate at that time. Additionally, if for example, the prior art system is performing RHO-RHO navigation when criteria for RHO-RHO navigation can no longer be fulfilled, the system reverts to RHO-THETA navigation, providing RHO-THETA criterial can be met. However, under these conditions, a more accurate position estimate is achievable by utilising the radio corrected INS or DEAD RECKONING, for at least a short time, from the last RHO-RHO computed position. These shortcomings of the prior art fixed hierarchy procedure result from the failure to make optimum usage of the navigation modes and sensors in the sense of minimising the value of estimated position error. The fixed hierarchy procedure does not take into account that the quality of a particular navigation mode and sensor combination is not static but varies dynamically as a function of time, position and other variables. Thus, prior art navigation systems compute aircraft position utilising inaccurate radio navaid data, even when a on-board inertial navigation system is providing a more accurate position. In addition, EP-A-61674 discloses a guidance system for an automotive vehicle which automatically switches from a navigational electromagnetic wave signal mode to a dead reckoning mode when any one of the field strengths of three navigational wave signals drops below a predetermined level, and automatically switches back to the navigational electromagnetic wave signal mode when the field strengths of three navigational signals all exceed the predetermined level. This system does not disclose the determination of an estimated error signal in any of the three modes. The shortcomings of prior art navigation systems are overcome by the navigation system, implemented in accordance with claim 1, capable of operating in multiple navigation modes, each mode utilising appropriate navigation sensors. The invention is defined in the appended claims and includes means for generating the expected or estimated navmode position error for each of the navigation modes and means for selecting the navigation mode having the smallest value of the estimated navmode error consistent with procedure specified navaid criteria. The invention further includes means for generating the aircraft position pursuant to the selected mode with a low pass, slow-in position filter processing the position data provided by the selected mode. The position filter prevents undesired instantaneous changes in aircraft position output when switching from one navigation mode to another. An identical filter is utilised to process the estimated navmode error for the selected mode to obtain an estimated position error that provides an estimate of the magnitude of the difference between the output position of the navigation system and the true aircraft position. This estimated position error is utilised to estimate the navmode errors to compute a correction factor for correcting the INS and DEAD RECKONING navigation modes. Thus, the INS and DEAD RECKONING systems are corrected for long-term drift while still utilising the excellent short-term performance thereof. The estimated position error is also utilised for sensor data validation in the performance of data reasonableness tests. The data reasonableness tests are performed by requiring that the difference between estimated sensor data based on assumed position calculated by the navigation system and actual sensor data which is a function of true position be below a threshhold. The threshhold is selected as a function of estimated position error, thereby permitting lower thresholds to be utilised than were possible in the prior art. The invention, therefore, provides an improved ability to reject bad sensor data by utilising more stringent data reasonableness tests. Thus, the navigation system implemented in accordance with the present invention provides a more accurate position output than was possible in the prior art by recognising the dynamic quality of navigation mode/sensor combinations; generating the estimated value of the mode/sensor error for each combination and implementing the navmode with the smallest value of estimated error consistent with procedures specified for the navaids. A navigation system in accordance with the present invention will now be described in greater detail, by way of example, with reference to the accompanying drawings, in which:- Figure 1 is a schematic block diagram of a navigation system implementing the concepts of the present invention, Figure 2 is a graph of the function utilised to estimate the navmode error for the MULTIRHORHO and BEELINE navigation modes, Figure 3 is a graph of the function utilised to estimate the navmode error for the RHO-THETA navigation mode, Figure 4 is a graph of the function utilised to estimate the navmode error for the INS navigation mode, Figure 5 is a graph of the function utilised to estimate the navmode error for the DEAD RECKONING navigation mode, Figure 6 is a diagram illustrating the position computation for the RHO-RHO navigation mode, Figure 7 is a diagram illustrating the position computation for the BEELINE navigation mode, Figure 8 is a diagram illustrating the position computation for the RHO-THETA navigation mode, Figure 9 is a graph of the estimated navmode error versus time for each of a plurality of navigation modes in accordance with an illustrative scenario, and Figure 10 is a graph of the estimated navmode error for the selected mode versus time, and estimated position error versus time corresponding to the scenario depicted in Figure 9. Referring to Figure 1, a multiple-mode, multiple-sensor navigation system implementing the concepts of the present invention is illustrated. The system of Figure 1 is capable of operating in a plurality of distinct navigation modes, each navmode utilising appropriate navigation sensors. A plurality of navmode error estimators 10-16 provide estimated navmode position error signals associated respectively with the navmodes supported by the system. The estimated navmode error signals from the estimators 10-16 are applied to a navigation mode selector 17 which is also responsive to signals representative of FAA (U.S. Federal Aviation Authority) procedure specified navaid criteria. The navigation mode selector 17 selects the navigation mode having the lowest value of estimated navmode error which is consistent with the FAA procedure specified navaid criteria signal. The navigation mode selector 17 provides a select navmode signal on a lead 18 representative of the selected navmode. The signal on the lead 18 is applied to an aircraft position computation block 19 wherein aircraft position is computed in accordance with the selected navmode. In the illustrated embodiment of the present invention, the aircraft position computation block 19 provides the following navmodes: RHO-RHO, RHO-THETA, LOCALISER, INS, AND DEAD RECKONING as indicated by the reference numerals 20-24 respectively. It will be appreciated that the signal on the lead 18 selects one of the computations 20-24 in accordance with the outputs of the error estimators 10-16 and the FAA procedure specified navaid criteria signal applied to the navigation mode selector 17. Each of the navmode computations 20-24 is responsive to appropriate sensor data and information from the navigation data base for computing the aircraft position in accordance with the selected navmode. The computed aircraft position signal is provided on a lead 25 via a low pass position filter 26. The low pass position filter 26 implements a slow-in type of function whereby abrupt changes in computed aircraft position cannot occur when switching navigtion modes. Although the position filter 26 is illustrated at the output of the aircraft position computation block 19, it will be appreciated that the filtering may alternatively be provided within the blocks 20-24 to the same effect. The navigation mode selector 17 provides the estimated navmode error on a lead 27 generated by the error estimator 10-16 associated with the selected navmode. The estimated navmode error signal on the lead 27 is processed through a low-pass position error filter 28 to provide an estimated position error signal on a lead 29. The position error filter 28 has the same time constant as the position filter 26 and has a transfer function of the form [a/s+a)]. The estimated position error on the lead 29 is an accurate estimate of the probable error in position at any given time. It will be appreciated that there is a distinction between the estimated navmode errors and the estimated position error on the lead 29. Navmode errors are associated with a particular navigation mode and are the outputs of the error estimators 10-16. Position error is the estimate of the magnitude of the difference between the position computed by the system of Figure 1 and the actual aircraft position. The estimated position error on the lead 29 is utilised in the calculation of INS and DEAD RECKONING correction factors and in the computation of the estimated navmode errors for the INS error estimator 15 and the DEAD RECKONING error estimator 16 so as to correct the INS and DEAD RECKONING navigation modes in a manner to be described. The estimated position error on the lead 29 is also utilised to perform sensor data validation via data reasonableness testing in a block 30 which is also responsive to the computed aircraft position on the lead 25. Data reasonableness tests are performed on the raw VOR and DME data applied as input to the block 30 to provide validated VOR and DME data to the outputs thereof in a manner to be explained. Referring to Figure 2 but with continued reference to Figure 1, the error estimator 10 provides the estimated MULTIRHORHO navmode error for the MULTIRHORHO navmode. The error function for the MULTIRHORHO navmode error is illustrated in Figure 2. The MULTIRHORHO navmode utilises signals received from plural DME stations. Preferably ARINC 709 scanning DME equipment provides the DME information required to perform the MULTIRHORHO navigation. Errors in position computation utilising MULTIRHORHO navigation are a function of the error models for each DME, the number of DME stations utilised and the geometry. For simplicity, the MULTIRHORHO error estimation may be performed solely as a function of the number of DME stations being utilised. If less than two usable DME stations (RHORHO case) are available, or geometry requirements are not met, the error estimator 1O sets the estimated navmode error to an arbitrarily large value. Otherwise, the error estimator 1O sets the estimated navmode error to O.5 nautical miles (NM) for two usable DME stations and decreases the estimated error to O.325 NM for five usable DME stations. A usable DME station is one that is validated by passing the data reasonableness tests of the block 30 and that meets minimum DME range criteria. A suitable range criterion is that the distance from the DME station to the aircraft is greater than 1.94 times the estimated position error on the lead 29. It will be appreciated from Figure 2 that the error function is non-linear. This non-linearity results because each additional usable DME station provides a marginal decrease in error which is smaller than the decrease provided by the addition of the previous DME station. BEELINE navigation may be utilised in the system of the present invention instead of MULTIRHORHO navigation. The estimated BEELINE navmode error is derived in the same manner as the estimated MULTIRHORHO navmode error except that the error is also a function of an initial position estimate and the number of iterations performed. The BEELINE error estimation may also be simplified by utilising solely a function of the number of DME stations. The error function of Figure 2 is additionally applicable to the BEELINE navmode error. Referring to Figure 3 but with continued reference to Figure 1, the error estimators 11 and 12 provide the estimated RHO-THETA navmode error for the RHO-THETA LEFT and RHO-THETA RIGHT navmodes, respectively. The error function for the estimated RHO-THETA navmode error is provided in Figure 3. Thus, it will be appreciated that the present embodiment supports two RHO-THETA navigation modes, RHO-THETA utilising the onside VOR and RHO-THETA utilising the offside VOR. In both modes of navigation, the ARINC 709 scanning DME provides the DME information required to perform the RHO-THETA navigation. The estimated RHO-THETA navmode error provided by the error estimator 11 is a function of the distance of the aircraft to any type of navaid tuned on the left radio. Similarly, the estimated RHO-THETA navmode error provided by the error estimator 12 is a function of the distance of the aircraft to any type of navaid tuned on the right radio. The error estimators 11 and 12 provide their respective estimated navmode error signals for the RHO-THETA LEFT and RHO-THETA RIGHT navigation modes. The error estimates for RHO-THETA navigation utilising the onside or offside VOR/DME are generated as follows. If the navigation radio receiver is tuned to a navaid that has a VOR only, or if the receiver is tuned to a VOR/DME navaid, but the VOR and DME are not both valid, the estimated navmode error is set to an arbitrarily large value. Otherwise, the estimated navmode error is computed as follows: ΔP = {(ΔR)² + [R (Δ⊖]²} 1/2 Where ΔP = Position Error (NM) R = DME ground range (NM) ΔR = DME range error (NM) Δ⊖ = VOR bearing error (RADIANS) If DME errors are assumed to be negligible, then ΔP = R (Δ⊖) Where Δ⊖ = O.O61 RADIANS or 3.5° The error estimator 12 of Figure 1 for computing the estimated navmode error for the RHO-THETA offside navmode adds a small positive bias to the estimated navmode error. This assures that if both the onside and offside receivers are tuned to the same navaid, the system will select the onside VOR receiver when performing RHO-THETA navigation. If the VOR receivers are tuned to different VOR stations, the system includes means (not shown) for selecting the closest valid VOR/DME when performing RHO-THETA navigation. With continued reference to Figure 1, the error estimator 13 provides the estimated navmode error for the LOCALISER LEFT navigation mode as a function of meeting minimum requirements for LOCALISER updating on the left. Similarly, the error estimator 14 provides the estimated navmode error for the LOCALISER RIGHT navmode as a function of meeting the minimum requirements for LOCALISER updating on the right. The LOCALISER navmode provides very accurate navigation during final approach and missed approach procedures. The criteria that must be achieved before LOCALISER navigation can be performed are very stringent, but when these criteria are met, LOCALISER navigation can provide navigational accuracy of better than O.1 NM. The estimated navmode error function for LOCALISER LEFT navigation or LOCALISER RIGHT navigation is generated utilising the following process. The estimated navmode errors for both onside and offside LOCALISER navigation are set to an arbitrarily large value and the estimated navmode error for onside LOCALISER navigation is generated as follows. If there is a procedure specified LOCALISER and it is tuned and valid on the instrument landing system (ILS) receiver, and the aircraft position is within 20 NM of the LOCALISER, and the bearing from the aircraft position to the LOCALISER is within ten degrees of the LOCALISER centre beam, and the aircraft track is within thirty degrees of the LOCALISER centre beam, and the LOCALISER deviation is less than 1.25 degrees; then the estimated navmode error for the onside LOCALISER navmode is set to O.1 NM. If any of these conditions are not met, the estimated navmode error remains at the arbitrarily large value. If, after the above LOCALISER error function is invoked, the estimated navmode error for onside LOCALISER navigation remains at the maximum value, then the estimated navmode error for offside LOCALISER navigation is generated utilising the same function. Otherwise, the estimated navmode error for offside LOCALISER navigation remains at the maximum value. This procedure ensures that offside LOCALISER navigation will never be performed when onside LOCALISER navigation is possible. Referring now to Figure 4 with continued reference to Figure 1, the error estimator 15 generates the estimated INS navmode error as a function of the estimated position error signal on the lead 29, the inertial navigation system error, the inertial navigation system drift rate, and the inertial navigation system alignment time. The error function for the estimated INS navmode error (with last known radio or flight crew correction) is illustrated in Figure 4. Specifically, the estimated navmode error function for the corrected INS navigation mode is generated in the following manner. When the flight crew (pilot or navigator) aligns the INS, the alignment is assumed to be fairly accurate and the estimated INS navmode error is initialised to an appropriate small value, for example, 0.5 NM. Thereafter, if the estimated position error on the lead 29 is less than the current estimated INS navmode error provided by the error estimator 15, the estimated INS navmode error is set to the estimated position error, thereby providing a recomputed INS correction bias. If, however, the estimated position error on the lead 29 is not less than the current estimated INS navmode error, the estimated INS navmode error is increased at the drift rate of the INS, for example 2 NM/HR. It will be appreciated that in accordance with the present invention, the estimated position error on the lead 29 is utilised by the INS error estimator 15 to provide an INS correction bias to be utilised in the block 23 to correct the INS position, In this manner, the excellent short-term characteristics of the INS system are utilised corrected for long-term INS drift. If, however, radio correction to the INS has been washed out, as is done during transit through regions in which no radio navaids are available, then the estimated INS navmode error will be set to: 2 NM + [2 NM/HR x (time in hours since alignment)] If the navigation system is not equipped with an INS, or if the INS has failed, the estimated INS navmode error is set to an arbitrarily large value. Referring now to Figure 5 but with continued reference to Figure 1, the error estimator 16 provides the estimated DEAD RECKONING navmode error in accordance with a function of the estimated position error on the lead 29, the DEAD RECKONING error, and the DEAD RECKONING drift rate. The error function for the estimated DEAD RECKONING navmode error (from last known position or with last known radio correction) is illustrated in Figure 5. The estimated navmode error function for DEAD RECKONING is similar to the estimated INS navmode error function described above except that instead of utilsing INS drift rate, a higher "DEAD RECKONING drift rate" is utilised. If the current value of estimated position error on the lead 29 is less than the estimated DEAD RECKONING navmode error, then the estimated DEAD RECKONING navmode error is set to the estimated position error. The DEAD RECKONING estimated navmode error is increased from the previous value at the appropriate DEAD RECKONING drift rate as determined by the curve of Figure 5. The dashed line curve of Figure 5 represents the assumption that the estimated navmode error is increased from the previous value at the rate of the expected average difference between the last known winds and the actual winds during the time that the system is in the DEAD RECKONING mode. Alternatively, the solid line curve of Figure 5 represents the assumption that the longer the aircraft DEAD RECKONS, the less accurate the wind estimate becomes. Therefore, when the DEAD RECKONING error is small (previous navmode was good and therefore the derived wind estimate is good), the drift rate is low, for example 20 NM/HR. When the DEAD RECKONING error is large (previous navmode was not good and therefore the wind estimate may be questionable or the aircraft has been DEAD RECKONING with an old wind estimate), the drift rate is high, for example 125 NM/HR. DEAD RECKONING may be considered as an economy INS or, alternatively, an INS can be considered as a very accurate DEAD RECKONING system. With continued reference to Figure 1, the navigation mode selector 17 selects the navmode having the minimum estimated navmode error that satisfied any procedure specified requirements. If, for example, the FAA prohibits the use of a particular VOR, the VOR navmodes are not enabled. Specifically, the navigation mode selector 17 tentatively selects the navigation mode having the lowest value of estimated navmode error. If there is a procedure specified navaid for the active leg, and the tentatively selected navigation mode does not utilise the procedure specified navaid, the navigation mode selector 17 attempts to identify a valid navigation mode having the lower value of estimated navmode error and which satisfies the procedure specified requirements. If such a mode is identified, it is selected. If a navigation mode satisfying the procedure specified requirements cannot be identified, or if there is not a procedure specified navaid for the active leg, then the tentative navigation mode is selected. It will be appreciated from the foregoing, that if an active leg has a procedure specified navaid, radio navigation utilising the procedure specified will be performed, if possible. It will also be appreciated that estimate navmode errors for RHO-THETA navmodes contain an offside bias so that when both left and right radios are tuned to the same navaid, the aircraft will navigate utilising onside data. Furthermore, it will be appreciated that offside LOCALISER navigation will not be performed when onside LOCALISER navigation is possible. As discussed above, the estimated position error signal on the lead 29 is utilised in the generation of the estimated navmode errors for the DEAD RECKONING and INS navmode error estimators. The estimated position error is also utilised in driving the data reasonableness tests implemented in the block 30. The data reasonableness tests are tightened or expanded in accordance with the confidence in position represented by the estimated position error signal. The data reasonableness tests for DME distance data may be implemented whereby the DME data is validated if: |DIST DME - DIST APRX | < ESTIMATED POSITION ERROR Where: DIST DME = The actual distance from the DME to the true position as obtained from the input DME data, and DIST APRX = The distance from the DME to the navigation system position as provided on the lead 25. The data validation tests for the VOR data is implemented in the block 30 whereby the VOR data is validated if: |DRG VOR - BRG APRX | < [(ESTIMATED POSITION ERROR/DIST APRX ) x (180/π)] Where: BRG VOR = The magnetic bearing as received from the VOR, and BRG APRX is the expected bearing from the VOR to the navigation system position as provided on the lead 25. Generally the estimated position error signal on the lead 29 is a measure of the error in the computed aircraft position at any time. If the position data provided by the VOR or DME is greater than this error, the data is considered invalid and the affected navmodes are disabled. It will be appreciated that similar data reasonableness tests may be derived and utilised for other navigation sensors. As described above, the estimated position error signal on the lead 29 is utilised to provide a correction factor for the INS and DEAD RECKONING navigation modes as well as in determining the validity threshold in the data reasonableness tests block 30. The estimated position error may also be utilised to set the minimum DME range of criteria to assure conversion of the BEELINE navmode. Navigation systems utilising the RHO-RHO navmode generally have a minimum leg length requirement that could be made less restrictive if it were a function of estimated position error. The estimated position error signal may also be utilised in installations having dual navigation systems for system-to-system position comparisons. Additionally, the estimated position error may be displayed to the pilot or navigator as a measure of navigation system performance. With continued reference to Figure 1, the aircraft position computation block 19 provides computed aircraft position in response to appropriate navigation sensor data and information from the navigation data base. Although it is not shown for simplicity, the aircraft position computation block 19 is responsive to VOR data from the left and right VOR receivers, DME data from the left and right DME receivers, LOCALISER data from the left and right LOCALISER receivers and INS data from the INS system. The aircraft position computation block 19 is also responsive to the estimated navmode error from the error estimator 15 for providing a radio correction bias for the INS position as well as to the estimated navmode error from the error estimator 16 for providing a position correction in the DEAD RECKONING computation. The position computation blocks 20-24 utilise conventional procedures for providing computed aircraft position, numerous suitable procedures being available in the art for use in the present invention. For example, a MULTIRHORHO procedure for use in block 20 may be implemented as follows. The ARINC 709 DME equipment provides 1O possible navaid pair permutations and the MULTIRHORHO procedure selects two DME navaids. When more than one navaid pair is usable, a different pair is selected every time MULTIRHORHO is executed. MULTIRHORHO defaults to RHO-RHO navigation with one navaid pair. A RHO-RHO navigation procedure is diagrammed in Figure 6. Given two DME facilities, with known locations, elevations, slant range from each of the facilities to the aircraft and the aircraft altitude, aircraft position is determined as follows. Slant range, station elevation and aircraft altitude are utilised to compute ground ranges D1 and D2. The two DME facilities and their associated ground ranges determine two circles which intersect at points P1 and P2. The aircraft position is either at P1 or P2. The ambiguity is resolved by comparing the bearing from DME1 to P1 with the bearing from DME1 to the last estimate of aircraft position. If the difference between these bearings is less than 30 degrees, P1 is assumed to be the actual aircraft position, otherwise, P2 is assumed to be the actual aircraft position. The angle THETA is restricted to be in the range 3O to 15O degrees. With this restriction, the procedure provides the correct position provided that D1 and D2 are both greater than 1.94 times the difference between the estimated position and actual aircraft position. In a manner well appreciated in the art, BEELINE navigation may be utilised instead of MULTIRHORHO or RHO-RHO navigation. Referring to Figure 7, several iterations of the BEELINE procedure are illustrated. It will be appreciated that on each successive iteration, the computed aircraft position becomes closer to the actual aircraft position. Given a DME distance to each of two or more DME ground stations, each having a known location and an initial position estimate P(N), position updates are generated by the BEELINE procedure as follows: 1. Generate the bearing B(N+1) from DME(N+1) to the initial position estimate P(N). 2. Obtain D(N+1) from the DME data. D(N+1) is the true distance from DME (N+1) to the actual aircraft position. 3. Utilise the bearing B(N+1) and the distance D(N+1) in a direct Sodano's geodesic equation to compute P(N+1), which is a new estimate of aircraft position. 4. Repeat steps 1-3 utilising a different DME station. Referring now to Figure 8, a RHO-THETA navigation procedure is illustrated. Given the co-located DME and VOR facility of known position and elevation, the VOR bearing, the DME slant range and the altitude of the aircraft, the aircraft position is computed as follows. The DME slant range is converted to ground range and the magnetic variation for the VOR location is added to the VOR bearing to convert the VOR bearing to a true bearing. The computed aircraft position P1 is then generated utilising Sodano's geodesic equations. In operation of the navigation system disclosed herein, an illustrative flight scenario will be described. Referring to Figures 9 and 10, the estimated navmode error and the estimated position error for the flight plan is illustrated. It will be appreciated that the flight plan is not "typical", but rather an example constructed to illustrate transitions between the navigation modes supported by the embodiment described above. During a typical commercial service flight, it is expected that the selected navmode will be MULTIRHORHO or BEELINE over most of the flight with occasional reversions to INS (or DEAD RECKONING for non-INS equipped aircraft). The estimated navmode error diagram of Figure 9 and the estimated position error diagram of Figure 10 illustrate the flight scenario wherein various navigation modes and sensor combinations are selected. Figure 9 illustrates the estimated navmode errors for each navmode combination. Figure 1O illustrates the estimated navmode error (in dashed line) for the selected navmode combination and further illustrates the resulting estimated position error in solid line. The following ordered list of selected navigation modes correspond to the indicated points on the time axis of Figures 9 and 10. 1. MULTIRHORHO NAVMODE (FIVE VALID DME NAVAIDS) 2. MULTIRHORHO NAVMODE (FOUR VALID DME NAVAIDS) 3. MULTIRHORHO NAVMODE (TWO VALID DME NAVAIDS) 4. INS NAVMODE 5. RHO-THETA LEFT NAVMODE 6. INS NAVMODE 7. MULTIRHORHO NAVMODE (TWO VALID DME NAVAIDS) 8. MULTIRHORHO NAVMODE (FOUR VALID DME NAVAIDS) 9. LOCALISER RIGHT NAVMODE It will be appreciated that the BEELINE navmode could be utilised instead of the MULTIRHORHO navmode. It will be understood from the foregoing that the present invention provides a multiple-mode, multiple-sensor navigation system with navigation mode selection determined by minimising position error. The error characteristics of the various navigation modes supported by the system are well known. For each navigation mode supported by the system an estimate of expected position error is generated in real time as a function of sensor data. Any navigation mode can be added to the system provided that a suitable error model therefor is available or can be developed. The system of the present invention, in dynamic operation, avoids fequent navigation mode switching when such switching would cause the aircraft to manoeuvre. The present invention estimates the navigation errors that would be introduced by each available navigation mode, and then selects the navigation mode with the lowest estimated error. The navigation system, in accordance with the present invention, provides navigation that is superior to that presently in use in prior art systems. The data reasonableness tests of block 30 of Figure 1, which are predicted on the allowable difference between expected sensor data and actual sensor data, are a function of expected position error, thereby providing the navigation system with an enhanced capability to reject inaccurate navaid sensor data. The data reasonableness test limits are maintained as tight as possible by adjusting the limits in accordance with function of estimated position error. The present invention provides the capability of utilising the excellent short-term accuracy of INS and/or DEAD RECKONING navigation, thereby avoiding less accurate navigation modes.

Claims: A navigation system for generating a position signal representative of the position of a vehicle, the system comprising navigation mode means (19), including a plurality of navigation modes (20-24), for generating the position signal and a navigation mode selector (17) characterised in that the system further includes error estimator means (10-16) for providing a plurality of estimated navigation mode error signals, each estimated navigation mode error signal representative of an estimate of the navigation mode error generated by a respective navigation mode (20-24), and further characterised in that the navigation mode selector (17) is responsive to the estimated navigation mode error signals for selecting the navigation mode (20-24) with the smallest associated estimated navigation mode error signal. A system according to claim 1, characterised in that it further comprises low pass position filter means (26) coupled to the navigation mode means (19) for eliminating abrupt position signal changes when switching between navigation modes (20-24) and low pass position error filter means (28) coupled to the navigation mode selector (17) for processing the estimated navigation mode error signal associated with its respective navigation mode (20-24), thereby providing an estimated position error signal. A system according to claims 1 or 2, characterised in that the plurality of navigation modes (20-24) includes an inertial navigation mode (23) and in that the system further includes an inertial navigation mode error estimator (15) responsive to the estimated navigation mode error signal for providing an estimated inertial navigation mode error signal, and the inertial navigation mode (23) including means for correcting the inertial navigation mode position signal in accordance with the estimated inertial navigation mode error signal. A system according to any of the preceding claims, characterised in that the plurality of navigation modes (20-24) includes a DEAD RECKONING navigation mode (14) and in that the system further includes a DEAD RECKONING error estimator (16) responsive to the estimated position error signal for providing an estimated DEAD RECKONING navigation mode error signal, the DEAD RECKONING navigation mode including means for correcting the DEAD RECKONING position signal in accordance with the estimated DEAD RECKONING navigation mode error signal. A system according to claim 2, further including navigation data validation means (30) responsive to the estimated position error signal and to the position signal for validating navigation data utilised in the system by comparing the navigation data with a threshold set in accordance the estimated position error. A system according to claim 5, characterised in that the navigation data validation means (30) determines differences between data received from a navigation sensor and the position signal, and compares the difference with said threshold.

Inventors: HARRAL, BLAKE GENE, REED, MICHAEL DEWAYNE
Applicants: HONEYWELL INC.
Application year: 1987
Main classification: G01S5
IPC codes: G05D1, G01C21, B64C13, G01S19