Curvature sensing and guidance control system for an agricultural vehicle

Patent metadata

Field	Value
Publication number	US-12372961-B2
Application number	US-202218058669-A
Country	US
Kind code	B2
Filing date	Nov 23, 2022
Priority date	Nov 24, 2021
Publication date	Jul 29, 2025
Grant date	Jul 29, 2025

Abstract

An autonomous vehicle control system includes one or more sensors configured for coupling with an agricultural vehicle, the one or more sensors configured to determine kinematics of the agricultural vehicle relative to a crop row. The system includes a guidance control module configured to coordinate steering of one or more steering mechanisms of the agricultural vehicle. The guidance control module includes a sensor input configured to receive kinematics of the agricultural vehicle, a vehicle kinematics comparator configured to determine one or more error values using the received vehicle kinematics, a crop curvature generator configured to determine crop row curvature using the one or more error values, and a steering interface configured to provide instructions to a vehicle steering controller to guide the agricultural vehicle using the crop row curvature.

First claim

What is claimed is:

1. A system for operating an agricultural vehicle, the system comprising:
one or more sensors configured for coupling with the agricultural vehicle, the one or more sensors configured to determine kinematics of the agricultural vehicle relative to a crop row; and
one or more processors configured to coordinate steering of one or more steering mechanisms of the agricultural vehicle to guide the agricultural vehicle, the one or more processors configured to:
receive determined kinematics of the agricultural vehicle from the one or more sensors;
determine a heading error (TKE) of the agricultural vehicle using the determined vehicle kinematics;
determine crop row curvature using the determined heading error (TKE);
provide instructions to guide the agricultural vehicle using the crop row curvature; and
automatically steer the agricultural vehicle based on the instructions.

2. The system of claim 1 , wherein the one or more processors are configured to determine a cross track error (XTE) of the agricultural vehicle, and the one or more processors are configured to determine the crop row curvature using the XTE of the agricultural vehicle.

3. The system of claim 2 , wherein the one or more processors are further configured to generate a projection bias of one or more of the TKE, the XTE, or the crop row curvature from a position of the one or more sensors to a control reference point of the agricultural vehicle.

4. The system of claim 3 , wherein the control reference point of the agricultural vehicle includes one of a front axle or a rear axle of the agricultural vehicle.

5. The system of claim 3 , wherein the projection bias is determined using an arc length between the position of the one or more sensors and the control reference point.

6. The system of claim 1 , wherein the kinematics include one or more of yaw rate or velocity of the agricultural vehicle, and the one or more sensors are configured to determine one or more of the yaw rate or velocity.

7. The system of claim 6 , wherein the one or more processors are configured to determine an estimate of a rate of change in heading error (TKE).

8. The system of claim 7 , wherein the one or more processors are configured to determine the crop row curvature by adding the yaw rate to the estimate of the rate of change in the heading error (TKE), and dividing by the velocity.

9. The system of claim 1 , wherein the one or more steering mechanisms include first and second steering mechanisms corresponding with front and rear axles of the agricultural vehicle.

10. The system of claim 1 , wherein the one or more sensors include one or more of optical, video, spectrometric, RGB (red-green-blue), thermographic, hyperspectral, ground penetrating radar, radar, LIDAR or ultrasound sensors.

11. A method of coordinating steering of one or more steering mechanisms of an agricultural vehicle, the method comprising:
receiving kinematics of the agricultural vehicle from one or more sensors configured for coupling with the agricultural vehicle;
determining a heading error (TKE) of the agricultural vehicle using the received vehicle kinematics;
determining crop row curvature using the determined heading error (TKE);
providing instructions to guide the agricultural vehicle using the crop row curvature; and
automatically steering the agricultural vehicle based on the instructions.

12. The method of claim 11 , wherein the vehicle kinematics include a yaw rate and a velocity of the agricultural vehicle, and receiving detected kinematics includes receiving one or more of yaw rate or velocity from the one or more sensors.

13. The method of claim 12 , wherein determining the crop row curvature includes determining an estimate of a rate of change in the heading error (TKE).

14. The method of claim 13 , wherein determining the crop row curvature includes adding the yaw rate to the estimate of the rate of change in the heading error (TKE), and dividing by the velocity.

15. The method of claim 13 , wherein determining the estimate of the rate of change in the heading error (TKE) includes taking a derivative of the heading error (TKE).

16. The method of claim 11 , wherein determining the crop row curvature further comprises:
filtering the crop row curvature using a time delay constant based on a distance between the one or more sensors and a control reference point of the agricultural vehicle.

17. The method of claim 11 , further comprising determining a curvature error, and wherein providing instructions includes using the curvature error and the crop row curvature.

18. The method of claim 11 , further comprising determining a position error and a curvature error, and wherein providing instructions includes using the heading error, the position error, the curvature error and the crop row curvature.

Assignees

• Raven Ind Inc

Inventors

• Rust Matthew K
• Rislov David Alan
• Mathews Jonathan Eugene

Classifications

• G05D1/2297

  positional data taught by the user, e.g. paths (G05D1/2295 takes precedence) · CPC title

• G05D1/646

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

• G05D1/247

  using signals provided by artificial sources external to the vehicle, e.g. navigation beacons · CPC title

• G06V20/56

  exterior to a vehicle by using sensors mounted on the vehicle · CPC title

• A01B69/008 Primary

  automatic · CPC title