The present invention claims priority of Korean Patent Application No. 10-2011-0042465, filed on May 4, 2011, which is incorporated herein by reference.
1. Field of the Invention
The present invention relates to a method of determining a drive lane, and more particularly, to a method of accurately determining the drive lane of a road using a precise digital map capable of differentiating the lanes of the road and carrier-based differential GPS having a high accuracy capable of differentiating the lanes of the road as well as a steering wheel model of a vehicle.
2. Description of Related Art
Generally, a navigation device which is widely used in a vehicle in order to assist a driver is to provide route information to the driver's destination. A driver can see a map displayed on a terminal of a navigation system or listen to voice message while driving a car.
The navigation device functions to combine location information obtained from GNSS (global navigation satellite system) and geographic data of a digital map and then to display a vehicle position on a road displayed on the map.
However, a conventional navigation device can just indicate rough road information, but cannot indicate precise information about a drive lane occupied by a vehicle. In other words, the conventional navigation device can guide only route and direction information to a destination, but cannot guide the route on the basis of the drive lane of the road on which a vehicle is running. For example, in case that the vehicle which intends to turn left runs on other lanes except the first lane, the conventional navigation device could not inform of lane change.
Therefore, there is a problem in that, since a driver has to recognize and determine the conditions around the vehicle and the actual drive lane occupied by the vehicle and then to change the lane, it is limited to provide practical information to the driver.
In order to solve the problem, the inventors have proposed a method of determining the drive lane using precise GPS information capable of differentiating each road lane and a precise digital map capable of displaying the lane information, which has been filed and issued as a patent (Korean Patent No. 10-1010678 entitled “a navigation device and a drive lane determining method thereof”).
In the drive lane determination method, a vehicle position is estimated on the basis of satellite signals received from a carrier-based navigation satellite system and compensation information received from a station, and an extent of lane differentiation is halved by determining a drive direction of the vehicle using vehicle location information and road lane information stored in a digital map, and a distance between a center line of each lane and a vehicle location is calculated by using the vehicle location information and the road lane information, and the road lane having a minimum value among the calculated distances is determined as a drive lane. In this method, however, the drive lane of a running vehicle is differentiated only using the satellite signals and the road lane information. Therefore, even when an error is occurred in the lane differentiation, it is impossible to correct the error, and thus reliability in the lane differentiation is deteriorated.
An embodiment of the present invention is directed to providing a method of determining a drive lane, in which a precise position differentiation technique and a precise digital map capable of differentiating each road lane are utilized, and in which it is checked whether an error is occurred in GPS information using information of a steering wheel direction of a vehicle, when the drive line is determined, and then if the error is occurred, the error can be corrected, thereby considerably increasing the performance of differentiating the road lane.
To achieve the object of the present invention, the present invention provides a method of determining a drive lane using a steering wheel model, including a step S100 of preparing a precise digital map having an accuracy capable of differentiating each road lane; a step S200 of estimating a vehicle location on a road using GPS information; a step S300 of checking whether the vehicle location information is normal using a difference between variation ΔΨk+1GPS in the azimuth angle of the vehicle obtained by using the GPS information and variation ΔΨk+1veh in the azimuth angle of the vehicle obtained by using the steering wheel model; and a step S500 of determining and outputting a drive lane occupied by the running vehicle, wherein, if the vehicle location information is normal as a result of the step S300, the step S500 is performed without a compensating step S400 so that the GPS information obtained in the step S200 is output as the road lane, and if the vehicle location information is abnormal, the compensating step S400 and the step S500 are performed in turn so that the road lane is output according to the result of the step S400.
Further, the present invention provides a method of determining a drive lane using a steering wheel model, including a step S100 of preparing a precise digital map having an accuracy capable of differentiating each road lane; a step S200 of estimating the vehicle location on a road using GPS information; and a step S300 of obtaining an azimuth angle Ψk+1DR of the vehicle using a previous azimuth angle ΨkGPS of the vehicle obtained by using the GPS information and variation ΔΨk+1veh azimuth angle of the vehicle obtained by using the steering wheel model, and checking whether the vehicle location information is normal using a difference between a current azimuth angle Ψk+1GPS of the vehicle obtained by using the GPS information and a current azimuth angle Ψk+1DL of the vehicle, wherein, if the vehicle location information is normal as a result of the step S300, a step S500 of determining and outputting a drive lane information occupied by a running vehicle is performed without a compensating step S400 so that the GPS information obtained in the step S200 is output as the road lane information, and if the vehicle location information is abnormal, the compensating step S400 and the step S500 are performed in turn so that the road lane information is output according to the result of the step S400.
The advantages, features and aspects of the invention will become apparent from the following description of the embodiments with reference to the accompanying drawings, which is set forth hereinafter.
The present invention is to provide a method of exactly determining a drive lane of a running vehicle using a precise digital map capable of differentiating each road lane and carrier-based differential GPS information having a high accuracy capable of recognizing each road lane. To this end, as shown in
(1) The Step S100 of Preparing a Precise Digital Map
In this step, a digital map stored in a navigation system is prepared into a precise digital map having a high accuracy capable of differentiating each road lane.
The navigation system (hereinafter, called ‘vehicle terminal’) used in a vehicle stores a map including road network information, information of the number of road lanes and the like. The vehicle terminal guides a route to a destination using the information included in the map.
However, a conventional vehicle terminal did not inform an exact drive lane occupied by a running vehicle while guiding a route to a destination.
Therefore, the present invention uses a precise digital map including information (hereinafter, called ‘lane differentiation information) of lane differentiation on a road as well as the road network information and the information of the number of road lanes, instead of the conventional digital map.
(2) The Step S200 of Calculating a Vehicle Location
In this step, the vehicle terminal precisely and exactly calculates a vehicle location on a road using GPS information received from a station and other GPS information directly received through the vehicle terminal.
In order to obtain the GPS information having a high accuracy capable of differentiating a drive lane occupied by a running vehicle, the present invention uses carrier-based differential GPS information which can provide precise location information, instead of the conventional GPS information.
The conventional GPS information provides service of measuring location, speed and time of a vehicle using a satellite. In the location measurement, a GPS receiver measures precise time and distance using four or more navigation satellite systems and then calculates a user location using a triangulation method.
However, since signals received from the navigation satellite systems includes various errors such as satellite orbit information error, satellite time information error, time delaying error occurred when GPS signals pass through the ionosphere and the troposphere, receiver error and the like, the measurement error comes to about 10 m. Therefore, the conventional GPS information is not suitable to differentiate a road lane having a width of about 3 m.
Differential GPS (DGPS) or differential global navigation satellite system (DGNSS) has been proposed to solve the problems in the conventional GPS information.
In the DGNSS which is a relative positioning type GPS measuring technique, a GPS station is disposed at a standard point of which a location is already known. The GPS station receives satellite signal, compensates errors and then provides the compensated signal to a vehicle or a user through a ground wireless communication network.
Referring to
The navigation satellite receiver 110 is to receive satellite signal transferred from a navigation satellite system 200. In general, the navigation satellite receiver 110 may be called as a GPS module.
The digital map 120 is to store GIS (geographic information system) data with respect to roads and major landmarks around the roads. As described above, the present invention utilizes a precise digital map having lane differentiation information of various roads having multiple lanes.
The radio communication part 130 receives compensation information from a station 300 in order to calculate an accurate location. The station 300 transfers to the radio communication part 130 a compensation error value calculated by comparing an accurately measured position of the station 300 and signals received from the navigation satellite system 200.
The display part 140 and the audio output part 150 are to output the information in the form of visual or audio information. For example, the display part 140 outputs the geographic information stored in the digital map 120 in the form of a map and also indicates a route on the map. The audio output part 150 outputs audio information relevant to straight movement, left turn, right turn and the like.
The control part 160 functions to control the display part 140 and the audio output part 150 on the basis of the data transferred from the navigation satellite receiver 110, the radio communication part 130 and the like.
Further, the vehicle terminal 100 includes a location estimation part 170 which estimates a vehicle location on the basis of the signals from the navigation satellite system 200 and the compensation information received from the station 300, and a lane differentiation part 180 which differentiates a drive lane occupied by a vehicle on the basis of the vehicle location estimated by the location estimation part 170 and the data of the digital map.
The location estimation part 170 and the lane differentiation part 180 are in the form of an algorithm or a program. The location estimation part 170 and the lane differentiation part 180 may be integrally formed with the control part 160 or may be separately formed from the control part 160.
According to the present invention, by using carrier-based DGNSS, it is possible to reduce the location error by an extent of a few dozen cm to a few mm, and thus it is possible to accurately estimate the location information.
Hereinafter, a method of estimating the vehicle location will be described fully.
Firstly, the location estimation part 170 estimates the vehicle location based on the signals of the navigation satellite system 200 and the compensation information of the station 300. Then, the location estimation part 170 determines a drive direction of the vehicle using the vehicle location information and the road lane information of the digital map 120. Herein, the drive direction can be determined by differential of past location information.
If the drive direction is determined, even though it is recognized that the vehicle is located at an opposite road lane as indicated by P2 in
Then, the lane differentiation part 180 calculates a distance between a vehicle location and a center line of each road lane using the road lane information of the digital map 120 and the estimated vehicle location. To this end, the digital map 120 has to include location information of the center line C1, C2, C3 of each road lane as shown in
When the distance between the vehicle location and the center line of each road lane is calculated, a distance between the vehicle location and the center lines C1, C2 and C3 of first, second and third road lanes, as shown in
For example, in case that the vehicle location estimated by the location estimation part 170 is P1, when calculating the distances between the location P1 and the center line C1, C2, C2 of each lane, a distance dl between P1 and C2 is the minimum value. Therefore, the second line having the center line C2 is determined as the drive line.
Herein, in case that the vehicle location estimated by the location estimation part 170 is P2, if the drive direction is determined as an upper direction of
Therefore, the present invention can obtain the precise location information, thereby informing the actual drive lane occupied by the running vehicle.
(3) The Step S300 of Checking Whether Vehicle Location Information is Normal
In the received GPS information (hereinafter, “GPS information”) which is the location information calculated by the DGNSS, the location information P2′ estimated by the GPS information may be different from the actual location information P2″ due to unexpected error or signal receiving failure. In this case, it is not possible to exactly guide the running vehicle.
To solve the problem, the present invention calculates variation in an azimuth angle of the vehicle obtained by using the GPS information and variation in an azimuth angle (a rotated angle around a center axis of the vehicle) of the vehicle obtained by using a steering wheel model, and then compares them in order to check whether the GPS information is normal.
The variation Ψk+1GPS in the azimuth angle of the vehicle obtained by using the GPS information can be obtained by Equation 1.
Ψk+1GPS=Ψk+1GPSΨkGPS, Equation 1
wherein Ψk+1GPS is the variation in the azimuth angle of the vehicle obtained by using the GPS information, Ψk+1GPS is a current azimuth angle of the vehicle obtained by using the GPS information, and ΨkGPS is a previous azimuth angle of the vehicle obtained by using the GPS information.
And the variation Ψk+1veh in the azimuth angle of the vehicle obtained by using the steering wheel model is calculated by Equation 2.
ΔΨk+1veh=ΩZ×1, Equation 2
wherein ΔΨk+1veh is the variation in the azimuth angle of the vehicle obtained by using the steering wheel model, ΩZ is a rotational angular velocity of the vehicle, and t is time.
The rotational angular velocity ΩZ can be calculated by using a vehicle speed V, distance L between front and rear axles, and a front wheel steering angle δj of the vehicle as shown in Equation 3. Herein, the front wheel steering angle δj can be obtained in real time through a torque sensor or an angular velocity sensor installed at the vehicle. The obtained information is input to the vehicle terminal through wire or wireless communication.
wherein ΩZ is the rotational angular velocity, V is the vehicle speed, L is the distance between the front and rear axles, and δj is the front wheel steering angle of the vehicle.
If the variation ΔΨk+1GPS in the azimuth angle of the vehicle obtained by using the GPS information and the variation ΔΨk+1veh the azimuth angle of the vehicle obtained by using the steering wheel model are calculated by Equations 1 and 2, these values are compared with each other as indicated by Equation 4. If the difference is less than a predetermined value, it is determined that the GPS information is normal, but if the difference is more than the predetermined value, it is determined that the GPS information is abnormal.
|ΔΨk+1GPS−ΔΨk+1veh|≧T, Equation 4
wherein ΔΨk+1GPS is the variation in the azimuth angle of the vehicle obtained by using the GPS, ΔΨk+1veh is the variation in the azimuth angle of the vehicle obtained by using the steering wheel model, and T is a threshold value which is set by a user.
As a result of the determination, if the GPS information is normal, the step S500 of determining and outputting the drive lane of the running vehicle, which will be described below, is carried out without performing the compensating step S400 which will be described below, and thus the GPS information obtained in the step S200 of calculating the vehicle location is output as the road lane information. If the GPS information is abnormal, the compensating step S400 and the step S500 of determining and outputting the road lane of the running vehicle are performed in turn, and thus the road lane information is output according to the result of the compensating step S400.
(4) The Compensating Step S400
In this step, if it is determined in the step S300 that the GPS information is abnormal, that is, if the difference between the variation ΔΨk+1GPS in the current azimuth angle of the vehicle obtained by using the GPS information and the variation ΔΨk+1veh in the azimuth angle of the vehicle obtained by using the steering wheel model is more than a predetermined value T, the azimuth angle Ψk+1DR of the vehicle is estimated by using the variation ΔΨk+1veh in the azimuth angle of the vehicle obtained by using the steering wheel model, and then the drive lane occupied by the running vehicle is determined using the relationship between the estimated azimuth angle Ψk+1DR of the vehicle and the road lane.
In other words, if it is determined that the GPS information is abnormal, the azimuth angle Ψk+1DR of the vehicle is obtained by using the previous azimuth angle ΨkGPS of the vehicle obtained by using the GPS information and the variation ΔΨk+1veh in the azimuth angle of the vehicle obtained by using the steering wheel model, as indicated by Equation 5.
Ψk+1DR=ΨkGPS+ΔΨk+1veh, Equation 5
wherein Ψk+1DR is the azimuth angle of the vehicle, ΨkGPS is the previous azimuth angle of the vehicle obtained by using the GPS information, and ΔΨk+1veh is the variation in the azimuth angle of the vehicle obtained by using the steering wheel model.
If the azimuth angle Ψk+1DR of the vehicle is calculated by Equation 5, an azimuth angle Ψk+1DL of the vehicle with respect to the road lane is calculated by Equation 6 which will be described below. The relationship among the azimuth angle Ψk+1DL of the vehicle with respect to the road lane, the azimuth angle Ψk+1DR of the vehicle and a road lane azimuth angle Ψk+1L of the vehicle is shown in
Ψk+1DL=Ψk+1DR−Ψk+1L, Equation 6
wherein Ψk+1DL is the azimuth angle of the vehicle with respect to the road lane, Ψk+1DR is the azimuth angle of the vehicle and Ψk+1L is the road lane azimuth angle of the vehicle. The road lane azimuth angle Ψk+1L of the vehicle can be obtained by using the road lane information stored in the precise digital map.
If the azimuth angle Ψk+1DL of the vehicle with respect to the road lane is obtained by Equation 6, the road lane occupied by the running vehicle is determined through Equations 7 to 9 using the obtained azimuth angle Ψk+1DL of the vehicle with respect to the road lane. That is, if the azimuth angle Ψk+1DL of the vehicle with respect to the road lane, which is obtained by Equation 6, is less than a predetermined value as indicated in Equation 7, the road lane which is determined to be occupied by the running vehicle is changed into a left lane, and if it is within a desired extent as indicated by Equation 8, the road lane is maintained, and if it is more than a predetermined value, the road lane is changed into a right lane.
Ψk+1DL<−T1, Equation 7
wherein Ψk+1DL is the azimuth angle of the vehicle with respect to the road lane, and T1 is a threshold value which is set by a user.
−T1≦Ψk+1DL<T1, Equation 8
wherein Ψk+1DL is the azimuth angle of the vehicle with respect to the road lane, and T1 is the threshold value.
T1≦Ψk+1DL, Equation 9
wherein Ψk+1DL is the azimuth angle of the vehicle with respect to the road lane, and T1 is the threshold value.
However, the above-mentioned description can be applied only when other road lanes are provided left and right. Although the vehicle is running on a rightmost lane, it may be determined that the conditions of Equation 9 are satisfied as the result of the compensating step. In this case, it is necessary to change the road lane into another right lane, but since the current road lane is the rightmost lane, it is impossible to change the road lane. This problem may be also occurred when the vehicle is running on a leftmost lane.
According to the present invention, in case that, as the result of the compensating step, it is necessary to change the road lane into another right or left lane although the vehicle is running on the rightmost or leftmost lane, that is, in case that there is not another right or left lane, the step S300 of checking whether vehicle location information is normal and the compensating step S400 are performed again, as shown in
Till now, it is described about the method of checking whether vehicle location information is normal and the compensating method. Herein, as shown in
Further, the present invention provides another method of checking whether vehicle location information is normal and another compensating method, as shown in
In other words, firstly, it is determined by Equation 4 whether the GPS information is normal. Unlike in the above embodiment in which the azimuth angle Ψk+1DR of the vehicle is obtained by Equation 5 only when the GPS information is abnormal, the azimuth angle Ψk+1DR of the vehicle is obtained by Equation 5, and it is determined whether the GPS information is normal using the obtained value. Herein, Equation 10 instead of Equation 4 is used as a standard of determining whether the GPS information is normal. Then, if the GPS information is normal, the road lane is determined on the basis of the GPS information, and if the GPS information is abnormal, the azimuth angle Ψk+1DL of the vehicle with respect to the road lane is obtained by Equation 6, and the obtained value is applied to Equations 7 to 9. According to the result thereof, the compensating is performed so that the road lane is changed or maintained, or the step S300 of checking whether vehicle location information is normal and the compensating step S400 are performed again according to whether another changeable road lane exists.
|Ψk+1GPS−Ψk+1DR|≧T, Equation 10
wherein Ψk+1GPS is the current azimuth angle of the vehicle obtained by using the GPS information, and Ψk+1DR is the current azimuth angle of the vehicle, and T is a threshold value which is set by a user.
(5) The Step S500 of Determining and Outputting the Drive Lane of the Running Vehicle
In this step, the location information obtained by the GPS information is matched with the road lane information stored in the vehicle terminal, reflecting the results of the step S300 of checking whether vehicle location information is normal and the compensating step S500, and thus the drive lane occupied by the running vehicle is determined. Then, the result is displayed on the vehicle terminal so that the drive lane occupied by the vehicle is displayed.
According to the present invention, since the vehicle location on the road is detected by using the carrier-based differential GPS information and the road lane is determined by using the precise digital map instead of the conventional digital map, it is possible to determine the drive lane occupied by the running vehicle.
Further, the azimuth angles (rotated angle around a center axis of the vehicle) of the vehicle obtained by using the carrier-based differential GPS information and the GPS information are compared with each other, and it is determined by the result thereof whether the GPS information is normal and the compensating thereof is performed. Therefore, reliability in the lane differentiation is improved.
While the present invention has been described with respect to the specific embodiments, it will be apparent to those skilled in the art that various changes and modifications may be made without departing from the spirit and scope of the invention as defined in the following claims.
Number | Date | Country | Kind |
---|---|---|---|
10-2011-0042465 | May 2011 | KR | national |
Number | Name | Date | Kind |
---|---|---|---|
5179519 | Adachi et al. | Jan 1993 | A |
5339246 | Kao | Aug 1994 | A |
5469158 | Morita | Nov 1995 | A |
5796613 | Kato et al. | Aug 1998 | A |
5828987 | Tano et al. | Oct 1998 | A |
5890092 | Kato et al. | Mar 1999 | A |
6351706 | Morimoto et al. | Feb 2002 | B1 |
6446000 | Shimabara | Sep 2002 | B2 |
6681180 | Bevly et al. | Jan 2004 | B2 |
7113866 | Taliwal | Sep 2006 | B2 |
7230567 | Arakane et al. | Jun 2007 | B2 |
7400969 | Watanabe et al. | Jul 2008 | B2 |
7414575 | Watanabe et al. | Aug 2008 | B2 |
7477973 | Brewer et al. | Jan 2009 | B2 |
7561961 | Wakamatsu et al. | Jul 2009 | B2 |
7606661 | Kwak | Oct 2009 | B2 |
7626533 | Cong et al. | Dec 2009 | B2 |
7742872 | Kimura et al. | Jun 2010 | B2 |
7774103 | Deng et al. | Aug 2010 | B2 |
8041472 | Kobori et al. | Oct 2011 | B2 |
8111147 | Litkouhi | Feb 2012 | B2 |
8160816 | Kanai et al. | Apr 2012 | B2 |
8195357 | Basnayake | Jun 2012 | B2 |
20030023369 | Takashima | Jan 2003 | A1 |
20030173127 | Noecker | Sep 2003 | A1 |
20050004753 | Weiland et al. | Jan 2005 | A1 |
20050283312 | Taliwal | Dec 2005 | A1 |
20070055431 | Deng et al. | Mar 2007 | A1 |
20070078594 | Mori | Apr 2007 | A1 |
20090099730 | McClure et al. | Apr 2009 | A1 |
20090099772 | Chiu et al. | Apr 2009 | A1 |
20090138193 | Katou | May 2009 | A1 |
20100017128 | Zeng | Jan 2010 | A1 |
20100019963 | Gao et al. | Jan 2010 | A1 |
20100042282 | Taguchi et al. | Feb 2010 | A1 |
20100082250 | Kondoh | Apr 2010 | A1 |
20100114431 | Switkes et al. | May 2010 | A1 |
20100121518 | Tiernan et al. | May 2010 | A1 |
20100125414 | Okuyama et al. | May 2010 | A1 |
20100241355 | Park | Sep 2010 | A1 |
20100286872 | Endo et al. | Nov 2010 | A1 |
20100292886 | Szczerba et al. | Nov 2010 | A1 |
20100299063 | Nakamura et al. | Nov 2010 | A1 |
20100312527 | Weiland et al. | Dec 2010 | A1 |
20100332127 | Imai et al. | Dec 2010 | A1 |
20110109475 | Basnayake et al. | May 2011 | A1 |
20120029799 | Miller | Feb 2012 | A1 |
20120053755 | Takagi | Mar 2012 | A1 |
Number | Date | Country |
---|---|---|
19970071406 | Jul 1997 | KR |
1020050012997 | Feb 2005 | KR |
1020060132302 | Dec 2006 | KR |
101010678 | Jan 2011 | KR |
Number | Date | Country | |
---|---|---|---|
20120283941 A1 | Nov 2012 | US |