Method for checking whether vehicle violates boundary of drivable area and driving assistance system
Through the inspection method based on the rotation direction, the calculation-intensive solution real numbers problem in the prior art is solved, and efficient and safe vehicle boundary inspection is achieved to ensure that the vehicle has no collision on the trajectory.
Patent Information
- Application Number
- CN202380034710.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Priority Date
- 2022-04-19
- Filing Date
- 2023-03-27
- Publication Date
- 2024-11-26
AI Technical Summary
When the existing driving assistance system checks whether the vehicle violates the boundaries of the driving area, it is intensive to calculate and difficult to ensure real-number solutions, resulting in low inspection efficiency and insufficient safety.
Using a rotation direction-based inspection method, by receiving boundary line information of the vehicle and the driving area, multiple points are selected to form polygonal stitches, traversing these points to determine the rotation direction, and determining whether the boundary is violated by comparing the rotation direction.
A low-computing, simple and safe inspection method is realized, which can quickly identify whether the driving area boundaries are violated, and improves the efficiency and safety of inspections.
Smart Images

Figure CN119032032A_ABST
Abstract
Description
[0001] The present invention relates to the field of driver assistance systems for vehicles and in particular to a robust method for checking whether a vehicle guided by a driver assistance system violates the boundaries of an allowed maneuverable space while driving along a trajectory.
[0002] Driving assistance systems in vehicles are generally known. Distance-based methods are also known, which involve checking whether the vehicle to be moved on a trajectory maintains a predefined distance from the boundary of the drivable area along the entire movement path described by the trajectory. This is done by taking into account the vehicle geometry, that is to say in particular the surface area generated by projecting the body contour onto the road.
[0003] There are also known methods that involve checking whether an intersection occurs between the driving passage of the vehicle, i.e., the area covered by the projection of the vehicle body contour on the road when the vehicle moves along the trajectory, and the boundary line of the drivable area (that is, whether the driving passage intersects the boundary of the drivable area). In the known method, the intersection with the boundary of the drivable area must be calculated.
[0004] The problem with the known methods is that they are very computationally intensive, since a system of equations must be solved in each case to determine the distance of the vehicle from the boundary line of the drivable area or the intersection of the body contour segment with the boundary line. Furthermore, it is not always guaranteed that the solution of the system of equations results in a real solution. If no real solution is found, further checks must be performed.
[0005] Starting from this, the object of the present invention is to specify a method which enables a reliable check of violations of the boundaries of a drivable area with a low computational effort.
[0006] This object is achieved by a method having the features of independent patent claim 1. The dependent claims relate to preferred embodiments. The parallel patent claim 11 relates to a driver assistance system which is designed to check for violations of the boundaries of a drivable area.
[0007] According to a first aspect, a method for checking whether a vehicle violates a boundary of a drivable area is disclosed. The vehicle has a driving assistance system designed to move the vehicle along a trajectory in a fully automatic or semi-automatic manner. The driving assistance system is additionally configured to perform a checking method comprising the following steps:
[0008] First, information about at least one boundary line of the drivable area is received. This information can be provided by an environment detection unit of the vehicle, which generates an environment model of the vehicle environment. For example, the boundary line can identify a boundary in the operable space, which boundary particularly defines a lane on which the vehicle will move. Alternatively, the boundary line can represent an environmental object in the vehicle environment.
[0009] In addition, information about the driving channel of the vehicle is received. The driving channel is the area covered by the projection of the vehicle body contour on the road when driving over the trajectory. In other words, the driving channel is a tubular area whose width is at least equal to the vehicle width (wider in the case of combined safety buffers).
[0010] Preferably, the borderline is defined by a plurality of points, that is to say, by a trace consisting of a plurality of straight lines, wherein each of these straight lines extends between two adjacent points. As an alternative, the borderline can also be formed by a continuous line.
[0011] A first point and a second point are selected on the boundary line of the drivable area. In this case, the first point is located behind the second point in the direction of travel of the vehicle. Thus, these points define a portion of the boundary line for which a check is performed to see whether the boundary line is violated when driving over the trajectory.
[0012] A third point located on the edge of the driving path of the vehicle is also determined. The driving path of the vehicle may be defined by a continuous line or by a plurality of body contours located at different positions along the trajectory. The body contour may be formed, for example, by a polygon, in particular a rectangle, which at least approximately describes the body contour when the vehicle is viewed from above. The body contour may be selected to be larger than the actual body contour to obtain a safety buffer.
[0013] Then, by checking whether there is a first clockwise or counterclockwise rotation direction while traversing the polygonal trace formed from the first point through the second point to the third point, the position of the third point relative to the line between the first point and the second point is determined. In other words, the three points (two of which are located on the boundary line and one of which indicates the driving passage of the vehicle) are connected by a trace. The trace can be open, that is, it can end at the third point, or the trace can be closed to form a triangle. Then check the rotation direction generated when traversing the trace in the direction of travel so as to traverse the path between the two points on the boundary line of the drivable area. Alternatively or additionally, it can be checked whether the first point to the third point are collinear, that is, whether they are located on a straight line.
[0014] Additionally, at least one fourth point that is located on an edge of the driving path of the vehicle and is different from the third point is determined.
[0015] Then, by checking whether there is a second clockwise or counterclockwise rotation direction while traversing the line trace formed from the first point through the second point to the fourth point, the position of the fourth point relative to the line between the first point and the second point is determined. In other words, the three points (two of which are located on the boundary line and one of which indicates another point of the driving passage of the vehicle) are connected by a line trace. The line trace can be open, that is, it can end at the fourth point, or the line trace can be closed to form a triangle. Then check the rotation direction generated when traversing the line trace in the direction of travel so as to traverse the path between the two points on the boundary line of the drivable area. Alternatively or additionally, it can be checked whether the first point, the second point and the fourth point are collinear, that is, whether they are located on a straight line.
[0016] Finally, it is checked whether the boundary of the drivable area is violated. This is done by comparing the first rotation direction and the second rotation direction. If they are the same, this indicates that the boundary of the drivable area is not violated. Different rotation directions indicate that the boundary of the drivable area is violated. Alternatively or additionally, the results of the collinearity check can also be used to identify whether the boundary of the drivable area is violated.
[0017] The method has the following technical advantages: With the aid of the checking method based on the direction of rotation, a technically simple check can be performed with little computational effort, since the checking method is point-based, which means that computationally efficient vector calculation methods can be used and therefore computationally intensive equation systems do not have to be solved. In addition, the checking method makes it possible to identify whether the drivable area has been completely left, thereby increasing the safety of the checking method.
[0018] According to an exemplary embodiment, the third point and the fourth point are each a vertex of a polygon simulating a vehicle body contour. The third point and the fourth point are associated with a common edge line of the vehicle body contour. The third point and the fourth point are each a vertex of the right side line or the left side line of the vehicle body contour. This makes it easy to check whether the edge line of the vehicle body contour intersects with the boundary line of the drivable area. Further relevant conclusions can be drawn from any other additional information available, such as whether it is related to the left or right corner of the vehicle body contour, or whether the first point and the second point are located on the boundary line on the left or right side of the vehicle, such as whether the vehicle is completely outside the drivable area.
[0019] According to an exemplary embodiment, when checking whether the boundary of the drivable area is violated, it is determined whether the first rotation direction and the second rotation direction are the same or different. If the first rotation direction and the second rotation direction are the same, it can be inferred that the third point and the fourth point are on the same side of the boundary line. In the case of different rotation directions, it can be inferred that the third point and the fourth point are on different sides of the boundary line, and thus the vehicle will enter an area not planned to travel when passing the trajectory, or there is a risk of collision with environmental objects.
[0020] According to an exemplary embodiment, at least one boundary line of the drivable area is approximated by a plurality of points spaced apart from one another. A pair of points of the boundary line is selected as a first point and a second point in succession in time and is used to determine a first rotation direction and a second rotation direction and to check whether a boundary of the drivable area is violated. This makes it possible to repeatedly / iteratively check whether a drivable area is violated based only on the pair of points of the boundary line without the need for a system of equations.
[0021] According to an exemplary embodiment, the drivable area has a left boundary line and a right boundary line, which are spaced apart from each other and define a lane. The vehicle body contour is approximated by a rectangle having a pair of left corners and a pair of right corners. A first rotation direction and a second rotation direction are determined for the pair of left corners, that is, a first rotation direction is determined for one of the left corners, and a second rotation direction is determined for the other left corner. Based on the first rotation direction and the second rotation direction, it is checked whether the vehicle violates the left boundary line of the drivable area. Therefore, the method can be applied advantageously and with a reduced amount of calculation to achieve compliance with the left boundary line of the predefined lane.
[0022] According to an exemplary embodiment, the drivable area has a left boundary line and a right boundary line, which are spaced apart from each other and define a lane. The vehicle body contour is approximated by a rectangle having a pair of left corners and a pair of right corners. A first rotation direction and a second rotation direction are determined for the pair of right corners, that is, the first rotation direction is determined for one of the right corners, and the second rotation direction is determined for the other right corner. Based on the first rotation direction and the second rotation direction, it is checked whether the vehicle violates the right boundary line of the drivable area. Therefore, the method can be applied advantageously and with a reduced amount of calculation to achieve compliance with the right boundary line of the predefined lane.
[0023] According to an exemplary embodiment, the drivable area has a left boundary line and a right boundary line, which are spaced apart from each other and define a lane. The vehicle body contour is approximated by a rectangle having two left corners and two right corners. The position of at least the two left corners relative to the line between the first point and the second point located on the left boundary line is checked. Here, in particular, the direction of rotation is determined for each left corner while traversing the line trace formed from the first point through the second point to the corresponding angle of the vehicle body contour, and the direction of rotation is determined for each left corner. Then check whether the direction of rotation is clockwise oriented. It can be determined thereby whether the vehicle is located on the right side of the left boundary line. If necessary, the direction of rotation can be determined and checked for more than two corners, in particular for all four corners of the rectangle simulating the vehicle body contour.
[0024] According to an exemplary embodiment, the drivable area has a left boundary line and a right boundary line, which are spaced apart from each other and define a lane. The vehicle body contour is approximated by a rectangle having two left corners and two right corners. The position of at least the two right corners relative to the line between the first point and the second point located on the right boundary line is checked. Here, in particular, the direction of rotation is determined for each right corner by determining the direction of rotation while traversing the line trace formed from the first point through the second point to the corresponding corner. It is then checked whether the direction of rotation is oriented counterclockwise. It can thus be determined whether the vehicle is located on the left side of the right boundary line.
[0025] According to an exemplary embodiment, the boundary line of the drivable area is associated with the boundary line of a location-limited environmental object in the environment area of the vehicle. The environmental object is described by a bounding box. The first point and the second point define a line of the bounding box, which line is associated with a side of the environmental object facing the vehicle. Thereby, it can be checked whether a collision occurs between the vehicle and the environmental object when driving over the trajectory.
[0026] According to an exemplary embodiment, the vehicle body contour is approximated by a rectangle with four corners, and the environmental objects are approximated by a rectangular bounding box with four corners. For each line of the rectangular bounding box, in particular by determining the rotation direction while traversing the line trace between the end points of the corresponding line of the rectangular bounding box and the corresponding corner of the rectangle of the vehicle body contour, the positions of all corners of the rectangle of the vehicle body contour relative to the corresponding line are determined. A large amount of rotation direction information is thus obtained. After the rotation direction is determined, it is checked whether all rotation directions are the same. It can thus be checked whether a collision with the environmental objects occurs in the longitudinal or transverse direction.
[0027] According to another aspect, the invention relates to a driving assistance system designed to check whether a vehicle violates the boundaries of a drivable area. The driving assistance system comprises a plurality of sensors distributed around the vehicle and a computing unit for processing the information provided by these sensors. The computing unit is configured to perform the following steps:
[0028] - receiving information about at least one boundary line of the drivable area;
[0029] - receiving information about the driving corridor of the vehicle, the driving corridor being the area covered by the projection of the vehicle body contour on the road when driving over the trajectory;
[0030] - selecting a first point and a second point on a boundary line of the drivable area, the first point being located behind the second point in the travel direction of the vehicle;
[0031] - determining a third point located on the edge of the driving path of the vehicle;
[0032] - determining the position of the third point relative to the line between the first point and the second point by checking whether there is a first direction of rotation, clockwise or counterclockwise, or collinearity between the first point, the second point and the third point while traversing a polygonal line formed from the first point through the second point to the third point;
[0033] - determining at least one fourth point located on an edge of the driving path of the vehicle and different from the third point;
[0034] - determining the position of the fourth point relative to the line between the first point and the second point by checking whether there is a second rotation direction, clockwise or counterclockwise, or collinearity between the first point, the second point and the fourth point while traversing the polygonal line formed from the first point through the second point to the fourth point;
[0035] - Checking whether a boundary of the drivable area has been violated by comparing the first rotation direction with the second rotation direction and / or by comparing the results of the collinearity check.
[0036] For the purposes of the present invention, the terms “approximately”, “substantially” or “about” mean a deviation from the corresponding exact value by + / -10%, preferably + / -5%, and / or a deviation in a form that does not significantly change the function.
[0037] The further developments, advantages and possible applications of the invention are also apparent from the following description of exemplary embodiments and the drawings. In this case, all features described and / or illustrated in the drawings are fundamentally the subject matter of the invention either by themselves or in any desired combination, regardless of their combination in the claims or their reference relationships. The content of the claims also forms part of the description.
[0038] The present invention will be explained in more detail below with reference to the accompanying drawings of exemplary embodiments. In the drawings:
[0039] Figure 1 A schematic top view of a vehicle with a driver assistance system is shown by way of example, the driver assistance system comprising a plurality of sensors and a computing unit;
[0040] Figure 2 Different arrangements of points A, B, and C are shown by way of example, and the resulting rotation direction is shown by a given arrangement direction of these points;
[0041] Figure 3 The movement of a vehicle along a trajectory defined by a pair of lane-defining boundary lines and an exemplary application of a turning direction method for checking whether a lane boundary line has been violated are exemplarily shown;
[0042] Figure 4The movement of the vehicle based on a trajectory along a lane is shown exemplarily, wherein the left boundary line of the lane is violated;
[0043] Figure 5 The movement of a vehicle along a trajectory is shown by way of example, the trajectory being laterally delimited by a plurality of surrounding objects, wherein collisions with surrounding objects occur when traveling along the trajectory;
[0044] Figure 6 A flow chart is shown which illustrates the steps of a method for checking whether a boundary of a drivable area has been violated.
[0045] Figure 1 By way of example and schematically, a vehicle 1 is shown with a driver assistance system for performing fully or semi-automatic driving maneuvers. The driver assistance system may be particularly designed to identify areas that can be driven fully or semi-automatically by the vehicle 1, and to control the vehicle 1 so that the vehicle does not violate the boundaries of the drivable area. For example, the drivable area may be a lane with a left boundary line and a right boundary line. As an alternative, the drivable area may be limited by one or more environmental objects, with which collisions need to be avoided.
[0046] The vehicle 1 has a plurality of sensors 2, by means of which the surrounding area of the vehicle 1 can be detected. The sensors 2 are connected to a computing unit 3 of the driver assistance system, which processes the sensor information and provides information about at least one boundary line of the drivable area. This surrounding detection enables the driver assistance system to identify a local area in which the vehicle 1 can be controlled without collision.
[0047] The driving assistance system is additionally designed to determine the movement trajectory of the vehicle 1 during a driving maneuver performed in a fully autonomous or semi-autonomous manner. When traversing the trajectory, the vehicle moves along a driving channel. The driving channel is given by the area covered or temporarily occupied by the vehicle body when the vehicle moves. The vehicle has a circumferential body contour, which is produced, for example, when looking down at the vehicle 1 from above, that is to say from a bird's eye view. This body contour is projected vertically downward onto the road and defines the road area occupied by the vehicle 1. This area must be freely traversable in order for the vehicle 1 to move without collision. Therefore, the driving channel is tubular and has a width at least equal to the width of the body contour. The driving channel can also be designed to be wider than the vehicle width to increase the safety of the method.
[0048] In order to be able to determine whether the vehicle 1 violates the boundary of the drivable area, a checking method based on the turning direction may be applied.
[0049] Figure 2Three possibilities are shown for how points A, B and C may be arranged. For example, the line between point B and point C forms a segment of the boundary line of the drivable area. For example, point A may be a vertex of the body contour of vehicle 1. Points A, B and C form a triangle, typically a polygon. When traversing the trace along the points in a predefined order (for example, from point B through point C to point A), position information about point A relative to the line between point B and point C may be determined. If a clockwise direction of rotation is produced when traversing the trace, it may be inferred that point A is located to the right of line BC. In the opposite case, if a counterclockwise direction of rotation ( Figure 2 The third case is the collinear case, where the three points A, B, and C are all on a straight line, such as Figure 2 As shown in the right figure.
[0050] Figure 3 An exemplary application of the described method is shown, in which a vehicle 1 moves on a track T in a driving direction FR on a lane defined by a left boundary line G1 and a right boundary line G2. The boundary lines G1, G2 can be approximated by discrete points spaced apart from one another. Figure 3 In the exemplary embodiment of FIG. 1 , point B and point C are two points of the left boundary line G1 , and point B′ and point C′ are two points of the right boundary line G2 .
[0051] The body contour of the vehicle 1 is approximated by a rectangle. The size of the rectangle is selected so that all areas of the vehicle 1 (including, for example, the rearview mirrors of the vehicle 1) are located within the body contour.
[0052] In order to ensure that the vehicle 1 can move on the trajectory T without collision, it must be checked that the driving channel of the vehicle 1 generated by the movement of the body contour along the trajectory T has no intersections with the boundary lines G1, G2. The driving channel of the vehicle 1 can in particular be a tubular area, which must be located within the boundary lines G1, G2 to ensure that the trajectory T is collision-free.
[0053] The check as to whether the trajectory T is collision-free may be performed repeatedly based on discrete vehicle positions of the vehicle 1, such as Figure 3 As indicated by the multiple rectangles representing the vehicle 1 .
[0054] At the defined vehicle position, it should be checked whether the left contour line of the vehicle is located on the right side of the left boundary line G1, and whether the right contour line of the vehicle is located on the left side of the right boundary line G2. In the exemplary embodiment shown, the check can be performed based on the left front corner and the left rear corner, or the right front corner and the right rear corner. It is necessary to check in more detail whether the left front corner and the left rear corner have the same position relative to the left boundary line G1, that is, both are located on the right side of the left boundary line G1. The same check is performed for the right front corner and the right rear corner relative to the right boundary line G2. These two corners must also have the same position relative to the right boundary line G2, that is, both must be located on the left side of the right boundary line G2.
[0055] For example, the check involves determining a pair of points of the left boundary line G1 of the lane, which are close to the left contour line of the vehicle. In the exemplary embodiment shown, these points are point B and point C. The left front corner of the vehicle 1 is represented as point A. For a line trace composed of the sequence of points BCA, this produces a clockwise rotation direction.
[0056] Then, the same check is performed on the left rear corner of the vehicle 1 relative to point B and point C. If the polygonal line trace from point B to C through the left rear corner and back to B is traversed, this also produces a clockwise rotation direction. Therefore, the result of the check is that the two vertices of the left contour of the vehicle are located on the same side of the left boundary line G1, that is, the left contour of the vehicle does not intersect with the left boundary line G1, that is, does not collide with the left boundary line G1. In addition, it can be determined that the two vertices of the left contour of the vehicle are located on the right side of the left boundary line G1.
[0057] A similar check is performed on the two vertices of the vehicle right contour line with respect to the right boundary line G2.
[0058] like Figure 3 As shown, the right boundary line G2 is also represented by a plurality of points, wherein point B' and point C' define a line forming a portion of the right boundary line G2. In order to be able to identify whether the vehicle 1 does not violate the right boundary line G2 when passing through the driving channel, the above algorithm is similarly implemented for the vertices of the right contour line of the vehicle. Therefore, the rotation direction is determined for the right front corner A' of the vehicle contour line and the trace B'-C'-A' generated thereby, which is generated when traversing the polygonal trace along the above-mentioned traversal direction. The rotation direction is counterclockwise in the exemplary embodiment shown.
[0059] Then, a similar check is performed on the right rear corner of the vehicle 1 relative to point B' and point C'. If the polygonal line trace from point B' to C' through the right rear corner of the vehicle 1 and back to B' is traversed, this also produces a counterclockwise rotation direction. Therefore, the result of the check is that the two vertices of the right contour line of the vehicle are located on the same side of the right boundary line G2, that is, the right contour line of the vehicle does not intersect with the right boundary line G2 and therefore does not collide with the right boundary line G2. In addition, it can be determined that the two vertices of the right contour line of the vehicle are located to the left of the right boundary line G2.
[0060] The above-described checking steps are preferably performed repeatedly for multiple vehicle positions along the driving corridor and for different sections of the boundary lines G1 and G2 (defined by the point pairs BC or B′-C′) to ensure the collision-free nature of the trajectory T.
[0061] Figure 4 An example is shown in which the trajectory T is determined such that the driving passage of the vehicle 1 intersects the left boundary line G1 in the area marked with an ellipse and thus violates the boundary of the drivable area.
[0062] The section of the boundary line G1 in the area of the vehicle 1 is defined by point B. L and C L The left front corner of vehicle 1 is indicated as point A. FL For point B L -C L -A FL When the proposed method is applied relative to the boundary line G1 (which in turn is formed by point B L and C L The limit) is applied to the left rear corner of the vehicle 1 (indicated as point A RL ), this is when traversing along point B L -C L -A RL Since the rotation directions of the front and rear angles are different, the proposed method makes it possible to identify violations of the boundary line G1.
[0063] In order to identify that the vehicle 1 is not completely outside the drivable area, it may be useful to check the position of a pair of left corners or a pair of right corners of the vehicle contour line relative to at least one boundary line G1, G2 in each cycle or at longer time intervals. L and C L When the marked line produces a counterclockwise rotation direction and the rotation direction indicates that the left corner of the body contour is located to the left of the left boundary line G1, it can be inferred that the vehicle 1 is outside the drivable area of the trajectory T at this point and therefore violates the boundary of the drivable area.
[0064] Figure 5 An exemplary embodiment is shown in which the boundaries of the drivable area are not defined by boundary lines in the operable space, but the drivable area is laterally bounded by environmental objects U having limited local extents. Therefore, the method can be used directly to prevent collisions with environmental objects U.
[0065] The environmental object U can be approximated by an environmental object contour, which is formed, for example, as a polygon with a plurality of vertices, in particular as a rectangle. In order to ensure that no collision occurs between the vehicle 1 and the environmental object U, no collision must occur in the lateral direction (that is, relative to the left or right boundary line of the environmental object contour) and the longitudinal direction (that is, relative to the front or rear boundary line of the environmental object contour).
[0066] like Figure 5 As shown, the corner of the body contour of the vehicle 1 is defined by point A. FL , A RL , A FR , A RR The angle of the environmental object contour is represented by B L , C L , B R , C R In order to identify whether the vehicle 1 will not collide with the environmental object U, the following steps may be performed:
[0067] First, check whether there is a lateral collision situation. For this purpose, for each corner of the body contour of the vehicle 1, its side contour line B relative to the surrounding object U is determined based on the above-mentioned rotation direction method. L -C L and B R -C R This means that for the point triple B L -C L -A FL , B L -C L -A RL , B L -C L -A FR and B L -C L -A RR And for the point triple B R -C R -A FL , B R -C R -A RL , B R -C R -A FR and B R-C R -A RR , the corresponding rotation direction is determined when the line paths spanned by these points are traversed. If the same rotation direction does not occur during the traversal of all lines, there is a lateral collision with an environmental object.
[0068] It is then checked whether a longitudinal collision situation exists. For this purpose, for each corner of the body contour of the vehicle 1, its front contour line C relative to the surrounding object U is determined based on the above-mentioned rotation direction method. L -C R and rear contour line B L -B R This means that for the point triple C L -C R -A FL , C L -C R -A RL , C L -C R -A FR and C L -C R -A RR And for the point triple B L -B R -A FL , B L -B R -A RL , B L -B R -A FR and B L -B R -A RR , the corresponding rotation direction is determined when the line paths spanned by these points are traversed. If the same rotation direction is not generated during the traversal of all lines, there is a longitudinal collision with an environmental object.
[0069] If the above method steps detect that neither a transverse collision situation nor a longitudinal collision situation exists, vehicle 1 can be moved along the trajectory relative to the checked surrounding objects without collision.
[0070] If Figure 5 If a plurality of environmental objects U are arranged along the trajectory T, the above method must be repeatedly applied to ensure that the vehicle 1 does not collide with any environmental object along the trajectory.
[0071] Figure 6 A block diagram is shown illustrating the steps of a method for checking whether a vehicle moving along a trajectory violates a boundary of a drivable area.
[0072] First, information about at least one boundary line of the drivable area is received (S10). In this case, the boundary line can be a boundary line in the operable space or related to an environmental object.
[0073] In addition, information about a driving passage of the vehicle is received, wherein the driving passage is an area covered by a projection of the vehicle body contour on the road when the vehicle passes through the trajectory (S11). The driving passage must be located in a drivable area or must be collision-free in order to avoid collision between the vehicle and environmental objects.
[0074] Next, a first point and a second point are selected on the boundary line of the drivable area, wherein the first point is located behind the second point in the vehicle driving direction (S12).
[0075] A third point located on the edge of the driving path of the vehicle is also determined (S13). The third point is particularly a point on the body contour of the vehicle, which defines, for example, a corner of the body contour.
[0076] Then, by checking whether there is a first clockwise or counterclockwise rotation direction or collinearity between the first point, the second point and the third point while traversing the line formed from the first point through the second point to the third point, the position of the third point relative to the line between the first point and the second point is determined (S14).
[0077] In addition, at least one fourth point located on the edge of the driving path of the vehicle and different from the third point is determined (S15). The fourth point is particularly a point on the body contour of the vehicle, which defines another corner of the body contour, for example.
[0078] Then, by checking whether there is a second rotation direction clockwise or counterclockwise, or collinearity between the first point, the second point and the fourth point while traversing the polygonal line formed from the first point through the second point to the fourth point, the position of the fourth point relative to the line between the first point and the second point is determined (S16).
[0079] Finally, by comparing the first rotation direction with the second rotation direction and / or by comparing the collinearity check results, it is checked whether the boundary of the drivable area is violated ( S17 ).
[0080] The invention has been described above using exemplary embodiments. It will be appreciated that many variations and modifications are possible without departing from the scope of protection defined by the patent claims.
[0081] List of Reference Numerals
[0082] 1 Vehicle
[0083] 2 Sensors
[0084] 3 Computational Unit
[0085] A FL Third Point
[0086] A RL Fourth point
[0087] B. First point
[0088] C. Second point
[0089] F Body outline
[0090] FR driving direction
[0091] G1 Left boundary line
[0092] G2 Right boundary line
[0093] T track
[0094] U Environment Objects
Claims
1. A computer-implemented method for checking whether a vehicle (1) moving along a trajectory (T) violates a drivable area boundary, the method comprising the following steps: a) receiving information about at least one boundary line (G1, G2) of a drivable area (S10); b) receiving information about a driving passage of the vehicle (1), the driving passage being an area covered by a projection of a vehicle body contour (F) on a road when the vehicle passes through a trajectory (T) (S11); c) Select the first point (B) and the second point (C) on the boundary line (G1) of the drivable area, The first point (B) is located behind the second point (C) in the travel direction (FR) of the vehicle (1) (S12); d) Determine a third point (A) located on the edge of the driving path of the vehicle (1) FL )(S13); e) By traversing from the first point (B) through the second point (C) to the third point (A FL ) to check the first point (B), the second point (C), and the third point (A FL ) between the first rotation direction, clockwise or counterclockwise, or collinearity, determine the third point (A FL ) relative to a line between the first point (B) and the second point (C) (S14); f) determining a point located on the edge of the driving path of the vehicle (1) and different from the third point (A) FL ) of at least one fourth point (A RL )(S15); g) By traversing from the first point (B) through the second point (C) to the fourth point (A RL ) to check the first point (B), the second point (C), and the fourth point (A RL ) between the two, whether there is a second rotation direction, clockwise or counterclockwise, or whether there is collinearity, to determine the fourth point (A RL ) relative to a line between the first point (B) and the second point (C) (S16); h) Checking whether the boundary of the drivable area is violated by comparing the first rotation direction with the second rotation direction and / or by comparing the collinearity check results (S17).
2. The method according to claim 1, characterized in that The third point (A FL ) and the fourth point (A RL ) are each a vertex of a polygon simulating the contour of the vehicle body, wherein the third point (A FL ) and the fourth point (A RL ) are related to the common edge of the vehicle body contour and are respectively the vertices of the right side line or the left side line of the vehicle body contour.
3. The method according to claim 1 or 2, characterized in that When checking whether the boundary of the drivable area is violated, it is determined whether the first rotation direction and the second rotation direction are the same or different.
4. The method according to any one of the preceding claims, characterized in that At least one boundary line (G1, G2) of the drivable area is approximated by a plurality of points spaced apart from each other, and a pair of points of the boundary line are selected successively in time as a first point (B) and a second point (C) and are used to determine a first rotation direction and a second rotation direction and to check whether a boundary of the drivable area is violated.
5. The method according to any one of the preceding claims, characterized in that A drivable area has a left boundary line (G1) and a right boundary line (G2), the left boundary line and the right boundary line are spaced apart from each other and define a lane, a vehicle body contour is approximated by a rectangle having a pair of left corners and a pair of right corners, a first rotation direction and a second rotation direction are determined for the pair of left corners, and a vehicle (1) is checked based on the first rotation direction and the second rotation direction to see whether it violates the left boundary line (G1) of the drivable area.
6. The method according to any one of the preceding claims, characterized in that A drivable area has a left boundary line (G1) and a right boundary line (G2), the left boundary line and the right boundary line are spaced apart from each other and define a lane, a vehicle body contour is approximated by a rectangle having a pair of left corners and a pair of right corners, a first rotation direction and a second rotation direction are determined for the pair of right corners, and based on the first rotation direction and the second rotation direction, it is checked whether the vehicle (1) violates the right boundary line (G2) of the drivable area.
7. The method according to any one of the preceding claims, characterized in that The drivable area has a left boundary line (G1) and a right boundary line (G2), which are spaced apart from each other and define a lane, the body contour is approximated by a rectangle with two left corners and two right corners, and the position of at least the two left corners relative to a line between a first point and a second point located on the left boundary line (G1) is checked at least briefly, in particular by determining the rotation direction for each left corner while traversing a line trace formed from the first point through the second point to the corresponding corner, the rotation direction is determined at least for the two left corners respectively, and it is checked whether the two rotation directions are oriented clockwise.
8. The method according to any one of the preceding claims, characterized in that The drivable area has a left boundary line (G1) and a right boundary line (G2), which are spaced apart from each other and define a lane, the body contour is approximated by a rectangle with two left corners and two right corners, and the position of at least the two right corners relative to a line between a first point and a second point located on the right boundary line (G2) is checked at least briefly, in particular by determining a rotation direction for each right corner while traversing a line trace formed from the first point through the second point to the corresponding corner, determining a rotation direction for at least the two right corners respectively, and checking whether the two rotation directions are oriented counterclockwise.
9. The method according to any one of claims 1 to 4, characterized in that The boundary line of the drivable area is related to the boundary line of an environmental object (U) with a limited location in the environmental area of the vehicle (1), the environmental object (U) being described by a bounding box, the first point (B) and the second point (C) defining the line of the bounding box, the line of the bounding box being related to the side of the environmental object (U) facing the vehicle (1).
10. The method according to claim 9, characterized in that The vehicle body contour is approximated by a rectangle with four corners, the environmental object (U) is approximated by a rectangular bounding box with four corners, for each line of the rectangular bounding box, in particular, the rotation direction is respectively determined by traversing the line trace between the end points of the corresponding line of the rectangular bounding box and the corresponding corners of the rectangle of the vehicle body contour, the positions of all corners of the rectangle of the vehicle body contour relative to the corresponding lines are determined, and after the rotation direction is determined, it is checked whether all rotation directions are the same.
11. A driving assistance system, the driving assistance system being designed to check whether a vehicle (1) violates the boundary of a drivable area, the driving assistance system comprising a plurality of sensors (2) distributed around the vehicle (1) and a computing unit (3) for processing information provided by the sensors (2), wherein: The computing unit (3) is configured to perform the following steps: a) receiving information about at least one boundary line of a drivable area; b) receiving information about a driving corridor of the vehicle (1), the driving corridor being an area covered by a projection of the vehicle body contour on the road when driving over the trajectory; c) selecting a first point (B) and a second point (C) on a boundary line of the drivable area, the first point (B) being located behind the second point (C) in the travel direction of the vehicle (1); d) Determine a third point (A) located on the edge of the driving path of the vehicle (1) FL ); e) By traversing from the first point (B) through the second point (C) to the third point (A FL ) to check the first point (B), the second point (C), and the third point (A FL ) between the first rotation direction, clockwise or counterclockwise, or collinearity, determine the third point (A FL ) relative to a line between the first point (B) and the second point (C); f) determining a point located on the edge of the driving path of the vehicle (1) and different from the third point (A) FL ) of at least one fourth point (A RL ); g) By traversing from the first point (B) through the second point (C) to the fourth point (A RL ) to check the first point (B), the second point (C), and the fourth point (A RL ) between the two, whether there is a second rotation direction, clockwise or counterclockwise, or whether there is collinearity, to determine the fourth point (A RL ) relative to a line between the first point (B) and the second point (C); h) Checking whether a boundary of the drivable area is violated by comparing the first rotation direction with the second rotation direction and / or by comparing the collinearity check results.
