Steering controller for an autonomous vehicle with stability regulation

Patent metadata

Field	Value
Publication number	US-11029690-B2
Application number	US-201916248830-A
Country	US
Kind code	B2
Filing date	Jan 16, 2019
Priority date	Jan 17, 2018
Publication date	Jun 8, 2021
Grant date	Jun 8, 2021

Abstract

A mobile machine including a chassis, a plurality of ground-engaging elements, 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 reference path. The controller is configured to implement a cascading control loop for controlling movement of the mobile machine, the cascading control loop including an outer loop and an inner loop. The outer loop is configured to determine a set heading for reducing a distance between the mobile machine and the reference path, the set heading being determined using an error slope parameter. The inner loop is configured to drive the actuators so that the mobile machine follows the set heading determined by the outer loop. The controller is configured to automatically adjust the error slope value so that the rate of change of the set heading does not exceed a maximum yaw rate.

First claim

Having thus described the preferred embodiment of the invention, what is claimed as new and desired to be protected by Letters Patent includes the following:

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 reference path, the controller configured to—
implement a cascading control loop for controlling movement of the mobile machine, the cascading control loop including—
an outer loop configured to determine a set heading for reducing a distance between the mobile machine and the reference path, the set heading being determined using an error slope parameter, the set heading causing the mobile machine to follow a path with varying radii of curvature, including a portion of the path with a smallest radius of curvature, and
an inner loop configured to drive the actuators so that the mobile machine follows the set heading determined by the outer loop, and

automatically adjust the error slope parameter so that the rate of change of the set heading does not exceed the mobile machine's maximum yaw rate and, after the mobile machine has traversed the portion of the path with the smallest radius of curvature, the set heading change is the lesser of the maximum error slope and the mobile machine's maximum yaw rate as the mobile machine approaches the reference path.

2. The mobile machine as set forth in claim 1 , the controller further configured to determine the set heading using only a heading reference value and a distance d of the mobile machine from the reference path.

3. The mobile machine as set forth in claim 2 , the controller further configured to determine the set heading by applying a hyperbolic tangent function to the product of the distance d and the error slope parameter.

4. The mobile machine as set forth in claim 1 , the error slope parameter determining an angle at which the mobile machine approaches the reference path and a turn radius of the mobile machine as it approaches the reference path.

5. The mobile machine as set forth in claim 1 , the controller configured to use a maximum yaw rate of the mobile machine and a current velocity of the mobile machine to automatically adjust the error slope value so that the rate of change of the set heading does not exceed the maximum yaw rate.

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

• B62D1/283

  for unmanned vehicles · CPC title

• A01B69/008

  automatic · CPC title