WO2023100620A1 - 作業機械のためのシステム、方法、及び作業機械 - Google Patents

作業機械のためのシステム、方法、及び作業機械 Download PDF

Info

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
Application number
PCT/JP2022/042062
Other languages
English (en)
French (fr)
Inventor
将也 木村
剛宏 柴田
貴聖 松井
智揮 平山
洋祐 山越
遼平 菊澤
Original Assignee
株式会社小松製作所
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 株式会社小松製作所 filed Critical 株式会社小松製作所
Priority to KR1020247008312A priority Critical patent/KR20240042101A/ko
Priority to CN202280066848.7A priority patent/CN118103570A/zh
Publication of WO2023100620A1 publication Critical patent/WO2023100620A1/ja

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2004Control mechanisms, e.g. control levers
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/18Counterweights
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2025Particular purposes of control systems not otherwise provided for
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2058Electric or electro-mechanical or mechanical control devices of vehicle sub-units
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/264Sensors and their calibration for indicating the position of the work tool
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60YINDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
    • B60Y2200/00Type of vehicle
    • B60Y2200/40Special vehicles
    • B60Y2200/41Construction vehicles, e.g. graders, excavators
    • B60Y2200/412Excavators

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)
  • Operation Control Of Excavators (AREA)
  • Component Parts Of Construction Machinery (AREA)

Abstract

システムは、第1部分を含む複数の構成部分を有する作業機械のためのシステムである。当該システムは、記憶装置と、入力装置と、コントローラとを備える。記憶装置は、複数の構成部分のそれぞれの重心位置を記憶している。入力装置は、第1部分の重心位置を決定するための第1パラメータの入力を受け付ける。コントローラは、複数の構成部分の重心位置に基づいて、作業機械全体の重心位置を算出する。コントローラは、入力装置によって第1パラメータが入力されたときには、第1パラメータによって、第1部分の重心位置を設定する。コントローラは、設定された第1部分の重心位置を含む複数の構成部分の重心位置に基づいて、作業機械全体の重心位置を設定する。

Description

作業機械のためのシステム、方法、及び作業機械
 本発明は、作業機械のためのシステム、方法、及び作業機械に関する。
 従来、作業機械全体の重心位置を算出して作業機械の転倒の可能性を判別する技術が知られている。例えば、特許文献1では、油圧ショベルの重心位置を求めるための計算モデルとして、集中質点モデルが使用される。集中質点モデルでは、油圧ショベルの各構成部分の重心に質量が集中していると見なされる。油圧ショベルは、ブームと、アームと、バケットと、旋回体と、走行体とを備えている。油圧ショベルの重心位置は、ブームの重心位置と、アームの重心位置と、バケットの重心位置と、旋回体の重心位置と、走行体の重心位置とを合成することで決定される。
特開2019-52499号公報
 作業機械は、出荷後に、構成部分の一部が別の部品に交換されることがある。例えば、油圧ショベルのバケットが、別の種類のアタッチメントに交換されることがある。或いは、旋回体のカウンタウェイトが、別の仕様のものに交換されることがある。そのような場合、交換後の構成部分の重心位置は、交換前の構成部品の重心位置から変化する。そのため、作業機械全体の重心位置を精度よく算出することが困難になる。本発明の目的は、作業機械において、構成部分の一部が交換された後でも、作業機械全体の重心位置を精度よく算出することにある。
 本発明の第1の態様に係るシステムは、第1部分を含む複数の構成部分を有する作業機械のためのシステムである。当該システムは、記憶装置と、入力装置と、コントローラとを備える。記憶装置は、複数の構成部分のそれぞれの重心位置を記憶している。入力装置は、第1部分の重心位置を決定するための第1パラメータの入力を受け付ける。コントローラは、複数の構成部分の重心位置に基づいて、作業機械全体の重心位置を算出する。コントローラは、入力装置によって第1パラメータが入力されたときには、第1パラメータによって、第1部分の重心位置を設定する。コントローラは、設定された第1部分の重心位置を含む複数の構成部分の重心位置に基づいて、作業機械全体の重心位置を設定する。
 本発明の第2の態様に係る方法は、第1部分を含む複数の構成部分を有する作業機械を制御するための方法である。当該方法は、複数の構成部分のそれぞれの重心位置を取得することと、複数の構成部分の重心位置に基づいて、作業機械全体の重心位置を算出することと、入力装置を介して、第1部分の重心位置を決定するための第1パラメータの入力を受け付けることと、入力装置によって第1パラメータが入力されたときには、第1パラメータによって、第1部分の重心位置を設定することと、設定された第1部分の重心位置を含む複数の構成部分の重心位置に基づいて、作業機械全体の重心位置を設定すること、を備える。
 本発明の第3の態様に係る作業機械は、複数の構成部分と、記憶装置と、入力装置と、コントローラとを備える。複数の構成部分は、第1部分を含む。記憶装置は、複数の構成部分のそれぞれの重心位置を記憶している。入力装置は、第1部分の重心位置を決定するための第1パラメータの入力を受け付ける。コントローラは、複数の構成部分の重心位置に基づいて、作業機械全体の重心位置を算出する。コントローラは、入力装置によって第1パラメータが入力されたときには、第1パラメータによって、第1部分の重心位置を設定する。コントローラは、設定された第1部分の重心位置を含む複数の構成部分の重心位置に基づいて、作業機械全体の重心位置を設定する。
 本発明によれば、作業機械の第1部分が交換された場合、交換後の第1部分の第1パラメータが、入力装置を介して入力されることで、第1部分の重心位置が設定される。そして、設定された第1部分の重心位置に基づいて、作業機械全体の重心位置が算出される。それにより、第1部品が交換された後でも、作業機械全体の重心位置が精度よく算出される。
