Automatic blade slope control system
First Claim
1. A method for controlling a blade mounted on a vehicle, the method comprising the steps of:
- receiving at a first time a first computed roll angle estimate and a first computed pitch angle estimate, wherein the first computed roll angle estimate and the first computed pitch angle estimate are based at least in part on a first angular velocity measurement about a first axis, a second angular velocity measurement about a second axis, and a third angular velocity measurement about a third axis from a three-axis gyroscope mounted on the blade, wherein the first axis, the second axis, and the third axis are orthogonal;
receiving at a second time a second computed roll angle estimate and a second computed pitch angle estimate, wherein the second computed roll angle estimate and the second computed pitch angle estimate are based at least in part on a fourth angular velocity measurement about the first axis, a fifth angular velocity measurement about the second axis, and a sixth angular velocity measurement about the third axis from the three-axis gyroscope mounted on the blade;
receiving at a third time a blade slope angle measurement from a blade slope angle tilt sensor mounted on the blade;
receiving at a fourth time a blade tip angle measurement from a blade tip angle tilt sensor mounted on the blade;
determining whether a first time condition is satisfied, wherein the first time condition is represented by;
the third time is greater than the first time and less than or equal to the second time;
upon determining that the first time condition is satisfied;
determining whether the received blade slope angle measurement is valid;
determining whether a second time condition is satisfied, wherein the second time condition is represented by;
the fourth time is greater than the first time and less than or equal to the second time;
upon determining that the second time condition is satisfied;
determining whether the received blade tip angle measurement is valid; and
upon determining that the first time condition is satisfied, the received blade slope angle measurement is valid, the second time condition is satisfied, and the received blade tip angle measurement is valid;
computing with a processor an estimate of the blade slope angle based at least in part on the received second computed roll angle estimate, the received second computed pitch angle estimate, the received blade slope angle measurement, and the received blade tip angle measurement.
2 Assignments
0 Petitions
Accused Products
Abstract
The slope angle of a blade on an earthmoving machine is automatically controlled based on measurements from a three-axis gyroscope, a blade slope angle tilt sensor, and a blade tip angle tilt sensor mounted on the blade. A three-axis gyroscope has high dynamic response and high resistance to mechanical disturbances but is subject to potentially unbounded errors. A tilt sensor has bounded errors but has a slow dynamic response and a high sensitivity to mechanical disturbances. The combination of a three-axis gyroscope and two tilt sensors provides an advantageous measurement system. Algorithms for performing proper fusion of the measurements account for the lack of synchronization between the three-axis gyroscope and the tilt sensors and also screen out invalid measurements from the tilt sensors. The blade slope angle is controlled based on a reference blade slope angle and an estimate of the blade slope angle computed from properly fused measurements.
53 Citations
36 Claims
-
1. A method for controlling a blade mounted on a vehicle, the method comprising the steps of:
-
receiving at a first time a first computed roll angle estimate and a first computed pitch angle estimate, wherein the first computed roll angle estimate and the first computed pitch angle estimate are based at least in part on a first angular velocity measurement about a first axis, a second angular velocity measurement about a second axis, and a third angular velocity measurement about a third axis from a three-axis gyroscope mounted on the blade, wherein the first axis, the second axis, and the third axis are orthogonal; receiving at a second time a second computed roll angle estimate and a second computed pitch angle estimate, wherein the second computed roll angle estimate and the second computed pitch angle estimate are based at least in part on a fourth angular velocity measurement about the first axis, a fifth angular velocity measurement about the second axis, and a sixth angular velocity measurement about the third axis from the three-axis gyroscope mounted on the blade; receiving at a third time a blade slope angle measurement from a blade slope angle tilt sensor mounted on the blade; receiving at a fourth time a blade tip angle measurement from a blade tip angle tilt sensor mounted on the blade; determining whether a first time condition is satisfied, wherein the first time condition is represented by; the third time is greater than the first time and less than or equal to the second time; upon determining that the first time condition is satisfied; determining whether the received blade slope angle measurement is valid; determining whether a second time condition is satisfied, wherein the second time condition is represented by; the fourth time is greater than the first time and less than or equal to the second time; upon determining that the second time condition is satisfied; determining whether the received blade tip angle measurement is valid; and upon determining that the first time condition is satisfied, the received blade slope angle measurement is valid, the second time condition is satisfied, and the received blade tip angle measurement is valid; computing with a processor an estimate of the blade slope angle based at least in part on the received second computed roll angle estimate, the received second computed pitch angle estimate, the received blade slope angle measurement, and the received blade tip angle measurement. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12)
-
-
13. An apparatus for controlling a blade mounted on a vehicle, the apparatus comprising:
-
a processor; memory operably coupled to the processor; and a data storage device operably coupled to the processor, wherein the data storage device stores computer program instructions, which, when executed by the processor, causes the processor to perform a method comprising the steps of; receiving at a first time a first computed roll angle estimate and a first computed pitch angle estimate, wherein the first computed roll angle estimate and the first computed pitch angle estimate are based at least in part on a first angular velocity measurement about a first axis, a second angular velocity measurement about a second axis, and a third angular velocity measurement about a third axis from a three-axis gyroscope mounted on the blade, wherein the first axis, the second axis, and the third axis are orthogonal; receiving at a second time a second computed roll angle estimate and a second computed pitch angle estimate, wherein the second computed roll angle estimate and the second computed pitch angle estimate are based at least in part on a fourth angular velocity measurement about the first axis, a fifth angular velocity measurement about the second axis, and a sixth angular velocity measurement about the third axis from the three-axis gyroscope mounted on the blade; receiving at a third time a blade slope angle measurement from a blade slope angle tilt sensor mounted on the blade; receiving at a fourth time a blade tip angle measurement from a blade tip angle tilt sensor mounted on the blade; determining whether a first time condition is satisfied, wherein the first time condition is represented by; the third time is greater than the first time and less than or equal to the second time; upon determining that the first time condition is satisfied; determining whether the received blade slope angle measurement is valid; determining whether a second time condition is satisfied, wherein the second time condition is represented by; the fourth time is greater than the first time and less than or equal to the second time; upon determining that the second time condition is satisfied; determining whether the received blade tip angle measurement is valid; and upon determining that the first time condition is satisfied, the received blade slope angle measurement is valid, the second time condition is satisfied, and the received blade tip angle measurement is valid; computing an estimate of the blade slope angle based at least in part on the received second computed roll angle estimate, the received second computed pitch angle estimate, the received blade slope angle measurement, and the received blade tip angle measurement. - View Dependent Claims (14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24)
-
-
25. A computer readable medium storing computer program instructions for controlling a blade mounted on a vehicle, wherein the computer program instructions, when executed by a processor, causes the processor to perform a method comprising the steps of:
-
receiving at a first time a first computed roll angle estimate and a first computed pitch angle estimate, wherein the first computed roll angle estimate and the first computed pitch angle estimate are based at least in part on a first angular velocity measurement about a first axis, a second angular velocity measurement about a second axis, and a third angular velocity measurement about a third axis from a three-axis gyroscope mounted on the blade, wherein the first axis, the second axis, and the third axis are orthogonal; receiving at a second time a second computed roll angle estimate and a second computed pitch angle estimate, wherein the second computed roll angle estimate and the second computed pitch angle estimate are based at least in part on a fourth angular velocity measurement about the first axis, a fifth angular velocity measurement about the second axis, and a sixth angular velocity measurement about the third axis from the three-axis gyroscope mounted on the blade; receiving at a third time a blade slope angle measurement from a blade slope angle tilt sensor mounted on the blade; receiving at a fourth time a blade tip angle measurement from a blade tip angle tilt sensor mounted on the blade; determining whether a first time condition is satisfied, wherein the first time condition is represented by; the third time is greater than the first time and less than or equal to the second time; upon determining that the first time condition is satisfied; determining whether the received blade slope angle measurement is valid; determining whether a second time condition is satisfied, wherein the second time condition is represented by; the fourth time is greater than the first time and less than or equal to the second time; upon determining that the second time condition is satisfied; determining whether the received blade tip angle measurement is valid; and upon determining that the first time condition is satisfied, the received blade slope angle measurement is valid, the second time condition is satisfied, and the received blade tip angle measurement is valid; computing an estimate of the blade slope angle based at least in part on the received second computed roll angle estimate, the received second computed pitch angle estimate, the received blade slope angle measurement, and the received blade tip angle measurement. - View Dependent Claims (26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36)
-
Specification