Vehicle navigation system provided with an adaptive inertial navigation system based on the measurement of the speed and lateral acceleration of the vehicle and provided with a correction unit for correcting the measured values

• US 4,758,959 A
• Filed: 09/03/1985
• Issued: 07/19/1988
• Est. Priority Date: 08/14/1984
• Status: Expired due to Fees

• Current Assignee: US Philips Corporation (Koninklijke Philips N.V.)
• Original Assignee: US Philips Corporation (Koninklijke Philips N.V.)
• Inventors: Krukkert, Henricus P. M., Thoone, Martinus L. G.
• Primary Examiner(s): Lall, Parshotam S.
• Assistant Examiner(s): Black, Thomas G.
• Application Number:
  US06/772,062
• Time in Patent Office: 1,050 Days
• Field of Search: 364/449, 364/436, 364/565, 364/566, 364/443, 364/453, 364/454, 364/450, 73/178 R, 340/990, 340/995, 343/450, 343/451
• US Class Current: 701/221
• CPC Class Codes: G01C 21/30 Map- or contour-matching

Abstract

A navigation system for a road vehicle comprises a route-determining unit and position-locating means. The route-determining unit works together with a mass memory which stores geographic data of a road network. The route-determining unit determines a driving route between a starting point and a destination supplied by the driver of the vehicle. The position-locating devices determine the vehicle position coordinates recurrently from the speed and acceleration of the moving vehicle provided by a measuring unit. A correction unit derives a correction vector for correcting the generated vehicle position coordinates. The correction vector is determined by performing a transposition of the generated vehicle position coordinates to an actual road position as repeated by coordinates of the road network stored in the mass memory. An acceleration operator is derived from the measured speed and lateral acceleration and from the generated vehicle position coordinates. The acceleration operator operates on the correction vector in order to derive a correction value for the measured acceleration. A receiver receives position coordinate signal from a navigation satellite. A Kalman filter mixes the vehicle position coordinates with the position coordinates originating from the navigation satellite.

Claims

1. A navigation system for a road vehicle comprising:

a measuring unit including a speedometer and an accelerometer for measuring lateral acceleration of the vehicle, a communication unit connected to a central unit for the input of a starting position and a destination and for displaying on a display means a driving route between the starting position and destination, said central unit comprising a mass storage device for storing geographic data of a road network, a control unit and position-locating means and all connected to a common communication line, said central unit including a route-determining unit for determining a driving route between said starting point and the destination by use of the geographic data in the mass storage device, said position-locating means having a first input connected to an output of the measuring unit for receiving measurement data so as to determine from the measurement data, after receiving the starting position, successive vehicle position coordinates and the driving direction of a moving vehicle, and wherein the position-locating means generate recurrently from received measured lateral acceleration and speed of the vehicle successive vehicle position coordinates and driving direction of the moving vehicle.

2. A navigation system as claimed in claim 1 further comprising a correction unit connected to the communication line for determining correction vectors that indicate a deviation between the vehicle position coordinates generated by the position-locating means and stored road position coordinates for a corresponding position on a part of the road, and for correcting the generated vehicle-position coordinates therewith, the geographic data of the road network including a set of segments where each segment represents a part of the road between two nodal points and identified at least by the coordinates of said two nodal points, said correction unit including transposition means for determining, under control of a first correction signal generated by the control unit, for each segment from a group of segments situated within a given radius around a generated vehicle position coordinates, a transposition of the generated vehicle position coordinates for a transposed vehicle position situated near the relevant segment, said transposition means generating correction vectors that give distances between the generated vehicle position and its transposed positions, and said correction unit further comprises means for selecting from the generated correction vectors that vector which has the smallest distance, a correction being made on the basis of the selected correction vector.

3. A navigation system as claimed in claim 2, wherein segments for parts of a road network which run along a straight line form a first subset of the set of segments, and wherein the straight part of a road is represented by one line section, the transposition means determining, for each segment of the first subset, the perpendicular projection of the generated vehicle position coordinates onto the line section of the relevant segment, and means for validating the transposition when the transposed position is a point of that line section.

4. A navigation system as claimed in claim 3, wherein segments for parts of a road network which follow a curved line form a second subset of the set of segments and with the curved part of a road represented by a number of line sections, the transposition means determining, for each segment of the second subset, the perpendicular projection of the generated vehicle position coordinates onto at least one line section of said number of line sections, and means for validating the transposition when the transposed position is a point of one of the line sections.

5. A navigation system as claimed in claim 4, wherein a point of intersection of two successive line sections forms a breakpoint and the transposition means perform a transposition by determining the distance between the generated vehicle position coordinates and at least one breakpoint.

6. A navigation system as claimed in claim 2, wherein for each segment the axis of the appertaining part of the road is parametrised by means of at least one section, and the transposition means perform a transposition by determining the path distance travelled between a reference point of the relevant segment and the generated vehicle position coordinate and subsequently transposing said distance on the sections of the relevant segment with said reference point as the point of departure.

7. A road vehicle navigation device comprising:

(a) a measuring unit comprising an accelerometer for measuring lateral acceleration of the vehicle and a speedometer, and a first output for supplying measured lateral acceleration signal values and speed signal values;

(b) a communication unit which includes input means for inputting a starting position and a destination and display means for displaying at least parts of a driving route between said starting position and said destination; and

