METHOD FOR THE PLANNING OF TRAJECTORIES

Abstract

A method and system is disclosed to operate a vehicle pulling a trailer through a cornering maneuver is disclosed. An outer, concave edge and an inner, convex edge of a negotiable road are identified. A path of travel is determined for an inner wheel of the trailer of the vehicle. A first directrix is determined on which a guide point of the vehicle must move in order to pull the inner wheel along the determined path of travel. A second directrix is determined, on which a outer, front wheel of the vehicle must move in order to pull the guide point along the first directrix. A concave-side distance between the outer, front wheel and the concave edge is estimated. When the difference between the distance on concave-side and convex-side exceeds a threshold value, the convex-side distance is adjusted to be closer to the concave-side distance.

Claims

1-12. (canceled)

13. A method for operating a vehicle pulling a trailer through a cornering maneuver comprising: identifying a concave edge and a convex edge of a negotiable road surface; determining a path of travel for an inner wheel of the facing towards the convex edge having a convex-side distance from the convex edge; computing a first directrix, on which a guide point of the vehicle must move in order to pull the inner wheel along the path of travel; computing a second directrix, on which an outer, front wheel of the vehicle facing towards the concave edge must move in order to pull the guide point along the first directrix; estimating a concave-side distance between the outer, front wheel and the concave edge; computing an adjusted path of travel such that the convex-side distance is closer to the concave-side distance when a difference between the concave-side distance and convex-side distances exceeds a threshold value; and issuing a command indicating the adjusted path of travel.

14. The method in accordance with claim 13, wherein issuing a command comprises generating a steering input for the vehicle.

15. The method in accordance with claim 13, wherein issuing a command comprises signaling an steering input for the vehicle.

16. The method in accordance with claim 13, further comprising setting the convex-side distance to zero when at least part of the second directrix lies outside the negotiable road surface.

17. The method in accordance with claim 13, further comprising selecting the guide point on a line that extends in the vehicle longitudinal direction from a trailer coupling to a rear axle of the vehicle.

18. The method in accordance with claim 13, further comprising acquiring an image of the negotiable road surface with an on-board camera for determining the convex and concave edges.

19. The method in accordance with claim 13, further comprising computing the first directrix such that, at each point on the path of travel there exists a first point on the first directrix that is connected to the point on the path of travel by a straight line of constant length, which intersects the path of travel at a first angle that remains constant.

20. The method in accordance with claim 19, further comprising computing the second directrix such that at each point on the first directrix there exists a second point on the second directrix that is connected to the point on the first directrix by a straight line of constant length, which intersects the first directrix at a second angle that remains constant.

21. The method in accordance with claim 13, further comprising detecting the presence of the trailer coupled to the vehicle.

22. The method in accordance with claim 13, further comprising detecting the presence of the trailer coupled to the vehicle an environmental sensor.

23. The method in accordance with claim 13, wherein detecting the presence of the trailer coupled to the vehicle comprises determining that the vehicle is pulling a trailer based on a by comparison of an engine load and an associated vehicle acceleration.

24. A non-transitory computer readable medium comprising processor-executable instructions for reading data from a processor in communication with a camera onboard a vehicle pulling a trailer through a cornering maneuver, the processor-executable instructions when executed on the processor in a device configure the device to: identify a concave edge and a convex edge of a negotiable road surface from image acquired by the camera; determine a path of travel for an inner wheel of the facing towards the convex edge having a convex-side distance from the convex edge; compute a first directrix, on which a guide point of the vehicle must move in order to pull the inner wheel along the path of travel; compute a second directrix, on which an outer, front wheel of the vehicle facing towards the concave edge must move in order to pull the guide point along the first directrix; estimate a concave-side distance between the outer, front wheel and the concave edge; compute an adjusted path of travel such that the convex-side distance is closer to the concave-side distance when a difference between the concave-side distance and convex-side distances exceeds a threshold value; and issue a command indicating the adjusted path of travel.

25. A driver assistance system for operating a vehicle pulling a trailer through a cornering maneuver comprising an electronic control unit configured to: identify a concave edge and a convex edge of a negotiable road surface; determine a path of travel for an inner wheel of the facing towards the convex edge having a convex-side distance from the convex edge; compute a first directrix, on which a guide point of the vehicle must move in order to pull the inner wheel along the path of travel; compute a second directrix, on which an outer, front wheel of the vehicle facing towards the concave edge must move in order to pull the guide point along the first directrix; estimate a concave-side distance between the outer, front wheel and the concave edge; compute an adjusted path of travel such that the convex-side distance is closer to the concave-side distance when a difference between the concave-side distance and convex-side distances exceeds a threshold value; and issue a command indicating the adjusted path of travel.

26. The driver assistance system in accordance with claim 25, wherein the electronic control unit is further configured to generating a steering input for the vehicle.

27. The driver assistance system in accordance with claim 25, wherein the electronic control unit is further configured to signal an steering input for the vehicle.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0017] The present disclosure will hereinafter be described in conjunction with the following drawing figures, wherein like numerals denote like elements.

[0018] FIG. 1 shows a vehicle with a driver assistance system steering the vehicle through a curve; and

