Automatic control method for the insertion and the extraction of a vehicle into and from a receiving station, and control device implementing a method of this kind

• US 9,933,785 B2
• Filed: 06/15/2016
• Issued: 04/03/2018
• Est. Priority Date: 07/03/2015
• Status: Active Grant

• Current Assignee: Commissariat a L'Energie Atomique (AES Corporation)
• Original Assignee: Commissariat a L'Energie Atomique (AES Corporation)
• Inventors: Lucet, Eric, Micaelli, Alain, Russotto, Franois-Xavier
• Primary Examiner(s): Holloway, Jason
• Application Number:
  US15/183,646
• Publication Number:
  US 20170003686A1
• Time in Patent Office: 657 Days
• CPC Class Codes: B60W 30/06 Automatic manoeuvring for parking
• CPC Class Codes: B62D 13/00 Steering specially adapted for trailers combined traction and steering hitches B60D
• CPC Class Codes: B62D 15/021 Determination of steering angle
• CPC Class Codes: B62D 15/0285 Parking performed automatically
• CPC Class Codes: G05D 1/0225 involving docking at a fixed facility, e.g. base station or loading bay parking aids B62D15/027

Abstract

A method comprises: a preliminary phase wherein a vehicle is aligned to be engaged toward a target position; a first phase wherein a reference trajectory is generated as a function of the status and target position of the vehicle, the status defined by the current position and orientation of the vehicle; a second phase wherein the reference trajectory being divided into sections, at the start of each section and before the vehicle begins a movement whether the reference trajectory can be followed is predicted as a function of imposed overall size constraints and estimated lateral and/or longitudinal slippages; a third phase, if the trajectory can be followed, wherein the turn angle of the wheels and the linear traction speed of the vehicle are controlled as a function of the status of the vehicle and the lateral and/or longitudinal slippages, to bring the centers of the wheels onto the reference trajectory.

Claims

1. An automatic control method for insertion of a vehicle into a receiving station and/or extraction from said station to a target position, said vehicle being subject to lateral and/or longitudinal slipping of front wheels and rear wheels during its movements, said method including the following phases:

a preliminary phase wherein said vehicle is aligned to be engaged toward said target position;

a first phase wherein a reference trajectory to be followed is generated with a vehicle control device as a function of a status of the vehicle and of the target position, said status being defined by a current position and an orientation of the vehicle;

a second phase wherein, said reference trajectory being divided into sections, at a start of each section and before the vehicle begins a movement, a determination of whether said reference trajectory can be followed is predicted with the vehicle control device as a function of imposed overall size constraints and estimated lateral and/or longitudinal slippages;

in a third phase, if said trajectory can be followed, a turn angle of said wheels and a linear traction speed of the vehicle are controlled with the vehicle control device as a function of the status of the vehicle and lateral and/or longitudinal slippages of the vehicle, to bring the centres of said wheels onto the reference trajectory; and

if the trajectory cannot be followed, a new alignment of the vehicle toward the target position is effected and a new reference trajectory is generated with the vehicle control device in accordance with the first phase.

2. The method according to claim 1, wherein a plurality of geographical zones are defined between an initial position of the vehicle and the target position in which said imposed constraints are increasingly severe as said receiving station is approached.

3. The method according to claim 1, wherein a control law for steering angles β

_f, β

_r of the front and rear wheels is obtained by a process of constrained optimization of a function in which a variable is a vector u composed of time-independent derivatives β

′

_f, β

′

_r with respect to distance of the turn angles.

4. The method according to claim 3, wherein said control law is based on a kinematic model of said vehicle taking account of a distance between an axis of the wheels and a steering axis at a front and at a rear of said vehicle.

5. The method according to claim 3, wherein the vector u is calculated for each section of said trajectory.

6. The method according to claim 3, wherein the constraints are a function of said imposed constraints depending on an overall size of said vehicle.

7. The method according to claim 1, wherein the status of said vehicle and the slippages are obtained by observation of variables independent of said trajectory, said variables being:

average rotation speeds ω

_f and ω

_r of the front and rear wheels;

steering angles of said front and rear wheels α

_f, α

_r;

derivatives with respect to time {dot over (α

)}_f, {dot over (α

)}_r of said steering angles; and

a position and an angle of a mobile frame of reference linked to said vehicle with respect to a fixed frame of reference.

8. The method according to claim 1, wherein the vehicle is a container transporter, the receiving station being configured for loading and unloading containers, said container transporter having elevation movements producing a distance between the axis of the wheels and a steering axis at the front and at the rear.

9. A vehicle control device for an automatic control of the insertion of a vehicle into a receiving station and/or extraction from said station to a target position, said vehicle being subject to lateral and/or longitudinal slipping of front wheels and rear wheels during these movements, said vehicle control device being implemented on board said vehicle and to be connected via appropriate interfaces at least to proprioceptive sensors, exteroceptive sensors and steering and traction motors of said vehicle, said vehicle control device including a computer implementing the following phases:

a preliminary phase wherein said vehicle is aligned to be engaged toward said target position;

a first phase wherein a reference trajectory to be followed is generated with the vehicle control device as a function of a status of the vehicle and of the target position, said status being defined by a current position and an orientation of the vehicle;

a second phase wherein, said reference trajectory being divided into sections, at a start of each section and before the vehicle begins a movement, a determination of whether said reference trajectory can be followed is predicted with the vehicle control device as a function of imposed overall size constraints and estimated lateral and/or longitudinal slippages;

in a third phase, if said trajectory can be followed, a turn angle of said wheels and a linear traction speed of the vehicle are controlled with the vehicle control device as a function of the status of the vehicle and lateral and/or longitudinal slippages of the vehicle, to bring the centres of said wheels onto the reference trajectory; and

if the trajectory cannot be followed, a new alignment of the vehicle toward the target position is effected and a new reference trajectory is generated with the vehicle control device in accordance with the first phase.

10. The vehicle control device according to claim 9, wherein a plurality of geographical zones are defined between an initial position of the vehicle and the target position in which said imposed constraints are increasingly severe as said receiving station is approached.

11. The vehicle control device according to claim 9, wherein a control law for steering angles β

_f, β

_r of the front and rear wheels is obtained by a process of constrained optimization of a function in which a variable is a vector u composed of time-independent derivatives β

′

_f, β

′

_r with respect to distance of the turn angles.

12. The vehicle control device according to claim 11, wherein said control law is based on a kinematic model of said vehicle taking account of a distance between an axis of the wheels and a steering axis at a front and at a rear of said vehicle.

13. The vehicle control device according to claim 11, wherein the vector u is calculated for each section of said trajectory.

14. The vehicle control device according to claim 11, wherein the constraints are a function of said imposed constraints depending on an overall size of said vehicle.

15. The vehicle control device according to claim 9, wherein the status of said vehicle and the slippages are obtained by observation of variables independent of said trajectory, said variables being:

average rotation speeds ω

_f and ω

_r of the front and rear wheels;

steering angles of said front and rear wheels α

_f, α

_r;

derivatives with respect to time {dot over (α

)}_f, {dot over (α

)}_r of said steering angles; and

a position and an angle of a mobile frame of reference linked to said vehicle with respect to a fixed frame of reference.

16. The vehicle control device according to claim 9, wherein the vehicle is a container transporter, the receiving station being configured for loading and unloading containers, said container transporter having elevation movements producing a distance between the axis of the wheels and a steering axis at the front and at the rear.