IP Library › Granted Patent US 8,145,391
Granted Patent B2
US 8,145,391 · App. 12/207,038 · Granted Mar 27, 2012

Automatic blade control system with integrated global navigation satellite system and inertial sensors

Assignee: Topcon Positioning Systems, Inc.
View Patent ↗
Loading inventors, assignments & file history…
Monitor This Case
Get email alerts when status or documents change.
Order Certified Copies
Most orders are placed with the USPTO same day — all within 24 business hours.
Order via The Patent Place →
Pre-filled with this patent's details
Quick Facts
Patent No.
US 8,145,391
App. No.
12/207,038
Granted
Mar 27, 2012
Kind
B2
Abstract

Disclosed are method and apparatus for controlling the blade elevation and blade slope angle of a dozer blade. Elevation and slope angle measurements are calculated from measurements received from a global navigation satellite system (GNSS) antenna and an inertial measurement unit mounted on the dozer blade. The inertial measurement unit includes three orthogonally placed accelerometers and three orthogonally placed rate gyros. The measurements are processed by algorithms to calculate estimates of the blade elevation, blade vertical velocity, blade slope angle, and blade slope angular velocity. These estimates are then provided as inputs to a control algorithm which provides control signals to control a dozer hydraulic system which controls the blade elevation and blade slope angle.

Claims (83)

1. A method for controlling a dozer blade mounted on a dozer body, the method comprising the steps of:

receiving first measurements from at least one global navigation satellite system sensor mounted on the dozer blade, the first measurements comprising measurements of an elevation of the dozer blade and a vertical velocity of the dozer blade;

receiving second measurements from a plurality of inertial sensors mounted on the dozer blade, the second measurements comprising at least one of:

a first acceleration measurement of the dozer blade along a first orthogonal axis;

a second acceleration measurement of the dozer blade along a second orthogonal axis;

a third acceleration measurement of the dozer blade along a third orthogonal axis;

a first angular velocity measurement of the dozer blade about the first orthogonal axis;

a second angular velocity measurement of the dozer blade about the second orthogonal axis; and

a third angular velocity measurement of the dozer blade about the third orthogonal axis;

calculating, based at least in part on the first measurements and the second measurements, compensation of a tangential acceleration and compensation of at least one centripetal acceleration arising from at least one circular motion of the dozer body; and

controlling the elevation of the dozer blade and a slope angle of the dozer blade based at least in part on the first measurements, and the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration.

2. The method of claim 1 , further comprising the steps of:

calculating an estimate of the elevation of the dozer blade based at least in part on the first measurements, the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration;

calculating an estimate of the vertical velocity of the dozer blade based at least in part on the first measurements, the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration; and

calculating an estimate of the slope angle of the dozer blade based at least in part on the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration.

3. The method of claim 1 , further comprising the step of:

calculating an estimate of a pitch angle of the dozer blade and an estimate of the slope angle of the dozer blade based at least in part on the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration.

4. The method of claim 1 , further comprising the steps of:

calculating an estimate of the elevation of the dozer blade based at least in part on the first measurements, the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration;

calculating an estimate of the vertical velocity of the dozer blade based at least in part on the first measurements, the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration;

calculating an estimate of the slope angle of the dozer blade based at least in part on the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration;

calculating an estimate of a pitch angle of the dozer blade based at least in part on the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration;

calculating an estimate of a slope angular velocity of the dozer blade based at least in part on the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration; and

controlling the elevation of the dozer blade and the slope angle of the dozer blade based at least in part on the estimate of the elevation of the dozer blade, the estimate of the vertical velocity of the dozer blade, the estimate of the slope angle of the dozer blade, and the estimate of the slope angular velocity of the dozer blade.

5. The method of claim 1 , wherein the plurality of inertial sensors comprises:

three orthogonally placed accelerometers configured to measure acceleration along the first orthogonal axis, the second orthogonal axis, and the third orthogonal axis; and

three orthogonally placed rate gyros configured to measure angular velocity about the first orthogonal axis, the second orthogonal axis, and the third orthogonal axis.

6. An apparatus for controlling a dozer blade mounted on a dozer body, the apparatus comprising:

means for receiving first measurements from at least one global navigation satellite system (GNSS) sensor mounted on the dozer blade, the first measurements comprising measurements of an elevation of the dozer blade and a vertical velocity of the dozer blade;

means for receiving second measurements from a plurality of inertial sensors mounted on the dozer blade, the second measurements comprising at least one of:

a first acceleration measurement of the dozer blade along a first orthogonal axis;

a second acceleration measurement of the dozer blade along a second orthogonal axis;

a third acceleration measurement of the dozer blade along a third orthogonal axis;

a first angular velocity measurement of the dozer blade about the first orthogonal axis;

a second angular velocity measurement of the dozer blade about the second orthogonal axis; and

a third angular velocity measurement of the dozer blade about the third orthogonal axis;

means for calculating, based at least in part on the first measurements and the second measurements, compensation of a tangential acceleration and compensation of at least one centripetal acceleration arising from at least one circular motion of the dozer body; and

means for controlling the elevation of the dozer blade and a slope angle of the dozer blade based at least in part on the first measurements, the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration.

7. The apparatus of claim 6 , further comprising:

