Steering controller for an autonomous vehicle with velocity regulation

Patent metadata

Field	Value
Publication number	US-11119488-B2
Application number	US-201916248826-A
Country	US
Kind code	B2
Filing date	Jan 16, 2019
Priority date	Jan 17, 2018
Publication date	Sep 14, 2021
Grant date	Sep 14, 2021

Abstract

A mobile machine including a chassis, a plurality of ground-engaging elements, a plurality of actuators for driving movement of the ground-engaging elements, and a controller for controlling each of the actuators to cause the mobile machine to follow a guidance path along a ground surface. The controller is configured to generate a first set of control values for driving the machine according to a first heading based on a reference heading error of the machine, generate a second set of control values for driving the machine according to a second heading based on a distance heading error of the machine, generate a current machine velocity using a prescribed machine velocity, the reference heading error, and the distance heading error, and generate control signals for driving the machine by combining the first set of control values, the second set of control values, and the current machine velocity.

First claim

The invention claimed is:

1. A mobile machine comprising:
a chassis;
a plurality of ground-engaging elements for supporting the chassis on a ground surface and propelling the chassis relative to the ground surface, each of the plurality of ground-engaging elements being at a fixed angle relative to the chassis;
a plurality of actuators for driving movement of the ground-engaging elements, each of the actuators being configured to drive movement of at least one of the ground-engaging elements independently of the other ground-engaging elements; and
a controller for controlling each of the actuators to cause the mobile machine to follow a guidance path along a ground surface, the controller configured to
receive a designated machine velocity,
generate a first set of control values for driving the machine according to a first heading based on a reference heading error of the machine,
generate a second set of control values for driving the machine according to a second heading based on a distance heading error of the machine,
generate a current machine velocity using the designated machine velocity, the reference heading error, the distance heading error, a distance to a next path turn, an angle of the next path turn and applying a hyperbolic tangent function to a term derived from the angle of the next path turn,
generate control signals for driving the machine by combining the first set of control values, the second set of control values, and the current machine velocity, and
use the control signals to control the actuators to thereby cause the machine to follow the guidance path at the current machine velocity.

2. The mobile machine of claim 1 , wherein the designated machine velocity is defined as a maximum machine velocity.

3. The mobile machine of claim 1 , the controller further configured to—
determine a weight scheme for the first set of control values and the second set of control values, the weight scheme depending on a distance error and giving greater weight to the set of control values with smaller distance errors and giving less weight to the set of control values with larger distance errors, the distance error being a distance between the machine's location and the guidance path, and
generate the control signals for driving the machine by combining the first set of control values and the second set of control values according to the weight scheme.

4. The mobile machine of claim 3 , the controller further configured to generate the current machine velocity using a steering error value, the steering error value being the result of the first set of control values and the second set of control values combined according to the weight scheme.

5. The mobile machine of claim 1 , the controller being further configured to—
apply a hyperbolic tangent function to a steering value derived from a steering error to generate a value of the hyperbolic tangent function, and
determine the current velocity of the mobile machine using the value of the hyperbolic tangent function.

6. The mobile machine of claim 5 , the steering value being defined as the product of a slope value and the difference between the steering error and an error threshold value.

7. The mobile machine according to claim 1 , the controller further configured to—
determine whether the angle of the next path turn exceeds a predetermined threshold, and
if the angle of the next path turn exceeds the predetermined threshold, generate the current machine velocity using the distance to the next path turn.

8. The mobile machine of claim 7 , the controller further configured to: begin decreasing the current machine velocity at a distance from the next path turn for a maximum designated velocity, and decreasing the current machine velocity at a decreased distance from the next path turn for a designated velocity less than the maximum designated velocity.

9. The mobile machine of claim 7 , the controller further configured to generate the current machine velocity by—
applying a hyperbolic tangent function to a term derived from the angle of the next path turn, and
applying a hyperbolic tangent function to a term that is directly proportional to the distance to the next path turn and inversely proportional to the designated velocity.

Assignees

• Agco Int Gmbh

Inventors

• Noess Christian

Classifications

• G05D1/646

  Following a predefined trajectory, e.g. a line marked on the floor or a flight path · CPC title

• G05D1/65

  Following a desired speed profile · CPC title

• G05D2101/10

  using artificial intelligence [AI] techniques · CPC title

• A01B69/008

  automatic · CPC title

• B62D1/283

  for unmanned vehicles · CPC title