WO2023100620A1 - 作業機械のためのシステム、方法、及び作業機械 - Google Patents
作業機械のためのシステム、方法、及び作業機械 Download PDFInfo
- Publication number
- WO2023100620A1 WO2023100620A1 PCT/JP2022/042062 JP2022042062W WO2023100620A1 WO 2023100620 A1 WO2023100620 A1 WO 2023100620A1 JP 2022042062 W JP2022042062 W JP 2022042062W WO 2023100620 A1 WO2023100620 A1 WO 2023100620A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- center
- gravity
- parameter
- gravity position
- controller
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Ceased
Links
Images
Classifications
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
- E02F3/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2025—Particular purposes of control systems not otherwise provided for
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/18—Counterweights
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2004—Control mechanisms, e.g. control levers
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2058—Electric or electro-mechanical or mechanical control devices of vehicle sub-units
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
- E02F9/264—Sensors and their calibration for indicating the position of the work tool
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2200/00—Type of vehicle
- B60Y2200/40—Special vehicles
- B60Y2200/41—Construction vehicles, e.g. graders, excavators
- B60Y2200/412—Excavators
Definitions
- the present invention relates to systems, methods, and working machines for working machines.
- a known technique is to calculate the position of the center of gravity of the entire work machine and determine the possibility of the work machine overturning.
- a lumped mass point model is used as a calculation model for determining the center-of-gravity position of a hydraulic excavator.
- the lumped mass model considers the mass to be concentrated at the center of gravity of each excavator component.
- a hydraulic excavator includes a boom, an arm, a bucket, a revolving body, and a traveling body.
- the center-of-gravity position of the hydraulic excavator is determined by synthesizing the center-of-gravity position of the boom, the center-of-gravity position of the arm, the center-of-gravity position of the bucket, the center-of-gravity position of the revolving body, and the center-of-gravity position of the traveling body.
- the excavator bucket may be replaced with another type of attachment.
- the counterweight of the rotating body may be replaced with one of a different specification.
- the center-of-gravity position of the component after replacement changes from the center-of-gravity position of the component before replacement. Therefore, it becomes difficult to accurately calculate the position of the center of gravity of the entire work machine.
- a system is a system for a work machine having multiple components including a first portion.
- the system includes a storage device, an input device, and a controller.
- the storage device stores the center-of-gravity position of each of the plurality of components.
- the input device receives input of a first parameter for determining the center-of-gravity position of the first portion.
- the controller calculates the center-of-gravity position of the entire work machine based on the center-of-gravity positions of the plurality of components.
- the controller sets the center-of-gravity position of the first portion using the first parameter when the input device inputs the first parameter.
- the controller sets the center-of-gravity position of the entire work machine based on the center-of-gravity positions of the plurality of components including the set center-of-gravity position of the first portion.
- a method is a method for controlling a work machine having a plurality of components including a first portion.
- the method includes acquiring the center-of-gravity position of each of a plurality of component parts, calculating the center-of-gravity position of the entire work machine based on the center-of-gravity positions of the plurality of component parts, and inputting a first accepting input of a first parameter for determining the position of the center of gravity of the portion; setting the position of the center of gravity of the first portion using the first parameter when the first parameter is input by the input device; setting the center-of-gravity position of the entire work machine based on the center-of-gravity positions of the plurality of components including the center-of-gravity position of the first portion.
- a work machine includes a plurality of components, a storage device, an input device, and a controller.
- the plurality of component parts includes a first part.
- the storage device stores the center-of-gravity position of each of the plurality of components.
- the input device receives input of a first parameter for determining the center-of-gravity position of the first portion.
- the controller calculates the center-of-gravity position of the entire work machine based on the center-of-gravity positions of the plurality of components.
- the controller sets the center-of-gravity position of the first portion using the first parameter when the first parameter is input by the input device.
- the controller sets the center-of-gravity position of the entire working machine based on the center-of-gravity positions of the plurality of components including the set center-of-gravity position of the first portion.
- the first parameter of the replaced first portion is input via the input device, thereby setting the center-of-gravity position of the first portion. be. Then, based on the set center-of-gravity position of the first portion, the center-of-gravity position of the entire working machine is calculated. As a result, even after the first component is replaced, the center-of-gravity position of the entire work machine can be calculated with high accuracy.
- FIG. 1 is a side view of a working machine according to an embodiment;
- FIG. 1 is a block diagram showing the configuration of a control system for a working machine;
- FIG. It is a figure which shows the structure of a working machine typically.
- 4 is a flowchart showing processing for calculating the center-of-gravity position of the entire working machine;
- FIG. 4 is a diagram showing the positions of the center of gravity of multiple components of the work machine; It is a figure which shows an example of the setting screen of an attachment. It is a figure which shows an example of the setting screen of an arm. It is a figure which shows an example of the setting screen of a boom.
- FIG. 1 is a side view of a working machine according to an embodiment;
- FIG. 1 is a block diagram showing the configuration of a control system for a working machine;
- FIG. It is a figure which shows the structure of a working machine typically.
- 4 is a flowchart showing processing for calculating the center-of-gravity position of
- FIG. 10 is a diagram showing an example of a setting screen for a revolving body; It is a figure which shows an example of the setting screen of a moving body. It is a figure which shows an example of specification data. It is a figure which shows the calculation method of the fall margin. It is a figure which shows an example of the screen which shows the possibility of falling. It is a figure which shows an example of the setting screen of the attachment which concerns on a modification. It is a figure which shows an example of the setting screen of a boom and an arm which concerns on a modification.
- FIG. 11 is a diagram showing an example of a setting screen for a revolving body and a traveling body according to a modification;
- FIG. 1 is a side view of a work machine 1 according to an embodiment.
- a working machine 1 includes a vehicle body 2 and a working machine 3 .
- the vehicle body 2 includes a revolving body 4 and a traveling body 5 .
- the revolving body 4 is rotatably supported with respect to the traveling body 5 .
- An operator's cab 6 is arranged in the revolving body 4 .
- a counterweight 7 is attached to the revolving body 4 .
- the revolving body 4 includes a drive source 11 and a hydraulic pump 12 .
- the drive source 11 is, for example, an internal combustion engine. However, the drive source 11 may be an electric motor or a hybrid mechanism of an engine and an electric motor.
- the hydraulic pump 12 is driven by the drive source 11 and discharges hydraulic oil.
- the work machine 1 has a swing motor 13 . Hydraulic oil discharged from the hydraulic pump 1224 is supplied to the swing motor 13 . Thereby, the turning motor 13 turns the turning body 4 .
- Running body 5 includes crawler belts 14 . The work machine 1 travels as the crawler belt 14 rotates.
- the work machine 3 is attached to the vehicle body 2.
- the working machine 3 is operable with respect to the vehicle body 2 .
- Work implement 3 includes boom 15 , arm 16 , and attachment 17 .
- Boom 15 is rotatably attached to vehicle body 2 via boom pin 18 .
- Arm 16 is rotatably attached to boom 15 via arm pin 19 .
- Attachment 17 is rotatably attached to arm 16 via attachment pin 20 .
- the work machine 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, respectively.
- 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 15 is operated by the expansion and contraction of the boom cylinder 21 .
- the arm 16 operates.
- the attachment 17 is operated by the extension and contraction of the attachment cylinder 23 .
- FIG. 2 is a block diagram showing the control system 10 of the work machine 1.
- the control system 10 includes an operating device 31 , an input device 32 and a display 33 .
- the operating device 31 , the input device 32 and the display 33 are arranged in the driver's cab 6 .
- the operation device 31 is a device for operating the working machine 3 , the revolving body 4 , and the traveling body 5 .
- the operation device 31 receives an operator's operation for driving the working machine 3, the revolving body 4, and the traveling body 5, and outputs an operation signal according to the operation.
- the operating device 31 includes, for example, levers, pedals, switches, and the like.
- the input device 32 receives an operator's operation for setting the control of the working machine 1, and outputs an operation signal according to the operation.
- Input device 32 is, for example, a touch screen.
- input device 32 may include a lever or switch.
- the display 33 displays an image according to the command signal input to the display 33 .
- the display 33 displays a screen for setting the control of the work machine 1 .
- the control system 10 includes a controller 30 and a storage device 36.
- Controller 30 is programmed to control work machine 1 based on the acquired data.
- the controller 30 includes a processor 34 such as a CPU (Central Processing Unit), and a memory 35 such as RAM (Random Access Memory) and ROM (Read Only Memory).
- the storage device 36 includes a semiconductor memory, hard disk, or the like. Storage device 36 is an example of a recording medium readable by non-transitory controller 30 .
- the storage device 36 stores programs and data for controlling the work machine 1 .
- the controller 30 acquires operation signals from the operation device 31 and the input device 32 .
- the controller 30 controls the working machine 3, the revolving body 4, and the traveling body 5 based on the operation signal.
- the control system 10 includes a vehicle body position sensor 41.
- a vehicle body position sensor 41 detects the position of the vehicle body 2 .
- a vehicle body position sensor 41 is arranged on the revolving body 4 .
- the vehicle body position sensor 41 is, for example, a position sensor using GNSS (Global Navigation Satellite System).
- the vehicle body position sensor 41 detects the position of the revolving superstructure 4 in the reference coordinate system.
- the reference coordinate system has an origin OW (see FIG. 5) outside the work machine 1, and is a coordinate system following the world geodetic system, for example.
- the controller 30 acquires position data indicating the position of the revolving structure 4 from the vehicle body position sensor 41 .
- the control system 10 has a vehicle body direction sensor 42 .
- the vehicle body direction sensor 42 is attached to the revolving body 4 .
- a vehicle body direction sensor 42 detects the direction of the revolving structure 4 .
- the vehicle body direction sensor 42 is, for example, an inertial measurement unit (IMU).
- IMU inertial measurement unit
- the vehicle body direction sensor 42 detects the yaw angle, roll angle, and pitch angle of the revolving body 4 as the directions of the components.
- the controller 30 acquires direction data indicating the direction of the revolving structure 4 from the vehicle body direction sensor 42 .
- the control system 10 includes a turning angle sensor 46 , a boom angle sensor 47 , an arm angle sensor 48 and an attachment angle sensor 49 .
- the turning angle sensor 46 detects the turning angle of the turning body 4 with respect to the traveling body 5 .
- the controller 30 calculates the orientation of the traveling structure 5 from the orientation of the revolving structure 4 and the turning angle of the revolving structure 4 .
- FIG. 3 is a diagram schematically showing the configuration of the working machine 1.
- a boom angle sensor 47 detects a boom angle ⁇ 1.
- a boom angle ⁇ 1 indicates an inclination angle of the boom 15 with respect to the revolving body 4 .
- An arm angle sensor 48 detects an arm angle ⁇ 2.
- An arm angle ⁇ 2 indicates the tilt angle of the arm 16 with respect to the boom 15 .
- An attachment angle sensor 49 detects an attachment angle ⁇ 3.
- An attachment angle ⁇ 3 indicates the angle of inclination of the attachment 17 with respect to the arm 16 .
- the attachment angle sensor 49 is, for example, a stroke sensor.
- An 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 boom angle sensor 47 are, for example, IMUs. Alternatively, the arm angle sensor 48 and the boom angle sensor 47 may be stroke sensors. Attachment angle sensor 49 may be an IMU.
- the boom angle sensor 47, the arm angle sensor 48, and the attachment angle sensor 49 may be angle sensors that directly detect the boom angle ⁇ 1, the arm angle ⁇ 2, and the attachment angle ⁇ 3, respectively.
- the controller 30 uses the turning angle sensor 46, the boom angle sensor 47, the arm angle sensor 48, and the attachment angle sensor 49 to determine the turning angle, the boom angle ⁇ 1, the arm angle ⁇ 2, and the attachment angle ⁇ 3. Get data.
- FIG. 4 is a flow chart showing processing for calculating the center-of-gravity position of the entire work machine 1 .
- step S1 the controller 30 acquires position data.
- the controller 30 acquires the position of the revolving superstructure 4 on the reference coordinate system from the position data.
- step S2 the controller 30 acquires direction data.
- the controller 30 acquires the orientation of the revolving superstructure 4 from the orientation data.
- step S3 the controller 30 acquires angle data.
- the controller 30 acquires the swing angle, the boom angle ⁇ 1, the arm angle ⁇ 2, and the attachment angle ⁇ 3 from the angle data.
- step S4 the controller 30 acquires dimension data.
- the dimension data indicates the dimension of each component for calculating the center-of-gravity position of the working machine 1 as a whole.
- the dimension data includes, for example, boom length L1, arm length L2, and attachment length L3.
- Boom length L1 is the length between boom pin 18 and arm pin 19 .
- Arm length L2 is the length between arm pin 19 and attachment pin 20 .
- the attachment length is the length between the attachment pin 20 and the tip P ⁇ b>1 of the attachment 17 .
- the dimensional data are stored in the storage device 36 .
- the controller 30 acquires dimensional data from the storage device 36 .
- step S5 the controller 30 acquires the center-of-gravity position of the component.
- FIG. 5 is a diagram showing the positions of the center of gravity of a plurality of components of work machine 1.
- the storage device 36 stores the center-of-gravity position G1 of the revolving structure 4, the center-of-gravity position G2 of the traveling structure 5, the center-of-gravity position G3 of the boom 15, the center-of-gravity position G4 of the arm 16, and the center-of-gravity position G5 of the attachment 17.
- the center-of-gravity position G1 of the revolving body 4 is represented by the coordinate system of the revolving body 4 .
- the coordinate system of the revolving body 4 is a coordinate system fixed to the revolving body 4 and has an origin O1 on the revolving body 4 .
- the center-of-gravity position G2 of the traveling body 5 is represented by the coordinate system of the traveling body 5 .
- the coordinate system of the running body 5 is a coordinate system fixed to the running body 5 and has an origin O2 on the running body 5 .
- the center-of-gravity position G3 of the boom 15 is expressed in the coordinate system of the boom 15.
- a coordinate system of the boom 15 is a coordinate system fixed to the boom 15 and has an origin O3 at the boom 15 .
- the center-of-gravity position G4 of the arm 16 is represented by the coordinate system of the arm 16.
- a coordinate system of the arm 16 is a coordinate system fixed to the arm 16 and has an origin O4 at the arm 16 .
- a center-of-gravity position G5 of the attachment 17 is represented by the coordinate system of the attachment 17 .
- a coordinate system of the attachment 17 is a coordinate system fixed to the attachment 17 and has an origin O5 at the attachment 17 .
- the controller 30 obtains the center-of-gravity positions G1-G5 of each component from the storage device .
- the controller 30 acquires the weight of the component.
- the storage device 36 stores the weight of the revolving structure 4 , the weight of the traveling structure 5 , the weight of the boom 15 , the weight of the arm 16 and the weight of the attachment 17 .
- Controller 30 obtains the weight of each component from storage device 36 .
- step S7 the controller 30 acquires a coordinate transformation matrix.
- the controller 30 acquires the transformation matrix of the revolving body 4 , the transformation matrix of the traveling body 5 , the transformation matrix of the boom 15 , the transformation matrix of the arm 16 , and the transformation matrix of the attachment 17 .
- the transformation matrix of the revolving body 4 is a transformation matrix from the coordinate system of the revolving body 4 to the reference coordinate system.
- the transformation matrix of the running body 5 is a transformation matrix from the coordinate system of the running body 5 to the coordinate system of the revolving body 4 .
- the transformation matrix of the boom 15 is a transformation matrix from the coordinate system of the boom 15 to the coordinate system of the revolving structure 4 .
- a transformation matrix of the arm 16 is a transformation matrix from the coordinate system of the arm 16 to the coordinate system of the boom 15 .
- a transformation matrix of the attachment 17 is a transformation matrix from the coordinate system of the attachment 17 to the coordinate system of the arm 16 .
- the transformation matrix of each component changes according to the posture of each component.
- the storage device 36 stores the positions of the origins O1-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 transformation matrix of each component based on the positional relationship of the origins O1-O5 of each coordinate system, the above-described dimension data, position data, direction data, and angle data.
- step S8 the controller 30 calculates the center-of-gravity position G0 of the work machine 1 as a whole.
- the controller 30 calculates the center-of-gravity position G0 of the work machine 1 as a whole based on the center-of-gravity positions G1 to G5, the weights, and the transformation matrix of each component.
- the controller 30 first transforms the position of the center of gravity of each component into the reference coordinate system using the following equations (1) to (5).
- world P upper world T upper upper P (1)
- world P under world T upper upper T under under P
- world P boom world T upper upper T boom boom P
- world P arm world T upper upper T boom boom T arm P (4)
- world P attachment world T upper upper T boom boom T arm T attachment attachment P (5)
- World P upper indicates the center-of-gravity position G1 of the revolving body 4 in the reference coordinate system.
- Upper P indicates the center-of-gravity position G1 of the revolving body 4 in the coordinate system of the revolving body 4 .
- world T upper indicates a transformation matrix from the coordinate system of the revolving body 4 to the reference coordinate system.
- World P under indicates the center-of-gravity position G2 of the traveling body 5 in the reference coordinate system.
- Upper T under indicates a transformation matrix from the coordinate system of the traveling body 5 to the coordinate system of the revolving body 4 .
- under P indicates the center-of-gravity position G2 of the running body 5 in the coordinate system of the running body 5 .
- world P boom indicates the center-of-gravity position G3 of the boom 15 in the reference coordinate system.
- upper T boom indicates a transformation matrix from the coordinate system of the boom 15 to the coordinate system of the revolving structure 4 .
- boom P indicates the center-of-gravity position G3 of the boom 15 in the coordinate system of the boom 15 .
- a world P arm indicates the center-of-gravity position G4 of the arm 16 in the reference coordinate system.
- boom T arm indicates a transformation matrix from the arm 16 coordinate system to the boom 15 coordinate system.
- arm P indicates the center-of-gravity position G4 of the arm 16 in the coordinate system of the arm 16;
- attachment P indicates the center-of-gravity position G5 of the attachment 17 in the reference coordinate system.
- arm T attachment indicates a transformation matrix from the coordinate system of attachment 17 to the coordinate system of arm 16 .
- attachment P indicates the center-of-gravity position G5 of the attachment 17 in the coordinate system of the attachment 17;
- controller 30 calculates the center-of-gravity position G0 of the entire work machine 1 using the following equation (6).
- world P all ( world P upper mass upper + world P under mass under + world P boom mass boom + world P arm mass arm + world P attachment mass attachment ) / mass all (6)
- World Pall indicates the center-of-gravity position G0 of the entire work machine 1 in the reference coordinate system.
- mass upper indicates the weight of the revolving body 4;
- mass under indicates the weight of the traveling body 5;
- mass boom indicates the weight of the boom 15;
- mass arm indicates the weight of the arm 16;
- mass attachment indicates the weight of the attachment 17;
- mass all indicates the weight of the working machine 1 as a whole.
- step S9 the controller 30 determines whether a parameter has been input via the input device 32.
- the input device 32 receives input of parameters for determining the center-of-gravity position of each component.
- the controller 30 causes the display 33 to display the setting screens shown in FIGS.
- FIG. 6 is a diagram showing an example of the setting screen 51 of the attachment 17.
- FIG. A plurality of types of the attachment 17 are displayed on the setting screen 51 of the attachment 17 .
- a plurality of types of attachments 17 indicates types of attachments 17 having different dimensions and/or weights or functions.
- the operator uses the input device 32 to select the type of attachment 17 after replacement.
- the controller 30 acquires the selected type of attachment 17 as a parameter of the center-of-gravity position G5 of the attachment 17 .
- FIG. 7 is a diagram showing an example of the setting screen 52 of the arm 16.
- FIG. A plurality of types of arms 16 are displayed on the arm 16 setting screen 52 . Multiple types of arms 16 refer to multiple types of arms 16 with different dimensions and/or weights.
- the operator uses the input device 32 to select the type of arm 16 after replacement.
- the controller 30 acquires the selected type of the arm 16 as a parameter of the center-of-gravity position G4 of the arm 16 .
- FIG. 8 is a diagram showing an example of the setting screen 53 of the boom 15.
- FIG. A plurality of types of booms 15 are displayed on the setting screen 53 of the boom 15 .
- Multiple types of booms 15 refer to multiple types of booms 15 with different dimensions and/or weights.
- the controller 30 acquires the selected type of boom 15 as a parameter of the center-of-gravity position G3 of the boom 15 .
- FIG. 9 is a diagram showing an example of the setting screen 54 of the revolving body 4.
- a plurality of types of the counterweight 7 are displayed on the setting screen 54 of the revolving body 4 .
- a plurality of types of counterweights 7 indicates a plurality of types of counterweights 7 having different dimensions and/or weights.
- the operator uses the input device 32 to select the type of counterweight 7 after replacement.
- the controller 30 acquires the selected type of the counterweight 7 as a parameter of the center-of-gravity position G1 of the revolving superstructure 4 .
- FIG. 10 is a diagram showing an example of the setting screen 55 of the moving object 5.
- FIG. A plurality of types of crawler belts 14 are displayed on the setting screen 55 of the traveling body 5 .
- Multiple types of tracks 14 refer to multiple types of tracks 14 that differ in size and/or weight.
- the controller 30 acquires the selected type of crawler belt 14 as a parameter of the center-of-gravity position G2 of the traveling body 5 .
- step S10 the controller 30 updates the center-of-gravity position of the component for which the parameter is input.
- the worker selects the bucket B using the input device 32 on the setting screen 51 of the attachment 17 .
- the storage device 36 stores specification data for each type of attachment 17 .
- the specification data 56 includes a plurality of types of attachments 17 and the dimensions and weights of the attachments 17 corresponding to each of the plurality of types.
- the dimensions of the attachment 17 include, for example, the attachment length L3 mentioned above.
- the controller 30 updates the dimensional data and weight of the attachment 17 with the dimensions and weight corresponding to the selected type.
- the controller 30 also updates the center-of-gravity position G5 of the attachment 17 with the updated dimension data and weight of the attachment 17 .
- the storage device 36 stores the specification data of each of the rotating body 4, the traveling body 5, the boom 15, and the arm 16 for the rotating body 4, the traveling body 5, the boom 15, and the arm 16.
- the specification data of the revolving body 4 includes a plurality of types of counterweights 7 and the dimensions and weights of the counterweights 7 corresponding to each of the plurality of types.
- the controller 30 updates the center-of-gravity position G1 of the revolving structure 4 with the dimensional data and weight of the selected counterweight 7.
- the specification data of the running body 5 includes multiple types of the running body 5 and the dimensions and weights of the running body 5 corresponding to each of the multiple types.
- controller 30 updates center-of-gravity position G ⁇ b>2 of traveling body 5 with the dimensional data and weight of selected crawler belt 14 .
- the specification data of the boom 15 includes multiple types of booms 15 and the dimensions and weights of the booms 15 corresponding to each of the multiple types.
- the controller 30 updates the center-of-gravity position G3 of the boom 15 based on the dimension data and weight of the selected boom 15.
- the specification data of the arm 16 includes multiple types of the arm 16 and the dimensions and weight of the arm 16 corresponding to each of the multiple types.
- the controller 30 updates the center-of-gravity position G4 of the arm 16 with the dimension data and weight of the selected arm 16.
- the controller 30 updates the weight of the component.
- the controller 30 updates the weights of the components whose parameters have been entered by the input device 32 with the specification data described above.
- the controller 30 updates the coordinate transformation matrix.
- the controller 30 updates the transformation matrix of the component whose parameters are input by the input device 32 with the above-described specification data.
- the process returns to steps S1 to S8, and the controller 30 updates the center-of-gravity position G0 of the entire working machine 1 based on the center-of-gravity positions of the plurality of components including the updated center-of-gravity positions of the components.
- the input device 32 selects the type of the attachment 17 after replacement, thereby updating the center-of-gravity position G5, the weight, and the conversion matrix of the attachment 17. Then, based on the above-described formulas (1) to (6), the updated center-of-gravity position G5, weight, and conversion matrix of the attachment 17, and the updated center-of-gravity positions G1 to G4, weights, and conversion matrices of the other constituent parts of the working machine By calculating the center-of-gravity position G0 of the entire work machine 1, the center-of-gravity position G0 of the entire work machine 1 is updated.
- the controller 30 calculates the center-of-gravity position G0 of the work machine 1 as a whole.
- the controller 30 determines the possibility of the overturn of the work machine 1 based on the center-of-gravity position G ⁇ b>0 of the work machine 1 as a whole.
- the controller 30 may determine the possibility of overturning of the work machine 1 based on the overturn margin Q.
- FIG. The overturn margin Q is indicated by the difference between the maximum height H1 of the trajectory A1 drawn by the center of gravity position G0 of the entire work machine 1 and the initial height H0 of the center of gravity position when the work machine 1 overturns. The greater the overturn margin Q, the lower the possibility of overturn.
- the controller 30 may display a warning display on the display 33 according to the fall margin Q. For example, as shown in FIG. 13, the controller 30 may cause the display 33 to display a screen 57 indicating the possibility of falling. On the screen 57 indicating the possibility of overturning, an image 61 of the working machine 1 and areas 62A to 62L obtained by dividing the surroundings of the working machine 1 into a plurality of areas are displayed.
- the controller 30 calculates the overturn margin Q of the work machine 1 in the direction of each of the areas 62A-62L.
- the controller 30 displays the areas 62A-62L in different colors according to the fall margin Q.
- FIG. For example, the areas 62H to 62J where the fall margin Q is equal to or less than the threshold are displayed in a different color from the other areas.
- the parameters of the components after replacement are input via the input device 32.
- the position of the center of gravity of the component is updated.
- the center-of-gravity position G0 of the entire work machine 1 is calculated based on the updated center-of-gravity positions of the components.
- the center-of-gravity position G0 of the entire work machine 1 can be accurately calculated even after part of the components are replaced.
- the work machine 1 is not limited to the hydraulic excavator described above, and may be other work machines such as a bulldozer, a wheel loader, or a motor grader.
- the structure of the working machine 3 is not limited to that of the embodiment described above, and may be modified.
- the work machine 3 is not limited to the three-axis structure of the boom 15, the arm 16, and the attachment 17, and may have a four-axis or more structure.
- the work machine 1 may be a remotely controllable vehicle. In that case, part of control system 103 may be located external to work machine 1 .
- the controller 30 may be arranged outside the work machine 1 .
- the operating device 31 , the input device 32 and the display 33 may be arranged outside the working machine 1 .
- the input device 32 and the display 33 may be computers separate from the work machine 1 .
- input device 32 and display 33 may be included in a computer operated by a service person for work machine 1 .
- the controller 30 may include a plurality of controllers separate from each other. The processing by the controller 30 described above may be distributed to and executed by a plurality of controllers. Controller 30 may include multiple processors. The processing by the controller 30 described above may be distributed to and executed by a plurality of processors.
- the processing by the controller 30 is not limited to the above embodiment, and may be modified. A part of the processing described above may be omitted. Alternatively, part of the processing described above may be changed.
- the work machine 1 in order to calculate the center of gravity position G0 of the entire work machine 1, the work machine 1 is divided into five components: the revolving body 4, the traveling body 5, the boom 15, the arm 16, and the attachment 17. It is However, the number of components is not limited to five and may be less than five or more than five.
- the controller 30 displays a warning display on the display 33 according to the fall margin Q.
- the controller 30 may emit a warning sound according to the fall margin Q.
- the controller 30 calculates the overturn margin Q based on the center-of-gravity position G0 of the work machine 1 as a whole.
- the controller 30 may simply display the center-of-gravity position G ⁇ b>0 of the entire work machine 1 on the display 33 .
- the type of component is selected using the input device 32 as a parameter for calculating the position of the center of gravity of the component.
- the parameter is not limited to the type of component, and may be the position of the center of gravity of each component.
- the parameters may be the dimensions and weight of each component.
- FIG. 14 is a diagram showing an example of the setting screen 58 of the attachment 17 according to the modification.
- the setting screen 58 for the attachment 17 may include an input field 71 for the dimensions of the attachment 17 and an input field 72 for the weight.
- FIG. 15 is a diagram showing an example of a setting screen 59 for the boom 15 and arm 16 according to the modification.
- the setting screen 59 for the boom 15 and the arm 16 may include an input field 73 for the dimensions of the boom 15 and an input field 74 for the weight.
- the setting screen 59 for the boom 15 and the arm 16 may include an input field 75 for the dimensions of the arm 16 and an input field 76 for the weight.
- FIG. 16 is a diagram showing an example of a setting screen 60 for the revolving body 4 and the traveling body 5 according to the modification.
- the setting screen 60 for the revolving structure 4 and the traveling structure 5 may include input fields 77A and 77B for the dimensions of the revolving structure 4 and an input field 78 for the weight.
- the setting screen 60 for the revolving body 4 and the traveling body 5 may include an input field for the dimensions of the counterweight 7 and an input field for the weight.
- the setting screen 60 for the revolving body 4 and the traveling body 5 may include input fields 79A-79C for the dimensions of the traveling body 5 and an input field 80 for the weight.
- the setting screen 60 for the revolving body 4 and the traveling body 5 may include an input field for the dimensions of the crawler belt 14 and an input field for the weight.
Landscapes
- Engineering & Computer Science (AREA)
- Mining & Mineral Resources (AREA)
- Civil Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Mechanical Engineering (AREA)
- Operation Control Of Excavators (AREA)
- Component Parts Of Construction Machinery (AREA)
Abstract
Description
world P upper= world T upper upper P (1)
world Punder = world T upper upper T under under P (2)
world Pboom = world T upper upper T boom boom P (3)
world Parm = world T upper upper T boom boom T arm arm P (4)
world Pattachment = world T upper upper Tboom boom T arm arm T attachment attachment P (5)
world Pall = (world P upper ・ mass upper + world P under ・ mass under + world P boom ・ mass boom + world P arm ・ mass arm + world P attachment ・ mass attachment ) / mass all (6)
3:作業機
4:旋回体
5:走行体
7:カウンタウェイト
14:履帯
17:アタッチメント
36:記憶装置
32:入力装置
30:コントローラ
G0:作業機械全体の重心位置
G1-G5:構成部分の重心位置
Claims (16)
- 第1部分を含む複数の構成部分を有する作業機械のためのシステムであって、
前記複数の構成部分のそれぞれの重心位置を記憶している記憶装置と、
前記第1部分の重心位置を決定するための第1パラメータの入力を受け付ける入力装置と、
コントローラと、
を備え、
前記コントローラは、
前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を算出し、
前記入力装置によって前記第1パラメータが入力されたときには、前記第1パラメータによって、前記第1部分の重心位置を設定し、
設定された前記第1部分の重心位置を含む前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を設定する、
システム。 - 前記記憶装置は、前記第1部分の複数の種類と、前記複数の種類のそれぞれに対応する前記第1部分の寸法と重量とを含む仕様データを記憶しており、
前記第1パラメータは、前記第1部分の複数の種類から選択される、
請求項1に記載のシステム。 - 前記第1パラメータは、前記第1部分の寸法と重量とを含む、
請求項1に記載のシステム。 - 前記第1パラメータは、前記第1部分の重心位置を含む、
請求項1に記載のシステム。 - 前記複数の構成部分は、第2部分をさらに含み、
前記入力装置は、前記第2部分の重心位置を決定するための第2パラメータの入力を受け付け、
前記コントローラは、前記入力装置によって前記第2パラメータが入力されたときには、前記第2パラメータによって、前記第2部分の重心位置を設定し、
設定された前記第2部分の重心位置を含む前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を設定する、
請求項1から4のいずれかに記載のシステム。 - 前記記憶装置は、前記第2部分の複数の種類と、前記複数の種類のそれぞれに対応する前記第2部分の寸法と重量とを含む仕様データを記憶しており、
前記第2パラメータは、前記第2部分の複数の種類のいずれかから選択される、
請求項5に記載のシステム。 - 前記第2パラメータは、前記第2部分の寸法と重量とを含む、
請求項5に記載のシステム。 - 前記第2パラメータは、前記第2部分の重心位置を含む、
請求項5に記載のシステム。 - ディスプレイをさらに備え、
前記コントローラは、前記第1パラメータの入力欄を前記ディスプレイに表示させる、
請求項1から4のいずれかに記載のシステム。 - ディスプレイをさらに備え、
前記コントローラは、前記第2パラメータの入力欄を前記ディスプレイに表示させる、
請求項5から8のいずれかに記載のシステム。 - 前記作業機械は、
車体と、
交換可能なアタッチメントを含み、前記車体に対して動作可能な作業機と、
を有し、
前記第1部分は、前記アタッチメントである、
請求項1から10に記載のシステム。 - 前記作業機械は、カウンタウェイトを含む旋回体を有し、
前記第1部分は、前記旋回体であり、
前記第1パラメータは、前記カウンタウェイトの種類、又は、前記カウンタウェイトの寸法及び重量を示す、
請求項1から10のいずれかに記載のシステム。 - 前記作業機械は、履帯を含む走行体を有し、
前記第1部分は、前記走行体であり、
前記第1パラメータは、前記履帯の種類、又は、前記履帯の寸法及び重量を示す、
請求項1から10のいずれかに記載のシステム。 - 第1部分を含む複数の構成部分を有する作業機械を制御するための方法であって、
前記複数の構成部分のそれぞれの重心位置を取得することと、
前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を算出することと、
入力装置を介して、前記第1部分の重心位置を決定するための第1パラメータの入力を受け付けることと、
前記入力装置によって前記第1パラメータが入力されたときには、前記第1パラメータによって、前記第1部分の重心位置を設定することと、
設定された前記第1部分の重心位置を含む前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を設定すること、
を備える方法。 - 前記複数の構成部分は、第2部分をさらに含み、
前記入力装置は、前記第2部分の重心位置を決定するための第2パラメータの入力を受け付け、
前記入力装置によって前記第2パラメータが入力されたときには、前記第2パラメータによって、前記第2部分の重心位置を設定することと、
設定された前記第2部分の重心位置を含む前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を設定すること、
をさらに備える請求項14に記載の方法。 - 作業機械であって、
第1部分を含む複数の構成部分と、
前記複数の構成部分のそれぞれの重心位置を記憶している記憶装置と、
前記第1部分の重心位置を決定するための第1パラメータの入力を受け付ける入力装置と、
コントローラと、
を備え、
前記コントローラは、
前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を算出し、
前記入力装置によって前記第1パラメータが入力されたときには、前記第1パラメータによって、前記第1部分の重心位置を設定し、
設定された前記第1部分の重心位置を含む前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を設定する、
作業機械。
Priority Applications (4)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| KR1020247008312A KR20240042101A (ko) | 2021-11-30 | 2022-11-11 | 작업 기계를 위한 시스템, 방법, 및 작업 기계 |
| US18/703,759 US12584290B2 (en) | 2021-11-30 | 2022-11-11 | System for controlling work machine, method, and work machine |
| DE112022004302.4T DE112022004302T5 (de) | 2021-11-30 | 2022-11-11 | System zur steuerung einer arbeitsmaschine, verfahren und arbeitsmaschine |
| CN202280066848.7A CN118103570A (zh) | 2021-11-30 | 2022-11-11 | 用于作业机械的系统、方法以及作业机械 |
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2021-194901 | 2021-11-30 | ||
| JP2021194901A JP7760348B2 (ja) | 2021-11-30 | 2021-11-30 | 作業機械のためのシステム、方法、及び作業機械 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| WO2023100620A1 true WO2023100620A1 (ja) | 2023-06-08 |
Family
ID=86612039
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| PCT/JP2022/042062 Ceased WO2023100620A1 (ja) | 2021-11-30 | 2022-11-11 | 作業機械のためのシステム、方法、及び作業機械 |
Country Status (6)
| Country | Link |
|---|---|
| US (1) | US12584290B2 (ja) |
| JP (1) | JP7760348B2 (ja) |
| KR (1) | KR20240042101A (ja) |
| CN (1) | CN118103570A (ja) |
| DE (1) | DE112022004302T5 (ja) |
| WO (1) | WO2023100620A1 (ja) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP7398422B2 (ja) * | 2021-12-03 | 2023-12-14 | 株式会社小松製作所 | 作業機械 |
| US12516508B2 (en) | 2023-08-31 | 2026-01-06 | Caterpillar Sarl | System, method, and non-transitory computer-readable storage medium for work machine guidance |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH0674661U (ja) * | 1993-03-31 | 1994-10-21 | 住友建機株式会社 | 建設機械の旋回転倒防止装置 |
| JPH07207711A (ja) * | 1994-01-11 | 1995-08-08 | Yutani Heavy Ind Ltd | 建設機械の転倒防止装置 |
| JP2020125594A (ja) * | 2019-02-01 | 2020-08-20 | 株式会社小松製作所 | 建設機械の制御システム、建設機械、及び建設機械の制御方法 |
| JP2021059842A (ja) * | 2019-10-03 | 2021-04-15 | ヤンマーパワーテクノロジー株式会社 | 建設機械 |
| JP2021152275A (ja) * | 2020-03-24 | 2021-09-30 | 日立建機株式会社 | 作業機械 |
Family Cites Families (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| ITUB20155602A1 (it) * | 2015-11-16 | 2017-05-16 | Sandro Dini | Zavorra per macchina operatrice. |
| JP6860458B2 (ja) | 2017-09-15 | 2021-04-14 | 日立建機株式会社 | 作業機械 |
-
2021
- 2021-11-30 JP JP2021194901A patent/JP7760348B2/ja active Active
-
2022
- 2022-11-11 KR KR1020247008312A patent/KR20240042101A/ko active Pending
- 2022-11-11 WO PCT/JP2022/042062 patent/WO2023100620A1/ja not_active Ceased
- 2022-11-11 DE DE112022004302.4T patent/DE112022004302T5/de active Pending
- 2022-11-11 US US18/703,759 patent/US12584290B2/en active Active
- 2022-11-11 CN CN202280066848.7A patent/CN118103570A/zh active Pending
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH0674661U (ja) * | 1993-03-31 | 1994-10-21 | 住友建機株式会社 | 建設機械の旋回転倒防止装置 |
| JPH07207711A (ja) * | 1994-01-11 | 1995-08-08 | Yutani Heavy Ind Ltd | 建設機械の転倒防止装置 |
| JP2020125594A (ja) * | 2019-02-01 | 2020-08-20 | 株式会社小松製作所 | 建設機械の制御システム、建設機械、及び建設機械の制御方法 |
| JP2021059842A (ja) * | 2019-10-03 | 2021-04-15 | ヤンマーパワーテクノロジー株式会社 | 建設機械 |
| JP2021152275A (ja) * | 2020-03-24 | 2021-09-30 | 日立建機株式会社 | 作業機械 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN118103570A (zh) | 2024-05-28 |
| DE112022004302T5 (de) | 2024-08-22 |
| US20250230630A1 (en) | 2025-07-17 |
| KR20240042101A (ko) | 2024-04-01 |
| JP2023081170A (ja) | 2023-06-09 |
| JP7760348B2 (ja) | 2025-10-27 |
| US12584290B2 (en) | 2026-03-24 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107002389B (zh) | 作业车辆的控制系统、控制方法及作业车辆 | |
| KR102259549B1 (ko) | 작업 기계 | |
| KR101989332B1 (ko) | 작업 기계의 표시 시스템 및 작업 기계 | |
| US9739038B2 (en) | Posture computing apparatus for work machine, work machine, and posture computation method for work machine | |
| US9598845B2 (en) | Posture computing apparatus for work machine, work machine, and posture computation method for work machine | |
| CN111226007B (zh) | 施工管理装置、显示装置及施工管理方法 | |
| CN110392754A (zh) | 工程机械 | |
| US12534875B2 (en) | Control system, control method, and control program | |
| JP2020105802A (ja) | 作業機械 | |
| KR20190034648A (ko) | 작업 기계 | |
| WO2023100620A1 (ja) | 作業機械のためのシステム、方法、及び作業機械 | |
| JP2022036308A (ja) | ショベル及びショベルの情報更新方法 | |
| JP2026026339A (ja) | 作業機械を制御するためのシステム、方法およびプログラム | |
| JP2023041850A (ja) | ショベル及びショベル用のシステム | |
| WO2023145609A1 (ja) | 建設機械の駆動制御装置及びこれを備えた建設機械 | |
| JP2019148166A (ja) | ショベル | |
| CN114423905B (zh) | 工程机械 | |
| JP7455632B2 (ja) | ショベル及びショベルの管理装置 | |
| JP7388957B2 (ja) | 作業機械の較正のための方法およびシステム | |
| CN117836489A (zh) | 用于控制作业机械的系统以及方法 | |
| WO2024204509A1 (ja) | システム、方法およびプログラム | |
| JP2025097465A (ja) | 作業機械、作業機械の管理システム | |
| JP2025117732A (ja) | 作業機械制御装置、作業機械、作業機械用外部装置、作業機械システムおよび位置補正方法 | |
| JP2026001843A (ja) | 作業機械においてリフトフレームに対するブレードの姿勢を決定するための方法、システム、および作業機械 | |
| KR20240026519A (ko) | 제어 시스템, 제어 방법 및 제어 프로그램 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| 121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 22901053 Country of ref document: EP Kind code of ref document: A1 |
|
| WWE | Wipo information: entry into national phase |
Ref document number: 202280066848.7 Country of ref document: CN |
|
| WWE | Wipo information: entry into national phase |
Ref document number: 18703759 Country of ref document: US |
|
| WWE | Wipo information: entry into national phase |
Ref document number: 112022004302 Country of ref document: DE |
|
| 122 | Ep: pct application non-entry in european phase |
Ref document number: 22901053 Country of ref document: EP Kind code of ref document: A1 |
|
| WWP | Wipo information: published in national office |
Ref document number: 18703759 Country of ref document: US |
|
| WWG | Wipo information: grant in national office |
Ref document number: 18703759 Country of ref document: US |