Patent Grant
7987047
The present invention relates to navigation equipment that performs positioning and map matching using a GPS (Global Positioning System) receiver and a dead reckoning sensor.
Navigation equipment mounted in a vehicle carries out display of the vehicle's position on a road shown in a map, guidance, etc. When displaying the vehicle's position on an on-screen road, the navigation equipment measures the movement of the vehicle by using the GPS and an dead reckoning sensor including a velocity sensor and an angular velocity sensor, and performs a map matching process so as to determine the position of the vehicle on a road link shown by map data. However, the dead reckoning sensor has a rate (referred to as a “Scale Factor”) with which the dead reckoning sensor converts pulses outputted from the velocity sensor into a distance and the rate differs for every vehicle. Furthermore, because the bias voltage (referred to as the “offset”) of the angular velocity sensor drifts according to temperature, it is necessary to always check occurrence of an error and to correct this error properly.
In addition, the GPS has problems when used as follows.
(1) The GPS positioning requires radio waves from three or more GPS satellites in principle. However, when the field of vision over the vehicle becomes narrowed because of buildings or the like around the road along which the vehicle is traveling, the radio wave from one or more GPS satellites is blocked. When the number of GPS satellites which can be used for the positioning becomes smaller than three due to this blocking, the navigation equipment cannot carry out the positioning and the availability of the navigation equipment is reduced. Hereafter, this problem is referred to as an “availability problem”.
(2) When a building or the like exists around the road along which the vehicle is traveling, the radio wave from a GPS satellite is reflected by the building or the like and propagates through a plurality of paths (a multipath) until the radio wave from the GPS satellite reaches the GPS receiver on the ground, and therefore the propagation delay time of the radio wave becomes long. In the GPS positioning, because the vehicle's position is measured from a pseudo range which is acquired by converting the propagation delay time into a distance, the occurrence of multipath propagation provides a large error for the vehicle's position. Hereafter, this problem is called a “multipath problem”.
As mentioned above, a problem with the case of carrying out the GPS positioning in an urban area is that the availability is reduced, and multipath propagation occurs and this results in a large error occurring in the vehicle's position. In a conventional navigation equipment, in order to eliminate this problem resulting from the GPS positioning, correction of the vehicle's position on a road link by using measurement data acquired from a dead reckoning sensor is carried out.
As such a technology, patent reference 1 discloses a GPS receiver which uses a Kalman filter in order to improve the accuracy of positioning computation results, and a car navigation system. The GPS receiver and the car navigation system disclosed by this patent reference 1 are constructed in such a way as to return the results of map matching to the Kalman filter in order to guide the convergence of the Kalman filter used for the GPS positioning arithmetic operation toward a correct direction. This is based on that the results of carrying out map matching using measurement data acquired from a dead reckoning sensor is more accurate than that provided by the results of carrying out map matching using GPS positioning data.
Furthermore, patent reference 2 discloses a GPS receiver with a DR (Dead Reckoning) function. The GPS receiver disclosed by this patent reference 2 is constructed in such a way as to, for example, feed the results of map matching carried out by navigation equipment back to the GPS receiver itself so as to cancel a positioning error. The GPS receiver with a DR function performs DR positioning and GPS positioning independently, but does not complexly carry out positioning by using a Kalman filter or the like.
Furthermore, patent reference 3 discloses a GPS receiver that reduces a pseudo range error without causing a reduction in the availability, thereby being able to improve the positioning accuracy. The GPS receiver disclosed by this patent reference 3 is constructed in such a way as to smooth the pseudo range (measured from the propagation delay time) which is easy to be affected by the influence of multipath propagation by using a range rate (measured from a Doppler shift of the carrier frequency) which cannot be easily affected by the influence of multipath propagation. Even in a case in which instantaneous interception of the radio wave from a GPS satellite occurs, the GPS receiver interpolates the pseudo range by using the range rate estimated from a relative movement between the GPS satellite and the vehicle, and uses the pseudo range for positioning calculation. Thereby, the GPS receiver resolves the multipath problem and the availability problem.
By the way, navigation equipment that performs positioning and map matching by using a GPS receiver and a dead reckoning sensor has to satisfy the following minimum requirements: being able to receive radio waves from three or more GPS satellites existing over the vehicle, and the GPS receiver being able to carry out either two-dimensional positioning or three-dimensional positioning, in order to use the results of GPS positioning.
However, when the vehicle is traveling along a road in an urban area or the like where buildings or the like extends along the road, the field of vision over the vehicle becomes narrowed because of the buildings or the like and, if the number of GPS satellites from which the GPS receiver can receive radio waves becomes smaller than three, there arises an availability problem that the availability of the GPS decreases. Furthermore, there arises a multipath problem that the GPS receiver often receives radio waves reflected by buildings or the like at such a location and easily produces GPS positioning results having a large error. To solve this problem, a conventional navigation equipment is constructed in such a way as to be able to determine (dead reckoning) the position of the vehicle by using the travelled distance and turning angle of the vehicle (user) which are measured by a dead reckoning sensor so as to correct the position of the vehicle on a road link or the like.
However, in a case in which the vehicle starts traveling from a place outside roads, such as a multi-level car parking tower, large errors occurring in the position and heading of the vehicle which are determined through dead reckoning cause a mismatch of the position of the vehicle onto an incorrect road link at a time when the vehicle travels along a road after that. In this case, when the navigation equipment is in a state in which it cannot carry out GPS positioning, the mismatching continues. When the current position of the vehicle is not correct, the navigation equipment makes a mistake in the route guidance etc.
To solve these problems, in accordance with the technology disclosed by patent reference 1, the results of carrying out map matching by using measurement data acquired from the dead reckoning sensor are fed back to the Kalman filter on the basis of the premise that its accuracy is higher than that provided by the results of carrying out map matching by using GPS positioning data so as to guide the direction of the convergence of the Kalman filter which is used for the GPS positioning arithmetic operations. However, as mentioned above, when the results of carrying out map matching are not correct, a disadvantage is that the results of mismatching obstruct normal GPS positioning, and therefore the identification of the position of the vehicle on a correct road link is hindered.
Furthermore, to solve the above-mentioned problems, in accordance with the technology disclosed by patent reference 2, attempt is made to remove errors in dead reckoning by using the results of map matching. However, this technology is effective when the map matching can be carried out correctly, like the technology disclosed by above-mentioned patent reference 1, though in a state in which a mismatch occurs before the GPS positioning is carried out, desired advantages cannot be provided, as mentioned above.
In addition, to solve the above-mentioned problems, in accordance with the technology disclosed by patent reference 3, the pseudo range which is easy to be affected by the influence of multipath propagation is smoothed by using the range rate which cannot be easily affected by the influence of multipath propagation so as to reduce the influence of multipath propagation. Furthermore, when instantaneous interception of the radio wave from a GPS satellite occurs, the GPS receiver interpolates the pseudo range by using the range rate estimated from a relative movement between the GPS satellite and the vehicle, and uses the pseudo range for the positioning calculation. Thereby, the reduction in the availability and the influence of multipath propagation can be reduced. However, when the number of radio waves from GPS satellites which can be used for the positioning after the navigation equipment is powered on is smaller than three, because even this technology does not make it possible to carry out the GPS positioning, the desired advantages cannot be provided.
The present invention is made in order to solve the above-mentioned problems, and it is therefore an object of the present invention to provide navigation equipment that can reduce the influence of multipath propagation without causing any reduction in the availability thereof, thereby being able to improve the positioning accuracy.
In order to solve the above-mentioned problems, in accordance with the present invention, there is provided navigation equipment including: a radio wave receiving unit for receiving radio waves emitted from a plurality of GPS satellites; a signal processing unit for identifying the GPS satellites which are emission sources of the radio waves received by the radio wave receiving unit to measure a pseudo range and a range rate of each of these identified GPS satellites, and for extracting a navigation message included in each of the radio waves; a GPS satellite behavior estimating unit for calculating a position and a velocity of each of the GPS satellites from the navigation message extracted by the signal processing unit; a pseudo range error estimating unit for estimating a pseudo range error on a basis of the pseudo range and the range rate which are measured by the signal processing unit; a user position observing unit for calculating a position of the navigation equipment by using the pseudo range measured by the signal processing unit, the position of each of the GPS satellites calculated by the GPS satellite behavior estimating unit, and the pseudo range error estimated by the pseudo range error estimating unit; a user velocity and heading observing unit for calculating a velocity of the navigation equipment from the range rate measured by the signal processing unit, the position of each of the GPS satellites calculated by the GPS satellite behavior estimating unit, and the position of the navigation equipment calculated by the user position observing unit; and a user heading searching unit for, when a multipath error included in the pseudo range error estimated by the pseudo range error estimating unit is smaller than a specified value, searching for, as a heading of the navigation equipment, a heading whose range rate, which is calculated on a basis of a relative movement of the navigation equipment having the position acquired by the user position observing unit and the velocity acquired by the user velocity and heading observing unit at a time when the navigation equipment changes its heading within a predetermined angle range with respect to a GPS satellite having the position and the velocity estimated by the GPS satellite behavior estimating unit, matches the range rate measured by the signal processing unit.
The navigation equipment in accordance with the present invention can judge whether or not each of the GPS satellite radio waves received thereby is under the influence of multipath propagation and can also detect the heading of the vehicle if the navigation equipment can receive one GPS satellite radio wave which is not affected by the influence of multipath propagation even in a case in which the navigation equipment cannot carry out GPS positioning because the number of GPS satellites which can be used for positioning is one or two. As a result, the navigation equipment can reduce the influence of multipath propagation without causing any reduction in its availability, and can improve the positioning accuracy.
Hereafter, preferred embodiments of the present invention will be described with reference to the accompanying drawings.
The radio wave receiving unit 11 has a GPS antenna for receiving radio waves (referred to as “GPS satellite radio waves” from here on) emitted from a plurality of GPS satellites existing over a vehicle equipped with the navigation equipment. The radio wave receiving unit 11 sends received signals which the radio wave receiving unit has acquired by receiving the GPS satellite radio waves by using this GPS antenna to the signal processing unit 12.
The signal processing unit 12 identifies the GPS satellites which have emitted the GPS satellite radio waves from the received signals sent thereto from the radio wave receiving unit 11 so as to calculate a pseudo range of each of the GPS satellites from a propagation delay time of the corresponding GPS satellite radio wave, and also calculates a range rate from the Doppler shift of the carrier frequency of the GPS satellite radio wave. The signal processing unit 12 also extracts a navigation message in which orbit information about each of the GPS satellites and so on are described and the reception time of receiving each of the GPS satellite radio waves from the corresponding received signal sent thereto from the radio wave receiving unit 11. The results of the signal processing performed by this signal processing unit 12 are sent to the GPS satellite behavior estimating unit 13, the pseudo range error estimating unit 14, the user position observing unit 15, the user velocity and heading observing unit 16, and the user heading searching unit 17.
The GPS satellite behavior estimating unit 13 calculates the position and velocity of each of the GPS satellites which vary from moment to moment by using the reception time of receiving the corresponding GPS satellite radio wave and the orbit information (Ephemeris etc.) included in the navigation message which have been extracted by the signal processing unit 12. The calculation results obtained by this GPS satellite behavior estimating unit 13 are sent to the user position observing unit 15, the user velocity and heading observing unit 16, and the user heading searching unit 17.
The pseudo range error estimating unit 14 estimates various error components (a GPS-satellite-mounted clock error, a radio wave ionosphere propagation delay error, a radio wave troposphere propagation delay error, a multipath error, receiver noise, etc.) included in the radio wave propagation delay time which has elapsed until each of the GPS satellite radio waves reaches the GPS antenna by using the reception time of receiving each of the GPS satellite radio waves and correction parameters (a correction parameter for a pseudo range error occurring at the time of passing through the ionosphere, a correction parameter for an error occurring in a clock mounted in each of the GPS satellites) included in the navigation message, the reception time and the navigation message being extracted by the signal processing unit 12. The error components estimated by the pseudo range error estimating unit 14 are informed to the user position observing unit 15 and the user heading searching unit 17.
The user position observing unit 15 measures the current position of the vehicle according to a predetermined calculation formula by using the pseudo range of each of the GPS satellites informed thereto from the signal processing unit 12, the behavior (the position and velocity) of each of the GPS satellites at the reception time which is calculated by the GPS satellite behavior estimating unit 13, the error components in the pseudo range which are estimated by the pseudo range error estimating unit 14, and the position of the vehicle (the previously-calculated position), and also calculates an error occurring in the internal clock of the navigation equipment.
The user velocity and heading observing unit 16 calculates the velocity and heading of the vehicle by using the range rate of each of the GPS satellites at the reception time of receiving the corresponding GPS satellite radio wave, which is calculated by the signal processing unit 12, the behavior (the position and velocity) of each of the GPS satellites at the reception time, which is calculated by GPS satellite behavior estimating unit 13, the errors in the pseudo range, which are estimated by the pseudo range error estimating unit 14, and the user's position, and informs the velocity and heading of the vehicle to the user heading searching unit 17.
As to a GPS satellite radio wave whose pseudo range error (the multipath error) estimated by the pseudo range error estimating unit 14 is equal to or smaller than a specified value, the user heading searching unit 17 compares the range rate calculated by the signal processing unit 12 with a range rate which this user heading searching unit 17 has estimated, and searches for the heading (showing the heading of the vehicle) which the user heading searching unit has used for calculation of the estimated value at the time when this estimated value matches the range rate calculated by the signal processing unit.
Next, the operation of the navigation equipment in accordance with Embodiment 1 of the present invention which is constructed as mentioned above will be explained with reference to a flow chart shown in
In the positioning process, the navigation equipment checks to see whether or not it is performing GPS reception first (step ST11). More specifically, the signal processing unit 12 checks to see whether or not the navigation equipment is receiving GPS satellite radio waves by watching, for example, a state of update of the reception time of receiving each of the GPS satellite radio waves which is extracted from the corresponding received signal sent thereto from the radio wave receiving unit 11. When, in this step ST11, judging that the navigation equipment is not receiving any GPS satellite radio waves, the signal processing unit ends the positioning process.
In contrast, when, in step ST11, judging that the navigation equipment is receiving GPS satellite radio waves, the signal processing unit calculates the behavior (the position and velocity) of each of the GPS satellites (step ST12). More specifically, after calculating back to the transmission time at which each of the GPS satellite radio waves was transmitted from the reception time of receiving the corresponding GPS satellite radio wave, which is extracted by the signal processing unit 12, the GPS satellite behavior estimating unit 13 calculates the position and velocity of each of the GPS satellites at the transmission time of the corresponding GPS satellite radio wave according to the predetermined calculation formula by using the orbit information (Ephemeris) included in the navigation message about the corresponding GPS satellite. The GPS satellite behavior estimating unit 13 then sends these calculation results to the user position observing unit 15, the user velocity and heading observing unit 16, and the user heading searching unit 17.
The navigation equipment then calculates pseudo range errors (a GPS-satellite-mounted clock error and a radio wave atmosphere propagation delay error) (step ST13). More specifically, the pseudo range error estimating unit 14 calculates, as errors included in the pseudo range informed thereto from the signal processing unit 12, a GPS-satellite-mounted clock error, a radio wave atmosphere (ionosphere and troposphere) propagation delay error according to the following equations (1) and (2) by using the predetermined parameters included in the navigation message. In the equation (2), because the GPS receiver noise is nearly equal in amount for every channel of the signal processing unit 12, the pseudo range error estimating unit determines the GPS receiver noise when the navigation equipment receives GPS satellite radio waves having no influence of multipath propagation.
[Equation 1]
dρ(T2)=ρcτ−(∥Ps−Po∥+c(dT2−dT1)+ε) (1)
where dρ(T2): the error in the pseudo range between each of the GPS satellites and the vehicle [m], T1: the transmission time at which each of the GPS satellite radio waves was transmitted (=T2−∥Ps−Po∥/c) [s], T2: the reception time of receiving each of the GPS satellite radio waves [s], Ps: the position of each of the GPS satellites (calculated from the navigation message) (xs,ys,zs) [m], Po: the position (xo, yo, zo) of the vehicle [m], ∥Ps−Po∥: the straight-line distance between the position Ps of each of the GPS satellites and the vehicle position Po [m]=((xs−xo)2+(ys−yo)2+(zs−zo)2)1/2, c: the light velocity (=2.99792458×108) [m/s], τ: the radio wave propagation time between each of the GPS satellites and the vehicle [s], ρcτ: the pseudo range (=cτ) [m], dT1: the GPS-satellite-mounted clock error (calculated by using the navigation message) [s], dT2: the navigation equipment internal clock error [s], ε: the error in the pseudo range (calculated by using the equation (2)) [m], diono: the radio wave ionosphere propagation delay error [m], dtrop: the radio wave troposphere propagation delay error [m], and dmp: the multipath error (unknown) [m].
[Equation 2]
ε=ρcτ−(∥Ps−Po∥+c(dT2−dT1)+diono+drev+dtrop) (2)
where diono: the radio wave ionosphere propagation delay error (calculated by using the navigation message) [m], dtrop: the radio wave troposphere propagation delay error (calculated according to a predetermined error model) [m], drev: the receiver noise (equal for every receiver channel) [m], and dmp: the multipath error (=0; in the case of a GPS satellite having a large elevation angle) [m].
The navigation equipment then estimates the pseudo range error (the multipath error) (step ST14). More specifically, the pseudo range error estimating unit 14 calculates the multipath error included in the pseudo range by comparing the delta range measured by the signal processing unit 12 with the range rate, and sends the calculation result to the user position observing unit 15 and the user heading searching unit 17. Because the calculation of the multipath error is described in detail in patent reference 3, please refer to this patent reference as needed.
The navigation equipment then carries out calculation of an error variance of the pseudo range (step ST15). More specifically, the pseudo range error estimating unit 14 calculates a variance per predetermined time of the pseudo range error (the multipath error) in each of the GPS satellite radio waves which is calculated in step ST14, and sends the calculation result to the user position observing unit 15 and the user heading searching unit 17.
The navigation equipment then checks to see whether or not the pseudo range error is smaller than a specified value (step ST16). More specifically, the user heading searching unit 17 compares the pseudo range error (only the multipath error), which is calculated in step ST14 and informed thereto from the pseudo range error estimating unit 14, with the specified value. When, in this step ST16, determining that the pseudo range error is smaller than the specified value, the user heading searching unit determines that it can search for the heading of the vehicle, and then advances the sequence to step ST17. In contrast, when, in this step ST16, determining that the pseudo range error is equal to or larger than the specified value, the user heading searching unit determines that it cannot search for the heading of the vehicle, and then skips step ST17 and advances the sequence to step ST18.
For example, when the vehicle is travelling along a country road, the navigation equipment performs the process of step ST17 on most of the received GPS satellite radio waves. In contrast, when the vehicle is traveling along a road in an urban area, because GPS satellite radio waves are blocked or reflected by buildings or the like extending along the road, as shown in, for example,
The navigation equipment, in step ST17, carries out a search for the heading of the vehicle. More specifically, the user heading searching unit 17 analyzes the range rate which is measured by the signal processing unit 12 and is not affected by the influence of multipath propagation, and searches for the heading of the vehicle.
Because this range rate of a GPS satellite can be measured from the Doppler shift of the carrier frequency of the GPS satellite radio wave from the GPS satellite, if the position and velocity of the GPS satellite and the position and velocity of the vehicle are known, the range rate can be calculated as a relative movement between them according to the following equation (3). When the vehicle is stationary, the waveform of the range rate which is calculated with the velocity of the vehicle in the equation (3) being set to zero is shown by the “estimated value (stationary)” of
The navigation equipment, in this step ST17, calculates the velocity vector of the vehicle and the range rate at a time when the vehicle changes its heading within a predetermined angle range, and searches for the heading in such a way as to assume, as the heading of the vehicle, the heading at a time when the difference between the waveform acquired through this calculation and the waveform (the “measurement value”) acquired through the measurement is equal to or smaller than a specified value. When, in this step ST17, searching for the heading, the navigation equipment compares the heading which it has searched for with the heading of the vehicle. Then, when the difference between them is equal to or larger than a predetermined angle, the navigation equipment determines that the heading of the vehicle has a large error, and corrects the heading of the vehicle with reference to the heading which it has searched for, as shown in
[Equation 3]
Δρrate-est=LOSx×(Vsx−Vox)+LOSy(Vsy−Voy)+LOSz(Vsz−Voz) (3)
where
LOSx=(xo−xs)/∥Ps−Po∥,
LOSy=(yo−ys)/∥Ps−Po∥,
LOSz=(zo−zs)/∥Ps−Po∥, and
∥Ps−Po∥={(xs−xo)2+(ys−yo)2+(zs−zo)2}1/2,
and where Δρrate-est: the estimated value of the range rate [m/s], Ps: the position of each of the GPS satellites (calculated from the navigation message) (xs, ys, zs) [m], Vs: the velocity of each of the GPS satellites (calculated from the navigation message) (vs, vs, vs) [m], Po: the position of the vehicle (xo, yo, zo) [m], Vs: the velocity of the vehicle (vs, vs, vs) [m], ∥Ps−Po∥: the distance between the position of each of the GPS satellites and the position of the vehicle [m], and LOS: the line of sight vector extending from the vehicle toward each of the GPS satellites.
The navigation equipment then checks to see whether the GPS satellite radio waves have been received from four or more satellites and whether a convergence calculation has been carried out a specified number of times or less (step ST18). More specifically, the user velocity and heading observing unit 16 checks to see whether or not the number of received GPS satellite radio waves is four or more, and whether the number of times that a convergence calculation has been carried out is equal to or less than the specified number of times. When, in this step ST18, determining that the number of received GPS satellite radio waves is less than four or the number of times that a convergence calculation has been carried out exceeds the specified number of times, the user velocity and heading observing unit determines that it cannot carry out positioning and ends the positioning process.
In contrast, when, in step ST18, determining that the number of received GPS satellite radio waves is equal to or greater than four and the number of times that a convergence calculation has been carried out is equal to or less than the specified number of times, the user velocity and heading observing unit calculates the velocity (vector) of the vehicle (step ST19). More specifically, the user velocity and heading observing unit 16 calculates the velocity vector of the vehicle according to equation (4) by using the range rate, the position and velocity of each of the GPS satellites at the reception time informed thereto from the GPS satellite behavior estimating unit 13, the position and velocity of the vehicle, and the range rate of each of the GPS satellites at the reception time of receiving the corresponding GPS satellite radio wave, which is informed thereto from the signal processing unit 12. The user velocity and heading observing unit 16 also calculates the heading (scalar) of the vehicle from the calculated velocity components in the X, Y, and Z-axes, and the position of the vehicle (n in the equation (4) shows an element number in a matrix, and is not PRN (Pseudo Random Noise code). The equation (4) is the one in which Vo is set to 0 in the equation (3).
where Δρrate-mes: the measurement value of the range rate [m/s], Δρrate-est: the estimated value of the range rate [m/s], Vo: the velocity of the vehicle (Vox, Voy, Voz, Vot) [m/s], A: a navigation matrix, W: a weighted matrix, and σδρ: the standard deviation of the pseudo range error.
The navigation equipment then calculates the position (vector) of the vehicle (step ST20). More specifically, the user position observing unit 15 determines, as a solution which reduces the sum of the squares of the pseudo range errors to a minimum, an error in the position of the vehicle and an error in the internal clock of the navigation equipment according to a weighted least squares method or the like by using, for example, the equation (5) so as to correct the position of the vehicle and the internal clock of the navigation equipment. In this case, when, in step ST17, succeeding in searching for the heading, the navigation equipment makes an adjustment so as to update the position of the vehicle within a predetermined angle range including this heading, as shown in a position update region which is the inside of a position error circle of
δPo: the position error in the position of the vehicle (δPox, δPoy, δPoz, δPot) [m] (δPot/c: the clock error), Po: the position of the vehicle (Pox, Poy, Poz, Pot) [m], A: the navigation matrix, W: the weighted matrix, σδρ: the standard deviation of the pseudo range error, and c: the light velocity (=2.99792458×108) [m/s].
The navigation equipment is constructed in such a way as to, in the above-mentioned positioning process, calculate the velocity and position of the vehicle by using a weighted least squares method. As an alternative, the navigation equipment can be constructed in such a way as to calculate the velocity and position of the vehicle by using sequential calculations or a Kalman filter.
As previously explained, the navigation equipment in accordance with Embodiment 1 of the present invention compares the delta range of each of GPS satellites which is easily affected by the influence of multipath propagation with the range rate of each of the GPS satellites which cannot be easily affected by the influence of multipath propagation so as to determine a pseudo range error in the pseudo range caused by the influence of multipath propagation. Therefore, the navigation equipment can grasp the influence of multipath propagation for each of the GPS satellites.
Furthermore, as to the range rate which is not affected by influence of multipath propagation, the navigation equipment compares a measurement value with an estimated value, and can detect the heading of the vehicle from the heading used for calculation of the estimated value at the time when the measurement value and the estimated value match each other. In a case in which, for example, the field of vision over the vehicle becomes narrowed because of buildings when the vehicle is traveling along a road in an urban area and therefore the number of GPS satellites which can be used for the positioning is reduced to one or two, or when having still received only one or two GPS satellite radio waves after powered on, a conventional navigation equipment cannot carry out the GPS positioning and therefore stops update of the position and heading of the vehicle. In contrast, even in such a case, the navigation equipment in accordance with this Embodiment 1 can detect the heading of the vehicle and can notify the heading of the vehicle to the driver and so on.
The navigation equipment in accordance with this Embodiment 2 is constructed in such a way that a velocity sensor 21 and a user velocity measuring unit 22 are added to the navigation equipment in accordance with Embodiment 1, and the function of the user velocity and heading observing unit 16 is changed. Hereafter, the same components as those of the navigation equipment in accordance with Embodiment 1 are designated by the reference numerals used in Embodiment 1 respectively, and the explanation of the components will be omitted hereafter and only different components will be explained hereafter.
The velocity sensor 21 outputs a pulse signal according to the velocity of the vehicle. The pulse signal outputted from this velocity sensor 21 is sent to the user velocity measuring unit 22. The user velocity measuring unit 22 converts the pulse signal sent thereto from the velocity sensor 21 into the velocity of the vehicle. The velocity of the vehicle acquired by this user velocity measuring unit 22 is informed to a user velocity and heading observing unit 16. After measuring the velocity (vector) of the vehicle by using the GPS and the velocity sensor 21 together, the user velocity and heading observing unit 16 calculates the heading of the vehicle from the velocity of the vehicle in each of X, Y, and Z-axes, and the position of the vehicle.
Next, the operation of the navigation equipment in accordance with Embodiment 2 of the present invention which is constructed as mentioned above will be explained with reference to a flow chart shown in
In the positioning process, the navigation equipment performs calculation of the velocity (scalar) of the vehicle first (step ST31). More specifically, the user velocity measuring unit 22 converts the pulse signal sent thereto from the velocity sensor 21 into the velocity (scalar) of the vehicle, and informs the velocity to the user velocity and heading observing unit 16. The navigation equipment then checks to see whether or not it is performing GPS reception (step ST11). When the navigation equipment, in this step ST11, determines that it is not performing GPS reception, the navigation equipment ends the positioning process. In contrast, when the navigation equipment, in step ST11, determines that it is performing GPS reception, the navigation equipment calculates the behavior (the position and velocity) of each of the GPS satellites (step ST12).
The navigation equipment then calculates pseudo range errors (a GPS-satellite-mounted clock error and a radio wave atmosphere propagation delay error) (step ST13). The navigation equipment further estimates a pseudo range error (a multipath error) (step ST14). The navigation equipment then calculates an error variance of the pseudo range (step ST15). The navigation equipment then checks to see whether or not the pseudo range error is smaller than a specified value (step ST16). When, in this step ST16, determining that the pseudo range error is smaller than the specified value, the user navigation equipment determines that it can search for the heading of the vehicle, and then advances the sequence to step ST32. In contrast, when, in this step ST16, determining that the pseudo range error is equal to or larger than the specified value, the navigation equipment determines that it cannot search for the heading of the vehicle, and then skips step ST32 and advances the sequence to step ST18.
In step ST32, the navigation equipment calculates the heading (scalar) and position of the vehicle. More specifically, the user heading searching unit 17 calculates the velocity vector of the vehicle and the range rate at a time when the vehicle changes its heading within a predetermined angle range, and searches for the heading in such a way as to assume, as the heading of the vehicle, the heading at a time when the difference between the waveform acquired through this calculation and the waveform (refer to the “measurement value” of
In the first calculation in the positioning process which the navigation equipment performs periodically, when calculating the velocity vector of the vehicle, the navigation equipment changes the heading within a large angle range including the heading of the vehicle determined in the previous prediction processing and then converts the velocity (scalar) measured by the velocity sensor 21 and the user velocity measuring unit 22 into the velocity vector. At this time, as the navigation equipment advances the convergence calculation, the navigation equipment gradually narrows the angle range including the heading of the vehicle acquired in step ST33. When the requirements in step ST18 are not satisfied and the heading of the vehicle is not calculated in step ST33, the navigation equipment keeps the angle range large. When then, in this step ST32, having searched for the heading, the navigation equipment compares this heading with the heading of the vehicle. When the difference between them is equal to or larger than a predetermined angle, the navigation equipment determines that the heading of the vehicle has a large error, and then corrects the heading of the vehicle with reference to the heading which it has searched for, as shown in
As previously explained, the navigation equipment in accordance with Embodiment 2 of the present invention measures the velocity of the vehicle on the basis of the pulse signal sent thereto from the velocity sensor 21. Therefore, the navigation equipment can always determine the velocity of the vehicle accurately. Furthermore, because the navigation equipment uses this high-accuracy velocity when searching for the heading of the vehicle at a time of having acquired the range rate without any influence of multipath propagation, the navigation equipment can determine the heading of the vehicle accurately.
As a result, when, for example, the field of vision over the vehicle becomes narrowed because of buildings when the vehicle is traveling along a road in an urban area and therefore the number of GPS satellites which can be used for the positioning is reduced to one or two, or when having still received only one or two GPS satellite radio waves after powered on, a conventional navigation equipment cannot carry out the GPS positioning and therefore stops update of the position and heading of the vehicle. In contrast, the navigation equipment in accordance with this Embodiment 2 can detect the heading of the vehicle by only receiving the range rate without any influence of multipath propagation from one GPS satellite. Therefore, the navigation equipment in accordance with this Embodiment 2 can estimate the position of the vehicle on the basis of the velocity and heading of the vehicle, thereby improving its availability.
The angular velocity sensor 23 outputs a signal according to the turning angular velocity of the vehicle. The signal outputted from this angular velocity sensor 23 is sent to the user turning angle measuring unit 24. The user turning angle measuring unit 24 measures the turning angle of the vehicle from the signal sent thereto from the angular velocity sensor 23. The turning angle of the vehicle measured by this user turning angle measuring unit 24 is informed to the user behavior measuring unit 25.
The user behavior measuring unit 25 performs dead reckoning calculation by using the velocity informed thereto from the user velocity measuring unit 22 and the turning angle informed thereto from the user turning angle measuring unit 24 so as to update the position, velocity, and heading of the vehicle.
While the user position observing unit 15 observes the position of the vehicle by using GPS satellite radio waves, like the navigation equipment in accordance with Embodiment 1, the navigation equipment in accordance with this Embodiment 3 corrects the position of the vehicle measured by the user behavior measuring unit 15.
Furthermore, while the user heading searching unit 17 analyzes the range rate and then searches for the heading of the vehicle, the user heading searching unit uses the results calculated by the user behavior measuring unit 25 as the position, heading, and velocity of the vehicle, and also uses a predetermined angle range including the heading calculated by the user behavior measuring unit 25 as an angle range within which the user heading searching unit changes the heading.
Next, the operation of the navigation equipment in accordance with Embodiment 3 of the present invention which is constructed as mentioned above will be explained with reference to a flow chart shown in
In the positioning process, the navigation equipment calculates the velocity (scalar) of the vehicle first (step ST31). The navigation equipment then calculates the turning angle (scalar) of the vehicle (step ST41). More specifically, the user turning angle measuring unit 24 measures the turning angle of the vehicle from the signal sent thereto from the angular velocity sensor 23. The navigation equipment then calculates the position (vector) of the vehicle (step ST42). More specifically, the user behavior measuring unit 25 performs dead reckoning calculation by using the velocity informed thereto from the user velocity measuring unit 22, and the turning angle informed thereto from the user turning angle measuring unit 24 so as to determine the position, heading, and velocity of the vehicle.
The navigation equipment then checks to see whether or not it is performing GPS reception (step ST11). When the navigation equipment, in this step ST11, determines that it is not performing GPS reception, the navigation equipment ends the positioning process. In contrast, when the navigation equipment, in step ST11, determines that it is performing GPS reception, the navigation equipment calculates the behavior (the position and velocity) of each of the GPS satellites (step ST12). The navigation equipment then calculates pseudo range errors (a GPS-satellite-mounted clock error and a radio wave atmosphere propagation delay error) (step ST13). The navigation equipment further estimates a pseudo range error (a multipath error) (step ST14). The navigation equipment then calculates an error variance of the pseudo range (step ST15). The navigation equipment then checks to see whether the pseudo range error is smaller than a specified value (step ST16). When, in this step ST16, determining that the pseudo range error is smaller than the specified value, the user navigation equipment determines that it can search for the heading of the vehicle, and then advances the sequence to step ST43. In contrast, when, in this step ST16, determining that the pseudo range error is equal to or larger than the specified value, the navigation equipment determines that it cannot search for the heading of the vehicle, and then advances the sequence to step ST18.
In step ST43, the navigation equipment calculates the heading (scalar) of the vehicle. More specifically, the user heading searching unit 17 calculates the velocity vector of the vehicle and the range rate at a time when the vehicle changes its heading within a predetermined angle range, and searches for the heading in such a way as to assume, as the heading of the vehicle, the heading at a time when the difference between the waveform acquired through this calculation and the waveform (refer to the “measurement value” of
When calculating the velocity vector of the vehicle, the navigation equipment changes the heading within a large angle range including the heading of the vehicle which is determined in step ST42 by the user behavior measuring unit 25, and then converts the velocity (scalar) measured by the velocity sensor 21 and the user velocity measuring unit 22 into the velocity vector. At this time, as the navigation equipment advances the convergence calculation for the GPS positioning in steps ST12 to ST21, the navigation equipment gradually narrows the angle range including the heading of the vehicle acquired in step ST42. When, in this step ST43, having searched for the heading, the navigation equipment then compares this heading with the heading of the vehicle acquired in step ST42. When the difference between them is equal to or larger than a predetermined angle, the navigation equipment determines that the heading of the vehicle has a large error, and then corrects the heading of the vehicle with reference to the heading which it has searched for, as shown in
As explained above, because the navigation equipment in accordance with this Embodiment 3 measures the velocity and turning angle of the vehicle on the basis of the signal sent from the velocity sensor 21 and the signal sent from the angular velocity sensor 23, the navigation equipment can always determine the velocity and turning angle of the vehicle with a high accuracy. Furthermore, because the navigation equipment uses this high-accuracy velocity when searching for the heading of the vehicle at a time of having acquired the range rate without any influence of multipath propagation, the navigation equipment can determine the heading of the vehicle accurately. Because the navigation equipment can correct the heading of the vehicle properly even when the vehicle is travelling in an urban area, the navigation equipment stabilizes the accuracy of the heading measurement using dead reckoning. Furthermore, because the navigation equipment properly corrects the position of the vehicle (dead reckoning) which it has determined by using the user behavior measuring unit 25 with reference to the position which it determined with the GPS positioning when the influence of multipath propagation was small, the navigation equipment reduces the accumulation of errors which is a drawback of dead reckoning, and also stabilizes the accuracy of the heading measurement using dead reckoning.
The angular velocity sensor correcting unit 26 accepts a heading calculated by a user behavior measuring unit 25 and a heading calculated by a user heading searching unit 17, and corrects a correction parameter (a bias voltage) used at a time of measurement of the turning angle of the vehicle from an output voltage of an angular velocity sensor 23. The correction parameter corrected by this angular velocity sensor good unit 26 is informed, as an offset error, to a user turning angle measuring unit 24. The user turning angle measuring unit 24 measures the turning angle of the vehicle from the signal sent thereto from the angular velocity sensor 23 after correcting the bias voltage by using the offset error informed thereto from the angular velocity sensor correcting unit 26.
Next, the operation of the navigation equipment in accordance with Embodiment 4 of the present invention which is constructed as mentioned above will be explained with reference to a flow chart shown in
In the positioning process shown in the flow chart of
For example, when the vehicle is traveling in a straightforward direction (in a traveling direction shown by a dotted line arrow shown in
As previously explained, even if a temperature drift occurs in the angular velocity sensor 23, the navigation equipment in accordance with Embodiment 4 of the present invention can detect and correct an error occurring in the bias voltage of the angular velocity sensor 23. Therefore, the user turning angle measuring unit 24 can measure the turning angle accurately. As a result, the navigation equipment can maintain the accuracy of the position and heading of the vehicle which are measured by the user behavior measuring unit 25 (dead reckoning) at a high level.
The map data storage unit 31 stores map data about roads in a predetermined area, the map data consisting of linear data and data about road links each shown by coordinate points and so on. The map data stored in this map data storage unit 31 are read by the road comparing unit 32.
The road comparing unit 32 compares the position of the vehicle observed by the user position observing unit 15 and the heading searched for by the user heading searching unit 17 with the position and direction of a road link which the road comparing unit has read from the map data storage unit 31 respectively, sets up a plurality of candidates for the current position of the vehicle on a road link which has been judged to provide a match with the highest reliability or more, and selects one candidate to be displayed from among the plurality of candidates to determine the candidate's position as the position of the vehicle. The road comparing unit 32 also updates the position of each of the candidates on the road link on the basis of both the velocity of the vehicle calculated by the user velocity and heading observing unit and the heading searched for by the user heading searching unit 17, and evaluates each candidate's reliability according to the difference between the heading searched for by the user heading searching unit 17 and that of the road link so as to select, as the position of the user, the position of the candidate providing the highest reliability among all the candidates.
Next, the operation of the navigation equipment in accordance with Embodiment 5 of the present invention constructed as mentioned above will be explained with reference to a flow chart shown in
In the positioning process shown in the flow chart of
For example, in a case shown in
Furthermore, in a case in which two roads branching off from a single road are running in parallel with each other, as shown in
As previously explained, the navigation equipment in accordance with Embodiment 5 of the present invention can judge whether or not each of GPS satellite radio waves received thereby is under the influence of multipath propagation and can also detect the heading of the vehicle if it receives one GPS satellite radio wave which is not affected by the influence of multipath propagation. Therefore, the navigation equipment can limit the angle of heading region in which the vehicle is existing with respect to a GPS position error circle, and can perform the map matching without being greatly affected by the influence of the GPS positioning results whose accuracy is reduced due to multipath propagation. As a result, the navigation equipment can stably and smoothly determine the heading and position of the vehicle on a road in an on-screen map. Accordingly, the navigation equipment can perform guidance and so on appropriately.
Furthermore, because the navigation equipment can evaluate the reliability of the heading of each of a plurality of candidates which are set up in the map matching even in a multipath environment if it receives one GPS satellite radio wave which is not affected by the influence of multipath propagation, the navigation equipment can reduce the occurrence of a mismatch to a road link having a different direction.
The map data storage unit 31 stores map data about roads in a predetermined area, the map data consisting of linear data and data about road links each shown by coordinate points and so on. The map data stored in this map data storage unit 31 are read by the road comparing unit 32.
The road comparing unit 32 compares the position and heading of the vehicle calculated by a user behavior measuring unit 25 with the position and direction of a road link which the road comparing unit has read from the map data storage unit 31 respectively, sets up a plurality of candidates for the current position of the vehicle on a road link which has been judged to provide a match with the highest reliability or more, and selects one candidate from among the plurality of candidates to determine the candidate's position as the position of the vehicle. The road comparing unit 32 also updates the position of each of the candidates on the road link on the basis of both the velocity of the vehicle calculated by a user velocity measuring unit 22 and the turning angle of the vehicle measured by a user turning angle measuring unit 24, and evaluates each candidate's reliability according to the difference between the heading searched for by a user heading searching unit and that of the road link so as to select, as the position of the user, the position of the candidate providing the highest reliability among all the candidates.
Next, the operation of the navigation equipment in accordance with Embodiment 6 of the present invention constructed as mentioned above will be explained with reference to a flow chart shown in
In the positioning process shown in the flow chart of
For example, in a case in which two roads branching off from a single road are running in parallel with each other, as shown in
Furthermore, in a case in which the vehicle advances to a road at a lower altitude after turning around on a loop bridge, as shown in
As previously explained, even when an error occurs in the position of a candidate on a road link due to accumulation of a digitization error in the road link, an error in the sensors, and a rounding error in the calculated value while continuing to update the position of the candidate on the road link by using both the velocity of the vehicle measured by the velocity sensor 21 and the turning angle of the vehicle measured by the angular velocity sensor 23, the navigation equipment in accordance with Embodiment 6 of the present invention knows the correct heading of the vehicle by only receiving the range rate without influence of multipath propagation from one GPS satellite. Therefore, the navigation equipment in accordance with Embodiment 6 of the present invention can correct the position of the candidate on the road link.
Furthermore, the navigation equipment can judge whether or not each of GPS satellite radio waves received thereby is under the influence of multipath propagation and can also detect the heading of the vehicle if it receives one GPS satellite radio wave which is not affected by the influence of multipath propagation. Therefore, the navigation equipment can limit the angle of heading region in which the vehicle is existing with respect to a GPS position error circle, and can perform the map matching smoothly without being greatly affected by the influence of the GPS positioning results whose accuracy is reduced due to multipath propagation.
Furthermore, because the navigation equipment can evaluate the reliability of the heading of each of a plurality of candidates which are set up in the map matching even in a multipath environment if it receives one GPS satellite radio wave which is not affected by the influence of multipath propagation, the navigation equipment can prevent a map mismatch to a road link having a different direction and update the position of the vehicle more smoothly. In addition, because the navigation equipment can reduce the number of candidates by limiting to candidates providing a match to the heading and reduce the load on the map matching process, the navigation equipment can perform the map matching process at shorter time intervals.
Furthermore, because the navigation equipment can limit the heading of the vehicle for which the navigation equipment calculates an estimated value of the range rate within a predetermined angle range including the direction of a road link on which a candidate exists, the processing load on the heading search does not increase even in a case in which there is no multipath influence on all the received GPS satellite radio waves. As a result, the navigation equipment does not have to lower the time intervals at which it carries out the map matching.
In addition, because the navigation equipment can detect the heading of the vehicle if it receives one GPS satellite radio wave which is not affected by the influence of multipath propagation, the navigation equipment can correct the position of the vehicle promptly every time when the vehicle changes its heading in the vicinity of a branch point, an intersection, or a heading change point even though the position of the vehicle on the road link has an error. Furthermore, although there is a case in which a remarkable difference occurs between the distance actually traveled by the vehicle the length of the corresponding road link even when, for example, the vehicle is traveling a single greatly-curved road, the navigation equipment can promptly correct the position of the vehicle to an appropriate position every time when the vehicle changes its heading even in this case.
The navigation equipment in accordance with any one of above-mentioned Embodiments 1 to 6 is constructed in such a way as to detect the correct heading of the vehicle after having succeeded in correctly measuring the velocity of the vehicle. In contrast, navigation equipment in accordance with this Embodiment 7 is constructed in such a way as to, when having succeeded in correctly measuring the heading of the vehicle even though the velocity of the vehicle has a large error, correct the velocity of the vehicle in such a way that the velocity of the vehicle shows an appropriate value.
The navigation equipment additionally includes a user velocity searching unit (not illustrated) for, when having succeeded in recognizing that the heading of the vehicle is correct through GPS positioning while, for example, the vehicle is traveling in a straight line, in order to estimate the range rate, comparing an estimated value which the user velocity searching unit has calculated by changing a coefficient, by which the velocity of the vehicle is to be multiplied, within a predetermined range with a received measurement value, and for searching for the coefficient (a scale factor of the velocity sensor 21) at a time when their waveforms match each other. When the user velocity searching unit then detects the scale factor of the velocity sensor 21, the user velocity measuring unit measures the velocity of the vehicle from the pulses of the velocity sensor 21 by using this scale factor.
With this structure, when the error in the heading of the vehicle is small, in order to estimate the range rate, the navigation equipment compares an estimated value which the user velocity searching unit has calculated by changing the coefficient, by which the velocity of the vehicle is to be multiplied, within a predetermined range while keeping the heading constant, with a received measurement value, and corrects the velocity by using the coefficient at a time when the waveforms of the estimated and measurement values match each other. Therefore, even in a case in which the navigation equipment cannot carry out GPS positioning because the number of GPS satellites which can be used for positioning is one or two, the navigation equipment can correct the velocity of the vehicle in such a way that the velocity of the vehicle shows an appropriate value if the navigation equipment can receive one GPS satellite radio wave without any influence of multipath propagation.
When receiving a GPS satellite radio wave without any influence of multipath propagation, the navigation equipment in accordance with any one of above-mentioned Embodiments 1 to 6 is constructed in such a way as to use the heading which the navigation equipment has detected by analyzing the range rate to correct the heading of the vehicle or evaluate the reliability of a candidate for map matching. As an alternative, the navigation equipment can be constructed in such a way as to, when receiving a plurality of GPS satellite radio waves without any influence of multipath propagation at the same time and then detecting a plurality of headings, perform a statistical process on the plurality of detected headings and then carry out the above-mentioned processes. According to this structure, the navigation equipment can detect the heading of the vehicle more accurately.
The navigation equipment can also be constructed in such a way as to, even when receiving only one GPS satellite radio wave without any influence of multipath propagation, perform a statistical process on a plurality of detected headings if receiving the plurality of headings at a plurality of points respectively, and then carryout the above-mentioned processes. According to this structure, the navigation equipment can detect the heading of the vehicle more accurately.
As mentioned above, the navigation equipment in accordance with the present invention can judge whether or not each of GPS satellite radio waves received thereby is under the influence of multipath propagation and can also detect the heading of a vehicle if the navigation equipment can receive one GPS satellite radio wave which is not affected by the influence of multipath propagation even in a case in which the navigation equipment cannot carry out GPS positioning because the number of GPS satellites which can be used for positioning is one or two. As a result, the navigation equipment can reduce the influence of multipath propagation without causing any reduction in its availability, and can improve the positioning accuracy. Therefore, the navigation equipment in accordance with the present invention is suitable for use as a vehicle-mounted navigation equipment or the like that carries out positioning and map matching using a GPS receiver and a dead reckoning sensor.
| Number | Date | Country | Kind |
|---|---|---|---|
| 2007-234367 | Sep 2007 | JP | national |
| Filing Document | Filing Date | Country | Kind | 371c Date |
|---|---|---|---|---|
| PCT/JP2008/001805 | 7/7/2008 | WO | 00 | 2/4/2010 |
| Publishing Document | Publishing Date | Country | Kind |
|---|---|---|---|
| WO2009/034671 | 3/19/2009 | WO | A |
| Number | Name | Date | Kind |
|---|---|---|---|
| 5438517 | Sennott et al. | Aug 1995 | A |
| 5442558 | Kyrtsos et al. | Aug 1995 | A |
| 5552794 | Colley et al. | Sep 1996 | A |
| 7158883 | Fuchs et al. | Jan 2007 | B2 |
| 7463189 | Bryant et al. | Dec 2008 | B2 |
| 7705775 | Madhavan et al. | Apr 2010 | B2 |
| 20100169006 | Ueda et al. | Jul 2010 | A1 |
| Number | Date | Country |
|---|---|---|
| 197 05 740 | Aug 1997 | DE |
| 1 218 694 | Nov 2006 | EP |
| 10-47983 | Feb 1998 | JP |
| 2001-124840 | May 2001 | JP |
| 2001-272239 | Oct 2001 | JP |
| 2002-213979 | Jul 2002 | JP |
| 3745165 | Feb 2006 | JP |
| 2006-322846 | Nov 2006 | JP |
| 2007-10550 | Jan 2007 | JP |
| WO-2005017552 | Feb 2005 | WO |
| Number | Date | Country | |
|---|---|---|---|
| 20110071755 A1 | Mar 2011 | US |