(c) a central unit comprising a mass storage device, a control unit, position-locating means and a route-determining unit and all connected to a communication line, said position-locating means being connected to said communication unit for receiving said starting position and to said first output of said measuring unit, said position-locating means being enabled upon reception of said starting position for generating, recurrently, based on said measured speed signal values and lateral acceleration signal values, successive vehicle position coordinates and the driving direction of the moving vehicle, said route-determining unit being connected to said communication unit for determining, under control of said control unit, driving route data between said starting position and said destination by using geographic data of a road network stored in said mass storage device, and means for supplying said driving route data to said display means.

8. A navigation device as claimed in claim 7, wherein said geographic data of the road network includes a set of segments in which each segment represents a roadpart of said road network, wherein each of said segments is bounded by two nodal points and contains at least the coordinates of the two nodal points, and said navigation device further comprises a correction unit for generating first correction signals, and connected to said communication line, said correction unit comprising transportation means for determining, under control of a received first correction signal, a number of transposed vehicle position coordinates by applying a transposition of a received vehicle position coordinate, generated by said position-locating means, to path coordinates of a group of segments formed by a number of segments of said set of segments and which are situated within a given radius around said received vehicle position coordinates, said transposition means further generating a number of correction values by determining, for each determined transposed coordinate of said number of transposed coordinates, the distance between said determined transposed coordinate and said vehicle position coordinate, said correction unit further comprising selection means for selecting from said number of correction values the one which has the smallest distance, and said correction unit comprises a correction module for determining a correction vehicle position coordinate by correcting said vehicle position coordinate with the selected correction value.

9. A navigation device as claimed in claim 8, wherein said set of segments comprises a first subset formed by segments which represent a roadpart formed by a substantially straight line and the substantially straight road part is represented by one line section, said transposition means determining said number of transposed coordinates by determining, for each segment of said group of said first subset, the perpendicular projection of said vehicle position coordinate on said line section of the considered segment, and said correction unit comprises means for checking whether said transposed coordinate is a point of that line section and for validating said transposed coordinate if it is a point of that line section.

10. A navigation device as claimed in claim 8, wherein said set of segments comprises a second subset formed by segments which represent a roadpart formed by a curved line and the curved roadpart is represented by a number of line sections, said transposition means determining said number of transposed coordinates by determining, for each segment of said group of said second subset, the perpendicular projection of said vehicle position coordinate on at least one line section of said number of line sections of the considered segment, and said correction unit comprises means for checking whether said transposed coordinate is a point of one of said line sections and for validating said transposed coordinate if it is a point of one of said line sections.

11. A navigation device as claimed in claims 9 or 10, wherein a point of intersection of two successive line sections of said segments forms a breakpoint, said transposition means determining said correction values by determining the distance between said vehicle position coordinate and at least one breakpoint.

12. A navigation device as claimed in claim 8, wherein for each of said segments the axis of the appertaining part of the road is parametrised by means of at least one line section, and said transportation means determines said correction value by determining the distance travelled between a reference point of the relevant segment and said vehicle position coordinate and subsequently transposing said distance on the line sections of the relevant segment with said reference point being the point of departure.

13. A navigation device as claimed in claim 8, wherein said central unit comprises detection means for receiving data representing said driving-direction and for detecting therefrom large momentary changes in said driving direction and for generating a second correction signal upon ascertaining a large momentary change in said driving direction, said detection means being connected with said route-determining unit for retrieving, under control of said second correction signal, momentary driving route coordinates and for ascertaining whether said momentary driving route coordinates contain coordinates of a nodal point or of a breakpoint and, in establishing coordinates of the nodal point or of the breakpoint, generating a third correction signal to control said transposition means to determine a correction value from the third correction signal.

14. A navigation device as claimed in claim 8, wherein said correction unit includes an operator generator for generating an acceleration operator from said measured speed value and lateral acceleration value and from said vehicle position coordinate, said correction unit including an operation unit having a first input connected to said selection unit for receiving said selected correction value, a second input connected to said operator generator for receiving said acceleration operator and a third input connected to said control unit for receiving a fourth correction signal generated by said correction unit, said operation unit causing said acceleration operator to operate on said selected correction value under control of said fourth correction signal to generate therefrom a correction parameter for a measured acceleration value.

15. A navigation device as claimed in claim 14, wherein said operation unit has an output connected to said position-locating means for delivering the correction parameter to said position-locating means which take up the presented correction parameter in the measured lateral acceleration.

16. A navigation device as claimed in claim 8, which comprises a receiving unit connected to the communication line for receiving position coordinate signals originating from a navigation satellite, and wherein said control unit comprises a mixing unit connected to the communication line for mixing, by means of a Kalman filter and under the control of a mixing signal generated by the control unit, generated vehicle position coordinates with position coordinates received from the navigation satellite, wherein the generated vehicle position coordinates and received position coordinates relate to a corresponding vehicle position, and said mixing unit is connected to the correction unit for receiving the correction value and/or the correction parameter.

17. A navigation device as claimed in claim 7 wherein said central unit includes a memory element for temporarily storing data and having a control input for receiving an enabling pulse generated by said position locating means upon stopping of the vehicle, and wherein the memory element stores the generated vehicle position coordinate under control of the enabling pulse thereby to preserve the vehicle position coordinate when the vehicle is stationary.