実施形態に係る作業機械の側面図である。 作業機械の制御システムの構成を示すブロック図である。 作業機械の構成を模式的に示す図である。 作業機械全体の重心位置を算出するための処理を示すフローチャートである。 作業機械の複数の構成部分の重心位置を示す図である。 アタッチメントの設定画面の一例を示す図である。 アームの設定画面の一例を示す図である。 ブームの設定画面の一例を示す図である。 旋回体の設定画面の一例を示す図である。 走行体の設定画面の一例を示す図である。 仕様データの一例を示す図である。 転倒余裕度の算出方法を示す図である。 転倒の可能性を示す画面の一例を示す図である。 変形例に係るアタッチメントの設定画面の一例を示す図である。 変形例に係るブーム及びアームの設定画面の一例を示す図である。 変形例に係る旋回体及び走行体の設定画面の一例を示す図である。
 以下、図面を参照して、本発明の一実施形態に係る作業機械について説明する。図1は、実施形態に係る作業機械1の側面図である。作業機械1は、車体2と作業機3とを備えている。車体2は、旋回体4と走行体5とを含む。旋回体4は、走行体5に対して旋回可能に支持されている。旋回体4には、運転室6が配置されている。旋回体4には、カウンタウェイト7が取り付けられている。
 旋回体4は、駆動源11と油圧ポンプ12とを含む。駆動源11は、例えば内燃エンジンである。ただし、駆動源11は、電動モータ、或いはエンジンと電動モータとのハイブリッド機構であってもよい。油圧ポンプ12は、駆動源11によって駆動され、作動油を吐出する。作業機械1は、旋回モータ13を備えている。油圧ポンプ1224から吐出された作動油は、旋回モータ13に供給される。それにより、旋回モータ13は、旋回体4を旋回させる。走行体5は、履帯14を含む。履帯14が回転することにより作業機械1が走行する。
 作業機3は、車体2に取り付けられている。作業機3は、車体2に対して動作可能である。作業機3は、ブーム15と、アーム16と、アタッチメント17とを含む。ブーム15は、ブームピン18を介して車体2に回転可能に取り付けられている。アーム16は、アームピン19を介してブーム15に回転可能に取り付けられている。アタッチメント17は、アタッチメントピン20を介して、アーム16に回転可能に取り付けられている。
 作業機3は、ブームシリンダ21と、アームシリンダ22と、アタッチメントシリンダ23とを含む。ブームシリンダ21と、アームシリンダ22と、アタッチメントシリンダ23とは、それぞれ油圧シリンダである。ブームシリンダ21と、アームシリンダ22と、アタッチメントシリンダ23とは、油圧ポンプ12から作動油によって駆動される。ブームシリンダ21が伸縮することで、ブーム15が動作する。アームシリンダ22が伸縮することで、アーム16が動作する。アタッチメントシリンダ23が伸縮することで、アタッチメント17が動作する。
 図2は、作業機械1の制御システム10を示すブロック図である。図2に示すように、制御システム10は、操作装置31と、入力装置32と、ディスプレイ33とを備える。操作装置31と、入力装置32と、ディスプレイ33とは、運転室6に配置されている。操作装置31は、作業機3、旋回体4、及び走行体5を操作するための装置である。操作装置31は、作業機3、旋回体4、及び走行体5を駆動するためのオペレータによる操作を受け付け、操作に応じた操作信号を出力する。操作装置31は、例えば、レバー、ペダル、スイッチ等を含む。
 入力装置32は、作業機械1の制御の設定を行うためのオペレータによる操作を受け付け、操作に応じた操作信号を出力する。入力装置32は、例えばタッチスクリーンである。或いは、入力装置32は、レバー、或いはスイッチを含んでもよい。ディスプレイ33は、ディスプレイ33に入力される指令信号に応じた画像を表示する。ディスプレイ33は、作業機械1の制御の設定を行うための画面を表示する。
 制御システム10は、コントローラ30と記憶装置36とを含む。コントローラ30は、取得したデータに基づいて作業機械1を制御するようにプログラムされている。コントローラ30は、CPU(Central Processing Unit)などのプロセッサ34と、RAM(Random Access Memory)、及びROM(Read Only Memory)などのメモリ35とを含む。記憶装置36は、半導体メモリ、或いはハードディスクなどを含む。記憶装置36は、非一時的な(non-transitory)コントローラ30で読み取り可能な記録媒体の一例である。記憶装置36は、作業機械1を制御するためのプログラムとデータとを記憶している。コントローラ30は、操作装置31及び入力装置32から操作信号を取得する。コントローラ30は、操作信号に基づいて、作業機3と旋回体4と走行体5とを制御する。
 制御システム10は、車体位置センサ41を備えている。車体位置センサ41は、車体2の位置を検出する。車体位置センサ41は、旋回体4に配置されている。車体位置センサ41は、例えば、GNSS(Global Navigation Satellite System)を用いた位置センサである。車体位置センサ41は、基準座標系における旋回体4の位置を検出する。基準座標系は、作業機械1の外部に原点OW(図5参照)を有しており、例えば世界測地系に従う座標系である。コントローラ30は、車体位置センサ41から、旋回体4の位置を示す位置データを取得する。
 制御システム10は、車体方向センサ42を備えている。車体方向センサ42は、旋回体4に取り付けられている。車体方向センサ42は、旋回体4の向きを検出する。
 車体方向センサ42は、例えば、慣性計測装置(Inertial Measurement Unit:IMU)である。車体方向センサ42は、旋回体4のヨー角とロール角とピッチ角とを、構成部分の向きとして検出する。コントローラ30は、車体方向センサ42から、旋回体4の向きを示す方向データを取得する。
 制御システム10は、旋回角度センサ46と、ブーム角度センサ47と、アーム角度センサ48と、アタッチメント角度センサ49とを含む。旋回角度センサ46は、走行体5に対する旋回体4の旋回角度を検出する。コントローラ30は、旋回体4の向きと、旋回体4の旋回角度とから、走行体5の向きを算出する。
 図3は、作業機械1の構成を模式的に示す図である。ブーム角度センサ47は、ブーム角θ1を検出する。ブーム角θ1は、旋回体4に対するブーム15の傾斜角を示す。アーム角度センサ48は、アーム角θ2を検出する。アーム角θ2は、ブーム15に対するアーム16の傾斜角を示す。アタッチメント角度センサ49は、アタッチメント角θ3を検出する。アタッチメント角θ3は、アーム16に対するアタッチメント17の傾斜角を示す。
 アタッチメント角度センサ49は、例えばストロークセンサである。アタッチメント角度センサ49は、アタッチメントシリンダ23のストローク量を検出する。コントローラ30は、ストローク量から、アタッチメント角θ3を算出する。アーム角度センサ48と、ブーム角度センサ47とは、例えばIMUである。或いは、アーム角度センサ48と、ブーム角度センサ47とは、ストロークセンサであってもよい。アタッチメント角度センサ49は、IMUであってもよい。
 或いは、ブーム角度センサ47と、アーム角度センサ48と、アタッチメント角度センサ49とは、それぞれ、ブーム角θ1と、アーム角θ2と、アタッチメント角θ3とを直接的に検出する角度センサであってもよい。コントローラ30は、旋回角度センサ46と、ブーム角度センサ47と、アーム角度センサ48と、アタッチメント角度センサ49とから、旋回角度と、ブーム角θ1と、アーム角θ2と、アタッチメント角θ3とを示す角度データを取得する。
 次に、作業機械1全体の重心位置を算出するためにコントローラ30によって実行される処理について説明する。本実施形態では、作業機械1が複数の構成部分に分けられ、各構成部分の重心位置と重量とから、作業機械1全体の重心位置が求められる。図4は、作業機械1全体の重心位置を算出するための処理を示すフローチャートである。
 図4に示すように、ステップS1では、コントローラ30は、位置データを取得する。コントローラ30は、位置データにより、基準座標系での旋回体4の位置を取得する。ステップS2では、コントローラ30は、方向データを取得する。コントローラ30は、方向データにより、旋回体4の向きを取得する。ステップS3では、コントローラ30は、角度データを取得する。コントローラ30は、角度データにより、旋回角度と、ブーム角θ1と、アーム角θ2と、アタッチメント角θ3とを取得する。
 ステップS4では、コントローラ30は、寸法データを取得する。寸法データは、作業機械1全体の重心位置を算出するための各構成部分の寸法を示す。図3に示すように、寸法データは、例えば、ブーム長さL1と、アーム長さL2と、アタッチメント長さL3とを含む。ブーム長さL1は、ブームピン18とアームピン19との間の長さである。アーム長さL2は、アームピン19とアタッチメントピン20との間の長さである。アタッチメント長さは、アタッチメントピン20とアタッチメント17の先端P1との間の長さである。寸法データは、記憶装置36に記憶されている。コントローラ30は、記憶装置36から寸法データを取得する。
 ステップS5では、コントローラ30は、構成部分の重心位置を取得する。図5は、作業機械1の複数の構成部分の重心位置を示す図である。記憶装置36は、旋回体4の重心位置G1と、走行体5の重心位置G2と、ブーム15の重心位置G3と、アーム16の重心位置G4と、アタッチメント17の重心位置G5とを記憶している。
 旋回体4の重心位置G1は、旋回体4の座標系で表される。旋回体4の座標系は、旋回体4に固定された座標系であり、旋回体4に原点O1を有する。走行体5の重心位置G2は、走行体5の座標系で表される。走行体5の座標系は、走行体5に固定された座標系であり、走行体5に原点O2を有する。
 ブーム15の重心位置G3は、ブーム15の座標系で表される。ブーム15の座標系は、ブーム15に固定された座標系であり、ブーム15に原点O3を有する。アーム16の重心位置G4は、アーム16の座標系で表される。アーム16の座標系は、アーム16に固定された座標系であり、アーム16に原点O4を有する。アタッチメント17の重心位置G5は、アタッチメント17の座標系で表される。アタッチメント17の座標系は、アタッチメント17に固定された座標系であり、アタッチメント17に原点O5を有する。コントローラ30は、記憶装置36から、各構成部分の重心位置G1-G5を取得する。
 ステップS6では、コントローラ30は、構成部分の重量を取得する。記憶装置36は、旋回体4の重量と、走行体5の重量と、ブーム15の重量と、アーム16の重量と、アタッチメント17の重量とを記憶している。コントローラ30は、記憶装置36から、各構成部分の重量を取得する。
 ステップS7では、コントローラ30は、座標の変換行列を取得する。コントローラ30は、旋回体4の変換行列と、走行体5の変換行列と、ブーム15の変換行列と、アーム16の変換行列と、アタッチメント17の変換行列とを取得する。旋回体4の変換行列は、旋回体4の座標系から基準座標系への変換行列である。走行体5の変換行列は、走行体5の座標系から旋回体4の座標系への変換行列である。ブーム15の変換行列は、ブーム15の座標系から旋回体4の座標系への変換行列である。アーム16の変換行列は、アーム16の座標系からブーム15の座標系への変換行列である。アタッチメント17の変換行列は、アタッチメント17の座標系からアーム16の座標系への変換行列である。
 各構成部分の変換行列は、各構成部分の姿勢に応じて変化する。記憶装置36は、旋回体4の座標系と、走行体5の座標系と、ブーム15の座標系と、アーム16の座標系と、アタッチメント17の座標系とのそれぞれの原点O1-O5の位置関係を記憶している。コントローラ30は、各座標系の原点O1-O5の位置関係と、上述した寸法データと、位置データと、方向データと、角度データとに基づいて、各構成部分の変換行列を算出する。
 ステップS8では、コントローラ30は、作業機械1全体の重心位置G0を算出する。コントローラ30は、各構成部分の重心位置G1-G5と重量と変換行列とに基づいて、作業機械1全体の重心位置G0を算出する。詳細には、コントローラ30は、まず、以下の式(1)~(5)により、各構成部分の重心位置を基準座標系に変換する。
