WO2022209214A1 - 演算装置および演算方法 - Google Patents

演算装置および演算方法 Download PDF

Info

Publication number
WO2022209214A1
WO2022209214A1 PCT/JP2022/002400 JP2022002400W WO2022209214A1 WO 2022209214 A1 WO2022209214 A1 WO 2022209214A1 JP 2022002400 W JP2022002400 W JP 2022002400W WO 2022209214 A1 WO2022209214 A1 WO 2022209214A1
Authority
WO
WIPO (PCT)
Prior art keywords
boom
arm
sensor
attachment
pin
Prior art date
Application number
PCT/JP2022/002400
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 DE112022000577.7T priority Critical patent/DE112022000577T5/de
Priority to US18/283,595 priority patent/US20240167247A1/en
Priority to KR1020237030216A priority patent/KR20230138020A/ko
Priority to CN202280019932.3A priority patent/CN116964280A/zh
Publication of WO2022209214A1 publication Critical patent/WO2022209214A1/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/2025Particular purposes of control systems not otherwise provided for
    • E02F9/2029Controlling the position of implements in function of its load, e.g. modifying the attitude of implements in accordance to vehicle speed
    • 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
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01GWEIGHING
    • G01G19/00Weighing apparatus or methods adapted for special purposes not provided for in the preceding groups
    • G01G19/08Weighing apparatus or methods adapted for special purposes not provided for in the preceding groups for incorporation in vehicles
    • G01G19/10Weighing apparatus or methods adapted for special purposes not provided for in the preceding groups for incorporation in vehicles having fluid weight-sensitive devices
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; 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/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • 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/26Indicating devices
    • E02F9/264Sensors and their calibration for indicating the position of the work tool
    • E02F9/265Sensors and their calibration for indicating the position of the work tool with follow-up actions (e.g. control signals sent to actuate the work tool)
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01GWEIGHING
    • G01G19/00Weighing apparatus or methods adapted for special purposes not provided for in the preceding groups
    • G01G19/08Weighing apparatus or methods adapted for special purposes not provided for in the preceding groups for incorporation in vehicles
    • G01G19/083Weighing apparatus or methods adapted for special purposes not provided for in the preceding groups for incorporation in vehicles lift truck scale
    • 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
    • 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/415Wheel loaders

