Identifying the Contour of a Vehicle on the Basis of Measurement Data from an Environment Sensor System
20210046940 ยท 2021-02-18
Assignee
Inventors
- Michael Feser (Barbing, DE)
- Kilian Schneider (Augsburg, DE)
- Thomas Brandmeier (Wenzenbach Irlbach, DE)
- Alexander Kamann (Regensburg, DE)
- Robert Lugner (Ingolstadt, DE)
- Daniel Weichselberger (Denkendorf, DE)
- Robert Naumann (Bad Griesbach i. Rottal, DE)
Cpc classification
B60W30/0956
PERFORMING OPERATIONS; TRANSPORTING
B60W10/30
PERFORMING OPERATIONS; TRANSPORTING
B60W2555/00
PERFORMING OPERATIONS; TRANSPORTING
B60W10/18
PERFORMING OPERATIONS; TRANSPORTING
B60W30/09
PERFORMING OPERATIONS; TRANSPORTING
B60W2520/00
PERFORMING OPERATIONS; TRANSPORTING
B60W60/0015
PERFORMING OPERATIONS; TRANSPORTING
B60W10/20
PERFORMING OPERATIONS; TRANSPORTING
B60W40/12
PERFORMING OPERATIONS; TRANSPORTING
International classification
B60W40/12
PERFORMING OPERATIONS; TRANSPORTING
B60W10/18
PERFORMING OPERATIONS; TRANSPORTING
B60W10/20
PERFORMING OPERATIONS; TRANSPORTING
B60W10/30
PERFORMING OPERATIONS; TRANSPORTING
B60W30/02
PERFORMING OPERATIONS; TRANSPORTING
B60W30/09
PERFORMING OPERATIONS; TRANSPORTING
B60W30/095
PERFORMING OPERATIONS; TRANSPORTING
B60W60/00
PERFORMING OPERATIONS; TRANSPORTING
Abstract
A method for identifying the contour of a vehicle based on measurement data from an environment sensor system is disclosed. The measurement data includes a set of spatial points of an object detected by the environment sensor system. The method includes: producing an envelope in the form of a polygonal chain around the object based on the set of spatial points; reducing the set of spatial points; removing spatial points from the polygonal chain that are irrelevant to identifying the contour of the vehicle and determining spatial points of the polygonal chain that are relevant to identifying the contour of the vehicle; classifying one or more edges as belonging to a front and a side of the vehicle on the basis of the reduced set of spatial points.
Claims
1. A method for identifying a contour of a vehicle based on measurement data from an environment sensor system, the measurement data comprise a set of spatial points of an object detected by the environment sensor system, the method includes: producing an envelope in the form of a polygonal chain around the object based on the set of spatial points; reducing the set of spatial points by deleting all spatial points situated within the envelope; removing spatial points from the polygonal chain that are irrelevant to identifying the contour of the vehicle; determining spatial points of the polygonal chain that are relevant to identifying the contour of the vehicle; classifying one or more edges as belonging to a front and a side of the vehicle based on the reduced set of spatial points; wherein removing spatial points from the polygonal chain that are irrelevant to identifying the contour of the vehicle includes the following: deleting spatial points on the envelope, straight connecting lines of which to adjacent spatial points of the polygonal chain are at an angle with respect to one another that is less than or equal to a first predetermined angle, and connecting the spatial points connected to the deleted spatial point in the polygonal chain.
2. The method according to claim 1, wherein the first predetermined angle is 2.
3. The method according to claim 1, further comprising: complementing a complete form of the vehicle by way of an estimation of a central axis of the vehicle on the basis of the classified edges.
4. The method according to claim 1, wherein producing an envelope in the form of a polygonal chain around the object on the basis of the set of spatial points includes performing a Graham's scan algorithm on the set of spatial points.
5. The method according to claim 1, wherein determining spatial points of the polygonal chain that are relevant to identifying the contour of the vehicle includes at least one of: determining a spatial point as relevant if straight connecting lines to adjacent spatial points of the polygonal chain are at an angle with respect to one another that is greater than a second predetermined angle; determining a spatial point as relevant if, for the spatial point and multiple spatial points adjacent to it in the polygonal chain, a sum of the angles at which straight connecting lines to adjacent spatial points of the polygonal chain are with respect to one another is greater than a third predetermined angle; determining a spatial point as relevant if the angle at which straight connecting lines to adjacent spatial points of the polygonal chain are with respect to one another, multiplied by a length of at least one of the straight connecting lines, exceeds a predetermined value of 8 m.
6. The method according to claim 5, wherein the second predetermined angle is 20 and the third predetermined angle is 17.5.
7. The method according to claim 1, wherein classifying one or more edges as belonging to a front and a side of the vehicle on the basis of the reduced set of spatial points includes: sorting the straight connecting lines of the reduced set of spatial points of the polygonal chain according to their length; comparing the two longest straight connecting lines with a front parameter and a side parameter; and determining whether the front and/or side of the vehicle is or respectively are visible.
8. The method according to claim 7, wherein determining whether the front and/or side of the vehicle is or respectively are visible includes at least one of the following: determining that the front and side are visible if the longest connecting line is longer than the front parameter and a second longest connecting line lies between the front parameter and the side parameter; determining that only the front is visible if the longest connecting line is shorter than the side parameter, but is longer than the front parameter; determining that only the side is visible if the longest connecting line is longer than the front parameter and the second longest connecting line is shorter than the side parameter ls.
9. The method according to claim 7, wherein complementing a complete form of the vehicle by way of an estimation of a central axis of the vehicle based on the classified edges includes: producing a central axis by placing a straight line through a midpoint of a classified front of the vehicle in such a manner that the straight line lies approximately parallel to a classified side of the vehicle; reflecting the classified front and side of the vehicle off the central axis; and overwriting spatial points on the side of the central axis, off which reflection occurred, by the reflected spatial points.
10. The method according to claim 1, wherein the method is executed cyclically and a trajectory of the vehicle is established by evaluating the complemented complete forms of the vehicle.
11. A safety system for a vehicle, the safety system is configured to: execute a method for identifying a contour of the vehicle based on measurement data from an environment sensor system, the measurement data comprise a set of spatial points of an object detected by the environment sensor system, the method includes: producing an envelope in the form of a polygonal chain around the object based on the set of spatial points; reducing the set of spatial points by deleting all spatial points situated within the envelope; removing spatial points from the polygonal chain that are irrelevant to identifying the contour of the vehicle; determining spatial points of the polygonal chain that are relevant to identifying the contour of the vehicle; classifying one or more edges as belonging to a front and a side of the vehicle based on the reduced set of spatial points; wherein removing spatial points from the polygonal chain that are irrelevant to identifying the contour of the vehicle includes the following: deleting spatial points on the envelope, the straight connecting lines of which to adjacent spatial points of the polygonal chain are at an angle with respect to one another that is less than or equal to a first predetermined angle, and connecting the spatial points connected to the deleted spatial point in the polygonal chain; actuate at least one of the following elements as a function of the identified contour of the vehicle: at least one passive safety element, including an airbag, a belt tensioner; at least one active safety element, including a brake assist system, an active steering device, an antilock braking system, a vehicle dynamics control system.
12. The safety system according to claim 11, wherein the safety system is configured, as a function of the identified contour of the vehicle, to assess a probability of an accident with the vehicle and, as a function of the assessment, to control the triggering of the at least one element.
13. The safety system according to claim 11, wherein the method further comprises: complementing a complete form of the vehicle by way of an estimation of a central axis of the vehicle on the basis of the classified edges.
14. The safety system according to claim 11, wherein producing an envelope in the form of a polygonal chain around the object on the basis of the set of spatial points includes performing a Graham's scan algorithm on the set of spatial points.
15. The safety system according to claim 11, wherein determining spatial points of the polygonal chain that are relevant to identifying the contour of the vehicle includes at least one of: determining a spatial point as relevant if straight connecting lines to adjacent spatial points of the polygonal chain are at an angle with respect to one another that is greater than a second predetermined angle; determining a spatial point as relevant if, for the spatial point and multiple spatial points adjacent to it in the polygonal chain, a sum of the angles at which straight connecting lines to adjacent spatial points of the polygonal chain are with respect to one another is greater than a third predetermined angle; determining a spatial point as relevant if the angle at which straight connecting lines to adjacent spatial points of the polygonal chain are with respect to one another, multiplied by a length of at least one of the straight connecting lines, exceeds a predetermined value of 8 m.
16. The safety system according to claim 15, wherein the second predetermined angle is 20 and the third predetermined angle is 17.5.
17. The safety system according to claim 11, wherein classifying one or more edges as belonging to a front and a side of the vehicle on the basis of the reduced set of spatial points includes: sorting the straight connecting lines of the reduced set of spatial points of the polygonal chain according to their length; comparing the two longest straight connecting lines with a front parameter and a side parameter; and determining whether the front and/or side of the vehicle is or respectively are visible.
18. The safety system according to claim 17, wherein determining whether the front and/or side of the vehicle is or respectively are visible includes at least one of the following: determining that the front and side are visible if the longest connecting line is longer than the front parameter and a second longest connecting line lies between the front parameter and the side parameter; determining that only the front is visible if the longest connecting line is shorter than the side parameter, but is longer than the front parameter; determining that only the side is visible if the longest connecting line is longer than the front parameter and the second longest connecting line is shorter than the side parameter ls.
19. The safety system according to claim 17, wherein complementing a complete form of the vehicle by way of an estimation of a central axis of the vehicle based on the classified edges includes: producing a central axis by placing a straight line through a midpoint of a classified front of the vehicle in such a manner that the straight line lies approximately parallel to a classified side of the vehicle; reflecting the classified front and side of the vehicle off the central axis; and overwriting spatial points on the side of the central axis, off which reflection occurred, by the reflected spatial points.
20. The safety system according to claim 11, wherein the method is executed cyclically and a trajectory of the vehicle is established by evaluating the complemented complete forms of the vehicle.
Description
DESCRIPTION OF DRAWINGS
[0018]
[0019]
[0020]
[0021]
DETAILED DESCRIPTION
[0022] In the following description, similar, functionally similar and functionally related elements are provided with the same reference numerals. Absolute values are only indicated by way of example below and are not to be understood to be restrictive.
[0023] The embodiment examples explained below are to be fundamentally classed in the field of vehicle safety for all steps of automated up to fully autonomous driving, wherein, within these fields, the focus is on the early triggering of passive safety elements such as airbags and belt tensioners with the aid of sensors for detecting the environment and collision partners. In general, the methods and systems described herein are, however, suitable for all types of driver assistance systems, in which object identification is deployed for vehicle safety, that is to say by way of example also active safety systems which can influence the control of the vehicle in order to avoid accidents such as, for example, automatic steering, braking and driving dynamics control interventions.
[0024] In the case of driver assistance systems currently deployed in vehicles, the environment is predominantly detected with radar and camera sensors, the information of which can already be used, for example, to lower ignition thresholds of actuators of passive safety elements. However, to date, the actuators are still activated after the time t0 of the first contact of two parties involved in an accident.
[0025] A further minimization of the severity of the accident for the occupants may be achieved by triggering protective and restraining means, for example belt tensioners or airbags, before t0. However, as much information as possible regarding the collision partners must be available for this. This includes, inter alia, the speed and the position which can be determined with the indicated sensor system. Further relevant parameters can, however, only be determined in a very limited manner or not at all, which is why a lidar sensor (or laser scanner) may be used in vehicles as a third environment detecting sensor. By virtue of the high number of measurement points in the space or respectively 3D measurement points, which may be supplied by the sensor data of a lidar sensor, using a lidar sensor makes it possible to calculate a vehicle contour of the other vehicle involved in the accident. Thus, the point of impact of the other vehicle involved in the accident with the ego-vehicle as well as the overlap of the other party involved in the accident may be assessed with greater precision. A method is described below, with which the estimation of a simple bounding box (enveloping body in the form of a cuboid in the space or respectively of a rectangle in the plane) may be increased to a detailed application for identifying the contour of approaching vehicles in pre-crash situations.
[0026] Nowadays, when objects surrounding the ego-vehicle are detected by environment sensors of a vehicle, the silhouette as well as the precise dimensions of these objects are not determined. Bounding boxes (smallest possible, axially parallel rectangle which encloses a predetermined set of objects or measurement points in the plane) are merely placed around the individual objects, without taking account of the exact object form. In this way, valuable information regarding the object or respectively an identified vehicle that can be relevant to a triggering of passive safety elements such as the ignition of restraining means is lost.
[0027]
[0028] If a passive safety element is now to be triggered, this can result in erroneous triggerings as a consequence of the oversized hypothesis of the target vehicle 12. An imminent collision including a crash constellation and severity is predicted by virtue of the intersection of the contours between the bounding box 16 and the ego-vehicle 10, which is why the passive safety elements, such as the restraining means, are activated. In reality, however, a completely different crash constellation and, thus, crash severity can occur, right up to the complete avoidance of the accident as a result of the vehicles simply passing one another. That is to say the collision may possibly not take place, although both vehicle objects 10 and 12 do meet in the prediction (intersection of the bounding box 18 of the target vehicle 12 with the ego-vehicle 10, but no intersection of the real vehicle contours of the vehicles 10 and 12). This is illustrated by way of example in
[0029] Erroneous triggerings, caused by the application of this simplified Bounding Box method without exact contour determination, cannot be tolerated for a secure pre-crash triggering of actuators of passive safety elements. Hence, knowledge of the exact contour of the target vehicle 12 is to be guaranteed. An explanation is provided below of how this technical problem can be solved by the method presented herein for identifying the contour of approaching vehicles in pre-crash situations.
[0030] As already explained, the objective is to estimate the contour of an approaching vehicle as precisely as possible in the pre-crash phase. This precise calculation fulfils the algorithm described below, for example, in four successive steps producing a convex envelope around the object, determining the decisive corner points, classifying the vehicle front and side as well as a final complementing the complete vehicle form by way of the estimation of a central axis. The latter step of complementing is optional and serves, above all, to increase the exactness of the contour identification.
[0031] Producing a Convex Envelope around the Object
[0032] Recourse is had to the known Graham's scan algorithm, which is distinguished by its short running time and high efficiency, as the basis of the convex envelope. This algorithm was presented in 1972 by the mathematician Ronald Lewis Graham. Here, a starting point P0 must first be defined, where the point having the smallest y-coordinate and x-coordinate is always used, since this must inevitably include a corner point in this method. All of the other points are then arranged in ascending order according to the angle between P0 and the x-axis in an anticlockwise manner. It is then tested whether three points form a positively oriented triangle, which is checked by way of a determinant. If this is the case, the outer lines of the triangle are specified as the outer envelope. If a triangle is negatively oriented, the calculation is restarted, where the middle point is skipped. This procedure is repeated until such time as the starting point is reached again and, as a consequence, the convex envelope has been completed. Finally, the connection between the points having the lowest and highest x-coordinate is deleted in order to only obtain the form which can also be seen by the lidar. The convex envelope thus obtained now corresponds to a polygonal chain, in which pairs of spatial points which define the envelope are connected to one another by connecting sections or respectively straight connecting lines.
[0033] Determining the Relevant or Respectively Decisive Corner Points
[0034] In the next step, corner points are crystallized out of the polygonal chain, from which the estimation of the exact vehicle contour is constructed and the vehicle longitudinal axis is deduced (relevant or respectively decisive corner points or respectively spatial points). Since the lidar point cloud represents an immense quantity of data, the majority of which is admittedly not used, the measurement data are reduced at this point. On the one hand, all of the points within the convex envelope are deleted, on the other are all of the points in which the connecting sections or respectively straight connecting lines of a spatial point of the polygonal chain include a negligibly small angle, i.e. are at anegligibly small angle with respect to one another.
[0035] This is illustrated by an example depicted in
[0036] The relevant corner points are subsequently defined from the remaining measurement points. For this purpose, it is checked whether they satisfy one of the following conditions, in particular arranged in descending order from a) to c). If a point has already been defined as a corner point, it may be provided that the further conditions no longer have to be met. It should be further noted that the two points having the lowest and highest x-coordinate automatically represent corner points.
[0037] a) Change by Way of Large Angle
[0038] A large change in angle on the structure of vehicles goes hand in hand with pronounced radius changes such as, for example, the transition from the lights to the fenders. Therefore, a corner point is produced at locations which have an angle transition of greater than 20, for example.
[0039] b) Totalized Small Angles
[0040] This observation is mainly directed at the transitions between the radiator grill of the vehicle and the lights. To this end, all of the points which lie within a specified length (for example 20 cm) are examined for their change in angle and the individual values are added up. If this total is, for example, above a limit of 17.5, a corner point is defined on this segment. The coordinates of this point are calculated from the arithmetical averages of all of the points involved. One example is shown in
[0041] c) Weighting by Way of Line Length
[0042] A definition of corner points solely by way of the angle between the straight lines based on the previous filtering is frequently not sufficient for the side structures of a vehicle. It can therefore be necessary to also include the length of the adjoining straight lines in the establishment thereof. To this end, the angle is multiplied by the straight lines and, as a consequence, is weighted. If a limiting value (for example 8 m) is exceeded during this, the point is determined as a corner point.
[0043] In the event that the target vehicle is approaching the ego-vehicle absolutely head-on, it is already possible to classify the vehicle front structure. If the target vehicle is driving towards the ego-vehicle at an angle, a vehicle side can additionally be classified. This takes place by taking account of the movement history of the tracked vehicle.
[0044] Classification of the Vehicle Front and Side
[0045] Following the determination of the corner points, the contour now exists in a simplified manner on a basis of, for example, six to eight points. The vehicle front, side as well as the headlights can be deduced from this. The backdrop to this is the desired determination at which angle the target vehicle is oriented with respect to the ego-vehicle.
[0046] For that reason, all of the lines are first sorted in ascending order according to their length. The two longest lines are subsequently compared with two parameters if (for example=1.60 m) for the front and is (for example=0.55 m) for the side. Here, four cases may be distinguished, which make it possible to make a clear decision regarding the visible vehicle parts. These are depicted in the following table (Table 1):
TABLE-US-00001 TABLE 1 Case Meaning Description 1 Front and side are The longest line is longer than l.sub.f and the visible second longest line lies between l.sub.f and l.sub.s. 2 Only front visible The longest line is shorter than l.sub.s, but longer than l.sub.f. If the two longest lines meet this, the line having the larger angle to the ego-vehicle is selected. 3 Only side visible The longest line is longer than l.sub.f and the second longest is shorter than l.sub.s. 4 No side identifiable/ None of cases 1, 2 or 3 are fulfilled. lidar impaired
[0047] A vehicle contour may already be identified with a relatively high exactness with the above steps, such as a vehicle front and, if applicable, a vehicle side, which constitutes an improvement compared with a simple bounding box or respectively a cuboid as a digital representation of a vehicle, since the vehicle contour identified with this method corresponds more exactly to the real vehicle contour.
[0048] Complementing the Complete Vehicle Form by way of the Estimation of a Central Axis
[0049] With this last step, the identification of the contour may be further improved in that a virtually complete vehicle form or respectively vehicle silhouette may be established, even if parts of the vehicle are concealed or respectively cannot be identified by a lidar sensor. To this end, the vehicle longitudinal axis is first determined. It is necessary to determine the vehicle longitudinal axis in order to obtain the entire vehicle silhouette if a part of the target vehicle is concealed or parts of the vehicle are not visible to the environment sensor system. For this purpose, a straight line is placed through the midpoint of the identified front structure, which lies parallel to the visible vehicle side. Finally, the vehicle contour facing the ego-vehicle is reflected off the central axis. The points on the other side of the central axis are overwritten with the new, reflected corner points.
[0050] In the case of a target vehicle which is moving head-on towards the ego-vehicle, the vehicle longitudinal axis can likewise be determined, with the aim of increasing the exactness of the overlap estimation. An orthogonal through the midpoint of the identified vehicle front defines, in this case, the longitudinal axis. By way of a time-dependent, consecutive observation of the target or respectively a determination of the target parameters of width and yaw angle, the exactness of the location of the central axis may, in addition, continually increase gradually.
[0051] The back of the target vehicle cannot be determined in such a detailed way, but can be simply fleshed out by way of a connection of the rear corner points. The reason for this is that it is not visible to the lidar. However, this is not to be deemed to be a problem, since the exact form of the vehicle back is not important if an accident occurs.
[0052] The end result is, consequently, a complete contour estimation of the target vehicle, as illustrated in
[0053] At the same time,
[0054] A number of implementations have been described. Nevertheless, it will be understood that various modifications may be made without departing from the spirit and scope of the disclosure. Accordingly, other implementations are within the scope of the following claims.