Vehicular guidance system having compensation for variations in ground elevation

• US 7,844,380 B2
• Filed: 08/17/2009
• Issued: 11/30/2010
• Est. Priority Date: 10/30/2003
• Status: Expired due to Term

• Current Assignee: Deere & Company
• Original Assignee: Deere & Company
• Inventors: Reid, John Franklin, Han, Shufeng, Pickett, Terence Daniel
• Primary Examiner(s): Hellner; Mark
• Assistant Examiner(s): Diacou; Ari M
• Application Number:
  US12/542,333
• Publication Number:
  US 20090292412A1
• Time in Patent Office: 470 Days
• Field of Search: 701/50, 701/210
• US Class Current: 701/50
• CPC Class Codes: A01B 69/008 automatic
• CPC Class Codes: A01B 79/005 Precision agriculture
• CPC Class Codes: G05D 1/0274 using mapping information stored in a memory device navigation using map-matching G01C21/30
• CPC Class Codes: G05D 1/0278 using satellite positioning signals, e.g. GPS
• CPC Class Codes: G05D 1/0891 specially adapted for land vehicles

Abstract

A system and method of guiding a vehicle comprises establishing elevation data and corresponding location data for a work area. A particular location of a vehicle within the work area is determined. Roll data and pitch data are estimated corresponding to the particular location. The vehicle is guided based upon the estimated roll data and the pitch data such that the vehicle follows a desired path.

Claims

1. A system of guiding a vehicle, the system comprising:

a data storage device for storing elevation data and corresponding location data for a work area;

a location-determining receiver for determining a particular location of a vehicle within the work area;

a data processor comprising a roll estimator for estimating a roll data and a pitch estimator for estimating pitch data corresponding to the particular location, the roll data associated with a corresponding lateral slope, the pitch data associated with a corresponding longitudinal slope generally perpendicular to the lateral slope, wherein each of the roll data and pitch data are separately estimated using i) a maximum slope of ground with respect to a reference point for each cell traversed by the vehicle corresponding to the particular location, and the maximum slope having a non-zero longitudinal slope component and a non-zero lateral slope component, and ii) an aspect angle between a direction of the maximum slope and an axis with which a direction of travel is coincident; and

a steering controller for guiding the vehicle utilizing the estimated roll data and the pitch data such that the vehicle follows a desired path.

2. The system according to claim 1 wherein the roll data comprises a roll angle and wherein the pitch data comprises a pitch angle.

3. The system according to claim 1 wherein the work area is divided into a group of cells, and wherein each cell is associated with a corresponding elevation and a respective location.

4. The system according to claim 1 wherein the data storage device further stores respective slope data and aspect data associated with the location data, the slope data indicating a change in the elevation and the aspect data indicating the direction of the slope.

5. The system according to claim 1 wherein the desired path comprises a substantially linear and arc path segment.

6. The system according to claim 1 wherein the data processor generates a steering compensation signal to compensate for changes in the roll data and pitch data between a first location and a second location within the work area to conform to the desired path.

7. The system according to claim 1 wherein the pitch estimator estimates the pitch data based on one or more of the following:

location data, elevation data, a current position of the vehicle, an expected position of the vehicle, vehicle speed, vehicle heading, vehicular velocity, and a path plan.

8. The system according to claim 1 wherein the pitch estimator estimates the pitch data consistent with the following equation:

θ

(Pitch angle)=Θ

_x=(arcsin(sin Θ

sin Ψ

), where Ψ

is the aspect, Θ

is the slope, Θ

_x is the longitudinal slope.

9. The system according to claim 1 wherein the roll estimator estimates the roll data based on one of more of the following:

location data, elevation data, a current position of the vehicle, an expected position of the vehicle, vehicle speed, vehicle heading, vehicular velocity, and a path plan.

10. The system according to claim 1 wherein the roll estimator estimates the roll data consistent with the following equation:

Φ

(Roll angle)=Θ

_y=arcsin(sin Θ

cos Ψ

), where Ψ

is the aspect, Θ

is the slope, and Θ

_y is the lateral slope.