The present application claims the benefit under 35 U.S.C. §119 of German Patent Application No. DE 102016203723.4 filed on Mar. 8, 2016, which is expressly incorporated herein by reference in its entirety.
The present invention relates to a method for ascertaining the pose of a vehicle, in which the vehicle senses static objects and in addition also dynamic objects in its environment and uses them for determining its position and its spatial orientation.
Moreover, the present invention relates to a system for carrying out the method.
Current driver-assistance systems (ADAS—Advanced Driver Assistance Systems) as well as highly automated vehicle systems for autonomous driving in city traffic (UAD=Urban Automated Driving) increasingly presuppose detailed knowledge of the environment of the vehicle as well as situational awareness. One important precondition for this is a need-based self-localization of the vehicle system. Only if this condition is met will it be possible, for example, to plan future driving applications with sufficient precision. A map-related localization, in which environment sensors installed in the vehicle monitor the vehicle environment and certain environmental information is extracted, is normally utilized for this purpose. The extracted environmental information is stored in a local environment model and then matched against a digital map with the aid of a suitable method. Depending on the extractable quantity and quality of environmental information, a specific localization accuracy is obtained in combination with odometer data. For this reason the localization accuracy of this method may vary considerably as a function of the situation.
It is an object of the present invention to improve the localization accuracy in the self-localization of a vehicle.
Advantageous specific embodiments of the present invention are described herein.
In accordance with the present invention, a method for ascertaining the pose of a vehicle is provided, in which the vehicle ascertains its own position and/or spatial orientation with the aid of information from its environment. In the process, the vehicle ascertains certain supplementary information about dynamic objects in its environment and uses the ascertained supplementary information for determining its own position and/or spatial orientation. The detection of dynamic objects increases the quantity of the environmental information available for ascertaining the pose of the vehicle and thereby allows for a considerable improvement in the localization result. As an alternative, the demands placed on the employed environmental sensor system are able to be reduced, which goes hand in hand with lower production costs. The robustness of the vehicle localization is enhanced at the same time because information from different sources is used.
In one specific embodiment, it is provided that the vehicle ascertains the relative position, the relative spatial orientation and/or the trajectory of dynamic objects in its environment as supplementary information and uses it for ascertaining its own position and/or spatial orientation. On the basis of this information it is possible to infer the location and course of the road and other routes, which can subsequently be compared with the corresponding roads and routes on the digital map. The position of a dynamic object is preferably acquired with the aid of the already installed environment sensors, which means that the quantity of the extractable environmental information may be increased without additional expense and the localization accuracy is improved as a result.
In one further specific embodiment, the vehicle carries out a self-localization by ascertaining certain environmental information pertaining to static objects in its environment with the aid of the environment sensors, by generating a local environment model with the aid of the ascertained environmental information, and by subsequently comparing the local environment model with a digital map in order to determine its own position and/or orientation on the digital map. The use of environmental information both of static and dynamic objects allows for a vehicle localization that is based solely on observation and which furthermore has better robustness because information from various sources is utilized.
In one further specific embodiment, the vehicle uses the supplementary information to generate additional data points in the local environment model, which are then compared with corresponding points on the digital map. This method constitutes a method that is particularly suitable for calculating the vehicle pose.
In one further specific embodiment, it is provided that the vehicle uses the ascertained supplementary information for ascertaining its orientation in its own traffic lane. This measure makes it particularly easy to improve the knowledge of the vehicle orientation with reference to the road on which the driving takes place, and therefore is also able to improve the localization based on the odometer data.
In one further specific embodiment, it is provided that the vehicle detects the orientation of an oncoming other vehicle traveling in an opposite lane in relation to itself as an item of supplementary information, and uses the detected orientation of the other vehicle for estimating its orientation in its own traffic lane. Since oncoming traffic passes in relatively close proximity to the vehicle, other vehicles in the opposing traffic lane are particularly suitable for ascertaining the ego vehicle's own orientation.
In one further specific embodiment, it is provided that the vehicle ascertains the relative position, the relative spatial orientation and/or the trajectory of other vehicles in its own traffic lane, in an adjacent traffic lane or on an adjacent road as supplementary information and uses the ascertained supplementary information for ascertaining its own position and/or spatial orientation. In principle, it is possible to increase the accuracy and robustness of the localization by using all vehicles that are detectable with the aid of available environment sensors.
In one further specific embodiment, it is provided that the vehicle ascertains not only the position and/or the trajectory of a dynamic object as supplementary information but also the type of object of the dynamic object. In the process, the vehicle compares the ascertained position and/or trajectory of the dynamic object with a possible current location and/or route assigned to this type of object on the digital map. Ascertaining the object type makes it possible to draw conclusions about the location of the respective object or of the route driven or traversed on foot by the respective object. This allows for less complicated matching between the local environment model and the digital map, because the number of potential locations on the digital map is able to be reduced considerably when the object type is taken into account.
In one further specific embodiment, it is provided that the vehicle ascertains the relative position, the relative spatial orientation and/or the trajectory of a pedestrian as supplementary information and compares the acquired supplementary information with a sidewalk or pedestrian crossing shown on the digital map. The use of pedestrians as dynamic objects makes it possible to increase the amount of extractable environmental information and thus to enhance the localization accuracy.
Below, the present invention is explained in greater detail with the aid of the figures.
For example, this is the relative position of these objects, their spatial orientation or distance. In addition, the object type is able to be ascertained as well, or the static objects can be identified with the aid of certain features. The environmental information extracted in the process is stored in a local environment model, which is matched with a digital map in order to ascertain the global position and the orientation of the vehicle on the digital map. The localization accuracy of this method essentially depends on the quantity and quality of environmental information extracted on the basis of static objects 220 through 225. Depending on the respective situation and the employed measuring method, the quantity and quality of extractable environmental information may vary to a considerable extent. For example, adverse weather conditions as well as other road users may obscure the view of static objects that are usable as landmarks. For example, this is the case with static object 226 in
As shown in
Conclusions with regard to the course of the road or the traffic lane at the current location of the other vehicle can also be drawn on the basis of the measured orientation of the other vehicle. These conclusions may be used as additional data points 406, 407 for the matching between local environment model 400 and digital map 300. Since road users also exhibit unpredictable behavior in some instances, the information obtained from monitoring the position, orientation and trajectory of the dynamic objects may also include an error. Suitable measures may be implemented in the vehicle to prevent any negative effect of such erroneous information on the localization result. For example, a suitable plausibilization method is one of those measures. Here, the measured or ascertained information is checked for plausibility and only information having sufficient plausibility is used for the localization. It is also possible to allocate individual weighting factors to additional data points 406, 407 ascertained from measuring dynamic objects in local environment model 400, these weighting factors taking the respective probability into account that detected dynamic object is indeed present at a location it had been allocated. In this way only a low weighting factor may be assigned by the system to another vehicle that exhibits unusual behavior, for instance because it is driving beyond a paved road, the low weighting factor ensuring that data points ascertained by monitoring this vehicle will not or only negligibly be considered during the matching with digital map 300.
Apart from improving the self-localization by matching the local environment model with the digital map, the supplementary information such as position, orientation and trajectory ascertained through measurements of the dynamic objects may furthermore by used by the vehicle to improve the estimation of its own orientation within the traffic lane. Using exemplary traffic situations, the following text describes different options with regard to the manner in which the ego vehicle, by monitoring dynamic objects in its environment, is able to use supplementary information in order to improve the self-localization.
By way of example,
As can be gathered from
When selecting suitable dynamic objects, it is in principle also possible to take road users into account who are located on a road other than road 210 on which ego vehicle 100 is traveling.
Additional supplementary information is able to be extracted by ascertaining the object type of a detected dynamic object. For example, while monitoring an object of the pedestrian type and by detecting his or her trajectory, it is possible to determine with a high degree of certainty that the pedestrian is ambulating on a sidewalk or a pedestrian crossing. It can therefore be stated with a high degree of probability that a sidewalk or pedestrian crossing extends along the monitored trajectory. In this context,
Since in road traffic, road users of different object types usually stay in the areas or paths they are assigned, stationary dynamic objects may basically also be used for the self-localization. For example, ego vehicle 100, as shown in
The method of the present invention uses additional information in order to improve the localization result of current localization methods or to reduce the demands placed on the employed environment sensor system. The system according to the present invention utilizes poses and trajectories of other road users to improve the ego vehicle's own pose estimate. In so doing, for example, the orientation of oncoming vehicles in relation to the ego vehicle is measured and the estimate of the orientation in the ego vehicle's own lane is improved thereby. The matching of trajectories of other vehicles with the localization map may furthermore be used to advantageously influence also the global pose estimate. At the same time, the robustness of the localization system is improved inasmuch as information from different sources is used.
Although the present invention has been described predominantly on the basis of specific exemplary embodiments, it is by no means restricted to such. The expert will thus be able to suitably modify the described features and combine them with each other without departing from the core of the present invention. In particular, in addition to the road users already mentioned in the description, the position, orientation and trajectory of any suitable dynamic object in the environment of the ego vehicle may in principle be used to improve the self-localization. In addition, the method according to the present invention is not restricted to the self-localization of the ego vehicle with the aid of static objects. Any suitable method or any combination of methods is basically possible for the self-localization.
Number | Date | Country | Kind |
---|---|---|---|
102016203723.4 | Mar 2016 | DE | national |