Method for determining a maximum speed limit for a reversing vehicle combination

Abstract

A method is provided for determining a maximum speed limit for a reversing vehicle combination that includes a towing vehicle and at least one towed trailer. The method includes determining a maneuver that is to be performed by the vehicle combination, simulating the complete maneuver in advance by using a control algorithm and a state space model, thereby obtaining the steering behavior of the vehicle combination during the maneuver, and calculating the maximum speed limit for the vehicle combination during the maneuver by using at least one predefined limiting condition. A maximum speed limit for a reverse assistance function can be estimated in advance, which allows for a faster and more efficient reversing of the vehicle combination, and at the same time allows for an improved comfort for the driver.

Claims

1. A method for determining a maximum speed limit for a reversing vehicle combination comprising a towing vehicle and at least one towed trailer, where the towing vehicle is provided with an automatic reverse assistance function, comprising: determining a manoeuvre that is to be performed by the vehicle combination, where the manoeuvre consists of a predefined path determined in advance prior to initiating the manoeuvre such that the vehicle will avoid obstacles when reversing, simulating the complete manoeuvre in advance prior to initiating the manoeuvre by using a control algorithm and a state space model, thereby obtaining the steering behaviour of the vehicle combination during the manoeuvre, calculating the maximum speed limit for the vehicle combination during the manoeuvre by using at least one predefined limiting condition, using the simulation of the complete manoeuvre, and controlling a vehicle speed with a non-transitory controller in accordance with the calculated maximum speed during the manoeuvre.

2. Method according to claim 1, wherein the manoeuvre is divided into sub-paths, and that a maximum speed limit is calculated for each sub-path, such that a maximum speed profile is obtained for the complete manoeuvre.

3. Method according to claim 2, wherein each sub-path is defined as a path segment in which the steering angle has the same sign.

4. Method according to claim 2, wherein each sub-path is defined by a predefined time interval.

5. Method according to claim 2, wherein each sub-path is defined by a predefined distance.

6. Method according to claim 1, wherein the each simulation point is assigned a maximum speed value, such that a continuous maximum speed profile is obtained for the complete manoeuvre.

7. Method according to claim 1, wherein the limiting condition is the properties of the steering actuator of the towing vehicle.

8. Method according to claim 1, wherein the limiting condition is the braking capacity of the vehicle combination.

9. Method according to claim 1, wherein the limiting condition is a measure corresponding to a comfort level of the driver.

10. Method according to claim 9, wherein the limiting condition is the lateral acceleration of the cab of the towing vehicle.

11. Method according to claim 1, wherein the maximum allowed speed during the manoeuvre is limited by a predefined set speed limit.

12. Method according to claim 1, wherein the manoeuvre that is to be performed is selected from a number of stored manoeuvres.

13. Method according to claim 1, wherein the calculated speed limit is used as an upper limit speed value for a reverse assistance function in which the driver controls the speed.

14. A method for determining a maximum speed limit for a reversing vehicle combination comprising a towing vehicle and at least one towed trailer, where the towing vehicle is provided with an automatic reverse assistance function, comprising: determining a manoeuvre that is to be performed by the vehicle combination, where the manoeuvre consists of a predefined path determined in advance prior to initiating the manoeuvre such that the vehicle will avoid obstacles when reversing, simulating the complete manoeuvre in advance prior to initiating the manoeuvre by using a control algorithm and a state space model, thereby obtaining the steering behaviour of the vehicle combination during the manoeuvre, calculating the maximum speed limit for the vehicle combination during the manoeuvre by using at least one predefined limiting condition, using the simulation of the complete manoeuvre, and informing a vehicle operator of the calculated maximum speed during the manoeuvre.

Description

BRIEF DESCRIPTION OF DRAWINGS

(1) The invention will be described in greater detail in the following, with reference to the attached drawings, in which

(2) FIG. 1 shows a schematic vehicle combination comprising a towing vehicle and a towed vehicle,

(3) FIG. 2 shows an example of a kinematic vehicle model, and

(4) FIG. 3 shows a schematic flow chart of an inventive method for determining a maximum speed limit for a reversing vehicle combination.

DETAILED DESCRIPTION

(5) The embodiments of the invention with further developments described in the following are to be regarded only as examples and are in no way to limit the scope of the protection provided by the patent claims.