world upperworld upper upper P    (1)
world Punder = world upper upper T under under P    (2)
world Pboom = world upper upper T boom boom P    (3)
world Parm = world upper upper T boom boom T arm arm P    (4)
world Pattachment = world upper upper Tboom boom T arm arm T attachment attachment P    (5)
 world upperは、基準座標系での旋回体4の重心位置G1を示す。upper Pは、旋回体4の座標系での旋回体4の重心位置G1を示す。world upperは、旋回体4の座標系から基準座標系への変換行列を示す。
 world Punderは、基準座標系での走行体5の重心位置G2を示す。upper T underは、走行体5の座標系から旋回体4の座標系への変換行列を示す。under Pは、走行体5の座標系での走行体5の重心位置G2を示す。
 world Pboomは、基準座標系でのブーム15の重心位置G3を示す。upper T boomは、ブーム15の座標系から旋回体4の座標系への変換行列を示す。boom Pは、ブーム15の座標系でのブーム15の重心位置G3を示す。
 world Parmは、基準座標系でのアーム16の重心位置G4を示す。boom T armは、アーム16の座標系からブーム15の座標系への変換行列を示す。arm Pは、アーム16の座標系でのアーム16の重心位置G4を示す。
 world Pattachmentは、基準座標系でのアタッチメント17の重心位置G5を示す。arm T attachmentは、アタッチメント17の座標系からアーム16の座標系への変換行列を示す。attachment Pは、アタッチメント17の座標系でのアタッチメント17の重心位置G5を示す。
 次にコントローラ30は、以下の式(6)により、作業機械1全体の重心位置G0を算出する。
