GRADE CONTROL FOR MACHINES WITH BUCKETS

Abstract

method is disclosed. The method may include controlling a leading edge of an implement of a machine using a first control loop to cause the implement to align to a defined design plan; controlling a trailing edge of the implement of the machine using a second control loop to cause the implement to align to the defined design plan; and selectively altering a gain to the second control loop based on a detected deviation of the implement from the defined design plan to increase an angle of approach, using the first control loop, when the implement is positioned above the defined design plan and decrease the angle of approach, using the first control loop, when the implement is aligned to the defined design plan.

Claims

1. A method, comprising: controlling, by a device, a leading edge of an implement of a machine using a first control loop to cause the implement to align to a defined design plan; controlling, by the device, a trailing edge of the implement of the machine using a second control loop to cause the implement to align to the defined design plan; and selectively altering, by the device, a gain to the second control loop based on a detected deviation of the implement from the defined design plan to increase an angle of approach, using the first control loop, when the implement is positioned above the defined design plan and decrease the angle of approach, using the first control loop, when the implement is aligned to the defined design plan.

2. The method of claim 1, further comprising: determining a position of the leading edge of the implement; and wherein controlling the leading edge of the implement using the first control loop comprises: controlling the leading edge of the implement based on the position of the leading edge of the implement.

3. The method of claim 1, further comprising: determining a position of the trailing edge of the implement; and wherein controlling the trailing edge of the implement using the second control loop comprises: controlling the trailing edge of the implement based on the position of the trailing edge of the implement.

4. The method of claim 1, further comprising: comparing a first position of the leading edge of the implement and a second position of the trailing edge of the implement to the design plan; determining a design plan error based on comparing the first position of the leading edge of the implement and the second position of the trailing edge of the implement to the design plan; and controlling the leading edge of the implement and the trailing edge of the implement based on the design plan error.

5. The method of claim 1, wherein the first control loop is configured to control a tilt of the implement.

6. The method of claim 1, wherein the second control loop is configured to control a lift of the implement.

7. The method of claim 1, further comprising: determining that the implement is positioned above the design plan; and wherein selectively altering the gain to the second control loop comprises: suppressing the second control loop to cause the implement to move based on the first control loop and based on determining that the implement is positioned above the design plan.

8. The method of claim 7, further comprising: determining, after suppressing the second control loop and after moving the implement based on the first control loop, that the implement is aligned with the design plan; and ending suppression of the second control loop to cause the implement to be moved based on both the first control loop and the second control loop.

9. The method of claim 1, wherein the first control loop and the second control loop are closed loop controls.

10. A system, comprising: one or more memories; and one or more processors communicatively coupled to the one or more memories, configured to: determine a position of a leading edge of an implement of a machine; determine a position of a trailing edge of the implement of the machine; determine, based on the position of the leading edge and the position of the trailing edge, a deviation from a design plan defining a grade for the implement of the machine; control the leading edge of the implement and suppress control of the trailing edge of the implement to increase a first angle of approach of the implement; determine, after controlling the leading edge of the implement and suppressing control of the trailing edge of the implement to increase the first angle of approach of the implement, that the position of the leading edge is aligned to the design plan; control the leading edge of the implement and control the trailing edge of the implement to decrease a second angle of approach of the implement based on determining that the position of the leading edge is aligned to the design plan; determine, after controlling the leading edge of the implement and controlling the trailing edge of the implement to decrease the second angle of approach of the implement, that the position of the leading edge and the position of the trailing edge are aligned to the design plan; and control the leading edge of the implement and control the trailing edge of the implement to maintain alignment of the position of the leading edge and the position of the trailing edge to the design plan.

11. The system of claim 10, wherein the one or more processors are further configured to: control the leading edge of the implement using a first control loop; and control the trailing edge of the implement using a second control loop.

12. The system of claim 11, wherein the one or more processors are further configured to: alter a gain of the second control loop to suppress control of the trailing edge of the implement.

13. The system of claim 10, wherein the one or more processors, when controlling the leading edge of the implement and suppressing control of the trailing edge of the implement, are to: control a tilt of the implement and suppress control of a lift of the implement.

14. The system of claim 10, wherein the one or more processors, when determining the position of the leading edge, are to: determine the position of the leading edge based at least one of: one or more sensor measurements, or a kinematic representation of the machine.

15. The system of claim 10, wherein the one or more processors, when determining the position of the trailing edge, are to: determine the position of the trailing edge based on at least one of: one or more sensor measurements, or a kinematic representation of the machine.