(6) FIG. 1 shows a schematic vehicle combination 1 comprising a towing vehicle 2 and a towed vehicle 3. The towing vehicle may be a regular truck adapted for commercial highway use, a bus or a tractor having a fifth wheel. In the shown example, a tractor having a fifth wheel is used as a towing vehicle. The towed vehicle 3 is in the shown example a semitrailer, but the towed vehicle may also be a regular trailer or a dolly. The semitrailer is provided with a kingpin that is connected to the fifth wheel of the tractor. This example shows a common type of a vehicle combination, but it is also possible to use a vehicle combination having other types of towing vehicles and other types and numbers of towed vehicles. One such example is a vehicle combination comprising a truck, a dolly and a semitrailer.

(7) The towing vehicle is provided with an automatic reverse assistance function, in which the steering of the vehicle combination is automated during reversing and where the speed of the vehicle combination is controlled by the driver. The automatic reverse assistance function is adapted to steer the vehicle through a desired manoeuvre which consists of or comprises a predefined path which the vehicle should follow. The predefined path is selected such that is allows the vehicle to reach its final destination in a safe way, avoiding obstacles along the path.

(8) In FIG. 2, a kinematic vehicle model of a tractor-semitrailer vehicle combination is shown. The vehicle combination contains two rigid bodies attached by a joint which has one rotational degree of freedom.

(9) In the figures, L.sub.x is the wheel base of the towing vehicle, in this example a tractor having one rear axle 7. This value may be the actual wheel base for a tractor having only two axles, or may be the effective wheel base for a tractor having more than two axles. The wheel base L is the distance between the front axle 6 and the rear axle 7 of the tractor. The distance between the rear axle and the connection point to the towed vehicle is denoted C. The tractor is provided with a fifth wheel 4 which connects to a king pin 5 provided on the semitrailer, which makes up the connection point between the tractor and the semitrailer. L.sub.2 is the wheel base of the towed vehicle, in this example a semitrailer having three rear axles 8. This value ma be the actual wheel base for a semitrailer having one rear axle, but is normally the effective wheel base defined as the distance between the connection point and the virtual rear axle 9 of the semitrailer, since most semitrailers are provided with two or three rear wheel axles.

(10) The algorithm for determining the maximum speed is in this example described for a tractor-semitrailer combination. However, any vehicle combination can be used with the described method.

(11) A kinematic model of the vehicle is developed.

(12) ${\stackrel{.}{x}}_2=v_1\cos \varphi \left(1-\frac{c}{L_1}\tan \mathrm{\varphi tan\delta }\right)\cos {\theta }_2$${\stackrel{.}{y}}_2=v_1\cos \varphi \left(1-\frac{c}{L_1}\tan \mathrm{\varphi tan\delta }\right)\sin {\theta }_2$${\stackrel{.}{\theta }}_2=-v_1\frac{1}{L_1{L}_2}\left(L_1\sin \varphi +C\cos \mathrm{\varphi tan\delta }\right)$$\stackrel{.}{\varphi }=-v_1\frac{1}{L_1{L}_2}\left(L_2\tan \delta +L_1\sin \varphi +C\cos \mathrm{\varphi tan\delta }\right)$

(13) where (x.sub.2, y.sub.2) is the coordinate of the semitrailer axle, θ.sub.2 is the heading of the trailer, φ.sub.2 is the articulation angle, δ is the steering angle and v is the speed of the tractor. The geometry is described by the wheelbase L.sub.1 of the truck, the wheelbase L.sub.2 of the trailer and the coupling position C. The equations above are time dependent. However, they may be rewritten to a time independent form.

(14) $\frac{\partial x_2}{\partial s}=\cos {\theta }_2$$\frac{\partial y_2}{\partial s}=\sin {\theta }_2$$\frac{\partial {\theta }_2}{\partial s}=-\frac{\left(L_1\tan \varphi +C\tan \delta \right)}{L_1{L}_2-{\mathrm{CL}}_2\tan \delta \tan \varphi }$$\frac{\partial \varphi }{\partial s}=-\frac{\left(L_1\tan \varphi +L_2\sec \varphi +C\tan \delta \right)}{L_1{L}_2-{\mathrm{CL}}_2\tan \mathrm{\delta tan}\varphi }$

(15) where s is the distance travelled along the path.