world Pall = (world 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 は、基準座標系での作業機械1全体の重心位置G0を示す。mass upper は、旋回体4の重量を示す。mass underは、走行体5の重量を示す。massboomは、ブーム15の重量を示す。mass armは、アーム16の重量を示す。mass attachmentは、アタッチメント17の重量を示す。massallは、作業機械1全体の重量を示す。
 ステップS9では、コントローラ30は、入力装置32を介したパラメータの入力があったかを判定する。入力装置32は、各構成部分の重心位置を決定するためのパラメータの入力を受け付ける。詳細には、コントローラ30は、図6から図10に示す設定画面をディスプレイ33に表示させる。
 図6は、アタッチメント17の設定画面51の一例を示す図である。アタッチメント17の設定画面51では、アタッチメント17の複数の種類が表示される。アタッチメント17の複数の種類は、寸法、及び/又は、重量、或いは機能の異なるアタッチメント17の種類を示す。アタッチメント17が交換された場合、作業者は、入力装置32を用いて、交換後のアタッチメント17の種類を選択する。コントローラ30は、選択されたアタッチメント17の種類を、アタッチメント17の重心位置G5のパラメータとして取得する。
 図7は、アーム16の設定画面52の一例を示す図である。アーム16の設定画面52では、アーム16の複数の種類が表示される。アーム16の複数の種類は、寸法、及び/又は、重量の異なるアーム16の複数の種類を示す。アーム16が交換された場合、作業者は、入力装置32を用いて、交換後のアーム16の種類を選択する。コントローラ30は、選択されたアーム16の種類を、アーム16の重心位置G4のパラメータとして取得する。
 図8は、ブーム15の設定画面53の一例を示す図である。ブーム15の設定画面53では、ブーム15の複数の種類が表示される。ブーム15の複数の種類は、寸法、及び/又は、重量の異なるブーム15の複数の種類を示す。ブーム15が交換された場合、作業者は、入力装置32を用いて、交換後のブーム15の種類を選択する。コントローラ30は、選択されたブーム15の種類を、ブーム15の重心位置G3のパラメータとして取得する。
 図9は、旋回体4の設定画面54の一例を示す図である。旋回体4の設定画面54では、カウンタウェイト7の複数の種類が表示される。カウンタウェイト7の複数の種類は、寸法、及び/又は、重量の異なるカウンタウェイト7の複数の種類を示す。カウンタウェイト7が交換された場合、作業者は、入力装置32を用いて、交換後のカウンタウェイト7の種類を選択する。コントローラ30は、選択されたカウンタウェイト7の種類を、旋回体4の重心位置G1のパラメータとして取得する。
 図10は、走行体5の設定画面55の一例を示す図である。走行体5の設定画面55では、履帯14の複数の種類が表示される。履帯14の複数の種類は、寸法、及び/又は、重量の異なる履帯14の複数の種類を示す。履帯14が交換された場合、作業者は、入力装置32を用いて、交換後の履帯14の種類を選択する。コントローラ30は、選択された履帯14の種類を、走行体5の重心位置G2のパラメータとして取得する。
 入力装置32によって、いずれかの構成部分の重心位置のパラメータが入力されたときには、処理はステップS10に進む。ステップS10では、コントローラ30は、パラメータが入力された構成部分の重心位置を更新する。
 例えば、アタッチメント17がバケットAからバケットBに交換された場合、作業者は、アタッチメント17の設定画面51において、入力装置32を用いてバケットBを選択する。
 記憶装置36は、アタッチメント17の各種類の仕様データを記憶している。図11に示すように、仕様データ56は、アタッチメント17の複数の種類と、複数の種類のそれぞれに対応するアタッチメント17の寸法と重量とを含む。アタッチメント17の寸法は、例えば上述したアタッチメント長さL3を含む。コントローラ30は、選択された種類に対応する寸法と重量とによって、アタッチメント17の寸法データと重量とを更新する。また、コントローラ30は、更新されたアタッチメント17の寸法データと重量とによって、アタッチメント17の重心位置G5を更新する。
 旋回体4、走行体5、ブーム15、アーム16についても同様に、記憶装置36は、旋回体4、走行体5、ブーム15、アーム16のそれぞれについて、仕様データを記憶している。旋回体4の仕様データは、カウンタウェイト7の複数の種類と、複数の種類のそれぞれに対応するカウンタウェイト7の寸法と重量とを含む。入力装置32によってカウンタウェイト7の種類が選択されると、コントローラ30は、選択されたカウンタウェイト7の寸法データと重量とによって、旋回体4の重心位置G1を更新する。
 走行体5の仕様データは、走行体5の複数の種類と、複数の種類のそれぞれに対応する走行体5の寸法と重量とを含む。入力装置32によって履帯14の種類が選択されると、コントローラ30は、選択された履帯14の寸法データと重量とによって、走行体5の重心位置G2を更新する。
 ブーム15の仕様データは、ブーム15の複数の種類と、複数の種類のそれぞれに対応するブーム15の寸法と重量とを含む。入力装置32によってブーム15の種類が選択されると、コントローラ30は、選択されたブーム15の寸法データと重量とによって、ブーム15の重心位置G3を更新する。
 アーム16の仕様データは、アーム16の複数の種類と、複数の種類のそれぞれに対応するアーム16の寸法と重量とを含む。入力装置32によってアーム16の種類が選択されると、コントローラ30は、選択されたアーム16の寸法データと重量とによって、アーム16の重心位置G4を更新する。
 ステップS11では、コントローラ30は、構成部分の重量を更新する。コントローラ30は、入力装置32によってパラメータが入力された構成部分の重量を、上述した仕様データによって更新する。ステップS12では、コントローラ30は、座標の変換行列を更新する。コントローラ30は、入力装置32によってパラメータが入力された構成部分の変換行列を、上述した仕様データによって更新する。そして、処理は、ステップS1~S8に戻り、コントローラ30は、更新された構成部分の重心位置を含む複数の構成部分の重心位置に基づいて、作業機械1全体の重心位置G0を更新する。
 例えば、アタッチメント17が交換された場合には、入力装置32によって交換後のアタッチメント17の種類が選択されることで、アタッチメント17の重心位置G5と重量と変換行列とが更新される。そして、上述した式(1)~(6)により、更新されたアタッチメント17の重心位置G5と重量と変換行列と、他の構成部分の重心位置G1-G4と重量と変換行列とによって、作業機械1全体の重心位置G0を算出することで、作業機械1全体の重心位置G0が更新される。
 なお、以上の説明では、説明の容易のために、作業機械1、及び、各構成部分の幅方向の寸法については、説明を省略している。ただし、重心位置の算出において、作業機械1、及び、各構成部分の幅方向の寸法が考慮されてもよい。
 以上のように、コントローラ30は、作業機械1全体の重心位置G0を算出する。コントローラ30は、作業機械1全体の重心位置G0に基づいて、作業機械1の転倒の可能性を判別する。例えば、図12に示すように、コントローラ30は、転倒余裕度Qに基づいて、作業機械1の転倒の可能性を判別してもよい。転倒余裕度Qは、作業機械1が転倒する際に、作業機械1全体の重心位置G0が描く軌跡A1の最大高さH1と、重心位置の初期高さH0との差で示される。転倒余裕度Qが大きいほど、転倒の可能性が低い。
 コントローラ30は、転倒余裕度Qに応じて、警告表示をディスプレイ33に表示させてもよい。例えば、図13に示すように、コントローラ30は、転倒の可能性を示す画面57をディスプレイ33に表示させてもよい。転倒の可能性を示す画面57では、作業機械1の画像61と供に、作業機械1の周囲を複数に分割したエリア62A-62Lが表示される。
 コントローラ30は、各エリア62A-62Lの方向への作業機械1の転倒余裕度Qを算出する。コントローラ30は、転倒余裕度Qに応じて、各エリア62A-62Lを異なる色で表示する。例えば、転倒余裕度Qが閾値以下となったエリア62H-62Jを他のエリアと異なる色で表示する。
 以上説明した本実施形態に係る作業機械1の制御システム10では、作業機械1の構成部分の一部が交換された場合に、交換後の構成部分のパラメータが、入力装置32を介して入力されることで、当該構成部分の重心位置が更新される。そして、更新された構成部分の重心位置に基づいて、作業機械1全体の重心位置G0が算出される。それにより、構成部分の一部が交換された後でも、作業機械1全体の重心位置G0が精度よく算出される。
 以上、本発明の一実施形態について説明したが、本発明は上記実施形態に限定されるものではなく、発明の要旨を逸脱しない範囲で種々の変更が可能である。
 作業機械1は、上述した油圧ショベルに限らず、ブルドーザ、ホイールローダ、或いはモータグレーダなどの他の作業機械であってもよい。作業機3の構造は、上述した実施形態のものに限らず、変更されてもよい。例えば、作業機3は、ブーム15、アーム16、及びアタッチメント17の3軸構造に限らず、4軸以上の構造を有してもよい。
 作業機械1は、遠隔操縦可能な車両であってもよい。その場合、制御システム103の一部は、作業機械1の外部に配置されてもよい。例えば、コントローラ30は、作業機械1の外部に配置されてもよい。操作装置31、入力装置32、ディスプレイ33は、作業機械1の外部に配置されてもよい。入力装置32とディスプレイ33とは、作業機械1と別体のコンピュータであってもよい。例えば、入力装置32とディスプレイ33とは、作業機械1のサービスマンによって操作されるコンピュータに含まれてもよい。
 コントローラ30は、互いに別体の複数のコントローラを含んでもよい。上述したコントローラ30による処理は、複数のコントローラに分散して実行されてもよい。コントローラ30は、複数のプロセッサを含んでもよい。上述したコントローラ30による処理は、複数のプロセッサに分散して実行されてもよい。
 コントローラ30による処理は、上記の実施形態のものに限らず、変更されてもよい。上述した処理の一部が省略されてもよい。或いは、上述した処理の一部が変更されてもよい。例えば、上記の実施形態では、作業機械1全体の重心位置G0を計算するために、作業機械1が、旋回体4、走行体5、ブーム15、アーム16、アタッチメント17の5つの構成部分に分けられている。しかし、構成部分の数は5つに限らず、5つより少なくてもよく、或いは5つより多くてもよい。
 上記の実施形態では、コントローラ30は、転倒余裕度Qに応じて、警告表示をディスプレイ33に表示している。しかし、コントローラ30は、転倒余裕度Qに応じて、警告音を発してもよい。上記の実施形態では、コントローラ30は、作業機械1全体の重心位置G0に基づいて、転倒余裕度Qを算出している。しかし、コントローラ30は、単に作業機械1全体の重心位置G0をディスプレイ33に表示してもよい。
 上記の実施形態では、構成部分の重心位置を算出するためのパラメータとして、構成部分の種類が、入力装置32を用いて選択されている。しかし、パラメータは、構成部分の種類に限らず、各構成部分の重心位置であってもよい。或いは、パラメータは、各構成部分の寸法及び重量であってもよい。
 例えば、図14は、変形例に係るアタッチメント17の設定画面58の一例を示す図である。図14に示すように、アタッチメント17の設定画面58は、アタッチメント17の寸法の入力欄71と重量の入力欄72とを含んでもよい。
 図15は、変形例に係るブーム15及びアーム16の設定画面59の一例を示す図である。図15に示すように、ブーム15及びアーム16の設定画面59は、ブーム15の寸法の入力欄73と重量の入力欄74とを含んでもよい。ブーム15及びアーム16の設定画面59は、アーム16の寸法の入力欄75と重量の入力欄76とを含んでもよい。
 図16は、変形例に係る旋回体4及び走行体5の設定画面60の一例を示す図である。図16に示すように、旋回体4及び走行体5の設定画面60は、旋回体4の寸法の入力欄77A,77Bと重量の入力欄78とを含んでもよい。或いは、旋回体4及び走行体5の設定画面60は、カウンタウェイト7の寸法の入力欄と重量の入力欄とを含んでもよい。
 図16に示すように、旋回体4及び走行体5の設定画面60は、走行体5の寸法の入力欄79A-79Cと重量の入力欄80とを含んでもよい。或いは、旋回体4及び走行体5の設定画面60は、履帯14の寸法の入力欄と重量の入力欄とを含んでもよい。
 本発明によれば、作業機械において、一部の構成部分が交換された後でも、作業機械全体の重心位置を精度よく算出することができる。
2:車体
3:作業機
4:旋回体
5:走行体
7:カウンタウェイト
14:履帯
17:アタッチメント
36:記憶装置
32:入力装置
30:コントローラ
G0:作業機械全体の重心位置
G1-G5:構成部分の重心位置

Claims (16)

  1.  第1部分を含む複数の構成部分を有する作業機械のためのシステムであって、
     前記複数の構成部分のそれぞれの重心位置を記憶している記憶装置と、
     前記第1部分の重心位置を決定するための第1パラメータの入力を受け付ける入力装置と、
     コントローラと、
    を備え、
     前記コントローラは、
     前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を算出し、
     前記入力装置によって前記第1パラメータが入力されたときには、前記第1パラメータによって、前記第1部分の重心位置を設定し、
     設定された前記第1部分の重心位置を含む前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を設定する、
    システム。
  2.  前記記憶装置は、前記第1部分の複数の種類と、前記複数の種類のそれぞれに対応する前記第1部分の寸法と重量とを含む仕様データを記憶しており、
     前記第1パラメータは、前記第1部分の複数の種類から選択される、
    請求項1に記載のシステム。
  3.  前記第1パラメータは、前記第1部分の寸法と重量とを含む、
    請求項1に記載のシステム。
  4.  前記第1パラメータは、前記第1部分の重心位置を含む、
    請求項1に記載のシステム。
  5.  前記複数の構成部分は、第2部分をさらに含み、
     前記入力装置は、前記第2部分の重心位置を決定するための第2パラメータの入力を受け付け、
     前記コントローラは、前記入力装置によって前記第2パラメータが入力されたときには、前記第2パラメータによって、前記第2部分の重心位置を設定し、
     設定された前記第2部分の重心位置を含む前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を設定する、
    請求項1から4のいずれかに記載のシステム。
  6.  前記記憶装置は、前記第2部分の複数の種類と、前記複数の種類のそれぞれに対応する前記第2部分の寸法と重量とを含む仕様データを記憶しており、
     前記第2パラメータは、前記第2部分の複数の種類のいずれかから選択される、
    請求項5に記載のシステム。
  7.  前記第2パラメータは、前記第2部分の寸法と重量とを含む、
    請求項5に記載のシステム。
  8.  前記第2パラメータは、前記第2部分の重心位置を含む、
    請求項5に記載のシステム。
  9.  ディスプレイをさらに備え、
     前記コントローラは、前記第1パラメータの入力欄を前記ディスプレイに表示させる、
    請求項1から4のいずれかに記載のシステム。
  10.  ディスプレイをさらに備え、
     前記コントローラは、前記第2パラメータの入力欄を前記ディスプレイに表示させる、
    請求項5から8のいずれかに記載のシステム。
  11.  前記作業機械は、
      車体と、
      交換可能なアタッチメントを含み、前記車体に対して動作可能な作業機と、
     を有し、
     前記第1部分は、前記アタッチメントである、
    請求項1から10に記載のシステム。
  12.  前記作業機械は、カウンタウェイトを含む旋回体を有し、
     前記第1部分は、前記旋回体であり、
     前記第1パラメータは、前記カウンタウェイトの種類、又は、前記カウンタウェイトの寸法及び重量を示す、
    請求項1から10のいずれかに記載のシステム。
  13.  前記作業機械は、履帯を含む走行体を有し、
     前記第1部分は、前記走行体であり、
     前記第1パラメータは、前記履帯の種類、又は、前記履帯の寸法及び重量を示す、
    請求項1から10のいずれかに記載のシステム。
  14.  第1部分を含む複数の構成部分を有する作業機械を制御するための方法であって、
     前記複数の構成部分のそれぞれの重心位置を取得することと、
     前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を算出することと、
     入力装置を介して、前記第1部分の重心位置を決定するための第1パラメータの入力を受け付けることと、
     前記入力装置によって前記第1パラメータが入力されたときには、前記第1パラメータによって、前記第1部分の重心位置を設定することと、
     設定された前記第1部分の重心位置を含む前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を設定すること、
    を備える方法。
  15.  前記複数の構成部分は、第2部分をさらに含み、
     前記入力装置は、前記第2部分の重心位置を決定するための第2パラメータの入力を受け付け、
     前記入力装置によって前記第2パラメータが入力されたときには、前記第2パラメータによって、前記第2部分の重心位置を設定することと、
     設定された前記第2部分の重心位置を含む前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を設定すること、
    をさらに備える請求項14に記載の方法。
  16.  作業機械であって、
     第1部分を含む複数の構成部分と、
     前記複数の構成部分のそれぞれの重心位置を記憶している記憶装置と、
     前記第1部分の重心位置を決定するための第1パラメータの入力を受け付ける入力装置と、
     コントローラと、
    を備え、
     前記コントローラは、
     前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を算出し、
     前記入力装置によって前記第1パラメータが入力されたときには、前記第1パラメータによって、前記第1部分の重心位置を設定し、
     設定された前記第1部分の重心位置を含む前記複数の構成部分の重心位置に基づいて、前記作業機械全体の重心位置を設定する、
    作業機械。
PCT/JP2022/042062 2021-11-30 2022-11-11 作業機械のためのシステム、方法、及び作業機械 WO2023100620A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
KR1020247008312A KR20240042101A (ko) 2021-11-30 2022-11-11 작업 기계를 위한 시스템, 방법, 및 작업 기계
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 JP2023081170A (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 WO2023100620A1 (ja) 2021-11-30 2022-11-11 作業機械のためのシステム、方法、及び作業機械

Country Status (4)

Country Link
JP (1) JP2023081170A (ja)
KR (1) KR20240042101A (ja)
CN (1) CN118103570A (ja)
WO (1) WO2023100620A1 (ja)

Citations (5)

* Cited by examiner, † Cited by third party
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 (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6860458B2 (ja) 2017-09-15 2021-04-14 日立建機株式会社 作業機械

Patent Citations (5)

* Cited by examiner, † Cited by third party
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
KR20240042101A (ko) 2024-04-01
CN118103570A (zh) 2024-05-28
JP2023081170A (ja) 2023-06-09

Similar Documents

Publication Publication Date Title
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
KR102259549B1 (ko) 작업 기계
WO2019058695A1 (ja) 作業機械
JP7354312B2 (ja) ショベル及びショベルの情報更新方法
KR20190034648A (ko) 작업 기계
JP2016169571A (ja) ショベル
WO2023100620A1 (ja) 作業機械のためのシステム、方法、及び作業機械
KR102479701B1 (ko) 작업 기계
JP7257430B2 (ja) ショベル及びショベル用システム
JP7388957B2 (ja) 作業機械の較正のための方法およびシステム
AU2020211863B2 (en) System and method for work machine
JP7100409B2 (ja) 作業機械
JP7143117B2 (ja) ショベル
WO2023054615A1 (ja) 作業機械を制御するためのシステム、方法およびプログラム
JP7455632B2 (ja) ショベル及びショベルの管理装置
WO2023032970A1 (ja) 制御システム、制御方法および制御プログラム
US20240044110A1 (en) Work machine
JP7349956B2 (ja) 施工方法及び施工システム
WO2023145609A1 (ja) 建設機械の駆動制御装置及びこれを備えた建設機械
WO2023032949A1 (ja) 制御システム、制御方法および制御プログラム
CN117836489A (zh) 用于控制作业机械的系统以及方法
KR20220086672A (ko) 작업 기계의 제어 시스템, 작업 기계, 및 작업 기계의 제어 방법
JP2019148166A (ja) ショベル

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