16. A machine, comprising: an articulated implement, comprising: the articulated implement having an end with a leading edge and a trailing edge; a first articulation control joint to articulate the leading edge of the articulated implement, a second articulation control joint to articulate the trailing edge of the articulated implement; and a grading control system, configured to: control the first articulation joint and the second articulation joint to maintain alignment of an angle of approach of the articulated implement with a design plan associated with a configured grade of the machine; determine, when controlling the first articulation joint and the second articulation joint, a deviation of the articulated implement from the design plan associated with the configured grade of the machine; suppress control of the second articulation joint; control, concurrent with suppressing control of the second articulation joint, the first articulation joint to realign the articulated implement with the design plan; and end, after controlling the first articulation joint to realign the articulated implement with the design plan, suppression of control of the second articulation joint.

17. The machine of claim 16, further comprising: one or more sensors to determine a position of the articulated implement relative to the design plan associated with the configured grade of the machine.

18. The machine of claim 16, wherein the grading control system comprises: a first control loop associated with controlling the first articulation joint; and a second control loop associated with controlling the second articulation joint.

19. The machine of claim 16, the grading control system, when configured to control the first articulation joint to realign the articulated implement with the design plan, is configured to: transmit a dump command to the first articulation joint to increase an angle of approach of the articulated implement; and transmit a dig command to another articulation joint to cause the articulated implement to dig into a surface.

20. The machine of claim 16, further comprising: a positioning system to determine a position of the machine; and wherein the grading control system is configured to determine the design plan based on the position of the machine.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0009] FIG. 1 is diagram of an example machine that includes a grading control system described herein.

[0010] FIG. 2 is a diagram of an example articulated implement that is controlled by a grading control system described herein.

[0011] FIG. 3 is diagram of an example bucket that is controlled by a grading control system described herein.

[0012] FIG. 4 is a diagram of example components of one or more systems and/or devices described herein.

[0013] FIG. 5 is a flow chart of an example process for grading control.

DETAILED DESCRIPTION

[0014] Although some implementations described herein relate to a track-type loader, the implementations apply equally to other types of machines, such as skid-steer loaders, backhoe loaders, wheel loaders, tractors, and/or the like. Moreover, although some implementations described herein relate to a bucket, the implementations apply equally to other types of implements, such as graders, rippers, and/or the like.

[0015] FIG. 1 is a diagram of an example machine 100 described herein. The machine 100 is shown as a track-type loader but may include any type of machine.

[0016] As shown in FIG. 1, machine 100 may have a frame 102 that supports an operator station 104, a power system 106, a drive system 108, and an implement 110. The operator station 104 may include operator controls 112 for operating the machine 100 via the power system 106. The illustrated operator station 104 is configured to define an interior cabin 114 within which the operator controls 112 are housed and which is accessible via a door 116.

[0017] The power system 106 is configured to supply power to the machine 100. The power system 106 may be operably arranged with the operator station 104 to receive control signals from the operator controls 112 in the operator station 104. Additionally, or alternatively, the power system 106 may be operably arranged with the drive system 108 and/or the implement 110 to selectively operate the drive system 108 and/or the implement 110 according to control signals received from the operator controls 112.

[0018] The power system 106 may provide operating power for the propulsion of the drive system 108 and/or the operation of the implement 110. The power system 106 may include an engine and a transmission. The engine may be any type of engine suitable for performing work using the machine 100, such as an internal combustion engine, a diesel engine, a gasoline engine, a gaseous fuel-powered engine, a natural gas engine, an electric motor, and/or the like.

[0019] The drive system 108 may be operably arranged with the power system 106 to selectively propel the machine 100 in accordance with control signals from the operator controls 112. The drive system 108 can include a plurality of ground-engaging members, such as tracks 118, as shown, which can be movably connected to the frame 102 through axles, drive shafts, and/or other components. In some implementations, the drive system 108 may be provided in the form of a wheel-drive system or any other type of drive system configured to propel the machine 100.

[0020] The implement 110 may be operably arranged with the power system 106 such that the implement 110 is articulatable through control signals transmitted from the operator controls 112 and/or a grading control system 120 to the power system 106. The implement 110 may be shown as a bucket. Other embodiments can include any other suitable implement for a variety of tasks. Example implements include loaders and/or the like.

[0021] The grading control system 120 may be operably arranged with one or more articulation control modules 122 to control articulation of the implement 110 based on information received from one or more position sensors 124 of a positioning system. For example, the one or more articulation control modules 122 may control a rack/dump function (i.e., a tilt function) of the implement 110, a raise/lower function (i.e., a lift function) of the implement 110, a dig function of the implement 110, and/or the like.

[0022] As indicated above, FIG. 1 is provided as an example. Other examples may differ from what was described in connection with FIG. 1.

[0023] FIG. 2 is a diagram of an example 200 described herein. Example 200 shows the implement 110 attached to the frame 102 of the machine 100.