(16) Since the equations of motion are independent of time, it is possible to predict how the vehicle will behave during the manoeuvre before the travel has started. For a time dependent case, it is not possible to predict the behaviour in advance since the speed is not known beforehand when the driver is in control of the speed. Before the vehicle starts travelling, the complete manoeuvre is simulated with the control algorithm that is to be used during the manoeuvre and a state space model of the vehicle combination. The control algorithm takes account of the offset from the desired path and adjusts the steering angle in order to minimize the offset. In this way, the steering of the vehicle is known before the manoeuvre is performed. The output of the simulation is the vehicle state (x.sub.2, y.sub.2, θ.sub.2, φ) and input δ as a function of s, which describes how they will change along the desired path.

(17) The simulation of the vehicle can be used to determine a maximum speed limit depending on one or more predefined conditions. In one example, the properties of the steering actuator are used as limiting condition of the truck. The actuators of the vehicle are naturally limited in how fast they can realise a motion change, and this is also the case for the steering actuator. The steering angle δ in the equations above, valid for an actively steered axle, has a maximum rate at which it can change. This maximum rate is δ.sub.max. The maximum allowed speed for the vehicle with respect to this actuator limitation can be found from the equation

(18) $v_{2,\max }=\frac{{\delta }_{\max }}{\frac{\partial \delta }{\partial s}}$

(19) where

(20) $\frac{\partial \delta }{\partial s}$
is found by differentiating δ found in the simulation. From this, the maximum speed of the drive axle v.sub.1 is obtained through the equation

(21) $v_2=v_1\cos \varphi \left(1-\frac{C}{L_1}\tan \varphi \tan \delta \right)$

(22) This gives a value for the maximum speed that the vehicle can travel with when cornering using the steering actuator and staying on the predefined path. With a higher speed, the steering will not be able to perform the required steering for the predefined path, which will result in that the vehicle will deviate from the predefined path. If the vehicle deviates from the predefined path, subsequent manoeuvres may also be of track, which may lead to that the vehicle reaches a wrong end position. A deviation from the predefined path may also be possible to compensate for, such that the vehicle still can reach the proper end position. However, a deviation along the predefined path may lead to a collision with an obstacle that is positioned outside of the predefined path. It is thus an advantage to adapt the reversing speed to the rate of the steering actuator.

(23) In another example, the braking capacity is used as limiting condition. The maximum deceleration of the vehicle combination is limited by the braking capacity of the vehicle combination. Since the vehicle combination should stop at the end position of the path, the speed must start to decrease some distance before the end position. The maximum deceleration is α.sub.max. The maximum speed of the vehicle combination, with respect to brake actuator limitations, is in this example limited to satisfy the deceleration limit. The maximum deceleration may be set either from the maximum brake capacity of the vehicle combination, or from the maximum deceleration allowed for a specific load. The maximum deceleration for a vehicle combination transporting a liquid, such as a petrol truck, may e.g. differ from the maximum deceleration allowed for a vehicle combination transporting concrete blocks. This maximum deceleration value can thus be used to set the maximum speed limit of the vehicle combination when reversing.

(24) The maximum deceleration can also be determined with regards to the comfort of the driver. Braking hard when reversing can be uncomfortable for the driver. Therefore, the maximum allowed deceleration can be set with respect not only to the actual braking capacity, but to the comfort of the driver. This comfort level of deceleration is most often lower than what the vehicle combination can deliver.

(25) It is also possible to limit the maximum speed of the vehicle combination when there are no physical bounds due to actuator limitation, in order to give the driver time to supervise the reversing action. It is therefore of advantage to set a fix maximum speed that may not be exceeded at any time of the manoeuvre, regardless of other conditions. Depending on the other conditions, this fixed maximum speed may be overridden by another lower determined speed limit, e.g. depending on the steering actuator rate.

(26) In another example, it is also possible to limit the speed in sharp turns, in order to limit the lateral forces experienced by the driver and/or imposed on the load. This maximum lateral acceleration is α.sub.lat,max. The simulation gives values for φ, δ and

(27) $\frac{\partial \delta }{\partial s}$
along the path. From this, the maximum speed v.sub.1(s) is given by the solution to the differential equation

(28) $a_{\mathrm{lat},\max }=\frac{\partial v_1}{\partial s}{v}_1\cos \varphi \left(1-\frac{C}{L_1}\tan \varphi \tan \delta \right)\tan \delta +v_1^2\left(\cos \varphi \left(1-\frac{C}{L_1}\tan \varphi \tan \delta \right)\frac{1}{{\cos }^2\delta }\frac{\partial \delta }{\partial s}+\frac{\tan \delta }{L_1}\right)$