[0019] FIG. 2 shows a flowchart of a working procedure for the driver assistance system.

DETAILED DESCRIPTION

[0020] The following detailed description is merely exemplary in nature and is not intended to limit the invention or the application and uses of the invention. Furthermore, there is no intention to be bound by any theory presented in the preceding background of the invention or the following detailed description.

[0021] FIG. 1 shows a motor vehicle 1 with a trailer 2 driving through a curve. The vehicle 1 has a front axle with steerable front wheels 3 and a rear axle with rear wheels 4. The front track or distance between the front wheels is designated as w1, and the wheelbase or distance between the axles is designated as d1. The front wheels 3 and a center point 5 of the rear axle form an isosceles triangle of width w1 and height d1.

[0022] A trailer coupling 6 is arranged centrally at the rear of the vehicle 1 at a distance d2 from the center point 5 of the rear axle. A drawbar 7 of the trailer 2 is connected such that it can pivot about the trailer coupling 6. The trailer 2 has a single axle with wheels 8. The trailer track or distance between the wheels 8 is designated as w2, and the distance between an axle for the trailer wheels 8 and the trailer coupling 6 is designated as d3. The wheels 8 and the trailer coupling 6 form a second isosceles triangle of width w2 and height d3.

[0023] An electronic control unit or microcomputer 9 of the vehicle 1 is connected to a camera 10, which is oriented on the roadway ahead of the vehicle 1 in order to identify the profiles of edges 11, 12 of the negotiable road surface 13 of the roadway on the basis of images supplied by the camera 10.

[0024] A sensor 14 at the rear of the vehicle can be a second camera, a radar sensor, or another sensor suitable for monitoring the traffic space behind the vehicle 1. In the context of the present disclosure, the sensor 14 is only required to detect the presence of the trailer 2 such that it is not a problem if the trailer 2 following closely behind the vehicle 1 completely, or almost completely, fills the field of view of the sensor 14. In principle, an electrical resistance connected to a trailer coupling can also indicate the presence of a trailer. However, in this case no distinction can be made between a trailer and, for example, a bicycle rack rigidly mounted on the trailer coupling and without ground contact, so that this criterion is indeed a necessary, but not a sufficient, criterion for the presence of a trailer.

[0025] In accordance with an alternative embodiment, the task of the sensor 14 to detect the presence of the trailer 2 is undertaken by an acceleration sensor, or data for the acceleration of the vehicle obtained by derivation from a tachometer signal against time. By dividing the power of an engine of the vehicle 1 by the resulting acceleration, the microcomputer 9 can estimate the inertial mass that is being driven by the engine. If this exceeds a predetermined limiting value, it is assumed that the trailer 2 is coupled.

[0026] The working procedure for the microcomputer 9 is illustrated in FIG. 2. At S1, a check is made to determine whether the trailer 2 is coupled to the vehicle 1. If the trailer 2 is coupled, then the profile of the inner or convex edge 11 of the roadway is initially determined on the basis of images from the camera 10 at S2. The profile identification can include calculating plane coordinates of a plurality of points of the edge 11 in a coordinate system related to the vehicle 1 and determining a polynomial that connects the points. The outer or concave edge 12 is correspondingly determined at S3 in a similar manner.

[0027] A path of travel 15 for the wheel 8 of the trailer 2 facing towards the convex edge 11, namely the inner trailer wheel, is then determined at S4. This path of travel 15 can be determined on the basis of the previously identified edge profile, such that all points of the path of travel 15 have the same desired distance ytarget=ymin from the polynomial calculated at S2. For reasons that will become apparent from the further description of the procedure, the actual distance y from the inner wheel 8 to the edge 11 is greater than ymin, so the path of travel 15 is preferably determined such that the distance to the edge 11 in a first section of the path of travel gradually decreases from y to ymin in order to produce a continuous connection between the impending path of travel 15 and the path of travel 16 already covered by the wheel 8.

[0028] The baseline of the triangle formed by the wheels 8 and the trailer coupling 6 is always at right angles to the path of travel 15. At S5, the microcomputer 9 therefore calculates points of a directrix 17 on which the trailer coupling 6 must move in order to guide the inner wheel 8 facing towards the convex edge 11 on the path of travel 15, by constructing a straight line 19, which intersects the path of travel 15 at an angle:

[00001]$={\tan }^{-1}.Math.\frac{w_2}{2.Math.d_3}$

and by selecting a point on the straight line whose distance r.sub.3 from the crossing point is given by:

[00002]$\sqrt{\frac{w_2^2}{4}+d_3^2}$

[0029] The center point 5 of the rear axle of the vehicle follows the center point 18 of the front axle on a tractrix. The path followed by the trailer coupling 6 deviates from this tractrix because of the non-vanishing distance d2, but this deviation is small as long as the path of the center point 18 does not have excessively tight curves, and here can be neglected, since the curvature of the path is limited by the maximum steering lock of the front wheels 3. This allows the microcomputer 9 to assume that the triangle formed by the trailer coupling 6 and the front wheels 3 is an isosceles triangle of invariable shape with the width w1 and the height d1+d2. In an analogous manner to the calculation of the directrix 17, at S6 the microcomputer 9 therefore calculates a path 20, which the front wheel 3 of the vehicle facing towards the concave edge 12 must follow, in order that the trailer coupling moves along the directrix 17, by constructing at points of the directrix 17 in each case a straight line, which intersects the directrix 17 at the angle:

