A PLANT AND A METHOD FOR NAVIGATING A VEHICLE

Abstract: In a plant for navigating a vehicle according to the appearance of the surface region over which it moves there are at least three devices (19-22) adapted to carry out a position determination of the vehicle according to a predetermined algorithm as well as members (24) adapted to compare the positions determined by the devices and at a substantial deviation of any position from the other positions assume that this is erroneous and form an average of the other positions as the correct position of the vehicle.

Description: JON ijn Applicant: SAAB DYNAMICS AB A plant and a method for navigating a vehicle FIELD OF THE I NVENTION AND PRIOR ART The present invention relates to a plant for navigating a vehicle according to the appearance of a surface region over which it moves, which comprises on board of the vehicle a radar altimeter adapted to send signals down towards said surface region and analyse signals reflected thereby for measuring the height over the part of the surface region just passed, a data base with information about the altitude of the surface region within the area in which the vehicle is present and a device having means adapted to compare the altitude of the surface region last meas- ured with the data base information about surface region altitudes within a given uncertainty area and form a measurement shell extending over this area at the distance measured over the surface region and having a predetermined vertical thickness and having a control unit adapted to control this procedure of forming a measurement shell to be repeated for forming new measurement shells and sections between such shells and the previous measurement shell for determining the position of the vehicle to be within the area of the section, which forms a new measurement shell, and to control a restart of said procedure if it is failed to form said section when attempted to, as well as a method according to the preamble of the appended independent method claim . Such a plant may be used for navigating vehicles of the most different types, for example aircrafts, which may comprise all types of airborne vehicles, such as aeroplanes, unmanned flying objects and so on, in which the navigation is carried out according to the appearance of the terrain overflown by the aircraft, but the vehicle may also be constituted by a boat, a submarine or the like, in which the surface region then is the bottom of the water, such as the sea, in which the boat is moving. However, the particular case of navigating an aeroplane will be discussed in this disclosure hereinafter so as to illuminate, but accordingly not in any way restrict the invention. It is pointed out that even if the radar altimeter measures the height of the aero- plane above the terrain it is understood that the altitude of the terrain is thereby indirectly determined , since the aeroplane through other sensors has information about the altitude thereof above sea level, so that thanks to the measurement of the radar altimeter said comparison of an altitude of the terrain measured with data base information about terrain altitudes may be carried out. A plant of this type may be used for navigating an aircraft during start and landing as well as cruise flight while utilizing the in- formation given by the appearance of the terrain overflown about the position of the aeroplane. Said device included in the plant is already known under the name terrain navigating filter, and this device performs an algo- rithm when forming a measurement shell in the way defined above. Such a terrain navigating filter has been developed by the applicant and been in use since 1 995. Thus, in such a device or terrain navigating filter an assumption about the noise of the radar altimeter is made, which depends on the fact that the measurement may sometimes take place on objects on the ground, such as trees, and a vertical thickness of the measurement shell is for that sake chosen so that independently of such noises it may for certain be said that the aeroplane is within the measurement shell. Should the noise be larger, there would be a risk for divergency, i.e. that the aeroplane ends up outside the measurement shell. Should such a divergency occur when the aeroplane flies over flat ground or water the device would not "die" but will continue to deliver erroneous position estimations, since there is then no terrain varying making it possible to get the overlap to disappear. A device overestimating the noise of the radar altimeter is normally used for avoiding this problem, but the costs for this overestimation is that the transient time increases and the performance of the device is deteriorated, i.e. the algorithm gets less exact. By such an increase of the thickness of the measurement shell it is for instance said that "the trees are never higher than 50 meters", instead of as earlier 25 meters for example. SUMMARY OF THE INVENTION The object of the present invention is to provide a plant and a method of the type defined in the introduction , which improve the functionality and the robustness of plants and methods of this type already known. This object is according to the invention obtained by providing such a plant with at least three said devices adapted to carry out said position determination of the vehicle and members adapted to compare the positions determined by the devices and upon a substantial deviation of any position from the other assume that this position is erroneous and form an average of the other positions as the correct position of the vehicle. By using a plurality of devices or terrain navigating filters in this way the risks of an occurrence of a fault in the position indica- tion gets considerably smaller than when using only one device. Since the aeroplane, in the case of a vehicle in the form of an aeroplane, is only located in one position at a given point of time it may be said that there is only one true position and infinitely many erroneous positions at a given point of time. This means that if a device makes a position determination coinciding with position determ inations of other devices these devices have to give correct est mations of the position of the aeroplane, since the probability of the same erroneous position determination of several devices is infinitely low. According to a preferred embodiment of the invention the control units of the different devices are adapted to co-operate for reducing the mutual dependency of the position determinations of the devices. This constitutes a very preferred embodiment of the invention, since a high degree of independency of the different devices with respect to each other considerably reduces the risk of two devices indicating the same erroneous position. A reduction of said dependency may in another preferred embodiment of the invention take place by arranging said means of at least one device to form a measurement shell having a thickness differing from the measurement shell thicknesses of the means of at least another device. By varying adjustments of the noise of the radar altimeter in this way it gets possible to determine whether any device indicates an erroneous position value after running through said procedure as a consequence of a too thin, or too thick, measurement shell, so that the position indication gets inexact. According to another preferred embodiment of the invention the different devices are adapted to start said procedure at a time delay with respect to each other, which makes it possible to maintain the robustness also over a terrain having small variations, such as in the aeroplane case agriculture land or water. According to another preferred embodiment of the invention the radar altimeter is adapted to carry out measurements more often than the respective device is adapted to form a new measurement shell, and the respective device is adapted to utilize results from other altitude measurements of the radar altimeter than the other devices. By the fact that the different devices in this way utilize different altitude measurements for the position determination thereof the risk of a repeated error as a consequence of any unusually large obstacle when measuring the terrain is extremely low. The method according to the invention and preferred embodiments thereof defined in the appended claims have advantages appearing without doubt from the description above of preferred embodiments of the plant according to the invention. Further advantages as well as advantageous features of the invention appear from the following description and the other dependent claims. BRIEF DESCRIPTION OF THE DRAWINGS With reference to the appended drawings, below follows a description of a plant and a method for navigating an aeroplane according to a preferred embodiment of the invention cited as an example. In the drawings: Fig 1 is a schematic view illustrating an aeroplane flying over a terrain portion and provided with a plant for navigation according to the invention in a first stage of a position determination procedure, Fig 2 is a view corresponding to Fig 1 in a later stage of said procedure, Fig 3 is a view corresponding to Figs 1 and 2 in a still later stage of said procedure, Figs 4 and 5 are views similar to the one in Fig 1 illustrating how different types of terrain may result in measure- ment faults for a device included in the plant according to the invention, Fig 6 is a very schematic view illustrating an aspect of the plant according to the invention and the method according to the invention, and Fig 7 is a simplified block diagram illustrating the algorithm according to which a device for terrain navi- gation included in the plant according to the invention is adapted to function. DETAI LED DESCRI PTION OF A PREFERRED EMBODIMENT OF THE INVENTION The construction and the function of the plant for navigating an aircraft according to the appearance of the terrain overflown thereby according to the invention will now firstly be explained with reference made to Figs 1 -3 in parallel with Fig 7. The aero- plane 1 is provided with a radar altimeter 2 schematically indicated in Fig 2 through a measurement cone and adapted to send signals down towards the terrain and analyse signals reflected thereby for measuring the altitude of the terrain just passed. The aeroplane has also a data base with information about altitudes of the terrain within the area in which the aeroplane is present, in which this area could be very large, and the data base could contain information about the appearance of the terrain of for example a whole country, such as Sweden , or for the entire earth surface. Terrain information is present in the form of alti- tude indications for certain fixed points in the terrain , between which the altitude may only be interpolated . The plant also comprises a device 3 for position determination of the aeroplane, the operation algorithm of which is schemati- cally represented in Fig 7. This device, which may be called terrain navigating filter, is adapted to operate in the following way: When the aeroplane is located in a position within a given uncertainty area and the position determination procedure is to be started a circle cylindrical measurement shell 4 is formed, which looks like a giant icehockey puck and in which the aeroplane certainly is located. This measurement shell 4 may have a radius of typically 10 km and the vertical thickness thereof may for example be 200 m. Thus, the proportions in the Figures are not correct, but the Figures are only used to explain the invention in a simple way. We now assume that the radar altimeter 2 carries out an altitude measurement at a certain time t-, , which gives a value of the distance in the vertical direction between the aeroplane and the part of the terrain for which the measurement is carried out, which could be the ground, and the measurement result is then only provided with an error emanating from the measurement method itself, but the measurement may also have been done on for example the top of a tree, and an error depending on the terrain is then introduced, since it has not been measured on the ground. The device comprises means adapted to compare the altitude measured of the terrain with data base information about terrain altitudes within a given uncertainty area and form a measurement shell 5 extending over this area at the measured distance above the terrain and having a predetermined vertical thickness. For the vertical position of the aeroplane this extends within the lateral limits 6, 7 between a lower limit S d and an upper limit S u of the measurement shell defined as follows: S s (X,Y) = h top (X,Y) + h ter - ε S u (X,Y) = h top (X,Y) + h ter + ε + N h top (X.Y) is the altitude information of the data base in the position X,Y, h ter is the height over the terrain measured by the radar altimeter, ε is the largest expected measurement fault as a con- sequence of the measurement method and N is the largest ex- pected measurement fault depending upon the terrain and the vegetation. Thus, knowledge is now gained of the fact that the aeroplane is both within the uncertainty area 4 and within the measurement shell 5, i.e. the section between the uncertainty area 4 and the measurement shell. This means that the measurement shell 5 is now the new uncertainty area when the aeroplane flies further according to Fig 3. The measurement shell is then moved ac- cording to an estimation of the movement of the aeroplane through any moving sensor not shown to the time t 2 for the next radar altitude measurement. However, the measurement is influenced by the movement of the aeroplane by a certain uncertainty with respect to the velocity, so that the measurement shell or the uncertainty area has to be expanded somewhat in all directions according to the uncertainty of the velocity. The uncertainty region moved and somewhat expanded is indicated in Fig 3 by 8. At this time t 2 a new radar altitude meas- urement is accordingly carried out, which after the comparison described above with data base information results in a new measurement shell 9, and the section 10 between the uncertainty area 8 and the measurement shell 9 gives a new uncertainty area 10, which shows that the uncertainty of the position of the aeroplane has been reduced drastically. This procedure of time- and measurement updates is continued and the positioning determination gets better gradually. Accordingly, a time update expands the uncertainty area, while an altitude measurement update contracts the uncertainty area, should there be charac- teristic terrain variations upon which the measurement has taken place. An altitude measurement update will not provide any new information if the ground is flat. Thus, the navigation is very dependent upon variations of the underlying terrain . For obtaining a high accuracy of the position determination it is necessary to create a small uncertainty area, which may be ob- tained for example by making the thickness of the measurement shell thinner, but this could then mean that a larger measurement error than the one predicted (N) could occur and then procure an end of the section method, since no section could be formed and thereby a restart of the entire procedure with uncertainty area 4 according to Fig 1 has to be done. Thus, the choice of N is a compromise between a desire of a small uncertainty area and the risk of getting an empty uncertainty area or section . The algorithm just described is schematically illustrated in Fig 7, in which a box 1 1 illustrates how it is started with a large uncertainty area, a time update expanding the uncertainty area somewhat takes place in box 12 , whereupon in box 1 3 a radar altitude measurement takes place, which forms a measurement shell reducing the uncertainty area. It is shown in box 14 that an attempt is made to form a new section between the measurement shell and the earlier uncertainty area, and if this is succeeded the arrow 1 5 is followed back to the box 12 for repeating this procedure between the boxes 12 and 14, but if the answer in box 14 is that no section may be formed then the arrow 16 is followed back to the box 1 1 for restarting the procedure with a large uncertainty area 4 according to Fig 1 . However, in a position determination by a device in the way described above problems may sometimes occur and the device may deliver erroneous values or not have any possibility to deliver values at all during a longer period of time, which is illustrated in Figs 4 and 5. It is shown in Fig 5 how a "rather" large measurement error, which emanates from the fact that there is a high obstacle on the ground , results in the occurrence of a so called "erroneous fixation", since a section between the preceding uncertainty area 5 and the new one 1 7 will be formed , but the aeroplane will not be located within this new section 1 8. Is the aeroplane located over flat ground when this takes place the filter will not die, i.e. a restart of the filter will not take place, but the device will continue to deliver erroneous position determinations or estimations during a long period of time. The present invention is characterized by having on board of an aeroplane at least three devices of the type described above, which are adapted to carry out said procedure for position determination of the aeroplane, and these different devices are in- dicated by a dashed line 1 9-22 each in Fig 6. Members 24 are arranged for comparing the positions determined by the devices and upon a substantial deviation of any position from the other assume that this is erroneous and form an average of the other positions as the correct position of the aeroplane. The accuracy of the position determination for the navigation may in this way be improved considerably and the risk of faults may be reduced remarkably, since the probability that a plurality of devices give the same erroneous estimation of the position is infinitely low and therefore substantially equal results of the position determi- nations of different devices mean in the practice that these determinations are correct. The position determinations of the devices should then be made as far as possible independent of each other. This may be achieved for example by arranging said means of each device to form measurement shells of a thick- ness differing from the measurement shell thicknesses of the means of the other devices, i .e. the expected noise of the altitude measurements may be varied. Another possibility consists in the fact that the different devices are started with a time delay with respect to each other, so that for example a new device is not started until the latest started device has formed a new section. Such a terrain dependent time delay results in a maintained robustness even over a terrain having small variations. Another possibility consists in arranging the radar altimeter to carry out altitude measurements more often than the respective device is adapted to form a new measurement shell , and the respective device is adapted to utilize results from other altitude measurements of the radar altimeter than the other devices. It is already so that the altimeter most often in the practice measures more often than it is necessary to measurement update the devices, so that this possibility is already available and the invention utilizes this possibility. The measurements are then usually carried out at a frequency of 10-30 Hz, preferably about 15 Hz, which for a normal flight speed of an aeroplane means a distance of about 1 5 m between such measurements at start and landing . The control units of the respective device are then preferably co-ordinated with each other, so that each utilizes the re- suit of altitude measurements of a determined time interval substantially coinciding with corresponding time intervals of control units of other devices, so that for example a device utilizes measurement results from the measurements 1 , 5, 9... in the chronological order, while for another device the corresponding order numbers are 2, 6, 10... The devices or the filters are advantageously as many as possible, and it is only the capacity of the computer of the aeroplane that sets the limits for how many devices that may be used. At least 5, preferably at least 1 0 devices are advantageously used in the plant. The invention is of course not in any way restricted to the preferred embodiments described above, but many possibilities to modifications thereof will be apparent to a person with skill in the art without departing from the basic idea of the invention . It is pointed out that the different devices in the plant may in the practice very well be summarized by one single computer pro- gram co-operating with the radar altimeter and the data base for performing the algorithm described above for different measurement points associated with the determined imagined device. "Radar altimeter" is to be given a broad sense and comprises all types of measurements in which a signal is transmitted and reflected by an object or causes a retransmission of any other type of signal for analysis and distance calculation. The device may as already mentioned be adapted for navigation of other vehicles than aeroplanes according to the appearance of the surface region over which they move, such as airborne vehicles or boats. Accordingly, the medium in which the signals of the radar altimeter are transmitted may be air or water. In the case last mentioned it may also be called echo depth sounder.

