Perception model for trajectory following autonomous and human augmented speed control

• US 8,498,796 B2
• Filed: 02/12/2007
• Issued: 07/30/2013
• Est. Priority Date: 02/12/2007
• Status: Active Grant

• Current Assignee: Deere & Company
• Original Assignee: Deere & Company
• Inventors: Norris, William Robert, Romig, Bernard Edwin, Reid, John Franklin
• Primary Examiner(s): Black, Thomas
• Assistant Examiner(s): LOUIE, WAE LENNY
• Application Number:
  US11/673,648
• Publication Number:
  US 20080195293A1
• Time in Patent Office: 2,360 Days
• Field of Search: 701/98, 701/93, 180/197
• US Class Current: 701/98
• CPC Class Codes: B60W 2050/0057 Frequency analysis, spectral techniques or transforms
• CPC Class Codes: G05D 1/0223 involving speed control of the vehicle vehicle fittings for automatically controlling, i.e. preventing speed from exceeding an arbitrarily established velocity or maintaining speed at a particular velocity, as selected by the vehicle operator B60K31/00

Abstract

A speed control method of a vehicle including the steps of obtaining a steering angle, a velocity error and a distance error. The velocity and the distance error being determined by mathematical combinations of a GPS position, a required path and speed set points. The steering angle, velocity errors and distance error are applied to fuzzy logic membership functions to produce an output that is applied to a velocity rule base. An output from the velocity rule base is defuzzified to produce a speed signal.

Claims

1. A speed control method of a vehicle, the method comprising the steps of:

obtaining a steering angle;

obtaining a velocity error;

obtaining a distance error, said velocity error and said distance error being determined by mathematical combinations of a GPS position, a required path and speed set points;

applying said steering angle, said velocity error and said distance error to fuzzy logic membership functions to produce an output that is applied to a velocity rule base;

defuzzifying an output from said velocity rule base to produce a speed signal;

receiving said speed signal by a vehicle control unit; and

changing a speed of the vehicle by said vehicle control unit using said speed signal.

2. The method of claim 1, further comprising the step of changing set points dependent on said distance error.

3. The method of claim 1, further comprising the step of establishing a required path which serves as an input to said obtaining a distance error step.

4. The method of claim 3, wherein said establishing a required path step also serves as an input to said obtaining a velocity error step.

5. The method of claim 3, further comprising the step of establishing required vehicle speed set points as an input to said obtaining a distance error step.

6. The method of claim 5, wherein said establishing required vehicle speed set points step also serves as an input to said obtaining a velocity error step.

7. The method of claim 6, further comprising the step of obtaining at least one of an orientation, a location and a velocity to input to at least one of said obtaining a velocity error step and said obtaining a distance error step.

8. A speed control method of a vehicle, the method comprising the steps of:

applying a steering angle, a velocity error and a distance error to fuzzy logic membership functions to produce an output that is applied to a velocity rule base;

defuzzifying an output from said velocity rule base to produce a speed signal;

receiving said speed signal by a vehicle control unit; and

changing a speed of the vehicle by said vehicle control unit using said speed signal.

9. The method of claim 8, further comprising the step of changing set points dependent on said distance error.

10. The method of claim 8, further comprising the step of establishing a required path which serves as an input to obtain said distance error.

11. The method of claim 10, wherein said establishing a required path step also serves as an input to obtain said velocity error.

12. The method of claim 10, further comprising the step of establishing required vehicle speed set points as an input to obtain said distance error.

13. The method of claim 12, wherein said establishing required vehicle speed set points step also serves as an input to obtain said velocity error.

14. The method of claim 13, further comprising the step of obtaining at least one of an orientation, a location and a velocity which is used to obtain said velocity error and said distance error.

15. A vehicle, comprising:

a drive system;

a speed control system operatively connected to said drive system;

a steering angle sensor producing a steering angle signal;

a reference system producing a velocity signal and a distance signal, said speed control system applying said steering angle signal, said velocity signal and said distance signal to fuzzy logic membership functions to produce an output that is applied to a velocity rule base, said velocity rule base producing an output that is defuzzified to produce a speed signal that is supplied to said speed control system to control the speed of said drive system; and

changing a speed of the vehicle by controlling the speed of said drive system.

16. The vehicle of claim 15, wherein a path is established which serves as a reference for determining said distance signal.

17. The vehicle of claim 16, wherein said path also serves as an input to obtain said velocity signal.

18. The vehicle of claim 17, wherein at least one of an orientation, a location and a velocity of the vehicle is input to said reference system to obtain said velocity signal and said distance signal.