This application is based on and claims the benefit of priority of Japanese Patent Application No. 2005-179727 filed on Jun. 20, 2005, and Japanese Patent Application No. 2006-102398 filed on Apr. 3, 2006, the disclosure of which are incorporated herein by reference.
The present invention generally relates to a vehicle controller for controlling a vehicle.
A map matching process in a navigation system basically estimates a position of a subject vehicle by, for example, acquiring a position data from a GPS satellite and combining the position data with additional data from a gyro and a speed sensor, and then determines the position of the subject vehicle by matching an estimated position to road data in a road map database. In this case, the matching process suffers from closely located roads in a small area or errors of sensing devices in terms of correctness and accuracy. That is, the current position of the vehicle may possibly be wrongly determined. In addition, the wrongly determined current position may affect a condition of vehicle control that uses current position data for suitably controlling the vehicle. The wrongly determined control condition may causes uncomfortableness, uncertainty or the like for a user of the vehicle.
A technique disclosed in Japanese Patent Document JP-A-2002-254980 uses map matching reliability index for evaluating accuracy of a vehicle position that is determined by using the map matching process, and controls a front light of the vehicle based on the evaluation of the positional accuracy. The reliability index has a predetermined set of ratings, for example, for determining reliability of map matching situations such as a turn case, a curve case, an off-the-route case or the like at an intersection, a branch, a corner or other points in a road. The reliability index has higher values in the situations where the current position of the vehicle is modified based on the estimated position of the vehicle. That is, the reliability index increases when the current position of the vehicle in the map is modified based on the estimation.
On the other hand, the road on the map data determined by using the map matching process has an increased possibility of errors when, for example, two roads starting from an intersection make a very small angle between them. That is, the vehicle position on the map just after passing the intersection may very well be wrong. Therefore, determining the reliability of the map matching process by utilizing the map data that specifies the two adjacent roads before passing the intersection is effective and useful for avoiding the erroneous control of the vehicle or the like.
However, the technique described above does not include consideration regarding a prior determination of erroneous map matching, that is, there is no consideration of a possibility of errors in the map matching.
In view of the above-described and other problems, the present disclosure provides a vehicle position detector and a vehicle controller that cooperatively control the vehicle based on a predicted level of certainty regarding a positional accuracy of the vehicle.
The vehicle position detector for use in a vehicle of the present disclosure includes a position detector, a map data storage, a map matching processor, a junction detector, a similarity calculator and an evaluation processor for the purpose of determining accuracy level evaluation of an adjustment of a current position of the vehicle. The vehicle position detector utilizes the above-described parts for detecting the current position of the vehicle, storing map data, and making adjustment on the detected current position in the map data. Then, the vehicle position detector determines whether a road to be traveled along by the vehicle has a junction, an intersection or the like, and calculates similarity index of each of the roads that starts at the junction portion of the road before the vehicle reaches the junction portion. Finally, the vehicle position detector predictably evaluates the position of the vehicle in each of the roads that extend from the junction portion. In this manner, the vehicle position detector predicts the possibility of erroneous determination of the current position of the vehicle in each of the roads before the vehicle actually travels along the roads.
In another aspect of the disclosure, the vehicle position detector utilizes a direction and/or an incline of the road stored in the map data for the calculation of the similarity index of the road. The similarity index is calculated as difference of the direction and/or the incline of each road.
In yet another aspect of the disclosure, the vehicle position detector includes a vector processor for converting the road into a series of vectors for further evaluation. That is, the similarity index is calculated based on each of the series of the vectors for more detailed evaluation.
In still yet another aspect of the disclosure, the vehicle position detector includes a threshold storage that stores a threshold of the similarity index and the accuracy level evaluation. In this manner, the evaluation processor determines the accuracy level evaluation based on the threshold of the similarity index.
In still yet another aspect of the disclosure, the vehicle controller having the above-described vehicle position detector includes a vehicle control units for controlling the vehicle based on the accuracy level evaluation. In this manner, the vehicle control unit suitably controls the vehicle based on the output of the accuracy level evaluation.
In still yet another aspect of the disclosure, the vehicle controller includes a plurality of the vehicle control units for controlling the vehicle. In each of the vehicle control units, a control level determination unit is implemented for determining the threshold of a control level regarding a predetermined type control of the vehicle. The vehicle control unit compares the control level and the accuracy level evaluation for suitably executing the predetermined type control. In this manner, the vehicle controller suitably controls each of the predetermined type controls controlled by the vehicle control unit.
In still yet another aspect of the disclosure, the vehicle controller acquires a certainty level evaluation of a road to be traveled along by the vehicle, and controls the vehicle based on the acquired evaluation by using the vehicle control unit. In this manner, the vehicle controller suitably predicts the evaluation, i.e., the degree of certainty of traveling on a certain road after passing a junction or the like, for appropriately control the vehicle. In addition, the vehicle controller may include a plurality of the vehicle control units for cooperative control of the vehicle based on the comparison between the control level threshold and the accuracy level evaluation or similar indices.
Other objects, features and advantages of the present invention will become more apparent from the following detailed description made with reference to the accompanying drawings, in which:
Embodiments of the present invention are described with reference to the drawings. Like parts have like numbers in each of the embodiments.
A vehicle position detector of the present disclosure is described as a function of a navigation system in a vehicle.
The control circuit 9 is a computer of well-known type, and includes a CPU, a ROM, a RAM, an I/O and a bus line for interconnection between these devices (not shown in the figure). The ROM stores a program for execution in the navigation system 100. The program in the ROM controls processes executed in the CPU or in other devices.
The position detector 1 includes a plurality of well-known type sensors such as a geomagnetism sensor 1a, a gyroscope 1b, a distance sensor 1c, and a Global Positioning System (GPS) receiver 1d. These sensors are complementarily used for interactive compensation of errors of respectively different natures. These sensors may selectively be used based on the accuracy of the output, and a steering rotation sensor, a speed sensor or the like (not shown in the figure) may additionally be utilized.
The map data input unit 2 is used to input map data such as road network data, index data, drawing data or the like into the navigation system 100 under instructions from the control circuit 9. These data are provided in various kinds of memory medium such as a CD-ROM, a DVD-ROM as well as a writable medium such as a memory card, a hard disk or the like.
Next, links and nodes in the road network data are described. Links and nodes are defined as a geometrical element with two points attached on both ends of the element, and the node corresponds to a crossing, a branch point or the like of a road. Roads in a real world are geometrically represented as a combination of the links and nodes. Link data of each road includes a link ID, a link length, coordinates (e.g., latitude and longitude) of nodes on both ends, i.e., a start point and an end point, road type (interstate, state road, local road, or the like), road width, the number of lanes and the like.
Node data of each node includes a node ID, node coordinates (e.g., latitude and longitude), a node incline, connecting link IDs for designating all of the links that share the node as an end point, a link type of the connecting link that specifies the link as an inbound or an outbound relative to the node, and a node attribute that designates a node type such as an intersection, a branch point or the like.
The operation switches 3 are, for example, disposed as touch switches or mechanical switches on the display 7, and are used for inputting various kinds of instructions. The instruction may include a map image scroll instruction, a text input instruction or the like.
The external memory 6 is a memory medium of read/write capability for storing/retrieving information. The memory 6 stores map data or the like that is used for process in the navigation system 100.
The display 7 is, for example, a liquid crystal display or the like, and displays a position mark at a current position of the vehicle derived from the position detector 1 on a map that is generated by using the map data inputted from the map data input unit 2.
The speaker 8 outputs guidance voice for navigating a user or a driver of the vehicle, warning sound for calling attention of the driver or the like.
The current position of the vehicle on the map is determined in the following manner. That is, the current position is temporarily calculated based on information from the geomagnetism sensor 1a, the gyroscope 1b, the distance sensor 1c, and the Global Positioning System (GPS) receiver 1d. Then, the temporary calculation of the current position is matched with the map data retrieved by the map data input unit 2 for determining the current position of the vehicle on the map. The process for determining the position of the vehicle on the map is called “map matching” process. The position of the vehicle is suitably adjusted to the road on the map by the map matching process. The map matching process in executed in the control circuit 9.
The navigation system 100 has a capability of a route navigation function that automatically calculates optimum routes from a start point or the current position to a destination for displaying a guidance on the display 7 when the start point and the destination are specified by the user. The start point and the destination are specified by using the operation switches 3 and the remote controller 5 in connection with the remote controller sensor 4.
The ECUs 10 include, for example, an air-conditioner ECU for controlling an air conditioner, an engine ECU for controlling an engine, and a body ECU for controlling a front lighting and/or suspensions. Each of the ECUs 10 receives certainty level information from the navigation system 100 for determining positional accuracy of the current position of the vehicle or currently traveling road where the current position of the vehicle is located. Each of the ECUs 10 utilizes the certainty level information for providing controls. In this manner, based on the certainty level information, each of the ECUs 10 determines whether the controls from each of the ECU should be provided.
More practically, each of the ECUs 10 provides the controls in the following manner. That is, the ECUs 10a to 10n respectively store a specific threshold for control provision from each of the ECUs 10. The threshold stored in each of the ECUs 10 is compared with the certainty level information from the navigation system 100. Comparison result is reflected on the control provided by each of the ECUs 10. That is, whether the control should be provided or level of the control is determined based on the comparison result.
Values of the threshold may be determined in the following manner. That is, the threshold values for various situations may vary from low to high in terms of suitable control of the situation. In the present embodiment, the threshold values of high, middle, and low level are described as examples of illustration purpose.
A high threshold value may be applied to situations that demand increased reliability for the provision of the control such as adaptive front lighting for adaptively controlling direction of head lights according to road shape, curve speed limiting for suppressing vehicle speed in a curved road, and cooperative gear shifting for predictably controlling automatic transmission in accordance with the road shape and/or the incline. Provision of the control in those situation based on an inaccurate position of the vehicle may lead to disagreement of vehicle behavior to the situation involved. In other words, safety related matter in vehicle control requires higher reliability, thereby having to be based on accurate information in terms of suitability of the vehicle control to the specific situation. Therefore, the ECUs 10 for the safety related control have to use high threshold values for control provision.
Threshold values of middle range may be applied to situations that require control of stability of traveling or similar attributes. That is, variable suspension control or variable dumper control may be provided based on the middle level threshold, because the ECUs 10 having the middle level threshold are not directly involved in safety related matter of the vehicle. Therefore, the ECUs 10 for controlling the traveling stability may use the middle level threshold value.
Threshold values of lower range may be applied to situations such as opening of side windows in the proximity of a railroad crossing, automatic ventilation switching between inner circulation mode and outer air introduction mode before and after entering a tunnel, automatic TV/radio channel selection according to administrative areas, and automatic CD/DVD entertainment provision from audio/navigation system based on an architectural environment of the vehicle. In those situations, the ECUs 10 are not involved in safety related matter of the vehicle. In other words, comfort of occupants in the vehicle does not relates to the accuracy level of the current position of the vehicle. Therefore, the ECUs 10 in charge of the control of those functions may have the lower threshold values for providing the control.
The certainty level determination process is described with reference to a flowchart.
In step S10, the process detects a current position of the vehicle in sensor information from the position detector 1.
In step S20, the process acquires road data of a front portion of the traveling road, i.e., a portion of a road ahead of the vehicle, by map matching. The map matching is based on the current position of the vehicle detected in step S10. The road data may cover a portion of the road in a predetermined distance (Lfr) from the vehicle. The distance Lfr is called as “along-the-road distance” and is shown in
In step S30, the process determines whether a junction exists ahead of the vehicle. That is, the process determines whether the currently traveling road forks in two or more directions. The process proceeds to step S40 when the road forks (step S30:YES), and the process proceeds to step S60 when the road does not fork (step S30:NO).
In steps S40 and S50, the process calculates similarity index of plural roads that fork and extend from the junction. In these steps, the plural roads ahead of the junction are examined in terms of similarity of shapes and/or inclines. That is, in step S40, coordinates of the start node and end node of the link in the road data are used to calculate horizontal correlation values based on the difference of direction of each road ahead of the junction. In step S50, the difference of incline of each road ahead of the junction are calculated as vertical correlation values in the same manner. The calculation of the horizontal/vertical correlation is described more in detail with reference to
In
The difference of each of the vectors is added and averaged in step S40 after the roads A and B are divided into the series of vectors. That is, the difference of each of the vectors VAn and VBn is calculated as a horizontal correlation value Vhθn, and average of the Vhθn is represented by an equation 1 in the following.
Further, in step S50, the difference of each of the vectors VAn and VBn is calculated as a vertical correlation value Vvθn, and average of the Vvθn is represented by an equation 2 in the following.
In this manner, the similarity of the roads A and the road B can be evaluated as correlation values based on the difference of directions and inclines as horizontal/vertical factors of the vector representation.
In step S60, the process determines certainty level in the map matching regarding the position of the vehicle and/or the road ahead of the junction based on the correlation values derived from those equations. The certainty level is determined by, for example, referring to a relationship table that defines relationship between the certainty levels and the horizontal/vertical correlation values in the external memory 6 or the like. In this manner, the road and the vehicle position ahead of the junction matched by the map matching are predictably evaluated for suitably providing the required control by employing the ECUs 10. In addition, certainty level in the map matching after the negative branch in step S30 may be determined to be in high level, because difference of vectors is minimum when there is no junction in the road ahead.
In step S70, the process outputs the certainty level to the ECUs 10. The process returns to step S10 after outputting the certainty level for iterative execution of the process.
The navigation system 100 in the present disclosure determines certainty level of the position of the vehicle and/or the road in the map matching for a portion of the road ahead of the junction based on the correlation value calculated for each the roads by analyzing the directions and/or inclines of the roads before the vehicle actually reaches the junction. Therefore, the navigation system 100 can evaluate or determine the possibility of errors in the map matching for the portion of the road ahead of the junction beforehand. That is, the possibility of the erroneous determination that the vehicle is traveling on the road A when the vehicle actually travels on the road B is predicted beforehand by the navigation system 100. In this manner, the ECUs 10 on the vehicle provide controls for suitably controlling the vehicle based on the comparison between the certainty level of the map matching and the threshold for control provision in each of the ECUs 10.
Although the present invention has been fully described in connection with the preferred embodiment thereof with reference to the accompanying drawings, it is to be noted that various changes and modifications will become apparent to those skilled in the art.
For example, correlation value of the horizontal and vertical direction may be variably changed based on the predicted error range in the map matching and/or accumulated sample data in the sensors of the position detector 1.
Further, in step S30 in the present embodiment, the junction may be replaced with an intersection or the like, because the intersection and the junction may present a similar situation when the angle between two outbound roads from the intersection is very small.
Furthermore, the difference of the direction and/or the incline of each vector used in steps S40 and S50 may directly be evaluated instead of evaluating the average of the differences.
Such changes and modifications are to be understood as being within the scope of the present invention as defined by the appended claims.
Number | Date | Country | Kind |
---|---|---|---|
JP2005-179727 | Jun 2005 | JP | national |
JP2006-102398 | Apr 2006 | JP | national |