Claims: Claims 1 . A plant for navigating a vehicle according to the appearance of a surface region over which it moves, which comprises on- board of the vehicle a radar altimeter (2) adapted to send signals down towards said surface region and analyse signals reflected thereby for measuring the height over the part of the surface region just passed, a data base with information about the altitude of the surface region within the area in which the vehicle is present and a device (3, 19-22) having means ( 13) adapted to compare the altitude of the surface region last measured with the data base information about surface region altitudes within a given uncertainty area and form a measurement shell (5) extending over this area at the distance measured over the surface region and having a predetermined vertical thickness and having a control unit adapted to control this procedure of forming a measurement shell to be repeated for forming new measurement shells and sections (10) between such shells and the previous measurement shell for determining the position of the vehicle to be within the area of the section , which forms a new measurement shell , and to control a restart of said procedure if it is failed to form said section when attempted to, characterized in that it comprises at least three said devices (1 9-22) adapted to carry out said position determination of the vehicle and members (24) adapted to compare the positions determined by the devices and upon a substantial deviation of any position from the other assume that this position is erroneous and form an average of the other positions as the correct position of the vehicle. 2. A plant according to claim 1 , characterized in that the control units of the different devices are adapted to co-operate for reducing the mutual dependency of the position determinations of the devices. 3. A plant according to claim 2, characterized in that said means (13) of at least one device is adapted to form measurement shells having a thickness differing from the measurement shell thicknesses of the means of at least another device. 4. A plant according to claim 3, characterized in that said means (13) of each device is adapted to form measurement shells having a thickness differing from the measurement shell thicknesses of the means of the other devices. 5. A plant according to any of claims 2-4, characterized in that the different devices (19-22) are adapted to start said procedure with a time delay with respect to each other. 6. A plant according to claim 5, characterized in that the different devices (19-22) are adapted to start said procedure with a time delay with respect to each other by not starting the procedure of a new device before the latest started device has formed a said section. 7. A plant according to any of claims 2-6, characterized in that the radar altimeter (2) is adapted to carry out altitude measurements more often than the respective device ( 1 9-22) is adapted to form a new measurement shell, and that the respective device is adapted to utilize results from other altitude measurements of the radar altimeter than the other devices. 8. A plant according to claim 7, characterized in that the control units of the respective device are co-ordinated with each other to each utilize the result of altitude measurements at a given time interval substantially coinciding with the corresponding time intervals of the control units of other devices. 9. A plant according to any of the preceding claims, character- ized in that the radar altimeter is adapted to carry out the meas- urements thereof with a frequency of 10-30 Hz, preferably about 1 5 Hz. 1 0. A plant according to any of the preceding claims, charac- terized in that it comprises at least five, preferably at least ten, such devices. 1 1 . A plant according to any of the preceding claims, characterized in that it is adapted for navigation of an aircraft, that the radar altimeter (2) is adapted to send signals down towards the terrain just passed by the aircraft for measuring the height of the aircraft over the terrain, and that said data base contains information about altitudes of the terrain within the area in which the aircraft is present. 12. A plant according to claim 1 1 , characterized in that it is adapted to be arranged on board of an aeroplane for navigation thereof according to the appearance of the terrain overflown thereby. 13. A method for navigating a vehicle according to the appearance of a surface region over which it moves, in which signals are sent through a radar altimeter (2) on board of a vehicle towards a surface region thereunder and signals reflected by the surface region are analysed for measuring the altitude of the surface region, in which the surface region altitude measured is compared with data base information about surface region altitudes within a given area, in which a measurement shell (5) extending over this area at the measured distance above the sur- face region and having a predetermined vertical thickness is formed, and in which this procedure is repeated for forming new measurement shells and sections (10) between a new measurement shell and the previous measurement shell for determination of the position to be within the area of the section, which forms a new measurement shell, and the procedure is restarted should no section be formed, characterized in that said position determination of th<5 vehicle is carried out through at least three different devices (19-22) and the positions determined by the devices are compared, and that upon a substantial deviation of any position from the other it is assumed that this is erroneous and an average of the other positions is formed as the correct position . 14. A method according to claim 13, characterized in that the different devices ( 1 9-22) are brought to co-operate so that the mutual dependency of the position determinations of the devices is reduced . 15. A method according to claim 14, characterized in that for at least one device measurement shells having a thickness differ- ing from the measurement shell thicknesses of at least another device are formed for reducing said dependency. 16. A method according to claim 14 or 1 5, characterized in that said procedure of the different devices ( 19-22) is started with a time delay with respect to each other. 17. A method according to any of claims 14-16, characterized in that altitude measurements are carried out through the radar altimeter (2) more often than the respective device forms a new measurement shell, and that the respective device is brought to utilize results from other altitude measurements of the radar altimeter (2) than the other devices. 18. A method according to any of claims 1 3-17, characterized in that it is intended for navigating an aircraft according to the appearance of the terrain overflown thereby, that signals are sent through the radar altimeter (2) on board of the aircraft towards the terrain just passed by the aircraft for measuring the height of the aircraft thereabove, and that the altitude of the ter- rain measured is compared with data base information about al- titudes of the terrain within the area in which the aircraft is present. 19. A method according to claim 18, characterized in that it is used for navigating an aircraft in the form of an aeroplane according to the appearance of the terrain overflown by the aeroplane.

Inventors: PERSSON NIKLAS, PERSSON, NIKLAS
Applicants: PERSSON NIKLAS, SAAB DYNAMICS AB, PERSSON, NIKLAS
Application year: 2001
Main classification: G01C21
IPC codes: G01C21, G01S7, G01S13