Definitions

  • the present disclosure relates to an arithmetic device and an arithmetic method for calculating the weight of a load carried by a working machine.
  • Patent Document 1 discloses an arithmetic device for a hydraulic excavator equipped with a bucket, which calculates the load amount in the bucket from the force balance condition around the bucket support shaft.
  • the above document describes experimentally determining the position of the center of gravity of the bucket load.
  • the position of the center of gravity of the bucket load is not necessarily constant. Therefore, it has been difficult to increase the accuracy of the payload amount with the technique of calculating the payload amount using the position of the center of gravity obtained experimentally.
  • This disclosure proposes an arithmetic device that can accurately calculate the weight of a load carried by a work machine.
  • a computing device for calculating the weight of a load carried by a work machine in a work machine provided with the work machine consists of a vehicle body, a boom bottom pin supported by the vehicle body, a boom rotatably connected to the vehicle body by the boom bottom pin, a boom top pin attached to the tip of the boom, and a boom rotatable by the boom top pin.
  • the calculation device calculates the weight of the load from any two balance formulas of a moment balance formula around the boom bottom pin, a moment balance formula around the boom top pin, and a moment balance formula around the arm top pin.
  • a computing device for calculating the weight of a load carried by a work machine in a work machine provided with the work machine consists of a vehicle body, a boom bottom pin supported by the vehicle body, a boom rotatably connected to the vehicle body by the boom bottom pin, a boom top pin attached to the tip of the boom, and a boom rotatable by the boom top pin. and a pivot member supported by the boom and rotatable together with the attachment relative to the boom.
  • the calculation device calculates the weight of the load from two balance formulas, one for the moment about the boom bottom pin and the other for the moment about the center of rotation of the rotating member.
  • an arithmetic device for calculating the weight of a load carried by a working machine which is provided with the working machine.
  • the work machine includes a vehicle body, a boom bottom pin supported by the vehicle body, a boom rotatably connected to the vehicle body at one end by the boom bottom pin, a boom top pin attached to the other end of the boom, and a boom by the boom top pin.
  • An arm having one end rotatably connected to the other end, an arm top pin attached to the other end of the arm, an attachment having one end rotatably connected to the other end of the arm by the arm top pin, and driving the boom a boom hydraulic cylinder that rotates and rotates, an arm hydraulic cylinder that drives and rotates the arm, an attachment hydraulic cylinder that drives and rotates the attachment, a pressure sensor, and a position sensor.
  • the pressure sensors include a boom pressure sensor attached to the boom hydraulic cylinder and outputting hydraulic pressure information of the boom hydraulic cylinder, an arm pressure sensor attached to the arm hydraulic cylinder and outputting hydraulic pressure information of the arm hydraulic cylinder, and an attachment hydraulic pressure sensor. and an attachment pressure sensor mounted on the cylinder for outputting hydraulic fluid pressure information for the attachment hydraulic cylinder.
  • the position sensors include a boom position sensor that outputs boom information for obtaining the position of the boom with respect to the vehicle body, an arm position sensor that outputs arm information for obtaining the position of the arm with respect to the boom, and a position sensor for obtaining the position of the attachment with respect to the arm. an attachment position sensor for outputting attachment information for the .
  • the computing device generates a first relational expression generated from the hydraulic pressure information of the boom hydraulic cylinder and the boom information, and a second relational expression generated from the hydraulic pressure information of the arm hydraulic cylinder and the arm information. and a third relational expression generated from the hydraulic pressure information of the attachment hydraulic cylinder and the attachment information.
  • the pressure sensor includes at least two sensors corresponding to the two relationships above.
  • a calculation method for calculating the weight of a load carried by a work machine of a work machine provided with the work machine includes, as members, a boom that rotates about a first rotation center, an arm that rotates about a second rotation center, and an attachment that rotates about a third rotation center.
  • the calculation method includes the following processes.
  • the first process is to formulate a relational expression of motion about any two of the first rotation center, the second rotation center and the third rotation center for the above members.
  • the second process is to obtain the weight and center-of-gravity position of each of the members.
  • the third process is to obtain the position of the member during transportation of the load.
  • the fourth process is to obtain the thrust force corresponding to the motion of the relational expression.
  • a fifth process is to calculate the position of the center of gravity of each member during transportation of the load, and the corresponding first, second, and third rotation centers, based on the position of the center of gravity of the member and the position of the member. It is to calculate the horizontal distance.
  • a sixth process is to calculate the weight of the load to be carried by the work machine from the relational expression, the acquired information, and the calculated information.
  • FIG. 1 is a diagram schematically showing the configuration of a working machine according to a first embodiment of the present disclosure
  • FIG. 2 is a block diagram showing a schematic configuration of a system of the working machine shown in FIG. 1
  • FIG. 3 is a diagram showing functional blocks within the controller shown in FIG. 2
  • FIG. FIG. 4 is a schematic diagram showing the balance of moments around the boom bottom pin
  • FIG. 4 is a schematic diagram showing the balance of moments around an arm top pin
  • FIG. 4 is a schematic diagram showing the balance of moments around the boom top pin
  • FIG. 12 is a diagram showing functional blocks in a controller of the fourth embodiment
  • FIG. FIG. 4 is a schematic diagram showing balance of moments around a support pin
  • FIG. 3 is a diagram showing a flow chart of the calculation method of the present disclosure
  • FIG. 1 is a side view schematically showing the configuration of a hydraulic excavator 100 as an example of a work machine based on the first embodiment of the present disclosure.
  • a hydraulic excavator 100 of the present embodiment mainly has a traveling body 1, a revolving body 2, and a working machine 3.
  • a vehicle body of the hydraulic excavator 100 is configured by the traveling body 1 and the revolving body 2 .
  • the traveling body 1 has a pair of left and right crawler belt devices 1a. Each of the pair of left and right crawler belt devices 1a has a crawler belt.
  • the hydraulic excavator 100 is self-propelled by rotating the pair of left and right crawler belts.
  • the revolving body 2 is installed so as to be rotatable with respect to the traveling body 1.
  • the revolving body 2 mainly has an operator's cab (cab) 2a, an operator's seat 2b, an engine room 2c, and a counterweight 2d.
  • the driver's cab 2a is arranged, for example, on the front left side of the revolving body 2 (vehicle front side).
  • a driver's seat 2b for an operator to sit on is arranged in the inner space of the driver's cab 2a.
  • the engine room 2c and the counterweight 2d are arranged on the rear side of the revolving body 2 (vehicle rear side) with respect to the driver's cab 2a.
  • the engine room 2c accommodates an engine unit (engine, exhaust treatment structure, etc.).
  • the upper part of the engine room 2c is covered with an engine hood.
  • the counterweight 2d is arranged behind the engine room 2c.
  • the working machine 3 is pivotally supported on the front side of the revolving body 2 and, for example, on the right side of the operator's cab 2a.
  • the working machine 3 has, for example, a boom 3a, an arm 3b, a bucket 3c, a boom cylinder 4a, an arm cylinder 4b, a bucket cylinder 4c, and the like.
  • a base end (one end) of the boom 3a is rotatably connected to the revolving body 2 by a boom bottom pin 5a.
  • a base end (one end) of the arm 3b is rotatably connected to a tip end (the other end) of the boom 3a by a boom top pin 5b.
  • the bucket 3c (one end) is rotatably connected to the tip (the other end) of the arm 3b by an arm top pin 5c.
  • the boom 3a of the work machine 3 rotates relative to the revolving body 2 around the boom bottom pin 5a.
  • the plane is represented as a straight line.
  • the direction in which this straight line extends is the front-rear direction of the vehicle body of the excavator 100 or the front-rear direction of the revolving body 2, and is hereinafter simply referred to as the front-rear direction.
  • the left-right direction (vehicle width direction) of the excavator 100 or the left-right direction of the revolving body 2 is a direction orthogonal to the front-rear direction in a plan view, and is hereinafter simply referred to as the left-right direction.
  • the vertical direction of the vehicle body of the hydraulic excavator 100 or the vertical direction of the revolving structure 2 is a direction orthogonal to a plane defined by the front-rear direction and the left-right direction, and is hereinafter simply referred to as the vertical direction.
  • the side where the work implement 3 protrudes from the vehicle body is the front direction
  • the direction opposite to the front direction is the rear direction.
  • the right side and the left side in the horizontal direction are the right direction and the left direction, respectively, when viewed in the forward direction.
  • the side with the ground is the lower side
  • the side with the sky is the upper side.
  • the front-back direction is the front-back direction of the operator seated in the driver's seat 2b in the operator's cab 2a.
  • the left-right direction is the left-right direction of the operator seated in the driver's seat 2b.
  • the vertical direction is the vertical direction of the operator seated on the driver's seat 2b.
  • the direction facing the operator seated on the driver's seat 2b is the front direction, and the direction behind the operator seated on the driver's seat 2b is the rearward direction.
  • the right side and the left side when an operator sitting in the driver's seat 2b faces the front are the right direction and the left direction, respectively.
  • the operator seated on the driver's seat 2b has the lower side at the feet and the upper side at the head side.
  • the boom 3a can be driven by a boom cylinder (boom hydraulic cylinder) 4a. By this drive, the boom 3a can be rotated vertically with respect to the revolving body 2 around the boom bottom pin 5a.
  • the arm 3b can be driven by an arm cylinder (arm hydraulic cylinder) 4b. This drive allows the arm 3b to rotate vertically with respect to the boom 3a around the boom top pin 5b.
  • the bucket (attachment) 3c can be driven by a bucket cylinder (attachment hydraulic cylinder) 4c. By this driving, the bucket 3c can be rotated vertically with respect to the arm 3b around the arm top pin 5c.
  • the working machine 3 can be driven in this way.
  • the boom bottom pin 5a is supported by the body of the excavator 100.
  • the boom bottom pin 5 a is supported by a pair of vertical plates (not shown) of the frame of the revolving body 2 .
  • the boom top pin 5b is attached to the tip of the boom 3a.
  • Arm top pin 5c is attached to the tip of arm 3b.
  • the boom bottom pin 5a, the boom top pin 5b and the arm top pin 5c all extend in the left-right direction.
  • the boom bottom pin 5a is also called a boom foot pin.
  • the working machine 3 has a bucket link 3d.
  • the bucket link 3d has a first link member 3da and a second link member 3db.
  • the tip of the first link member 3da and the tip of the second link member 3db are connected via a bucket cylinder top pin 3dc so as to be relatively rotatable.
  • the bucket cylinder top pin 3dc is connected to the tip of the bucket cylinder 4c. Therefore, the first link member 3da and the second link member 3db are pin-connected to the bucket cylinder 4c.
  • the proximal end of the first link member 3da is rotatably connected to the arm 3b by a first link pin 3dd.
  • a base end of the second link member 3db is rotatably connected to a bracket at the root portion of the bucket 3c by a second link pin 3de.
  • a pressure sensor 6a is attached to the head side of the boom cylinder 4a.
  • the pressure sensor 6a can detect the pressure (head pressure) of hydraulic fluid in the cylinder head side oil chamber 40A of the boom cylinder 4a.
  • a pressure sensor 6b is attached to the bottom side of the boom cylinder 4a.
  • the pressure sensor 6b can detect the pressure (bottom pressure) of the working oil in the cylinder bottom side oil chamber 40B of the boom cylinder 4a.
  • the pressure sensors 6a and 6b output working oil pressure information consisting of head pressure and bottom pressure to a controller 10 which will be described later.
  • a pressure sensor 6c is attached to the head side of the arm cylinder 4b.
  • the pressure sensor 6c can detect the pressure of hydraulic fluid (head pressure) in the cylinder head side oil chamber of the arm cylinder 4b.
  • a pressure sensor 6d is attached to the bottom side of the arm cylinder 4b.
  • the pressure sensor 6d can detect the pressure (bottom pressure) of hydraulic fluid in the cylinder bottom side oil chamber of the arm cylinder 4b.
  • the pressure sensors 6c and 6d output working oil pressure information consisting of head pressure and bottom pressure to the controller 10, which will be described later.
  • a pressure sensor 6e is attached to the head side of the bucket cylinder 4c.
  • the pressure sensor 6e can detect the pressure (head pressure) of hydraulic fluid in the cylinder head side oil chamber of the bucket cylinder 4c.
  • a pressure sensor 6f is attached to the bottom side of the bucket cylinder 4c.
  • the pressure sensor 6f can detect the pressure (bottom pressure) of hydraulic oil in the cylinder bottom side oil chamber of the bucket cylinder 4c.
  • the pressure sensors 6e and 6f output working oil pressure information consisting of head pressure and bottom pressure to the controller 10, which will be described later.
  • the boom 3a, the arm 3b, and the bucket 3c are provided with position sensors for obtaining information on their respective positions and attitudes.
  • the position sensor outputs boom information, arm information and attachment information for obtaining respective positions of the boom 3a, the arm 3b and the bucket 3c to the controller 10 which will be described later.
  • a stroke sensor 7a is attached to the boom cylinder 4a as a position sensor.
  • the stroke sensor 7a detects the amount of displacement of the cylinder rod 4ab with respect to the cylinder aa in the boom cylinder 4a as boom information.
  • a stroke sensor 7b is attached to the arm cylinder 4b as a position sensor.
  • the stroke sensor 7b detects the amount of displacement of the cylinder rod in the arm cylinder 4b as arm information.
  • a stroke sensor 7c is attached to the bucket cylinder 4c as a position sensor.
  • the stroke sensor 7c detects the amount of displacement of the cylinder rod in the bucket cylinder 4c as attachment information.
  • the position sensor may be an angle sensor.
  • An angle sensor 9a is attached around the boom bottom pin 5a.
  • An angle sensor 9b is attached around the boom top pin 5b.
  • An angle sensor 9c is attached around the arm top pin 5c.
  • the angle sensors 9a, 9b, 9c may be potentiometers or rotary encoders.
  • the angle sensors 9a, 9b, and 9c output rotation angle information (boom information, arm information, and attachment information) of the boom 3a and the like to the controller 10, which will be described later.
  • boom angle ⁇ b is usually an acute angle.
  • the boom angle ⁇ b represents the angle of the boom 3a with respect to the revolving body 2.
  • the boom angle ⁇ b can be calculated from the detection result of the stroke sensor 7a, and can be calculated from the measurement value of the angle sensor 9a.
  • the angle between a straight line passing through the boom bottom pin 5a and the boom top pin 5b and a straight line passing through the boom top pin 5b and the arm top pin 5c (indicated by a chain double-dashed line in FIG. 1) is Let the arm angle be ⁇ a.
  • the arm angle ⁇ a represents the angle of the arm 3b with respect to the boom 3a in the area where the arm 3b rotates when viewed from the side.
  • the arm angle ⁇ a can be calculated from the detection result of the stroke sensor 7b, and can be calculated from the measurement value of the angle sensor 9b.
  • the angle formed by a straight line passing through the boom top pin 5b and the arm top pin 5c and a straight line passing through the arm top pin 5c and the cutting edge of the bucket 3c (indicated by a chain double-dashed line in FIG. 1) is Let the bucket angle be ⁇ k.
  • the bucket angle ⁇ k represents the angle of the bucket 3c with respect to the arm 3b in the region where the bucket 3c rotates when viewed from the side.
  • the bucket angle ⁇ k can be calculated from the detection result of the stroke sensor 7c, and can be calculated from the measurement value of the angle sensor 9c.
  • the position sensor may be an IMU (Inertial Measurement Unit).
  • IMUs 8a, 8b, 8c and 8d are attached to the revolving body 2, the boom 3a, the arm 3b and the first link member 3da, respectively.
  • the IMU 8a measures the acceleration of the revolving structure 2 in the longitudinal direction, the lateral direction and the vertical direction, and the angular velocity of the revolving structure 2 in the longitudinal direction, the lateral direction and the vertical direction.
  • Each of the IMUs 8b, 8c, 8d controls the acceleration of the boom 3a, the arm 3b, and the first link member 3da in the longitudinal, lateral, and vertical directions, and the acceleration of the boom 3a, arm 3b, Angular velocity of one link member 3da is measured.
  • the acceleration of the expansion and contraction of the boom cylinder 4a (the amount of change in the expansion and contraction speed of the boom cylinder 4a ) can be obtained.
  • the boom angle ⁇ b, arm angle ⁇ a, and bucket angle ⁇ k may be calculated from the detection results of IMUs 8b, 8c, and 8d, respectively.
  • the position sensors As the position sensors, the stroke sensor of each hydraulic cylinder, the angle sensor of each link such as the boom 3a, and the IMU are mentioned, but the position sensor may be a six-axis acceleration sensor.
  • the position sensor may be a combination of some of the above sensors.
  • the position sensor may also use a GNSS (Global Navigation Satellite System).
  • GNSS Global Navigation Satellite System
  • FIG. 2 is a block diagram showing a schematic configuration of the system of the work machine shown in FIG. 1. As shown in FIG.
  • the system in this embodiment is a system for determining the load capacity, which is the weight of the load L (FIG. 1) carried by the working machine 3.
  • the system in this embodiment includes a hydraulic excavator 100 as an example of a working machine shown in FIG. 1 and a controller 10 shown in FIG.
  • the controller 10 may be mounted on the hydraulic excavator 100 .
  • the controller 10 may be installed outside the excavator 100 .
  • the controller 10 may be placed at the work site of the excavator 100 or at a remote location away from the work site of the excavator 100 .
  • the engine 31 is, for example, a diesel engine.
  • the output of the engine 31 is controlled by controlling the injection amount of fuel to the engine 31 by the controller 10 .
  • the hydraulic pump 33 is connected to the engine 31.
  • the hydraulic pump 33 is driven by the rotational driving force of the engine 31 being transmitted to the hydraulic pump 33 .
  • the hydraulic pump 33 is, for example, a variable displacement hydraulic pump that has a swash plate and changes the displacement by changing the tilt angle of the swash plate.
  • a part of the oil discharged from the hydraulic pump 33 is supplied to the direction control valve 34 as hydraulic oil.
  • a part of the oil discharged from the hydraulic pump 33 is decompressed to a constant pressure by a decompression valve and used as pilot oil.
  • the direction control valve 34 is, for example, a spool-type valve that moves a rod-shaped spool to switch the direction in which hydraulic oil flows. The amount of hydraulic oil supplied to the actuator 40 is adjusted by moving the spool in the axial direction.
  • the directional control valve 34 is provided with a spool stroke sensor that detects the movement distance (spool stroke) of the spool.
  • the actuator 40 includes a boom cylinder 4a, an arm cylinder 4b, a bucket cylinder 4c, a travel motor, a swing motor (not shown), and the like shown in FIG.
  • the oil supplied to the actuator 40 in order to operate the actuator 40 is referred to as hydraulic oil.
  • the oil supplied to the directional control valve 34 to operate the directional control valve 34 is called pilot oil.
  • the pressure of the pilot oil is called pilot oil pressure.
  • the hydraulic pump 33 may deliver both hydraulic oil and pilot oil as described above.
  • the hydraulic pump 33 may separately have a hydraulic pump (main hydraulic pump) that delivers hydraulic oil and a hydraulic pump (pilot hydraulic pump) that delivers pilot oil.
  • the operation device 25 is arranged in the driver's cab 2a.
  • the operating device 25 is operated by an operator.
  • the operation device 25 receives an operator's operation for driving the work machine 3 .
  • the operating device 25 also receives an operator's operation for turning the revolving body 2 .
  • the operation device 25 outputs an operation signal according to an operator's operation.
  • the operating device 25 has a first operating lever 25R and a second operating lever 25L.
  • the first control lever 25R is arranged, for example, on the right side of the driver's seat 2b.
  • the second control lever 25L is arranged, for example, on the left side of the driver's seat 2b.
  • the forward, backward, leftward, and rightward motions correspond to the motions of the two axes.
  • the boom 3a and the bucket 3c are operated by the first operating lever 25R.
  • Operation of the first control lever 25R in the front-rear direction corresponds to, for example, operation of the boom 3a, and the boom 3a is lowered and raised in response to the operation in the front-rear direction.
  • Operation of the first control lever 25R in the horizontal direction corresponds to, for example, operation of the bucket 3c, and the operation of the bucket 3c in the digging direction (upward) and the dumping direction (downward) is executed according to the horizontal direction operation.
  • the arm 3b and the revolving body 2 are operated by the second operating lever 25L.
  • the operation of the second control lever 25L in the front-rear direction corresponds to, for example, turning of the revolving body 2, and the revolving body 2 is turned to the right and left in response to the operation in the front-rear direction.
  • the lateral operation of the second control lever 25L corresponds to, for example, the operation of the arm 3b, and the arm 3b is moved in the dumping direction (upward) and the excavating direction (downward) in accordance with the lateral operation.
  • the pilot oil sent from the hydraulic pump 33 and decompressed by the decompression valve is supplied to the operating device 25 .
  • the pilot hydraulic pressure is adjusted based on the amount of operation of the operating device 25 .
  • the operating device 25 and the directional control valve 34 are connected via a pilot oil passage 450 . Pilot oil is supplied to the directional control valve 34 via a pilot oil passage 450 . As a result, the spool of the directional control valve 34 moves in the axial direction to adjust the flow direction and flow rate of hydraulic oil supplied to the boom cylinder 4a, the arm cylinder 4b and the bucket cylinder 4c. The vertical movement of 3c is executed.
  • a pressure sensor 36 is arranged in the pilot oil passage 450 .
  • a pressure sensor 36 detects the pilot oil pressure.
  • a detection result of the pressure sensor 36 is output to the controller 10 .
  • the amount of increase in the pilot hydraulic pressure varies depending on the angle at which each of the control levers 25L and 25R is tilted from the neutral position. The details of the operation of the operating device 25 can be determined based on the result of detection of the pilot oil pressure by the pressure sensor 36 .
  • Detection signals of stroke sensors 7a-7c, IMUs 8a-8d, angle sensors 9a-9c and pressure sensors 6a-6f are also input to the controller 10.
  • the controller 10 may be electrically connected to each of the stroke sensors 7a to 7c, IMUs 8a to 8d, angle sensors 9a to 9c, and pressure sensors 6a to 6f, 36 by wire, or may communicate wirelessly.
  • the controller 10 is, for example, a computer, server, mobile terminal, or the like, and may be a CPU (Central Processing Unit).
  • the operation device 25 may be an electric type of operation device.
  • the amount of operation of each of the first operating lever 25R and the second operating lever 25L is detected by, for example, a potentiometer.
  • a potentiometer is a displacement sensor that produces an electrical (voltage) output proportional to mechanical position.
  • a detection result of the potentiometer is output to the controller 10 .
  • the content of the operation of the operation device 25 can be determined based on the detection result of the potentiometer.
  • FIG. 3 is a diagram showing functional blocks within the controller 10 shown in FIG.
  • the boom cylinder thrust calculation unit 10a acquires the detection results of the pressure sensors 6a and 6b. Specifically, the boom cylinder thrust calculation unit 10a acquires the head pressure of the boom cylinder 4a detected by the pressure sensor 6a. The boom cylinder thrust calculation unit 10a acquires the bottom pressure of the boom cylinder 4a detected by the pressure sensor 6b. The boom cylinder thrust calculation unit 10a calculates a boom cylinder thrust Fboom based on the head pressure and bottom pressure of the boom cylinder 4a.
  • Thrust is defined as a force that pushes an object in the direction of movement
  • the boom cylinder thrust Fboom is the thrust generated by the boom cylinder 4a that causes the boom 3a to rotate relative to the vehicle body.
  • the boom cylinder thrust force Fboom is a force acting in the extending direction of the boom cylinder 4a.
  • the boom cylinder thrust force calculation unit 10a outputs the calculated boom cylinder thrust force Fboom to the payload amount calculation unit 10i.
  • the arm cylinder thrust calculation unit 10b acquires the detection results of the pressure sensors 6c and 6d. Specifically, the arm cylinder thrust calculation unit 10b acquires the head pressure of the arm cylinder 4b detected by the pressure sensor 6c. The arm cylinder thrust calculation unit 10b acquires the bottom pressure of the arm cylinder 4b detected by the pressure sensor 6d. The arm cylinder thrust calculation unit 10b calculates the arm cylinder thrust Farm based on the head pressure and the bottom pressure of the arm cylinder 4b.
  • the arm cylinder thrust force Farm is a thrust force generated by the arm cylinder 4b that causes the arm 3b to rotate relative to the boom 3a.
  • the arm cylinder thrust force Farm is a force acting in the extending direction of the arm cylinder 4b.
  • the arm cylinder thrust force calculation unit 10b outputs the calculated arm cylinder thrust force Farm to the load amount calculation unit 10i.
  • the bucket cylinder thrust calculation unit 10c acquires the detection results of the pressure sensors 6e and 6f. Specifically, the bucket cylinder thrust calculation unit 10c acquires the head pressure of the bucket cylinder 4c detected by the pressure sensor 6e. The bucket cylinder thrust calculation unit 10c acquires the bottom pressure of the bucket cylinder 4c detected by the pressure sensor 6f. The bucket cylinder thrust calculation unit 10c calculates the bucket cylinder thrust Fbucket based on the head pressure and bottom pressure of the bucket cylinder 4c.
  • the bucket cylinder thrust force Fbucket is a thrust force generated by the bucket cylinder 4c that causes the bucket 3c to rotate relative to the arm 3b.
  • the bucket cylinder thrust Fbucket is a force acting in the extending direction of the bucket cylinder 4c.
  • the bucket cylinder thrust force calculation unit 10c outputs the calculated bucket cylinder thrust force Fbucket to the payload amount calculation unit 10i.
  • the boom angle calculator 10d acquires information about the boom angle ⁇ b from at least one of the stroke sensor 7a, IMU 8b, and angle sensor 9a.
  • the boom angle calculator 10d calculates the boom angle ⁇ b based on the acquired information.
  • the boom angle calculator 10d outputs the calculated boom angle ⁇ b to the center-of-gravity position calculator 10g.
  • the arm angle calculator 10e acquires information about the arm angle ⁇ a from at least one of the stroke sensor 7b, IMU 8c, and angle sensor 9b.
  • the arm angle calculator 10e calculates the arm angle ⁇ a based on the acquired information.
  • the arm angle calculator 10e outputs the calculated arm angle ⁇ a to the center-of-gravity position calculator 10g.
  • the bucket angle calculator 10f acquires information about the bucket angle ⁇ k from at least one of the stroke sensor 7c, IMU 8d, and angle sensor 9c. The bucket angle calculator 10f calculates the bucket angle ⁇ k based on the acquired information. The bucket angle calculator 10f outputs the calculated bucket angle ⁇ k to the center-of-gravity position calculator 10g.
  • the storage unit 10j stores various types of information such as the dimensions, weight, and position of the center of gravity of each member that constitutes the working machine 3. These various types of information may be input from the input unit 11 outside the controller 10 to the storage unit 10j.
  • the storage unit 10j may be arranged outside the controller 10 instead of being included in the controller 10. FIG.
  • the center-of-gravity position calculation unit 10g calculates the relative position of the center of gravity of each member constituting the working machine 3, such as the boom 3a, the cylinder 4aa of the boom cylinder 4a, the first link member 3da, etc., with respect to the boom bottom pin 5a.
  • the center-of-gravity position calculator 10g stores the boom angle ⁇ b calculated by the boom angle calculator 10d, the arm angle ⁇ a calculated by the arm angle calculator 10e, and the bucket angle ⁇ k calculated by the bucket angle calculator 10f.
  • the relative positions of the members forming the work machine 3 are calculated from the position of the center of gravity of each member forming the work machine 3 stored in the section 10j.
  • the center-of-gravity position calculation unit 10g calculates the postures of the boom 3a, the arm 3b, and the bucket 3c based on the boom bottom pin 5a from the boom angle ⁇ b, the arm angle ⁇ a, and the bucket angle ⁇ k.
  • the center-of-gravity position calculation unit 10g calculates the states (attitudes and strokes) of other constituent members of the working machine 3 from the calculated attitudes.
  • the center-of-gravity position calculation unit 10g calculates the relative position of each member of the working machine 3 with respect to the boom bottom pin 5a based on the calculation result and the stored center-of-gravity position of each member.
  • the moment distance calculator 10h calculates the distance in the horizontal direction from the boom bottom pin 5a to the center of gravity of each member that constitutes the working machine. Specifically, the moment distance calculator 10h calculates a horizontal distance Xboom from the boom bottom pin 5a to the center of gravity of the boom 3a. The moment distance calculator 10h calculates a horizontal distance Xarm from the boom bottom pin 5a to the center of gravity of the arm 3b. The moment distance calculator 10h calculates a horizontal distance Xbucket from the boom bottom pin 5a to the center of gravity of the bucket 3c.
  • the moment distance calculator 10h calculates a horizontal distance XboomC from the boom bottom pin 5a to the center of gravity of the cylinder portion (cylinder 4aa) of the boom cylinder 4a.
  • the moment distance calculator 10h calculates a horizontal distance XboomCR from the boom bottom pin 5a to the center of gravity of the cylinder rod portion (cylinder rod 4ab) of the boom cylinder 4a.
  • the moment distance calculator 10h calculates a horizontal distance XarmC from the boom bottom pin 5a to the center of gravity of the cylinder portion of the arm cylinder 4b.
  • the moment distance calculator 10h calculates a horizontal distance XarmCR from the boom bottom pin 5a to the center of gravity of the cylinder rod portion of the arm cylinder 4b.
  • the moment distance calculator 10h also calculates a horizontal distance Xboomtop from the boom bottom pin 5a to the boom top pin 5b.
  • the moment distance calculator 10h calculates a horizontal distance Xarmtop from the boom bottom pin 5a to the arm top pin 5c.
  • the moment distance calculator 10h also calculates the distance hboom from the boom bottom pin 5a to the boom cylinder 4a in the direction orthogonal to the extending direction of the boom cylinder 4a.
  • the moment distance calculator 10h calculates the distance harm from the boom top pin 5b to the arm cylinder 4b in the direction orthogonal to the extending direction of the arm cylinder 4b.
  • the moment distance calculator 10h calculates the distance hbucket from the arm top pin 5c to the bucket cylinder 4c in the direction orthogonal to the extending direction of the bucket cylinder 4c.
  • the moment distance calculation unit 10h outputs these calculated distances to the payload calculation unit 10i.
  • the payload calculation unit 10i calculates the weight Mpayload of the load L loaded on the bucket 3c. A method of calculating the weight Mpayload will be described later.
  • the payload calculation unit 10 i outputs the calculated weight M payload to the display unit 12 outside the controller 10 .
  • the display unit 12 may be arranged, for example, in the operator's cab 2 a ( FIG. 1 ), or may be arranged at a remote location away from the hydraulic excavator 100 .
  • the display unit 12 displays the calculated weight Mpayload on the screen.
  • An operator who operates the excavator 100 in the operator's cab 2a, an operator who operates the excavator 100 at a remote location, a supervisor who monitors the operation of the excavator 100, or the like can see the load on the bucket 3c by looking at the display unit 12.
  • the weight Mpayload of the load L can be recognized.
  • each of the input unit 11 and the display unit 12 may be connected to the controller 10 by wire or wirelessly.
  • FIG. 3 is a schematic diagram showing the moment balance around the boom bottom pin 5a.
  • a moment balance formula around the boom bottom pin 5a is represented by the following formula (1).
  • Equation (1) The left side of equation (1) is the moment due to the boom cylinder thrust force Fboom.
  • Mpayload is the weight of the load L loaded on the bucket 3c.
  • Xpayload is the horizontal distance from the boom bottom pin 5a to the center of gravity of the load L loaded on the bucket 3c.
  • the first term on the right side of Equation (1) is the moment due to the load L loaded on the bucket 3c.
  • Mboom is the weight of the boom 3a.
  • MboomC is the weight of the cylinder portion of the boom cylinder 4a.
  • MboomCR is the weight of the cylinder rod portion of the boom cylinder 4a.
  • Marm is the weight of arm 3b.
  • MarmC is the weight of the cylinder portion of the arm cylinder 4b.
  • MarmCR is the weight of the cylinder rod portion of the arm cylinder 4b.
  • Mbucket is the weight of the bucket 3c.
  • Each of these weights Mboom, MboomC, MboomCR, Marm, MarmC, MarmCR and Mbucket is stored in storage unit 10j by performing an input operation to storage unit 10j through input unit 11 shown in FIG. ing.
  • FIG. 5 is a schematic diagram showing the balance of moments around the arm top pin 5c.
  • a moment balance formula about the arm top pin 5c is represented by the following formula (3).
  • the left side of equation (3) is the moment due to the thrust force Fbucket of the bucket cylinder 4c.
  • the first term on the right side of equation (3) is the moment due to the load L loaded on the bucket 3c.
  • MXwe_bucket in the second term on the right side of equation (3) is the moment due to the weight of the bucket 3c.
  • equation (4) that does not depend on the distance Xpayload can be formulated as an equation for calculating the payload Mpayload.
  • the distance Xpayload is included in formula (1), and the distance Xpayload is also included in formula (3). Solving these two balance equations as simultaneous equations yields equation (4) that does not include the distance Xpayload. Based on the formula (4), it becomes possible to calculate the payload amount Mpayload. As a result, it is possible to eliminate the influence of the positional deviation of the center of gravity of the load L loaded on the bucket 3c, and to calculate the payload amount Mpayload with higher accuracy.
  • the distance Xpayload can be calculated by substituting the payload amount Mpayload calculated according to formula (4) into formula (1) or formula (3). Further, from the simultaneous equations of the equations (1) and (3), the following equation (5) that does not depend on the payload Mpayload can be formulated as an equation for calculating the distance Xpayload.
  • the position of the center of gravity of the load L loaded on the bucket 3c can be corrected according to the calculated distance Xpayload.
  • the calculation method for calculating the weight Mpayload of the load L carried by the bucket 3c includes the following processing.
  • FIG. 11 is a diagram illustrating a flow chart of the computation method of the present disclosure.
  • step S1 shown in FIG. 11 The process executed in step S1 shown in FIG. 11 is performed with respect to the members of the working machine 3 with respect to the boom bottom pin 5a (first rotation center), the boom top pin 5b (second rotation center), and the arm top pin 5c (second rotation center). It is to formulate a relational expression of the motion around any two of the three rotation centers).
  • a relational expression of motion about the first rotation center and the third rotation center is formulated.
  • the motion relational expression may be a moment balance equation about the center of rotation of motion.
  • the equation may acquire relational expression information stored in the storage unit 10j.
  • the relational expression information acquired from the storage unit 10j may be one relational expression obtained by organizing the payload amount Mpayload from the two relational expressions of motion around the center of rotation.
  • step S2 The processing executed in step S2 is to acquire the weight and center of gravity position of each member of the boom 3a, arm 3b and bucket 3c (attachment). Information on the center of gravity and the position of the center of gravity of each member may be obtained from the storage unit 10j.
  • the process executed in step S3 is to acquire the position of each member when the load L is transported.
  • the position of each member may be obtained by obtaining the rotation angle of each member, which indicates the orientation of each member, and calculating from the rotation angle.
  • the process executed in step S4 is to obtain the thrust force corresponding to the motion of each member in the relational expression of the motion of each member.
  • the thrust is obtained by measuring the working oil pressure of the hydraulic cylinders that operate the boom 3a and the bucket 3c. Thrust may be obtained from the head and bottom pressures of the hydraulic cylinders that rotate the boom 3a, arm 3b and bucket 3c (attachment) members.
  • step S5 from the position of the center of gravity of each member and the position of each member during transportation of the load L, the center of gravity of each member during transportation of the load L and the center of rotation of each member are calculated. Calculating the horizontal distances (moment distances) from each of the first rotation center, the second rotation center, and the third rotation center.
  • the obtained information and the calculated information are input to the relational expression of the motion of each member, and the weight of the load L to be carried by the working machine 3 (the payload Mpayload) is calculated. That is.
  • the acquired information refers to the weight and center-of-gravity position of each member of the working machine 3, and the thrust force of the hydraulic cylinder that rotates each member when the load L is being transported.
  • the calculated information refers to the horizontal distance between the center of gravity of each member and the center of rotation of each member when the load L is conveyed.
  • the weight Mpayload of the load L loaded on the bucket 3c is calculated from two balance equations, a moment balance equation about the boom bottom pin 5a and a moment balance equation about the arm top pin 5c.
  • the controller 10 is not limited to this example, and the controller 10 can use any two of a moment balance formula around the boom bottom pin 5a, a moment balance formula around the boom top pin 5b, and a moment balance formula around the arm top pin 5c. From the equation, the weight Mpayload of the load L loaded on the bucket 3c can be calculated.
  • the weight Mpayload is calculated from two balance equations, one for the moment around the boom bottom pin 5a and the other for the moment around the boom top pin 5b.
  • the payload calculation unit 10i reads out the moment balance formula around the boom top pin 5b from the storage unit 10j.
  • FIG. 6 is a schematic diagram showing the moment balance around the boom top pin 5b.
  • a moment balance formula around the boom top pin 5b is represented by the following formula (6).
  • Equation (6) The left side of equation (6) is the moment due to the arm cylinder thrust force Farm.
  • the first term on the right side of equation (6) is the moment due to the load L loaded on the bucket 3c.
  • MXwe_arm in the second term on the right side of Equation (6) is the moment due to the weight of the work implement 3 on the tip side of the work implement 3 relative to the boom top pin 5b.
  • Moment MXwe_arm is calculated by a balance formula similar to formula (2).
  • equation (7) that does not depend on the distance Xpayload can be formulated as an equation for calculating the payload Mpayload.
  • the distance Xpayload is included in formula (1), and the distance Xpayload is also included in formula (6). Solving these two balance equations as simultaneous equations yields equation (7) that does not include the distance Xpayload. Based on the formula (7), it becomes possible to calculate the payload Mpayload. As a result, it is possible to eliminate the influence of the positional deviation of the center of gravity of the load L loaded on the bucket 3c, and to calculate the payload amount Mpayload with higher accuracy.
  • the distance Xpayload can be calculated by substituting the payload amount Mpayload calculated according to formula (7) into formula (1) or formula (6). Further, from the simultaneous equations of Equations (1) and (6), an equation that does not depend on the payload Mpayload can be formulated as an equation for calculating the distance Xpayload. The position of the center of gravity of the load L loaded on the bucket 3c can be corrected according to the calculated distance Xpayload.
  • the concept of the embodiment is not limited to this example, and for example, the concept of the embodiment can be applied to the arm crane specification hydraulic excavator 100 in which the hoisting hook is attached to the second link pin 3de and the load L can be hoisted and hoisted. It is possible to accurately calculate the weight of the load.
  • each of the three links (boom 3a, arm 3b, bucket 3c) of work implement 3 has position sensors 9a, 9b, 9c and corresponding pressure sensor 6a. , 6b, 6c, but is not limited to this configuration.
  • Pressure sensors may be provided only on links that are subject to the two equations used to calculate the payload Mpayload.
  • the hydraulic excavator 100 including the bucket 3c as the attachment at the tip of the working machine 3 has been described.
  • the attachment is not limited to the bucket 3c, and the attachment may be replaced with a grapple, a lifting magnet, or the like depending on the type of work.
  • a hydraulic excavator 100 having a lifting magnet 103 as an attachment will be described.
  • FIG. 7 is a side view schematically showing the configuration of a hydraulic excavator 100 as an example of a working machine based on the third embodiment.
  • a hydraulic excavator 100 according to the third embodiment has substantially the same configuration as the hydraulic excavator 100 according to the first embodiment shown in FIG. different in that respect.
  • the lifting magnet 103 has a body portion 105 and a support portion 104 .
  • the body portion 105 is a magnet that generates magnetic force.
  • Body portion 105 is, for example, an electromagnet.
  • the main body 105 can hold and carry a magnetic body by magnetic force.
  • the support portion 104 supports the body portion 105 .
  • the support portion 104 is rotatably connected to the tip portion of the arm 3b by an arm top pin 5c.
  • a proximal end of the second link member 3db is rotatably connected to a bracket at the root portion of the support portion 104 by a second link pin 3de.
  • the weight of the load L can be calculated with higher accuracy by eliminating the influence of the deviation of the center of gravity position of the load L held by the lifting magnet 103.
  • the weight of the load L can be calculated more accurately by calculating the weight of the load L while the revolving structure 2 is swinging with respect to the traveling structure 1. can.
  • the work machine is the hydraulic excavator 100
  • the weight of the load L carried by the work machine 3 can be reduced. It is possible to calculate with high accuracy.
  • the work machine may be a wheel loader, backhoe loader, skid steer loader, or the like.
  • FIG. 8 is a side view schematically showing the configuration of a wheel loader 200 as an example of a working machine based on the fourth embodiment.
  • wheel loader 200 has vehicle body frame 202 , working machine 203 , traveling device 204 , and cab 205 .
  • the vehicle body of the wheel loader 200 is composed of the vehicle body frame 202 and the cab 205 . Inside the cab 205, a seat on which an operator sits, an operation device, and the like are arranged. A work machine 203 and a travel device 204 are attached to the vehicle body of the wheel loader 200 . The working machine 203 is arranged in front of the vehicle body, and a counterweight 206 is provided at the rearmost end of the vehicle body.
  • the body frame 202 includes a front frame 211 and a rear frame 212.
  • a steering cylinder 213 is attached to the front frame 211 and the rear frame 212 .
  • Steering cylinder 213 is a hydraulic cylinder.
  • the steering cylinder 213 expands and contracts with hydraulic fluid from a steering pump (not shown). The expansion and contraction of the steering cylinder 213 allows the front frame 211 and the rear frame 212 to swing relative to each other in the left-right direction. As a result, the traveling direction of the wheel loader 200 can be changed left and right.
  • the direction in which the wheel loader 200 travels straight is called the front-rear direction of the wheel loader 200 .
  • the front-rear direction of the wheel loader 200 the side on which the work implement 203 is arranged with respect to the body frame 202 is defined as the front direction, and the side opposite to the front direction is defined as the rear direction.
  • the left-right direction of the wheel loader 200 is a direction orthogonal to the front-rear direction in plan view.
  • the right side and the left side in the horizontal direction as viewed from the front are the right side and the left side, respectively.
  • the vertical direction of the wheel loader 200 is a direction orthogonal to a plane defined by the front-rear direction and the left-right direction. In the vertical direction, the side with the ground is the lower side, and the side with the sky is the upper side.
  • the running device 204 includes running wheels 204a and 204b. Each of the running wheels 204a and 204b is a wheel and has a tire made of rubber.
  • the running wheel (front wheel) 204a is rotatably attached to the front frame 211 .
  • the running wheel (rear wheel) 204b is rotatably attached to the rear frame 212 .
  • the wheel loader 200 can be self-propelled by rotationally driving the running wheels 204a and 204b.
  • the work machine 203 is for performing work such as excavation.
  • Work implement 203 is attached to front frame 211 .
  • Work implement 203 includes a bucket 214 , a boom 215 , a bell crank 216 , a tilt rod 217 , a boom cylinder 218 and a bucket cylinder 219 .
  • the base end of the boom 215 is rotatably attached to the front frame 211 by a boom bottom pin 221.
  • the boom 215 is thereby rotatably attached to the vehicle body.
  • Bucket 214 is rotatably attached to the tip of boom 215 by boom top pin 222 .
  • the boom bottom pin 221 is supported by the vehicle body of the wheel loader 200 .
  • a boom top pin 222 is attached to the tip of the boom 215 .
  • the boom bottom pin 221 and boom top pin 222 extend in the left-right direction.
  • the boom cylinder 218 drives the boom 215.
  • One end of the boom cylinder 218 is rotatably attached to the front frame 211 of the vehicle body by a pin 223 .
  • the boom cylinder 218 is thereby rotatably attached to the vehicle body.
  • the other end of boom cylinder 218 is rotatably attached to boom 215 by pin 224 .
  • the boom cylinder 218 is, for example, a hydraulic cylinder.
  • Boom cylinder 218 is extended and retracted by hydraulic oil from a work machine pump (not shown). As a result, the boom 215 is driven, and the bucket 214 attached to the tip of the boom 215 is raised and lowered.
  • the bellcrank 216 is rotatably supported on the boom 215 by a support pin 229.
  • the bellcrank 216 has a first end located on one side of the support pin 229 and a second end located on the opposite side of the support pin 229 from the first end.
  • a first end of bell crank 216 is connected to bucket 214 via tilt rod 217 .
  • a second end of the bellcrank 216 is connected to the front frame 211 of the vehicle body via a bucket cylinder 219 .
  • tilt rod 217 is rotatably attached to the first end of the bellcrank 216 by a pin 227.
  • the other end of tilt rod 217 is rotatably attached to bucket 214 by pin 228 .
  • a bucket cylinder 219 drives the bucket 214 with respect to the boom 215 .
  • One end of the bucket cylinder 219 is rotatably attached to the front frame 211 of the vehicle body by a pin 225 .
  • the other end of bucket cylinder 219 is rotatably attached to the second end of bellcrank 216 by pin 226 .
  • the bucket cylinder 219 is, for example, a hydraulic cylinder. Bucket cylinder 219 expands and contracts with hydraulic oil from a work machine pump (not shown). The expansion and contraction of the bucket cylinder 219 drives the bellcrank 216 and rotates the bellcrank 216 with respect to the boom 215 . The rotation of the bellcrank 216 is transmitted to the bucket 214 via the tilt rod 217 to drive the bucket 214 and rotate the bucket 214 up and down with respect to the boom 215 .
  • Bellcrank 216 corresponds to a pivoting member of the embodiment that is rotatable relative to boom 215 together with bucket 214 .
  • the wheel loader 200 further has a sensor that detects information about the thrust Fboom of the boom cylinder 218 and a sensor that detects information about the thrust Fbucket of the bucket cylinder 219 .
  • the sensors that detect information on the thrust force Fboom of the boom cylinder 218 are, for example, the pressure sensors 231b and 231h.
  • Each of pressure sensors 231 b and 231 h detects the cylinder pressure of boom cylinder 218 .
  • a pressure sensor 231 b detects the bottom pressure of the boom cylinder 218 .
  • a pressure sensor 231 h detects the head pressure of the boom cylinder 218 .
  • Head pressure means the pressure on the cylinder rod side with respect to the piston of the hydraulic cylinder
  • bottom pressure means the pressure on the tube side with respect to the piston
  • the sensors that detect information on the thrust force Fbucket of the bucket cylinder 219 are, for example, pressure sensors 232b and 232h. Each of pressure sensors 232 b and 232 h detects the cylinder pressure of bucket cylinder 219 . A pressure sensor 232 b detects the bottom pressure of the bucket cylinder 219 . A pressure sensor 232 h detects the head pressure of the bucket cylinder 219 .
  • the wheel loader 200 further has a sensor that detects information about the attitude of the working machine 203 .
  • Sensors that detect information about the attitude of work implement 203 include, for example, a first sensor that detects information about the boom angle and a second sensor that detects information about the bucket angle with respect to the boom.
  • the information about the attitude of the working machine 203 includes the distance hboom and the distance hbucket (Fig. 10).
  • a distance hboom is the distance between the boom bottom pin 221 and the pin 223 and is the distance in the direction orthogonal to the direction in which the boom cylinder 218 extends.
  • a distance hbucket is the distance between the support pin 229 and the pin 226 and is the distance in the direction perpendicular to the direction in which the bucket cylinder 219 extends.
  • the boom angle is the angle of the boom 215 with respect to the front frame 211 of the vehicle body.
  • Bucket angle is the angle of bucket 214 relative to boom 215 .
  • a first sensor that detects information about the boom angle is the potentiometer 233, for example.
  • a potentiometer 233 is mounted concentrically with the boom bottom pin 221 .
  • the stroke sensor 235 of the boom cylinder 218 may be used instead of the potentiometer 233 as the first sensor that detects information about the boom angle.
  • an IMU (Inertial Measurement Unit) 237 may be used as the first sensor that detects information about the boom angle. IMU 237 is attached to boom 215, for example.
  • a second sensor that detects information about the bucket angle is the potentiometer 234, for example.
  • a potentiometer 234 is mounted concentrically with the support pin 229 .
  • a stroke sensor 236 of the bucket cylinder 219 may be used instead of the potentiometer 234 as the second sensor that detects information about the bucket angle.
  • the IMU 238 may be used as a second sensor that detects information about the bucket angle. IMU 238 is attached to tilt rod 217, for example.
  • the potentiometers 233, 234, stroke sensors 235, 236, and IMUs 237, 238 described above may be used as sensors for detecting information regarding the position of the center of gravity GC1 of the work implement 203.
  • the information regarding the position of the center of gravity GC1 of work implement 203 is the distance Xwe.
  • the distance Xwe is the distance between the center of gravity GC1 and the boom bottom pin 221, and is the distance along the front-rear direction of the wheel loader 200.
  • the distance Xwe is the horizontal distance between the center of gravity GC1 and the boom bottom pin 221 when the wheel loader 200 is placed on the horizontal ground.
  • the potentiometers 233, 234, stroke sensors 235, 236, and IMUs 237, 238 may also be used as sensors for detecting information regarding the position of the center of gravity GC2 of the cargo within the bucket 214.
  • the information regarding the position of the center of gravity GC2 of the cargo within the bucket 214 is the distance Xpayload.
  • the distance Xpayload is the distance between the center of gravity GC2 and the boom bottom pin 221, and is the distance along the front-rear direction of the wheel loader 200.
  • Xpayload is the horizontal distance between the center of gravity GC2 and the boom bottom pin 221 when the wheel loader 200 is placed on the horizontal ground.
  • FIG. 9 is a diagram showing functional blocks within the controller 250 of the fourth embodiment.
  • the system in this embodiment is a system for determining the amount of load, which is the weight of the load to be carried by the working machine 203 .
  • the system in this embodiment includes a wheel loader 200 as an example of a working machine shown in FIG. 8 and a controller 250 shown in FIG. Controller 250 may be mounted on wheel loader 200 .
  • Controller 250 may be installed outside wheel loader 200 .
  • Controller 250 may be located at the work site of wheel loader 200 or at a remote location away from the work site of wheel loader 200 .
  • the boom cylinder thrust calculation unit 250a acquires the detection results of the pressure sensors 231b and 231h. Specifically, the boom cylinder thrust calculation unit 250a acquires the head pressure of the boom cylinder 218 detected by the pressure sensor 231h. The boom cylinder thrust calculation unit 250a acquires the bottom pressure of the boom cylinder 218 detected by the pressure sensor 231b. The boom cylinder thrust calculation unit 250a calculates a boom cylinder thrust Fboom based on the head pressure and bottom pressure of the boom cylinder 218 .
  • Thrust is defined as a force that pushes an object in the direction of motion
  • the boom cylinder thrust Fboom is the thrust generated by the boom cylinder 218 that causes the boom 215 to rotate relative to the vehicle body.
  • the boom cylinder thrust force calculation unit 250a outputs the calculated boom cylinder thrust force Fboom to the payload amount calculation unit 250i.
  • the bucket cylinder thrust calculation unit 250c acquires the detection results of the pressure sensors 232b and 232h. Specifically, the bucket cylinder thrust calculation unit 250c acquires the head pressure of the bucket cylinder 219 detected by the pressure sensor 232h. The bucket cylinder thrust calculation unit 250c acquires the bottom pressure of the bucket cylinder 219 detected by the pressure sensor 232b. Bucket cylinder thrust calculation section 250 c calculates bucket cylinder thrust Fbucket based on the head pressure and bottom pressure of bucket cylinder 219 .
  • the bucket cylinder thrust force Fbucket is a thrust force generated by the bucket cylinder 219 that causes the bucket 214 to rotate relative to the boom 215 .
  • the bucket cylinder thrust force calculation unit 250c outputs the calculated bucket cylinder thrust force Fbucket to the payload amount calculation unit 250i.
  • the boom angle calculator 250d acquires information about the boom angle from at least one of the stroke sensor 235, IMU 237, and potentiometer 233. The boom angle calculator 250d calculates the boom angle based on the acquired information. The boom angle calculator 250d outputs the calculated boom angle to the center-of-gravity position calculator 250g.
  • the bucket angle calculator 250f acquires information about the bucket angle from at least one of the stroke sensor 236, the IMU 238, and the potentiometer 234. Bucket angle calculator 250f calculates the bucket angle based on the acquired information. Bucket angle calculator 250f outputs the calculated bucket angle to center-of-gravity position calculator 250g.
  • the storage unit 250j stores various information such as the dimensions and weights of the members constituting the working machine 203 and the position of the center of gravity GC1 of the working machine 203. These various types of information may be input from the input unit 251 outside the controller 250 to the storage unit 250j.
  • the storage unit 250j may be arranged outside the controller 250 instead of being included in the controller 250. FIG.
  • the center-of-gravity position calculator 250g calculates the relative position of the center of gravity GC1 of the work implement 203 with respect to the boom bottom pin 221 .
  • the center-of-gravity position calculation unit 250g calculates the boom angle calculated by the boom angle calculation unit 250d, the bucket angle calculated by the bucket angle calculation unit 250f, and the position of the center of gravity GC1 of the work machine 203 stored in the storage unit 10j. , the relative position of the center of gravity GC1 of the working machine 203 is calculated.
  • the moment distance calculator 250h calculates the distance in the horizontal direction from the boom bottom pin 221 to the center of gravity GC1 of the work implement 203. Specifically, moment distance calculator 250h calculates horizontal distance Xwe from boom bottom pin 221 to center of gravity GC1 of work implement 203 .
  • the moment distance calculator 250h also calculates a horizontal distance Xbucket from the boom bottom pin 221 to the center of gravity GC3 (FIG. 10) of the bucket 214.
  • the moment distance calculator 250 h calculates a horizontal distance Xtiltrod from the boom bottom pin 221 to the center of gravity of the tilt rod 217 .
  • the moment distance calculator 250h calculates the horizontal distance Xpin from the boom bottom pin 221 to the support pin 229 .
  • the moment distance calculator 250h calculates the distance hboom from the boom bottom pin 221 to the boom cylinder 218 in the direction perpendicular to the extension direction of the boom cylinder 218 .
  • the moment distance calculator 250h calculates the distance hbucket from the support pin 229 to the bucket cylinder 219 in the direction perpendicular to the extending direction of the bucket cylinder 219 .
  • the moment distance calculation unit 250h outputs these calculated distances to the payload calculation unit 250i.
  • the load weight calculator 250i calculates the weight Mpayload of the load loaded on the bucket 214.
  • the payload calculation unit 250 i outputs the calculated weight Mpayload to the display unit 252 outside the controller 250 .
  • Display 252 may be located, for example, in cab 205 ( FIG. 8 ), or may be located at a remote location away from wheel loader 200 .
  • the display unit 252 displays the calculated weight Mpayload on the screen.
  • An operator who operates the wheel loader 200 in the cab 205 an operator who operates the wheel loader 200 at a remote location, a supervisor who monitors the operation of the wheel loader 200 , or the like, sees the display section 252 to see that the bucket 214 is loaded.
  • the payload weight Mpayload can be recognized.
  • each of the input unit 251 and the display unit 252 may be connected to the controller 250 by wire or wirelessly.
  • the payload calculation unit 250i shown in FIG. 9 reads out the balance formula of the moment around the boom bottom pin 221 from the storage unit 250j.
  • a moment balance formula around the boom bottom pin 221 is represented by the following formula (8).
  • Equation (8) The left side of equation (8) is the moment due to the boom cylinder thrust force Fboom.
  • Mpayload is the weight of the load on bucket 214 .
  • Xpayload is the horizontal distance from the boom bottom pin 221 to the center of gravity GC2 of the load loaded on the bucket 214;
  • the first term on the right side of equation (8) is the moment due to the load loaded on bucket 214 .
  • Equation (8) The second term MXwe on the right side of equation (8) is the moment due to the weight of the work implement 203 itself.
  • Moment MXwe is obtained by multiplying the sum M1 (FIG. 8) of the weight of each member constituting work implement 203 and the horizontal distance Xwe from boom bottom pin 221 to center of gravity GC1 of work implement 203 .
  • FIG. 10 is a schematic diagram showing the balance of moments around the support pin 229. As shown in FIG. A moment balance formula about the support pin 229 is represented by the following formula (9).
  • Equation (9) The left side of equation (9) is the moment due to the bucket cylinder thrust force Fbucket.
  • the first term on the right side of equation (9) is the moment due to the load loaded on bucket 214 .
  • MXwe_pin in the second term on the right side of equation (9) is a moment due to the weight of work implement 203 on the tip side of work implement 203 relative to support pin 229 .
  • Moment MXwe_pin is calculated by the following equation (10).
  • Mbucket is the weight of the bucket 214.
  • Mtiltrod is the weight of the tilt rod 217;
  • Each of these weights Mbucket and Mtiltrod is stored in the storage unit 250j, for example, by performing an input operation to the storage unit 250j with the input unit 251 shown in FIG.
  • equation (11) that does not depend on the distance Xpayload can be formulated as an equation for calculating the payload Mpayload.
  • the distance Xpayload is included in the formula (8), and the distance Xpayload is also included in the formula (9). Solving these two balance equations as simultaneous equations yields equation (11) that does not include the distance Xpayload. Based on the formula (11), it becomes possible to calculate the payload Mpayload. As a result, the influence of the deviation of the center of gravity of the load loaded on the bucket 214 can be eliminated, and the payload amount Mpayload can be calculated with higher accuracy.
  • the distance Xpayload can be calculated by substituting the payload Mpayload calculated according to the formula (11) into the formula (8) or (9). Further, from the simultaneous equations of Equations (8) and (9), an equation that does not depend on the payload Mpayload can be formulated as an equation for calculating the distance Xpayload. The center-of-gravity position of the load loaded on the bucket 214 can be corrected according to the calculated distance Xpayload.
  • the weight of the load is calculated while the wheel loader 200 moves backward with the load loaded in the bucket 214, thereby calculating the weight of the load more accurately. can do.
  • the controller 10 uses two of the moment balance formulas for each of the multiple links of the work machine as the relational formulas for calculating the weight of the load.
  • the relational expression is not limited to a moment balance expression, and may be an equation of motion for each of a plurality of links. Equations of motion, like balance equations, may be set up with information from pressure and position sensors.

