Machine stability detection and control

Patent metadata

Field	Value
Publication number	US-10767348-B2
Application number	US-201816048966-A
Country	US
Kind code	B2
Filing date	Jul 30, 2018
Priority date	Jul 30, 2018
Publication date	Sep 8, 2020
Grant date	Sep 8, 2020

Abstract

A mobile work machine includes a frame, a set of ground engaging elements movably supported by the frame and driven to drive movement of the mobile work machine, a movable element movably supported by the frame to move relative to the frame, and an actuator coupled to the movable element to controllably drive movement of the movable element. The mobile work machine also includes a control system that generates an actuator control signal, indicative of a commanded movement of the actuator, and provides the actuator control signal to the actuator to control the actuator to perform the commanded movement. Further, the mobile work machine includes a stability system, coupled to the control system, that determines whether the commanded movement will result in an unstable state of the mobile work machine and, if so, generates a restriction signal, restricting the commanded movement to avoid the unstable state.

First claim

What is claimed is:

1. A mobile work machine, comprising:
a frame;
a set of ground engaging elements movably supported by the frame and driven by a power source to drive movement of the mobile work machine;
a movable element movably supported by the frame to move relative to the frame;
an actuator coupled to the movable element to controllably drive movement of the movable element;
a control system that generates an actuator control signal, indicative of a commanded movement of the actuator, and provides the actuator control signal to the actuator to control the actuator to perform the commanded movement;
a terrain identifier configured to identify a characteristic of terrain in a geographic area around the mobile work machine; and
a stability system, coupled to the control system, that includes a terrain detector that defines a plurality of grid sections that correspond to geographic locations in the geographic area around the mobile work machine, based on the identified characteristics of the terrain in the geographic area around the mobile work machine and determines whether the commanded movement will result in an unstable state of the mobile work machine based on the identified characteristic of the terrain in the grid section in the geographic area around the mobile work machine and, if so, generates a restriction signal, restricting the commanded movement to avoid the unstable state.

2. The mobile work machine of claim 1 wherein the terrain detector is configured to generate a map that defines the plurality of grid sections that correspond to geographic locations in the geographic area around the mobile work machine, based on a terrain signal generated by the terrain identifier indicative of the identified characteristic of the terrain in the geographic area around the mobile work machine.

3. The mobile work machine of claim 2 wherein the stability system comprises:
a machine configuration detector configured to detect a machine configuration in which the mobile machine is likely to be configured if positioned at a given one of the geographic locations.

4. The mobile work machine of claim 3 wherein the machine configuration detector detects a likely load on the mobile work machine, based on the detected machine configuration.

5. The mobile work machine of claim 4 wherein the stability system comprises:
stability detection logic configured to detect a center of gravity of the mobile work machine at the given geographic location, based on the likely load and the terrain data.

6. The mobile work machine of claim 5 wherein the stability detection logic detects the unstable state of the mobile work machine by determining whether the center of gravity of the mobile work machine is within a threshold area bounded by the ground engaging elements.

7. The mobile work machine of claim 6 wherein the stability system comprises:
a dynamic stability controller that receives an indication from the stability detection logic, indicative of a determination that the center of gravity is not within the threshold area, and automatically restricts generation of the actuator control signal, based on the indication.

8. The mobile work machine of claim 7 wherein the dynamic stability controller generates the restriction signal to restrict the commanded movement and prevent configuration of the mobile work machine in the machine configuration to avoid the unstable state.

9. The mobile work machine of claim 8 wherein the dynamic stability controller comprises:
a model-look up component that generates a weighted value and assigns the weighted value to the commanded movement, wherein the weighted value is indicative of a degree of deviation, of the center of gravity from the threshold area, attributed to the commanded movement.

10. The mobile work machine of claim 5 wherein the stability detection logic identifies a slope at a particular grid point in the map corresponding to the given geographic location, based on the terrain signal, and detects the center of gravity of the mobile work machine by detecting a likely elevation of at least one of the ground engaging elements relative to the frame, based on the slope.

11. The mobile work machine of claim 10 wherein the stability detection logic detects the center of gravity based on the likely load on the mobile work machine relative to the likely elevation of the at least one ground engaging element.

12. A method of controlling a mobile machine comprising:
defining a plurality of grid sections, each corresponding to a geographic location in a geographic area around the mobile machine;
generating a slope value indicative of terrain for each grid section;
predicting a center of gravity of the mobile machine for each grid section, based on the slope value;
determining whether the predicted center of gravity would render the mobile machine in an unstable state for each grid section; and
if so, generating a restriction signal that prevents the mobile machine from being controllably rendered in the unstable state.

13. The method of claim 12 further comprising:
predicting different machine configurations of the mobile machine for each grid section.

14. The method of claim 13 wherein predicting a center of gravity of the mobile machine for each grid section comprises:
predicting a plurality of different centers of gravity of the mobile machine, each predicted center of gravity corresponding to a particular one of the predicted machine configurations.

15. The method of claim 14 further comprising:
generating a stability distribution having a set of values for each grid section, each value indicating a measure of likelihood that the mobile machine will have a particular one of the predicted centers of gravity.

16. The method of claim 15 wherein determining whether the predicted center of gravity would render the mobile machine in an unstable state for each grid section comprises:
aggregating the set of values for each grid section; and
generating an average stability measure, for each grid section, indicative of a measure of likelihood that the mobile machine will have an average center of gravity that renders the mobile machine in the unstable state, based on the aggregated set of values.

17. A mobile work machine, comprising:
a frame;
a movable element;
an actuator coupled to the movable element to controllably drive movement of the movable element;
a control system that generates a control signal, indicative of a commanded movement of the movable element, and provides the control signal to the actuator to control the actuator to perform the commanded movement; and
a stability system, coupled to the control system, configured to:
generate terrain data indicative of detected slope at a plurality of positions in a geographic area surrounding the mobile work machine,
detect, for a particular position in the geographic area, an expected orientation of the mobile work machine relative to the detected slope corresponding to the particular position,
detect a likely unstable state of the mobile work machine, based on determining that a measure of probability, that the mobile work machine will have a center of gravity that is not within a stability limit for the particular position, exceeds a threshold measure of probability, and
a dynamic stability controller that automatically generates a restriction signal restricting generation of the control signal to avoid the unstable state of the mobile work machine at the particular position.

18. The mobile work machine of claim 17 wherein the stabil

Assignees

• Deere & Co

Inventors

• Kean Michael G
• Cherney Mark J

Classifications

• G05B15/02

  electric · CPC title

• E02F9/262 Primary

  with follow-up actions to control the work tool, e.g. controller · CPC title

• B60W2530/10

  Weight · CPC title

• B60W2552/00

  Input parameters relating to infrastructure · CPC title

• E02F9/2033

  Limiting the movement of frames or implements, e.g. to avoid collision between implements and the cabin (sub-groups of E02F3/431 of E02F3/435 take precedence; for turntables E02F9/123) · CPC title