EP4303369A1 - Work machine - Google Patents
Work machine Download PDFInfo
- Publication number
- EP4303369A1 EP4303369A1 EP22763269.2A EP22763269A EP4303369A1 EP 4303369 A1 EP4303369 A1 EP 4303369A1 EP 22763269 A EP22763269 A EP 22763269A EP 4303369 A1 EP4303369 A1 EP 4303369A1
- Authority
- EP
- European Patent Office
- Prior art keywords
- boom
- limit value
- allowable range
- height direction
- work machine
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000004364 calculation method Methods 0.000 claims abstract description 62
- 230000005484 gravity Effects 0.000 claims abstract description 14
- 238000001514 detection method Methods 0.000 claims description 23
- 238000000034 method Methods 0.000 description 34
- 230000008569 process Effects 0.000 description 33
- 230000036544 posture Effects 0.000 description 26
- 238000010586 diagram Methods 0.000 description 16
- 239000013598 vector Substances 0.000 description 13
- 239000003921 oil Substances 0.000 description 11
- 239000004576 sand Substances 0.000 description 10
- 230000006870 function Effects 0.000 description 8
- 230000008859 change Effects 0.000 description 5
- 230000004044 response Effects 0.000 description 4
- 239000002689 soil Substances 0.000 description 4
- 238000009412 basement excavation Methods 0.000 description 3
- 230000008602 contraction Effects 0.000 description 3
- NCGICGYLBXGBGN-UHFFFAOYSA-N 3-morpholin-4-yl-1-oxa-3-azonia-2-azanidacyclopent-3-en-5-imine;hydrochloride Chemical compound Cl.[N-]1OC(=N)C=[N+]1N1CCOCC1 NCGICGYLBXGBGN-UHFFFAOYSA-N 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000003384 imaging method Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000002123 temporal effect Effects 0.000 description 2
- 238000012217 deletion Methods 0.000 description 1
- 230000037430 deletion Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
Images
Classifications
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
- E02F9/261—Surveying the work-site to be treated
- E02F9/262—Surveying the work-site to be treated with follow-up actions to control the work tool, e.g. controller
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
- E02F3/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2025—Particular purposes of control systems not otherwise provided for
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/30—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom
- E02F3/32—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom working downwardly and towards the machine, e.g. with backhoes
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
- E02F3/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
- E02F3/437—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like providing automatic sequences of movements, e.g. linear excavation, keeping dipper angle constant
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/08—Superstructures; Supports for superstructures
- E02F9/10—Supports for movable superstructures mounted on travelling or walking gears or on other superstructures
- E02F9/12—Slewing or traversing gears
- E02F9/121—Turntables, i.e. structure rotatable about 360°
- E02F9/123—Drives or control devices specially adapted therefor
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2025—Particular purposes of control systems not otherwise provided for
- E02F9/2033—Limiting the movement of frames or implements, e.g. to avoid collision between implements and the cabin
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
- E02F9/261—Surveying the work-site to be treated
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2200/00—Type of vehicle
- B60Y2200/40—Special vehicles
- B60Y2200/41—Construction vehicles, e.g. graders, excavators
- B60Y2200/412—Excavators
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
- E02F9/2221—Control of flow rate; Load sensing arrangements
- E02F9/2225—Control of flow rate; Load sensing arrangements using pressure-compensating valves
- E02F9/2228—Control of flow rate; Load sensing arrangements using pressure-compensating valves including an electronic controller
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
- E02F9/2278—Hydraulic circuits
- E02F9/2285—Pilot-operated systems
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
- E02F9/2278—Hydraulic circuits
- E02F9/2292—Systems with two or more pumps
Definitions
- the present invention relates to a work machine.
- An articulated work machine for example, a hydraulic excavator
- a front work device for example, a boom, an arm, and an attachment including a bucket or the like
- a hydraulic actuator for example, a hydraulic actuator driven by a hydraulic actuator.
- This type of work machine performs a loading work of a target object by performing a convey operation and a dump operation (for example, dirt dumping operation).
- the convey operation conveys the target object, such as excavated earth and sand, toward a loaded machine, such as a carrier machine (for example, a dump truck).
- the dump operation dumps the target object conveyed by the convey operation onto the loaded machine.
- a position of the front work device for example, a position of the bucket
- the front work device possibly interferences with the loaded machine under the convey operation.
- the position of the front work device is excessively high with respect to the loaded machine, the dumped target object possibly damages the loaded machine.
- a hydraulic excavator for mine might dump about 50 tons of earth and sand onto the dump truck at one time of the dirt dumping operation. If the position of the bucket is excessively high with respect to the dump truck, the dumped dirt possibly seriously damages the dump truck.
- An operator of the work machine who performs the loading work is required to perform a linked operation of the swing operation of the upper swing body and the turn operation of the front work device while confirming the position of the loaded machine, and thus a sophisticated skill is required.
- Patent Literature 1 discloses a loading machine control device that includes an avoidable location identification section.
- the avoidable location identification section identifies an interference avoiding position having a height same as a dirt dumping position and a distance from the swing center of the upper swing body same as a distance from the swing center to the dirt dumping position. In the interference avoiding position, the loaded machine is not present under the bucket.
- Patent Literature 1 JP 2019-65661 A
- the loading machine control device of Patent Literature 1 automatically moves the bucket from an excavation complete position to the interference avoiding position upon input of an operation signal for instructing a dirt dumping from an operator.
- the loading machine control device of Patent Literature 1 automatically moves the bucket to a dirt dumping position by halting an operation of the front work device and continuing the swing operation of the upper swing body alone. That is, since the loading machine control device of Patent Literature 1 moves the bucket along a trajectory passing through the interference avoiding position and the dirt dumping position, the operator possibly feels uncomfortable feeling depending on the trajectory.
- the present invention has been made in consideration of the above-described points and an object of which is to provide a work machine that allows assisting a loading work without giving uncomfortable feeling to an operator.
- the work machine is for loading a target object onto a loaded machine by performing a convey operation and a dump operation, the convey operation conveying the target object toward the loaded machine, the dump operation dumping the target object conveyed by the convey operation onto the loaded machine.
- the work machine comprises: an upper swing body that swings with respect to a lower traveling body; a working device mounted on the upper swing body and including a boom, an arm, and a bucket; a posture detecting device that detects a turn angle of the working device and a swing angle of the upper swing body; an object detecting device that detects a position of the loaded machine; and a control device that controls operations of the working device and the upper swing body.
- the control device includes: an allowable range calculation section that calculates an allowable range indicating a range in which the working device is movable in a height direction allowed in the swing operation of the upper swing body based on a detection result of the object detecting device; an operation determining section that determines whether the work machine is under the convey operation or not based on a detection result of the posture detecting device and a detection result of the object detecting device; an operation control section that controls a turn operation of the boom such that the position of the working device in the height direction remains within the allowable range when the work machine is determined to be under the convey operation.
- the allowable range calculation section calculates a range of the turn angle of the boom defined by a lower limit value and an upper limit value as the allowable range, the lower limit value of the position in the height direction allowing the working device to avoid interference with the loaded machine under the convey operation, the upper limit value of the position in the height direction obtained based on at least one of a dimension of the bucket, a capacity of the bucket, a type of the target object, or a specific gravity of the target object.
- the present invention can provide a work machine that allows assisting a loading work without giving uncomfortable feeling to an operator.
- the work machine of the embodiment is a work machine that loads a target object onto a loaded machine by performing a convey operation that conveys the target object toward the loaded machine and a dump operation that dumps the target object conveyed by the convey operation onto the loaded machine.
- a hydraulic excavator including a bucket as an example of the work machine.
- the work machine of the embodiment may be a hydraulic excavator including an attachment other than the bucket, and may be a work machine other than the hydraulic excavator that performs the loading work of the target object by performing the above-described convey operation and dump operation.
- Fig. 1 is a diagram schematically illustrating a configuration of a work machine 1 of Embodiment 1.
- the work machine 1 performs an excavation work that excavates a target excavation surface, such as the ground, and the loading work that loads the target object, such as excavated earth and sand, onto the loaded machine, such as a carrier machine or the like including a dump truck. In this loading work, the work machine 1 performs the above-described convey operation and dump operation.
- the work machine 1 includes an articulated front work device 2 and a machine main body 3 on which the front work device 2 is mounted.
- the front work device 2 holds the target object and turns in the vertical direction or the front-back direction.
- the front work device 2 is an example of "working device" recited in claims.
- the machine main body 3 includes a lower traveling body 5 and an upper swing body 7.
- the lower traveling body 5 travels with a right traveling hydraulic motor 4a and a left traveling hydraulic motor 4b provided on a right side portion and a left side portion of the lower traveling body 5.
- the upper swing body 7 is mounted via a swing device above the lower traveling body 5 and swings using a hydraulic swing motor 6 of the swing device.
- the right traveling hydraulic motor 4a and the left traveling hydraulic motor 4b are collectively referred to as "traveling hydraulic motors 4a, 4b.”
- the front work device 2 is an articulated working device configured with a plurality of front attachment members mounted in a front portion of the upper swing body 7.
- the upper swing body 7 swings with the front work device 2 mounted.
- the front work device 2 includes a boom 8, an arm 9, and a bucket 10.
- the boom 8 is coupled to a front portion of the upper swing body 7 turnably in the vertical direction.
- the arm 9 is coupled to a distal end portion of the boom 8 turnably in the vertical direction.
- the bucket 10 is coupled to a distal end portion of the arm 9 turnably in the vertical direction.
- the boom 8 is coupled to the upper swing body 7 by a boom pin 8a and turns by expansion and contraction of a boom cylinder 11.
- the arm 9 is coupled to a distal end portion of the boom 8 by an arm pin 9a and turns by expansion and contraction of an arm cylinder 12.
- the bucket 10 is coupled to a distal end portion of the arm 9 by a bucket pin 10a and a bucket link 16 and turns by expansion and contraction of a bucket cylinder 13.
- the boom pin 8a is provided with a boom angular sensor 14 that detects a turn angle of the boom 8.
- the arm pin 9a is provided with an arm angular sensor 15 that detects a turn angle of the arm 9.
- the bucket link 16 is provided with a bucket angular sensor 17 that detects a turn angle of the bucket 10.
- the respective turn angles of the boom 8, the arm 9, and the bucket 10 may be obtained by detecting respective angles of the boom 8, the arm 9, and the bucket 10 with respect to the reference surface, such as the horizontal surface, by an inertial measurement device, and converting them into the respective turn angles.
- the respective turn angles of the boom 8, the arm 9, and the bucket 10 may be obtained by detecting respective strokes of the boom cylinder 11, the arm cylinder 12, and the bucket cylinder 13 by stroke sensors, and converting them into the respective turn angles.
- the upper swing body 7 is provided with an inclined angle sensor 18 that detects an inclined angle of the machine main body 3 with respect to the reference surface, such as the horizontal surface.
- the swing device between the lower traveling body 5 and the upper swing body 7 is provided with a swing angle sensor 19 that detects a swing angle as a relative angle of the upper swing body 7 with respect to the lower traveling body 5.
- the upper swing body 7 is provided with an angular velocity sensor 20 that detects an angular velocity of the upper swing body 7.
- the boom angular sensor 14, the arm angular sensor 15, the bucket angular sensor 17, the inclined angle sensor 18, and the swing angle sensor 19 are collectively referred to as "posture detecting device 53."
- the posture detecting device 53 detects the respective turn angles of the front work device 2, the swing angle of the upper swing body 7, and the like.
- An operating device which operates a plurality of hydraulic actuators 4a, 4b, 6, 11, 12, 13, is installed in an operator's cabin disposed in the upper swing body 7.
- the operating device includes a right travel lever 23a for operating the right traveling hydraulic motor 4a, a left travel lever 23b for operating the left traveling hydraulic motor 4b, a right operation lever 22a for operating the boom cylinder 11 and the bucket cylinder 13, a left operation lever 22b for operating the arm cylinder 12 and the hydraulic swing motor 6.
- the right travel lever 23a, the left travel lever 23b, the right operation lever 22a, and the left operation lever 22b are collectively referred to as "operation levers 22, 23.”
- the operation levers 22, 23 are electrical levers.
- the upper swing body 7 is provided with an object detecting device 54 that detects a type and a position of an object present around the work machine 1.
- the object detecting device 54 may be, for example, a Light Detection And Ranging (LiDAR), and may be a stereo camera.
- the object detecting device 54 can detect a position of the loaded machine for which the work machine 1 performs the loading work.
- a plurality of the object detecting devices 54 may be provided to the work machine 1.
- Fig. 2 is a diagram schematically illustrating a configuration of a hydraulic system mounted on the work machine 1 shown in Fig. 1 .
- An engine 103 as a prime mover mounted on the upper swing body 7 drives a hydraulic pressure pump 102 and a pilot pump 104.
- the control device 40 controls the turn operation of the front work device 2, the traveling operation of the lower traveling body 5, and the swing operation of the upper swing body 7 in response to operation information (operation amount and operation direction) of the operation levers 22, 23 by the operator.
- the control device 40 detects the operation information (operation amount and operation direction) of the operation levers 22, 23 by the operator using sensors 52a to 52f, such as a rotary encoder and a potentiometer, and outputs control commands to electromagnetic proportional valves 47a to 47l corresponding to the detected operation information.
- the electromagnetic proportional valves 47a to 47l are disposed on a pilot line 100 and operates when the control commands are input from the control device 40, and the electromagnetic proportional valves 47a to 47l outputs pilot pressures to a flow rate control valve 101 for operating the flow rate control valve 101.
- the operation information of the operation levers 22, 23 by the operator is also referred to as "operation instruction of operator.”
- the sensors 52a to 52f that detect this operation information are collectively referred to as "operation detecting device 52.”
- the flow rate control valve 101 controls a pressure oil to each of the hydraulic swing motor 6, the arm cylinder 12, the boom cylinder 11, the bucket cylinder 13, the right traveling hydraulic motor 4a, and the left traveling hydraulic motor 4b supplied from the hydraulic pressure pump 102 corresponding to the pilot pressures from the electromagnetic proportional valves 47a to 47l.
- the electromagnetic proportional valves 47a, 47b output the pilot pressures to the flow rate control valve 101 for controlling the pressure oil supplied to the hydraulic swing motor 6.
- the electromagnetic proportional valves 47c, 47d output the pilot pressures to the flow rate control valve 101 for controlling the pressure oil supplied to the arm cylinder 12.
- the electromagnetic proportional valves 47e, 47f output the pilot pressures to the flow rate control valve 101 for controlling the pressure oil supplied to the boom cylinder 11.
- the electromagnetic proportional valves 47g, 47h output the pilot pressures to the flow rate control valve 101 for controlling the pressure oil supplied to the bucket cylinder 13.
- the electromagnetic proportional valves 47i, 47j output the pilot pressures to the flow rate control valve 101 for controlling the pressure oil supplied to the right traveling hydraulic motor 4a.
- the electromagnetic proportional valves 47k, 47l output the pilot pressures to the flow rate control valve 101 for controlling the pressure oil supplied to the left traveling hydraulic motor 4b.
- the boom cylinder 11, the arm cylinder 12, and the bucket cylinder 13 expand and contract with the supplied pressure oils to respectively turn the boom 8, the arm 9, and the bucket 10. This changes a position and a posture of the bucket 10.
- the hydraulic swing motor 6 rotates with the supplied pressure oil to swing the upper swing body 7.
- the right traveling hydraulic motor 4a and the left traveling hydraulic motor 4b rotate with the supplied pressure oil for causing the lower traveling body 5 to travel.
- the traveling hydraulic motors 4a, 4b, the hydraulic swing motor 6, the boom cylinder 11, the arm cylinder 12, and the bucket cylinder 13 are collectively referred to as "hydraulic actuator.”
- Fig. 3 is a diagram illustrating a functional configuration of the control device 40 shown in Fig. 2 .
- Fig. 4 is a diagram illustrating a reference coordinate system defined in the control device 40 shown in Fig. 3 .
- Fig. 5 is a view of the reference coordinate system shown in Fig. 4 viewed in another direction.
- Fig. 6 is a diagram describing an allowable range calculated by an allowable range calculation section 46 shown in Fig. 3 .
- the control device 40 includes a posture calculation section 41, a velocity calculation section 42, a velocity vector calculation section 43, a loaded machine position calculation section 44, an operation determining section 45, an allowable range calculation section 46, and an operation control section 48.
- the control device 40 has a preliminarily set reference coordinate system for identifying positions and postures of configuration elements of the work machine 1.
- the reference coordinate system of the embodiment is defined as a right hand coordinate system having the point as the origin at which the lower traveling body 5 contacts the ground G in a swing center 120 as shown in Fig. 4 and Fig. 5 .
- the reference coordinate system is defined to have the forward direction of the lower traveling body 5 as the positive direction of the X-axis.
- the reference coordinate system of the embodiment is defined to have the direction of the swing center 120 extending upward as the positive direction of the Z-axis.
- the reference coordinate system of the embodiment is defined to be orthogonal to each of the X-axis and the Z-axis and have the left side as the positive direction of the Y-axis.
- the XY plane is fixed to the ground G.
- a swing angle of the upper swing body 7 is defined to have a state in which the front work device 2 is parallel to the X-axis as 0 degree.
- the operation plane of the front work device 2 is parallel to the XZ plane
- a direction of raising operation of the boom 8 is the positive direction of the Z-axis
- the dumping direction of the arm 9 and the bucket 10 is the positive direction of the X-axis.
- the posture calculation section 41 calculates the postures and the like of the configuration elements of the work machine 1 in the reference coordinate system from detection signals of the posture detecting device 53. Specifically, the posture calculation section 41 calculates a turn angle ⁇ bm of the boom 8 with respect to the X-axis from a detection signal of a turn angle of the boom 8 output from the boom angular sensor 14. The posture calculation section 41 calculates a turn angle ⁇ am of the arm 9 with respect to the boom 8 from a detection signal of a turn angle of the arm 9 output from the arm angular sensor 15. The posture calculation section 41 calculates a turn angle ⁇ bk of the bucket 10 with respect to the arm 9 from a detection signal of a turn angle of the bucket 10 output from the bucket angular sensor 17. The posture calculation section 41 calculates a swing angle ⁇ sw of the upper swing body 7 with respect to the X-axis (the lower traveling body 5) from a detection signal of a swing angle of the upper swing body 7 output from the swing angle sensor 19.
- the posture calculation section 41 calculates the respective positions of the boom 8, the arm 9, and the bucket 10 based on the calculated respective turn angles ⁇ bm , ⁇ am , ⁇ bk of the front work device 2 and swing angle ⁇ sw of the upper swing body 7, a dimension L bm of the boom 8, a dimension L am of the arm 9, and a dimension L bk of the bucket 10.
- the dimension L bm of the boom 8 is a length from the boom pin 8a to the arm pin 9a.
- the dimension L am of the arm 9 is a length from the arm pin 9a to the bucket pin 10a.
- the dimension L bk of the bucket 10 is a length from the bucket pin 10a to a distal end portion (for example, a distal end portion of tooth) of the bucket 10.
- the posture calculation section 41 calculates the inclined angle ⁇ of the machine main body 3 (the lower traveling body 5) with respect to a reference plane DP from a detection signal of the inclined angle of the machine main body 3 output from the inclined angle sensor 18.
- the reference plane DP is, for example, a horizontal plane orthogonal to the gravity direction.
- the inclined angle ⁇ includes a pitch angle as a rotation angle around the Y-axis and a roll angle as a rotation angle around the X-axis.
- the posture calculation section 41 calculates a ground angle ⁇ as an angle of the bucket 10 with respect to the ground G from the respective turn angles ⁇ bm , ⁇ am , ⁇ bk of the front work device 2.
- the ground angle ⁇ of the bucket 10 is an angle formed between the ground G and a straight line passing through the distal end portion of the bucket 10 and the bucket pin 10a.
- the velocity calculation section 42 calculates respective speeds of hydraulic actuators 6, 11, 12, 13 from a detection signal of the operation detecting device 52.
- the control device 40 stores a table showing a correspondence relation between operation amounts of the operation levers 22, 23 and the respective speeds of the hydraulic actuators 6, 11, 12, 13 in advance.
- the velocity calculation section 42 calculates the respective speeds of the hydraulic actuators 6, 11, 12, 13 from the operation amounts included in the operation information of the operation levers 22, 23 output from the operation detecting device 52.
- the velocity calculation section 42 can convert a velocity of the hydraulic swing motor 6 into the swing speed of the upper swing body 7.
- the velocity calculation section 42 can convert a velocity of the boom cylinder 11 into a turn speed of the boom 8.
- the velocity calculation section 42 can convert a velocity of the arm cylinder 12 into a turn speed of the arm 9.
- the velocity calculation section 42 can convert a velocity of the bucket cylinder 13 into a turn speed of the bucket 10.
- the velocity calculation section 42 may calculate the respective turn speeds of the front work device 2 by calculating temporal changes of the respective turn angles ⁇ bm , ⁇ am , ⁇ bk of the front work device 2 calculated by the posture calculation section 41.
- the velocity calculation section 42 may calculate a swing speed of the upper swing body 7 by calculating a temporal change of a swing angle ⁇ sw of the upper swing body 7 calculated by the posture calculation section 41.
- the velocity vector calculation section 43 calculates speed vectors occurring in the front work device 2 based on a calculation result of the posture calculation section 41 and a calculation result of the velocity calculation section 42. Specifically, the velocity vector calculation section 43 calculates a speed vector occurring at a distal end of the arm 9 based on the respective turn angles ⁇ bm , ⁇ am , ⁇ bk of the front work device 2, the swing angle ⁇ sw of the upper swing body 7, the respective turn speeds of the front work device 2, and the swing speed of the upper swing body 7.
- the loaded machine position calculation section 44 calculates a position of the loaded machine in the reference coordinate system from a position of the loaded machine detected by the object detecting device 54.
- the object detecting device 54 is mounted on the upper swing body 7. Accordingly, the loaded machine position calculation section 44 can calculate a position of the loaded machine in the reference coordinate system based on the swing angle ⁇ sw of the upper swing body 7 and an installation position of the object detecting device 54 with respect to the reference coordinate system.
- the operation determining section 45 determines whether the work machine 1 is under the convey operation or not based on a detection result of the object detecting device 54 and a detection result of the posture detecting device 53. Specifically, the operation determining section 45 obtains the ground angle ⁇ of the bucket 10 calculated by the posture calculation section 41 based on the detection result of the posture detecting device 53, a direction of the speed vector calculated by the velocity vector calculation section 43 based on the detection result of the posture detecting device 53, and the position of the loaded machine calculated by the loaded machine position calculation section 44 based on the detection result of the object detecting device 54.
- the operation determining section 45 determines that the work machine 1 is under the convey operation when the ground angle ⁇ of the bucket 10 is equal to or more than a predetermined value, the direction of the speed vector occurring at the distal end of the arm 9 is a direction toward the loaded machine, and the front work device 2 has not reached the position of the loaded machine yet.
- the operation determining section 45 determines that the work machine 1 is not under the convey operation when the ground angle ⁇ of the bucket 10 is less than the predetermined value, the direction of the speed vector occurring at the distal end of the arm 9 is not a direction toward the loaded machine, or the front work device 2 has reached the position of the loaded machine.
- the allowable range calculation section 46 calculates an allowable range showing a range in which the front work device 2 is movable in the height direction while the upper swing body 7 is under the swing operation based on the detection result of the object detecting device 54.
- the allowable range calculation section 46 calculates a range of the turn angle of the boom 8 as the allowable range.
- the range of the turn angle of the boom 8 is defined by a lower limit value and an upper limit value.
- the lower limit value of the position of the front work device 2 in the height direction allows the front work device 2 to avoid interference with the loaded machine under the convey operation.
- the upper limit value of the position of the front work device 2 in the height direction allows avoiding a damage on the loaded machine due to the target object in the dump operation.
- the allowable range calculation section 46 sets the turn angle ⁇ bm of the boom 8 corresponding to the lower limit value of the position of the front work device 2 in the height direction that allows the front work device 2 to avoid interference with the loaded machine under the convey operation, to the lower limit value of the allowable range. In this embodiment, the allowable range calculation section 46 sets the turn angle ⁇ bm of the boom 8 corresponding to the upper limit value of the position of the front work device 2 in the height direction that allows avoiding a damage on the loaded machine due to the target object in the dump operation, to the upper limit value of the allowable range.
- a relation between the lower limit value of the allowable range for the position of the front work device 2 in the height direction and a swing angle ⁇ sw of the front work device 2 to reach the position of the loaded machine is also referred to as "correlation map A.”
- a relation between the upper limit value of the allowable range for the position of the front work device 2 in the height direction and the swing angle ⁇ sw is also referred to as "correlation map B.”
- a relation between the turn angle ⁇ bm of the boom 8 corresponding to the lower limit value of the allowable range and the swing angle ⁇ sw is assumed to be “correlation map A.”
- a relation between the turn angle ⁇ bm of the boom 8 corresponding to the upper limit value of the allowable range and the swing angle ⁇ sw is assumed to be "correlation map B.”
- ⁇ bmll sin ⁇ 1 ⁇ Z ll a ll 2 + b ll 2 ⁇ ⁇ bmll
- a ll , b ll , ⁇ bmll are coefficients for composition of trigonometric functions.
- the upper limit value ⁇ bmul of the turn angle ⁇ bm of the boom 8 in this case is given with the following formula.
- the upper limit value ⁇ bmul of the turn angle ⁇ bm may be a predetermined constant value.
- aui, b ul , a bmul are coefficients for composition of trigonometric functions.
- the height Zui can be preliminarily set based on at least one of the dimension L bk and a capacity of the bucket 10, a type of the earth and sand to be excavated, or a specific gravity (weight) of the earth and sand to be excavated, or a combination thereof.
- the height Z ul can be preliminarily set with a relation (combination) between the dimension L bk and the capacity of the bucket 10 and the type and specific gravity (weight) of the earth and sand to be excavated.
- the height Z ul may be a constant value obtained by adding four times of the dimension L bk of the bucket 10 to the height of the distal end portion of the arm 9 from the ground G.
- the height Z ul can be set to be lower assuming that the larger the gross weight of the target object is loaded onto the loaded machine in one time of the loading work, the more seriously the loaded machine is damaged in the dump operation.
- the height Z ul can be set adjustably considering the damage using the value obtained by adding the four times of the dimension L bk of the bucket 10 to the height of the distal end portion of the arm 9 from the ground G as a reference Z of the height Zui.
- the height Z ul may be set to be lower as the capacity of the bucket 10 increases, and the height Z ul may be set to be lower as the specific gravity (weight) of the target object such as the earth and sand to be excavated increases.
- the height Z ul may be set to be lower as an average size (for example, an average particle size of the earth and sand ) and/or a size variation of the target object increases.
- Table 1 summarizes the relation (combination) between the capacities of the buckets 10, the types of the target objects, the specific gravities of the target objects, and the heights Zui.
- the work machine 1 includes an input device 57 for an operator to input information on the capacity of the bucket 10, and the type and the specific gravity of the target object.
- the allowable range calculation section 46 of the control device 40 is configured to perform setting and adjusting of the height Zui based on the information input by the input device 57.
- the work machine 1 may include a receiving device that receives information on the capacity of the bucket 10, and the type and the specific gravity of the target object from outside (for example, a control system).
- the allowable range calculation section 46 of the control device 40 may be configured to perform setting and adjusting of the height Zui based on the information received by the receiving device.
- the work machine 1 may include an imaging device that captures the target object.
- the work machine 1 may include a retrieving device that retrieves map information, the position information of the work machine 1, geological information (for example, information on geological layer components) of a work site associated with the map information.
- the allowable range calculation section 46 of the control device 40 may be configured to determine the type and the specific gravity of the target object based on an image of the target object captured by the imaging device or information retrieved by the retrieving device, and perform setting and adjusting of the height Zui based on them.
- the work machine 1 does not have to perform setting and adjusting of the height Zui based on the capacity of the bucket 10 or the information on the type and the specific gravity of the target object, and may perform setting and adjusting of the height Zui by directly inputting the height Zui to the input device 57 by an operator.
- a position X am in a X-axis direction of the distal end portion of the arm 9 in the reference coordinate system is given using a position L ox in the X-axis direction and a position L oy in a Y-axis direction of the boom pin 8a with respect to the origin in the reference coordinate system with the following formula.
- X am L ox + L bm cos ⁇ bm + L am cos ⁇ bm + ⁇ am cos ⁇ sw ⁇ L oy sin ⁇ sw
- a swing angle ⁇ swT at which the front work device 2 reaches the loaded machine is given using a position Xt in the X-axis direction of the loaded machine in the reference coordinate system with the following formula.
- ⁇ swT cos ⁇ 1 ⁇ X t a swT 2 + b swT 2 + ⁇ swT
- a swT , b swT , ⁇ swT are coefficients for composition of trigonometric functions.
- the correlation map A calculated by the allowable range calculation section 46 indicates how the turn angle ⁇ bm corresponding to the lower limit value of the allowable range changes in response to the change of the swing angle ⁇ sw .
- the turn angle ⁇ bm corresponding to the lower limit value of the allowable range monotonically increases in response to the increases of the swing angle ⁇ sw as shown in Fig. 6 .
- the correlation map B indicates how the turn angle ⁇ bm corresponding to the upper limit value of the allowable range changes in response to the change of the swing angle ⁇ sw .
- the turn angle ⁇ bm (that is, ⁇ bmul ) corresponding to the upper limit value of the allowable range is a predetermined constant value as shown in Fig. 6 , for the increase of the swing angle ⁇ sw .
- the operation control section 48 controls the turn speed of the front work device 2 such that the position of the front work device 2 in the height direction remains within the allowable range, thus controlling the turn operation of the front work device 2. Specifically, when the position of the front work device 2 in the height direction that moves in accordance with an operation instruction by an operator on the front work device 2 falls below the lower limit value or exceeds the upper limit value of the allowable range (which is predicted), the operation control section 48 invalidates the operation instruction. Then, the operation control section 48 controls the turn speed of the front work device 2 such that the position of the front work device 2 in the height direction remains within the allowable range.
- the operation control section 48 controls the turn speed of the boom 8 such that the position of the front work device 2 in the height direction remains within the allowable range. Specifically, the operation control section 48 calculates the turn speed (a target turn speed) of the boom 8 such that the turn angle ⁇ bm of the boom 8 remains within the allowable range between the correlation map A and the correlation map B shown in Fig. 6 .
- the operation control section 48 invalidates the operation instruction by the operator that causes the turn angle ⁇ bm to fall below the correlation map A, and calculates the target turn speed of the boom 8 for automatically performing the raising operation such that the turn angle ⁇ bm of the boom 8 exceeds the correlation map A.
- the amount of the raising operation of the boom 8 by the operator is excessive or the like, and the turn angle ⁇ bm of the boom 8 is predicted to exceed the correlation map B in some cases.
- the operation control section 48 invalidates the operation instruction of the operator that causes the turn angle ⁇ bm to exceed the correlation map B, and calculates the target turn speed of the boom 8 for automatically performing a lowering operation such that the turn angle ⁇ bm of the boom 8 falls below the correlation map B. Furthermore, for example, in the work machine 1, the raising operation of the arm 9 by the operator is performed or the like, and the turn angle ⁇ bm of the boom 8 is predicted to exceed the correlation map B in some cases.
- the operation control section 48 invalidates the operation instruction of the operator that causes the turn angle ⁇ bm to exceed the correlation map B, and calculates the target turn speed of the boom 8 for automatically performing a lowering operation of the boom 8 such that the turn angle ⁇ bm of the boom 8 falls below the correlation map B.
- the operation control section 48 calculates a target speed of the boom cylinder 11 corresponding to the target turn speed of the boom 8. Then, the operation control section 48 outputs a control command to the electromagnetic proportional valves 47a to 47l (specifically, the electromagnetic proportional valves 47e, 47f) for operating the boom cylinder 11 corresponding to the target speed of the boom cylinder 11.
- the electromagnetic proportional valves 47a to 47l (specifically, the electromagnetic proportional valves 47e, 47f) generate the pilot pressures for controlling the pressure oil supplied to the boom cylinder 11 and output them to the flow rate control valve 101, thus operating the boom cylinder 11 corresponding to the target speed.
- the boom 8 turns corresponding to the target turn speed, and the turn angle ⁇ bm of the boom 8 remains within the allowable range.
- the operation control section 48 predicts that the turn angle ⁇ bm of the boom 8 operated by the operator remains within the allowable range between the correlation maps A and B in some cases. In this case, the operation control section 48 controls the turn operation of the boom 8 in accordance with the operation instruction of the operator so as to cause the boom 8 to turn.
- the control device 40 generates information indicating execution of a control intervention when the control intervention is executed to invalidate the operation instruction of the operator and assists the loading work in a case of, for example, automatically performing the raising operation or the lowering operation of the boom 8. Then, the control device 40 can notify the operator of the information indicating execution of the control intervention by displaying the information on a display device 55 or emitting a voice from a speaker. In this embodiment, invalidating the operation instruction of the operator and executing of the control intervention for assisting the loading work is also referred to as "loading assistance control.”
- Fig. 7 is a flowchart of a process relating to a loading assistance control executed by the control device 40 shown in Fig. 3 .
- Step S101 the control device 40 determines whether the ground angle ⁇ of the bucket 10 is equal to or more than a predetermined value or not.
- the predetermined value is a lower limit value of the ground angle ⁇ of the bucket 10 when the bucket 10 holds the target object.
- the bucket 10 may be holding the target object, and the work machine 1 may be under the convey operation.
- the control device 40 determines that the work machine 1 may be under the convey operation and advances the process to Step S102.
- the control device 40 determines that the work machine 1 is not under the convey operation and terminates the process.
- Step S102 the control device 40 determines whether a direction of the speed vector occurring at the distal end of the arm 9 is a direction toward the loaded machine or not.
- the front work device 2 may be moving toward the loaded machine, and the work machine 1 may be under the convey operation.
- the control device 40 determines that the work machine 1 may be under the convey operation and advances the process to Step S103.
- the control device 40 determines that the work machine 1 is not under the convey operation and terminates the process.
- Step S103 the control device 40 determines whether the front work device 2 has reached the position of the loaded machine or not.
- the convey operation may have been terminated.
- the control device 40 determines that the work machine 1 may be under the convey operation and advances the process to Step S104.
- the control device 40 determines that the work machine 1 is not under the convey operation and terminates the process.
- Step S104 the control device 40 calculates the correlation maps A and B. That is, the control device 40 calculates the lower limit value and the upper limit value in the allowable range of the turn angle ⁇ bm of the boom 8.
- Step S105 the control device 40 determines whether the turn angle ⁇ bm of the boom 8 falls below the correlation map A by the operation of the operator or not.
- the control device 40 advances the process to Step S108 when the turn angle ⁇ bm falls below the correlation map A.
- Step S106 the control device 40 advances the process to Step S106 when the turn angle ⁇ bm does not fall below the correlation map A.
- Step S106 the control device 40 determines whether the turn angle ⁇ bm of the boom 8 exceeds the correlation map B by the operation of the operator or not.
- the control device 40 advances the process to Step S 109 when the turn angle ⁇ bm exceeds the correlation map B.
- the control device 40 advances the process to Step S107 when the turn angle ⁇ bm does not exceed the correlation map B.
- Step S107 the control device 40 controls the turn operation of the boom 8 in accordance with the operation instruction of the operator so as to cause the boom 8 to turn. Then, the control device 40 terminates the process.
- Step S108 the control device 40 invalidates the operation instruction of the operator that causes the turn angle ⁇ bm to fall below the correlation map A. Then, the control device 40 automatically executes the raising operation of the boom 8 such that the turn angle ⁇ bm of the boom 8 exceeds the correlation map A. Then, the control device 40 terminates the process.
- Step S109 the control device 40 invalidates the operation instruction of the operator that causes the turn angle ⁇ bm to exceed the correlation map B. Then, the control device 40 automatically executes the lowering operation of the boom 8 such that the turn angle ⁇ bm of the boom 8 falls below the correlation map B. Then, the control device 40 terminates the process.
- the control device 40 does not have to automatically execute the lowering operation of the boom 8 and may automatically halt the turn operation of the boom 8.
- the control device 40 of Embodiment 1 includes an allowable range calculation section 46 that calculates the allowable range indicating a range of the position of the front work device 2 in the height direction allowed in the swing operation of the upper swing body 7, based on the detection result of the object detecting device 54.
- the control device 40 includes an operation determining section 45 that determines whether it is under the convey operation or not based on the detection result of the posture detecting device 53 and the detection result of the object detecting device 54.
- the control device 40 includes an operation control section 48 that controls the turn operation of the boom 8 such that the position of the front work device 2 in the height direction remains within the allowable range when it is determined to be under the convey operation.
- the allowable range calculation section 46 calculates the range of the turn angle of the boom 8 defined by the lower limit value and the upper limit value as the allowable range.
- the lower limit value of the position of the front work device 2 in the height direction allows the front work device 2 to avoid interference with the loaded machine under the convey operation.
- the upper limit value of the position of the front work device 2 in the height direction is obtained based on the capacity of the bucket 10 and the type or the specific gravity of the target object.
- the work machine 1 of Embodiment 1 does not move the front work device 2 along only a specific trajectory and can move the front work device 2 along various trajectories on which intention of the operator is reflected as far as the position of the front work device 2 in the height direction remains within the allowable range.
- the allowable range is the range of the position of the front work device 2 in the height direction for avoiding the interference of the front work device 2 with the loaded machine and for avoiding the damage on the loaded machine by the target object. Accordingly, the work machine 1 of Embodiment 1 can assist the loading work without giving uncomfortable feeling to the operator while suppressing the interference with the loaded machine and the damage on the loaded machine.
- the operation control section 48 of Embodiment 1 invalidates the operation instruction of the operator when the position of the front work device 2 in the height direction that moves in accordance with the operation instruction of the operator falls below the lower limit value or exceeds the upper limit value. Then, the operation control section 48 controls the turn speed of the boom 8 such that the position of the front work device 2 in the height direction remains within the allowable range.
- the work machine 1 of Embodiment 1 ensures keeping the position of the front work device 2 in the height direction within the allowable range by the control intervention even when the position of the front work device 2 in the height direction is about to deviate from the allowable range by operation of the operator. Accordingly, the work machine 1 of Embodiment 1 ensures suppressing the interference with the loaded machine and the damage on the loaded machine, and can actively assist the loading work without giving uncomfortable feeling to the operator.
- Fig. 8 is a diagram illustrating an update example a correlation map A shown in Fig. 6 .
- the allowable range calculation section 46 updates the allowable range by setting the position of the front work device 2 in the height direction when the operation instruction becomes undetectable, as a new lower limit value.
- the allowable range calculation section 46 newly calculates a correlation map A1 using the turn angle ⁇ bmS1 corresponding to the swing angle ⁇ swS1 when the operation instruction becomes undetectable. That is, the allowable range calculation section 46 updates the allowable range by setting the position of the front work device 2 in the height direction when the operation instruction becomes undetectable, as a new lower limit value.
- Fig. 8 illustrates the turn angle ⁇ bmS1 as the turn angle ⁇ bm corresponding to the updated lower limit value of the allowable range.
- the work machine 1 of Embodiment 1 ensures keeping the position of the front work device 2 in the height direction within the allowable range with the intention of the operator reflected as much as possible even when the position of the front work device 2 in the height direction is about to fall below the lower limit value of the allowable range, by the operation of the operator. Accordingly, the work machine 1 of Embodiment 1 can assist the loading work without giving the uncomfortable feeling to the operator as less as possible while surely suppressing the interference with the loaded machine and the damage on the loaded machine.
- the arrow of the dashed line in Fig. 8 indicates that the operator continued the raising operation of the boom 8 in the above-described condition, and the turn angle ⁇ bm is about to exceed the correlation map B.
- the operation control section 48 invalidates the operation instruction of the operator that causes the turn angle ⁇ bm to exceed the correlation map B.
- the operation control section 48 controls the turn speed of the boom 8 such that the turn angle ⁇ bm does not exceed the correlation map B by automatically executing the lowering operation of the boom 8 and/or automatically halting the turn operation of the boom 8.
- the work machine 1 of Embodiment 1 ensures keeping the position of the front work device 2 in the height direction within the allowable range with the intention of the operator reflected as much as possible even when the position of the front work device 2 in the height direction is about to exceed the upper limit value of the allowable range, by the operation of the operator. Accordingly, the work machine 1 of Embodiment 1 can assist the loading work without giving the uncomfortable feeling to the operator as less as possible while surely suppressing the interference with the loaded machine and the damage on the loaded machine.
- Fig. 9 is a diagram illustrating a functional configuration of a work machine 1 of Embodiment 2.
- the work machine 1 of Embodiment 2 includes a target object information acquisition device 56 that obtains information on the target object held onto the front work device 2, that is, the target object held onto the bucket 10.
- the target object information acquisition device 56 is configured of a weight detecting device that detects, for example, a weight of the bucket 10 or a weight of the target object held onto the bucket 10.
- the operation determining section 45 of Embodiment 2 performs the determination by adding an obtained result of the target object information acquisition device 56 to the determination condition of Embodiment 1 as the determination condition for performing the determination of whether the work machine 1 is under the convey operation or not.
- Fig. 10 is a flowchart of a process relating to a loading assistance control executed by the control device 40 shown in Fig. 9 .
- Step S101 to Step S103 shown in Fig. 10 the control device 40 executes processes similar to the processes in Step S101 to Step S103 of Embodiment 1 shown in Fig. 7 . However, when the front work device 2 has not reached the position of the loaded machine in Step S103, the control device 40 determines that the work machine 1 may be under the convey operation and advances the process to Step S201.
- Step S201 the control device 40 determines whether a sufficient amount of the target object for operation of the convey operation is present in the bucket 10 or not based on the obtained result of the target object information acquisition device 56. For example, the control device 40 determines whether the weight of the bucket 10 obtained by the target object information acquisition device 56 is greater than a weight (hereinafter referred to as "predetermined weight") in which the sufficient amount of the target object is not present in the bucket 10. The control device 40 determines that the sufficient amount of the target object is present in the bucket 10 when the weight of the bucket 10 obtained by the target object information acquisition device 56 is greater than the predetermined weight. In this case, the control device 40 determines that the work machine 1 may be under the convey operation and advances the process to Step S104.
- predetermined weight a weight
- control device 40 determines that the sufficient amount of the target object is not present in the bucket 10 when the weight of the bucket 10 obtained by the target object information acquisition device 56 is equal to or less than the predetermined weight. In this case, the control device 40 determines that the work machine 1 is not under the convey operation and terminates the process.
- Step S104 to Step S109 shown in Fig. 10 the control device 40 executes processes similar to the processes in Step S104 to Step S109 of Embodiment 1 shown in Fig. 7 .
- Step S201 only has to be performed before Step S104, and does not have to be performed between Step S103 and Step S104.
- Step S201 may be performed before, for example, Step S101.
- the operation determining section 45 of Embodiment 2 determines whether the bucket 10 holds the target object or not based on the obtained result of the target object information acquisition device 56, and determines whether it is under the convey operation or not based on the determination result.
- the operation determining section 45 of Embodiment 2 can determine that the work machine 1 is under the convey operation, more accurately than Embodiment 1. Accordingly, the work machine 1 of Embodiment 2 can more accurately obtain the intention of the operator who performs operation relating to the convey operation than Embodiment 1, and thus can assist the loading work without giving the uncomfortable feeling to the operator compared with Embodiment 1.
- Fig. 11 is a flowchart of a process relating to a loading assistance control executed by a control device 40 of Embodiment 3.
- Step S101 to Step S104 performed before Step S105 are similar to those of Embodiment 1 or Embodiment 2, their illustrations will be omitted.
- control device 40 of Embodiment 3 adds Step S301 to Step S303 to Step S101 to Step S109 of Embodiment 1 shown in Fig. 7 , and executes the process relating to the loading assistance control.
- Step S105 shown in Fig. 11 the control device 40 advances the process to Step S301 when the turn angle ⁇ bm falls below the correlation map A.
- Step S106 the control device 40 advances the process to Step S106 when the turn angle ⁇ bm does not fall below the correlation map A.
- Step S301 the control device 40 determines whether the turn angle ⁇ bm falls below the correlation map A or not even when the raising operation of the boom 8 is performed on condition that the turn speed of the boom 8 is controlled to be the maximum turn speed in the current swing speed.
- the control device 40 expresses the correlation map A using the turn speed of the boom 8 and the swing speed of the upper swing body 7 with the following formula.
- the control device 40 converts the turn speed of the boom 8 in the following formula into the speed of the boom cylinder 11. Then, the control device 40 determines whether the converted speed of the boom cylinder 11 is larger than the preliminarily stored maximum value of the speed of the boom cylinder 11 or not.
- ⁇ is a coefficient representing a gradient of the correlation map A.
- Step S302 the control device 40 calculates the swing speed that satisfies the relation of Formula (6) from the maximum value of the speed of the boom cylinder 11.
- the control device 40 automatically decelerates the swing operation of the upper swing body 7 such that the upper swing body 7 swings at the calculated swing speed. That is, the operation control section 48 of the control device 40 controls the swing speed of the upper swing body 7 such that the position of the front work device 2 in the height direction exceeds the lower limit value of the allowable range when the raising operation of the boom 8 is performed at least at the maximum turn speed.
- Step S303 the control device 40 automatically executes the raising operation of the boom 8 at the turn speed corresponding to the decelerated swing speed. Then, the control device 40 terminates the process.
- Step S106 to Step S109 shown in Fig. 11 the control device 40 executes the processes similar to Step S106 to Step S109 of Embodiment 1 shown in Fig. 7 or Embodiment 2 shown in Fig. 10 .
- the operation control section 48 of Embodiment 3 controls the swing speed of the upper swing body 7 such that the position of the front work device 2 in the height direction exceeds the lower limit value when the position of the front work device 2 in the height direction that moves in accordance with the operation instruction of the operator falls below the lower limit value of the allowable range and when the position of the front work device 2 in the height direction falls below the lower limit value of the allowable range even on condition that the turn speed of the boom 8 is controlled to be the maximum turn speed.
- the work machine 1 of Embodiment 3 ensures keeping the position of the front work device 2 in the height direction within the allowable range even when the position of the front work device 2 in the height direction is about to fall below the lower limit value of the allowable range due to the excessive swing operation amount of the upper swing body 7 by the operator. Accordingly, the work machine 1 of Embodiment 3 ensures suppressing the interference with the loaded machine and the damage on the loaded machine, and can assist the loading work without giving uncomfortable feeling to the operator.
- Fig. 12 is a diagram schematically illustrating a screen displayed on the display device 55 of Embodiment 4.
- the display device 55 of Embodiment 4 not only displays the information indicating the control intervention for assisting the loading work but also can display the correlation map A and the correlation map B as shown in Fig. 12 .
- the display device 55 can display an icon C superimposed on the correlation map A and the correlation map B.
- the icon C indicates the current position of the front work device 2 in the height direction and the swing speed of the upper swing body 7.
- Fig. 12 an example in which the icon C indicating the turn angle ⁇ bm of the boom 8 and the swing angle ⁇ sw corresponding to the current position of the front work device 2 in the height direction is superimposed on the correlation map A and the correlation map B is illustrated.
- the work machine 1 of Embodiment 4 not only notifies the operator of the information indicating that the control intervention for assisting the loading work is to be executed but also visualizes the specific content of the control intervention for allowing the operator to intuitively obtain it. Accordingly, the work machine 1 of Embodiment 4 allows suppressing the interference with the loaded machine and the damage on the loaded machine, and can assist the loading work without giving uncomfortable feeling to the operator, furthermore.
- the present invention is not limited to the above-described embodiments, and includes various modifications.
- the above-described embodiments are described in detail for ease of understanding of the present invention, and does not necessarily include all of the described configurations.
- a part of the configuration of one embodiment can be replaced by the configuration of another embodiment.
- the configuration of another embodiment can be added to the configuration of one embodiment. Addition, deletion, or replacement of another configuration can be performed on a part of the configuration in each of the embodiments.
- the above-described respective configurations, functions, processing units, processing means, or the like may be achieved by hardware, for example, a part of or all of which are designed with, for example, an integrated circuit.
- the above-described respective configurations and functions may be achieved by software with which a processor interprets and executes programs achieving the respective functions.
- the program that achieves each function, tape, and information, such as files, can be placed in a memory, a storage unit, such as a hard disk and a Solid State Drive (SSD), or a storing medium, such as an IC card, an SD card, and a DVD.
- SSD Solid State Drive
- control lines and information lines considered necessary for the description are described. Not all the control lines and the information lines on the product are necessarily described. Actually almost all configurations may be considered to be mutually coupled.
Landscapes
- Engineering & Computer Science (AREA)
- Mining & Mineral Resources (AREA)
- Civil Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Mechanical Engineering (AREA)
- Life Sciences & Earth Sciences (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Paleontology (AREA)
- Operation Control Of Excavators (AREA)
Abstract
Provided is a work machine that allows assisting a loading work without giving uncomfortable feeling to an operator. The control device 40 of the work machine 1 includes an allowable range calculation section 46 that calculates an allowable range indicating a range in which the front work device 2 is movable in a height direction allowed in a swing operation; an operation determining section 45 that determines whether the work machine 1 is under a convey operation; and an operation control section 4 that controls a turn operation of a boom 8 such that the position of the front work device 2 in the height direction remains within the allowable range when the work machine 1 is determined to be under the convey operation. The allowable range calculation section 46 calculates a range of the turn angle of the boom 8 as the allowable range defined by a lower limit value and an upper limit value. The lower limit value of a position of the front work device 2 in the height direction allows the front work device 2 to avoid interference with the loaded machine under the convey operation. The upper limit value of the position of the front work device 2 in the height direction is obtained based on at least one of dimension and capacity of the bucket 10, type of the loading target object, and specific gravity of the loading target object.
Description
- The present invention relates to a work machine.
- An articulated work machine (for example, a hydraulic excavator) including a front work device (for example, a boom, an arm, and an attachment including a bucket or the like) driven by a hydraulic actuator has been known. This type of work machine performs a loading work of a target object by performing a convey operation and a dump operation (for example, dirt dumping operation). The convey operation conveys the target object, such as excavated earth and sand, toward a loaded machine, such as a carrier machine (for example, a dump truck). The dump operation dumps the target object conveyed by the convey operation onto the loaded machine.
- When the loading work is performed, if a position of the front work device (for example, a position of the bucket) is low with respect to the loaded machine, the front work device possibly interferences with the loaded machine under the convey operation. On the other hand, if the position of the front work device is excessively high with respect to the loaded machine, the dumped target object possibly damages the loaded machine. For example, a hydraulic excavator for mine might dump about 50 tons of earth and sand onto the dump truck at one time of the dirt dumping operation. If the position of the bucket is excessively high with respect to the dump truck, the dumped dirt possibly seriously damages the dump truck. An operator of the work machine who performs the loading work is required to perform a linked operation of the swing operation of the upper swing body and the turn operation of the front work device while confirming the position of the loaded machine, and thus a sophisticated skill is required.
- A technique for assisting this type of loading work is disclosed in, for example,
Patent Literature 1.Patent Literature 1 discloses a loading machine control device that includes an avoidable location identification section. The avoidable location identification section identifies an interference avoiding position having a height same as a dirt dumping position and a distance from the swing center of the upper swing body same as a distance from the swing center to the dirt dumping position. In the interference avoiding position, the loaded machine is not present under the bucket. - Patent Literature 1:
JP 2019-65661 A - The loading machine control device of
Patent Literature 1 automatically moves the bucket from an excavation complete position to the interference avoiding position upon input of an operation signal for instructing a dirt dumping from an operator. When the bucket reaches the interference avoiding position, the loading machine control device ofPatent Literature 1 automatically moves the bucket to a dirt dumping position by halting an operation of the front work device and continuing the swing operation of the upper swing body alone. That is, since the loading machine control device ofPatent Literature 1 moves the bucket along a trajectory passing through the interference avoiding position and the dirt dumping position, the operator possibly feels uncomfortable feeling depending on the trajectory. - The present invention has been made in consideration of the above-described points and an object of which is to provide a work machine that allows assisting a loading work without giving uncomfortable feeling to an operator.
- In order to solve the above-described problems, a work machine according to the invention is provided. The work machine is for loading a target object onto a loaded machine by performing a convey operation and a dump operation, the convey operation conveying the target object toward the loaded machine, the dump operation dumping the target object conveyed by the convey operation onto the loaded machine. The work machine comprises: an upper swing body that swings with respect to a lower traveling body; a working device mounted on the upper swing body and including a boom, an arm, and a bucket; a posture detecting device that detects a turn angle of the working device and a swing angle of the upper swing body; an object detecting device that detects a position of the loaded machine; and a control device that controls operations of the working device and the upper swing body. The control device includes: an allowable range calculation section that calculates an allowable range indicating a range in which the working device is movable in a height direction allowed in the swing operation of the upper swing body based on a detection result of the object detecting device; an operation determining section that determines whether the work machine is under the convey operation or not based on a detection result of the posture detecting device and a detection result of the object detecting device; an operation control section that controls a turn operation of the boom such that the position of the working device in the height direction remains within the allowable range when the work machine is determined to be under the convey operation. The allowable range calculation section calculates a range of the turn angle of the boom defined by a lower limit value and an upper limit value as the allowable range, the lower limit value of the position in the height direction allowing the working device to avoid interference with the loaded machine under the convey operation, the upper limit value of the position in the height direction obtained based on at least one of a dimension of the bucket, a capacity of the bucket, a type of the target object, or a specific gravity of the target object.
- The present invention can provide a work machine that allows assisting a loading work without giving uncomfortable feeling to an operator.
- The problems, configurations, and effects other than those described above will be made apparent from the following description of embodiments.
-
-
Fig. 1 is a diagram schematically illustrating a configuration of a work machine ofEmbodiment 1. -
Fig. 2 is a diagram schematically illustrating a configuration of a hydraulic system mounted on the work machine shown inFig. 1 . -
Fig. 3 is a diagram illustrating a functional configuration of a control device shown inFig. 2 . -
Fig. 4 is a diagram illustrating a reference coordinate system defined in the control device shown inFig. 3 . -
Fig. 5 is a view of the reference coordinate system shown inFig. 4 viewed in another direction. -
Fig. 6 is a diagram describing an allowable range calculated by an allowable range calculation section shown inFig. 3 . -
Fig. 7 is a flowchart of a process relating to a loading assistance control executed by the control device shown inFig. 3 . -
Fig. 8 is a diagram illustrating an update example of a correlation map shown inFig. 6 . -
Fig. 9 is a diagram illustrating a functional configuration of a work machine ofEmbodiment 2. -
Fig. 10 is a flowchart of a process relating to a loading assistance control executed by a control device shown inFig. 9 . -
Fig. 11 is a flowchart of a process relating to a loading assistance control executed by a control device ofEmbodiment 3. -
Fig. 12 is a diagram schematically illustrating a screen displayed on a display device of Embodiment 4. - The following describes the embodiments of the present invention by referring to the drawings. It should be noted that configurations denoted by the same reference numerals in each embodiment have the same functions in each embodiment unless otherwise specified, and the description thereof will be omitted.
- The work machine of the embodiment is a work machine that loads a target object onto a loaded machine by performing a convey operation that conveys the target object toward the loaded machine and a dump operation that dumps the target object conveyed by the convey operation onto the loaded machine. A following description will be given of a hydraulic excavator including a bucket as an example of the work machine. However, the work machine of the embodiment may be a hydraulic excavator including an attachment other than the bucket, and may be a work machine other than the hydraulic excavator that performs the loading work of the target object by performing the above-described convey operation and dump operation.
-
Fig. 1 is a diagram schematically illustrating a configuration of awork machine 1 ofEmbodiment 1. - The
work machine 1 performs an excavation work that excavates a target excavation surface, such as the ground, and the loading work that loads the target object, such as excavated earth and sand, onto the loaded machine, such as a carrier machine or the like including a dump truck. In this loading work, thework machine 1 performs the above-described convey operation and dump operation. Thework machine 1 includes an articulatedfront work device 2 and a machinemain body 3 on which thefront work device 2 is mounted. Thefront work device 2 holds the target object and turns in the vertical direction or the front-back direction. Thefront work device 2 is an example of "working device" recited in claims. - The machine
main body 3 includes alower traveling body 5 and anupper swing body 7. Thelower traveling body 5 travels with a right travelinghydraulic motor 4a and a left travelinghydraulic motor 4b provided on a right side portion and a left side portion of thelower traveling body 5. Theupper swing body 7 is mounted via a swing device above thelower traveling body 5 and swings using ahydraulic swing motor 6 of the swing device. In this embodiment, the right travelinghydraulic motor 4a and the left travelinghydraulic motor 4b are collectively referred to as "travelinghydraulic motors - The
front work device 2 is an articulated working device configured with a plurality of front attachment members mounted in a front portion of theupper swing body 7. Theupper swing body 7 swings with thefront work device 2 mounted. Thefront work device 2 includes aboom 8, anarm 9, and abucket 10. Theboom 8 is coupled to a front portion of theupper swing body 7 turnably in the vertical direction. Thearm 9 is coupled to a distal end portion of theboom 8 turnably in the vertical direction. Thebucket 10 is coupled to a distal end portion of thearm 9 turnably in the vertical direction. - The
boom 8 is coupled to theupper swing body 7 by aboom pin 8a and turns by expansion and contraction of aboom cylinder 11. Thearm 9 is coupled to a distal end portion of theboom 8 by anarm pin 9a and turns by expansion and contraction of anarm cylinder 12. Thebucket 10 is coupled to a distal end portion of thearm 9 by abucket pin 10a and abucket link 16 and turns by expansion and contraction of abucket cylinder 13. - The
boom pin 8a is provided with a boomangular sensor 14 that detects a turn angle of theboom 8. Thearm pin 9a is provided with an armangular sensor 15 that detects a turn angle of thearm 9. Thebucket link 16 is provided with a bucketangular sensor 17 that detects a turn angle of thebucket 10. - The respective turn angles of the
boom 8, thearm 9, and thebucket 10 may be obtained by detecting respective angles of theboom 8, thearm 9, and thebucket 10 with respect to the reference surface, such as the horizontal surface, by an inertial measurement device, and converting them into the respective turn angles. The respective turn angles of theboom 8, thearm 9, and thebucket 10 may be obtained by detecting respective strokes of theboom cylinder 11, thearm cylinder 12, and thebucket cylinder 13 by stroke sensors, and converting them into the respective turn angles. - The
upper swing body 7 is provided with an inclined angle sensor 18 that detects an inclined angle of the machinemain body 3 with respect to the reference surface, such as the horizontal surface. The swing device between thelower traveling body 5 and theupper swing body 7 is provided with aswing angle sensor 19 that detects a swing angle as a relative angle of theupper swing body 7 with respect to thelower traveling body 5. Theupper swing body 7 is provided with an angular velocity sensor 20 that detects an angular velocity of theupper swing body 7. In this embodiment, the boomangular sensor 14, the armangular sensor 15, the bucketangular sensor 17, the inclined angle sensor 18, and theswing angle sensor 19 are collectively referred to as "posture detectingdevice 53." Theposture detecting device 53 detects the respective turn angles of thefront work device 2, the swing angle of theupper swing body 7, and the like. - An operating device, which operates a plurality of
hydraulic actuators upper swing body 7. Specifically, the operating device includes aright travel lever 23a for operating the right travelinghydraulic motor 4a, aleft travel lever 23b for operating the left travelinghydraulic motor 4b, aright operation lever 22a for operating theboom cylinder 11 and thebucket cylinder 13, aleft operation lever 22b for operating thearm cylinder 12 and thehydraulic swing motor 6. In this embodiment, theright travel lever 23a, theleft travel lever 23b, theright operation lever 22a, and theleft operation lever 22b are collectively referred to as "operation levers 22, 23." The operation levers 22, 23 are electrical levers. - The
upper swing body 7 is provided with anobject detecting device 54 that detects a type and a position of an object present around thework machine 1. Theobject detecting device 54 may be, for example, a Light Detection And Ranging (LiDAR), and may be a stereo camera. Theobject detecting device 54 can detect a position of the loaded machine for which thework machine 1 performs the loading work. A plurality of theobject detecting devices 54 may be provided to thework machine 1. -
Fig. 2 is a diagram schematically illustrating a configuration of a hydraulic system mounted on thework machine 1 shown inFig. 1 . - An
engine 103 as a prime mover mounted on theupper swing body 7 drives ahydraulic pressure pump 102 and apilot pump 104. Thecontrol device 40 controls the turn operation of thefront work device 2, the traveling operation of thelower traveling body 5, and the swing operation of theupper swing body 7 in response to operation information (operation amount and operation direction) of the operation levers 22, 23 by the operator. Specifically, thecontrol device 40 detects the operation information (operation amount and operation direction) of the operation levers 22, 23 by theoperator using sensors 52a to 52f, such as a rotary encoder and a potentiometer, and outputs control commands to electromagneticproportional valves 47a to 47l corresponding to the detected operation information. The electromagneticproportional valves 47a to 47l are disposed on apilot line 100 and operates when the control commands are input from thecontrol device 40, and the electromagneticproportional valves 47a to 47l outputs pilot pressures to a flowrate control valve 101 for operating the flowrate control valve 101. In this embodiment, the operation information of the operation levers 22, 23 by the operator is also referred to as "operation instruction of operator." In this embodiment, thesensors 52a to 52f that detect this operation information are collectively referred to as "operation detecting device 52." - The flow
rate control valve 101 controls a pressure oil to each of thehydraulic swing motor 6, thearm cylinder 12, theboom cylinder 11, thebucket cylinder 13, the right travelinghydraulic motor 4a, and the left travelinghydraulic motor 4b supplied from thehydraulic pressure pump 102 corresponding to the pilot pressures from the electromagneticproportional valves 47a to 47l. The electromagneticproportional valves rate control valve 101 for controlling the pressure oil supplied to thehydraulic swing motor 6. The electromagneticproportional valves rate control valve 101 for controlling the pressure oil supplied to thearm cylinder 12. The electromagneticproportional valves rate control valve 101 for controlling the pressure oil supplied to theboom cylinder 11. The electromagneticproportional valves rate control valve 101 for controlling the pressure oil supplied to thebucket cylinder 13. The electromagneticproportional valves 47i, 47j output the pilot pressures to the flowrate control valve 101 for controlling the pressure oil supplied to the right travelinghydraulic motor 4a. The electromagnetic proportional valves 47k, 47l output the pilot pressures to the flowrate control valve 101 for controlling the pressure oil supplied to the left travelinghydraulic motor 4b. - The
boom cylinder 11, thearm cylinder 12, and thebucket cylinder 13 expand and contract with the supplied pressure oils to respectively turn theboom 8, thearm 9, and thebucket 10. This changes a position and a posture of thebucket 10. Thehydraulic swing motor 6 rotates with the supplied pressure oil to swing theupper swing body 7. The right travelinghydraulic motor 4a and the left travelinghydraulic motor 4b rotate with the supplied pressure oil for causing thelower traveling body 5 to travel. In this embodiment, the travelinghydraulic motors hydraulic swing motor 6, theboom cylinder 11, thearm cylinder 12, and thebucket cylinder 13 are collectively referred to as "hydraulic actuator." -
Fig. 3 is a diagram illustrating a functional configuration of thecontrol device 40 shown inFig. 2 .Fig. 4 is a diagram illustrating a reference coordinate system defined in thecontrol device 40 shown inFig. 3 .Fig. 5 is a view of the reference coordinate system shown inFig. 4 viewed in another direction.Fig. 6 is a diagram describing an allowable range calculated by an allowablerange calculation section 46 shown inFig. 3 . - The
control device 40 includes aposture calculation section 41, avelocity calculation section 42, a velocityvector calculation section 43, a loaded machineposition calculation section 44, anoperation determining section 45, an allowablerange calculation section 46, and anoperation control section 48. - The
control device 40 has a preliminarily set reference coordinate system for identifying positions and postures of configuration elements of thework machine 1. The reference coordinate system of the embodiment is defined as a right hand coordinate system having the point as the origin at which thelower traveling body 5 contacts the ground G in aswing center 120 as shown inFig. 4 andFig. 5 . The reference coordinate system is defined to have the forward direction of thelower traveling body 5 as the positive direction of the X-axis. The reference coordinate system of the embodiment is defined to have the direction of theswing center 120 extending upward as the positive direction of the Z-axis. The reference coordinate system of the embodiment is defined to be orthogonal to each of the X-axis and the Z-axis and have the left side as the positive direction of the Y-axis. In the reference coordinate system of the embodiment, the XY plane is fixed to the ground G. - In the reference coordinate system of the embodiment, a swing angle of the
upper swing body 7 is defined to have a state in which thefront work device 2 is parallel to the X-axis as 0 degree. In a state where theupper swing body 7 has the swing angle of 0 degree, the operation plane of thefront work device 2 is parallel to the XZ plane, a direction of raising operation of theboom 8 is the positive direction of the Z-axis, the dumping direction of thearm 9 and thebucket 10 is the positive direction of the X-axis. - The
posture calculation section 41 calculates the postures and the like of the configuration elements of thework machine 1 in the reference coordinate system from detection signals of theposture detecting device 53. Specifically, theposture calculation section 41 calculates a turn angle θbm of theboom 8 with respect to the X-axis from a detection signal of a turn angle of theboom 8 output from the boomangular sensor 14. Theposture calculation section 41 calculates a turn angle θam of thearm 9 with respect to theboom 8 from a detection signal of a turn angle of thearm 9 output from the armangular sensor 15. Theposture calculation section 41 calculates a turn angle θbk of thebucket 10 with respect to thearm 9 from a detection signal of a turn angle of thebucket 10 output from the bucketangular sensor 17. Theposture calculation section 41 calculates a swing angle θsw of theupper swing body 7 with respect to the X-axis (the lower traveling body 5) from a detection signal of a swing angle of theupper swing body 7 output from theswing angle sensor 19. - Furthermore, the
posture calculation section 41 calculates the respective positions of theboom 8, thearm 9, and thebucket 10 based on the calculated respective turn angles θbm, θam, θbk of thefront work device 2 and swing angle θsw of theupper swing body 7, a dimension Lbm of theboom 8, a dimension Lam of thearm 9, and a dimension Lbk of thebucket 10. The dimension Lbm of theboom 8 is a length from theboom pin 8a to thearm pin 9a. The dimension Lam of thearm 9 is a length from thearm pin 9a to thebucket pin 10a. The dimension Lbk of thebucket 10 is a length from thebucket pin 10a to a distal end portion (for example, a distal end portion of tooth) of thebucket 10. - Furthermore, the
posture calculation section 41 calculates the inclined angle θ of the machine main body 3 (the lower traveling body 5) with respect to a reference plane DP from a detection signal of the inclined angle of the machinemain body 3 output from the inclined angle sensor 18. The reference plane DP is, for example, a horizontal plane orthogonal to the gravity direction. The inclined angle θ includes a pitch angle as a rotation angle around the Y-axis and a roll angle as a rotation angle around the X-axis. Theposture calculation section 41 calculates a ground angle γ as an angle of thebucket 10 with respect to the ground G from the respective turn angles θbm, θam, θbk of thefront work device 2. The ground angle γ of thebucket 10 is an angle formed between the ground G and a straight line passing through the distal end portion of thebucket 10 and thebucket pin 10a. - The
velocity calculation section 42 calculates respective speeds ofhydraulic actuators operation detecting device 52. Specifically, thecontrol device 40 stores a table showing a correspondence relation between operation amounts of the operation levers 22, 23 and the respective speeds of thehydraulic actuators velocity calculation section 42 calculates the respective speeds of thehydraulic actuators operation detecting device 52. Thevelocity calculation section 42 can convert a velocity of thehydraulic swing motor 6 into the swing speed of theupper swing body 7. Thevelocity calculation section 42 can convert a velocity of theboom cylinder 11 into a turn speed of theboom 8. Thevelocity calculation section 42 can convert a velocity of thearm cylinder 12 into a turn speed of thearm 9. Thevelocity calculation section 42 can convert a velocity of thebucket cylinder 13 into a turn speed of thebucket 10. - The
velocity calculation section 42 may calculate the respective turn speeds of thefront work device 2 by calculating temporal changes of the respective turn angles θbm, θam, θbk of thefront work device 2 calculated by theposture calculation section 41. Thevelocity calculation section 42 may calculate a swing speed of theupper swing body 7 by calculating a temporal change of a swing angle θsw of theupper swing body 7 calculated by theposture calculation section 41. - The velocity
vector calculation section 43 calculates speed vectors occurring in thefront work device 2 based on a calculation result of theposture calculation section 41 and a calculation result of thevelocity calculation section 42. Specifically, the velocityvector calculation section 43 calculates a speed vector occurring at a distal end of thearm 9 based on the respective turn angles θbm, θam, θbk of thefront work device 2, the swing angle θsw of theupper swing body 7, the respective turn speeds of thefront work device 2, and the swing speed of theupper swing body 7. - The loaded machine
position calculation section 44 calculates a position of the loaded machine in the reference coordinate system from a position of the loaded machine detected by theobject detecting device 54. Theobject detecting device 54 is mounted on theupper swing body 7. Accordingly, the loaded machineposition calculation section 44 can calculate a position of the loaded machine in the reference coordinate system based on the swing angle θsw of theupper swing body 7 and an installation position of theobject detecting device 54 with respect to the reference coordinate system. - The
operation determining section 45 determines whether thework machine 1 is under the convey operation or not based on a detection result of theobject detecting device 54 and a detection result of theposture detecting device 53. Specifically, theoperation determining section 45 obtains the ground angle γ of thebucket 10 calculated by theposture calculation section 41 based on the detection result of theposture detecting device 53, a direction of the speed vector calculated by the velocityvector calculation section 43 based on the detection result of theposture detecting device 53, and the position of the loaded machine calculated by the loaded machineposition calculation section 44 based on the detection result of theobject detecting device 54. Theoperation determining section 45 determines that thework machine 1 is under the convey operation when the ground angle γ of thebucket 10 is equal to or more than a predetermined value, the direction of the speed vector occurring at the distal end of thearm 9 is a direction toward the loaded machine, and thefront work device 2 has not reached the position of the loaded machine yet. Theoperation determining section 45 determines that thework machine 1 is not under the convey operation when the ground angle γ of thebucket 10 is less than the predetermined value, the direction of the speed vector occurring at the distal end of thearm 9 is not a direction toward the loaded machine, or thefront work device 2 has reached the position of the loaded machine. - The allowable
range calculation section 46 calculates an allowable range showing a range in which thefront work device 2 is movable in the height direction while theupper swing body 7 is under the swing operation based on the detection result of theobject detecting device 54. In detail, the allowablerange calculation section 46 calculates a range of the turn angle of theboom 8 as the allowable range. The range of the turn angle of theboom 8 is defined by a lower limit value and an upper limit value. The lower limit value of the position of thefront work device 2 in the height direction allows thefront work device 2 to avoid interference with the loaded machine under the convey operation. The upper limit value of the position of thefront work device 2 in the height direction allows avoiding a damage on the loaded machine due to the target object in the dump operation. In this embodiment, the allowablerange calculation section 46 sets the turn angle θbm of theboom 8 corresponding to the lower limit value of the position of thefront work device 2 in the height direction that allows thefront work device 2 to avoid interference with the loaded machine under the convey operation, to the lower limit value of the allowable range. In this embodiment, the allowablerange calculation section 46 sets the turn angle θbm of theboom 8 corresponding to the upper limit value of the position of thefront work device 2 in the height direction that allows avoiding a damage on the loaded machine due to the target object in the dump operation, to the upper limit value of the allowable range. - In this embodiment, a relation between the lower limit value of the allowable range for the position of the
front work device 2 in the height direction and a swing angle θsw of thefront work device 2 to reach the position of the loaded machine is also referred to as "correlation map A." In this embodiment, a relation between the upper limit value of the allowable range for the position of thefront work device 2 in the height direction and the swing angle θsw is also referred to as "correlation map B." In this embodiment, a relation between the turn angle θbm of theboom 8 corresponding to the lower limit value of the allowable range and the swing angle θsw is assumed to be "correlation map A." In this embodiment, a relation between the turn angle θbm of theboom 8 corresponding to the upper limit value of the allowable range and the swing angle θsw is assumed to be "correlation map B." - A following description will be given of a specific calculation method for calculating the allowable range by the allowable
range calculation section 46. In the following description, a dimension of thework machine 1 in the width direction is assumed to be negligible. First, a height Zam of the distal end portion of thearm 9 from the ground G in the reference coordinate system is given using a height Loz of theboom pin 8a from the ground G in the reference coordinate system with the following formula.
[Math. 1] - Considering a dimension Lbk of the
bucket 10 and a margin, and assuming that a height (the lower limit value of the position of thefront work device 2 in the height direction) in the reference coordinate system is Zll where the distal end portion of thearm 9 should reach without interference with the loaded machine when thefront work device 2 reaches the loaded machine, the lower limit value θbmll of the turn angle θbm of theboom 8 in this case is given with the following formula.
[Math. 2] - Similarly, assuming that an allowable height of the distal end portion of the
arm 9 from the ground G (the upper limit value of the position of thefront work device 2 in the height direction) for the target object not to damage the loaded machine is Zul, the upper limit value θbmul of the turn angle θbm of theboom 8 in this case is given with the following formula. In this embodiment, the upper limit value θbmul of the turn angle θbm may be a predetermined constant value.
[Math. 3] - The height Zui can be preliminarily set based on at least one of the dimension Lbk and a capacity of the
bucket 10, a type of the earth and sand to be excavated, or a specific gravity (weight) of the earth and sand to be excavated, or a combination thereof. Especially, the height Zul can be preliminarily set with a relation (combination) between the dimension Lbk and the capacity of thebucket 10 and the type and specific gravity (weight) of the earth and sand to be excavated. For example, the height Zul may be a constant value obtained by adding four times of the dimension Lbk of thebucket 10 to the height of the distal end portion of thearm 9 from the ground G. For example, the height Zul can be set to be lower assuming that the larger the gross weight of the target object is loaded onto the loaded machine in one time of the loading work, the more seriously the loaded machine is damaged in the dump operation. Specifically, for example, the height Zul can be set adjustably considering the damage using the value obtained by adding the four times of the dimension Lbk of thebucket 10 to the height of the distal end portion of thearm 9 from the ground G as a reference Z of the height Zui. For example, the height Zul may be set to be lower as the capacity of thebucket 10 increases, and the height Zul may be set to be lower as the specific gravity (weight) of the target object such as the earth and sand to be excavated increases. For example, the height Zul may be set to be lower as an average size (for example, an average particle size of the earth and sand ) and/or a size variation of the target object increases. The setting contents of the heights Zui in consideration thereof can be summarized as shown in Table 1. Table 1 summarizes the relation (combination) between the capacities of thebuckets 10, the types of the target objects, the specific gravities of the target objects, and the heights Zui. In the embodiment, thework machine 1 includes aninput device 57 for an operator to input information on the capacity of thebucket 10, and the type and the specific gravity of the target object. The allowablerange calculation section 46 of thecontrol device 40 is configured to perform setting and adjusting of the height Zui based on the information input by theinput device 57. Thework machine 1 may include a receiving device that receives information on the capacity of thebucket 10, and the type and the specific gravity of the target object from outside (for example, a control system). The allowablerange calculation section 46 of thecontrol device 40 may be configured to perform setting and adjusting of the height Zui based on the information received by the receiving device. Thework machine 1 may include an imaging device that captures the target object. Thework machine 1 may include a retrieving device that retrieves map information, the position information of thework machine 1, geological information (for example, information on geological layer components) of a work site associated with the map information. The allowablerange calculation section 46 of thecontrol device 40 may be configured to determine the type and the specific gravity of the target object based on an image of the target object captured by the imaging device or information retrieved by the retrieving device, and perform setting and adjusting of the height Zui based on them. Thework machine 1 does not have to perform setting and adjusting of the height Zui based on the capacity of thebucket 10 or the information on the type and the specific gravity of the target object, and may perform setting and adjusting of the height Zui by directly inputting the height Zui to theinput device 57 by an operator.[Table 1] Bucket Capacity Type of Target Object Specific Gravity of Target Object Gross Weight per Loading Damage on Loaded Machine Height Zul (Upper Limit Value) Medium Sand and Sandy Soil Type Medium Medium Medium Z Cohesive Soil Type Small Small Small 1.1 Z Ore Type Large Large Large 0.9 Z Large Sand and Sandy Soil Type Medium Large Large 0.9 Z Cohesive Soil Type Small Medium Medium Z Ore Type Large Extra Large Extra Large 0.8 Z - A position Xam in a X-axis direction of the distal end portion of the
arm 9 in the reference coordinate system is given using a position Lox in the X-axis direction and a position Loy in a Y-axis direction of theboom pin 8a with respect to the origin in the reference coordinate system with the following formula.
[Math. 4] - A swing angle θswT at which the
front work device 2 reaches the loaded machine is given using a position Xt in the X-axis direction of the loaded machine in the reference coordinate system with the following formula.
[Math. 5] - Assuming that the turn angle of the
boom 8 is θbmS and the swing angle of theupper swing body 7 is θswS when it is determined to be under the convey operation by theoperation determining section 45, correlation maps A and B as shown inFig. 6 are obtained. In the convey operation, when the turn angle θbm of theboom 8 and/or the turn angle θam of thearm 9 change, the height Zll where the distal end portion of thearm 9 should reach when thefront work device 2 reaches the loaded machine, the lower limit value θbmll of the turn angle θbm of theboom 8 at this time, and the swing angle θswT required to reach the position Xt of the loaded machine also change. Accordingly, the allowablerange calculation section 46 sequentially updates the correlation map A shown inFig. 6 . - That is, the correlation map A calculated by the allowable
range calculation section 46 indicates how the turn angle θbm corresponding to the lower limit value of the allowable range changes in response to the change of the swing angle θsw. In this embodiment, the turn angle θbm corresponding to the lower limit value of the allowable range monotonically increases in response to the increases of the swing angle θsw as shown inFig. 6 . Similarly, the correlation map B indicates how the turn angle θbm corresponding to the upper limit value of the allowable range changes in response to the change of the swing angle θsw. In this embodiment, the turn angle θbm (that is, θbmul) corresponding to the upper limit value of the allowable range is a predetermined constant value as shown inFig. 6 , for the increase of the swing angle θsw. - When it is determined to be under the convey operation by the
operation determining section 45, theoperation control section 48 controls the turn speed of thefront work device 2 such that the position of thefront work device 2 in the height direction remains within the allowable range, thus controlling the turn operation of thefront work device 2. Specifically, when the position of thefront work device 2 in the height direction that moves in accordance with an operation instruction by an operator on thefront work device 2 falls below the lower limit value or exceeds the upper limit value of the allowable range (which is predicted), theoperation control section 48 invalidates the operation instruction. Then, theoperation control section 48 controls the turn speed of thefront work device 2 such that the position of thefront work device 2 in the height direction remains within the allowable range. In this embodiment, when it is determined to be under the convey operation by theoperation determining section 45, theoperation control section 48 controls the turn speed of theboom 8 such that the position of thefront work device 2 in the height direction remains within the allowable range. Specifically, theoperation control section 48 calculates the turn speed (a target turn speed) of theboom 8 such that the turn angle θbm of theboom 8 remains within the allowable range between the correlation map A and the correlation map B shown inFig. 6 . - For example, in the
work machine 1, the operator does not perform a raising operation of theboom 8 or an amount of the raising operation of theboom 8 is insufficient, and the turn angle θbm of theboom 8 is predicted to fall below the correlation map A in some cases. In this case, theoperation control section 48 invalidates the operation instruction by the operator that causes the turn angle θbm to fall below the correlation map A, and calculates the target turn speed of theboom 8 for automatically performing the raising operation such that the turn angle θbm of theboom 8 exceeds the correlation map A. Furthermore, for example, in thework machine 1, the amount of the raising operation of theboom 8 by the operator is excessive or the like, and the turn angle θbm of theboom 8 is predicted to exceed the correlation map B in some cases. In this case, theoperation control section 48 invalidates the operation instruction of the operator that causes the turn angle θbm to exceed the correlation map B, and calculates the target turn speed of theboom 8 for automatically performing a lowering operation such that the turn angle θbm of theboom 8 falls below the correlation map B. Furthermore, for example, in thework machine 1, the raising operation of thearm 9 by the operator is performed or the like, and the turn angle θbm of theboom 8 is predicted to exceed the correlation map B in some cases. In this case, theoperation control section 48 invalidates the operation instruction of the operator that causes the turn angle θbm to exceed the correlation map B, and calculates the target turn speed of theboom 8 for automatically performing a lowering operation of theboom 8 such that the turn angle θbm of theboom 8 falls below the correlation map B. - Then, the
operation control section 48 calculates a target speed of theboom cylinder 11 corresponding to the target turn speed of theboom 8. Then, theoperation control section 48 outputs a control command to the electromagneticproportional valves 47a to 47l (specifically, the electromagneticproportional valves boom cylinder 11 corresponding to the target speed of theboom cylinder 11. The electromagneticproportional valves 47a to 47l (specifically, the electromagneticproportional valves boom cylinder 11 and output them to the flowrate control valve 101, thus operating theboom cylinder 11 corresponding to the target speed. Theboom 8 turns corresponding to the target turn speed, and the turn angle θbm of theboom 8 remains within the allowable range. - The
operation control section 48 predicts that the turn angle θbm of theboom 8 operated by the operator remains within the allowable range between the correlation maps A and B in some cases. In this case, theoperation control section 48 controls the turn operation of theboom 8 in accordance with the operation instruction of the operator so as to cause theboom 8 to turn. - The
control device 40 generates information indicating execution of a control intervention when the control intervention is executed to invalidate the operation instruction of the operator and assists the loading work in a case of, for example, automatically performing the raising operation or the lowering operation of theboom 8. Then, thecontrol device 40 can notify the operator of the information indicating execution of the control intervention by displaying the information on adisplay device 55 or emitting a voice from a speaker. In this embodiment, invalidating the operation instruction of the operator and executing of the control intervention for assisting the loading work is also referred to as "loading assistance control." -
Fig. 7 is a flowchart of a process relating to a loading assistance control executed by thecontrol device 40 shown inFig. 3 . - In Step S101, the
control device 40 determines whether the ground angle γ of thebucket 10 is equal to or more than a predetermined value or not. The predetermined value is a lower limit value of the ground angle γ of thebucket 10 when thebucket 10 holds the target object. When the ground angle γ of thebucket 10 is equal to or more than the predetermined value, thebucket 10 may be holding the target object, and thework machine 1 may be under the convey operation. When the ground angle γ of thebucket 10 is equal to or more than the predetermined value, thecontrol device 40 determines that thework machine 1 may be under the convey operation and advances the process to Step S102. On the other hand, when the ground angle γ of thebucket 10 is less than the predetermined value, thecontrol device 40 determines that thework machine 1 is not under the convey operation and terminates the process. - In Step S102, the
control device 40 determines whether a direction of the speed vector occurring at the distal end of thearm 9 is a direction toward the loaded machine or not. When the direction of the speed vector occurring at the distal end of thearm 9 is the direction toward the loaded machine, thefront work device 2 may be moving toward the loaded machine, and thework machine 1 may be under the convey operation. When the direction of the speed vector occurring at the distal end of thearm 9 is the direction toward the loaded machine, thecontrol device 40 determines that thework machine 1 may be under the convey operation and advances the process to Step S103. On the other hand, when the direction of the speed vector occurring at the distal end of thearm 9 is not the direction toward the loaded machine, thecontrol device 40 determines that thework machine 1 is not under the convey operation and terminates the process. - In Step S103, the
control device 40 determines whether thefront work device 2 has reached the position of the loaded machine or not. When thefront work device 2 has reached the position of the loaded machine, the convey operation may have been terminated. When thefront work device 2 has not reached the position of the loaded machine, thecontrol device 40 determines that thework machine 1 may be under the convey operation and advances the process to Step S104. On the other hand, when thefront work device 2 has reached the position of the loaded machine, thecontrol device 40 determines that thework machine 1 is not under the convey operation and terminates the process. - In Step S104, the
control device 40 calculates the correlation maps A and B. That is, thecontrol device 40 calculates the lower limit value and the upper limit value in the allowable range of the turn angle θbm of theboom 8. - In Step S105, the
control device 40 determines whether the turn angle θbm of theboom 8 falls below the correlation map A by the operation of the operator or not. Thecontrol device 40 advances the process to Step S108 when the turn angle θbm falls below the correlation map A. On the other hand, thecontrol device 40 advances the process to Step S106 when the turn angle θbm does not fall below the correlation map A. - In Step S106, the
control device 40 determines whether the turn angle θbm of theboom 8 exceeds the correlation map B by the operation of the operator or not. Thecontrol device 40 advances the process to StepS 109 when the turn angle θbm exceeds the correlation map B. On the other hand, thecontrol device 40 advances the process to Step S107 when the turn angle θbm does not exceed the correlation map B. - In Step S107, the
control device 40 controls the turn operation of theboom 8 in accordance with the operation instruction of the operator so as to cause theboom 8 to turn. Then, thecontrol device 40 terminates the process. - In Step S108, the
control device 40 invalidates the operation instruction of the operator that causes the turn angle θbm to fall below the correlation map A. Then, thecontrol device 40 automatically executes the raising operation of theboom 8 such that the turn angle θbm of theboom 8 exceeds the correlation map A. Then, thecontrol device 40 terminates the process. - In Step S109, the
control device 40 invalidates the operation instruction of the operator that causes the turn angle θbm to exceed the correlation map B. Then, thecontrol device 40 automatically executes the lowering operation of theboom 8 such that the turn angle θbm of theboom 8 falls below the correlation map B. Then, thecontrol device 40 terminates the process. When the turn angle θbm of theboom 8 does not exceed the correlation map B in Step S109, thecontrol device 40 does not have to automatically execute the lowering operation of theboom 8 and may automatically halt the turn operation of theboom 8. - Thus, the
control device 40 ofEmbodiment 1 includes an allowablerange calculation section 46 that calculates the allowable range indicating a range of the position of thefront work device 2 in the height direction allowed in the swing operation of theupper swing body 7, based on the detection result of theobject detecting device 54. Thecontrol device 40 includes anoperation determining section 45 that determines whether it is under the convey operation or not based on the detection result of theposture detecting device 53 and the detection result of theobject detecting device 54. Thecontrol device 40 includes anoperation control section 48 that controls the turn operation of theboom 8 such that the position of thefront work device 2 in the height direction remains within the allowable range when it is determined to be under the convey operation. The allowablerange calculation section 46 calculates the range of the turn angle of theboom 8 defined by the lower limit value and the upper limit value as the allowable range. The lower limit value of the position of thefront work device 2 in the height direction allows thefront work device 2 to avoid interference with the loaded machine under the convey operation. The upper limit value of the position of thefront work device 2 in the height direction is obtained based on the capacity of thebucket 10 and the type or the specific gravity of the target object. - As a result, the
work machine 1 ofEmbodiment 1 does not move thefront work device 2 along only a specific trajectory and can move thefront work device 2 along various trajectories on which intention of the operator is reflected as far as the position of thefront work device 2 in the height direction remains within the allowable range. Furthermore, the allowable range is the range of the position of thefront work device 2 in the height direction for avoiding the interference of thefront work device 2 with the loaded machine and for avoiding the damage on the loaded machine by the target object. Accordingly, thework machine 1 ofEmbodiment 1 can assist the loading work without giving uncomfortable feeling to the operator while suppressing the interference with the loaded machine and the damage on the loaded machine. - Especially, the
operation control section 48 ofEmbodiment 1 invalidates the operation instruction of the operator when the position of thefront work device 2 in the height direction that moves in accordance with the operation instruction of the operator falls below the lower limit value or exceeds the upper limit value. Then, theoperation control section 48 controls the turn speed of theboom 8 such that the position of thefront work device 2 in the height direction remains within the allowable range. - As a result, the
work machine 1 ofEmbodiment 1 ensures keeping the position of thefront work device 2 in the height direction within the allowable range by the control intervention even when the position of thefront work device 2 in the height direction is about to deviate from the allowable range by operation of the operator. Accordingly, thework machine 1 ofEmbodiment 1 ensures suppressing the interference with the loaded machine and the damage on the loaded machine, and can actively assist the loading work without giving uncomfortable feeling to the operator. -
Fig. 8 is a diagram illustrating an update example a correlation map A shown inFig. 6 . - In the
work machine 1, while thefront work device 2 moves within the allowable range in accordance with the operation instruction of the operator, the operator halts the operation or the like, and the operation instruction becomes undetectable by theoperation detecting device 52 in some cases. In this case, the allowablerange calculation section 46 updates the allowable range by setting the position of thefront work device 2 in the height direction when the operation instruction becomes undetectable, as a new lower limit value. - In the example of
Fig. 8 , after the calculation of the allowable range by the allowablerange calculation section 46, theboom 8 moves remaining within the allowable range in the swing operation in accordance with the operation instruction of the operator, and a condition that an increasing rate of the turn angle θbm with respect to the swing angle θsw is greater than the correlation map A is assumed. In this condition, the arrow of the dash-dot-dash line inFig. 8 indicates that the operator halted the raising operation of theboom 8 at the swing angle θswS1. This is a case where the operation instruction becomes undetectable by theoperation detecting device 52 while theboom 8 turns within the allowable range in accordance with the operation instruction of the operator. In this case, the allowablerange calculation section 46 newly calculates a correlation map A1 using the turn angle θbmS1 corresponding to the swing angle θswS1 when the operation instruction becomes undetectable. That is, the allowablerange calculation section 46 updates the allowable range by setting the position of thefront work device 2 in the height direction when the operation instruction becomes undetectable, as a new lower limit value.Fig. 8 illustrates the turn angle θbmS1 as the turn angle θbm corresponding to the updated lower limit value of the allowable range. - As a result, the
work machine 1 ofEmbodiment 1 ensures keeping the position of thefront work device 2 in the height direction within the allowable range with the intention of the operator reflected as much as possible even when the position of thefront work device 2 in the height direction is about to fall below the lower limit value of the allowable range, by the operation of the operator. Accordingly, thework machine 1 ofEmbodiment 1 can assist the loading work without giving the uncomfortable feeling to the operator as less as possible while surely suppressing the interference with the loaded machine and the damage on the loaded machine. - The arrow of the dashed line in
Fig. 8 indicates that the operator continued the raising operation of theboom 8 in the above-described condition, and the turn angle θbm is about to exceed the correlation map B. In this case, theoperation control section 48 invalidates the operation instruction of the operator that causes the turn angle θbm to exceed the correlation map B. Then, theoperation control section 48 controls the turn speed of theboom 8 such that the turn angle θbm does not exceed the correlation map B by automatically executing the lowering operation of theboom 8 and/or automatically halting the turn operation of theboom 8. - As a result, the
work machine 1 ofEmbodiment 1 ensures keeping the position of thefront work device 2 in the height direction within the allowable range with the intention of the operator reflected as much as possible even when the position of thefront work device 2 in the height direction is about to exceed the upper limit value of the allowable range, by the operation of the operator. Accordingly, thework machine 1 ofEmbodiment 1 can assist the loading work without giving the uncomfortable feeling to the operator as less as possible while surely suppressing the interference with the loaded machine and the damage on the loaded machine. - A description will be given of a
work machine 1 ofEmbodiment 2 usingFig. 9 andFig. 10 . In thework machine 1 ofEmbodiment 2, explanations for configurations and operations similar to those ofEmbodiment 1 will be omitted. -
Fig. 9 is a diagram illustrating a functional configuration of awork machine 1 ofEmbodiment 2. - The
work machine 1 ofEmbodiment 2 includes a target objectinformation acquisition device 56 that obtains information on the target object held onto thefront work device 2, that is, the target object held onto thebucket 10. The target objectinformation acquisition device 56 is configured of a weight detecting device that detects, for example, a weight of thebucket 10 or a weight of the target object held onto thebucket 10. Theoperation determining section 45 ofEmbodiment 2 performs the determination by adding an obtained result of the target objectinformation acquisition device 56 to the determination condition ofEmbodiment 1 as the determination condition for performing the determination of whether thework machine 1 is under the convey operation or not. -
Fig. 10 is a flowchart of a process relating to a loading assistance control executed by thecontrol device 40 shown inFig. 9 . - In Step S101 to Step S103 shown in
Fig. 10 , thecontrol device 40 executes processes similar to the processes in Step S101 to Step S103 ofEmbodiment 1 shown inFig. 7 . However, when thefront work device 2 has not reached the position of the loaded machine in Step S103, thecontrol device 40 determines that thework machine 1 may be under the convey operation and advances the process to Step S201. - In Step S201, the
control device 40 determines whether a sufficient amount of the target object for operation of the convey operation is present in thebucket 10 or not based on the obtained result of the target objectinformation acquisition device 56. For example, thecontrol device 40 determines whether the weight of thebucket 10 obtained by the target objectinformation acquisition device 56 is greater than a weight (hereinafter referred to as "predetermined weight") in which the sufficient amount of the target object is not present in thebucket 10. Thecontrol device 40 determines that the sufficient amount of the target object is present in thebucket 10 when the weight of thebucket 10 obtained by the target objectinformation acquisition device 56 is greater than the predetermined weight. In this case, thecontrol device 40 determines that thework machine 1 may be under the convey operation and advances the process to Step S104. On the other hand, thecontrol device 40 determines that the sufficient amount of the target object is not present in thebucket 10 when the weight of thebucket 10 obtained by the target objectinformation acquisition device 56 is equal to or less than the predetermined weight. In this case, thecontrol device 40 determines that thework machine 1 is not under the convey operation and terminates the process. - In Step S104 to Step S109 shown in
Fig. 10 , thecontrol device 40 executes processes similar to the processes in Step S104 to Step S109 ofEmbodiment 1 shown inFig. 7 . - Step S201 only has to be performed before Step S104, and does not have to be performed between Step S103 and Step S104. Step S201 may be performed before, for example, Step S101.
- Thus, the
operation determining section 45 ofEmbodiment 2 determines whether thebucket 10 holds the target object or not based on the obtained result of the target objectinformation acquisition device 56, and determines whether it is under the convey operation or not based on the determination result. - As a result, the
operation determining section 45 ofEmbodiment 2 can determine that thework machine 1 is under the convey operation, more accurately thanEmbodiment 1. Accordingly, thework machine 1 ofEmbodiment 2 can more accurately obtain the intention of the operator who performs operation relating to the convey operation thanEmbodiment 1, and thus can assist the loading work without giving the uncomfortable feeling to the operator compared withEmbodiment 1. - A description will be given of a
work machine 1 ofEmbodiment 3 usingFig. 11 . In thework machine 1 ofEmbodiment 3, explanations for configurations and operations similar to those ofEmbodiment 1 orEmbodiment 2 will be omitted. -
Fig. 11 is a flowchart of a process relating to a loading assistance control executed by acontrol device 40 ofEmbodiment 3. InFig. 11 , Step S101 to Step S104 performed before Step S105 are similar to those ofEmbodiment 1 orEmbodiment 2, their illustrations will be omitted. - In order for the turn angle θbm of the
boom 8 to exceed the correlation map A shown inFig. 6 in the swing operation, it is necessary to increase the turn angle θbm of theboom 8 corresponding to the increase of the swing angle θsw. In this respect, when the increase of the swing angle θsw is excessive, the turn angle θbm of theboom 8 does not follow in some cases. That is, the swing speed of theupper swing body 7 is excessively fast, the turn speed of the raising operation of theboom 8 does not catch up in some cases. - As a countermeasure against this, the
control device 40 ofEmbodiment 3 adds Step S301 to Step S303 to Step S101 to Step S109 ofEmbodiment 1 shown inFig. 7 , and executes the process relating to the loading assistance control. - In Step S105 shown in
Fig. 11 , thecontrol device 40 advances the process to Step S301 when the turn angle θbm falls below the correlation map A. On the other hand, thecontrol device 40 advances the process to Step S106 when the turn angle θbm does not fall below the correlation map A. - In Step S301, the
control device 40 determines whether the turn angle θbm falls below the correlation map A or not even when the raising operation of theboom 8 is performed on condition that the turn speed of theboom 8 is controlled to be the maximum turn speed in the current swing speed. - Specifically, the
control device 40 expresses the correlation map A using the turn speed of theboom 8 and the swing speed of theupper swing body 7 with the following formula. Thecontrol device 40 converts the turn speed of theboom 8 in the following formula into the speed of theboom cylinder 11. Then, thecontrol device 40 determines whether the converted speed of theboom cylinder 11 is larger than the preliminarily stored maximum value of the speed of theboom cylinder 11 or not.
[Math. 6] - In a case where the converted speed of the
boom cylinder 11 is larger than the maximum value of the speed, this is the case where the turn angle θbm falls below the correlation map A even when the raising operation of theboom 8 is performed on condition that the turn speed of theboom 8 is controlled to be the maximum turn speed in the current swing speed. That is, in the case where the converted speed of theboom cylinder 11 is larger than the maximum value of the speed, this is the case where the position of thefront work device 2 in the height direction falls below the lower limit value of the allowable range even when the raising operation of theboom 8 is performed on condition that the turn speed of theboom 8 is controlled to be the maximum turn speed in the current swing speed. In this case, thecontrol device 40 advances the process to Step S302. On the other hand, in a case where the converted speed of theboom cylinder 11 is equal to or less than the maximum value of the speed, this is the case where the turn angle θbm does not fall below the correlation map A when the raising operation of theboom 8 is performed on condition that the turn speed of theboom 8 is controlled to be the maximum turn speed in the current swing speed. That is, in the case where the converted speed of theboom cylinder 11 is equal to or less than the maximum value of the speed, this is the case where the position of thefront work device 2 in the height direction does not fall below the lower limit value of the allowable range when the raising operation of theboom 8 is performed on condition that the turn speed of theboom 8 is controlled to be the maximum turn speed in the current swing speed. In this case, thecontrol device 40 advances the process to Step S108. - In Step S302, the
control device 40 calculates the swing speed that satisfies the relation of Formula (6) from the maximum value of the speed of theboom cylinder 11. Thecontrol device 40 automatically decelerates the swing operation of theupper swing body 7 such that theupper swing body 7 swings at the calculated swing speed. That is, theoperation control section 48 of thecontrol device 40 controls the swing speed of theupper swing body 7 such that the position of thefront work device 2 in the height direction exceeds the lower limit value of the allowable range when the raising operation of theboom 8 is performed at least at the maximum turn speed. - In Step S303, the
control device 40 automatically executes the raising operation of theboom 8 at the turn speed corresponding to the decelerated swing speed. Then, thecontrol device 40 terminates the process. - In Step S106 to Step S109 shown in
Fig. 11 , thecontrol device 40 executes the processes similar to Step S106 to Step S109 ofEmbodiment 1 shown inFig. 7 orEmbodiment 2 shown inFig. 10 . - Thus, the
operation control section 48 ofEmbodiment 3 controls the swing speed of theupper swing body 7 such that the position of thefront work device 2 in the height direction exceeds the lower limit value when the position of thefront work device 2 in the height direction that moves in accordance with the operation instruction of the operator falls below the lower limit value of the allowable range and when the position of thefront work device 2 in the height direction falls below the lower limit value of the allowable range even on condition that the turn speed of theboom 8 is controlled to be the maximum turn speed. - As a result, the
work machine 1 ofEmbodiment 3 ensures keeping the position of thefront work device 2 in the height direction within the allowable range even when the position of thefront work device 2 in the height direction is about to fall below the lower limit value of the allowable range due to the excessive swing operation amount of theupper swing body 7 by the operator. Accordingly, thework machine 1 ofEmbodiment 3 ensures suppressing the interference with the loaded machine and the damage on the loaded machine, and can assist the loading work without giving uncomfortable feeling to the operator. - A description will be given of a
work machine 1 of Embodiment 4 usingFig. 12 . In thework machine 1 of Embodiment 4, explanations for configurations and operations similar to those ofEmbodiment 1 toEmbodiment 3 will be omitted. -
Fig. 12 is a diagram schematically illustrating a screen displayed on thedisplay device 55 of Embodiment 4. - The
display device 55 of Embodiment 4 not only displays the information indicating the control intervention for assisting the loading work but also can display the correlation map A and the correlation map B as shown inFig. 12 . In this respect, thedisplay device 55 can display an icon C superimposed on the correlation map A and the correlation map B. The icon C indicates the current position of thefront work device 2 in the height direction and the swing speed of theupper swing body 7. InFig. 12 , an example in which the icon C indicating the turn angle θbm of theboom 8 and the swing angle θsw corresponding to the current position of thefront work device 2 in the height direction is superimposed on the correlation map A and the correlation map B is illustrated. - As a result, the
work machine 1 of Embodiment 4 not only notifies the operator of the information indicating that the control intervention for assisting the loading work is to be executed but also visualizes the specific content of the control intervention for allowing the operator to intuitively obtain it. Accordingly, thework machine 1 of Embodiment 4 allows suppressing the interference with the loaded machine and the damage on the loaded machine, and can assist the loading work without giving uncomfortable feeling to the operator, furthermore. - The present invention is not limited to the above-described embodiments, and includes various modifications. For example, the above-described embodiments are described in detail for ease of understanding of the present invention, and does not necessarily include all of the described configurations. A part of the configuration of one embodiment can be replaced by the configuration of another embodiment. The configuration of another embodiment can be added to the configuration of one embodiment. Addition, deletion, or replacement of another configuration can be performed on a part of the configuration in each of the embodiments.
- The above-described respective configurations, functions, processing units, processing means, or the like may be achieved by hardware, for example, a part of or all of which are designed with, for example, an integrated circuit. For example, the above-described respective configurations and functions may be achieved by software with which a processor interprets and executes programs achieving the respective functions. The program that achieves each function, tape, and information, such as files, can be placed in a memory, a storage unit, such as a hard disk and a Solid State Drive (SSD), or a storing medium, such as an IC card, an SD card, and a DVD.
- Furthermore, control lines and information lines considered necessary for the description are described. Not all the control lines and the information lines on the product are necessarily described. Actually almost all configurations may be considered to be mutually coupled.
-
- 1
- Work machine
- 2
- Front work device (work device)
- 5
- Lower traveling body
- 7
- Upper swing body
- 8
- Boom
- 9
- Arm
- 10
- Bucket
- 40
- Control device
- 45
- Operation determining section
- 46
- Allowable range calculation section
- 48
- Operation control section
- 52
- Operation detecting device
- 53
- Posture detecting device
- 54
- Object detecting device
- 55
- Display device
- 56
- Target object information acquisition device
Claims (6)
- A work machine for loading a target object onto a loaded machine by performing a convey operation and a dump operation, the convey operation conveying the target object toward the loaded machine, the dump operation dumping the target object conveyed by the convey operation onto the loaded machine, the work machine comprising:an upper swing body that swings with respect to a lower traveling body;a working device mounted on the upper swing body and including a boom, an arm, and a bucket;a posture detecting device that detects a turn angle of the working device and a swing angle of the upper swing body;an object detecting device that detects a position of the loaded machine; anda control device that controls operations of the working device and the upper swing body,wherein the control device includes:an allowable range calculation section that calculates an allowable range indicating a range in which the working device is movable in a height direction allowed in the swing operation of the upper swing body based on a detection result of the object detecting device;an operation determining section that determines whether the work machine is under the convey operation or not based on a detection result of the posture detecting device and a detection result of the object detecting device;an operation control section that controls a turn operation of the boom such that the position of the working device in the height direction remains within the allowable range when the work machine is determined to be under the convey operation,wherein the allowable range calculation section calculates a range of the turn angle of the boom defined by a lower limit value and an upper limit value as the allowable range, the lower limit value of the position in the height direction allowing the working device to avoid interference with the loaded machine under the convey operation, the upper limit value of the position in the height direction obtained based on at least one of a dimension of the bucket, a capacity of the bucket, a type of the target object, or a specific gravity of the target object.
- The work machine according to claim 1, further comprisingan operation detecting device that detects an operation instruction by an operator to the working device,wherein the operation control section invalidates the operation instruction when the position of the working device in the height direction that moves in accordance with the operation instruction falls below the lower limit value or exceeds the upper limit value, and controls the turn speed of the boom such that the position of the working device in the height direction remains within the allowable range.
- The work machine according to claim 2, wherein
the operation control section controls a swing speed of the upper swing body such that the position of the working device in the height direction exceeds the lower limit value when the position of the working device in the height direction that moves in accordance with the operation instruction falls below the lower limit value and the position of the working device in the height direction falls below the lower limit value even when the operation control section controls the turn speed of the boom to a maximum turn speed. - The work machine according to claim 2, wherein
the allowable range calculation section updates the allowable range using the position of the working device in the height direction when the operation instruction becomes undetectable newly as the lower limit value in a case where the operation instruction becomes undetectable while the working device moves in accordance with the operation instruction within the allowable range. - The work machine according to claim 1, further comprisinga target object information acquisition device that obtains information on the target object held in the bucket,wherein the operation determining section determines whether the bucket holds the target object based on a result obtained by the target object information acquisition device and determines whether the work machine is under the convey operation based on the determination result.
- The work machine according to claim 1, further comprisinga display device that displays a correlation map indicating a relation between the swing angle of the upper swing body and the lower limit value and a relation between the swing angle of the upper swing body and the upper limit value,wherein the display device displays an icon indicating a current position of the working device in the height direction and a current swing angle of the upper swing body with the correlation map superimposed.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021032298 | 2021-03-02 | ||
PCT/JP2022/008656 WO2022186215A1 (en) | 2021-03-02 | 2022-03-01 | Work machine |
Publications (1)
Publication Number | Publication Date |
---|---|
EP4303369A1 true EP4303369A1 (en) | 2024-01-10 |
Family
ID=83154464
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
EP22763269.2A Pending EP4303369A1 (en) | 2021-03-02 | 2022-03-01 | Work machine |
Country Status (6)
Country | Link |
---|---|
US (1) | US20230358014A1 (en) |
EP (1) | EP4303369A1 (en) |
JP (1) | JP7360568B2 (en) |
KR (1) | KR20230132563A (en) |
CN (1) | CN115997061A (en) |
WO (1) | WO2022186215A1 (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20230033461A (en) * | 2021-09-01 | 2023-03-08 | 볼보 컨스트럭션 이큅먼트 에이비 | Construction equipment |
CN117449371B (en) * | 2023-12-25 | 2024-03-19 | 山西太重数智科技股份有限公司 | Intelligent electric shovel attitude adjusting control system and method |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6345080B2 (en) * | 2014-10-30 | 2018-06-20 | 日立建機株式会社 | Work machine turning support device |
JP7216472B2 (en) | 2017-10-04 | 2023-02-01 | 株式会社小松製作所 | Working system and control method |
JP7383599B2 (en) | 2018-03-26 | 2023-11-20 | 住友建機株式会社 | excavator |
JP7046031B2 (en) * | 2019-04-04 | 2022-04-01 | 日立建機株式会社 | Hydraulic excavator |
-
2022
- 2022-03-01 KR KR1020237028136A patent/KR20230132563A/en unknown
- 2022-03-01 WO PCT/JP2022/008656 patent/WO2022186215A1/en active Application Filing
- 2022-03-01 US US18/023,465 patent/US20230358014A1/en active Pending
- 2022-03-01 CN CN202280005769.5A patent/CN115997061A/en active Pending
- 2022-03-01 JP JP2023503871A patent/JP7360568B2/en active Active
- 2022-03-01 EP EP22763269.2A patent/EP4303369A1/en active Pending
Also Published As
Publication number | Publication date |
---|---|
US20230358014A1 (en) | 2023-11-09 |
JPWO2022186215A1 (en) | 2022-09-09 |
JP7360568B2 (en) | 2023-10-12 |
WO2022186215A1 (en) | 2022-09-09 |
KR20230132563A (en) | 2023-09-15 |
CN115997061A (en) | 2023-04-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108055855B (en) | Working machine | |
CN108699799B (en) | Working machine | |
CN109101032B (en) | System and method for controlling machine pose using sensor fusion | |
EP4303369A1 (en) | Work machine | |
CN110392756B (en) | Working machine | |
US20180372498A1 (en) | System and method for determining machine state using sensor fusion | |
CN108779614B (en) | Working machine | |
US20210164192A1 (en) | Loading machine control device and control method | |
KR102402518B1 (en) | working machine | |
CN107306500B (en) | Control device for work machine, and control method for work machine | |
CN111032969B (en) | Working machine | |
CN111032962B (en) | Construction machine | |
KR20190034648A (en) | Working machine | |
US11585071B2 (en) | Hystat swing motion actuation, monitoring, and control system | |
CN113924397B (en) | Working machine | |
CN113423894B (en) | Working machine | |
US20210324605A1 (en) | Blade control device for work machinery | |
US20230392346A1 (en) | System for mitigation of unintentional working machine movement | |
WO2024004984A1 (en) | Work machine | |
JP7268577B2 (en) | working machine | |
EP4019704A1 (en) | Penetration monitoring control system and work machine | |
EP4386146A1 (en) | Trajectory-generating system and work machine comprising same | |
CN117916429A (en) | Work machine | |
JP2023066442A (en) | Construction machine | |
CN116234960A (en) | Excavation position determination system, excavation control system, and construction machine |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE INTERNATIONAL PUBLICATION HAS BEEN MADE |
|
PUAI | Public reference made under article 153(3) epc to a published international application that has entered the european phase |
Free format text: ORIGINAL CODE: 0009012 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: REQUEST FOR EXAMINATION WAS MADE |
|
17P | Request for examination filed |
Effective date: 20230324 |
|
AK | Designated contracting states |
Kind code of ref document: A1 Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC MK MT NL NO PL PT RO RS SE SI SK SM TR |
|
DAV | Request for validation of the european patent (deleted) | ||
DAX | Request for extension of the european patent (deleted) |