(29) using the boundary condition v.sub.1(s.sub.final)=0, i.e. the vehicle is going to stop at the end of the path. In this example, it is assumed that the vehicle always stays on the path, which gives that

(30) $\frac{ds}{dt}=v_2.$

(31) In this way, a maximum speed limit for the vehicle can be determined during a reverse assistance manoeuvre. If the manoeuvre is relatively short or does not comprise any sharp turns, it may suffice with one maximum speed limit that is used for the complete manoeuvre. However, for longer manoeuvres, it is unpractical to use one maximum speed limit for the complete manoeuvre, since the maximum speed limit will be set by the lowest determined speed limit value. If e.g. a sharp turn is comprised, the maximum speed limit will be set by the speed through the sharp turn. Since this speed limit may be very low, it will be unpractical to use the same speed limit for reversing along a straight path.

(32) The manoeuvre may thus be divided in several sub-paths, where a maximum speed limit is determined for each sub-path. In this way, a maximum speed limit for a sharp turn is used to limit the speed through this sharp turn, and another speed limit is used to limit the speed when reversing along a straight path. For some sub-paths, the steering actuator rate may be the limiting condition, and for other sub-paths, the comfort of the driver may be the limiting condition. The different determined maximum speed limits make up a maximum speed profile for the manoeuvre.

(33) A sub-path may be defined and delimited in different ways. In one example, a sub-path is defined as a path segment in which the steering angle has the same sign. This means that when the steering wheels are directed in the same direction with regards to the centre line of the vehicle, a sub-path is defined. When the steering wheels changes direction, e.g. from turning right to turning left, a new sub-path is defined. In another example, a sub-path is defined by a predefined time interval. It is also possible to define a sub-path by a predefined distance value.

(34) It is also possible to assign a maximum speed value to each simulation point, such that a continuous maximum speed profile is obtained for the complete manoeuvre. This can be seen as using a very high number of sub-paths defined by the same time or distance interval length. By using a continuous speed profile for the complete manoeuvre, a high degree of comfort can be obtained. Further, the manoeuvre can be performed with the highest possible speed in a secure way.

(35) It is thus possible to determine a maximum speed limit or speed profile based on predefined limiting conditions of the vehicle, the vehicle combination and/or the driver. In addition to limiting the speed to these pre-calculated values, it is also possible to measure actual values during the actual reversing of the vehicle combination, e.g. to measure the actual steering actuator rate and the actual lateral acceleration during the manoeuvre. If the maximum values of the measured units, 5.sub.max and/or a.sub.latiTnax are exceeded, the speed can be dynamically decreased during the manoeuvre. In this way, the determined maximum speed limit can be overridden by the actual measured values, should e.g. the load on the vehicle combination cause the vehicle combination to behave in a different way than expected.

(36) FIG. 3 shows a schematic flow chart of the method for determining a maximum speed limit for a reversing vehicle combination comprising a towing vehicle and at least one towed trailer. The method is performed before the actual reversing of the vehicle combination is started.

(37) In step 100, a manoeuvre that is to be performed by the vehicle combination is determined. The manoeuvre may e.g. be selected from a list of stored manoeuvres previously performed by the vehicle combination or by another vehicle combination. It would also be possible to set an end point on a map and to obtain a suggested path between the present position and the end position.

(38) In step 110, the complete manoeuvre is simulated in advance by using a control algorithm and a state space model, such that the steering behaviour of the vehicle combination during the manoeuvre is obtained.

(39) In step 120, the maximum speed limit for the vehicle combination during the manoeuvre is calculated by using at least one predefined limiting condition of the vehicle, the vehicle combination or the driver. The limiting condition may be the properties of one or more actuators of the vehicle, such as the steering actuator or the brake actuators, allowed stress on the load or comfort properties of the driver.

(40) The complete manoeuvre may be divided in several sub-paths in order to determine different maximum speed limits for different parts of the path to be travelled. The method may thus be repeated for each sub-path.

(41) The invention is not to be regarded as being limited to the embodiments described above, a number of additional variants and modifications being possible within the scope of the subsequent patent claims.

REFERENCE SIGNS

(42) 1: Vehicle combination 2: Truck 3: Semitrailer 4: Fifth wheel 5: King pin 6: Tractor front axle 7: Tractor rear axle 8: Semitrailer rear axle 9: Semitrailer virtual rear axle