Patent Publication Number: US-4731613-A

Title: Positioning system for a vehicle

Description:
BACKGROUND OF THE INVENTION 
     (1) Technical Field of the Invention 
     The present invention relates to a positioning system for a vehicle. 
     (2) Description of the Prior Art 
     Heretofore, a positioning system used, for instance, for the route guidance unit for a vehicle employed for the most cases the system in which the vector that represents the shifted position of the vehicle is detected by means of a vehicle speed sensor and a direction sensor and the current position of the vehicle is found by integrating the values of the vector with respect to a reference position. In such a system, however, the detection errors in these sensors are accumulated as they appear so that it was necessary to provide some measures for removing these errors. With such a circumstance in mind, there has been proposed a positioning system which makes use of satellites called global positioning system (GPS) that is free from the problem of accumulation of these errors. 
     However, in GPS radio waves must be received simultaneously from three or more satellites to carry out a computation determining a current position of the vehicle, so that it fails to be feasible in an area where a plurality of GPS satellites cannot be observed. 
     SUMMARY OF THE INVENTION 
     An object of the invention is to provide a positioning system for a vehicle which makes it possible to carry out position measurement if only at least one satellite is observable. 
     Another object of the invention is to provide a positioning system for a vehicle, capable of finding the absolute coordinates of the vehicle when it is in city zones or areas among mountains, and in addition even when it is in a time zone in which the number of observable satellites is small. 
    
    
     BRIEF DESCRIPTION OF THE DRAWING 
     These and other objects, feature and advantages of the present invention will be more apparent from the following description of a preferred embodiment, taken in conjunction with the accompanying drawings, in which: 
     FIG. 1 is a block diagram of a prior art positioning system for a vehicle. 
     FIG. 2 is an explanatory diagram for illustrating the receiving condition of a vehicle which is driving in a city zone. 
     FIG. 3 is an explanatory diagram for the present invention. 
     FIG. 4 is a block diagram for the positioning system for a vehicle utilized in the route guidance unit according to the invention. 
     FIG. 5 is an explanatory diagram for the GPS computation system according to the invention. 
     FIG. 6 is a flow chart for the GPS computation system. 
     FIGS. 7 and 8 are explanatory diagrams for the vector computation system according to the invention. 
     FIG. 9 is a flow chart for the vector computation system according to the invention. 
     FIG. 10 is an explanatory diagram for the compound computation system accoding to the invention. 
     FIG. 11 is a flow chart for the compound computation system according to the invention. 
     FIG. 12 is a flow chart concerning the display in the route guidance unit according to the invention. 
     FIG. 13 is an explanatory diagram for an example of display of a driving locus according to the invention. 
    
    
     DESCRIPTION OF THE PREFERRED EMBODIMENTS 
     To facilitate the understanding of the present invention, a brief reference will be made to a prior art illustrated in FIGS. 1 and 2. 
     GPS consists, as shown by FIG. 1, of three GPS satellites Si (Sa, Sb, Sc) that radiate their respective navigational data at predetermined times, an omnidirectional antenna 1 which receives radio waves from these satellites, and a receiving apparatus 3 which analyzes and computes the radio waves received by the antenna 1. 
     The satellite Si has an atomic clock therein, and transmits with a predetermined timing its own current position as a radio wave (at 1575.42 MHz) which is represented as a PN (pseudo-noise) code. The current position P i  of a satellite Si may be represented by P i  (R i , θ i , ψ i ) in terms of the spherical coordinates of the system that has the center of the earth as the reference point. 
     The receiving apparatus 3 includes a PN signal processing section 3a and a positioning computation section 3b. 
     The PN signal processing section 3a demodulates the high frequency signal (PN code) which is spectrally diffused. The positioning computation section 3b decodes the demodulated PN code to find the current position P i  for each satellite and also evaluates the distance D i  between each satellite Si and the receiving position by multiplying the propagation delay time for the radio wave emitted by each satellite by the velocity of light. Here, the propagation delay time Δt di  is obtained by subtracting the offset time Δt u  (bias in the clock) from the measured phase difference Δt i . 
     As shown in FIG. 1, if three satellites can be observed, the longitude θ, the latitude ψ, and the offset time Δt u  for the vehicle can be found by deriving and solving a set of three-dimensional simultaneous equations. If the height (altitude) of the vehicle is desired in addition, it means that the number of unknowns is augmented by one so that it becomes necessary to have four satellites that can be observed simultaneously. The computation system for determining the position of the vehicle by means of a plurality of satellites that can be observed simultaneously will be referred to in what follows as the GPS computation system. 
     Since, however, such an existing positioning system that uses GPS is a system which permits position measurement only when a plurality (three, for example) of satellites are observable simultaneously, there is a problem that the position measurement fails to be feasible in driving in city zones where it may not always be possible to observe a plurality of GPS satellites, as shown by FIG. 2. 
     Referring now to FIG. 3, an embodiment of the invention is shown. A positioning system 15 for a vehicle includes GPS receiving means 5 which receives a navigational data radiated at predetermined times from a satellite to analyze the position and the propagation delay time for the satellite, GPS computing means 7 which computes the receiving position by collecting the position and the propagation delay time as analyzed by the GPS receiving means 5 for a plurality of satellites, vector detecting means 9 which detects the shift amount of the vehicle as a vector, vector computing means 11 which computes the vector quantity for the shift amount of the vehicle by receiving the detection signal from the vector detecting means 9, and compound computing means 13 which computes the receiving position at a later time by receiving with a time interval the position and the propagation delay time for the satellite from the GPS receiving means 7 and the vector quantity representing the amount of vehicle shift which occurred during that interval from the vector computing means 11. 
     In FIG. 4 is shown a block diagram illustrating an embodiment of the present invention. 
     The positioning system for a vehicle 15 includes a receiving apparatus 17 which corresponds to the receiving means 5 of FIG. 3, a detection apparatus 19 which corresponds to the vector detecting means 9 of FIG. 3, and a position computation apparatus 23 which has built-in computing means 7, 11, and 13 and an attached altimeter 21, with an arrangement in which the output from the position computation apparatus 23 is transmitted to a route guidance unit 25. 
     The receiving apparatus 17 has in its inside a PN signal processing section as shown in the prior art example, and analyzes the navigational data sent from the satellites S i  (S a , S b , S c , . . . ) via the antenna 1. 
     The vector detection apparatus 19 includes an optical fiber gyro 27 of frequency modulation system and a vehicle speed sensor 29. The optical fiber gyro 27 detects the angular velocity Ω of the vehicle while the vehicle speed sensor 29 detects the velocity V of the vehicle. 
     The position computation apparatus 23 consists, for example, of a microcomputer. 
     (I) Computational Process in the GPS Computing Means 
     Consider as shown by FIG. 5 a rectangular coordinate system with the center 0 of the earth 31 as the origin, X-Y plane in the equatorial plane, and Z axis passing through the north pole N. The vehicle position P may be represented by the spherical coordinates (r, θ, ψ) where r is the radial distance (radius of the earth), θ is the latitude with the Z axis as the reference, and ψ is the longitude with the X axis as the reference. 
     Assume that the vehicle is currently at the position P(r, θ, ψ) and that three satellites S i , namely, S a , S b , and S c  are observable. 
     The radio waves radiated from the satellites Sa, Sb, and Sc are caught by the omnidirectional antenna 1 and are input to the receiving apparatus 17. At the receiving apparatus 17 the high frequency signal which is spectrally diffused by the PN code is demodulated and at the same time the phase difference Δt i  of the PN code in terms of time received by the built-in clock is detected. 
     Through demodulation of the PN signals, the positions P i  [P a  (r a , θ a , ψ a ), P b  (r b , θ b , ψ b ) P c  (r c , θ c , ψ c )] for the respective satellites and the respective phase differences Δt i  (Δt a , Δt b , Δt c ) will be found. 
     In the phase difference Δt i  for each of the satellite Sa, Sb, and Sc there is included the offset time (the bias with respect to the atomic clock in the GPS satellite) Δt u  of the built-in clock in the GPS receiving apparatus. The phase differences Δt i  (Δt a , Δt b , Δt c ) are the sum of the propagation delay times Δt di  for the radio waves radiated from the respective satellites to reach the observation point (vehicle position) on the earth and the offset time Δt u , and may be represented by the following equation. 
     
         Δt.sub.i =Δt.sub.di +Δt.sub.u =D.sub.i /C+Δt.sub.u (1) 
    
     where C is the velocity of light, D i  is the distance and i=a, b, and c. 
     Here, the distance D i  between the satellite Si and the vehicle position P can be represented by the following expression in terms of their rectangular coordinates. 
     
         D.sub.i.sup.2 =(x.sub.i -x).sup.2 +(y.sub.i -y).sup.2 +(z.sub.i -z).sup.2 ( 2) 
    
     Substituting the relations 
     
         X.sub.i =R.sub.i ·sin θ.sub.i ·cos ψ.sub.i, Y.sub.i =R.sub.i ·θ.sub.i ·sin ψ.sub.i, Z.sub.i =R.sub.i ·cos θ.sub.i 
    
     and 
     
         X=r·sin θ·cos ψ, Y=r·sin θ·sin ψ, Z=r·cos θ 
    
     that express the rectangular coordinates in terms of the spherical coordinates for the satellite and the vehicle position, respectively, into Eq. (2), expanding the squares and rearranging, one obtains 
     
         D.sub.i.sup.2 =r.sub.i.sup.2 +r.sup.2 -2R.sub.i r{cos θ.sub.i ·cos θ+sin θ.sub.i ·sin θ·cos (ψ.sub.i -ψ)}. 
    
     By expressing cos θ i  ·cos θ and sin θ i  ·sin θ as combinations of cos (θ i  -θ) and cos (θ i  +θ) the above equation becomes 
     
         Di.sup.2 =r.sub.i.sup.2 +r.sup.2 -r.sub.i r{cos (θ.sub.i -θ)[1+cos (ψ.sub.i -ψ)]+cos (θ.sub.i +θ)[1-cos (ψ.sub.i -ψ) ]}                                   (3) 
    
     From Eqs. (1) and (3) there is obtained 
     
         D.sub.i.sup.2 =C.sup.2 (Δt.sub.i -Δt.sub.u).sup.2 =r.sub.i.sup.2 +r.sup.2 -r.sub.i r{[1+cos (ψ.sub.i -ψ)]cos (θ.sub.i -θ)+[1=cos (ψ.sub.i -ψ)]cos (θ.sub.i +θ)}                                                (4) 
    
     where i=a, b, and c. 
     Equation (4) includes three unknowns, namely, the offset time Δt u  of the clock and the angular variables θ and ψ of the current position P of the vehicle so that they can be determined by solving the set of three-dimensional simultaneous equations obtained by writing down Eq. (4) for three satellites S a , S b , and S c . 
     It should be noted that if use is made of the height h obtained by the altimeter 21, then the height of the vehicle can also be known without increasing the number of the satellites to be observed. 
     In FIG. 6 is shown a processing flow chart for the GPS computing means 7. 
     In step 403 the positions P i  and the phase differences Δt i  for three satellites S i  and the height h from the altimeter 21 are input, in step 405 the vehicle position P(r, θ, ψ) is computed, and in step 407 the result of the above computation is output to the route guidance unit 25. 
     (II) Computational Process in the Vector Computing Mean 
     The formula for computing the angular velocity [rad/sec] of the vehicle by means of the optical fiber gyro 27 of frequency modulation system is given by 
     
         Ω=λ/2R.sub.1 (fo =Fo)                         (5) 
    
     where λ is the wavelength (m) of the laser light, R 1  is the radius (m) of the fiber loop, f o  is the frequency (Hz) of the high frequency signal, Fo is a constant (Hz). Therefore, it becomes possible to detect the angular velocity Ω of rotation by counting the frequency f o  (see Optical Wave Electronic Engineering, Corona Publishing Company, p.281). 
     From the angular velocity Ω of the vehicle, the vector quantity for the shiftings of the vehicle (variations Δθ and Δψ for the latitude and the longitude, respectively) can be found in the following way. 
     As shown in FIG. 7, with the vehicle position P 1  at the beginning of measurement as the origin, X axis is taken in the direction of the east and Y axis is taken in the direction of the north. By setting time t=0 when the vehicle is at P 1  where it is running in the direction of γ with respect to the X axis, a new axis X&#39; is chosen along the direction of running γ and a new axis Y&#39; is chosen perpendicular to it. Then, the vehicle position P 2  (Δx&#39;, Δy&#39;) after elapse of time t=t 0  is given by the following equations. 
     
         ΔX&#39;=∫V(t)·cos [∫Ω(t)dt]dt   (6) 
    
     
         ΔY&#39;=∫V(t)·sin [∫•(t)dt]dt   (7) 
    
     where V(t) and Ω(t) are the instantaneous values of V and Ω at time t. 
     The transformation of the coordinataes x&#39; and y&#39; of the point P 2  given by Eqs. (6) and (7), respectively, to x and y coordinates are represented by the following. 
     
         Δx=Δx&#39;·cos γ-Δy&#39;·sin γ(8) 
    
     
         Δy=Δx&#39;·sin γ-Δy&#39;·cos γ(9) 
    
     Referring to FIG. 8, the shift Δx in the longitudinal direction and the shift Δy in the latitudinal direction given by Eqs. (8) and (9), respectively, are seen to correspond to a latitude change Δψ and a longitude change Δθ as shown below. 
     
         Δψ=Δx/r, Δθ=Δy/r         (10) 
    
     The vector values Δθ and Δψ for the amount of shift in the vehicle thus obtained as in Eq. (10) are fed to the compound computing means 13 or the route guidance unit 25 as indicated in FIG. 3. 
     Although it is arranged in this embodiment to feed the vector quantities Δθ and Δψ to the route guidance unit 25, it is of course possible to feed the values of Δx and Δy instead of Δθ and Δθ to represent a processing chart for the vector computing them directly on a CRT. 
     In FIG. 9 is illustrated a processing chart for the vector computing mean 21. 
     In step 703, angular velocity Ω from the optical fiber gyro 27 as well as the vehicle speed V from the vehicle speed sensor 29 are input. In step 705 Δx&#39; and Δy&#39;, in step 707 Δx and Δy, and in step 709 Δθ and Δψ are computed respectively. In step 711, the results of these computation are output to the route guidance unit 25 or the compound computing means 13. 
     (III) Computational Process in the Compound Computing Means 
     Assume that it is not possible to observe simultaneously two satellites from the vehicle position P such that one satellite is observed at time T 1  and another at time T 2 . 
     The satellites Si in this case could be the same satellite as observed with a time interval so long as it is not a geostationary satellite. However, preferably observations of separate satellites that are situated a distance apart be made in succession. 
     (i) Suppose that a satellite Sa (Υa, θa, ψa) alone was observed at time T 1 . 
     Assume that the (unknown) vehicle position is given by P 1  (r, θ 1 , ψ 1 ) (considering the radius r of the earth to be constant) and that the bias of the clock with respect to the atomic clock has already been corrected for. 
     First, from the result of analysis of the navigational data which is sent from the satellite Sa, the current position P a  (r a , θ a , ψ a ) of the satellite Sa in the spherical coordinate system with the center 0 of the earth 31 as the origin and the distance Di between the satellite Si and the vehicle can be determined. Here, the propagation delay time Δt di  is to be determined by subtracting the offset time Δt u  from the phase difference Δt i  that has been measured previously. 
     Then, the (unknown) current position P 1  lies somewhere on the intersection e of the sphere of radius D a  with the satellite Sa as the center and the sphere (earth) of radius r. 
     In the triangle that has three points 0, P a , and P 1  as its vertices, the angle P a  OP 1  (planar angle) which is called α may be given from the cosine law as 
     
         cos α=(R.sub.a.sup.2 +r.sup.2 -D.sub.a.sup.2)/2rR.sub.a (11) 
    
     The coordinates of the foot H of the perpendicular from the point P1 to the straight line joining two points Pa and O are given by H(r&#39;, θa, ψa) where from the right triangle OP1H one has 
     
         r&#39;=r cos α                                           (12) 
    
     Furthermore, since the current position P 1  (r, θ 1 , ψ 1 ) lies on the circle e of radius P 1  H with the point H as the center, the distance l 1  between the points P 1  and H (radius of the circle e) may be represented by the following by referring to Eq. (3). 
     
         l.sub.2 =r.sup.2 +r&#39;.sup.2 -2rr&#39;{cos (θ-θ.sub.a)[1+cos (ψ-ψ.sub.a)]+cos (θ+θ.sub.a)[1-cos (ψ-ψ.sub.a)]}                                     (13) 
    
     Substituting l 1  =r·sin α and Eq. (12) into Eq. (13) the equation for the intersection e is obtained as (with cos α=0) 
     
         0=cos α-cos (θ-θ.sub.a)[1+cos (ψ-ψ.sub.a)]-cos (θ+θ.sub.a)[1-cos (ψ-ψ.sub.a)]        (14) 
    
     (ii) Suppose that the vehicle which was at the point P 1  at time T 1  moved to the point P 2  at time T 2 . 
     The shifts of the vehicle during the time T 2  -T 1 , namely, the changes in the latitude and the longitude θ and ψ, respectively, are represented from Eqs. (8)-(10) by 
     
         Δθ=(1/r)(Δx&#39;·sin γ+Δy&#39;·cos γ), 
    
     
         Δψ=(1/r)(ΔX&#39;·cos γ-Δy&#39;·sin γ)                                                  (15) 
    
     where Δx&#39; and Δy&#39; are given by Eqs. (6) and (7). 
     Since the vehicle position P 1  (r, θ, ψ) lies on the circle e that satisfies Eq. (14), the vehicle position P 2  at time T 2  lies on a curve f obtained by replacing θ by (θ-Δθ) and ψ by (ψ+Δψ) in Eq. (14). 
     In other words, if the vehicle which was on the curve e at time T 1  moved by a fixed vector quantity (Δθ, Δψ), then the vehicle will be at time T 2  on a curve f which is obtained by parallel displacing the curve e by a fixed vector quantity (-Δθ, Δψ). 
     Here, by referring to Eq. (14), the equation for the curve f is given by 
     
         cos α-cos (θ-θ.sub.a -Δθ)[1+cos (ψ-ψ.sub.a +Δψ)]-cos (θ+θ.sub.a -Δθ)[1-cos (ψ-ψ.sub.a +Δψ)]=0 (16) 
    
     (iii) Assume that a satellite Sb alone is observed at time T 2 . 
     If it is assumed that at time T 2  only the radio wave radiated by a satellite S b  is received, then the current position P b  of the satellite Sb and the distance Db between the satellite Sb and the vehicle position P can be known. 
     The current position P 2  (r, θ, ψ) lies on the intersection g (a circle) of the sphere of radius D b  with center at the satellite Sb and the earth which is a sphere of radius r. 
     In the triangle with three points 0, P b , and P 2  as its vertices, the angle P b  OP 2  which is called β can be given from the cosine law by the following. 
     
         cos β=(R.sub.b.sup.2 +r.sup.2 -D.sub.b.sup.2)/2rR.sub.b (17) 
    
     Analogous to the procedure by which Eq. (14) was obtained the equation for the curve g is given (with cos β 0) by 
     
         0=cos β-cos (θ-θ.sub.b)[1+cos (ψ-ψ.sub.b)]-cos (θ+θ.sub.b)[1-cos (ψ-ψ.sub.b)]        (18) 
    
     (iv) Evaluation of the vehicle position P 2  at time T 2 . 
     Since the current position P 2  of the vehicle (at time T 2 ) is situated at the intersecting point of the curve f defined by Eq. (16) and the curve g defined by Eq. (18), the current position P 2  (r, θ, ψ) can be defined as the solution to the set of simultaneous equations formed by Eqs. (16) and (18). 
     It should be remembered here that although there exist two possible solutions to the above set only the intersecting point that is located in the region of special interest need be taken as the acceptable solution. 
     In the manner explained in the foregoing, if the radio waves radiated intermittently from at least one satellite can be received, then the vehicle position at times T 1 , T 2 , T 3 , . . . at which the radio waves are received intermittently can be evaluated. 
     It should be noted here that the form of the earth is represented by the equipotential surface of the gravitational field called geoid, and the distance r from the center of the earth to the mean sea level at a region of interest can be represented by 
     
         r+Δr (Δr: regional correction value). 
    
     Therefore, when the vehicle is near 0 m from sea level, its current position P 2  (r 1 , θ, ψ) may be evaluated from Eqs. (11), (15), and (17) by setting the radius of the earth to 
     
         r.sub.1 =r+Δr 
    
     Moreover, when the vehicle is operated in a region other than 0 m from sea level, the current position P 2  (r 2 , θ, ψ) may be evaluated by measuring the altitude h by means of the altimeter 21 and by replacing the radius of the earth in the above three equations by 
     
         r.sub.2 =r.sub.1 +h 
    
     In this manner a highly precise position determination that takes into account the form of the earth and the altitude can be realized. 
     The processings in the compound computing means 13 are shown in FIG. 11 as a flow chart. 
     The processings in each of the steps 903 through 917 are the same as have already been described in the foregoing so that no further explanation will be given. What is meant by initial value setting for inertial navigation in step 919 is to use the current vehicle position P 2  (r, θ, ψ) or P 2  (r 2 , θ, ψ) thus determined as the starting point of the inertial navigational. Further, step 921 means that the obtained information is to be output to the route guidance unit 15. 
     In FIG. 12 is illustrated a processing flow chart concerning the route display. 
     The route guidance unit 25 includes a CRT (see FIG. 4) on which is displayed the locus of the vehicle. 
     Step 1003 is for judging whether a display by means of the inertial navigation should be carried out, and the display by the inertial navigation is continued until the error in the display becomes tolerable (for a duration in which the vehicle runs, for example, 1-5 km). When the inertial navigation is judged to be displayed, it received in step 1005 the vector quantity (Δθ, Δψ) or (Δx, Δy) from the vector computing means 21, and processes integration and display in step 1007. 
     After completing the inertial navigation in step 1009, it proceeds to step 1011 via step 1003 in order to have the absolute coordinates of the vehicle position, where the observation conditions on the satellites are judged. 
     If there are over three satellites that can be observed, it proceeds to step 1013 where it lets the GPS computing means 7 shown in FIG. 3 carry out the computation based on the usual GPS computation system, and receives the result of the computation to display the current position of the vehicle. 
     On the other hand, if the number of observable satellites is less than three, for instance, one, it proceeds to step 1015 where it is arranged to display in step 1017 the result of computation carried out in the compound computing means 13. Further, if in step 1015 none of the satellites is observable, it proceeds to step 1019 where it is arranged to continue the inertial navigation. 
     FIG. 11 illustrates the processing conditions of the route guidance unit 25 shown in FIG. 4. 
     In FIG. 13 suppose that the vehicle runs from the point P3 on the left of the figure toward the point P15. 
     The small circle on the points P 3 , P 4 , and P 5  indicate that they are displays of the result of the GPS computation mentioned in step 913 above. Such a display becomes possible when a plurality of satellites are observable under such conditions as the vehicle is on a piece of flat land 33 and it is in the time zone in which a large number of satellites are observable. The arrows along the path indicate that they are displays due to the inertial navigation. 
     As soon as the vehicle enters a tunnel 35 at the point P 6  none of the satellites becomes observable while it remains inside of the tunnel 35, so that it has to rely solely upon the inertial navigation by the processing indicated by step 1019 of FIG. 12 until it clears the tunnel 35 to arrive at the point P8. 
     Now, when the vehicle enters a city zone 37, the number of observable satellites is reduced as in the former example illustrated in FIG. 12, and also the possible observation of the satellites becomes intermittent. Similarly, in an area among the mountains 39 the chances of having reduced number of observable satellites increases. 
     For instance, if at time T 2  (at point P 9 ) just one satellite alone is observable, point P 9  need only be determined by means of the compound computation system by using the information on the one satellite that was observed at time T 1  at the previous point P 8  and the vector quantity for the amount of shift utilized for the inertial navigation from point P 8  to point P 9 . 
     The points P 10  through P 14  are determined similarly. When a plurality (for instance, three) of satellites become observable, it is only necessary to display the result of computation by the GPS computing means 7, as indicated for point P 15 . In the figure, the coordinates computed by the compound computation system are indicated by a small triangular mark. 
     As in the foregoing, by arranging to display the coordinates of the vehicles as determined by the GPS computation system and the compound computation system in addition to the inertial navigation, it becomes possible to display the vehicle locus extremely accurately, providing a vehicle guidance which is highly reliable. 
     Although the vehicle is assumed to be in motion for all times in the compound computation system in the above, it is to be noted that it is possible to determine the vehicle position by making observation on two satellites at times with a time interval while the vehicle is standing still for a fixed length of time, and they by applying the system shown in the flow chart of FIG. 11. 
     Various modifications will become possible for those skilled in the art after receiving the teachings of the present disclosure without departing from the scope thereof.