Landscapes

  • Engineering & Computer Science (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Mechanical Engineering (AREA)
  • Operation Control Of Excavators (AREA)

Abstract

作業機の運搬する荷の重量を精度よく算出できる演算装置を提供する。油圧ショベル(100)は、車体と、車体に支持されたブームボトムピン(5a)と、ブームボトムピン(5a)により車体に回転可能に連結されたブーム(3a)と、ブーム(3a)の先端に取り付けられたブームトップピン(5b)と、ブームトップピン(5b)によりブーム(3a)に回転可能に連結されたアーム(3b)と、アーム(3b)の先端に取り付けられたアームトップピン(5c)と、アームトップピン(5c)によりアーム(3b)に回転可能に連結されたバケット(3c)とを備えている。演算装置は、ブームボトムピン(5a)まわりのモーメントの釣り合い式、ブームトップピン(5b)まわりのモーメントの釣り合い式、アームトップピン(5c)まわりのモーメントの釣り合い式のうちのいずれか2つの釣り合い式から、作業機(3)の運搬する荷の重量を算出する。

Description

演算装置および演算方法
 本開示は、作業機の運搬する荷の重量を算出する演算装置および演算方法に関する。
 特開平10-245874号公報(特許文献1)には、バケットを備えた油圧ショベルにおいて、バケット支持軸回りの力の釣り合い条件からバケット内の積荷重量を算出する演算装置が開示されている。
特開平10-245874号公報
 上記文献には、バケット積荷の重心位置を実験的に求めることが記載されている。しかしながら、バケット積荷の重心位置は必ずしも一定ではない。そのため、実験的に求めた重心位置を用いて積荷重量を算出する技術では、積荷重量の精度を高くすることが困難であった。
 本開示では、作業機の運搬する荷の重量を精度よく算出できる演算装置が提案される。
 本開示のある局面に従うと、作業機を備える作業機械における、作業機の運搬する荷の重量を算出する演算装置が提案される。作業機械は、車体と、車体に支持されたブームボトムピンと、ブームボトムピンにより車体に回転可能に連結されたブームと、ブームの先端に取り付けられたブームトップピンと、ブームトップピンによりブームに回転可能に連結されたアームと、アームの先端に取り付けられたアームトップピンと、アームトップピンによりアームに回転可能に連結されたアタッチメントとを備えている。演算装置は、ブームボトムピンまわりのモーメントの釣り合い式、ブームトップピンまわりのモーメントの釣り合い式、アームトップピンまわりのモーメントの釣り合い式のうちのいずれか2つの釣り合い式から、荷の重量を算出する。
 本開示のある局面に従うと、作業機を備える作業機械における、作業機の運搬する荷の重量を算出する演算装置が提案される。作業機械は、車体と、車体に支持されたブームボトムピンと、ブームボトムピンにより車体に回転可能に連結されたブームと、ブームの先端に取り付けられたブームトップピンと、ブームトップピンによりブームに回転可能に連結されたアタッチメントと、ブームに支持され、アタッチメントとともにブームに対して回転可能な回動部材とを備えている。演算装置は、ブームボトムピンまわりのモーメントの釣り合い式と、回動部材の回転中心まわりのモーメントの釣り合い式との2つの釣り合い式から、荷の重量を算出する。
 本開示のある局面に従うと、作業機を備える作業機械の、前記作業機の運搬する荷の重量を算出する演算装置が提案される。作業機械は、車体と、車体に支持されたブームボトムピンと、ブームボトムピンにより車体に一端を回転可能に連結されたブームと、ブームの他端に取り付けられたブームトップピンと、ブームトップピンによりブームの他端に一端を回転可能に連結されたアームと、アームの他端に取り付けられたアームトップピンと、アームトップピンによりアームの他端に一端を回転可能に連結されたアタッチメントと、ブームを駆動して回転動作させるブーム油圧シリンダと、アームを駆動して回転動作させるアーム油圧シリンダと、アタッチメントを駆動して回転動作させるアタッチメント油圧シリンダと、圧力センサと、位置センサとを備えている。圧力センサは、ブーム油圧シリンダに取り付けられブーム油圧シリンダの作動油圧力情報を出力するブーム圧力センサと、アーム油圧シリンダに取り付けられアーム油圧シリンダの作動油圧力情報を出力するアーム圧力センサと、アタッチメント油圧シリンダに取り付けられアタッチメント油圧シリンダの作動油圧力情報を出力するアタッチメント圧力センサと、のうちの少なくとも2つのセンサを含んでいる。位置センサは、車体に対するブームの位置を得るためのブーム情報を出力するブーム位置センサと、ブームに対するアームの位置を得るためのアーム情報を出力するアーム位置センサと、アームに対するアタッチメントの位置を得るためのアタッチメント情報を出力するアタッチメント位置センサと、を含んでいる。演算装置は、荷の運搬における、ブーム油圧シリンダの作動油圧力情報とブーム情報とから生成される第一の関係式と、アーム油圧シリンダの作動油圧力情報とアーム情報とから生成される第二の関係式と、アタッチメント油圧シリンダの作動油圧力情報とアタッチメント情報とから生成される第三の関係式と、のうちのいずれか2つの関係式から、荷の重量を算出する。圧力センサは、上記の2つの関係式に対応する2つのセンサを少なくとも含んでいる。
 本開示のある局面に従うと、作業機を備える作業機械の、作業機の運搬する荷の重量を算出する演算方法が提案される。作業機は、第1回転中心を軸として回動するブームと、第2回転中心を軸として回動するアームと、第3回転中心を軸として回動するアタッチメントと、を部材として有している。演算方法は、以下の処理を備えている。第1の処理は、上記の部材について、第1回転中心、第2回転中心および第3回転中心のうちのいずれか2つの回転中心回りの運動の関係式を立式することである。第2の処理は、部材の各々の重量および重心位置を取得することである。第3の処理は、荷の運搬時における部材の位置を取得することである。第4の処理は、関係式の運動に対応する推力を取得することである。第5の処理は、部材の重心位置と部材の位置とから、荷の運搬時における部材の各々の重心位置と、対応する第1回転中心、第2回転中心および第3回転中心のそれぞれとの水平方向距離を演算することである。第6の処理は、関係式と、取得された情報と、演算された情報とにより、作業機の運搬する荷の重量を演算することである。
 本開示に係る演算装置および演算方法によれば、作業機の運搬する荷の重量を精度よく算出することができる。
本開示の第一実施形態に基づく作業機械の構成を概略的に示す図である。 図1に示される作業機械のシステムの概略構成を示すブロック図である。 図2に示されるコントローラ内の機能ブロックを示す図である。 ブームボトムピンまわりのモーメントの釣り合いを示す模式図である。 アームトップピンまわりのモーメントの釣り合いを示す模式図である。 ブームトップピンまわりのモーメントの釣り合いを示す模式図である。 第三実施形態に基づく作業機械の構成を概略的に示す図である。 第四実施形態に基づく作業機械の構成を概略的に示す図である。 第四実施形態のコントローラ内の機能ブロックを示す図である。 支持ピンまわりのモーメントの釣り合いを示す模式図である。 本開示の演算方法のフローチャートを示す図である。
 以下、実施形態について図面に基づいて説明する。以下の説明では、同一部品には、同一の符号を付している。それらの名称および機能も同じである。したがって、それらについての詳細な説明は繰り返さない。
 [第一実施形態]
 <作業機械の構成>
 図1は、本開示の第一実施形態に基づく作業機械の一例としての油圧ショベル100の構成を概略的に示す側面図である。図1に示されるように、本実施の形態の油圧ショベル100は、走行体1と、旋回体2と、作業機3とを主に有している。走行体1と旋回体2とにより、油圧ショベル100の車体が構成されている。
 走行体1は左右一対の履帯装置1aを有している。この左右一対の履帯装置1aの各々は履帯を有している。左右一対の履帯が回転駆動されることにより油圧ショベル100が自走する。
 旋回体2は走行体1に対して旋回自在に設置されている。この旋回体2は、運転室(キャブ)2aと、運転席2bと、エンジンルーム2cと、カウンタウェイト2dとを主に有している。運転室2aは、旋回体2のたとえば前方左側(車両前側)に配置されている。運転室2aの内部空間には、オペレータが着座するための運転席2bが配置されている。
 エンジンルーム2cおよびカウンタウェイト2dの各々は、運転室2aに対して旋回体2の後方側(車両後側)に配置されている。エンジンルーム2cは、エンジンユニット(エンジン、排気処理構造体など)を収納している。エンジンルーム2cの上方はエンジンフードにより覆われている。カウンタウェイト2dは、エンジンルーム2cの後方に配置されている。
 作業機3は、旋回体2の前方側であって運転室2aのたとえば右側にて軸支されている。作業機3は、たとえばブーム3a、アーム3b、バケット3c、ブームシリンダ4a、アームシリンダ4b、バケットシリンダ4cなどを有している。ブーム3aの基端部(一端)は、ブームボトムピン5aにより旋回体2に回転可能に連結されている。アーム3bの基端部(一端)は、ブームトップピン5bによりブーム3aの先端部(他端)に回転可能に連結されている。バケット3c(の一端)は、アームトップピン5cによりアーム3bの先端部(他端)に回転可能に連結されている。
 本実施形態においては、作業機3を基準として、油圧ショベル100の各部の位置関係について説明する。
 作業機3のブーム3aは、旋回体2に対して、ブームボトムピン5aを中心に回転移動する。旋回体2に対して回動するブーム3aの特定の部分、たとえばブーム3aの先端部が移動する軌跡は円弧状であり、その円弧を含む平面が特定される。油圧ショベル100を平面視した場合に、当該平面は直線として表される。この直線の延びる方向が、油圧ショベル100の車体の前後方向、または旋回体2の前後方向であり、以下では単に前後方向ともいう。油圧ショベル100の車体の左右方向(車幅方向)、または旋回体2の左右方向とは、平面視において前後方向と直交する方向であり、以下では単に左右方向ともいう。油圧ショベル100の車体の上下方向、または旋回体2の上下方向とは、前後方向および左右方向によって定められる平面に直交する方向であり、以下では単に上下方向ともいう。
 前後方向において、車体から作業機3が突き出している側が前方向であり、前方向と反対方向が後方向である。前方向を視て左右方向の右側、左側がそれぞれ右方向、左方向である。上下方向において地面のある側が下側、空のある側が上側である。
 前後方向とは、運転室2a内の運転席2bに着座したオペレータの前後方向である。左右方向とは、運転席2bに着座したオペレータの左右方向である。上下方向とは、運転席2bに着座したオペレータの上下方向である。運転席2bに着座したオペレータに正対する方向が前方向であり、運転席2bに着座したオペレータの背後方向が後方向である。運転席2bに着座したオペレータが正面に正対したときの右側、左側がそれぞれ右方向、左方向である。運転席2bに着座したオペレータの足元側が下側、頭上側が上側である。
 ブーム3aは、ブームシリンダ(ブーム油圧シリンダ)4aにより駆動可能である。この駆動により、ブーム3aは、ブームボトムピン5aを中心に旋回体2に対して上下方向に回動可能である。アーム3bは、アームシリンダ(アーム油圧シリンダ)4bにより駆動可能である。この駆動により、アーム3bは、ブームトップピン5bを中心にブーム3aに対して上下方向に回動可能である。バケット(アタッチメント)3cは、バケットシリンダ(アタッチメント油圧シリンダ)4cにより駆動可能である。この駆動によりバケット3cは、アームトップピン5cを中心にアーム3bに対して上下方向に回動可能である。このように作業機3は駆動可能である。
 ブームボトムピン5aは、油圧ショベル100の車体に支持されている。ブームボトムピン5aは、旋回体2のフレームの一対の縦板(図示せず)に支持されている。ブームトップピン5bは、ブーム3aの先端に取り付けられている。アームトップピン5cは、アーム3bの先端に取り付けられている。ブームボトムピン5a、ブームトップピン5bおよびアームトップピン5cは、いずれも左右方向に延びている。ブームボトムピン5aはブームフートピンとも呼ばれる。
 作業機3は、バケットリンク3dを有している。バケットリンク3dは、第1リンク部材3daと、第2リンク部材3dbとを有している。第1リンク部材3daの先端と第2リンク部材3dbの先端とは、バケットシリンダトップピン3dcを介して、相対回転可能に連結されている。バケットシリンダトップピン3dcは、バケットシリンダ4cの先端に連結されている。したがって第1リンク部材3daおよび第2リンク部材3dbは、バケットシリンダ4cにピン連結されている。
 第1リンク部材3daの基端は、第1リンクピン3ddによりアーム3bに回転可能に連結されている。第2リンク部材3dbの基端は、第2リンクピン3deによりバケット3cの根元部分のブラケットに回転可能に連結されている。
 ブームシリンダ4aのヘッド側には、圧力センサ6aが取り付けられている。圧力センサ6aは、ブームシリンダ4aのシリンダヘッド側油室40A内の作動油の圧力(ヘッド圧)を検出することができる。ブームシリンダ4aのボトム側には、圧力センサ6bが取り付けられている。圧力センサ6bは、ブームシリンダ4aのシリンダボトム側油室40B内の作動油の圧力(ボトム圧)を検出することができる。圧力センサ6a,6bは、ヘッド圧とボトム圧とからなる作動油圧力情報を後述のコントローラ10に出力する。
 アームシリンダ4bのヘッド側には、圧力センサ6cが取り付けられている。圧力センサ6cは、アームシリンダ4bのシリンダヘッド側油室内の作動油の圧力(ヘッド圧)を検出することができる。アームシリンダ4bのボトム側には、圧力センサ6dが取り付けられている。圧力センサ6dは、アームシリンダ4bのシリンダボトム側油室内の作動油の圧力(ボトム圧)を検出することができる。圧力センサ6c,6dは、ヘッド圧とボトム圧とからなる作動油圧力情報を後述のコントローラ10に出力する。
 バケットシリンダ4cのヘッド側には、圧力センサ6eが取り付けられている。圧力センサ6eは、バケットシリンダ4cのシリンダヘッド側油室内の作動油の圧力(ヘッド圧)を検出することができる。バケットシリンダ4cのボトム側には、圧力センサ6fが取り付けられている。圧力センサ6fは、バケットシリンダ4cシリンダボトム側油室内の作動油の圧力(ボトム圧)を検出することができる。圧力センサ6e,6fは、ヘッド圧とボトム圧とからなる作動油圧力情報を後述のコントローラ10に出力する。
 ブーム3a、アーム3bおよびバケット3cには、それぞれの位置および姿勢の情報を得るための位置センサが設けられている。位置センサは、ブーム3a、アーム3bおよびバケット3cのそれぞれの位置を得るためのブーム情報、アーム情報およびアタッチメント情報を、後述のコントローラ10に出力する。
 ブームシリンダ4aには、位置センサとして、ストロークセンサ7aが取り付けられている。ストロークセンサ7aは、ブームシリンダ4aにおけるシリンダaaに対するシリンダロッド4abの変位量をブーム情報として検出する。アームシリンダ4bには、位置センサとして、ストロークセンサ7bが取り付けられている。ストロークセンサ7bは、アームシリンダ4bにおけるシリンダロッドの変位量をアーム情報として検出する。バケットシリンダ4cには、位置センサとして、ストロークセンサ7cが取り付けられている。ストロークセンサ7cは、バケットシリンダ4cにおけるシリンダロッドの変位量をアタッチメント情報として検出する。
 位置センサは、角度センサであってもよい。ブームボトムピン5aの周囲には、角度センサ9aが取り付けられている。ブームトップピン5bの周囲には、角度センサ9bが取り付けられている。アームトップピン5cの周囲には、角度センサ9cが取り付けられている。角度センサ9a,9b,9cは、ポテンショメータであってもよく、ロータリーエンコーダであってもよい。角度センサ9a,9b,9cは、ブーム3aなどの回転角情報(ブーム情報、アーム情報およびアタッチメント情報)を、後述のコントローラ10に出力する。
 図1に示されるように、側方視において、ブームボトムピン5aとブームトップピン5bとを通る直線(図1中に二点鎖線で図示)と、上下方向に延びる直線(図1中に破線で図示)とのなす角度を、ブーム角θbとする。ブーム角θbは、通常、鋭角である。ブーム角θbは、旋回体2に対するブーム3aの角度を表す。ブーム角θbは、ストロークセンサ7aの検出結果から算出することができ、また角度センサ9aの測定値から算出することができる。
 側方視において、ブームボトムピン5aとブームトップピン5bとを通る直線と、ブームトップピン5bとアームトップピン5cとを通る直線(図1中に二点鎖線で図示)とのなす角度を、アーム角θaとする。アーム角θaは、側方視でアーム3bが回動する領域におけるブーム3aに対するアーム3bの角度を表す。アーム角θaは、ストロークセンサ7bの検出結果から算出することができ、また角度センサ9bの測定値から算出することができる。
 側方視において、ブームトップピン5bとアームトップピン5cとを通る直線と、アームトップピン5cとバケット3cの刃先とを通る直線(図1中に二点鎖線で図示)とのなす角度を、バケット角θkとする。バケット角θkは、側方視でバケット3cが回動する領域におけるアーム3bに対するバケット3cの角度を表す。バケット角θkは、ストロークセンサ7cの検出結果から算出することができ、また角度センサ9cの測定値から算出することができる。
 位置センサは、IMU(Inertial Measurement Unit:慣性計測装置)であってもよい。旋回体2、ブーム3a、アーム3bおよび第1リンク部材3daのそれぞれには、IMU8a,8b,8c,8dが取り付けられている。IMU8aは、前後方向、左右方向および上下方向における旋回体2の加速度と、前後方向、左右方向および上下方向まわりの旋回体2の角速度とを計測する。IMU8b,8c,8dのそれぞれは、前後方向、左右方向および上下方向におけるブーム3a、アーム3b、第1リンク部材3daの加速度と、前後方向、左右方向および上下方向まわりのブーム3a、アーム3b、第1リンク部材3daの角速度とを計測する。
 旋回体2に取り付けられたIMU8aで測定された加速度とブーム3aに取り付けられたIMU8bで測定された加速度との差分に基づいて、ブームシリンダ4aの伸縮の加速度(ブームシリンダ4aの伸縮速度の変化量)を取得することができる。ブーム角θb、アーム角θa、バケット角θkは、それぞれIMU8b,8c,8dの検出結果から算出されてもよい。
 位置センサとして、各油圧シリンダのストロークセンサ、ブーム3aなどの各リンクの角度センサ、およびIMUを挙げたが、位置センサは六軸加速度センサであってもよい。位置センサは上記センサのいくつかを併用するものであってもよい。位置センサは上記センサに加え、GNSS(Global Navigation Satellite System:衛星測位システム)を併用するものであってもよい。
 <作業機械のシステムの概略構成>
 次に、作業機械のシステムの概略構成について図2を用いて説明する。図2は、図1に示される作業機械のシステムの概略構成を示すブロック図である。
 図2に示されるように、本実施形態におけるシステムは、作業機3の運搬する荷L(図1)の重量である積荷重量を決定するためのシステムである。本実施形態におけるシステムは、図1に示す作業機械の一例としての油圧ショベル100と、図2に示されるコントローラ10とを含んでいる。コントローラ10は、油圧ショベル100に搭載されていてもよい。コントローラ10は、油圧ショベル100の外部に設置されていてもよい。コントローラ10は、油圧ショベル100の作業現場に配置されてもよく、油圧ショベル100の作業現場から離れた遠隔地に配置されてもよい。
 エンジン31は、たとえばディーゼルエンジンである。エンジン31への燃料の噴射量がコントローラ10によって制御されることにより、エンジン31の出力が制御される。
 油圧ポンプ33は、エンジン31に連結されている。エンジン31の回転駆動力が油圧ポンプ33に伝達されることにより、油圧ポンプ33が駆動される。油圧ポンプ33は、たとえば斜板を有し、斜板の傾転角が変更されることにより吐出容量を変化させる可変容量型の油圧ポンプである。油圧ポンプ33から吐出された油の一部は、作動油として方向制御弁34に供給される。油圧ポンプ33から吐出された油の一部は、減圧弁によって一定の圧力に減圧されて、パイロット油として使用される。
 方向制御弁34は、たとえばロッド状のスプールを動かして作動油が流れる方向を切り換えるスプール方式の弁である。スプールが軸方向に移動することにより、アクチュエータ40に対する作動油の供給量が調整される。方向制御弁34には、スプールの移動距離(スプールストローク)を検出するスプールストロークセンサが設けられる。
 アクチュエータ40への油圧の供給および排出が制御されることにより、作業機3の動作、旋回体2の旋回、および走行体1の走行動作が制御される。上記アクチュエータ40は、図1に示されるブームシリンダ4a、アームシリンダ4b、バケットシリンダ4c、走行モータ、図示しない旋回モータなどを含んでいる。
 なお、本例においては、アクチュエータ40を作動するために、そのアクチュエータ40に供給される油は作動油と称される。また、方向制御弁34を作動するためにその方向制御弁34に供給される油はパイロット油と称される。また、パイロット油の圧力はパイロット油圧と称される。
 油圧ポンプ33は、上記のように作動油とパイロット油との両方を送出するものであってもよい。油圧ポンプ33は、作動油を送出する油圧ポンプ(メイン油圧ポンプ)と、パイロット油を送出する油圧ポンプ(パイロット油圧ポンプ)とを別々に有してもよい。
 操作装置25は、運転室2a内に配置されている。操作装置25は、オペレータにより操作される。操作装置25は、作業機3を駆動するオペレータ操作を受け付ける。また操作装置25は、旋回体2を旋回させるオペレータ操作を受け付ける。操作装置25は、オペレータ操作に応じた操作信号を出力する。
 操作装置25は、第1操作レバー25Rと、第2操作レバー25Lとを有している。第1操作レバー25Rは、たとえば運転席2bの右側に配置されている。第2操作レバー25Lは、たとえば運転席2bの左側に配置されている。第1操作レバー25Rおよび第2操作レバー25Lでは、前後左右の動作が2軸の動作に対応する。
 第1操作レバー25Rにより、たとえばブーム3aおよびバケット3cが操作される。第1操作レバー25Rの前後方向の操作は、たとえばブーム3aの操作に対応し、前後方向の操作に応じてブーム3aが下降する動作および上昇する動作が実行される。第1操作レバー25Rの左右方向の操作は、たとえばバケット3cの操作に対応し、左右方向の操作に応じてバケット3cの掘削方向(上向き)およびダンプ方向(下向き)への動作が実行される。
 第2操作レバー25Lにより、たとえばアーム3bおよび旋回体2が操作される。第2操作レバー25Lの前後方向の操作は、たとえば旋回体2の旋回に対応し、前後方向の操作に応じて旋回体2の右旋回動作および左旋回動作が実行される。第2操作レバー25Lの左右方向の操作は、たとえばアーム3bの操作に対応し、左右方向の操作に応じてアーム3bのダンプ方向(上向き)および掘削方向(下向き)への動作が実行される。
 油圧ポンプ33から送出され、減圧弁によって減圧されたパイロット油が、操作装置25に供給される。操作装置25の操作量に基づいて、パイロット油圧が調整される。
 操作装置25と方向制御弁34とは、パイロット油路450を介して接続されている。パイロット油は、パイロット油路450を介して方向制御弁34に供給される。これにより、方向制御弁34のスプールが軸方向に移動して、ブームシリンダ4a、アームシリンダ4bおよびバケットシリンダ4cに供給される作動油の流れ方向および流量が調整され、ブーム3a、アーム3b、バケット3cの上下方向への動作が実行される。
 パイロット油路450には、圧力センサ36が配置されている。圧力センサ36は、パイロット油圧を検出する。圧力センサ36の検出結果は、コントローラ10に出力される。パイロット油圧の増加量は、操作レバー25L,25Rの各々を中立位置から傾倒させる角度によって異なる。圧力センサ36によるパイロット油圧の検出結果によって、操作装置25の操作内容を判断することができる。
 コントローラ10には、ストロークセンサ7a~7c、IMU8a~8d、角度センサ9a~9cおよび圧力センサ6a~6fの検出信号も入力される。
 コントローラ10は、ストロークセンサ7a~7c、IMU8a~8d、角度センサ9a~9cおよび圧力センサ6a~6f,36の各々と有線で電気的に接続されていてもよく、また無線で通信可能とされていてもよい。コントローラ10は、たとえばコンピュータ、サーバー、携帯端末などであり、CPU(Central Processing Unit)であってもよい。
 上記においては操作装置25がパイロット油圧方式である場合について説明したが、操作装置25は電気方式の操作装置であってもよい。操作装置25が電気方式である場合、第1操作レバー25Rおよび第2操作レバー25Lの各々の操作量は、たとえばポテンショメータにより検出される。ポテンショメータとは、機械的な位置に比例した電気(電圧)出力を得る変位センサである。ポテンショメータの検出結果は、コントローラ10に出力される。ポテンショメータの検出結果によって、操作装置25の操作内容を判断することができる。
 <コントローラ10内の機能ブロック>
 次に、コントローラ10内の機能ブロックについて図3を用いて説明する。図3は、図2に示されるコントローラ10内の機能ブロックを示す図である。
 図3に示されるように、ブームシリンダ推力算出部10aは、圧力センサ6a,6bの検知結果を取得する。具体的には、ブームシリンダ推力算出部10aは、圧力センサ6aにより検知されたブームシリンダ4aのヘッド圧を取得する。ブームシリンダ推力算出部10aは、圧力センサ6bにより検知されたブームシリンダ4aのボトム圧を取得する。ブームシリンダ推力算出部10aは、ブームシリンダ4aのヘッド圧とボトム圧とに基づいて、ブームシリンダ推力Fboomを算出する。
 推力とは物体を運動方向におしすすめる力と定義され、ブームシリンダ推力Fboomは、ブームシリンダ4aの発生する、ブーム3aを車体に対して相対回転させる推力である。ブームシリンダ推力Fboomは、ブームシリンダ4aの延在方向に作用する力である。ブームシリンダ推力算出部10aは、算出したブームシリンダ推力Fboomを、積荷重量算出部10iへ出力する。
 アームシリンダ推力算出部10bは、圧力センサ6c,6dの検知結果を取得する。具体的には、アームシリンダ推力算出部10bは、圧力センサ6cにより検知されたアームシリンダ4bのヘッド圧を取得する。アームシリンダ推力算出部10bは、圧力センサ6dにより検知されたアームシリンダ4bのボトム圧を取得する。アームシリンダ推力算出部10bは、アームシリンダ4bのヘッド圧とボトム圧とに基づいて、アームシリンダ推力Farmを算出する。
 アームシリンダ推力Farmは、アームシリンダ4bの発生する、アーム3bをブーム3aに対して相対回転させる推力である。アームシリンダ推力Farmは、アームシリンダ4bの延在方向に作用する力である。アームシリンダ推力算出部10bは、算出したアームシリンダ推力Farmを、積荷重量算出部10iへ出力する。
 バケットシリンダ推力算出部10cは、圧力センサ6e,6fの検知結果を取得する。具体的には、バケットシリンダ推力算出部10cは、圧力センサ6eにより検知されたバケットシリンダ4cのヘッド圧を取得する。バケットシリンダ推力算出部10cは、圧力センサ6fにより検知されたバケットシリンダ4cのボトム圧を取得する。バケットシリンダ推力算出部10cは、バケットシリンダ4cのヘッド圧とボトム圧とに基づいて、バケットシリンダ推力Fbucketを算出する。
 バケットシリンダ推力Fbucketは、バケットシリンダ4cの発生する、バケット3cをアーム3bに対して相対回転させる推力である。バケットシリンダ推力Fbucketは、バケットシリンダ4cの延在方向に作用する力である。バケットシリンダ推力算出部10cは、算出したバケットシリンダ推力Fbucketを、積荷重量算出部10iへ出力する。
 ブーム角算出部10dは、ストロークセンサ7a、IMU8b、および角度センサ9aの少なくともいずれか1つのセンサから、ブーム角θbに関する情報を取得する。ブーム角算出部10dは、取得した情報に基づいて、ブーム角θbを算出する。ブーム角算出部10dは、算出したブーム角θbを、重心位置算出部10gへ出力する。
 アーム角算出部10eは、ストロークセンサ7b、IMU8c、および角度センサ9bの少なくともいずれか1つのセンサから、アーム角θaに関する情報を取得する。アーム角算出部10eは、取得した情報に基づいて、アーム角θaを算出する。アーム角算出部10eは、算出したアーム角θaを、重心位置算出部10gへ出力する。
 バケット角算出部10fは、ストロークセンサ7c、IMU8d、および角度センサ9cの少なくともいずれか1つのセンサから、バケット角θkに関する情報を取得する。バケット角算出部10fは、取得した情報に基づいて、バケット角θkを算出する。バケット角算出部10fは、算出したバケット角θkを、重心位置算出部10gへ出力する。
 記憶部10jは、作業機3を構成する各部材の寸法、重量および重心の位置などの各種情報を記憶している。これらの各種情報は、コントローラ10外部の入力部11から、記憶部10jに入力されてもよい。記憶部10jは、コントローラ10に含まれず、コントローラ10の外部に配置されていてもよい。
 重心位置算出部10gは、作業機3を構成する各部材、たとえばブーム3a、ブームシリンダ4aのシリンダ4aa、第1リンク部材3daなど、の重心の、ブームボトムピン5aに対する相対位置を算出する。重心位置算出部10gは、ブーム角算出部10dで算出されたブーム角θbと、アーム角算出部10eで算出されたアーム角θaと、バケット角算出部10fで算出されたバケット角θkと、記憶部10jに記憶されている作業機3を構成する各部材の重心の位置とから、作業機3を構成する各部材の上記相対位置を算出する。
 重心位置算出部10gは、ブーム角θb、アーム角θaおよびバケット角θkから、ブームボトムピン5aを基準とするブーム3a、アーム3bおよびバケット3cの姿勢を算出する。重心位置算出部10gは、算出された姿勢から作業機3の他の構成部材の状態(姿勢・ストローク)を算出する。重心位置算出部10gは、算出結果と記憶されている各部材の重心位置とから、作業機3を構成する各部材のブームボトムピン5aを基準とする相対位置を算出する。
 モーメント距離算出部10hは、ブームボトムピン5aから、作業機を構成する各部材の重心までの、水平方向における距離を算出する。具体的には、モーメント距離算出部10hは、ブームボトムピン5aからブーム3aの重心までの水平方向の距離Xboomを算出する。モーメント距離算出部10hは、ブームボトムピン5aからアーム3bの重心までの水平方向の距離Xarmを算出する。モーメント距離算出部10hは、ブームボトムピン5aからバケット3cの重心までの水平方向の距離Xbucketを算出する。
 モーメント距離算出部10hは、ブームボトムピン5aからブームシリンダ4aのシリンダ部分(シリンダ4aa)の重心までの水平方向の距離XboomCを算出する。モーメント距離算出部10hは、ブームボトムピン5aからブームシリンダ4aのシリンダロッド部分(シリンダロッド4ab)の重心までの水平方向の距離XboomCRを算出する。
 モーメント距離算出部10hは、ブームボトムピン5aからアームシリンダ4bのシリンダ部分の重心までの水平方向の距離XarmCを算出する。モーメント距離算出部10hは、ブームボトムピン5aからアームシリンダ4bのシリンダロッド部分の重心までの水平方向の距離XarmCRを算出する。
 また、モーメント距離算出部10hは、ブームボトムピン5aからブームトップピン5bまでの水平方向の距離Xboomtopを算出する。モーメント距離算出部10hは、ブームボトムピン5aからアームトップピン5cまでの水平方向の距離Xarmtopを算出する。
 また、モーメント距離算出部10hは、ブームシリンダ4aの延在方向に直交する方向における、ブームボトムピン5aからブームシリンダ4aまでの距離hboomを算出する。モーメント距離算出部10hは、アームシリンダ4bの延在方向に直交する方向における、ブームトップピン5bからアームシリンダ4bまでの距離harmを算出する。モーメント距離算出部10hは、バケットシリンダ4cの延在方向に直交する方向における、アームトップピン5cからバケットシリンダ4cまでの距離hbucketを算出する。
 モーメント距離算出部10hは、算出したこれらの距離を、積荷重量算出部10iへ出力する。
 積荷重量算出部10iは、バケット3cに積載された荷Lの重量Mpayloadを算出する。重量Mpayloadの算出方法は後述する。積荷重量算出部10iは、算出した重量Mpayloadをコントローラ10外の表示部12に出力する。表示部12は、たとえば運転室2a(図1)内に配置されていてもよく、また油圧ショベル100から離れた遠隔地に配置されていてもよい。表示部12は、算出した重量Mpayloadを画面に表示する。運転室2a内で油圧ショベル100を操作するオペレータ、遠隔地で油圧ショベル100を操作するオペレータまたは油圧ショベル100の動作を監視する監視者などは、表示部12を見ることにより、バケット3cに積載された荷Lの重量Mpayloadを認識することができる。
 なお入力部11および表示部12の各々は、コントローラ10と有線で接続されていてもよく、また無線で接続されていてもよい。
 <荷Lの重量の算出>
 以下、バケット3cに積載された荷Lの重量Mpayloadの算出方法の詳細について説明する。荷Lの重量Mpayloadは、荷Lの運搬中における作業機3を構成する3つのリンク(ブーム3a、アーム3b、バケット3c)それぞれに関して位置センサからの情報と圧力センサからの情報とからセットアップされた3つの関係式のいずれか2つから算出される。以下、リンクとしてブーム3aとバケット3cとを対象にし、関係式としてモーメントの釣り合い式をセットアップして、荷Lの重量Mpayloadの算出方法を説明する。
 図3に示される積荷重量算出部10iは、記憶部10jから、ブームボトムピン5aまわりのモーメントの釣り合い式を読み出す。図4は、ブームボトムピン5aまわりのモーメントの釣り合いを示す模式図である。ブームボトムピン5aまわりのモーメントの釣り合い式は、以下の式(1)により表される。
Figure JPOXMLDOC01-appb-M000001
 式(1)の左辺は、ブームシリンダ推力Fboomによるモーメントである。式(1)の右辺の第1項において、Mpayloadは、バケット3cに積載された荷Lの重量である。Xpayloadは、ブームボトムピン5aから、バケット3cに積載された荷Lの重心位置までの水平方向の距離である。式(1)の右辺の第1項は、バケット3cに積載された荷Lによるモーメントである。
 式(1)の右辺の第2項のMXweは、作業機3の自重によるモーメントである。モーメントMXweは、以下の式(2)により算出される。
Figure JPOXMLDOC01-appb-M000002
 式(2)において、Mboomは、ブーム3aの重量である。MboomCは、ブームシリンダ4aのシリンダ部分の重量である。MboomCRは、ブームシリンダ4aのシリンダロッド部分の重量である。Marmは、アーム3bの重量である。MarmCは、アームシリンダ4bのシリンダ部分の重量である。MarmCRは、アームシリンダ4bのシリンダロッド部分の重量である。Mbucketは、バケット3cの重量である。
 これらの重量Mboom、MboomC、MboomCR、Marm、MarmC、MarmCRおよびMbucketの各々は、たとえば、図3に示される入力部11にて記憶部10jへの入力操作を行なうことにより、記憶部10jに記憶されている。
 次に、積荷重量算出部10iは、記憶部10jから、アームトップピン5cまわりのモーメントの釣り合い式を読み出す。図5は、アームトップピン5cまわりのモーメントの釣り合いを示す模式図である。アームトップピン5cまわりのモーメントの釣り合い式は、以下の式(3)により表される。
Figure JPOXMLDOC01-appb-M000003
 式(3)の左辺は、バケットシリンダ4cの推力Fbucketによるモーメントである。式(3)の右辺の第1項は、バケット3cに積載された荷Lによるモーメントである。式(3)の右辺の第2項のMXwe_bucketは、バケット3cの自重によるモーメントである。
 式(1)と式(3)との連立方程式から、積荷重量Mpayloadを算出するための式として、距離Xpayloadに依存しない以下の式(4)を立式することができる。
Figure JPOXMLDOC01-appb-M000004
 式(1)には距離Xpayloadが含まれており、式(3)にも距離Xpayloadが含まれている。これら2つの釣り合い式を連立方程式として解くことで、距離Xpayloadを含まない式(4)が導き出される。式(4)に基づいて、積荷重量Mpayloadを算出することが可能になる。これにより、バケット3cに積載された荷Lの重心位置のずれの影響をなくして、より精度のよい積荷重量Mpayloadを算出することができる。
 式(4)に従って算出された積荷重量Mpayloadを式(1)または式(3)に代入することで、距離Xpayloadを算出することができる。また、式(1)と式(3)との連立方程式から、距離Xpayloadを算出するための式として、積荷重量Mpayloadに依存しない以下の式(5)を立式することができる。
Figure JPOXMLDOC01-appb-M000005
 算出された距離Xpayloadに従って、バケット3cに積載された荷Lの重心位置を補正することができる。
 要約すると、バケット3cの運搬する荷Lの重量Mpayloadを算出する演算方法は、以下の処理を含む。図11は、本開示の演算方法のフローチャートを示す図である。
 図11に示されるステップS1で実行される処理は、作業機3の部材について、ブームボトムピン5a(第1回転中心)、ブームトップピン5b(第2回転中心)、およびアームトップピン5c(第3回転中心)のうちのいずれか2つの回転中心まわりの運動の関係式を立式することである。本実施形態では、第1回転中心および第3回転中心まわりの運動の関係式が立式される。運動の関係式は、運動の回転中心まわりのモーメントの釣り合い式であってよい。立式は、記憶部10jに記憶される関係式情報を取得するものであってよい。記憶部10jから取得される関係式情報は、上記2つの回転中心まわりの運動の関係式から積荷重量Mpayloadについて整理した1つの関係式であってもよい。
 ステップS2で実行される処理は、ブーム3a、アーム3bおよびバケット3c(アタッチメント)の各部材の重量および重心位置を取得することである。各部材の重心および重心位置の情報は、記憶部10jから取得してよい。
 ステップS3で実行される処理は、荷Lの運搬時における各部材の位置を取得することである。各部材の位置は、各部材の姿勢を示す各部材の回転角を取得して、その回転角から演算により取得してもよい。
 ステップS4で実行される処理は、各部材の運動の関係式における、部材の運動に対応する推力を取得することである。本実施形態では、ブーム3aとバケット3cとを動作させる油圧シリンダの作動油圧力を計測して、推力を取得している。推力は、ブーム3a、アーム3bおよびバケット3c(アタッチメント)の各部材を回動させる油圧シリンダのヘッド圧とボトム圧とから得られてよい。
 ステップS5で実行される処理は、各部材の重心位置と、荷Lの運搬時の各部材の位置とから、荷Lの運搬時における各部材の重心位置と各部材の回転中心である上記第1回転中心、第2回転中心および第3回転中心のそれぞれとの水平方向の距離(モーメント距離)を演算することである。
 ステップS6で実行される処理は、各部材の運動の関係式に、取得された情報および演算された情報を入力して、作業機3の運搬する荷Lの重量(積荷重量Mpayload)を演算することである。取得された情報とは、作業機3の各部材の重量および重心位置と、荷Lの運搬時の各部材を回動させる油圧シリンダの推力とを指す。演算された情報とは、荷Lの運搬時の各部材の重心位置と各部材の回転中心との水平方向の距離を指す。
 [第二実施形態]
 第一実施形態では、ブームボトムピン5aまわりのモーメントの釣り合い式と、アームトップピン5cまわりのモーメントの釣り合い式との2つの釣り合い式から、バケット3cに積載された荷Lの重量Mpayloadを算出する例について説明した。この例に限られず、コントローラ10は、ブームボトムピン5aまわりのモーメントの釣り合い式、ブームトップピン5bまわりのモーメントの釣り合い式、アームトップピン5cまわりのモーメントの釣り合い式のうちのいずれか2つの釣り合い式から、バケット3cに積載された荷Lの重量Mpayloadを算出することができる。第二実施形態では、ブームボトムピン5aまわりのモーメントの釣り合い式と、ブームトップピン5bまわりのモーメントの釣り合い式との2つの釣り合い式から、重量Mpayloadを算出する例について説明する。
 第二実施形態における油圧ショベル100の構成、システム構成、およびコントローラ10内の機能ブロックは、図1から図3を参照して第一実施形態で説明した通りである。
 第二実施形態においては、積荷重量算出部10iは、記憶部10jから、ブームトップピン5bまわりのモーメントの釣り合い式を読み出す。図6は、ブームトップピン5bまわりのモーメントの釣り合いを示す模式図である。ブームトップピン5bまわりのモーメントの釣り合い式は、以下の式(6)により表される。
Figure JPOXMLDOC01-appb-M000006
 式(6)の左辺は、アームシリンダ推力Farmによるモーメントである。式(6)の右辺の第1項は、バケット3cに積載された荷Lによるモーメントである。式(6)の右辺の第2項のMXwe_armは、ブームトップピン5bよりも作業機3の先端側の作業機3の自重によるモーメントである。モーメントMXwe_armは、式(2)と同様の釣り合い式により算出される。
 式(1)と式(6)との連立方程式から、積荷重量Mpayloadを算出するための式として、距離Xpayloadに依存しない以下の式(7)を立式することができる。
Figure JPOXMLDOC01-appb-M000007
 式(1)には距離Xpayloadが含まれており、式(6)にも距離Xpayloadが含まれている。これら2つの釣り合い式を連立方程式として解くことで、距離Xpayloadを含まない式(7)が導き出される。式(7)に基づいて、積荷重量Mpayloadを算出することが可能になる。これにより、バケット3cに積載された荷Lの重心位置のずれの影響をなくして、より精度のよい積荷重量Mpayloadを算出することができる。
 式(7)に従って算出された積荷重量Mpayloadを式(1)または式(6)に代入することで、距離Xpayloadを算出することができる。また、式(1)と式(6)との連立方程式から、距離Xpayloadを算出するための式として、積荷重量Mpayloadに依存しない式を立式することができる。算出された距離Xpayloadに従って、バケット3cに積載された荷Lの重心位置を補正することができる。
 第一および第二実施形態の説明では、バケット3cに積載された荷Lの重量である積荷重量Mpayloadを算出する例について説明した。この例に限られず、たとえば吊りフックが第2リンクピン3deに取り付けられて荷Lを吊り上げおよび吊り下げることが可能なアームクレーン仕様の油圧ショベル100に、実施形態の思想を適用することで、吊り荷の重量を精度よく算出することが可能である。
 第一および第二実施形態に示される油圧ショベル100においては、作業機3の3つのリンク(ブーム3a、アーム3b、バケット3c)のそれぞれが位置センサ9a,9b,9c、および対応する圧力センサ6a,6b,6cを備えるが、この構成に限定されるものではない。圧力センサは、積荷重量Mpayloadの算出に使用される2つの関係式の対象となるリンクのみが具備してもよい。
 [第三実施形態]
 第一および第二実施形態では、作業機3の先端のアタッチメントとしてバケット3cを備える油圧ショベル100について説明した。アタッチメントはバケット3cに限られず、作業の種類に応じて、アタッチメントが、グラップル、リフティングマグネットなどに付け替えられることがある。第三実施形態では、アタッチメントとしてリフティングマグネット103を備える油圧ショベル100について説明する。
 図7は、第三実施形態に基づく作業機械の一例としての油圧ショベル100の構成を概略的に示す側面図である。第三実施形態に基づく油圧ショベル100は、図1に示される第一実施形態の油圧ショベル100とほぼ同一の構成を備えており、バケット3cに替えてリフティングマグネット103を作業機3の先端に備える点で異なっている。
 リフティングマグネット103は、本体部105と、支持部104とを有している。本体部105は、磁力を発生する磁石である。本体部105はたとえば、電磁石である。本体部105は、磁力によって、磁性体を保持して運搬することができる。支持部104は、本体部105を支持する。支持部104は、アームトップピン5cによりアーム3bの先端部に回転可能に連結されている。第2リンク部材3dbの基端は、第2リンクピン3deにより支持部104の根元部分のブラケットに回転可能に連結されている。
 リフティングマグネット103を備える油圧ショベル100においては、作業機3の運搬する荷L、すなわち本体部105に吸着保持される磁性体の、本体部105に対する相対位置および磁性体の姿勢を一定にするのが難しい。そのため、磁性体の重心位置がずれやすい。図7に示されるように、ブームボトムピン5aまわりのモーメントの釣り合い式と、アームトップピン5cまわりのモーメントの釣り合い式との2つの釣り合い式から、荷Lの重心位置のずれに依存しない荷Lの重量を算出するための式を立式することにより、リフティングマグネット103に保持された荷Lの重心位置のずれの影響をなくして、より精度のよい荷Lの重量を算出することができる。
 第一から第三実施形態に示される油圧ショベル100においては、走行体1に対する旋回体2の旋回中に、荷Lの重量を算出することで、より精度よく荷Lの重量を算出することができる。
 [第四実施形態]
 第一から第三実施形態では、作業機械が油圧ショベル100である例について説明した。油圧ショベル100に限られず、多リンク機構の作業機3を備え作業機3が荷Lを運搬する作業機械に、実施形態の思想を適用することで、作業機3の運搬する荷Lの重量を精度よく算出することが可能である。たとえば作業機械は、ホイールローダ、バックホーローダ、スキッドステアローダなどであってもよい。
 図8は、第四実施形態に基づく作業機械の一例としてのホイールローダ200の構成を概略的に示す側面図である。図8に示されるように、ホイールローダ200は、車体フレーム202と、作業機203と、走行装置204と、キャブ205とを有している。
 車体フレーム202およびキャブ205から、ホイールローダ200の車体が構成されている。キャブ205内には、オペレータが着座するシートおよび操作装置などが配置されている。ホイールローダ200の車体には、作業機203および走行装置204が取り付けられている。作業機203は車体の前方に配置されており、車体の最後端にはカウンタウエイト206が設けられている。
 車体フレーム202は、前フレーム211と後フレーム212とを含んでいる。前フレーム211と後フレーム212とには、ステアリングシリンダ213が取り付けられている。ステアリングシリンダ213は、油圧シリンダである。ステアリングシリンダ213はステアリングポンプ(図示せず)からの作動油で伸縮する。ステアリングシリンダ213の伸縮により、前フレーム211と後フレーム212とは互いに左右方向に揺動可能である。これにより、ホイールローダ200の進行方向が左右に変更可能である。
 第四実施形態において、ホイールローダ200が直進走行する方向を、ホイールローダ200の前後方向という。ホイールローダ200の前後方向において、車体フレーム202に対して作業機203が配置されている側を前方向とし、前方向と反対側を後方向とする。ホイールローダ200の左右方向とは、平面視において前後方向と直交する方向である。前方向を見て左右方向の右側、左側が、それぞれ右方向、左方向である。ホイールローダ200の上下方向とは、前後方向および左右方向によって定められる平面に直交する方向である。上下方向において地面のある側が下側、空のある側が上側である。
 走行装置204は、走行輪204a,204bを含んでいる。走行輪204a,204bの各々は車輪であり、ゴムよりなるタイヤを有している。走行輪(前輪)204aは、前フレーム211に回転可能に取り付けられている。走行輪(後輪)204bは、後フレーム212に回転可能に取り付けられている。ホイールローダ200は、走行輪204a,204bが回転駆動されることにより自走可能である。
 作業機203は、掘削などの作業を行うためのものである。作業機203は、前フレーム211に取り付けられている。作業機203は、バケット214と、ブーム215と、ベルクランク216と、チルトロッド217と、ブームシリンダ218と、バケットシリンダ219とを含んでいる。
 ブーム215の基端部は、ブームボトムピン221によって前フレーム211に回転自在に取付けられている。これによりブーム215は車体に回転可能に取り付けられている。バケット214は、ブームトップピン222によってブーム215の先端に回転自在に取付けられている。ブームボトムピン221は、ホイールローダ200の車体に支持されている。ブームトップピン222は、ブーム215の先端に取り付けられている。ブームボトムピン221とブームトップピン222とは、左右方向に延びている。
 ブームシリンダ218はブーム215を駆動する。ブームシリンダ218の一端は、車体の前フレーム211にピン223によって回転可能に取り付けられている。これによりブームシリンダ218は、車体に回転可能に取り付けられている。ブームシリンダ218の他端は、ブーム215にピン224によって回転可能に取り付けられている。
 ブームシリンダ218はたとえば油圧シリンダである。ブームシリンダ218は、作業機ポンプ(図示せず)からの作動油によって伸縮する。これによりブーム215が駆動し、ブーム215の先端に取り付けられたバケット214が昇降する。
 ベルクランク216は、支持ピン229によってブーム215に回転自在に支持されている。ベルクランク216は、支持ピン229の一方側に位置する第1端部と、支持ピン229に対して第1端部と反対側に位置する第2端部とを有している。ベルクランク216の第1端部はチルトロッド217を介在してバケット214に接続されている。ベルクランク216の第2端部はバケットシリンダ219を介在して車体の前フレーム211に接続されている。
 チルトロッド217の一端はベルクランク216の第1端部にピン227によって回転可能に取り付けられている。チルトロッド217の他端はバケット214にピン228によって回転可能に取り付けられている。
 バケットシリンダ219は、ブーム215に対してバケット214を駆動する。バケットシリンダ219の一端は車体の前フレーム211にピン225によって回転可能に取り付けられている。バケットシリンダ219の他端はベルクランク216の第2端部にピン226によって回転可能に取り付けられている。
 バケットシリンダ219はたとえば油圧シリンダである。バケットシリンダ219は、作業機ポンプ(図示せず)からの作動油によって伸縮する。バケットシリンダ219の伸縮によりベルクランク216が駆動し、ベルクランク216がブーム215に対して回転する。ベルクランク216の回転がチルトロッド217を介してバケット214に伝達されることで、バケット214が駆動し、バケット214がブーム215に対して上下に回動する。ベルクランク216は、バケット214とともにブーム215に対して回転可能な、実施形態の回動部材に相当する。
 ホイールローダ200は、ブームシリンダ218の推力Fboomに関する情報を検知するセンサと、バケットシリンダ219の推力Fbucketに関する情報を検知するセンサとをさらに有している。
 ブームシリンダ218の推力Fboomに関する情報を検知するセンサは、たとえば圧力センサ231b,231hである。圧力センサ231b,231hの各々は、ブームシリンダ218のシリンダ圧力を検知する。圧力センサ231bは、ブームシリンダ218のボトム圧を検知する。圧力センサ231hは、ブームシリンダ218のヘッド圧を検知する。
 ヘッド圧とは油圧シリンダのピストンに対してシリンダーロッド側の圧力を意味し、ボトム圧とはピストンに対してチューブ側の圧力を意味する。
 バケットシリンダ219の推力Fbucketに関する情報を検知するセンサは、たとえば圧力センサ232b,232hである。圧力センサ232b,232hの各々は、バケットシリンダ219のシリンダ圧力を検知する。圧力センサ232bは、バケットシリンダ219のボトム圧を検知する。圧力センサ232hは、バケットシリンダ219のヘッド圧を検知する。
 ホイールローダ200は、作業機203の姿勢に関する情報を検知するセンサをさらに有している。作業機203の姿勢に関する情報を検知するセンサは、たとえばブーム角度に関する情報を検知する第1センサと、ブームに対するバケット角度に関する情報を検知する第2センサとを含む。
 作業機203の姿勢に関する情報は、距離hboomおよび距離hbucket(図10)を含む。距離hboomは、ブームボトムピン221とピン223との間の距離であって、ブームシリンダ218の延びる方向に直交する方向の距離である。距離hbucketは、支持ピン229とピン226との間の距離であって、バケットシリンダ219の延びる方向に直交する方向の距離である。
 ブーム角度は、車体の前フレーム211に対するブーム215の角度である。バケット角度は、ブーム215に対するバケット214の角度である。
 ブーム角度に関する情報を検知する第1センサは、たとえばポテンショメータ233である。ポテンショメータ233は、ブームボトムピン221と同心となるように取り付けられている。ブーム角度に関する情報を検知する第1センサとして、ポテンショメータ233に代えて、ブームシリンダ218のストロークセンサ235が用いられてもよい。
 またブーム角度に関する情報を検知する第1センサとして、IMU(Inertial Measurement Unit)237が用いられてもよい。IMU237は、たとえばブーム215に取り付けられている。
 バケット角度に関する情報を検知する第2センサは、たとえばポテンショメータ234である。ポテンショメータ234は、支持ピン229と同心となるように取り付けられている。バケット角度に関する情報を検知する第2センサとして、ポテンショメータ234に代えて、バケットシリンダ219のストロークセンサ236が用いられてもよい。
 またバケット角度に関する情報を検知する第2センサとして、IMU238が用いられてもよい。IMU238は、たとえばチルトロッド217に取り付けられている。
 上記のポテンショメータ233,234、ストロークセンサ235,236、およびIMU237,238は、作業機203の重心GC1の位置に関する情報を検知するセンサとして用いられてもよい。作業機203の重心GC1の位置に関する情報とは、距離Xweである。
 距離Xweは、重心GC1とブームボトムピン221との間の距離であって、ホイールローダ200の前後方向に沿う距離である。距離Xweは、ホイールローダ200が水平な地面に載置されている状態においては、重心GC1とブームボトムピン221との間の水平方向に沿う距離である。
 また上記のポテンショメータ233,234、ストロークセンサ235,236、およびIMU237,238は、バケット214内の積荷の重心GC2の位置に関する情報を検知するセンサとして用いられてもよい。バケット214内の積荷の重心GC2の位置に関する情報とは、距離Xpayloadである。
 距離Xpayloadは、重心GC2とブームボトムピン221との間の距離であって、ホイールローダ200の前後方向に沿う距離である。Xpayloadは、ホイールローダ200が水平な地面に載置されている状態においては、重心GC2とブームボトムピン221との間の水平方向に沿う距離である。
 図9は、第四実施形態のコントローラ250内の機能ブロックを示す図である。本実施形態におけるシステムは、作業機203の運搬する荷の重量である積荷重量を決定するためのシステムである。本実施形態におけるシステムは、図8に示す作業機械の一例としてのホイールローダ200と、図9に示されるコントローラ250とを含んでいる。コントローラ250は、ホイールローダ200に搭載されていてもよい。コントローラ250は、ホイールローダ200の外部に設置されていてもよい。コントローラ250は、ホイールローダ200の作業現場に配置されてもよく、ホイールローダ200の作業現場から離れた遠隔地に配置されてもよい。
 図9に示されるように、ブームシリンダ推力算出部250aは、圧力センサ231b,231hの検知結果を取得する。具体的には、ブームシリンダ推力算出部250aは、圧力センサ231hにより検知されたブームシリンダ218のヘッド圧を取得する。ブームシリンダ推力算出部250aは、圧力センサ231bにより検知されたブームシリンダ218のボトム圧を取得する。ブームシリンダ推力算出部250aは、ブームシリンダ218のヘッド圧とボトム圧とに基づいて、ブームシリンダ推力Fboomを算出する。
 推力とは物体を運動方向におしすすめる力と定義され、ブームシリンダ推力Fboomは、ブームシリンダ218の発生する、ブーム215を車体に対して相対回転させる推力である。ブームシリンダ推力算出部250aは、算出したブームシリンダ推力Fboomを、積荷重量算出部250iへ出力する。
 バケットシリンダ推力算出部250cは、圧力センサ232b,232hの検知結果を取得する。具体的には、バケットシリンダ推力算出部250cは、圧力センサ232hにより検知されたバケットシリンダ219のヘッド圧を取得する。バケットシリンダ推力算出部250cは、圧力センサ232bにより検知されたバケットシリンダ219のボトム圧を取得する。バケットシリンダ推力算出部250cは、バケットシリンダ219のヘッド圧とボトム圧とに基づいて、バケットシリンダ推力Fbucketを算出する。
 バケットシリンダ推力Fbucketは、バケットシリンダ219の発生する、バケット214をブーム215に対して相対回転させる推力である。バケットシリンダ推力算出部250cは、算出したバケットシリンダ推力Fbucketを、積荷重量算出部250iへ出力する。
 ブーム角算出部250dは、ストロークセンサ235、IMU237、およびポテンショメータ233の少なくともいずれか1つのセンサから、ブーム角度に関する情報を取得する。ブーム角算出部250dは、取得した情報に基づいて、ブーム角度を算出する。ブーム角算出部250dは、算出したブーム角度を、重心位置算出部250gへ出力する。
 バケット角算出部250fは、ストロークセンサ236、IMU238、およびポテンショメータ234の少なくともいずれか1つのセンサから、バケット角度に関する情報を取得する。バケット角算出部250fは、取得した情報に基づいて、バケット角度を算出する。バケット角算出部250fは、算出したバケット角度を、重心位置算出部250gへ出力する。
 記憶部250jは、作業機203を構成する各部材の寸法および重量、および作業機203の重心GC1の位置などの各種情報を記憶している。これらの各種情報は、コントローラ250外部の入力部251から、記憶部250jに入力されてもよい。記憶部250jは、コントローラ250に含まれず、コントローラ250の外部に配置されていてもよい。
 重心位置算出部250gは、作業機203の重心GC1の、ブームボトムピン221に対する相対位置を算出する。重心位置算出部250gは、ブーム角算出部250dで算出されたブーム角度と、バケット角算出部250fで算出されたバケット角度と、記憶部10jに記憶されている作業機203における重心GC1の位置とから、作業機203の重心GC1の上記相対位置を算出する。
 モーメント距離算出部250hは、ブームボトムピン221から、作業機203の重心GC1までの、水平方向における距離を算出する。具体的には、モーメント距離算出部250hは、ブームボトムピン221から作業機203の重心GC1までの水平方向の距離Xweを算出する。
 また、モーメント距離算出部250hは、ブームボトムピン221からバケット214の重心GC3(図10)までの水平方向の距離Xbucketを算出する。モーメント距離算出部250hは、ブームボトムピン221からチルトロッド217の重心までの水平方向の距離Xtiltrodを算出する。
 また、モーメント距離算出部250hは、ブームボトムピン221から支持ピン229までの水平方向の距離Xpinを算出する。
 また、モーメント距離算出部250hは、ブームシリンダ218の延在方向に直交する方向における、ブームボトムピン221からブームシリンダ218までの距離hboomを算出する。モーメント距離算出部250hは、バケットシリンダ219の延在方向の直交する方向における、支持ピン229からバケットシリンダ219までの距離hbucketを算出する。
 モーメント距離算出部250hは、算出したこれらの距離を、積荷重量算出部250iへ出力する。
 積荷重量算出部250iは、バケット214に積載された荷の重量Mpayloadを算出する。積荷重量算出部250iは、算出した重量Mpayloadをコントローラ250外の表示部252に出力する。表示部252は、たとえばキャブ205(図8)内に配置されていてもよく、またホイールローダ200から離れた遠隔地に配置されていてもよい。表示部252は、算出した重量Mpayloadを画面に表示する。キャブ205内でホイールローダ200を操作するオペレータ、遠隔地でホイールローダ200を操作するオペレータまたはホイールローダ200の動作を監視する監視者などは、表示部252を見ることにより、バケット214に積載された荷の重量Mpayloadを認識することができる。
 なお入力部251および表示部252の各々は、コントローラ250と有線で接続されていてもよく、また無線で接続されていてもよい。
 以下、第四実施形態における、バケット214に積載された荷の重量Mpayloadの算出方法の詳細について説明する。図9に示される積荷重量算出部250iは、記憶部250jから、ブームボトムピン221まわりのモーメントの釣り合い式を読み出す。ブームボトムピン221まわりのモーメントの釣り合い式は、以下の式(8)により表される。
Figure JPOXMLDOC01-appb-M000008
 式(8)の左辺は、ブームシリンダ推力Fboomによるモーメントである。式(8)において、Mpayloadは、バケット214に積載された荷の重量である。Xpayloadは、ブームボトムピン221から、バケット214に積載された荷の重心GC2のまでの水平方向の距離である。式(8)の右辺の第1項は、バケット214に積載された荷によるモーメントである。
 式(8)の右辺の第2項のMXweは、作業機203の自重によるモーメントである。モーメントMXweは、作業機203を構成する各部材の重量の和M1(図8)と、ブームボトムピン221から作業機203の重心GC1までの水平方向の距離Xweとの積で求められる。
 次に、積荷重量算出部250iは、記憶部250jから、支持ピン229まわりのモーメントの釣り合い式を読み出す。図10は、支持ピン229まわりのモーメントの釣り合いを示す模式図である。支持ピン229まわりのモーメントの釣り合い式は、以下の式(9)により表される。
Figure JPOXMLDOC01-appb-M000009
 式(9)の左辺は、バケットシリンダ推力Fbucketによるモーメントである。式(9)の右辺の第1項は、バケット214に積載された荷によるモーメントである。式(9)の右辺の第2項のMXwe_pinは、支持ピン229よりも作業機203の先端側の作業機203の自重によるモーメントである。モーメントMXwe_pinは、以下の式(10)により算出される。
Figure JPOXMLDOC01-appb-M000010
 式(10)において、Mbucketは、バケット214の重量である。Mtiltrodは、チルトロッド217の重量である。これらの重量Mbucket、Mtiltrodの各々は、たとえば、図9に示される入力部251にて記憶部250jへの入力操作を行うことにより、記憶部250jに記憶されている。
 式(8)と式(9)との連立方程式から、積荷重量Mpayloadを算出するための式として、距離Xpayloadに依存しない以下の式(11)を立式することができる。
Figure JPOXMLDOC01-appb-M000011
 式(8)には距離Xpayloadが含まれており、式(9)にも距離Xpayloadが含まれている。これら2つの釣り合い式を連立方程式として解くことで、距離Xpayloadを含まない式(11)が導き出される。式(11)に基づいて、積荷重量Mpayloadを算出することが可能になる。これにより、バケット214に積載された荷の重心位置のずれの影響をなくして、より精度のよい積荷重量Mpayloadを算出することができる。
 式(11)に従って算出された積荷重量Mpayloadを式(8)または式(9)に代入することで、距離Xpayloadを算出することができる。また、式(8)と式(9)との連立方程式から、距離Xpayloadを算出するための式として、積荷重量Mpayloadに依存しない式を立式することができる。算出された距離Xpayloadに従って、バケット214に積載された荷の重心位置を補正することができる。
 第四実施形態に示されるホイールローダ200においては、バケット214に荷を積載した状態でホイールローダ200が後進する積荷後進中に、荷の重量を算出することで、より精度よく荷の重量を算出することができる。
 上記実施形態では、コントローラ10は、荷の重量を算出するための関係式として、作業機が備える複数のリンクの各々に関するモーメントの釣り合い式のうちの2つの釣り合い式を使用した。関係式は、モーメントの釣り合い式に限定されるものではなく、複数のリンクの各々に関する運動方程式であってもよい。運動方程式は、釣り合い式と同様に、圧力センサと位置センサとからの情報によりセットアップしてよい。
 以上のように実施形態について説明を行ったが、今回開示された実施形態はすべての点で例示であって、制限的なものではないと考えられるべきである。本発明の範囲は上記した説明ではなくて請求の範囲によって示され、請求の範囲と均等の意味および範囲内でのすべての変更が含まれることが意図される。
 1 走行体、2 旋回体、2a 運転室、3,203 作業機、3a,215 ブーム、3b アーム、3c,214 バケット(アタッチメント)、3d バケットリンク、3da 第1リンク部材、3db 第2リンク部材、3dc バケットシリンダトップピン、3dd 第1リンクピン、3de 第2リンクピン、4a,218 ブームシリンダ(ブーム油圧シリンダ)、4aa シリンダ、4ab シリンダロッド、4b アームシリンダ(アーム油圧シリンダ)、4c,219 バケットシリンダ(アタッチメント油圧シリンダ)、5a,221 ブームボトムピン(第1回転中心)、5b,222 ブームトップピン(第2回転中心)、5c アームトップピン(第3回転中心)、6a,6b,6c,6d,6e,6f,231b,231h,232b,232h 圧力センサ、7a,7b,7c,235,236 ストロークセンサ、9a,9b,9c 角度センサ(センサ、位置センサ)、10,250 コントローラ、10a,250a ブームシリンダ推力算出部、10b アームシリンダ推力算出部、10c,250c バケットシリンダ推力算出部、10d,250d ブーム角算出部、10e アーム角算出部、10f,250f バケット角算出部、10g,250g 重心位置算出部、10h,250h モーメント距離算出部、10i,250i 積荷重量算出部、10j,250j 記憶部、11,251 入力部、12,252 表示部、40 アクチュエータ、100 油圧ショベル、103 リフティングマグネット、104 支持部、105 本体部、200 ホイールローダ、202 車体フレーム、204 走行装置、205 キャブ、216 ベルクランク、217 チルトロッド、229 支持ピン、233,234 ポテンショメータ、L 荷。

Claims (17)

  1.  作業機を備える作業機械の、前記作業機の運搬する荷の重量を算出する演算装置であって、
     前記作業機械は、
      車体と、
      前記車体に支持されたブームボトムピンと、
      前記ブームボトムピンにより前記車体に回転可能に連結されたブームと、
      前記ブームの先端に取り付けられたブームトップピンと、
      前記ブームトップピンにより前記ブームに回転可能に連結されたアームと、
      前記アームの先端に取り付けられたアームトップピンと、
      前記アームトップピンにより前記アームに回転可能に連結されたアタッチメントとを備え、
     前記ブームボトムピンまわりのモーメントの釣り合い式、前記ブームトップピンまわりのモーメントの釣り合い式、前記アームトップピンまわりのモーメントの釣り合い式のうちのいずれか2つの釣り合い式から、前記荷の重量を算出する、演算装置。
  2.  前記作業機械は、
      前記ブームを前記車体に対して相対回転させる推力を発生するアクチュエータと、
      前記車体に対する前記ブームの角度を検知するセンサとを備え、
     前記アクチュエータの発生する推力と、前記センサの検知結果とに基づいて、前記ブームボトムピンまわりのモーメントの釣り合い式を立てる、請求項1に記載の演算装置。
  3.  前記作業機械は、
      前記アームを前記ブームに対して相対回転させる推力を発生するアクチュエータと、
      前記ブームに対する前記アームの角度を検知するセンサとを備え、
     前記アクチュエータの発生する推力と、前記センサの検知結果とに基づいて、前記ブームトップピンまわりのモーメントの釣り合い式を立てる、請求項1に記載の演算装置。
  4.  前記作業機械は、
      前記アタッチメントを前記アームに対して相対回転させる推力を発生するアクチュエータと、
      前記アームに対する前記アタッチメントの角度を検知するセンサとを備え、
     前記アクチュエータの発生する推力と、前記センサの検知結果とに基づいて、前記アームトップピンまわりのモーメントの釣り合い式を立てる、請求項1に記載の演算装置。
  5.  前記作業機械は、前記アクチュエータと前記アームとを連結するリンク部材をさらに備え、
     前記センサは、前記リンク部材に取り付けられている、請求項4に記載の演算装置。
  6.  前記アタッチメントは、リフティングマグネットである、請求項1から請求項5のいずれか1項に記載の演算装置。
  7.  前記いずれか2つの釣り合い式から、前記荷の重心位置を算出する、請求項1から請求項6のいずれか1項に記載の演算装置。
  8.  作業機を備える作業機械の、前記作業機の運搬する荷の重量を算出する演算装置であって、
     前記作業機械は、
      車体と、
      前記車体に支持されたブームボトムピンと、
      前記ブームボトムピンにより前記車体に回転可能に連結されたブームと、
      前記ブームの先端に取り付けられたブームトップピンと、
      前記ブームトップピンにより前記ブームに回転可能に連結されたアタッチメントと、
      前記ブームに支持され、前記アタッチメントとともに前記ブームに対して回転可能な回動部材とを備え、
     前記ブームボトムピンまわりのモーメントの釣り合い式と、前記回動部材の回転中心まわりのモーメントの釣り合い式との2つの釣り合い式から、前記荷の重量を算出する、演算装置。
  9.  前記作業機械は、
      前記ブームを前記車体に対して相対回転させる推力を発生するアクチュエータと、
      前記車体に対する前記ブームの角度を検知するセンサとを備え、
     前記アクチュエータの発生する推力と、前記センサの検知結果とに基づいて、前記ブームボトムピンまわりのモーメントの釣り合い式を立てる、請求項8に記載の演算装置。
  10.  前記作業機械は、
      前記アタッチメントを前記ブームに対して相対回転させる推力を発生するアクチュエータと、
      前記ブームに対する前記アタッチメントの角度を検知するセンサとを備え、
     前記アクチュエータの発生する推力と、前記センサの検知結果とに基づいて、前記回転中心まわりのモーメントの釣り合い式を立てる、請求項8に記載の演算装置。
  11.  前記2つの釣り合い式から、前記荷の重心位置を算出する、請求項8から請求項10のいずれか1項に記載の演算装置。
  12.  作業機を備える作業機械の、前記作業機の運搬する荷の重量を算出する演算装置であって、
     前記作業機械は、
      車体と、
      前記車体に支持されたブームボトムピンと、
      前記ブームボトムピンにより前記車体に一端を回転可能に連結されたブームと、
      前記ブームの他端に取り付けられたブームトップピンと、
      前記ブームトップピンにより前記ブームの他端に一端を回転可能に連結されたアームと、
      前記アームの他端に取り付けられたアームトップピンと、
      前記アームトップピンにより前記アームの他端に一端を回転可能に連結されたアタッチメントと、
      前記ブームを駆動して回転動作させるブーム油圧シリンダと、
      前記アームを駆動して回転動作させるアーム油圧シリンダと、
      前記アタッチメントを駆動して回転動作させるアタッチメント油圧シリンダと、
      前記ブーム油圧シリンダに取り付けられ前記ブーム油圧シリンダの作動油圧力情報を出力するブーム圧力センサと、前記アーム油圧シリンダに取り付けられ前記アーム油圧シリンダの作動油圧力情報を出力するアーム圧力センサと、前記アタッチメント油圧シリンダに取り付けられ前記アタッチメント油圧シリンダの作動油圧力情報を出力するアタッチメント圧力センサと、のうちの少なくとも2つのセンサを含む、圧力センサと、
      前記車体に対する前記ブームの位置を得るためのブーム情報を出力するブーム位置センサと、前記ブームに対する前記アームの位置を得るためのアーム情報を出力するアーム位置センサと、前記アームに対する前記アタッチメントの位置を得るためのアタッチメント情報を出力するアタッチメント位置センサと、を備え、
     前記荷の運搬における、前記ブーム油圧シリンダの前記作動油圧力情報と前記ブーム情報とから生成される第一の関係式と、前記アーム油圧シリンダの前記作動油圧力情報と前記アーム情報とから生成される第二の関係式と、前記アタッチメント油圧シリンダの前記作動油圧力情報と前記アタッチメント情報とから生成される第三の関係式と、のうちのいずれか2つの関係式から、前記荷の重量を算出し、
     前記圧力センサは、前記2つの関係式に対応する2つのセンサを少なくとも含む、演算装置。
  13.  前記ブーム位置センサは、前記車体に対する前記ブームの角度を検知するセンサであり、
     前記アーム位置センサは、前記ブームに対する前記アームの角度を検知するセンサであり、
     前記アタッチメント位置センサは、前記アームに対する前記アタッチメントの角度を検知するセンサである、請求項12に記載の演算装置。
  14.  前記第一の関係式は、前記荷の運搬の際の、前記ブームボトムピンまわりのモーメントの釣り合い式であり、
     前記第二の関係式は、前記荷の運搬の際の、前記ブームトップピンまわりのモーメントの釣り合い式であり、
     前記第三の関係式は、前記荷の運搬の際の、前記アームトップピンまわりのモーメントの釣り合い式である、請求項12または請求項13に記載の演算装置。
  15.  作業機を備える作業機械の、前記作業機の運搬する荷の重量を算出する演算方法であって、
      前記作業機は、第1回転中心を軸として回動するブームと、第2回転中心を軸として回動するアームと、第3回転中心を軸として回動するアタッチメントと、を部材として有し、
     前記部材について、前記第1回転中心、前記第2回転中心および前記第3回転中心のうちのいずれか2つの回転中心回りの運動の関係式を立式することと、
     前記部材の各々の重量および重心位置を取得することと、
     前記荷の運搬時における前記部材の位置を取得することと、
     前記関係式の前記運動に対応する推力を取得することと、
     前記部材の前記重心位置と前記位置とから、前記荷の運搬時における前記部材の各々の重心位置と、対応する前記第1回転中心、前記第2回転中心および前記第3回転中心のそれぞれとの水平方向距離を演算することと、
     前記関係式と、前記取得された情報と、前記演算された情報とにより、前記作業機の運搬する前記荷の重量を演算することと、を備える、演算方法。
  16.  前記部材の前記位置を、前記部材の姿勢を示す角度から取得する、請求項15に記載の演算方法。
  17.  前記関係式は、前記運動の回転中心まわりのモーメントの釣り合い式である、請求項15または請求項16に記載の演算方法。
PCT/JP2022/002400 2021-03-31 2022-01-24 演算装置および演算方法 WO2022209214A1 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
DE112022000577.7T DE112022000577T5 (de) 2021-03-31 2022-01-24 Berechnungsvorrichtung und ein Berechnungsverfahren
US18/283,595 US20240167247A1 (en) 2021-03-31 2022-01-24 Computing device and computing method
KR1020237030216A KR20230138020A (ko) 2021-03-31 2022-01-24 연산 장치 및 연산 방법
CN202280019932.3A CN116964280A (zh) 2021-03-31 2022-01-24 运算装置以及运算方法

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2021061390A JP2022157266A (ja) 2021-03-31 2021-03-31 演算装置および演算方法
JP2021-061390 2021-03-31

Publications (1)

Publication Number Publication Date
WO2022209214A1 true WO2022209214A1 (ja) 2022-10-06

Family

ID=83458615

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2022/002400 WO2022209214A1 (ja) 2021-03-31 2022-01-24 演算装置および演算方法

Country Status (6)

Country Link
US (1) US20240167247A1 (ja)
JP (1) JP2022157266A (ja)
KR (1) KR20230138020A (ja)
CN (1) CN116964280A (ja)
DE (1) DE112022000577T5 (ja)
WO (1) WO2022209214A1 (ja)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07252091A (ja) * 1994-03-15 1995-10-03 Sumitomo Constr Mach Co Ltd クレーン仕様ショベルの吊り荷重量演算装置
JP2019157362A (ja) * 2018-03-07 2019-09-19 日立建機株式会社 作業機械
JP2020164325A (ja) * 2019-03-29 2020-10-08 住友重機械工業株式会社 作業機械
JP2021021263A (ja) * 2019-07-29 2021-02-18 住友重機械工業株式会社 作業機械

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH10245874A (ja) 1997-03-06 1998-09-14 Sumitomo Constr Mach Co Ltd 油圧ショベルの積荷重量演算装置

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07252091A (ja) * 1994-03-15 1995-10-03 Sumitomo Constr Mach Co Ltd クレーン仕様ショベルの吊り荷重量演算装置
JP2019157362A (ja) * 2018-03-07 2019-09-19 日立建機株式会社 作業機械
JP2020164325A (ja) * 2019-03-29 2020-10-08 住友重機械工業株式会社 作業機械
JP2021021263A (ja) * 2019-07-29 2021-02-18 住友重機械工業株式会社 作業機械

Also Published As

Publication number Publication date
DE112022000577T5 (de) 2023-12-28
KR20230138020A (ko) 2023-10-05
CN116964280A (zh) 2023-10-27
US20240167247A1 (en) 2024-05-23
JP2022157266A (ja) 2022-10-14

Similar Documents

Publication Publication Date Title
CN107407074B (zh) 显示系统及工程机械
US9091586B2 (en) Payload determination system and method
CN108779616B (zh) 机动平路机的控制方法、机动平路机以及机动平路机的作业管理系统
CN106460362A (zh) 工程机械的控制系统、工程机械、以及工程机械的控制方法
US20170107688A1 (en) Work vehicle, bucket device, and method for obtaining tilt angle
CN107109818A (zh) 工程机械的控制装置及工程机械的控制方法
JP7242387B2 (ja) ショベル
WO2021124880A1 (ja) 作業機械、計測方法およびシステム
WO2020195880A1 (ja) 作業機械、システムおよび作業機械の制御方法
JP7289701B2 (ja) ショベル
WO2022209214A1 (ja) 演算装置および演算方法
JP7358164B2 (ja) 制御システム、作業車両の制御方法、および、作業車両
WO2022176515A1 (ja) 作業機モーメントを推定する方法
JP7420619B2 (ja) ショベル
JP7197342B2 (ja) 作業機械、作業機械を含むシステム、および作業機械の制御方法
JP7143117B2 (ja) ショベル
WO2020194559A1 (ja) 油圧ショベル
WO2021085167A1 (ja) 作業機械
WO2021065313A1 (ja) 作業機械
JP7395403B2 (ja) 検出装置及びショベル
JP2024057328A (ja) 作業機械の異常判定装置及びこれを備えた作業機械
CN117836487A (zh) 用于控制作业机械的系统、方法以及程序
CN118103572A (zh) 工程机械控制系统、工程机械、管理装置及工程机械的控制方法
JP2005082265A (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: 22779444

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 20237030216

Country of ref document: KR

Kind code of ref document: A

WWE Wipo information: entry into national phase

Ref document number: 1020237030216

Country of ref document: KR

WWE Wipo information: entry into national phase

Ref document number: 112022000577

Country of ref document: DE

WWE Wipo information: entry into national phase

Ref document number: 202280019932.3

Country of ref document: CN

WWE Wipo information: entry into national phase

Ref document number: 18283595

Country of ref document: US

122 Ep: pct application non-entry in european phase

Ref document number: 22779444

Country of ref document: EP

Kind code of ref document: A1