means for calculating an estimate of the elevation of the dozer blade based at least in part on the first measurements, and the second measurements, the compensation of the tangential acceleration, the compensation of the at least one centripetal acceleration;

means for calculating an estimate of the vertical velocity of the dozer blade based at least in part on the first measurements, and the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration; and

means for calculating an estimate of the slope angle of the dozer blade based at least in part on the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration.

8. The apparatus of claim 6 , further comprising:

means for calculating an estimate of a pitch angle of the dozer blade and an estimate of the slope angle of the dozer blade based at least in part on the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration.

9. The apparatus of claim 6 , further comprising:

means for calculating an estimate of the elevation of the dozer blade based at least in part on the first measurements, the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration;

means for calculating an estimate of the vertical velocity of the dozer blade based at least in part on the first measurements, the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration;

means for calculating an estimate of the slope angle of the dozer blade based at least in part on the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration;

means for calculating an estimate of a pitch angle of the dozer blade based at least in part on the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration;

means for calculating an estimate of a slope angular velocity of the dozer blade based at least in part on the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration; and

means for controlling the elevation of the dozer blade and the slope angle of the dozer blade based at least in part on the estimate of the elevation of the dozer blade, the estimate of the vertical velocity of the dozer blade, the estimate of the slope angle of the dozer blade, and the estimate of the slope angular velocity of the dozer blade.

10. The apparatus of claim 6 , wherein the at least one GNSS sensor comprises:

at least one antenna configured to receive GNSS signals.

11. The apparatus of claim 6 , wherein the plurality of inertial sensors comprises:

three orthogonally placed accelerometers configured to measure acceleration along the first orthogonal axis, the second orthogonal axis, and the third orthogonal axis; and

three orthogonally placed rate gyros configured to measure angular velocity about the first orthogonal axis, the second orthogonal axis, and the third orthogonal.

12. A computer readable medium storing computer instructions for controlling a dozer blade mounted on a dozer body, the computer instructions defining the steps of:

receiving first measurements from at least one global navigation satellite system sensor mounted on the dozer blade, the first measurements comprising measurements of an elevation of the dozer blade and a vertical velocity of the dozer blade;

receiving second measurements from a plurality of inertial sensors mounted on the dozer blade, the second measurements comprising at least one of:

a first acceleration measurement of the dozer blade along a first orthogonal axis;

a second acceleration measurement of the dozer blade along a second orthogonal axis;

a third acceleration measurement along a third orthogonal axis;

a first angular velocity measurement of the dozer blade about the first orthogonal axis;

a second angular velocity measurement about the second orthogonal axis; and

a third angular velocity measurement of the dozer blade about the third orthogonal axis;

calculating, based at least in part on the first measurements and the second measurements, compensation of a tangential acceleration and compensation of at least one centripetal acceleration arising from at least one circular motion of the dozer body; and

controlling the elevation of the dozer blade and a slope angle of the dozer blade based at least in part on the first measurements, the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration.

13. The computer readable medium of claim 12 , wherein the computer instructions further comprise computer instructions defining the steps of:

calculating an estimate of the elevation of the dozer blade based at least in part on the first measurements, the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration;

calculating an estimate of the vertical velocity of the dozer blade based at least in part on the first measurements, the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration; and

calculating an estimate of the slope angle of the dozer blade based at least in part on the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration.

14. The computer readable medium of claim 12 , wherein the computer instructions further comprise computer instructions defining the step of:

calculating an estimate of a pitch angle of the dozer blade and an estimate of the slope angle of the dozer blade based at least in part on the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration.

15. The computer readable medium of claim 12 , wherein the computer instructions further comprise computer instructions defining the steps of:

calculating an estimate of the elevation of the dozer blade based at least in part on the first measurements, the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration;

calculating an estimate of the vertical velocity of the dozer blade based at least in part on the first measurements, the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration;

calculating an estimate of the slope angle of the dozer blade based at least in part on the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration;

calculating an estimate of a pitch angle of the dozer blade based at least in part on the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration;

calculating an estimate of a slope angular velocity of the dozer blade based at least in part on the second measurements, the compensation of the tangential acceleration, and the compensation of the at least one centripetal acceleration; and

controlling the elevation of the dozer blade and the slope angle of the dozer blade based at least in part on the estimate of the elevation of the dozer blade, the estimate of the vertical velocity of the dozer blade, the estimate of the slope angle of the dozer blade, and the estimate of the slope angular velocity of the dozer blade.

16. The computer readable medium of claim 12 , wherein the plurality of inertial sensors comprises:

three orthogonally placed accelerometers configured to measure acceleration along the first orthogonal axis, the second orthogonal axis, and the third orthogonal axis; and

three orthogonally placed rate gyros configured to measure angular velocity about the first orthogonal axis, the second orthogonal axis, and the third orthogonal axis.

Assignments (1)
ASSIGNMENT OF ASSIGNOR'S INTEREST Recorded Oct 14, 2008
From: OMELCHENKO, ALEXANDER; ZHDANOV, ALEXEY VLADISLAVOVICH
To: TOPCON POSITIONING SYSTEMS, INC.
Reel/Frame 021690/0274 →
Continuity (1)
Related Publication 20090069987A1 · Mar 12, 2009