[00003]$={\tan }^{-1}.Math.\frac{w_1}{2.Math.\left(d_1+d_2\right)}$

and by selecting a point on the straight line whose distance r.sub.1 from the crossing point is given by:

[00004]$\sqrt{\frac{w_1^2}{4}+{\left(d_1+d_2\right)}^2}$

[0030] The inaccuracy that results from neglecting the non-vanishing distance d2 between the trailer coupling 6 and the midpoint 5 of the rear axle is comparable if, in step S5, in accordance with an alternative method, a directrix is calculated for the center point 5, by selecting as the angle of the straight lines constructed, originating from the path of travel 15:

[00005]$={\tan }^{-1}.Math.\frac{w_2}{2.Math.\left(d_2+d_3\right)}$

and by selecting as the distance r.sub.3 of the point of the directrix:

[00006]$\sqrt{\frac{w_2^2}{4}+{\left(d_2+d_3\right)}^2}$

and originating from this directrix for the construction of the path 20 an angle:

[00007]$={\tan }^{-1}.Math.\frac{w_1}{2.Math.d_1}$

and a distance:

[00008]$r_1=\sqrt{\frac{w_1^2}{4}+d_1^2}$

[0031] In general, the directrix 17 can be calculated for any guide point 21 located on the center line of vehicle 1 at a distance *d2 from trailer coupling 6 and (1)*d2 from point 5; it then applies that:

[00009]$={\tan }^{-1}.Math.\frac{w_2}{2.Math.\left({\mathrm{ed}}_1+d_3\right)},r_3=\sqrt{\frac{w_2^2}{4}+{\left({\mathrm{ed}}_2+d_3\right)}^2}$$\mathrm{and}$$={\tan }^{-1}.Math.\frac{w_1}{2.Math.\left(d_1+\left(1-e\right).Math.d_2\right)},r_1=\sqrt{\frac{w_1^2}{4}+{\left(d_1+\left(1-e\right).Math.d_2\right)}^2}$

[0032] At S7, the distance y to the concave edge 12 is estimated for the path 20 thus obtained. If it appears at S8 that this distance is locally zero, i.e. if the path 20 touches or crosses over the edge 12, then the forecasted path is unsuitable for driving, and the microcomputer 9 sets the distance ytarget to zero at S10 and returns to S4. However, if the path 20 touches or crosses over the edge 12 beforehand at S9 such that ytarget has already been previously set to zero, then the curve is not negotiable, and the microcomputer 9 issues a braking command for the vehicle 1 itself, or a warning signal for the driver to do so at S11.

[0033] If the distance y is greater than zero over the entire path 20, then at S12 the minimum of y is compared with the distance ytarget between the path of travel 15 and the edge 11. If both distances are approximately equal, i.e. if:

[00010]$1-\mathrm{.Math.}<\frac{.Math..Math.y^{}}{.Math..Math.y_{\mathrm{soll}}}<1+\mathrm{.Math.}$

When soll=target is fulfilled, then the path 20 is suitable and can be negotiated. The microcomputer 9 can issue a steering command fully autonomously at S13. Alternatively, the microcomputer 9 may signal or display the path 20 to a driver. For example, an actuator controlled by the microcomputer 9 may exert a torque on a steering wheel of the vehicle in the direction of the position required for driving along the path 20, such that the driver may decide whether to follow the signaled path, or to overcome the torque of the actuator to drive along another path.

[0034] If the distances y and ytarget differ too greatly at S12, then at S14 ytarget is adjusted so as to be closer to y, for example by a fixed increment or decrement, or by forming an average value. The process may then be repeated from S4 with the new value of ytarget thus obtained. This ensures that, if the roadway offers sufficient space, a path of travel is selected for the vehicle 1 and trailer 2 that is approximately equidistant from both edges 11, 12.

[0035] If the presence of a trailer is not detected at S1, a simplified modification of the method described above may be implemented, in which, based on the profile of the edge 11 in accordance with the above-described principles, a path of travel is determined, not for a trailer wheel, but instead for the rear wheel 4 of the vehicle 1 facing towards the edge 11. The resulting path 17 of the guide point 21 is forecasted, and, as indicated in FIG. 2 by a dashed line, the process proceeds from S5 and following on the basis of this path 17.

[0036] While at least one exemplary embodiment has been presented in the foregoing detailed description, it should be appreciated that a vast number of variations exist. It should also be appreciated that the exemplary embodiment or exemplary embodiments are only examples, and are not intended to limit the scope, applicability, or configuration of the invention in any way. Rather, the foregoing detailed description will provide those skilled in the art with a convenient road map for implementing an exemplary embodiment as contemplated herein. It should be understood that various changes may be made in the function and arrangement of elements described in an exemplary embodiment without departing from the scope of the invention as set forth in the appended claims.