[0024] As shown in FIG. 2, the implement 110 may include a first articulation control module 122-1 and a second articulation control module 122-2, and may include a first position sensor 124-1 and a second position sensor 124-2.

[0025] As further shown in FIG. 2, and by reference number 201, the first articulation control module 122-1 may be operably arranged with a lift arm 202 of the implement 110 to control a raise/lower function (i.e., a lift function) of the implement 110. For example, the grading control system 120 may control the first articulation control module 122-1 based on position information from the first position sensor 124-1 to control lift of the implement 110. Similarly, as shown by reference number 203, the second articulation control module 122-2 may be operably arranged with a bucket 204, which may be an end of the implement 110, to control a rack/dump function (i.e., a tilt function) of the implement 110. For example, the grading control system 120 may control the second articulation control module 122-2 based on position information from the second position sensor 124-2 to control tilt of the bucket 204 of the implement 110.

[0026] As indicated above, FIG. 2 is provided as an example. Other examples may differ from what was described in connection with FIG. 2.

[0027] FIG. 3 is a diagram of an example 300 described herein. Example 300 shows a kinematic scheme for the bucket 204.

[0028] A leading edge of the bucket 204 (e.g., a position of a cutting edge and/or teeth of the bucket 204) may be defined as a point B1, as shown by reference number 302. Similarly, the trailing edge of the bucket 204 (e.g., a heel of the bucket 204) may be defined as a point B2, as shown by reference number 304. As shown by reference number 306, a bucket plane may be defined by line B1-B2. As shown by reference numbers 308 and 310, an angle of approach may be defined as an angle between the bucket plane and a design plan to which the bucket 204 is configured to align to perform, for example, a grading operation. The design plan may be a grade that the bucket 204 is to grade during the grading operation. As shown by reference number 312, the bucket 204 may be disposed above the design plan, and a ground surface may be disposed between the bucket 204 and the design plan. As a result, a bottom surface of the bucket 204 cannot be lowered to the design plan using the raise/lower control, as described above, and the bucket 204 may be aligned to the design plan using a grading control method described below. As described in more detail herein, the grading control system 120 may tilt the bucket 204 to increase the angle of approach and may suppress control of the lift function of the bucket 204, thereby enabling the leading edge of the bucket 204 to penetrate the ground surface. Once the leading edge of the bucket 204 has reached the grade of the design plan, the grading control system 120 may tilt the bucket 204 to decrease the angle of approach and may stop suppressing the lift function of the bucket 204, thereby enabling the bucket 204 to follow the design plan during the grading operation.

[0029] As indicated above, FIG. 3 is provided as an example. Other examples may differ from what was described in connection with FIG. 3.

[0030] FIG. 4 is a diagram of an example environment 400 in which systems and/or methods, described herein, may be implemented. As shown in FIG. 4, environment 400 may include the grading control system 120, the articulation control module(s) 122, and the position sensor(s) 124. Devices of environment 400 may interconnect via wired connections, wireless connections, or a combination of wired and wireless connections.

[0031] The grading control system 120 includes one or more processors 410 (e.g., a microprocessor, a microcontroller, a field-programmable gate array (FPGA), an application-specific integrated circuit (ASIC), and/or the like) and a memory 412 (e.g., read-only memory (ROM), random-access memory (RAM), and/or the like). In some implementations, the grading control system 120 may be an electronic control unit of the machine 100 and that is configured to control one or more articulation control modules 122. The processor 410 may execute one or more instructions and/or commands to control one or more components of the machine 100, such as to control a set of control loops associated with controlling one or more articulation control modules 122 based on sensor information from one or more position sensors 124. The memory 412 may store program code for execution by the processor 410 and/or for storing data in connection with execution of such program code by the processor 410.

[0032] The grading control system 120 may receive one or more input signals from various components of the machine 100, may operate on the one or more input signals using multiple control loops to generate one or more output signals (e.g., by executing a program using the input signals as input to the program), and may output the one or more output signals to various components of the machine 100. For example, the grading control system 120 may receive a set of sensor measurements, such as a location measurement identifying a location of machine 100, a position measurement identifying a position of bucket 204 relative to a design plan, and/or the like. In some implementations, the grading control system 120 may use a kinematic representation of the machine 100 to determine a position of the bucket 204 based on a position of another portion of the machine 100, such as the frame 102, the tracks 118, and/or the like. In this case, the grading control system 120 may transmit a control signal to the one or more articulation control modules 122 to control whether the bucket 204 is tilted and/or lifted to align to the design plan, as described in more detail herein. The one or more articulation control modules 122 may control one or more articulation joints of the machine 100 to adjust a tilt, a lift, and/or the like of the implement 110.

