WO2019038426A1 - A method for steering an articulated vehicle - Google Patents
A method for steering an articulated vehicle Download PDFInfo
- Publication number
- WO2019038426A1 WO2019038426A1 PCT/EP2018/072890 EP2018072890W WO2019038426A1 WO 2019038426 A1 WO2019038426 A1 WO 2019038426A1 EP 2018072890 W EP2018072890 W EP 2018072890W WO 2019038426 A1 WO2019038426 A1 WO 2019038426A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- trailer
- road
- relation
- tractor
- orientation
- Prior art date
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/025—Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D13/00—Steering specially adapted for trailers
Definitions
- the invention relates to a method for steering an articulated vehicle traveling on a road, the vehicle comprising a tractor and a trailer.
- the invention also relates to a computer program, a computer readable medium, a control unit, and a vehicle.
- the invention can be applied in heavy-duty vehicles, such as trucks. Although the invention will be described with respect to trucks, the invention is not restricted to this particular vehicle, but may also be used in other vehicles such as cars with trailers.
- BACKGROUND Driving a heavy articulated vehicle may be a challenging task. Difficulties may be caused by the vehicle size and weight, the vehicle dynamics in the longitudinal and lateral directions, and the possible safety impact in case of an accident.
- a problem with known driver assistance models is that the manoeuvrability and stability aspects of articulated vehicles are challenging, and low-speed and high speed
- EP2188168B1 relates to a method for supporting lane keeping of a vehicle. It suggests a predictor module estimating the future trajectory of a towing vehicle and a trailer relative to the lane using fused lane data and vehicle sensor data. This method requires a model based predictive control with repetitive calculations of trajectories, which in turn requires a high processing capacity of a control unit for the method.
- An object of the invention is to improve driver assistance functions or automatic driving in articulated vehicles. Another object of the invention is to reduce processing capacity requirements for driver assistance functions or automatic driving in articulated vehicles.
- the object is reached with a method according to claim 1 .
- the object is reached with a method for steering an articulated vehicle traveling on a road, the vehicle comprising a tractor and a trailer, the method comprising determining a position of the tractor in relation to the road, and adjusting the steering in dependence on the determined tractor position.
- the method further comprises determining an orientation of the trailer in relation to the road, and/or an angular velocity of the trailer in relation to the road, and adjusting the steering in dependence on the determined trailer orientation and/or the determined angular velocity.
- the word tractor refers to any vehicle which is adapted to pull a trailer.
- the tractor could be, for example, a truck, a lorry, or a road tractor, or even a car.
- the word trailer refers to any vehicle which is adapted to be pulled by a tractor.
- the orientation of the trailer in relation to the road may be the angle of the trailer in relation to the road. Determining the orientation of the trailer, in relation to the road, may involve determining a heading angle of the trailer, relative to the road. Thus, the orientation of the trailer may be the heading angle of the trailer. The heading angle of the trailer may be an angle of a longitudinal axis of the trailer.
- embodiments of the invention may comprise determining an orientation of the trailer in relation to the road, instead of an absolute orientation of the trailer, and adjusting the steering in dependence on the determined trailer orientation.
- embodiments of the invention may involve using, for steering adjustments, the angular velocity of the trailer in relation to the road, instead of an absolute angular velocity.
- Embodiments of the invention improve the tracking performance for both a tractor semi- trailer combination and an A-double combination.
- the invention may reduce the lateral distance offset of the rearmost vehicle axle.
- the invention allows for providing models which are tunable, in terms of simple and understandable parameters.
- the invention provides for providing driver assistance functions or automatic driving in articulated vehicles, without the need for predictive control. Instead, merely current values of the of input parameters for the method, such as the trailer orientation, and/or the trailer angular velocity, may be used. Thereby, merely momentary proportional regulation may be used. Thereby, the processing capacity requirements of control units for driver assistance functions or automatic driving in articulated vehicles may be reduced.
- determining the trailer orientation in relation to the road, and/or the trailer angular velocity in relation to the road comprises determining a direction of the road at the trailer.
- the road at the trailer may be understood as the road under the trailer, or in a vicinity of the trailer.
- the trailer orientation in relation to the road, and/or the trailer angular velocity in relation to the road may be determined in a simple manner.
- determining the trailer orientation in relation to the road comprises comparing the orientation of the trailer, and the direction of the road at the trailer.
- a control algorithm may be provided, which requires a particularly low computational capacity for the method.
- such a comparison may be done as a direct comparison.
- Such a direct comparison may be done without the use of a fixed coordinate system.
- an object sensor such as a trailer mounted camera, may be used for capturing images of the road and the trailer orientation in relation to the road may be determined by image analysis. The determination may then be done without the use of a fixed coordinate system.
- Embodiments of the invention may involve determining the direction of the road at the trailer in a fixed coordinate system. This may be done, for example, based on trailer position data, and map data. Thereby, the orientation of the trailer in relation to the fixed coordinate system may be determined.
- the trailer orientation in relation to the road may be determined by comparing the orientation of the trailer in the fixed coordinate system, and the direction of the road at the trailer in the fixed coordinate system.
- an accurate determination of the trailer orientation in relation to the road may be obtained, without any requirement for a relatively high computational capacity of a control unit carrying out the method.
- the orientation of the trailer, in relation to the road may be determined as an angular difference between the direction of the road at the trailer, in the fixed coordinate system, and the orientation of the trailer, in the fixed coordinate system.
- determining the trailer orientation in relation to the road, and/or the trailer angular velocity in relation to the road comprises determining a curvature of the road.
- the trailer angular velocity in relation to the road may be determined in a simple manner.
- embodiments of the invention may involve determining the curvature of the road in a fixed coordinate system.
- the method may involve determining the curvature of the road at the trailer.
- the angular velocity of the trailer, in relation to the fixed coordinate system may be determined.
- the trailer angular velocity in relation to the road may be determined by comparing the angular velocity of the trailer in the fixed coordinate system, and the curvature of the road at the trailer in the fixed coordinate system.
- determining the trailer angular velocity in relation to the road comprises comparing the angular velocity of the trailer, with a rate of change of the direction of the road at the trailer.
- the determination of the trailer angular velocity in relation to the road may comprise comparing the angular velocity of the trailer in a fixed coordinate system, with a rate of change of the direction of the road at the trailer in a fixed coordinate system.
- the rate of change of the direction of the road at the trailer may be determined based on the curvature of the road at the trailer and the velocity of the trailer. For example, the rate of change of the direction of the road may be determined by dividing the trailer velocity by the curvature, for example expressed as the radius of the road curvature.
- the trailer angular velocity in relation to the road allows for an accurate control of relatively fast events.
- the trailer angular velocity in relation to the road may be determined as an angular velocity difference between the rate of change of the direction of the road, and the yaw rate of the trailer.
- the trailer orientation in relation to the road, and/or the trailer angular velocity in relation to the road is determined based on signals from an object sensor mounted on the trailer.
- the object sensor is preferably arranged to detect spatial features externally of the trailer.
- the object sensor may be arranged to detect spatial features behind and/or laterally of the trailer.
- the object sensor may be a camera, and the signals may represent at least one image.
- the camera may face rearwards and/or sideways from the trailer.
- the trailer orientation in relation to the road, and/or the trailer angular velocity in relation to the road may be determined by analysing images from a sensor or camera facing rearwards and/or sideways.
- the trailer orientation in relation to the road, and/or the trailer angular velocity in relation to the road is determined based on signals from an object sensor mounted on the tractor.
- the trailer orientation in relation to the road, and/or the trailer angular velocity in relation to the road may be determined based also on signals from at least one articulation sensor, which articulation sensor signals represent a respective angle of at least one articulated joint between the tractor and the trailer.
- the object sensor may be arranged to detect spatial features externally of the tractor.
- the object sensor may be arranged to detect spatial features in front and/or laterally of the tractor.
- the object sensor may be a camera, and the signals may represent at least one image.
- the camera may face forwards and/or sideways from the tractor.
- road information may be obtained using a tractor mounted object sensor.
- One or more articulation sensors may be provided for registering the angle between vehicle parts.
- the tractor orientation in relation to a section of the road at the tractor may be determined. Such a determination may be based on signals from a tractor mounted object sensor.
- a point in time of the determination, of the tractor orientation in relation to the road section may be referred to as a first point in time.
- the trailer orientation in relation to the tractor, at the first point in time may be determined based on signals from the one or more articulation sensors. Based on the trailer orientation in relation to the tractor, and the tractor orientation in relation to the road section, the trailer orientation in relation to the road section at the first point in time may be determined.
- a subsequent point in time, at which the trailer passes the road section at which the tractor orientation in relation to the road section was determined, may be referred to as a second point in time.
- the change of the trailer orientation in relation to the road section, from the first point in time to the second point in time, may be determined by means of a yaw sensor in the trailer.
- the vehicle may comprise a plurality of trailers.
- determining the trailer orientation, and/or the trailer angular velocity may comprise determining the orientation, in relation to the road, of the rearmost trailer, and/or the angular velocity, in relation to the road, of the rearmost trailer.
- the demands on a vehicle driver, due to the nature of the vehicle, may be particularly high.
- determining a position of the tractor, in relation to the road comprises determining rates of change of angles between a movement direction of the tractor, and directions to near and far points ahead of the tractor.
- the method may be simple to implement and to adjust to a particular vehicle.
- determining a position of the tractor in relation to the road may in some embodiments comprise determining angles between a movement direction of the tractor, and directions to near and far points ahead of the tractor.
- the position of the tractor in relation to the road may comprise determining an angle, and/or a rate of change of an angle, between on one hand a movement direction of the tractor, and on the other hand a direction to a near point ahead of the tractor, and/or a direction to a far point ahead of the tractor.
- the near and far points may be at different distances ahead of the vehicle.
- the near and far points may represent a centre of a desired position on a road.
- the near and far points may be obtained by sensor measurements. Said centre may be calculated based on detected lane boundaries, and/or based on a position of a further vehicle in front said vehicle.
- the position of the tractor, in relation to the road may be determined in some other manner.
- the position of the tractor, in relation to the road may involve minimising a lateral acceleration, and lateral position and orientation errors between a previewed path of the tractor and an actual path of the tractor, e.g. as in X. Yang, S. Rakheja, and I. Stiharu, "Structure of the driver model for articulated vehicles", International Journal of Heavy Vehicle Systems 9.1 (2002), pp. 27-51 ,
- Fig. 1 is a side view of an articulated vehicle with a tractor and two trailers.
- Fig. 2 is a diagram schematically depicting the vehicle in fig. 1 , when travelling through a curve of a road, and indicating parameters used in a method according to an embodiment of the invention.
- Fig. 3 is a detail of fig. 2.
- Fig. 4 is a diagram depicting steps in said method.
- Fig. 5 shows a top view of the vehicle in fig. 1 , and a stretch of a road on which the vehicle is travelling.
- Fig. 6 is a diagram depicting steps in a method according to an alternative embodiment of the invention. DETAILED DESCRIPTION OF EXAMPLE EMBODIMENTS OF THE INVENTION
- Fig. 1 shows an articulated vehicle in the form of a so called A-double combination.
- the vehicle is herein also referred to as a subject vehicle.
- the vehicle comprises a tractor 101 in the form of a truck.
- the vehicle also comprises a forward trailer 102 and a rearmost trailer 103.
- the rearmost trailer 103 forms part of an A-frame drawbar trailer.
- the A-frame drawbar trailer comprises the rearmost trailer and a dolly 1031 .
- the dolly 1031 is connected to the forward trailer 102.
- the vehicle may comprise more than two trailers.
- the vehicle may comprise a single trailer, such as in a tractor semitrailer combination.
- the vehicle comprises a control unit 120.
- the control unit 120 is arranged to control a steering angle of two front wheels 101 1 of the tractor 101 .
- the control unit steering angle control may be effected by one or more actuators (not shown).
- the control unit 120 may be arranged to provide an automatic steering function of the vehicle 1.
- the tractor may comprise a steering wheel (not shown) arranged to be handled by a driver of the vehicle.
- the control unit 120 may be arranged to provide a supporting steering function of the vehicle 1.
- Such a supporting steering function may be arranged to adjust the steering control by the steering wheel.
- the vehicle is provided with a forward object sensor 12.
- the forward object sensor 121 mounted on the tractor 101 .
- the control unit 120 is arranged to receive signals from the forward object sensor.
- the forward object sensor 121 is arranged to detect spatial features in front of the tractor 101.
- the forward object sensor 121 is a camera.
- the object sensor could be any suitable kind of camera, e.g. a stereo camera.
- the object sensor may be a radar detector.
- the vehicle may be provided with a plurality of forward object sensors; e.g. one of the object sensors may be a camera, and another of the object sensors may be a radar detector.
- the vehicle is provided with two rearward object sensors 122.
- the rearward object sensors 122 are mounted on the rearmost trailer 103.
- the control unit 120 is arranged to receive signals from the rearward object sensors.
- the rearward object sensors 121 are arranged to detect spatial features laterally of the rearmost trailer 103. In this
- the rearward object sensors 121 are formed by two cameras 122.
- the cameras are directed in opposite lateral directions.
- the vehicle is provided with a yaw rate sensor 123.
- the yaw rate sensor 123 is mounted on the rearmost trailer 103.
- the control unit 120 is arranged to receive signals from the yaw rate sensor.
- the yaw rate sensor 123 is arranged to detect yaw movements, i.e. rotations around a substantially vertical axis of the rearmost trailer 103.
- the method may be used e.g. for lane maintaining manoeuvring, lane changes, roadway entrance and exit, ramps, and overtaking. Below, and example involving lane maintaining manoeuvring is described.
- the method includes determining S1 a line representing the lane centre LC.
- the lane centre LC is indicated with a broken line in fig. 2.
- the lane centre is determined as the vehicle moves.
- the lane centre may be determined and updated as the vehicle moves.
- the lane centre LC is determined based at least partly on signals from the forward object sensor 121 .
- a determination may include identifying lane edges LEL, LER.
- Lane edges LEL, LER, indicated in fig. 2 may be identified e.g. based on image data of the forward object sensor in the form of the camera.
- Such an identification may include identifying painted lines on the road, curbs, and/or grass or gravel, which indicate lane edges.
- the lane centre LC may be determined partly based on one or more predetermined road design features.
- the road design features may be stored accessible to the control unit 120.
- the road design features may represent geographical entities based on which the road is designed.
- the road design features may for example be a straight line, a circular arc, and/or a clothoid.
- a clothoid is a spiral whose curvature is a linear function of the distance travelled along the spiral.
- a road design feature of a stretch of a road on which the vehicle is travelling may be identified based on signals from the forward object sensor 121.
- a parameter of a road design feature may be determined based on signals from the forward object sensor 121. For example, where a road design feature of a stretch of a road, on which the vehicle is travelling, is assumed to be a circular arc, the radius of the arc may be determined based on signals from the forward object sensor 121.
- the method comprises determining S2 a position of the tractor 101 in relation to the road. This determination comprises determining rates of changes of angles On, Of between a movement direction TM of the tractor 101 , and directions sn, sf to near and far points n, f ahead of the tractor 101 , indicated in fig. 2.
- the absolute positions of the near point n and far point f are assumed to be located on the lane centre LC.
- the absolute positions of the near point n and far point f are assumed to be located at the distances sn and sf from the subject vehicle front axle position s1f.
- the near and far points n, f are ahead of the front axle position s1f.
- the near and far points n, f may be located at respective intersection of boundaries of near and far visual fields with the lane centre LC.
- the distances sn, sf from the subject vehicle front axle position s1f to the near and far points may be constant for both straight-line and curved paths.
- the far point f may be located by projecting a tangent line from the subject vehicle front axle position s1f to an inside edge of the lane, the intersection of the tangent line with the lane centre LC being considered as the far point f, similarly to as suggested said PhD thesis.
- the rates of changes of the angles ⁇ , Of between the movement direction TM of the tractor 101 , and the directions sn, sf to the near and far points n, f are herein also referred to as angular velocities ⁇ ' ⁇ , Of of the directions sn, sf to the near and far points n, f.
- angular velocity Of of the direction to the far point sf is provided.
- a calculation of the angular velocity ⁇ ' ⁇ of the direction to the near point sn may be similar.
- ⁇ ⁇ - ⁇ (2)
- eslf and enlf are unit vectors
- ⁇ 1 is the yaw angle of the tractor 101 , relative to the road.
- s1f and dlf are the velocities of the subject vehicle front axle, in the road coordinate frame (s1f; n1f; b1f).
- the centre o of the road coordinate frame is on the lane centre LC, and moves along with the vehicle.
- FR1f and ⁇ 1 are the angular velocity of the road at the subject vehicle front axle position s1f, and the angular velocity of the tractor 101 , respectively, dlf is the subject vehicle front axle position perpendicular to the road tangent, f/o' and rf/o' are the velocity and position of the far point f in the moving coordinate frame.
- equation (4) may be simplified.
- ⁇ sf ⁇ ch (6)
- ch the horizontal curvature of the road.
- vyvlf and vxvlf are velocity components of the vehicle front axle, along the lane centre LC and transverse to the lane centre LC, respectively.
- rate of change of the angle 9f between the tractor movement direction TM, and the direction sf to the far point f As mentioned, the rate of change On of the angle ⁇ between the tractor movement direction TM, and the direction sn to the near point n may be determined in a similar manner.
- the position of the tractor 101 in relation to the road is represented by the angle ⁇ between the tractor movement direction TM, and the direction sn to the near point n, and the determined rates of changes Of, Bn of the angles ⁇ , 9f between the tractor movement direction TM, and the directions sn, sf to the near and far points n, f.
- the method comprises determining S3 an orientation Or, indicated in fig. 2, of the rearmost trailer 1 03, in relation to the road.
- the method comprises determining an angular velocity of the rearmost trailer 1 03 in relation to the road.
- Determining the trailer orientation Or in relation to the road, and the trailer angular velocity in relation to the road comprises determining the yaw angle ⁇ 4 and the yaw rate ⁇ 4 of the rearmost trailer, illustrated in fig. 2.
- the yaw angle ⁇ 4 and the yaw rate ⁇ 4 of the rearmost trailer may be determined based on signals from the yaw rate sensor 223 in the rearmost trailer.
- the yaw angle ⁇ 4 and the yaw rate ⁇ 4 of the rearmost trailer may be determined based on signals from a yaw rate sensor in the tractor 1 01 , and based on signals from articulation sensors in articulated joints connecting the rearmost trailer 1 03 to the dolly 1 031 , the dolly 1 031 to the forward trailer 1 02, and the forward trailer 1 02 to the tractor 1 01 .
- Determining the trailer orientation Or in relation to the road, and the trailer angular velocity in relation to the road ⁇ 'R4r' - ⁇ 4 comprises determining a direction ( R4r' of the road at the trailer 1 03.
- the angle of the road ⁇ ', at a rear point r, in relation to a fixed coordinate system, and the rate of change R4r' of the angle of the road ( R4r' in relation to the fixed coordinate system, are determined.
- the rear point r is determined, by means of the rear object sensor, to be positioned on an inner edge LEL of the lane, and to move along with the vehicle.
- the orientation Or of the rearmost trailer 1 03, in relation to the road is determined as
- the steering angle ⁇ , indicated in fig. 2, of the tractor front wheels 101 1 are adjusted based on the position of the tractor 101 in relation to the road Of, ⁇ ' ⁇ , ⁇ , as well as the orientation Or of the rearmost trailer 103 in relation to the road, and the angular velocity 0r of the rearmost trailer 103 in relation to the road.
- a desired rate of change ⁇ of the steering angle ⁇ is determined S4 as
- Or is an error which provides, with an increasing size, an increased desired rate of change ⁇ of the steering angle.
- 0r is an error which provides, with an increasing size, an increased desired rate of change ⁇ of the steering angle.
- either the orientation Or of the trailer in relation to the road, or the angular velocity Br of the trailer in relation to the road may be determined.
- the desired steering angle change rate ⁇ may be used in a fully automatic steering function.
- the desired steering angle change rate may be used for correcting manual steering actions by a driver of the vehicle.
- an automatic steering function may override the manual steering actions.
- the orientation Or of the rearmost trailer 103 in relation to the road, and the angular velocity Br of the rearmost trailer 103 in relation to the road may be determined based on a determined curvature of the road.
- embodiments of the invention have been described as used for maintaining the vehicle in a lane of a road. As suggested, the invention may also be applicable to other types of driving situations. For example, embodiment of the invention may be used to assist a vehicle driver in a lane changing manoeuvre, or to automatically perform such a manoeuvre.
- the method described above 5 with reference to fig. 1 - fig. 4 may include identifying boundaries LEL, LEL2 of a lane, adjacent to a lane in which the vehicle is travelling. Such an identification may be done based, at least partly, on signals from the forward object sensor 121 , (fig. 1 ). The identification may include identifying lane edges of the adjacent lane. Lane edges may be identified e.g. based on image data of the camera formed by the forward object sensor. 10 The method may include determining a line representing the centre LC2 of the adjacent lane. The actual track of the vehicle front axle during the lane change is in fig. 5 indicated with the broken lime DP.
- the method may comprise determining, during the lane change, a position of the tractor 15 101 in relation to the centre LC2 of the adjacent lane. This determination may comprise determining rates of changes of angles between a movement direction of the tractor, and directions to a near point n and a far point f ahead of the tractor. The absolute positions of the near point n and far point f may be assumed to be located on the centre LC2 of the adjacent lane.
- the method may advantageously comprise determining, during the lane change, an orientation of the rearmost trailer 103 in relation to the road, and determining an angular velocity of the rearmost trailer 103 in relation to the road. Such determinations may involve determining an orientation of the rearmost trailer 103 in relation to the road.
- the yaw angle and the yaw rate of the rearmost trailer are determined, e.g. based on signals from a yaw rate sensor in the rearmost trailer. Further, a direction of the road at the trailer 103 is determined.
- the angle of the road, at a rear point r, in relation to a fixed coordinate 30 system, and the rate of change of the angle of the road in relation to the fixed coordinate system are determined.
- the rear point r is determined, by means of a rear object sensor (not shown), mounted to the trailer, to be positioned on one of the boundaries LEL2 of the adjacent lane, and to move along with the vehicle.
- the orientation of the rearmost trailer 103, in relation to the road is determined based on the determined yaw angle of the rearmost trailer, and on the determined direction of the road at the trailer 103, similarly to what has been described above with reference to fig. 2.
- the angular velocity of the rearmost trailer 103 in relation to the road is determined based on the determined yaw rate of the rearmost trailer, and on the determined rate of change of the angle of the road in relation to the fixed coordinate system, similarly to what has been described above with reference to fig. 2.
- Fig. 6 depicts steps in a method according to a further embodiment of the invention.
- the method provides for steering an articulated vehicle traveling on a road.
- the articulated vehicle could be of any kind, e.g. as described above with reference to fig. 1 .
- the vehicle comprises a tractor and a trailer.
- the method comprises determining S2 a position of the tractor 101 in relation to the road.
- the method also comprises determining S3 an orientation of the trailer in relation to the road, and/or an angular velocity of the trailer in relation to the road.
- the steering of the articulated vehicle is adjusted S5 in dependence on the determined tractor position, and in dependence on the determined trailer orientation and/or the determined angular velocity.
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
The invention involves a method for steering an articulated vehicle traveling on a road, the vehicle comprising a tractor (101) and a trailer (102, 103), the method comprising determining (S2) a position (θn, θf) of the tractor (101) in relation to the road, and adjusting (S5) the steering in dependence on the determined tractor position. The method further comprises determining (S3) an orientation of the trailer (102, 103) in relation to the road (θr), and/or an angular velocity of the trailer (102, 103) in relation to the road (r), and adjusting (S5) the steering in dependence on the determined trailer orientation and/or the determined angular velocity.
Description
A METHOD FOR STEERING AN ARTICULATED VEHICLE
TECHNICAL FIELD The invention relates to a method for steering an articulated vehicle traveling on a road, the vehicle comprising a tractor and a trailer. The invention also relates to a computer program, a computer readable medium, a control unit, and a vehicle.
The invention can be applied in heavy-duty vehicles, such as trucks. Although the invention will be described with respect to trucks, the invention is not restricted to this particular vehicle, but may also be used in other vehicles such as cars with trailers.
BACKGROUND Driving a heavy articulated vehicle may be a challenging task. Difficulties may be caused by the vehicle size and weight, the vehicle dynamics in the longitudinal and lateral directions, and the possible safety impact in case of an accident.
It is known to provide models, to be stored accessible to vehicle control units, which may assist drivers or provide automatic driving of vehicles. "Steering control characteristics of human driver coupled with an articulated commercial vehicle", S. Taheri, PhD thesis, Concordia University, 2014, presents a two-stage preview model including a path preview function, using near and far points to manage central lane position and vehicle orientation. The model also includes vehicle orientation and lateral position error, and additional vehicle states. The additional vehicle states are lateral accelerations and yaw rates of the tractor and semi-trailer units, and the articulation angle rate.
A problem with known driver assistance models is that the manoeuvrability and stability aspects of articulated vehicles are challenging, and low-speed and high speed
manoeuvring often require different gain factors to achieve good overall performance. Further, the inventors have found that a two-stage preview model resulted in the lateral distance offset of the rearmost vehicle unit being unacceptably large in low speed cornering.
EP2188168B1 relates to a method for supporting lane keeping of a vehicle. It suggests a predictor module estimating the future trajectory of a towing vehicle and a trailer relative to the lane using fused lane data and vehicle sensor data. This method requires a model based predictive control with repetitive calculations of trajectories, which in turn requires a high processing capacity of a control unit for the method.
SUMMARY
An object of the invention is to improve driver assistance functions or automatic driving in articulated vehicles. Another object of the invention is to reduce processing capacity requirements for driver assistance functions or automatic driving in articulated vehicles.
The objects are reached with a method according to claim 1 . Thus, the object is reached with a method for steering an articulated vehicle traveling on a road, the vehicle comprising a tractor and a trailer, the method comprising determining a position of the tractor in relation to the road, and adjusting the steering in dependence on the determined tractor position.
The method further comprises determining an orientation of the trailer in relation to the road, and/or an angular velocity of the trailer in relation to the road, and adjusting the steering in dependence on the determined trailer orientation and/or the determined angular velocity.
It should be noted that herein, the word tractor refers to any vehicle which is adapted to pull a trailer. The tractor could be, for example, a truck, a lorry, or a road tractor, or even a car. Further, herein the word trailer refers to any vehicle which is adapted to be pulled by a tractor. The trailer could be, for example, a semi-trailer with or without a dolly, a full- trailer, an A-frame drawbar trailer, or even a travel trailer. Determining the position of the tractor in relation to the road may comprise determining the orientation and/or the location of the tractor in relation to the road.
The orientation of the trailer in relation to the road may be the angle of the trailer in relation to the road. Determining the orientation of the trailer, in relation to the road, may involve determining a heading angle of the trailer, relative to the road. Thus, the
orientation of the trailer may be the heading angle of the trailer. The heading angle of the trailer may be an angle of a longitudinal axis of the trailer.
Thus, embodiments of the invention may comprise determining an orientation of the trailer in relation to the road, instead of an absolute orientation of the trailer, and adjusting the steering in dependence on the determined trailer orientation. Alternatively, or additionally, embodiments of the invention may involve using, for steering adjustments, the angular velocity of the trailer in relation to the road, instead of an absolute angular velocity.
Embodiments of the invention improve the tracking performance for both a tractor semi- trailer combination and an A-double combination. In case of low speed manoeuvring, at 10-50km/h, the invention may reduce the lateral distance offset of the rearmost vehicle axle. Also, the invention allows for providing models which are tunable, in terms of simple and understandable parameters. The invention provides for providing driver assistance functions or automatic driving in articulated vehicles, without the need for predictive control. Instead, merely current values of the of input parameters for the method, such as the trailer orientation, and/or the trailer angular velocity, may be used. Thereby, merely momentary proportional regulation may be used. Thereby, the processing capacity requirements of control units for driver assistance functions or automatic driving in articulated vehicles may be reduced.
Preferably, determining the trailer orientation in relation to the road, and/or the trailer angular velocity in relation to the road, comprises determining a direction of the road at the trailer. The road at the trailer may be understood as the road under the trailer, or in a vicinity of the trailer. Thereby, the trailer orientation in relation to the road, and/or the trailer angular velocity in relation to the road, may be determined in a simple manner.
Preferably, determining the trailer orientation in relation to the road comprises comparing the orientation of the trailer, and the direction of the road at the trailer. Thereby, a control algorithm may be provided, which requires a particularly low computational capacity for the method. In some embodiments, such a comparison may be done as a direct comparison. Such a direct comparison may be done without the use of a fixed coordinate system. For example, an object sensor, such as a trailer mounted camera, may be used for capturing images of the road and the trailer orientation in relation to the road may be
determined by image analysis. The determination may then be done without the use of a fixed coordinate system.
Embodiments of the invention may involve determining the direction of the road at the trailer in a fixed coordinate system. This may be done, for example, based on trailer position data, and map data. Thereby, the orientation of the trailer in relation to the fixed coordinate system may be determined. Thus, the trailer orientation in relation to the road may be determined by comparing the orientation of the trailer in the fixed coordinate system, and the direction of the road at the trailer in the fixed coordinate system. Thereby, an accurate determination of the trailer orientation in relation to the road may be obtained, without any requirement for a relatively high computational capacity of a control unit carrying out the method. For example, the orientation of the trailer, in relation to the road, may be determined as an angular difference between the direction of the road at the trailer, in the fixed coordinate system, and the orientation of the trailer, in the fixed coordinate system.
In some embodiments, determining the trailer orientation in relation to the road, and/or the trailer angular velocity in relation to the road, comprises determining a curvature of the road. Thereby, the trailer angular velocity in relation to the road may be determined in a simple manner. For example, embodiments of the invention may involve determining the curvature of the road in a fixed coordinate system. The method may involve determining the curvature of the road at the trailer. Thereby, the angular velocity of the trailer, in relation to the fixed coordinate system, may be determined. Thus, the trailer angular velocity in relation to the road may be determined by comparing the angular velocity of the trailer in the fixed coordinate system, and the curvature of the road at the trailer in the fixed coordinate system.
Preferably, determining the trailer angular velocity in relation to the road comprises comparing the angular velocity of the trailer, with a rate of change of the direction of the road at the trailer. The determination of the trailer angular velocity in relation to the road may comprise comparing the angular velocity of the trailer in a fixed coordinate system, with a rate of change of the direction of the road at the trailer in a fixed coordinate system. The rate of change of the direction of the road at the trailer may be determined based on the curvature of the road at the trailer and the velocity of the trailer. For example, the rate of change of the direction of the road may be determined by dividing the trailer velocity by
the curvature, for example expressed as the radius of the road curvature. Determining the trailer angular velocity in relation to the road allows for an accurate control of relatively fast events. For example, the trailer angular velocity in relation to the road may be determined as an angular velocity difference between the rate of change of the direction of the road, and the yaw rate of the trailer.
Preferably, the trailer orientation in relation to the road, and/or the trailer angular velocity in relation to the road, is determined based on signals from an object sensor mounted on the trailer. The object sensor is preferably arranged to detect spatial features externally of the trailer. For example, the object sensor may be arranged to detect spatial features behind and/or laterally of the trailer. The object sensor may be a camera, and the signals may represent at least one image. The camera may face rearwards and/or sideways from the trailer. Thus, the trailer orientation in relation to the road, and/or the trailer angular velocity in relation to the road, may be determined by analysing images from a sensor or camera facing rearwards and/or sideways.
In some embodiments, the trailer orientation in relation to the road, and/or the trailer angular velocity in relation to the road, is determined based on signals from an object sensor mounted on the tractor. Thereby, the trailer orientation in relation to the road, and/or the trailer angular velocity in relation to the road, may be determined based also on signals from at least one articulation sensor, which articulation sensor signals represent a respective angle of at least one articulated joint between the tractor and the trailer. The object sensor may be arranged to detect spatial features externally of the tractor. For example, the object sensor may be arranged to detect spatial features in front and/or laterally of the tractor. The object sensor may be a camera, and the signals may represent at least one image. The camera may face forwards and/or sideways from the tractor. In such embodiments, road information may be obtained using a tractor mounted object sensor. One or more articulation sensors may be provided for registering the angle between vehicle parts.
In some embodiments, the tractor orientation in relation to a section of the road at the tractor may be determined. Such a determination may be based on signals from a tractor
mounted object sensor. In an example, a point in time of the determination, of the tractor orientation in relation to the road section, may be referred to as a first point in time. The trailer orientation in relation to the tractor, at the first point in time, may be determined based on signals from the one or more articulation sensors. Based on the trailer orientation in relation to the tractor, and the tractor orientation in relation to the road section, the trailer orientation in relation to the road section at the first point in time may be determined. A subsequent point in time, at which the trailer passes the road section at which the tractor orientation in relation to the road section was determined, may be referred to as a second point in time. The change of the trailer orientation in relation to the road section, from the first point in time to the second point in time, may be determined by means of a yaw sensor in the trailer.
The vehicle may comprise a plurality of trailers. Thereby, determining the trailer orientation, and/or the trailer angular velocity, may comprise determining the orientation, in relation to the road, of the rearmost trailer, and/or the angular velocity, in relation to the road, of the rearmost trailer. Thereby, embodiments of the invention may be
advantageously used in applications where the vehicle comprises a plurality of trailers. In such applications, the demands on a vehicle driver, due to the nature of the vehicle, may be particularly high.
Preferably, determining a position of the tractor, in relation to the road, comprises determining rates of change of angles between a movement direction of the tractor, and directions to near and far points ahead of the tractor. Thereby, the method may be simple to implement and to adjust to a particular vehicle. It should be noted that determining a position of the tractor in relation to the road may in some embodiments comprise determining angles between a movement direction of the tractor, and directions to near and far points ahead of the tractor. In some embodiments, the position of the tractor in relation to the road may comprise determining an angle, and/or a rate of change of an angle, between on one hand a movement direction of the tractor, and on the other hand a direction to a near point ahead of the tractor, and/or a direction to a far point ahead of the tractor.
The near and far points may be at different distances ahead of the vehicle. The near and far points may represent a centre of a desired position on a road. The near and far points may be obtained by sensor measurements. Said centre may be calculated based on
detected lane boundaries, and/or based on a position of a further vehicle in front said vehicle.
It should be noted that the position of the tractor, in relation to the road, may be determined in some other manner. For example, the position of the tractor, in relation to the road, may involve minimising a lateral acceleration, and lateral position and orientation errors between a previewed path of the tractor and an actual path of the tractor, e.g. as in X. Yang, S. Rakheja, and I. Stiharu, "Structure of the driver model for articulated vehicles", International Journal of Heavy Vehicle Systems 9.1 (2002), pp. 27-51 ,
"Adapting an articulated vehicle to its drivers", Transactions-American Society of
Mechanical Engineers Journal of Mechanical Design 123.1 (2001 ), pp. 132-140, and "Study of control characteristics of an articulated vehicle driver", International Journal of Heavy Vehicle Systems 4.2-4 (1997), pp. 373-397. The objects are also reached with a computer program according to claim 15, a computer readable medium according to claim 16, a control unit according to claim 17, or a vehicle according to claim 18.
Further advantages and advantageous features of the invention are disclosed in the following description and in the dependent claims.
BRIEF DESCRIPTION OF THE DRAWINGS
With reference to the appended drawings, below follows a more detailed description of embodiments of the invention cited as examples.
In the drawings:
Fig. 1 is a side view of an articulated vehicle with a tractor and two trailers.
Fig. 2 is a diagram schematically depicting the vehicle in fig. 1 , when travelling through a curve of a road, and indicating parameters used in a method according to an embodiment of the invention.
Fig. 3 is a detail of fig. 2.
Fig. 4 is a diagram depicting steps in said method.
Fig. 5 shows a top view of the vehicle in fig. 1 , and a stretch of a road on which the vehicle is travelling.
Fig. 6 is a diagram depicting steps in a method according to an alternative embodiment of the invention. DETAILED DESCRIPTION OF EXAMPLE EMBODIMENTS OF THE INVENTION
Fig. 1 shows an articulated vehicle in the form of a so called A-double combination. The vehicle is herein also referred to as a subject vehicle. The vehicle comprises a tractor 101 in the form of a truck. The vehicle also comprises a forward trailer 102 and a rearmost trailer 103. The rearmost trailer 103 forms part of an A-frame drawbar trailer. The A-frame drawbar trailer comprises the rearmost trailer and a dolly 1031 . The dolly 1031 is connected to the forward trailer 102.
It should be noted that the invention is applicable to a variety of alternative articulated vehicles. Thus, the vehicle may comprise more than two trailers. Alternatively, the vehicle may comprise a single trailer, such as in a tractor semitrailer combination.
The vehicle comprises a control unit 120. The control unit 120 is arranged to control a steering angle of two front wheels 101 1 of the tractor 101 . The control unit steering angle control may be effected by one or more actuators (not shown). The control unit 120 may be arranged to provide an automatic steering function of the vehicle 1. The tractor may comprise a steering wheel (not shown) arranged to be handled by a driver of the vehicle. Thereby, the control unit 120 may be arranged to provide a supporting steering function of the vehicle 1. Such a supporting steering function may be arranged to adjust the steering control by the steering wheel.
The vehicle is provided with a forward object sensor 12. The forward object sensor 121 mounted on the tractor 101 . The control unit 120 is arranged to receive signals from the forward object sensor. The forward object sensor 121 is arranged to detect spatial features in front of the tractor 101. In this embodiment, the forward object sensor 121 is a
camera. The object sensor could be any suitable kind of camera, e.g. a stereo camera. In some embodiments, the object sensor may be a radar detector. In some embodiments, the vehicle may be provided with a plurality of forward object sensors; e.g. one of the object sensors may be a camera, and another of the object sensors may be a radar detector.
The vehicle is provided with two rearward object sensors 122. The rearward object sensors 122 are mounted on the rearmost trailer 103. The control unit 120 is arranged to receive signals from the rearward object sensors. The rearward object sensors 121 are arranged to detect spatial features laterally of the rearmost trailer 103. In this
embodiment, the rearward object sensors 121 are formed by two cameras 122. The cameras are directed in opposite lateral directions.
The vehicle is provided with a yaw rate sensor 123. The yaw rate sensor 123 is mounted on the rearmost trailer 103. The control unit 120 is arranged to receive signals from the yaw rate sensor. The yaw rate sensor 123 is arranged to detect yaw movements, i.e. rotations around a substantially vertical axis of the rearmost trailer 103.
Below, a method of steering the articulated vehicle, when traveling on a road, is described with reference to fig. 2 - fig. 4. The method may be used e.g. for lane maintaining manoeuvring, lane changes, roadway entrance and exit, ramps, and overtaking. Below, and example involving lane maintaining manoeuvring is described.
The method includes determining S1 a line representing the lane centre LC. The lane centre LC is indicated with a broken line in fig. 2. The lane centre is determined as the vehicle moves. The lane centre may be determined and updated as the vehicle moves.
The lane centre LC is determined based at least partly on signals from the forward object sensor 121 . Such a determination may include identifying lane edges LEL, LER. Lane edges LEL, LER, indicated in fig. 2, may be identified e.g. based on image data of the forward object sensor in the form of the camera. Such an identification may include identifying painted lines on the road, curbs, and/or grass or gravel, which indicate lane edges.
The lane centre LC may be determined partly based on one or more predetermined road design features. The road design features may be stored accessible to the control unit
120. The road design features may represent geographical entities based on which the road is designed. The road design features may for example be a straight line, a circular arc, and/or a clothoid. A clothoid is a spiral whose curvature is a linear function of the distance travelled along the spiral.
A road design feature of a stretch of a road on which the vehicle is travelling may be identified based on signals from the forward object sensor 121. A parameter of a road design feature may be determined based on signals from the forward object sensor 121. For example, where a road design feature of a stretch of a road, on which the vehicle is travelling, is assumed to be a circular arc, the radius of the arc may be determined based on signals from the forward object sensor 121.
The method comprises determining S2 a position of the tractor 101 in relation to the road. This determination comprises determining rates of changes of angles On, Of between a movement direction TM of the tractor 101 , and directions sn, sf to near and far points n, f ahead of the tractor 101 , indicated in fig. 2.
The absolute positions of the near point n and far point f are assumed to be located on the lane centre LC. The absolute positions of the near point n and far point f are assumed to be located at the distances sn and sf from the subject vehicle front axle position s1f. The near and far points n, f are ahead of the front axle position s1f.
Similarly to as suggested in pages 125-128 in said PhD thesis "Steering control characteristics of human driver coupled with an articulated commercial vehicle", (S.
Taheri), for a straight-line road segment, the near and far points n, f may be located at respective intersection of boundaries of near and far visual fields with the lane centre LC.
For a given forward speed, the distances sn, sf from the subject vehicle front axle position s1f to the near and far points may be constant for both straight-line and curved paths.
Alternatively, in curved paths the far point f may be located by projecting a tangent line from the subject vehicle front axle position s1f to an inside edge of the lane, the intersection of the tangent line with the lane centre LC being considered as the far point f, similarly to as suggested said PhD thesis.
The rates of changes of the angles θη, Of between the movement direction TM of the tractor 101 , and the directions sn, sf to the near and far points n, f are herein also referred to as angular velocities β'η, Of of the directions sn, sf to the near and far points n, f. Below, an example of a calculation of the angular velocity Of of the direction to the far point sf is provided. A calculation of the angular velocity θ'η of the direction to the near point sn may be similar.
The absolute velocity sf of the far point f can be described with a vector vf as vf = (sf ■ cos(0f + Ψ1 - ΔΨΡίί))■ eslf - (sf ■ sin(0f + Ψ1 - ΔΨΡίί))■ enlf (1 )
ΔΨΡίί = ΨΡίί - ΨΡΜί (2) where eslf and enlf are unit vectors, and Rtf and are the road angles at the subject vehicle front axle position s1f and the far point position f, respectively. Ψ1 is the yaw angle of the tractor 101 , relative to the road.
The absolute velocity of point f may be described in the moving coordinate frame (s1f; n1f; b1f) as vf = ((s1f - WR lf ■ d lf)■ cos(0f + Ψ1 ) + dlf ■ sin(0f + Ψ1 ) + f/o')■ eslf +
(-(slf - ^filf - d lf)■ sin(0f + Ψ1 ) + dlf ■ cos(0f + Ψ1 ) + {9f + Ψ1)- rf/o')■ enlf (3) where s1f and dlf are the velocities of the subject vehicle front axle, in the road coordinate frame (s1f; n1f; b1f). The centre o of the road coordinate frame is on the lane centre LC, and moves along with the vehicle. *FR1f and Ψ1 are the angular velocity of the road at the subject vehicle front axle position s1f, and the angular velocity of the tractor 101 , respectively, dlf is the subject vehicle front axle position perpendicular to the road tangent, f/o' and rf/o' are the velocity and position of the far point f in the moving coordinate frame.
By combining (1 )-(3), the velocity rf/o' of point f and the angular velocity Of of the direction sf to the far point f can be described as
Of = (-if ■ sin(9f + Ψ1 - ΔΨΡίί) + (i1f - ¥Rlf ■ dlf)■ sin(9f + Ψ1 )) / rf/o'
- d1f cos(9f + Ψ1 ) / η7ο' - f l (4) rf/o' if ■ COS(9f + Ψ1 ΔΨΡίί) - ((i1f - ■ dlf)■ cos
- d1f sin(9f + Ψ1 ) (5)
In some embodiments, equation (4) may be simplified. By assuming a circular road section and equal velocities if, i lf of the far point f and the subject vehicle front axle s1f, the length of the vector rf/o', indicating the position of the far point f in the moving coordinate frame, becomes constant. Thereby, ΔΨΡίί = sf ■ ch (6) where ch is the horizontal curvature of the road. Assuming 9f, Ψ1 and ΔΨ ί are small angles, and ignoring products of vehicle states (vyvlf ■ Ψ1 and d1f ■ Ψ1 ), equation (4) can be written as
Of = (-vyvlf - vxvlf ■ (Ψ1 + sf ■ ch)) / rf/o' - Ψ1 (7) vyvlf and vxvlf are velocity components of the vehicle front axle, along the lane centre LC and transverse to the lane centre LC, respectively. Of represents the rate of change of the angle 9f between the tractor movement direction TM, and the direction sf to the far point f. As mentioned, the rate of change On of the angle θη between the tractor movement direction TM, and the direction sn to the near point n may be determined in a similar manner. In this embodiment, the position of the tractor 101 in relation to the road is represented by the angle θη between the tractor movement direction TM, and the direction sn to the near point n, and the determined rates of changes Of, Bn of the angles θη, 9f between the tractor movement direction TM, and the directions sn, sf to the near and far points n, f.
The method comprises determining S3 an orientation Or, indicated in fig. 2, of the rearmost trailer 1 03, in relation to the road. The method comprises determining an angular velocity of the rearmost trailer 1 03 in relation to the road. Determining the trailer orientation Or in relation to the road, and the trailer angular velocity in relation to the road, comprises determining the yaw angle Ψ4 and the yaw rate Ψ4 of the rearmost trailer, illustrated in fig. 2. The yaw angle Ψ4 and the yaw rate Ψ4 of the rearmost trailer may be determined based on signals from the yaw rate sensor 223 in the rearmost trailer.
Alternatively, the yaw angle Ψ4 and the yaw rate Ψ4 of the rearmost trailer may be determined based on signals from a yaw rate sensor in the tractor 1 01 , and based on signals from articulation sensors in articulated joints connecting the rearmost trailer 1 03 to the dolly 1 031 , the dolly 1 031 to the forward trailer 1 02, and the forward trailer 1 02 to the tractor 1 01 .
Determining the trailer orientation Or in relation to the road, and the trailer angular velocity in relation to the road ¥'R4r' - Ψ4, comprises determining a direction ( R4r' of the road at the trailer 1 03. As illustrated in fig. 2, the angle of the road ΨΡΜΓ', at a rear point r, in relation to a fixed coordinate system, and the rate of change R4r' of the angle of the road ( R4r' in relation to the fixed coordinate system, are determined. The rear point r is determined, by means of the rear object sensor, to be positioned on an inner edge LEL of the lane, and to move along with the vehicle. The orientation Or of the rearmost trailer 1 03, in relation to the road, is determined as
Or = H>R4r' - Ψ4 (8)
The angular velocity of the rearmost trailer 1 03 in relation to the road is determined as 8r = R4r' - Ψ4 (9)
The steering angle δ, indicated in fig. 2, of the tractor front wheels 101 1 are adjusted based on the position of the tractor 101 in relation to the road Of, θ'η, θη, as well as the orientation Or of the rearmost trailer 103 in relation to the road, and the angular velocity 0r of the rearmost trailer 103 in relation to the road. In this embodiment, a desired rate of change δ of the steering angle δ is determined S4 as
(5 = kf ■ (if + kn ■ θ'η + knl ■ On + kr■ i?r + krl ■ Or (10) where kf, kn, knl , kr and krl are gain factors.
Thus, Or is an error which provides, with an increasing size, an increased desired rate of change δ of the steering angle. 0r is an error which provides, with an increasing size, an increased desired rate of change δ of the steering angle. Thereby, the steering is adjusted
S5 in dependence on the determined trailer orientation and/or angular velocity. In some embodiments, either the orientation Or of the trailer in relation to the road, or the angular velocity Br of the trailer in relation to the road may be determined.
The desired steering angle change rate δ may be used in a fully automatic steering function. Alternatively, the desired steering angle change rate may be used for correcting manual steering actions by a driver of the vehicle. For example, when the actual steering angle change rate, provided as a result of the driver's manual steering actions, differ from the desired steering angle change rate δ by more than a threshold differentiation, an automatic steering function may override the manual steering actions. In some embodiments, the orientation Or of the rearmost trailer 103 in relation to the road, and the angular velocity Br of the rearmost trailer 103 in relation to the road may be determined based on a determined curvature of the road.
Above, embodiments of the invention have been described as used for maintaining the vehicle in a lane of a road. As suggested, the invention may also be applicable to other types of driving situations. For example, embodiment of the invention may be used to
assist a vehicle driver in a lane changing manoeuvre, or to automatically perform such a manoeuvre.
Reference is made to fig. 5. For a lane changing manoeuvre, the method described above 5 with reference to fig. 1 - fig. 4 may include identifying boundaries LEL, LEL2 of a lane, adjacent to a lane in which the vehicle is travelling. Such an identification may be done based, at least partly, on signals from the forward object sensor 121 , (fig. 1 ). The identification may include identifying lane edges of the adjacent lane. Lane edges may be identified e.g. based on image data of the camera formed by the forward object sensor. 10 The method may include determining a line representing the centre LC2 of the adjacent lane. The actual track of the vehicle front axle during the lane change is in fig. 5 indicated with the broken lime DP.
The method may comprise determining, during the lane change, a position of the tractor 15 101 in relation to the centre LC2 of the adjacent lane. This determination may comprise determining rates of changes of angles between a movement direction of the tractor, and directions to a near point n and a far point f ahead of the tractor. The absolute positions of the near point n and far point f may be assumed to be located on the centre LC2 of the adjacent lane.
20
The method may advantageously comprise determining, during the lane change, an orientation of the rearmost trailer 103 in relation to the road, and determining an angular velocity of the rearmost trailer 103 in relation to the road. Such determinations may involve determining an orientation of the rearmost trailer 103 in relation to the road.
25 Thereby, similarly to what has been described above, the yaw angle and the yaw rate of the rearmost trailer are determined, e.g. based on signals from a yaw rate sensor in the rearmost trailer. Further, a direction of the road at the trailer 103 is determined.
In this example, the angle of the road, at a rear point r, in relation to a fixed coordinate 30 system, and the rate of change of the angle of the road in relation to the fixed coordinate system, are determined. The rear point r is determined, by means of a rear object sensor (not shown), mounted to the trailer, to be positioned on one of the boundaries LEL2 of the adjacent lane, and to move along with the vehicle.
The orientation of the rearmost trailer 103, in relation to the road, is determined based on the determined yaw angle of the rearmost trailer, and on the determined direction of the road at the trailer 103, similarly to what has been described above with reference to fig. 2. The angular velocity of the rearmost trailer 103 in relation to the road is determined based on the determined yaw rate of the rearmost trailer, and on the determined rate of change of the angle of the road in relation to the fixed coordinate system, similarly to what has been described above with reference to fig. 2.
Fig. 6 depicts steps in a method according to a further embodiment of the invention. The method provides for steering an articulated vehicle traveling on a road. The articulated vehicle could be of any kind, e.g. as described above with reference to fig. 1 . The vehicle comprises a tractor and a trailer. The method comprises determining S2 a position of the tractor 101 in relation to the road. The method also comprises determining S3 an orientation of the trailer in relation to the road, and/or an angular velocity of the trailer in relation to the road. The steering of the articulated vehicle is adjusted S5 in dependence on the determined tractor position, and in dependence on the determined trailer orientation and/or the determined angular velocity.
It is to be understood that the present invention is not limited to the embodiments described above and illustrated in the drawings; rather, the skilled person will recognize that many changes and modifications may be made within the scope of the appended claims.
Claims
1 . A method for steering an articulated vehicle traveling on a road, the vehicle
comprising a tractor (101 ) and a trailer (102, 103), the method comprising determining (S2) a position (On, Of) of the tractor (101 ) in relation to the road, and adjusting (S5) the steering in dependence on the determined tractor position, characterised by determining (S3) an orientation of the trailer (102, 103) in relation to the road (Or), and/or an angular velocity of the trailer (102, 103) in relation to the road (0r), and adjusting (S5) the steering in dependence on the determined trailer orientation and/or the determined angular velocity.
A method according to claim 1 , characterised in that determining the trailer orientation in relation to the road (Or), and/or the trailer angular velocity in relation to the road ($r), comprises determining a direction (Ψ ΡΜΓ') of the road at the trailer
(102, 103).
A method according to any one of the preceding claims, characterised in that determining the trailer orientation in relation to the road (Or) comprises comparing the orientation of the trailer, and the direction of the road at the trailer.
A method according to any one of the preceding claims, characterised in that determining the trailer orientation in relation to the road (Or) comprises comparing the orientation of the trailer in a fixed coordinate system, and the direction of the road at the trailer in a fixed coordinate system.
A method according to any one of the preceding claims, characterised in that determining the trailer orientation in relation to the road (Or), and/or the trailer angular velocity in relation to the road (0r), comprises determining a curvature of the road.
A method according to any one of the preceding claims, characterised in that determining the trailer angular velocity in relation to the road comprises comparing the angular velocity of the trailer, with a rate of change of the direction of the road at the trailer.
7. A method according to any one of the preceding claims, characterised in that the trailer orientation in relation to the road (Or), and/or the trailer angular velocity in relation to the road (i5r), is determined based on signals from an object sensor mounted on the trailer (102, 103).
8. A method according to claim 7, characterised in that the object sensor is arranged to detect spatial features externally of the trailer (102, 103).
9. A method according to any one of claims 7-8, characterised in that the object sensor is a camera, and the signals represent at least one image.
10. A method according to any one of the preceding claims, characterised in that the trailer orientation in relation to the road (Or), and/or the trailer angular velocity in relation to the road (0r), is determined based on signals from an object sensor mounted on the tractor (101 ), and based on signals from at least one articulation sensor, which articulation sensor signals represent a respective angle of at least one articulated joint between the tractor (101 ) and the trailer (102, 103).
1 1 . A method according to claim 10, characterised in that the object sensor is
arranged to detect spatial features externally of the tractor (101 ).
12. A method according to any one of claims 10-1 1 , characterised in that the object sensor is a camera, and the signals represent at least one image.
13. A method according to any one of the preceding claims, characterised in that the vehicle comprises a plurality of trailers (102, 103), and determining the trailer orientation and/or the trailer angular velocity comprises determining the orientation in relation to the road (Or) of the rearmost trailer (103), and/or the angular velocity in relation to the road (f r) of the rearmost trailer (103).
14. A method according to any one of the preceding claims, characterised in that determining a position of the tractor (101 ) in relation to the road comprises determining rates of changes of angles (On, Of) between a movement direction
(TM) of the tractor (101 ), and directions to near and far points (n, f) ahead of the tractor (101 ).
15. A computer program comprising program code means for performing the steps of any of claims 1 -14 when said program is run on a computer.
16. A computer readable medium carrying a computer program comprising program code means for performing the steps of any of claims 1 -14 when said program product is run on a computer.
17. A control unit configured to perform the steps of the method according to any of claims 1 -14.
18. A vehicle comprising a control unit according to claim 17.
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US16/633,405 US11840275B2 (en) | 2017-08-25 | 2018-08-24 | Method for steering an articulated vehicle |
CN201880054075.4A CN111032492B (en) | 2017-08-25 | 2018-08-24 | Method for steering an articulated vehicle |
EP18756251.7A EP3672860B1 (en) | 2017-08-25 | 2018-08-24 | A method for steering an articulated vehicle |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/EP2017/071443 WO2019037870A1 (en) | 2017-08-25 | 2017-08-25 | A method for steering an articulated vehicle |
EPPCT/EP2017/071443 | 2017-08-25 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2019038426A1 true WO2019038426A1 (en) | 2019-02-28 |
Family
ID=59738343
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/EP2017/071443 WO2019037870A1 (en) | 2017-08-25 | 2017-08-25 | A method for steering an articulated vehicle |
PCT/EP2018/072890 WO2019038426A1 (en) | 2017-08-25 | 2018-08-24 | A method for steering an articulated vehicle |
Family Applications Before (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/EP2017/071443 WO2019037870A1 (en) | 2017-08-25 | 2017-08-25 | A method for steering an articulated vehicle |
Country Status (4)
Country | Link |
---|---|
US (1) | US11840275B2 (en) |
EP (1) | EP3672860B1 (en) |
CN (1) | CN111032492B (en) |
WO (2) | WO2019037870A1 (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110308724A (en) * | 2019-07-01 | 2019-10-08 | 百度在线网络技术(北京)有限公司 | Automatic Pilot control method, device, vehicle, storage medium and electronic equipment |
CN111016898A (en) * | 2019-11-14 | 2020-04-17 | 安徽卡思普智能科技有限公司 | Intelligent vehicle track lane change planning method |
US11447374B2 (en) | 2016-09-15 | 2022-09-20 | Terex Australia Pty Ltd | Crane counterweight and suspension |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110262509B (en) * | 2019-07-10 | 2022-06-28 | 百度在线网络技术(北京)有限公司 | Automatic vehicle driving method and device |
US11980125B2 (en) * | 2020-12-18 | 2024-05-14 | Deere & Company | Position detectors for steering systems of agricultural header transport systems |
CN113147897B (en) * | 2021-05-24 | 2022-08-23 | 清华大学 | Method and system for controlling superposition of automobile and train tracks |
KR102444675B1 (en) * | 2021-06-24 | 2022-09-20 | (주)뷰런테크놀로지 | Apparatus and method for predicting lane-change of surrounding objects |
CN113696969B (en) * | 2021-09-02 | 2022-07-26 | 浙江吉利控股集团有限公司 | Vehicle steering control method and system and vehicle |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090236823A1 (en) * | 2006-05-08 | 2009-09-24 | Mechanical System Dynamics Pty Ltd | Operation of Self-Steering Axles on Semi-Trailers |
EP2188168A1 (en) * | 2007-08-15 | 2010-05-26 | Volvo Technology Corporation | Operating method and system for supporting lane keeping of a vehicle |
US20120029782A1 (en) * | 2009-02-02 | 2012-02-02 | Toyota Jidosha Kabushiki Kaisha | Behavior control device for a combination vehicle |
US20140303847A1 (en) * | 2013-02-04 | 2014-10-09 | Ford Global Technologies, Llc | Object avoidance for a trailer backup assist system |
Family Cites Families (40)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20020107627A1 (en) * | 2000-11-29 | 2002-08-08 | Visteon Global Technologies, Inc. | Trailer and simulator |
US6668225B2 (en) * | 2000-11-29 | 2003-12-23 | Visteon Global Technologies, Inc. | Trailer control system |
US6679181B2 (en) * | 2001-05-24 | 2004-01-20 | Richard B. Fox | Dual mode transportation system and method |
FR2834495B1 (en) * | 2002-01-10 | 2004-06-18 | Kuhn Nodet Sa | PROCESS FOR PLACING THE WHEELS OF A TRAILER IN THE WAKE OF THE WHEELS OF A TRACTOR MACHINE, AND DEVICE FOR IMPLEMENTING THIS PROCESS |
US20080208424A1 (en) * | 2007-02-22 | 2008-08-28 | Honeywell International Inc. | Electronic protection for articulated vehicles |
US8170739B2 (en) * | 2008-06-20 | 2012-05-01 | GM Global Technology Operations LLC | Path generation algorithm for automated lane centering and lane changing control system |
US8650004B2 (en) * | 2008-11-26 | 2014-02-11 | Transoft Solutions, Inc. | Method and apparatus for displaying a representation of a traffic intersection |
US8665078B2 (en) * | 2011-07-25 | 2014-03-04 | Ford Global Technologies | Width calibration of lane departure warning system |
US9373044B2 (en) * | 2011-07-25 | 2016-06-21 | Ford Global Technologies, Llc | Trailer lane departure warning system |
BR112014010411A2 (en) * | 2011-10-31 | 2017-04-18 | Volvo Lastvagnar Ab | method and arrangement for vehicle stabilization |
US9187117B2 (en) * | 2012-01-17 | 2015-11-17 | Ford Global Technologies, Llc | Autonomous lane control system |
SE537900C2 (en) | 2012-03-07 | 2015-11-17 | Scania Cv Ab | Procedure and system for determining vehicle position |
JP5432312B2 (en) * | 2012-03-30 | 2014-03-05 | 日信工業株式会社 | Motion stabilization device for articulated vehicles |
KR102047280B1 (en) * | 2012-09-27 | 2019-11-21 | 한국전자통신연구원 | Lane tracking apparatus using camera direction control and method thereof |
JP6036198B2 (en) * | 2012-11-13 | 2016-11-30 | 株式会社デンソー | Driving support device and driving support system |
US9081385B1 (en) * | 2012-12-21 | 2015-07-14 | Google Inc. | Lane boundary detection using images |
JP6069148B2 (en) * | 2013-09-19 | 2017-02-01 | 日立オートモティブシステムズ株式会社 | Vehicle control device |
US9120359B2 (en) * | 2013-12-13 | 2015-09-01 | Honda Motor Co., Ltd. | Method and system for stability control |
DE102015102889A1 (en) | 2014-03-03 | 2015-09-03 | Ford Global Technologies, Llc | Trailer lane departure warning system |
US10446021B2 (en) * | 2014-07-25 | 2019-10-15 | Moasis Inc. | Onboard traffic and pedestrian warning systems and methods having optical and audio signal feedback and control |
US9499197B2 (en) * | 2014-10-15 | 2016-11-22 | Hua-Chuang Automobile Information Technical Center Co., Ltd. | System and method for vehicle steering control |
KR102270287B1 (en) * | 2014-11-19 | 2021-06-29 | 현대모비스 주식회사 | System and Method for Lane Keep Asistance |
KR101724887B1 (en) * | 2015-08-10 | 2017-04-07 | 현대자동차주식회사 | Autonomous Driving Control Apparatus and Method for Determining Lane Change and Timing thereof Based on Analysis for Shapes and Links of Forward Road |
DE102015215802B4 (en) * | 2015-08-19 | 2024-06-06 | Zf Friedrichshafen Ag | Stabilization of a vehicle combination |
US9527528B1 (en) * | 2015-09-04 | 2016-12-27 | Continental Automotive Systems, Inc. | Trailer radius indication |
US20170183035A1 (en) * | 2015-12-29 | 2017-06-29 | Microsoft Technology Licensing, Llc | Dynamic lane shift |
CN107082071A (en) | 2016-02-15 | 2017-08-22 | 宝马股份公司 | For preventing the unexpected method and servicing unit for leaving runway |
US9849878B2 (en) * | 2016-02-26 | 2017-12-26 | GM Global Technology Operations LLC | System and method for providing a corrected lane following path through a curve for trailering vehicles |
US9849911B2 (en) * | 2016-02-26 | 2017-12-26 | GM Global Technology Operations LLC | Enhanced vehicle lateral control (lane following/lane keeping/lane changing control) for trailering vehicles |
NL2016753B1 (en) * | 2016-05-10 | 2017-11-16 | Daf Trucks Nv | Platooning method for application in heavy trucks |
US10259390B2 (en) * | 2016-05-27 | 2019-04-16 | GM Global Technology Operations LLC | Systems and methods for towing vehicle and trailer with surround view imaging devices |
US20170349213A1 (en) * | 2016-06-02 | 2017-12-07 | GM Global Technology Operations LLC | System And Method For Displaying A Forward Drive Trajectory, Providing A Jackknifing Warning And Providing A Trailer Turn Aid |
CN106354160B (en) | 2016-09-20 | 2019-01-29 | 济南大学 | A kind of deflection control method when n section tractor-trailer mobile robot counter motion |
KR101859045B1 (en) * | 2016-11-02 | 2018-05-17 | 엘지전자 주식회사 | Apparatus for providing around view and Vehicle |
US10252593B2 (en) * | 2016-12-02 | 2019-04-09 | Toyota Motor Engineering & Manufacturing North America, Inc. | Vehicle attitude modification |
US10994729B2 (en) * | 2017-03-29 | 2021-05-04 | Mitsubishi Electric Research Laboratories, Inc. | System and method for controlling lateral motion of vehicle |
DE102017109731A1 (en) * | 2017-05-05 | 2018-11-08 | Konecranes Global Corporation | Method and system for operating an automatically guided transport vehicle for containers |
DE102017113469A1 (en) * | 2017-06-20 | 2018-12-20 | Valeo Schalter Und Sensoren Gmbh | Method for operating a parking assistance device of a motor vehicle with combined view of transparent trailer and environment |
JP7133298B2 (en) * | 2017-08-10 | 2022-09-08 | 株式会社小松製作所 | Transportation vehicle control system and transportation vehicle management method |
US11048251B2 (en) * | 2017-08-16 | 2021-06-29 | Uatc, Llc | Configuring motion planning for a self-driving tractor unit |
-
2017
- 2017-08-25 WO PCT/EP2017/071443 patent/WO2019037870A1/en active Application Filing
-
2018
- 2018-08-24 EP EP18756251.7A patent/EP3672860B1/en active Active
- 2018-08-24 US US16/633,405 patent/US11840275B2/en active Active
- 2018-08-24 WO PCT/EP2018/072890 patent/WO2019038426A1/en active Search and Examination
- 2018-08-24 CN CN201880054075.4A patent/CN111032492B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090236823A1 (en) * | 2006-05-08 | 2009-09-24 | Mechanical System Dynamics Pty Ltd | Operation of Self-Steering Axles on Semi-Trailers |
EP2188168A1 (en) * | 2007-08-15 | 2010-05-26 | Volvo Technology Corporation | Operating method and system for supporting lane keeping of a vehicle |
EP2188168B1 (en) | 2007-08-15 | 2012-08-01 | Volvo Technology Corporation | Operating method and system for supporting lane keeping of a vehicle |
US20120029782A1 (en) * | 2009-02-02 | 2012-02-02 | Toyota Jidosha Kabushiki Kaisha | Behavior control device for a combination vehicle |
US20140303847A1 (en) * | 2013-02-04 | 2014-10-09 | Ford Global Technologies, Llc | Object avoidance for a trailer backup assist system |
Non-Patent Citations (5)
Title |
---|
"International Journal of Heavy Vehicle Systems", vol. 4.2-4, 1997, article "Study of control characteristics of an articulated vehicle driver", pages: 373 - 397 |
"Transactions-American Society of Mechanical Engineers Journal of Mechanical Design", vol. 123.1, 2001, article "Adapting an articulated vehicle to its drivers", pages: 132 - 140 |
S. TAHERI: "PhD thesis", 2014, CONCORDIA UNIVERSITY, article "Steering control characteristics of human driver coupled with an articulated commercial vehicle" |
S. TAHERI: "Steering control characteristics of human driver coupled with an articulated commercial vehicle", PHD THESIS, pages 125 - 128 |
X. YANG, S. RAKHEJA; I. STIHARU: "Structure of the driver model for articulated vehicles", INTERNATIONAL JOURNAL OF HEAVY VEHICLE SYSTEMS, vol. 9.1, 2002, pages 27 - 51 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11447374B2 (en) | 2016-09-15 | 2022-09-20 | Terex Australia Pty Ltd | Crane counterweight and suspension |
CN110308724A (en) * | 2019-07-01 | 2019-10-08 | 百度在线网络技术(北京)有限公司 | Automatic Pilot control method, device, vehicle, storage medium and electronic equipment |
EP3760518A1 (en) * | 2019-07-01 | 2021-01-06 | Baidu Online Network Technology (Beijing) Co., Ltd. | Method and device for autonomous driving control, vehicle, storage medium and electronic device |
CN110308724B (en) * | 2019-07-01 | 2022-06-03 | 阿波罗智能技术(北京)有限公司 | Automatic driving control method, automatic driving control device, vehicle, storage medium and electronic equipment |
US11524702B2 (en) | 2019-07-01 | 2022-12-13 | Apollo Intelligent Driving Technology (Beijing) Co., Ltd. | Method and device for autonomous driving control, vehicle, storage medium and electronic device |
CN111016898A (en) * | 2019-11-14 | 2020-04-17 | 安徽卡思普智能科技有限公司 | Intelligent vehicle track lane change planning method |
CN111016898B (en) * | 2019-11-14 | 2021-10-19 | 安徽卡思普智能科技有限公司 | Intelligent vehicle track lane change planning method |
Also Published As
Publication number | Publication date |
---|---|
CN111032492B (en) | 2022-07-08 |
US11840275B2 (en) | 2023-12-12 |
WO2019037870A1 (en) | 2019-02-28 |
US20210155289A1 (en) | 2021-05-27 |
EP3672860B1 (en) | 2022-09-21 |
EP3672860A1 (en) | 2020-07-01 |
CN111032492A (en) | 2020-04-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11840275B2 (en) | Method for steering an articulated vehicle | |
JP7124117B2 (en) | Trailer detection and autonomous hitching | |
US12054149B2 (en) | Vision-based follow the leader lateral controller | |
EP3678109B1 (en) | Position correction method for driving-assist vehicle and position error correction device | |
US10850770B2 (en) | Device and a method for reversing an articulated vehicle combination | |
US20210078634A1 (en) | Vehicular trailering assist system | |
EP3016835B1 (en) | Vehicle control system | |
CN112805208B (en) | Automatic reverse by following a user selected trajectory and estimating vehicle motion | |
US10752289B2 (en) | Control system for steering a towing vehicle with a trailer | |
Fritz et al. | CHAUFFEUR Assistant: a driver assistance system for commercial vehicles based on fusion of advanced ACC and lane keeping | |
WO2014174027A1 (en) | Vehicle hitch assistance system | |
CN115113191A (en) | Tracking different parts of an articulated vehicle | |
CN116062032A (en) | Driver assistance system for a heavy vehicle with overhang | |
JP2024520376A (en) | An adaptive path following algorithm for large vehicles. | |
CN115129053A (en) | Airport traction transport vehicle and automatic driving system thereof | |
LeBlanc et al. | A warning and intervention system to prevent road-departure accidents | |
EP3932779B1 (en) | A method for guiding a vehicle | |
EP4389541A1 (en) | Parking route generation device | |
JP2023536468A (en) | A long-term visual trailer tracker for vehicle-trailer angle estimation | |
CN117755331A (en) | Vehicle-mounted HUD-based large truck turning follow-up visual induction method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 18756251 Country of ref document: EP Kind code of ref document: A1 |
|
DPE1 | Request for preliminary examination filed after expiration of 19th month from priority date (pct application filed from 20040101) | ||
NENP | Non-entry into the national phase |
Ref country code: DE |
|
ENP | Entry into the national phase |
Ref document number: 2018756251 Country of ref document: EP Effective date: 20200325 |