SYSTEM FOR CONTROLLING WORK MACHINE, METHOD, AND WORK MACHINE
20250230630 ยท 2025-07-17
Inventors
- Shoya KIMURA (Tokyo, JP)
- Takehiro SHIBATA (Tokyo, JP)
- Takatoshi MATSUI (Tokyo, JP)
- Tomoki HIRAYAMA (Tokyo, JP)
- Yosuke YAMAGOE (Tokyo, JP)
- Ryohei KIKUZAWA (Tokyo, JP)
Cpc classification
E02F9/264
FIXED CONSTRUCTIONS
E02F9/2025
FIXED CONSTRUCTIONS
International classification
Abstract
A work machine includes a plurality of constituent portions including a first portion. A system for the work machine includes a storage device, an input device, and a controller. The storage device stores center of gravity positions of the plurality of constituent portions. The input device receives input of a first parameter for determining the center of gravity position of the first portion. The controller calculates a center of gravity position of the entire work machine based on the center of gravity positions of the plurality of constituent portions. The controller sets the center of gravity position of the first portion by using the first parameter when the first parameter is inputted with the input device. The controller sets the center of gravity position of the entire work machine based on the center of gravity positions of the plurality of constituent portions that include the set center of gravity position of the first portion.
Claims
1. A system for a work machine including a plurality of constituent portions including a first portion, the system comprising: a storage device that stores center of gravity positions of the plurality of constituent portions; an input device that receives input of a first parameter for determining the center of gravity position of the first portion; and a controller configured to calculate a center of gravity position of the entire work machine based on the center of gravity positions of the plurality of constituent portions, set the center of gravity position of the first portion by using the first parameter when the first parameter is inputted with the input device, and set the center of gravity position of the entire work machine based on the center of gravity positions of the plurality of constituent portions that include the set center of gravity position of the first portion.
2. The system according to claim 1, wherein the storage device stores a plurality of types of the first portion and specification data that includes a dimension and a mass of the first portion corresponding to each of the plurality of types, and the first parameter is selected from the plurality of types of the first portion.
3. The system according to claim 1, wherein the first parameter includes a dimension and a mass of the first portion.
4. The system according to claim 1, wherein the first parameter includes the center of gravity position of the first portion.
5. The system according to claim 1, wherein the plurality of constituent portions further include a second portion, the input device receives input of a second parameter for determining a center of gravity position of the second portion, and the controller is configured to set the center of gravity position of the second portion by using the second parameter when the second parameter is inputted with the input device, and set the center of gravity position of the entire work machine based on the center of gravity positions of the plurality of constituent portions that include the set center of gravity position of the second portion.
6. The display system according to claim 5, wherein the storage device stores a plurality of types of the second portion and specification data that includes a dimension and a mass of the second portion corresponding to each of the plurality of types, and the second parameter is selected from the plurality of types of the second portion.
7. The system according to claim 5, wherein the second parameter includes a dimension and a mass of the second portion.
8. The system according to claim 5, wherein the second parameter includes the center of gravity position of the second portion.
9. The system according to claim 1, further comprising: a display, the controller being configured to cause the display to display an input field for the first parameter.
10. The system according to claim 5, further comprising: a display, the controller being configured to cause the display to display an input field for the second parameter.
11. The system according to claim 1, wherein the work machine includes a vehicle body, and a work implement that includes a replaceable attachment, the work implement being movable with respect to the vehicle body, and the first portion is the attachment.
12. The system according to claim 1, wherein the work machine includes a rotating body that includes a counterweight, the first portion is the rotating body, and the first parameter indicates a type of the counterweight and a dimension and a mass of the counterweight.
13. The system according to claim 1, wherein the work machine includes a traveling body that includes a crawler belt, the first portion is the traveling body, and the first parameter indicates a type of the crawler belt and a dimension and a mass of the crawler belt.
14. A method for controlling a work machine including a plurality of constituent portions including a first portion, the method comprising: acquiring center of gravity positions of the plurality of constituent portions; calculating a center of gravity position of the entire work machine based on the center of gravity positions of the plurality of constituent portions, receiving input of a first parameter for determining a center of gravity position of the first portion via an input device, setting the center of gravity position of the first portion by using a first parameter when the first parameter is inputted with the input device, and setting the center of gravity position of the entire work machine based on the center of gravity positions of the plurality of constituent portions that include the set center of gravity position of the first portion.
15. The method according to claim 14, wherein the plurality of constituent portions further include a second portion, the input device receives input of a second parameter for determining a center of gravity position of the second portion, and the method further comprises: setting the center of gravity position of the second portion by using the second parameter when the second parameter is inputted with the input device; and setting the center of gravity position of the entire work machine based on the center of gravity positions of the plurality of constituent portions that include the set center of gravity position of the second portion.
16. A work machine comprising: a plurality of constituent portions that include a first portion; a storage device that stores center of gravity positions of the plurality of constituent portions; an input device that receives input of a first parameter for determining a center of gravity position of the first portion; and a controller configured to calculate a center of gravity position of the entire work machine based on the center of gravity positions of the plurality of constituent portions, set the center of gravity position of the first portion by using the first parameter when the first parameter is inputted with the input device, and set the center of gravity position of the entire work machine based on the center of gravity positions of the plurality of constituent portions that include the set center of gravity position of the first portion.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0009]
[0010]
[0011]
[0012]
[0013]
[0014]
[0015]
[0016]
[0017]
[0018]
[0019]
[0020]
[0021]
[0022]
[0023]
[0024]
DETAILED DESCRIPTION OF EMBODIMENT(S)
[0025] The following is a description of a work machine according to a first embodiment of the present invention with reference to the drawings.
[0026] The rotating body 4 includes a driving source 11 and a hydraulic pump 12. The driving source 11 is, for example, an internal combustion engine. However, the driving source 11 may also be an electric motor or a hybrid mechanism of an engine and an electric motor. The hydraulic pump 12 is driven by the driving source 11 and discharges hydraulic fluid. The work machine 1 includes a rotation motor 13. The hydraulic fluid discharged from the hydraulic pump 12 is supplied to the rotation motor 13. As a result, the rotation motor 13 causes the rotating body 4 to rotate. The traveling body 5 includes crawler belts 14. The work machine 1 travels due to the rotation of the crawler belts 14.
[0027] The work implement 3 is attached to the vehicle body 2. The work implement 3 is movable with respect to the vehicle body 2. The work implement 3 includes a boom 15, an arm 16, and an attachment 17. The boom 15 is rotatably attached to the vehicle body 2 via a boom pin 18. The arm 16 is rotatably attached to the boom 15 via an arm pin 19. The attachment 17 is rotatably attached to the arm 16 via an attachment pin 20.
[0028] The work implement 3 includes a boom cylinder 21, an arm cylinder 22, and an attachment cylinder 23. The boom cylinder 21, the arm cylinder 22, and the attachment cylinder 23 are hydraulic cylinders. The boom cylinder 21, the arm cylinder 22, and the attachment cylinder 23 are driven by hydraulic fluid from the hydraulic pump 12. The boom cylinder 21 extends and contracts whereby the boom 15 moves. The arm cylinder 22 extends and contracts whereby the arm 16 moves. The attachment cylinder 23 extends and contracts whereby the attachment 17 moves.
[0029]
[0030] The input device 32 receives operations by the operator for setting the control of the work machine 1, and outputs operation signals corresponding to the operations. The input device 33 is, for example, a touchscreen. Alternatively, the input device 32 may include a lever or a switch. The display 33 displays images corresponding to instruction signals inputted to the display 33. The display 33 displays a screen for performing the settings for controlling the work machine 1.
[0031] The control system 10 includes a controller 30 and a storage device 36. The controller 30 is programmed so as to control the work machine 1 based on acquired data. The controller 30 includes a processor 34 such as a central processing unit (CPU), and a memory 35 such as a random access memory (RAM) and a read-only memory (ROM). The storage device 36 includes a semiconductor memory or a hard disk and the like. The storage device 36 is an example of a non-transitory recording medium that can be read by the processor 30. The storage device 36 stores programs and data for controlling the work machine 1. The controller 30 acquires operation signals from the operating device 31 and the input device 32. The controller 30 controls the work implement 3, the rotating body 4, and the traveling body 5 based on the operation signals.
[0032] The control system 10 includes a vehicle body positional sensor 41. The vehicle body positional sensor 41 detects the position of the vehicle body 2. The vehicle body positional sensor 41 is disposed on the rotating body 4. The vehicle body positional sensor 41 is a positional sensor that uses, for example, a global navigation satellite system (GNSS). The vehicle body positional sensor 41 detects the position of the rotating body 4 in a standard coordinate system. The standard coordinate system is a coordinate system that has a point of origin OW (see
[0033] The control system 10 includes a vehicle body directional sensor 42. The vehicle body directional sensor 42 is attached to the rotating body 4. The vehicle body directional sensor 42 detects the orientation of the rotating body 4.
[0034] The vehicle body directional sensor 42 is, for example, an inertial measurement unit (IMU). The vehicle body directional sensor 42 detects the yaw angle, the roll angle, and the pitch angle of the rotating body 4 as the orientation of a constituent portion. The controller 30 acquires directional data that indicates the orientation of the rotating body 4 from the vehicle body directional sensor 42.
[0035] The control system 10 includes a rotating angle sensor 46, a boom angle sensor 47, an arm angle sensor 48, and an attachment angle sensor 49. The rotating angle sensor 46 detects the rotating angle of the rotating body 4 with respect to the traveling body 5. The controller 30 calculates the orientation of the traveling body 5 from the orientation of the rotating body 4 and the rotating angle of the rotating body 4.
[0036]
[0037] The attachment angle sensor 49 is, for example, a stroke sensor. The attachment angle sensor 49 detects the stroke amount of the attachment cylinder 23. The controller 30 calculates the attachment angle 3 from the stroke amount. The arm angle sensor 48 and the boom angle sensor 47 are, for example, IMUs. Alternatively, the arm angle sensor 48 and the boom angle sensor 47 may also be stroke sensors. The attachment angle sensor 49 may also be an IMU.
[0038] Alternatively, the boom angle sensor 47, the arm angle sensor 48, and the attachment angle sensor 49 may also be angle sensors that directly detect the respective boom angle 1, the arm angle 2, and the attachment angle 3. The controller 30 acquires angle data that indicates the rotation angle, the boom angle 1, the arm angle 2, and the attachment angle 3 from the rotating angle sensor 46, the boom angle sensor 47, the arm angle sensor 48, and the attachment angle sensor 49.
[0039] Next, processing executed by the controller 30 for calculating the center of gravity position of the entire work machine 1 will be explained. In the present embodiment, the work machine 1 is divided into a plurality of constituent portions, and the center of gravity position of the entire work machine 1 is calculated from the center of gravity positions and the masses of each of the constituent portions.
[0040] As illustrated in step S1 in
[0041] In step S4, the controller 30 acquires dimensional data. The dimensional data indicates the dimensions of the constituent portions for calculating the center of gravity position of the entire work machine 1. As illustrated in
[0042] In step S5, the controller 30 acquires the center of gravity positions of the constituent portions.
[0043] The center of gravity position G1 of the rotating body 4 is represented by the coordinate system of the rotating body 4. The coordinate system of the rotating body 4 is a coordinate system fixed to the rotating body 4 and has a point of origin O1 in the rotating body 4. The center of gravity position G2 of the traveling body 5 is represented by a coordinate system of the traveling body 5. The coordinate system of the traveling body 5 is a coordinate system fixed to the traveling body 5 and has a point of origin O2 in the traveling body 5.
[0044] The center of gravity position G3 of the boom 15 is represented by a coordinate system of the boom 15. The coordinate system of the boom 15 is a coordinate system fixed to the boom 15 and has a point of origin O3 in the boom 15. The center of gravity position G4 of the arm 16 is represented by a coordinate system of the arm 16. The coordinate system of the arm 16 is a coordinate system fixed to the arm 16 and has a point of origin O4 in the arm 16. The center of gravity position G5 of the attachment 17 is represented by a coordinate system of the attachment 17. The coordinate system of the attachment 17 is a coordinate system fixed to the attachment 17 and has a point of origin O5 in the attachment 17. The controller 30 acquires the center of gravity positions G1 to G5 of the constituent portions from the storage device 36.
[0045] In step S6, the controller 30 acquires the masses of the constituent portions. The storage device 36 stores the mass of the rotating body 4, the mass of the traveling body 5, the mass of the boom 15, the mass of the arm 16, and the mass of the attachment 17. The controller 30 acquires the masses of the constituent portions from the storage device 36.
[0046] In step S7, the controller 30 acquires conversion matrices of the coordinates. The controller 30 acquires the conversion matrix of the rotating body 4, the conversion matrix of the traveling body 5, the conversion matrix of the boom 15, the conversion matrix of the arm 16, and the conversion matrix of the attachment 17. The conversion matrix of the rotating body 4 is a conversion matrix for converting the coordinate system of the rotating body 4 to the standard coordinate system. The conversion matrix of the traveling body 5 is a conversion matrix for converting the coordinate system of the traveling body 5 to the coordinate system of the rotating body 4. The conversion matrix of the boom 15 is a conversion matrix for converting the coordinate system of the boom 15 to the coordinate system of the rotating body 4. The conversion matrix of the arm 16 is a conversion matrix for converting the coordinate system of the arm 16 to the coordinate system of the boom 15. The conversion matrix of the attachment 17 is a conversion matrix for converting the coordinate system of the attachment 17 to the coordinate system of the arm 16.
[0047] The conversion matrices of the constituent portions change in response to the attitude of each constituent portion. The storage device 36 stores the positional relationships of the respective points of origin O1 to O5 of the coordinate system of the rotating body 4, the coordinate system of the traveling body 5, the coordinate system of the boom 15, the coordinate system of the arm 16, and the coordinate system of the attachment 17. The controller 30 calculates the conversion matrices of the constituent portions based on the positional relationships of the points of origin O1 to O5 in each coordinate system and the abovementioned dimensional data, positional data, directional data, and angle data.
[0048] In step S8, the controller 30 calculates the center of gravity position G0 of the entire work machine 1. The controller 30 calculates the center of gravity G0 of the entire work machine 1 based on the center of gravities G1 to G5, the masses, and the conversion matrices of the constituent portions. Specifically, the controller 30 first converts the center of gravity positions of the constituent portions to the standard coordinate system using the following equations (1) to (5).
[0049] .sup.worldP.sub.upper represents the center of gravity position G1 of the rotating body 4 in the standard coordinate system. .sup.upperP represents the center of gravity position G1 of the rotating body 4 in the coordinate system of the rotating body 4. .sup.worldT.sub.upper represents the conversion matrix for converting from the coordinate system of the rotating body 4 to the standard coordinate system.
[0050] .sup.worldP.sub.under represents the center of gravity position G2 of the traveling body 5 in the standard coordinate system. .sup.upperT.sub.under represents the conversion matrix for converting from the coordinate system of the traveling body 5 to the coordinate system of the rotating body 4. under P represents the center of gravity position G2 of the traveling body 5 in the coordinate system of the traveling body 5.
[0051] .sup.worldP.sub.boom indicates the center of gravity position G3 of the boom 15 in the standard coordinate system. .sup.upperT.sub.boom represents the conversion matrix for converting from the coordinate system of the boom 15 to the coordinate system of the rotating body 4. .sup.boomP represents the center of gravity position G3 of the boom 15 in the coordinate system of the boom 15.
[0052] .sup.worldP.sub.arm indicates the center of gravity position G4 of the arm 16 in the standard coordinate system. .sup.boomT.sub.arm represents the conversion matrix for converting from the coordinate system of the arm 16 to the coordinate system of the boom 15. .sup.armP represents the center of gravity position G4 of the arm 16 in the coordinate system of the arm 16.
[0053] .sup.worldP.sub.attachment indicates the center of gravity position G5 of the attachment 17 in the standard coordinate system. .sup.armT.sub.attachment represents the conversion matrix for converting from the coordinate system of the attachment 17 to the coordinate system of the arm 16. .sup.attachmentP indicates the center of gravity position G5 of the attachment 17 in the coordinate system of the attachment 17.
[0054] Next, the controller 30 calculates the center of gravity position G0 of the entire work machine 1 using the following equation (6).
[0055] .sup.worldP.sub.all represents the center of gravity position G0 of the entire work machine 1 in the standard coordinate system. mass.sub.upper represents the mass of the rotating body 4. mass.sub.under represents the mass of the traveling body 5. mass.sub.boom represents the mass of the boom 15. mass arm represents the mass of the arm 16. mass.sub.attachment represents the mass of the attachment 17. mass.sub.all represents the mass of the entire work machine 1.
[0056] In step S9, the controller 30 determines whether there has been an input of a parameter via the input device 32. The input device 32 receives the input of a parameter for determining the center of gravity positions of the constituent portions. Specifically, the controller 30 causes the display 33 to display the setting screens illustrated in
[0057]
[0058]
[0059]
[0060]
[0061]
[0062] When the parameter of the center of gravity position of one of the constituent portions has been inputted by means of the input device 32, the process advances to step S10. In step S10, the controller 30 updates the center of gravity position of the constituent portion for which parameter has been inputted.
[0063] For example, when the attachment 17 is replaced from bucket A to bucket B, a worker uses the input device 32 to select the bucket B on the setting screen 51 of the attachment 17.
[0064] The storage device 36 stores specification data of each type of the attachment 17. As illustrated in
[0065] Similarly for the rotating body 4, the traveling body 5, the boom 15, and the arm 16, the storage device 36 stores the respective specification data of the rotating body 4, the traveling body 5, the boom 15, and the arm 16. The specification data of the rotating body 4 includes the plurality of types of counterweights 7 and the dimensions and mass of the counterweights 7 corresponding to each of the plurality of types. When the type of the counterweight 7 is selected with the input device 32, the controller 30 updates the center of gravity position G1 of the rotating body 4 with the dimensional data and mass of the selected counterweight 7.
[0066] The specification data of the traveling body 5 includes the plurality of types of traveling bodies 5 and the dimensions and mass of the traveling bodies 5 corresponding to each of the plurality of types. When the type of the crawler belt 14 is selected with the input device 32, the controller 30 updates the center of gravity position G2 of the traveling body 5 with the dimensional data and mass of the selected crawler belt 14.
[0067] The specification data of the boom 15 includes the plurality of types of booms 15 and the dimensions and mass of the booms 15 corresponding to each of the plurality of types. When the type of the boom 15 is selected with the input device 32, the controller 30 updates the center of gravity position G3 of the boom 15 with the dimensional data and mass of the selected boom 15.
[0068] The specification data of the arm 16 includes the plurality of types of arms 16 and the dimensions and mass of the arms 16 corresponding to each of the plurality of types. When the type of the arm 16 is selected with the input device 32, the controller 30 updates the center of gravity position G4 of the arm 16 with the dimensional data and mass of the selected arm 16.
[0069] In step S11, the controller 30 updates the masses of the constituent portions. The controller updates the masse of the constituent portion for which a parameter has been inputted with the input device 32, with the abovementioned specification data. In step S12, the controller 30 updates the conversion matrix of the coordinates. The controller 30 updates the conversion matrix of the constituent portion for which a parameter has been inputted with the input device 32, with the abovementioned specification data. The process then returns to steps S1 to S8 and the controller 30 updates the center of gravity position G0 of the entire work machine 1 based on the center of gravity positions of the plurality of constituent portions that include the updated center of gravity position of the constituent portion.
[0070] For example, when the attachment 17 is replaced, the type of the attachment 17 after the replacement is selected with the input device 32 whereby the center of gravity position G5, the mass, and the conversion matrix of the attachment 17 are updated. The center of gravity position G0 of the entire work machine 1 is calculated using the updated center of gravity position G5, mass, and conversion matrix of the attachment 17 and the center of gravity positions G1 to G4, the masses, and the conversion matrices of the other constituent portions by using the abovementioned equations (1) to (6), whereby the center of gravity position G0 of the entire work machine 1 is updated.
[0071] An explanation of the dimensions in the width direction of the work machine 1 and the constituent portions has been omitted for ease of explanation in the above explanation. However, the dimensions in the width direction of the work machine 1 and the constituent portions may be taken into account in the calculation of the center of gravity positions.
[0072] As described above, the controller 30 calculates the center of gravity position G0 of the entire work machine 1. The controller 30 assesses the possibility of overturning of the work machine 1 based on the center of gravity position G0 of the entire work machine 1. For example, as illustrated in
[0073] The controller 30 may cause a warning display to be displayed on the display 33 in response to the overturning margin Q. For example, as illustrated in
[0074] The controller 30 calculates the overturning margin Q of the work machine 1 in the directions of the areas 62A to 62L. The controller 30 displays the areas 62A to 62L in different colors in accordance with the overturning margin Q. For example, the areas 62H to 62J in which the overturning margin Q is equal to or less than a threshold are displayed in a different color than the other areas.
[0075] In the control system 10 of the work machine 1 according to the present embodiment discussed above, when one portion of the constituent portions of the work machine 1 is replaced, the parameter of the constituent portion after the replacement is inputted via the input device 32 whereby the center of gravity position of said constituent portion is updated. The center of gravity position G0 of the entire work machine 1 is calculated based on the updated center of gravity position of the constituent portion. Consequently, the center of gravity position G0 of the entire work machine 1 is calculated accurately even after a portion of the constituent portions has been replaced.
[0076] Although an embodiment of the present invention has been described so far, the present invention is not limited to the above embodiment and various modifications may be made within the scope of the invention.
[0077] The work machine 1 is not limited to a hydraulic excavator and may be another work machine such as a bulldozer, a wheel loader, or a motor grader or the like. The configuration of the work implement 3 is not limited to the above embodiment and may be modified. For example, the work implement 3 is not limited to the three-axis structure of the boom 15, the arm 16, and the attachment 17 and may have four or more axes.
[0078] The work machine 1 may be a vehicle that can be remotely operated. In this case, a portion of the control system 10 may be disposed outside of the work machine 1. For example, the controller 30 may be disposed outside the work machine 1. The operating device 31, the input device 32, and the display 33 may also be disposed outside of the work machine 1. The input device 32 and the display 33 may also be a computer separate from the work machine 1. For example, the input device 32 and the display 33 may be included in a computer that is operated by a service man of the work machine 1.
[0079] The controller 30 may include a plurality of controllers separate from each other. The abovementioned processes of the controller 30 may distributed and executed among the plurality of controllers. The controller 30 may include a plurality of processors. The abovementioned processes by the controller 30 may distributed and executed among the plurality of processors.
[0080] The processing by the controller 30 is not limited to the above embodiment and may be changed. A portion of the abovementioned processing may be omitted. Alternatively, a portion of the abovementioned processing may be changed. For example, in the above embodiment, the work machine 1 is divided into the five constituent portions of the rotating body 4, the traveling body 5, the boom 15, the arm 16, and the attachment 17 in order to calculate the center of gravity position G0 of the entire work machine 1. However, the number of the constituent portions is not limited five and may be less than five or greater than five.
[0081] In the above embodiment, the controller 30 displays a warning display on the display 33 in accordance with the overturning margin Q. However, the controller 30 may also emit a warning sound in accordance with the overturning margin Q. In the above embodiment, the controller 30 calculates the overturning margin Q based on the center of gravity position G0 of the entire work machine 1. However, the controller 30 may simply display the center of gravity position G0 of the entire work machine 1 on the display 33.
[0082] In the above embodiment, the type of the constituent portion is selected as a parameter for calculating the center of gravity position of the constituent portion, using the input device 32. However, the parameter is not limited to the type of the constituent portion and may be the center of gravity position of each constituent portion. Alternatively, the parameter may be the dimensions and the mass of each constituent portion.
[0083] For example,
[0084]
[0085]
[0086] As illustrated in
[0087] According to the present invention, it is possible to accurately calculate the center of gravity position of the entire work machine even after a portion of the constituent portions have been replaced in the work machine.