[0033] The number and arrangement of devices shown in FIG. 4 are provided as an example. In practice, there may be additional devices, fewer devices, different devices, or differently arranged devices than those shown in FIG. 4. Furthermore, two or more devices shown in FIG. 4 may be implemented within a single device, or a single device shown in FIG. 4 may be implemented as multiple, distributed devices. Additionally, or alternatively, a set of devices (e.g., one or more devices) of environment 400 may perform one or more functions described as being performed by another set of devices of environment 400.

[0034] FIG. 5 is a flow chart of an example process 500 for grading control. In some implementations, one or more process blocks of FIG. 5 may be performed by a grading control system. In some implementations, one or more process blocks of FIG. 5 may be performed by another device or a group of devices separate from or including the grading control system (e.g., grading control system 120).

[0035] As shown in FIG. 5, process 500 may include controlling a leading edge of an end of an implement using a first control loop (block 510). For example, the grading control system (e.g., using processor 410, memory 412, and/or the like) may control a leading edge of a bucket using a first control loop, as described above. The grading control system may determine a position of the leading edge of the implement (e.g., based on information from a position sensor 124), and may control the leading edge of the implement based on the position of the leading edge of the bucket. The grading control system may use the first control loop to adjust a tilt of the bucket to control the leading edge of the implement.

[0036] As shown in FIG. 5, process 500 may include controlling a trailing edge of the end of the implement using a second control loop (block 520). For example, the grading control system (e.g., using processor 410, memory 412, and/or the like) may control the trailing edge of the bucket using the second control loop, as described above. The grading control system may determine a position of the trailing edge of the implement (e.g., based on information from a position sensor 124), and may control the trailing edge of the implement based on the position of the leading edge of the implement. The implement may use the second control loop to adjust a lift of the implement to control a position of the trailing edge of the implement.

[0037] As shown in FIG. 5, process 500 may include selectively altering a gain to the second control loop to align the implement to a design plan (block 530). For example, the grading control system (e.g., using processor 410, memory 412, and/or the like) may selectively alter the gain to the second control loop to align a bucket to the design plan, as described above. The grading control system may determine that the implement is positioned above the design plan and may suppress the second control loop to cause the implement to move based on the first control loop, thereby causing the implement to tilt toward alignment with the design plan. After suppressing the second control loop, the grading control system may determine that implement is aligned with the design plan (e.g., the leading edge is aligned with the design plan) and may end suppression of the second control loop to enable the implement to grade in accordance with the design plan.

[0038] Although FIG. 5 shows example blocks of process 500, in some implementations, process 500 may include additional blocks, fewer blocks, different blocks, or differently arranged blocks than those depicted in FIG. 5. Additionally, or alternatively, two or more of the blocks of process 500 may be performed in parallel.

INDUSTRIAL APPLICABILITY

[0039] The disclosed grading control system (e.g., the grading control system 120) may be used with any machine where a technique for grading control is desirable. The disclosed grading control system may use two independent closed loop control loops to control tilt, and lift, respectively. The disclosed grading control system may use a first control loop to maintain a position of a first point, B1, associated with a leading edge of the bucket on a grade of a design plan. The disclosed grading control system may use a second control loop to maintain a position of a second point, B2, associated with a trailing edge of the bucket on the grade of the design plan.

[0040] The disclosed grading control system may compare a first position of B1 with a second position of B2 to determine the position of the bucket relative to the design plan and/or a design plan error representing a deviation of the bucket from a grade associated with the design plan. When points B1 and B2 are disposed above the design plan, the disclosed grading control system may suppress the second control loop. The disclosed grading control system may suppress the second control loop by decreasing a gain to signals associated with the second control loop. In this case, the disclosed grading control system may cause the first control loop to tilt the bucket toward the design plan (e.g., by providing a dump command to an articulation control module of the bucket) rather than lowering the bucket toward the design plan using lift control. For example, the bucket may use the first control loop to increase an angle of approach toward the design plan, thereby enabling the bucket to penetrate the ground toward the design plan and to move the bucket such that B1 reaches a grade of the design plan. In this way, the disclosed grading control system improves control of the bucket relative to lowering the bucket using the lift control (which may be prevented from reaching the design plan by a surface of the ground).

[0041] Further, the disclosed grading control system may determine that the bucket has aligned to the design plan (e.g., when point B1 is aligned to the design plan). In this case, the disclosed grading control system may use the first control loop to tilt the bucket to cause B2 to be aligned to the design plan (e.g., by decreasing the angle of approach to return the bucket to a flat position relatively parallel to the design plan). After, the disclosed grading control system may end suppression of the second control loop, which may enable the bucket to follow the design plan during a grading operation by using both the tilt control and the lift control.