WO2015181989A1 - 作業機械の制御システム、作業機械及び作業機械の制御方法 - Google Patents

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

Info

Publication number
WO2015181989A1
WO2015181989A1 PCT/JP2014/064543 JP2014064543W WO2015181989A1 WO 2015181989 A1 WO2015181989 A1 WO 2015181989A1 JP 2014064543 W JP2014064543 W JP 2014064543W WO 2015181989 A1 WO2015181989 A1 WO 2015181989A1
Authority
WO
WIPO (PCT)
Prior art keywords
target
work machine
excavation
bucket
boom
Prior art date
Application number
PCT/JP2014/064543
Other languages
English (en)
French (fr)
Inventor
義樹 上
健 ▲高▼浦
Original Assignee
株式会社小松製作所
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 株式会社小松製作所 filed Critical 株式会社小松製作所
Priority to CN201480000998.3A priority Critical patent/CN105408554B/zh
Priority to US14/386,094 priority patent/US9540793B2/en
Priority to KR1020157031858A priority patent/KR101751164B1/ko
Priority to PCT/JP2014/064543 priority patent/WO2015181989A1/ja
Priority to DE112014000074.4T priority patent/DE112014000074B4/de
Priority to JP2014528347A priority patent/JP5823044B1/ja
Publication of WO2015181989A1 publication Critical patent/WO2015181989A1/ja

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/264Sensors and their calibration for indicating the position of the work tool
    • E02F9/265Sensors and their calibration for indicating the position of the work tool with follow-up actions (e.g. control signals sent to actuate the work tool)
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • E02F3/439Automatic repositioning of the implement, e.g. automatic dumping, auto-return
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2025Particular purposes of control systems not otherwise provided for
    • E02F9/2033Limiting the movement of frames or implements, e.g. to avoid collision between implements and the cabin
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2203Arrangements for controlling the attitude of actuators, e.g. speed, floating function
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2278Hydraulic circuits
    • E02F9/2292Systems with two or more pumps
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2278Hydraulic circuits
    • E02F9/2296Systems with a variable displacement pump
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/261Surveying the work-site to be treated
    • E02F9/262Surveying the work-site to be treated with follow-up actions to control the work tool, e.g. controller
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C15/00Surveying instruments or accessories not provided for in groups G01C1/00 - G01C13/00
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/30Dredgers; 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/32Dredgers; 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

Definitions

  • the present invention relates to a work machine control system including a work machine, a work machine, and a work machine control method.
  • Patent Document 1 a control for moving the bucket along the target terrain to be excavated so as not to erode the target terrain.
  • the present invention aims to operate a work machine as intended by an operator.
  • the present invention is a control system for controlling a work machine including a work machine having a work tool, based on a position detection unit that detects position information of the work machine, and the position information detected by the position detection unit. At least one target construction surface that obtains the position of the work machine and indicates a target shape, and a first cut surface that intersects a work machine operation plane that is a plane on which the work machine operates and is parallel to the vertical direction. Based on the first target excavation landform information acquired from the generation unit that generates the first target excavation landform information that is information of the intersecting portion, the speed in the direction in which the work implement approaches the excavation target is A work machine control system including a work machine control unit that executes excavation control for controlling the speed to be less than a speed limit.
  • the generation unit generates second target excavation landform information that is information on a portion where at least one target construction surface and the work machine operation plane or a second cutout plane parallel to the work machine operation plane intersects.
  • the work implement control unit preferably executes the excavation control based on the first target excavation landform information and the second target excavation landform information acquired from the setting unit.
  • the present invention is a control system for controlling a work machine including a work machine having a work tool, based on a position detection unit that detects position information of the work machine, and the position information detected by the position detection unit.
  • a first cut surface that obtains a position of the work machine and intersects a work machine operation plane that is a plane on which the work machine operates and is parallel to a vertical direction; a first target construction surface that indicates a target shape; and
  • a generation unit that generates first target excavation landform information that is information of a portion where a second target construction surface that is continuous to the side of the first target construction surface intersects, and the first target excavation acquired from the generation unit
  • a work machine control system comprising: a work machine control unit that executes excavation control for controlling a speed in a direction in which the work machine approaches the excavation target to be equal to or lower than a speed limit based on terrain information.
  • the generation unit generates second target excavation landform information that is information of a portion where the first target construction surface and the work machine operation plane or a second cut-out surface parallel to the work machine operation plane intersects.
  • the work implement control unit preferably executes the excavation control based on the first target excavation landform information and the second target excavation landform information acquired from the setting unit.
  • the work implement control unit executes the excavation control based on the second target excavation landform information, and stops the excavation control being executed based on the first target excavation landform information, or the excavation control being stopped It is preferable to resume.
  • the work implement controller may stop the excavation control when an angle of the first target excavation landform information immediately below the work implement with respect to a horizontal plane of the work machine is equal to or larger than a predetermined size. preferable.
  • the work implement control unit executes the excavation control based on a minimum distance between a cutting edge of the work tool and the first target excavation landform information.
  • the work implement control unit executes the excavation control on a target construction surface corresponding to the first target excavation landform information based on a distance between a cutting edge of the work tool and the first target excavation landform information. It is preferable to determine whether or not.
  • the work machine includes a swing body that is attached to the work machine and rotates around a predetermined axis, and the work machine control unit is configured to perform the excavation when the work machine is rotating together with the swing body. It is preferable to execute the control.
  • the work machine control unit performs the excavation control based on a speed obtained by combining a target speed in a direction in which the work machine turns and a target speed in the front-rear direction of the work tool.
  • the work machine includes a detection device that detects an angular velocity and an acceleration, and the position of the work machine is predicted using a turning speed of the work machine detected by the detection device.
  • the present invention is a work machine including the above-described work machine control system.
  • the present invention is a control method for controlling a work machine including a work machine having a work tool, wherein the position of the work machine is detected, the position of the work machine is obtained based on the detected position information, and a target 1st target which is the information of the part which the at least 1 target construction surface which shows a shape, and the 1st cut surface which cross
  • the second target excavation landform which is the first target excavation landform information and information on a portion where at least one target construction plane and the work machine operation plane or a second cutout plane parallel to the work machine operation plane intersect. It is preferable to control based on the information so that the speed in the direction in which the working machine approaches the excavation target is equal to or less than the speed limit.
  • the first target excavation is performed based on the distance between the cutting edge of the working tool and the first target excavation landform information when controlling the speed in the direction in which the work machine approaches the excavation target to be equal to or less than the speed limit. It is preferable to determine whether or not to execute the excavation control on the target construction surface corresponding to the terrain information.
  • the excavation control is executed when the working machine is turning together with the turning body provided in the working machine.
  • the present invention can operate the work machine as intended by the operator.
  • FIG. 1 is a perspective view of a work machine according to the first embodiment.
  • FIG. 2 is a block diagram showing the configuration of the drive system and control system of the hydraulic excavator.
  • FIG. 3A is a side view of the excavator.
  • FIG. 3B is a rear view of the excavator.
  • FIG. 4 is a schematic diagram illustrating an example of target construction information.
  • FIG. 5 is a block diagram illustrating the work machine controller and the display controller.
  • FIG. 6 is a diagram illustrating an example of the target excavation landform displayed on the display unit.
  • FIG. 7 is a schematic diagram showing the relationship among the target speed, the vertical speed component, and the horizontal speed component.
  • FIG. 8 is a diagram illustrating a method for calculating the vertical velocity component and the horizontal velocity component.
  • FIG. 1 is a perspective view of a work machine according to the first embodiment.
  • FIG. 2 is a block diagram showing the configuration of the drive system and control system of the hydraulic excavator.
  • FIG. 9 is a diagram illustrating a method for calculating the vertical velocity component and the horizontal velocity component.
  • FIG. 10 is a schematic diagram showing the distance between the cutting edge and the target excavation landform.
  • FIG. 11 is a graph showing an example of speed limit information.
  • FIG. 12 is a schematic diagram illustrating a method of calculating the vertical speed component of the boom speed limit.
  • FIG. 13 is a schematic diagram showing the relationship between the vertical speed component of the boom speed limit and the boom speed limit.
  • FIG. 14 is a diagram illustrating an example of a change in the speed limit of the boom due to the movement of the blade edge.
  • FIG. 15 is a diagram illustrating a detailed structure of a hydraulic system 300 included in the excavator 100.
  • FIG. 16 is a diagram illustrating a relationship between a bucket and a groove when excavating the groove.
  • FIG. 17 is a diagram illustrating a relationship between buckets and grooves when excavating the grooves.
  • FIG. 18 is a diagram illustrating a relationship between buckets and grooves when excavating the grooves.
  • FIG. 19A is a diagram illustrating a relationship between a bucket and a groove when excavating the groove.
  • FIG. 19B is a diagram illustrating a relationship between a bucket and a groove when excavating the groove.
  • FIG. 20 is a diagram for explaining a position where the longitudinal target excavation landform data is cut out from the target excavation landform.
  • FIG. 21 is a diagram for explaining a plane in which the longitudinal target excavation landform data is cut out from the target excavation landform.
  • FIG. 22 is a diagram for explaining a plane for cutting out the width direction target excavation landform data.
  • FIG. 23 is a diagram for explaining a plane for cutting out the width direction target excavation landform data.
  • FIG. 24 is a diagram illustrating a relationship between a target excavation landform and a excavator bucket when excavating a groove.
  • FIG. 25 is a flowchart illustrating a control example when excavating a groove.
  • FIG. 26 is a diagram illustrating a state in which the bucket of the excavator faces the groove wall when excavating the groove.
  • FIG. 27 is a diagram illustrating a state in which the bucket is viewed from the rear of the hydraulic excavator.
  • FIG. 28 is a diagram for explaining a speed component when the bucket approaches the groove wall.
  • FIG. 29 is a diagram illustrating the distance between the blade edge of the bucket and the groove wall.
  • FIG. 30 is a diagram for explaining the boom speed limit.
  • FIG. 31 is a flowchart illustrating a processing example of excavation control in the width direction.
  • FIG. 32 is a flowchart showing excavation control processing based on a speed obtained by combining the turning target speed and the target speed in the front-rear direction.
  • FIG. 33 is an explanatory diagram of a method for obtaining the target speed in the front-rear direction.
  • FIG. 34 is a diagram illustrating a method for obtaining a speed obtained by combining the turning target speed and the target speed in the front-rear direction.
  • FIG. 35 is a diagram for explaining a speed component when the bucket approaches the target excavation landform corresponding to the side wall.
  • FIG. 36 is a diagram for explaining the boom limit speed.
  • FIG. 37 is a block diagram illustrating a display controller and a work machine controller and a sensor controller according to a modification.
  • FIG. 38A is a diagram illustrating a posture of the excavator.
  • FIG. 38B is a diagram illustrating the posture of the hydraulic excavator.
  • FIG. 39 is a flowchart for explaining a process in which the prediction correction unit updates the corrected turning body orientation data.
  • FIG. 40 is a diagram for explaining processing of the prediction correction unit that is executed in accordance with the operation of the upper-part turning body.
  • FIG. 1 is a perspective view of a work machine according to the first embodiment.
  • FIG. 2 is a block diagram showing the configuration of the hydraulic system 300 and the control system 200 of the excavator 100.
  • a hydraulic excavator 100 as a work machine has a vehicle main body 1 and a work implement 2 as main bodies.
  • the vehicle body 1 includes an upper swing body 3 as a swing body and a travel device 5 as a travel body.
  • the upper swing body 3 accommodates devices such as an engine and a hydraulic pump as a power generation device inside the engine room 3EG.
  • the engine room 3EG is disposed on one end side of the upper swing body 3.
  • the excavator 100 uses an internal combustion engine such as a diesel engine as an engine as a power generation device, but the power generation device is not limited to this.
  • the power generation device of the hydraulic excavator 100 may be, for example, a so-called hybrid device in which an internal combustion engine, a generator motor, and a power storage device are combined. Further, the power generation device of the hydraulic excavator 100 does not have an internal combustion engine, and may be a combination of a power storage device and a generator motor.
  • the upper swing body 3 has a cab 4.
  • the cab 4 is installed on the other end side of the upper swing body 3. That is, the cab 4 is installed on the side opposite to the side where the engine room 3EG is arranged.
  • a display unit 29 and an operation device 25 shown in FIG. 2 are arranged. These will be described later.
  • a handrail 9 is attached above the upper swing body 3.
  • the traveling device 5 carries the upper swing body 3.
  • the traveling device 5 has crawler belts 5a and 5b.
  • the traveling device 5 causes the excavator 100 to travel by driving one or both of the traveling motors 5c provided on the left and right sides and rotating the crawler belts 5a and 5b.
  • the work machine 2 is attached to the side of the cab 4 of the upper swing body 3.
  • the hydraulic excavator 100 may include a tire instead of the crawler belts 5a and 5b, and a traveling device that can travel by transmitting the driving force of the engine to the tire via the transmission.
  • An example of the hydraulic excavator 100 having such a configuration is a wheel-type hydraulic excavator.
  • the hydraulic excavator 100 includes a traveling device having such a tire, and further, a working machine is attached to the vehicle main body (main body portion), and includes an upper swing body 3 and a swing mechanism thereof as shown in FIG.
  • a backhoe loader may be used. That is, the backhoe loader is provided with a traveling device having a work machine attached to the vehicle body and constituting a part of the vehicle body.
  • the upper revolving unit 3 is on the front side where the work implement 2 and the cab 4 are arranged, and is on the rear side where the engine room 3EG is arranged (x direction).
  • the left side toward the front is the left of the upper swing body 3, and the right side toward the front is the right of the upper swing body 3.
  • the left-right direction of the upper swing body 3 is also referred to as the width direction (y direction).
  • the excavator 100 or the vehicle main body 1 has the traveling device 5 side on the lower side with respect to the upper swing body 3 and the upper swing body 3 side on the basis of the traveling device 5 (z direction).
  • the lower side is the vertical direction, that is, the gravity direction side
  • the upper side is the opposite side of the vertical direction.
  • the work machine 2 includes a boom 6, an arm 7, a bucket 8 as a work tool, a boom cylinder 10, an arm cylinder 11, and a bucket cylinder 12.
  • a base end portion of the boom 6 is rotatably attached to a front portion of the vehicle main body 1 via a boom pin 13.
  • a base end portion of the arm 7 is rotatably attached to a tip end portion of the boom 6 via an arm pin 14.
  • a bucket 8 is attached to the tip of the arm 7 via a bucket pin 15.
  • the bucket 8 rotates around the bucket pin 15.
  • the bucket 8 has a plurality of blades 8 ⁇ / b> B attached to the side opposite to the bucket pin 15.
  • the blade tip 8T is the tip of the blade 8B.
  • the bucket 8 may not have a plurality of blades 8B. That is, it may be a bucket that does not have the blade 8B as shown in FIG. 1 and whose blade edge is formed in a straight shape by a steel plate.
  • the work machine 2 may include, for example, a tilt bucket having a single blade.
  • a tilt bucket is equipped with a bucket tilt cylinder. By tilting the bucket to the left and right, even if the excavator is on a sloping ground, it is possible to form and level the slope and flat ground freely.
  • the bucket can also be pressed.
  • the work machine 2 may include a rock drilling attachment or the like with a slope bucket or a rock drilling tip instead of the bucket 8.
  • the boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12 shown in FIG. 1 are hydraulic cylinders that are driven by the pressure of hydraulic oil (hereinafter referred to as hydraulic pressure as appropriate).
  • the boom cylinder 10 drives the boom 6 to raise and lower it.
  • the arm cylinder 11 drives the arm 7 to rotate around the arm pin 14.
  • the bucket cylinder 12 drives the bucket 8 to rotate around the bucket pin 15.
  • the direction control valve 64 controls the flow rate of the hydraulic oil supplied from the hydraulic pumps 36 and 37 to the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12, and the like, and switches the direction in which the hydraulic oil flows.
  • the direction control valve 64 is for a working machine for controlling a traveling direction control valve for driving the traveling motor 5c and a swing motor for swinging the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12 and the upper swing body 3.
  • the work machine controller 26 shown in FIG. 2 controls the control valve 27 shown in FIG. 2 to control the pilot pressure of the hydraulic oil supplied from the operating device 25 to the direction control valve 64.
  • the flow rate of the hydraulic oil supplied from the valve 64 to the boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12 is controlled.
  • the work machine controller 26 can control the operations of the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12, and the like.
  • the antennas 21 and 22 are attached to the upper part of the upper swing body 3.
  • the antennas 21 and 22 are used to detect the current position of the excavator 100.
  • the antennas 21 and 22 are electrically connected to a position detection device 19 as a position detection unit for detecting the current position of the excavator 100 shown in FIG.
  • the position detection device 19 detects the current position of the excavator 100 using RTK-GNSS (Real Time Kinematic-Global Navigation Satellite Systems, GNSS is a global navigation satellite system).
  • GNSS Real Time Kinematic-Global Navigation Satellite Systems
  • the antennas 21 and 22 are appropriately referred to as GNSS antennas 21 and 22, respectively.
  • a signal corresponding to the GNSS radio wave received by the GNSS antennas 21 and 22 is input to the position detection device 19.
  • the position detection device 19 detects the installation positions of the GNSS antennas 21 and 22.
  • the position detection device 19 includes, for example, a three-dimensional position sensor.
  • the GNSS antennas 21 and 22 are preferably installed at both end positions on the upper swing body 3 and separated in the left-right direction of the excavator 100.
  • the GNS antennas 21 and 22 are attached to the handrails 9 attached to both sides in the width direction of the upper swing body 3.
  • the position at which the GNS antennas 21 and 22 are attached to the upper swing body 3 is not limited to the handrail 9.
  • the GNS antennas 21 and 22 should be installed as far as possible from the excavator 100. This is preferable because the detection accuracy of the current position is improved.
  • the GNSS antennas 21 and 22 are preferably installed at positions that do not hinder the visual field of the operator as much as possible.
  • the hydraulic system 300 of the excavator 100 includes an engine 35 and hydraulic pumps 36 and 37 as power generation sources.
  • the hydraulic pumps 36 and 37 are driven by the engine 35 and discharge hydraulic oil.
  • the hydraulic oil discharged from the hydraulic pumps 36 and 37 is supplied to the boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12.
  • the excavator 100 includes a turning motor 38.
  • the turning motor 38 is a hydraulic motor, and is driven by hydraulic oil discharged from the hydraulic pumps 36 and 37.
  • the turning motor 38 turns the upper turning body 3.
  • two hydraulic pumps 36 and 37 are shown, but only one hydraulic pump may be provided.
  • the turning motor 38 is not limited to a hydraulic motor, and may be an electric motor.
  • a control system 200 as a work machine control system includes a position detection device 19, a global coordinate calculation unit 23, an IMU (Inertial Measurement Unit) 24 as a detection device for detecting angular velocity and acceleration, and an operation device. 25, a work machine controller 26 as a work machine control unit, a sensor controller 39, a display controller 28 as a generation unit, and a display unit 29.
  • the operating device 25 is a device for operating the work machine 2 shown in FIG.
  • the operation device 25 receives an operation by an operator for driving the work machine 2 and outputs hydraulic oil corresponding to the operation amount.
  • the operating device 25 has a left operating lever 25L installed on the left side of the operator and a right operating lever 25R arranged on the right side of the operator.
  • the front-rear and left-right operations correspond to the biaxial operations.
  • the operation in the front-rear direction of the right operation lever 25R corresponds to the operation of the boom 6.
  • the operation of lowering the boom 6 is executed according to the operation in the front-rear direction.
  • the left / right operation of the right operation lever 25R corresponds to the operation of the bucket 8.
  • the raising operation of the boom 6 corresponds to a dumping operation.
  • the lowering operation of the boom 6 corresponds to an excavation operation.
  • the excavation operation of the arm 7 corresponds to a lowering operation.
  • the dumping operation of the arm 7 corresponds to a raising operation.
  • the excavation operation of the bucket 8 corresponds to a lowering operation.
  • the dumping operation of the bucket 8 corresponds to a raising operation.
  • the lowering operation of the arm 7 may be referred to as a bending operation.
  • the raising operation of the arm 7 may be referred to as an extension operation.
  • the operating device 25 uses a pilot hydraulic system.
  • the operating device 25 is supplied from the hydraulic pump 36 with hydraulic oil that has been reduced to a predetermined pilot pressure by a pressure reducing valve (not shown) based on a boom operation, a bucket operation, an arm operation, and a turning operation.
  • the pilot hydraulic pressure can be supplied to the pilot oil passage 450 according to the operation in the front-rear direction of the right operation lever 25R, and the operation of the boom 6 by the operator is accepted.
  • a valve device included in the right operation lever 25R is opened according to the operation amount of the right operation lever 25R, and hydraulic oil is supplied to the pilot oil passage 450.
  • the pressure sensor 66 detects the pressure of the hydraulic oil in the pilot oil passage 450 at that time as the pilot pressure.
  • the pressure sensor 66 transmits the detected pilot pressure to the work machine controller 26 as a boom operation amount MB.
  • the operation amount in the front-rear direction of the right operation lever 25R is appropriately referred to as a boom operation amount MB.
  • a pilot oil passage 50 between the operating device 25 and the boom cylinder 10 is provided with a pressure sensor 68, a control valve (hereinafter referred to as an intervention valve as appropriate) 27C, and a shuttle valve 51.
  • the intervention valve 27C and the shuttle valve 51 will be described later.
  • the pilot hydraulic pressure can be supplied to the pilot oil passage 450 in accordance with the left / right operation of the right operation lever 25R, and the operation of the bucket 8 by the operator is accepted.
  • the valve device included in the right operation lever 25R is opened according to the operation amount of the right operation lever 25R, and hydraulic oil is supplied to the pilot oil passage 450.
  • the pressure sensor 66 detects the pressure of the hydraulic oil in the pilot oil passage 450 at that time as the pilot pressure.
  • the pressure sensor 66 transmits the detected pilot pressure to the work machine controller 26 as a bucket operation amount MT.
  • the operation amount in the left-right direction of the right operation lever 25R will be appropriately referred to as a bucket operation amount MT.
  • the pilot hydraulic pressure can be supplied to the pilot oil passage 450 according to the operation in the front-rear direction of the left operation lever 25L, and the operation of the arm 7 by the operator is accepted.
  • the valve device included in the left operation lever 25L is opened according to the operation amount of the left operation lever 25L, and hydraulic oil is supplied to the pilot oil passage 450.
  • the pressure sensor 66 detects the pressure of the hydraulic oil in the pilot oil passage 450 at that time as the pilot pressure.
  • the pressure gauge 66 transmits the detected pilot pressure as the arm operation amount MA to the work machine controller 26.
  • the operation amount in the left-right direction of the left operation lever 25L is appropriately referred to as an arm operation amount MA.
  • the pilot hydraulic pressure can be supplied to the pilot oil passage 450 according to the left / right operation of the left operation lever 25L, and the turning operation of the upper swing body 3 by the operator is accepted.
  • the valve device included in the left operation lever 25L is opened according to the operation amount of the left operation lever 25L, and hydraulic oil is supplied to the pilot oil passage 450.
  • the pressure sensor 66 detects the pressure of the hydraulic oil in the pilot oil passage 450 at that time as the pilot pressure.
  • the pressure sensor 66 transmits the detected pilot pressure to the work machine controller 26 as the turning operation amount MR.
  • the operation amount in the front-rear direction of the left operation lever 25L is appropriately referred to as a turning operation amount MR.
  • the operation device 25 supplies the directional control valve 64 with pilot hydraulic pressure having a magnitude corresponding to the operation amount of the right operation lever 25R.
  • the operating device 25 supplies the control valve 27 with pilot hydraulic pressure having a magnitude corresponding to the operating amount of the left operating lever 25L.
  • the spool of the direction control valve 64 is operated by this pilot oil pressure.
  • the pilot oil passage 450 is provided with a control valve 27.
  • the operation amount of the right operation lever 25R and the left operation lever 25L is detected by a pressure sensor 66 installed in the pilot oil passage 450.
  • the pilot hydraulic pressure detected by the pressure sensor 66 is input to the work machine controller 26.
  • the work machine controller 26 opens and closes the pilot oil passage 450 by outputting a control signal N of the pilot oil passage 450 to the control valve 27 according to the input pilot oil pressure.
  • the operation amounts of the left operation lever 25L and the right operation lever 25R are detected by, for example, a potentiometer and a Hall IC, and the work machine controller 26 controls the direction control valve 64 and the control valve 27 based on these detection values.
  • the work machine 2 may be controlled.
  • the left operation lever 25L and the right operation lever 25R may be of an electric system.
  • the turning operation and the arm operation may be interchanged. In this case, the extension or bending operation of the arm 7 is executed according to the left / right operation of the left operation lever 25L, and the left / right turning operation of the upper swing body 3 is executed according to the operation of the left operation lever 25L in the front / rear direction.
  • the control system 200 includes a first stroke sensor 16, a second stroke sensor 17, and a third stroke sensor 18.
  • the first stroke sensor 16 is provided in the boom cylinder 10
  • the second stroke sensor 17 is provided in the arm cylinder 11
  • the third stroke sensor 18 is provided in the bucket cylinder 12.
  • the first stroke sensor 16 detects the stroke length LS1 of the boom cylinder 10.
  • the first stroke sensor 16 detects the amount of displacement corresponding to the extension of the boom cylinder 10 and outputs it to the sensor controller 39.
  • the sensor controller 39 calculates the cylinder length of the boom cylinder 10 (hereinafter referred to as the boom cylinder length as appropriate) corresponding to the displacement amount of the first stroke sensor 16.
  • the sensor controller 39 detects the boom from the boom cylinder length detected by the first stroke sensor 16 in the direction (z-axis direction) orthogonal to the horizontal coordinate system of the excavator 100, specifically, the horizontal plane in the local coordinate system of the vehicle body 1. 6 is output to the work machine controller 26 and the display controller 28.
  • the second stroke sensor 17 detects the stroke length LS2 of the arm cylinder 11.
  • the second stroke sensor 17 detects the amount of displacement corresponding to the extension of the arm cylinder 11 and outputs it to the sensor controller 39.
  • the sensor controller 39 calculates the cylinder length of the arm cylinder 11 (hereinafter referred to as the arm cylinder length as appropriate) corresponding to the displacement amount of the second stroke sensor 17.
  • the sensor controller 39 calculates the inclination angle ⁇ 2 of the arm 7 with respect to the boom 6 from the arm cylinder length detected by the second stroke sensor 17 and outputs it to the work machine controller 26 and the display controller 28.
  • the third stroke sensor 18 detects the stroke length LS3 of the bucket cylinder 12.
  • the third stroke sensor 18 detects the amount of displacement corresponding to the extension of the bucket cylinder 12 and outputs it to the sensor controller 39.
  • the sensor controller 39 calculates the cylinder length of the bucket cylinder 12 (hereinafter referred to as the bucket cylinder length as appropriate) corresponding to the displacement amount of the third stroke sensor 18.
  • the sensor controller 39 calculates the inclination angle ⁇ 3 of the cutting edge 8T of the bucket 8 of the bucket 8 with respect to the arm 7 from the bucket cylinder length detected by the third stroke sensor 18, and outputs the inclination angle ⁇ 3 to the work machine controller 26 and the display controller 28. .
  • the rotary encoder that is attached to the boom 6 and measures the tilt angle of the boom 6 is measured by the first stroke sensor 16 or the like.
  • the work machine controller 26 includes a storage unit 26M such as a RAM (Random Access Memory) and a ROM (Read Only Memory), and a processing unit 26P such as a CPU (Central Processing Unit).
  • the work machine controller 26 controls the control valve 27 and the intervention valve 27C based on the detection value of the pressure sensor 66 shown in FIG.
  • the direction control valve 64 is disposed between hydraulic actuators such as the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12, and the turning motor 38, and the hydraulic pumps 36 and 37.
  • the direction control valve 64 controls the flow rate of hydraulic oil supplied from the hydraulic pumps 36 and 37 to the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12 and the swing motor 38.
  • the position detection device 19 included in the control system 200 detects the position of the excavator 100.
  • the position detection device 19 includes the GNSS antennas 21 and 22 described above.
  • a signal corresponding to the GNSS radio wave received by the GNSS antennas 21 and 22 is input to the global coordinate calculation unit 23.
  • the GNSS antenna 21 receives reference position data P1 indicating its own position from a positioning satellite.
  • the GNSS antenna 22 receives reference position data P2 indicating its own position from a positioning satellite.
  • the GNSS antennas 21 and 22 receive the reference position data P1 and P2 with a period of 10 Hz, for example.
  • the reference position data P1 and P2 are information on the position where the GNSS antenna is installed. Each time the GNSS antennas 21 and 22 receive the reference position data P ⁇ b> 1 and P ⁇ b> 2, the GNSS antennas 21 and 22 output the global position calculation unit 23.
  • the global coordinate calculation unit 23 acquires two reference position data P1 and P2 (a plurality of reference position data) expressed in the global coordinate system.
  • the global coordinate calculation unit 23 generates revolving body arrangement data indicating the arrangement of the upper revolving body 3 based on the two reference position data P1 and P2.
  • the swing body arrangement data includes one reference position data P of the two reference position data P1 and P2, and swing body orientation data Q generated based on the two reference position data P1 and P2. included.
  • the turning body azimuth data Q is determined based on an angle formed by the azimuth determined from the reference position data P acquired by the GNSS antennas 21 and 22 with respect to the reference azimuth (for example, north) of the global coordinates.
  • the turning body orientation data Q indicates the direction in which the upper turning body 3, that is, the work implement 2 is facing.
  • the global coordinate calculation unit 23 acquires the two reference position data P1 and P2 from the GNSS antennas 21 and 22 at a frequency of 10 Hz, for example, the turning body arrangement data, that is, the reference position data P and the turning body orientation data Q are obtained.
  • the data is updated and output to the work machine controller 26 and the display controller 28.
  • the IMU 24 is attached to the upper swing body 3.
  • the IMU 24 detects operation data indicating the operation of the upper swing body 3.
  • the operation data detected by the IMU 24 is, for example, acceleration and angular velocity.
  • the operation data is a turning angular velocity ⁇ at which the upper turning body 3 turns around the turning axis z of the upper turning body 3 shown in FIG.
  • the turning angular velocity ⁇ is obtained, for example, by differentiating the turning angle of the upper turning body 3 detected by the IMU 24 with respect to time.
  • the turning angle of the upper swing body 3 may be acquired from position information of the GNSS antennas 21 and 22.
  • FIG. 3A is a side view of the excavator 100.
  • FIG. 3B is a rear view of the excavator 100.
  • the IMU 24 detects an inclination angle ⁇ 4 with respect to the left-right direction of the vehicle body 1, an inclination angle ⁇ 5 with respect to the front-rear direction of the vehicle body 1, acceleration, and angular velocity.
  • the IMU 24 updates the turning angular velocity ⁇ , the inclination angle ⁇ 4, and the inclination angle ⁇ 5 at a frequency of 100 Hz, for example.
  • the update cycle in the IMU 24 is preferably shorter than the update cycle in the global coordinate calculation unit 23.
  • the turning angular velocity ⁇ and the inclination angle ⁇ 5 detected by the IMU 24 are output to the sensor controller 39.
  • the sensor controller 39 performs a filter process or the like on the turning angular velocity ⁇ and the inclination angle ⁇ 5 and then outputs them to the work machine controller 26 and the display controller 28.
  • the display controller 28 acquires revolving unit arrangement data (reference position data P and revolving unit orientation data Q) from the global coordinate calculation unit 23.
  • the display controller 28 generates bucket blade tip position data S indicating the three-dimensional position of the blade tip 8T of the bucket 8 as work implement position data.
  • the display controller 28 produces
  • the display controller 28 derives the target excavation landform data Ua for display based on the target excavation landform data U, and causes the display unit 29 to display the target excavation landform 43I based on the display target excavation landform data Ua.
  • the display unit 29 is, for example, a liquid crystal display device or the like, but is not limited thereto.
  • a switch 29 ⁇ / b> S is installed adjacent to the display unit 29.
  • the switch 29S is an input device for selecting whether or not to execute excavation control described later.
  • the work machine controller 26 acquires the turning angular velocity ⁇ indicating the turning angular velocity ⁇ at which the upper turning body 3 turns around the turning axis z shown in FIG. 1 from the sensor controller 39.
  • the work machine controller 26 acquires the boom operation signal MB, the bucket operation signal MT, the arm operation signal MA, and the turning operation signal MR from the pressure sensor 66.
  • the work machine controller 26 acquires the tilt angle ⁇ 1 of the boom 6, the tilt angle ⁇ 2 of the arm 7, and the tilt angle ⁇ 3 of the bucket 8 from the sensor controller 39.
  • the work machine controller 26 acquires the target excavation landform data U from the display controller 28.
  • the work machine controller 26 calculates the position of the blade edge 8T of the bucket 8 (hereinafter, referred to as a blade edge position as appropriate) from the angle of the work machine 2 acquired from the sensor controller 39.
  • the work machine controller 26 uses the boom operation amount MB, the bucket operation amount MT, and the arm operation amount MA input from the operation device 25 so as to move the cutting edge 8T of the bucket 8 along the target excavation landform data U. Adjustment is performed based on the distance and speed between the terrain data U and the blade edge 8T of the bucket 8.
  • the work machine controller 26 generates a control signal N for controlling the work machine 2 so that the cutting edge 8T of the bucket 8 moves along the target excavation landform data U, and outputs the control signal N to the control valve 27 shown in FIG. .
  • the speed at which the work machine 2 approaches the target excavation landform data U is limited according to the distance to the target excavation landform data U.
  • the global coordinate calculation unit 23 detects the reference position data P1 and P2 of the GNSS antennas 21 and 22 in the global coordinate system.
  • the global coordinate system is a three-dimensional coordinate system indicated by (X, Y, Z) based on, for example, a reference position PG of the reference pile 60 that is a reference installed in the work area GD of the excavator 100. As shown in FIG. 3A, the reference position PG is located at the tip 60T of the reference pile 60 installed in the work area GD, for example.
  • the global coordinate system is, for example, a coordinate system in GNSS.
  • the display controller 28 shown in FIG. 2 calculates the position of the local coordinate system when viewed in the global coordinate system based on the detection result by the position detection device 19.
  • the local coordinate system is a three-dimensional coordinate system indicated by (x, y, z) with the excavator 100 as a reference.
  • the reference position PL of the local coordinate system is located, for example, on a swing circle for turning the upper swing body 3.
  • the work machine controller 26 calculates the position of the local coordinate system when viewed in the global coordinate system as follows.
  • the sensor controller 39 calculates the tilt angle ⁇ 1 of the boom 6 with respect to the direction (z-axis direction) orthogonal to the horizontal plane in the local coordinate system from the boom cylinder length detected by the first stroke sensor 16.
  • the work machine controller 26 calculates the inclination angle ⁇ 2 of the arm 7 with respect to the boom 6 from the arm cylinder length detected by the second stroke sensor 17.
  • the work machine controller 26 calculates the inclination angle ⁇ 3 of the bucket 8 with respect to the arm 7 from the bucket cylinder length detected by the third stroke sensor 18.
  • the storage unit 26M of the work machine controller 26 stores data of the work machine 2 (hereinafter, referred to as work machine data as appropriate).
  • the work machine data includes the length L1 of the boom 6, the length L2 of the arm 7, and the length L3 of the bucket 8.
  • the length L1 of the boom 6 corresponds to the length from the boom pin 13 to the arm pin 14.
  • the length L2 of the arm 7 corresponds to the length from the arm pin 14 to the bucket pin 15.
  • the length L3 of the bucket 8 corresponds to the length from the bucket pin 15 to the cutting edge 8T of the bucket 8.
  • the blade tip 8T is the tip of the blade 8B shown in FIG.
  • the work implement data includes position information up to the boom pin 13 with respect to the reference position PL in the local coordinate system.
  • FIG. 4 is a schematic diagram showing an example of the target construction surface.
  • the target construction information T which is a finish target after excavation of the excavation target of the work machine 2 included in the excavator 100, includes a plurality of target construction surfaces 41 each represented by a triangular polygon.
  • reference numeral 41 is given to only one of the plurality of target construction surfaces 41, and reference numerals of the other target construction surfaces 41 are omitted.
  • the work machine controller 26 performs control so that the speed in the direction in which the work machine 2 approaches the excavation target is equal to or less than the speed limit in order to prevent the bucket 8 from eroding the target excavation landform 43I. This control is appropriately referred to as excavation control.
  • excavation control executed by the work machine controller 26 will be described.
  • FIG. 5 is a block diagram showing the work machine controller 26 and the display controller 28.
  • FIG. 6 is a diagram illustrating an example of the target excavation landform 43I displayed on the display unit.
  • FIG. 7 is a schematic diagram showing the relationship among the target speed, the vertical speed component, and the horizontal speed component.
  • FIG. 8 is a diagram illustrating a method for calculating the vertical velocity component and the horizontal velocity component.
  • FIG. 9 is a diagram illustrating a method for calculating the vertical velocity component and the horizontal velocity component.
  • FIG. 10 is a schematic diagram showing the distance between the cutting edge and the target construction surface.
  • FIG. 11 is a graph showing an example of speed limit information.
  • FIG. 12 is a schematic diagram illustrating a method of calculating the vertical speed component of the boom speed limit.
  • FIG. 13 is a schematic diagram showing the relationship between the vertical speed component of the boom speed limit and the boom speed limit.
  • FIG. 14 is a diagram illustrating an example of a change in the speed limit of the boom due to the
  • the display controller 28 generates target excavation landform data U and outputs it to the work machine controller 26.
  • the excavation control is executed, for example, when the operator of the excavator 100 selects to execute the excavation control using the switch 29S shown in FIG.
  • the work machine controller 26 detects the boom operation amount MB, the arm operation amount MA, the bucket operation amount MT, the target excavation landform data U acquired from the display controller 28, and the inclination angle ⁇ 1 acquired from the sensor controller 39.
  • ⁇ 2, ⁇ 3, and ⁇ 5 are used to generate a boom command signal CBI necessary for excavation control, and an arm command signal and a bucket command signal are generated as necessary to drive the control valve 27 and the intervention valve 27C.
  • the work machine 2 is controlled.
  • the display controller 28 includes a target construction information storage unit 28A, a bucket cutting edge position data generation unit 28B, and a target excavation landform data generation unit 28C.
  • the target construction information storage unit 28A stores target construction information T as information indicating the target shape in the work area.
  • the target construction information T includes coordinate data and angle data required for generating the target excavation landform data U as information indicating the target shape of the excavation target.
  • the target construction information T includes position information of a plurality of target construction surfaces 41.
  • the target construction information storage unit 28A is, for example, the target construction information T that is necessary for the excavation control work machine controller 26 to control the work machine 2 or to display the target excavation landform data Ua on the display unit 29.
  • the necessary target construction information T may be downloaded to the target construction information storage unit 28A by connecting a terminal device storing the target construction information T to the display controller 28, or a storage device that can be taken out is stored in the controller 28. You may connect and transfer.
  • the bucket blade edge position data generation unit 28B determines the position of the turning center of the excavator 100 passing through the turning axis z of the upper swing body 3 based on the reference position data P and the swing body orientation data Q acquired from the global coordinate calculation unit 23.
  • the turning center position data XR shown is generated. In the turning center position data XR, the reference PL and xy coordinates of the local coordinate system coincide.
  • the bucket cutting edge position data generation unit 28B generates bucket cutting edge position data S indicating the current position of the cutting edge 8T of the bucket 8 based on the turning center position data XR and the inclination angles ⁇ 1, ⁇ 2, and ⁇ 3 of the work implement 2.
  • the bucket blade tip position data generation unit 28B acquires the reference position data P and the swing body orientation data Q from the global coordinate calculation unit 23 at a frequency of 10 Hz, for example. Therefore, the bucket blade edge position data generation unit 28B can update the bucket blade edge position data S at a frequency of 10 Hz, for example.
  • the bucket cutting edge position data generation unit 28B outputs the updated bucket cutting edge position data S to the target excavation landform data generation unit 28C.
  • the target excavation landform data generation unit 28C acquires the target construction information T stored in the target construction information storage unit 28A and the bucket blade tip position data S from the bucket blade tip position data generation unit 28B.
  • the target excavation landform data generation unit 28 ⁇ / b> C sets, as the excavation target position 44, the intersection of the perpendicular line passing through the cutting edge position P ⁇ b> 4 of the cutting edge 8 ⁇ / b> T and the target construction surface 41 in the local coordinate system.
  • the excavation target position 44 is a point immediately below the cutting edge position P4 of the bucket 8.
  • the target excavation landform data generation unit 28C is based on the target construction information T and the bucket edge position data S, and is defined in the front-rear direction of the upper swing body 3 and passes through the excavation target position 44 as shown in FIG.
  • An intersection line 43 between the plane 42 of the machine 2 and the target construction information T represented by the plurality of target construction surfaces 41 is acquired as a candidate line for the target excavation landform 43I.
  • the excavation target position 44 is one point on the candidate line.
  • the plane 42 is a plane parallel to a plane on which the work machine 2 operates (work machine operation plane) or a work machine operation plane.
  • the work machine operation plane is a plane parallel to the xz plane of the excavator 100 when the boom 6 and the arm 7 do not rotate around an axis parallel to the z axis of the local coordinate system of the excavator 100.
  • the work machine operation plane is the axis on which the arm rotates, that is, the arm pin 14 shown in FIG. It is a plane orthogonal to the axis.
  • the work machine operation plane is appropriately referred to as an arm operation plane.
  • the target excavation landform data generation unit 28C determines one or more inflection points before and after the excavation target position 44 of the target construction information T and lines before and after the target excavation landform 43I as the excavation target.
  • two inflection points Pv1, Pv2 and lines before and after the inflection points Pv1, Pv2 are determined as the target excavation landform 43I.
  • the target excavation landform data generation unit 28 ⁇ / b> C is a target which is information indicating the target shape of the excavation target, the position information of one or more inflection points before and after the excavation target position 44 and the angle information of the lines before and after the excavation target position 44. It is generated as excavation landform data U.
  • the target excavation landform 43I is defined by a line, but may be defined as a surface based on, for example, the width of the bucket 8 or the like.
  • the target excavation landform data U generated in this way has some information on the plurality of target construction surfaces 41.
  • the target excavation landform data generation unit 28C outputs the generated target excavation landform data U to the work machine controller 26.
  • the display controller 28 and the work machine controller directly exchange signals. However, for example, signals may be exchanged via an in-vehicle signal line such as CAN (Controller Area Network).
  • the target excavation landform data U includes a plane 42 as a work machine operation plane on which the work machine 2 operates, and at least one target construction surface (first target construction surface) 41 indicating a target shape. It is the information in the part to do.
  • the plane 42 is an xz plane in the local coordinate system (x, y, z) shown in FIGS. 3A and 3B.
  • a plane that intersects (or is orthogonal to) the plane 42 and is parallel to the vertical direction, and at least the target shape is shown. There is also information on a portion where one target construction surface 41 intersects.
  • This information is information indicating the target shape of the excavation target in the width direction of the work machine 2 (y direction in the local coordinate system). This information is appropriately referred to as width direction target excavation landform data Uw.
  • a width-direction target excavation landform 46I is generated based on the width-direction target excavation landform data Uw. Details of the width direction target excavation landform data Uw and the target excavation landform 46I will be described later.
  • the target excavation landform data U obtained by cutting out the plurality of target construction surfaces 41 by the plane 42 will be appropriately referred to as front-rear direction target excavation landform data U.
  • the display controller 28 displays the target excavation on the display unit 29 based on the width direction target excavation landform data Uw as the first target excavation landform information or the longitudinal target excavation landform data U as the second target excavation landform information.
  • the topography 43I is displayed.
  • display target excavation landform data Ua is used.
  • Based on the target excavation landform data Ua for display for example, an image showing the positional relationship between the target excavation landform 43I set as the excavation target of the bucket 8 and the cutting edge 8T as shown in FIG. Is done.
  • the display controller 28 displays the target excavation landform (display excavation landform) 43I on the display unit 29 based on the display target excavation landform data Ua.
  • the longitudinal target excavation landform data U and the width direction target excavation landform data Uw output to the work machine controller 26 are used for excavation control.
  • the target excavation landform data U and the width direction target excavation landform data Uw used for excavation control are referred to as work target excavation landform data as appropriate.
  • the target excavation landform data generation unit 28C acquires the bucket cutting edge position data S from the bucket cutting edge position data generation unit 28B at a frequency of 10 Hz, for example. Therefore, the target excavation landform data generation unit 28 ⁇ / b> C can update the longitudinal target excavation landform data U and the width direction target excavation landform data Uw at a frequency of 10 Hz, for example, and output them to the work machine controller 26. Next, the work machine controller 26 will be described.
  • the work machine controller 26 includes a target speed determination unit 52, a distance acquisition unit 53, a speed limit determination unit 54, a work machine control unit 57, and an excavation control availability determination unit (hereinafter referred to as a control availability determination unit as appropriate) 58. And have.
  • the work machine controller 26 executes excavation control using the target excavation landform 43I based on the above-described longitudinal target excavation landform data U or the width direction target excavation landform data Uw.
  • the target excavation landform 43I used for display is referred to as display target excavation landform, and the latter is referred to as excavation control target excavation landform.
  • the functions of the target speed determination unit 52, the distance acquisition unit 53, the speed limit determination unit 54, the work machine control unit 57, and the controlled criticism bottom 58 are realized by the processing unit 26P illustrated in FIG.
  • excavation control by the work machine controller 26 will be described.
  • This excavation control is an example of excavation control in the front-rear direction of the work machine 2, but excavation control is also possible in the width direction of the work machine 2.
  • Excavation control in the width direction of the work machine 2 will be described later.
  • the target speed determination unit 52 determines the boom target speed Vc_bm, the arm target speed Vc_am, and the bucket target speed Vc_bkt.
  • the boom target speed Vc_bm is the speed of the cutting edge 8T when only the boom cylinder 10 is driven.
  • the arm target speed Vc_am is the speed of the cutting edge 8T when only the arm cylinder 11 is driven.
  • the bucket target speed Vc_bkt is the speed of the cutting edge 8T when only the bucket cylinder 12 is driven.
  • the boom target speed Vc_bm is calculated according to the boom operation amount MB.
  • the arm target speed Vc_am is calculated according to the arm operation amount MA.
  • the bucket target speed Vc_bkt is calculated according to the bucket operation amount MT.
  • the storage unit 26M stores target speed information that defines the relationship between the boom operation amount MB and the boom target speed Vc_bm.
  • the target speed determination unit 52 determines the boom target speed Vc_bm corresponding to the boom operation amount MB by referring to the target speed information.
  • the target speed information is, for example, a graph describing the magnitude of the boom target speed Vc_bm with respect to the boom operation amount MB.
  • the target speed information may be in the form of a table or a mathematical expression.
  • the target speed information includes information that defines the relationship between the arm operation amount MA and the arm target speed Vc_am.
  • the target speed information includes information that defines the relationship between the bucket operation amount MT and the bucket target speed Vc_bkt.
  • the target speed determination unit 52 determines the arm target speed Vc_am corresponding to the arm operation amount MA by referring to the target speed information.
  • the target speed determination unit 52 determines the bucket target speed Vc_bkt corresponding to the bucket operation amount MT by referring to the target speed information. As shown in FIG.
  • the target speed determination unit 52 converts the boom target speed Vc_bm into a speed component in a direction perpendicular to the target excavation landform 43I (target excavation landform data U) (hereinafter, referred to as a vertical speed component as appropriate) Vcy_bm and The velocity is converted into a velocity component (hereinafter referred to as a horizontal velocity component as appropriate) Vcx_bm in a direction parallel to the target excavation landform 43I (target excavation landform data U).
  • the target speed determination unit 52 acquires the inclination angle ⁇ 5 from the sensor controller 39, and obtains the inclination in the direction perpendicular to the target excavation landform 43I with respect to the vertical axis of the global coordinate system. Then, the target speed determination unit 52 obtains an angle ⁇ 2 (see FIG. 8) representing the inclination between the vertical axis of the local coordinate system and the direction orthogonal to the target excavation landform 43I from these inclinations.
  • the target speed determining unit 52 calculates the boom target speed Vc_bm by using a trigonometric function from the angle ⁇ 2 formed by the vertical axis of the local coordinate system and the direction of the boom target speed Vc_bm. Conversion is made into a velocity component VL1_bm in the vertical axis direction and a velocity component VL2_bm in the horizontal axis direction. Then, as shown in FIG. 9, the target speed determination unit 52 uses the trigonometric function to calculate the vertical axis direction of the local coordinate system from the gradient ⁇ 1 between the vertical axis of the local coordinate system and the direction perpendicular to the target excavation landform 43I.
  • the velocity component VL1_bm and the velocity component VL2_bm in the horizontal axis direction are converted into the above-described vertical velocity component Vcy_bm and horizontal velocity component Vcx_bm for the target excavation landform 43I.
  • the target speed determination unit 52 converts the arm target speed Vc_am into a vertical speed component Vcy_am and a horizontal speed component Vcx_am in the vertical axis direction of the local coordinate system.
  • the target speed determination unit 52 converts the bucket target speed Vc_bkt into a vertical speed component Vcy_bkt and a horizontal speed component Vcx_bkt in the vertical axis direction of the local coordinate system.
  • the distance acquisition unit 53 acquires the distance d between the cutting edge 8T of the bucket 8 and the target excavation landform 43I as shown in FIG. Specifically, the distance acquisition unit 53 obtains the edge 8T of the bucket 8 and the target excavation landform 43I from the position information of the edge 8T acquired as described above and the target excavation landform data U indicating the position of the target excavation landform 43I. The shortest distance d is calculated. In this embodiment, excavation control is executed based on the shortest distance d between the cutting edge 8T of the bucket 8 and the target excavation landform 43I.
  • the speed limit determining unit 54 calculates the speed limit Vcy_lmt of the entire work machine 2 shown in FIG. 1 based on the distance d between the cutting edge 8T of the bucket 8 and the target excavation landform 43I.
  • the speed limit Vcy_lmt of the work implement 2 as a whole is a movement speed of the cutting edge 8T that is allowable in the direction in which the cutting edge 8T of the bucket 8 approaches the target excavation landform 43I.
  • the storage unit 26M illustrated in FIG. 2 stores speed limit information that defines the relationship between the distance d and the speed limit Vcy_lmt.
  • FIG. 11 shows an example of speed limit information.
  • the horizontal axis in FIG. 11 is the distance d, and the vertical axis is the speed limit Vcy.
  • the distance d when the cutting edge 8T is located outside the target excavation landform 43I, that is, on the working machine 2 side of the excavator 100 is a positive value, and the cutting edge 8T is within the target excavation landform 43I.
  • the distance d when located on the inner side of the excavation object than the target excavation landform 43I is a negative value.
  • the distance d when the cutting edge 8T is located above the target excavation landform 43I is a positive value, and the cutting edge 8T is located below the target excavation landform 43I.
  • the distance d at the time of doing is a negative value.
  • the distance d when the cutting edge 8T is at a position where it does not erode with respect to the target excavation landform 43I is a positive value
  • the distance d when the cutting edge 8T is at a position where it erodes with respect to the target excavation landform 43I is negative. It can be said that it is a value.
  • the distance d is zero.
  • the speed when the cutting edge 8T goes from the inside of the target excavation landform 43I to the outside is a positive value
  • the speed when the cutting edge 8T goes from the outside of the target excavation landform 43I to the inside is negative. Value. That is, the speed when the cutting edge 8T is directed upward of the target excavation landform 43I is a positive value, and the speed when the cutting edge 8T is directed downward is a negative value.
  • the slope of the speed limit Vcy_lmt when the distance d is between d1 and d2 is smaller than the slope when the distance d is greater than or equal to d1 or less than d2.
  • d1 is greater than zero.
  • d2 is smaller than 0.
  • the inclination when the distance d is between d1 and d2 is greater than the inclination when the distance d is not less than d1 or not more than d2. Also make it smaller.
  • the speed limit Vcy_lmt is a negative value, and the speed limit Vcy_lmt decreases as the distance d increases. That is, when the distance d is equal to or greater than d1, the speed toward the lower side of the target excavation landform 43I increases as the cutting edge 8T is further from the target excavation landform 43I above the target excavation landform 43I, and the absolute value of the speed limit Vcy_lmt increases. . When the distance d is 0 or less, the speed limit Vcy_lmt is a positive value, and the speed limit Vcy_lmt increases as the distance d decreases.
  • the speed limit Vcy_lmt is Vmin.
  • the first predetermined value dth1 is a positive value and is larger than d1.
  • Vmin is smaller than the minimum value of the target speed. That is, when the distance d is equal to or greater than the first predetermined value dth1, the operation of the work machine 2 is not limited. Therefore, when the cutting edge 8T is far away from the target excavation landform 43I above the target excavation landform 43I, the operation of the work machine 2, that is, the excavation control is not performed.
  • the distance d is smaller than the first predetermined value dth1, the operation of the work machine 2 is restricted. Specifically, as will be described later, when the distance d is smaller than the first predetermined value dth1, the operation of the boom 6 is restricted.
  • the speed limit determining unit 54 is a vertical speed component of the speed limit of the boom 6 from the speed limit Vcy_lmt, the arm target speed Vc_am, and the bucket target speed Vc_bkt of the entire work machine 2 (hereinafter, referred to as a limit vertical speed component of the boom 6 as appropriate).
  • Vcy_bm_lmt is calculated.
  • the speed limit determining unit 54 subtracts the vertical speed component Vcy_am of the arm target speed and the vertical speed component Vcy_bkt of the bucket target speed from the speed limit Vcy_lmt of the work implement 2 as a whole. 6 of the limited vertical velocity component Vcy_bm_lmt is calculated.
  • the speed limit determining unit 54 converts the limited vertical speed component Vcy_bm_lmt of the boom 6 into a speed limit (boom speed limit) Vc_bm_lmt of the boom 6, as shown in FIG.
  • the speed limit determination unit 54 determines the target excavation from the above-described tilt angle ⁇ 1 of the boom 6, the tilt angle ⁇ 2 of the arm 7, the tilt angle ⁇ 3 of the bucket 8, the reference position data of the GNSS antennas 21 and 22, the target excavation landform data U, and the like.
  • the relationship between the direction perpendicular to the terrain 43I and the direction of the boom limit speed Vc_bm_lmt is obtained, and the limit vertical speed component Vcy_bm_lmt of the boom 6 is converted into the boom limit speed Vc_bm_lmt.
  • the calculation in this case is performed by a procedure reverse to the calculation for obtaining the vertical speed component Vcy_bm in the direction perpendicular to the target excavation landform 43I from the boom target speed Vc_bm.
  • the shuttle valve 51 shown in FIG. 2 selects a larger one of the pilot pressure generated based on the operation of the boom 6 and the pilot pressure generated by the intervention valve 27C based on the boom intervention command CBI. 64.
  • the direction control valve 64 corresponding to the boom cylinder 10 is operated by the pilot pressure based on the boom intervention command CBI.
  • the driving of the boom 6 based on the boom speed limit Vc_bm_lmt is realized.
  • the work machine control unit 57 controls the work machine 2.
  • the work implement control unit 57 outputs the arm command signal, the boom command signal, the boom intervention command CBI, and the bucket command signal to the control valve 27 and the intervention valve 27C shown in FIG.
  • the bucket cylinder 12 is controlled.
  • the arm command signal, the boom command signal, the boom intervention command CBI, and the bucket command signal have current values corresponding to the boom command speed, the arm command speed, and the bucket command speed, respectively.
  • the shuttle valve 51 selects the pilot pressure based on the lever operation.
  • the direction control valve 64 corresponding to the boom cylinder 10 is operated by the pilot pressure selected by the shuttle valve 51 based on the operation of the boom 6. That is, since the boom 6 is driven based on the boom target speed Vc_bm, it is not driven based on the boom limit speed Vc_bm_lmt.
  • the work implement control unit 57 sets each of the boom target speed Vc_bm, the arm target speed Vc_am, and the bucket target speed Vc_bkt.
  • the boom command speed, the arm command speed, and the bucket command speed are selected.
  • the work machine control unit 57 determines the speeds (cylinder speeds) of the boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12 according to the boom target speed Vc_bm, the arm target speed Vc_am, and the bucket target speed Vc_bkt. Then, the work implement control unit 57 operates the boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12 by controlling the control valve 27 based on the determined cylinder speed.
  • the work machine control unit 57 operates the boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12 according to the boom operation amount MB, the arm operation amount MA, and the bucket operation amount MT. . Therefore, the boom cylinder 10 operates at the boom target speed Vc_bm, the arm cylinder 11 operates at the arm target speed Vc_am, and the bucket cylinder 12 operates at the bucket target speed Vc_bkt.
  • the shuttle valve 51 selects the pilot pressure output from the intervention valve 27C based on the intervention command.
  • the boom 6 operates at the boom limit speed Vc_bm_lmt
  • the arm 7 operates at the arm target speed Vc_am.
  • the bucket 8 operates at the bucket target speed Vc_bkt.
  • the limited vertical speed component Vcy_bm_lmt of the boom 6 is calculated by subtracting the vertical speed component Vcy_amt of the arm target speed and the vertical speed component Vcy_bkt of the bucket target speed from the limited speed Vcy_lmt of the work implement 2 as a whole. The Therefore, when the speed limit Vcy_lmt of the work implement 2 as a whole is smaller than the sum of the vertical speed component Vcy_am of the arm target speed and the vertical speed component Vcy_bkt of the bucket target speed, the limit vertical speed component Vcy_bm_lmt of the boom 6 is increased. Negative value.
  • the boom speed limit Vc_bm_lmt is a negative value.
  • the work implement control unit 57 lowers the boom 6 but decelerates the boom target speed Vc_bm. For this reason, it can suppress that the bucket 8 erodes the target excavation landform 43I, suppressing an uncomfortable feeling of an operator small.
  • the limit vertical speed component Vcy_bm_lmt of the boom 6 becomes a positive value.
  • the boom speed limit Vc_bm_lmt is a positive value. In this case, even if the operating device 25 is operated in the direction in which the boom 6 is lowered, the boom 6 is raised based on the command signal from the intervention valve 27C shown in FIG. For this reason, the expansion of the erosion of the target excavation landform 43I can be quickly suppressed.
  • the absolute value of the speed component of the speed limit of the boom 6 in the direction (hereinafter, appropriately referred to as the speed limit horizontal speed component) Vcx_bm_lmt is also reduced. Therefore, when the cutting edge 8T is positioned above the target excavation landform 43I, the speed of the boom 6 in the direction perpendicular to the target excavation landform 43I and the target excavation of the boom 6 are increased as the cutting edge 8T approaches the target excavation landform 43I.
  • FIG. 14 shows the speed limit of the boom 6 when the distance d between the target excavation landform 43I and the cutting edge 8T of the bucket 8 is smaller than the first predetermined value dth1, and the cutting edge of the bucket 8 moves from the position Pn1 to the position Pn2.
  • the distance between the cutting edge 8T and the target excavation landform 43I at the position Pn2 is smaller than the distance between the cutting edge 8T and the target excavation landform 43I at the position Pn1. Therefore, the limited vertical speed component Vcy_bm_lmt2 of the boom 6 at the position Pn2 is smaller than the limited vertical speed component Vcy_bm_lmt1 of the boom 6 at the position Pn1.
  • the boom limit speed Vc_bm_lmt2 at the position Pn2 is smaller than the boom limit speed Vc_bm_lmt1 at the position Pn1.
  • the limited horizontal speed component Vcx_bm_lmt2 of the boom 6 at the position Pn2 is smaller than the limited horizontal speed component Vcx_bm_lmt1 of the boom 6 at the position Pn1.
  • the arm target speed Vc_am and the bucket target speed Vc_bkt are not limited.
  • this embodiment can suppress the uncomfortable feeling in the operation at the time of excavation of an operator, suppressing the expansion of erosion of the target excavation landform 43I.
  • the control availability determination unit 58 shown in FIG. 5 determines whether or not to execute excavation control based on the lateral target excavation landform data Uw. For example, when the lateral target excavation landform data Uw immediately below the bucket 8 is equal to or greater than a predetermined angle with respect to the horizontal plane, the control availability determination unit 58 stops the excavation control being executed. The processing executed by the control availability determination unit 58 will be described later.
  • the cutting edge position P4 of the cutting edge 8T is not limited to GNSS, and may be measured by other positioning means. Therefore, the distance d between the cutting edge 8T and the target excavation landform 43I is not limited to GNSS, and may be measured by other positioning means.
  • the absolute value of the bucket speed limit is smaller than the absolute value of the bucket target speed. For example, the bucket speed limit may be calculated by the same method as the arm speed limit described above. The bucket 8 may be restricted together with the restriction of the arm 7.
  • FIG. 15 is a diagram showing a detailed structure of a hydraulic system 300 provided in the excavator 100.
  • the hydraulic system 300 includes a hydraulic cylinder 60 including a boom cylinder 10, an arm cylinder 11, and a bucket cylinder 12.
  • the hydraulic cylinder 60 is operated by the hydraulic oil supplied from the hydraulic pumps 36 and 37 shown in FIG.
  • a direction control valve 64 that controls the direction in which the hydraulic oil flows.
  • the direction control valve 64 is disposed in each of the boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12.
  • the direction control valve 64 is a spool system that moves the rod-shaped spool 64S to switch the direction in which the hydraulic oil flows.
  • the spool 64S is moved by the hydraulic oil pilot oil supplied from the operating device 25 shown in FIG.
  • the direction control valve 64 operates the hydraulic cylinder 60 by supplying hydraulic oil (hereinafter referred to as pilot oil as appropriate) to the hydraulic cylinder 60 by the movement of the spool.
  • the supply of hydraulic oil to the cap-side oil chamber 48R of the hydraulic cylinder 60 and the supply of hydraulic oil to the rod-side oil chamber 47R are switched.
  • the supply amount of hydraulic oil (supply amount per unit time) to the hydraulic cylinder 60 is adjusted by moving the spool 64S in the axial direction.
  • the cylinder speed of the hydraulic cylinder 60 is adjusted by adjusting the amount of hydraulic oil supplied to the hydraulic cylinder 60.
  • a directional control valve 640 that supplies hydraulic oil to the boom cylinder 10 and a directional control valve 641 that supplies hydraulic oil to the arm cylinder 11 are provided with a spool stroke sensor 65 that detects the movement amount (movement distance) of the spool 64S. ing.
  • the operation of the direction control valve 64 is adjusted by the operation device 25.
  • the hydraulic oil sent from the hydraulic pump 36 and decompressed by the pressure reducing valve is supplied to the operating device 25 as pilot oil. Pilot oil sent from a pilot hydraulic pump different from the hydraulic pump 36 may be supplied to the operating device 25.
  • the operation device 25 adjusts the pilot oil pressure based on the operation of each operation lever.
  • the direction control valve 64 is driven by the pilot hydraulic pressure. By adjusting the pilot oil pressure by the operating device 25, the moving amount of the spool 64S in the axial direction is adjusted.
  • the direction control valve 64 is provided in each of the boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12.
  • the direction control valve 64 connected to the boom cylinder 10 is appropriately referred to as a direction control valve 640.
  • the direction control valve 64 connected to the arm cylinder 11 is appropriately referred to as a direction control valve 641.
  • the direction control valve 64 connected to the bucket cylinder 12 is appropriately referred to as a direction control valve 642.
  • the operating device 25 and the directional control valve 64 are connected via a pilot oil passage 450. Pilot oil for moving the spool 64 ⁇ / b> S of the direction control valve 64 flows through the pilot oil passage 450.
  • the control valve 27, the pressure sensor 66, and the pressure sensor 67 are arranged in the pilot oil passage 450.
  • a pilot oil passage 450 is connected to the direction control valve 64. Pilot oil is supplied to the directional control valve 64 through the pilot oil passage 450.
  • the direction control valve 64 has a first pressure receiving chamber and a second pressure receiving chamber.
  • the pilot oil passage 450 is connected to the first pressure receiving chamber and the second pressure receiving chamber.
  • pilot oil is supplied to the second pressure receiving chamber of the directional control valve 64 via pilot oil passages 4520A, 4521A, and 4522A, which will be described later, the spool moves in accordance with the pilot hydraulic pressure, and the hydraulic pressure passes through the directional control valve 64.
  • the hydraulic oil is supplied to the rod side oil chamber 47R of the cylinder 60.
  • the amount of hydraulic oil supplied to the rod side hydraulic chamber 47R is adjusted by the operation amount of the operating device 25 (the amount of movement of the spool 64S).
  • the pilot oil passage 450 connected to the direction control valve 640 that supplies hydraulic oil to the boom cylinder 10 is appropriately referred to as boom adjustment oil passages 4520A and 4520B.
  • the pilot oil passage 450 connected to the direction control valve 641 that supplies hydraulic oil to the arm cylinder 11 is appropriately referred to as arm adjustment oil passages 4521A and 4521B.
  • the pilot oil passage 450 connected to the direction control valve 642 that supplies hydraulic oil to the bucket cylinder 12 is appropriately referred to as bucket adjustment oil passages 4522A and 4522B.
  • the pilot oil passage 450 connected to the boom adjustment oil passage 4520A is appropriately referred to as a boom operation oil passage 4510A
  • the pilot oil passage 450 connected to the boom adjustment oil passage 4520B is appropriately referred to as a boom.
  • This is referred to as an operation oil passage 4510B
  • the pilot oil passage 450 connected to the arm adjustment oil passage 4521A is appropriately referred to as an arm operation oil passage 4511A
  • the pilot oil passage 450 connected to the arm adjustment oil passage 4521B is appropriately referred to as an arm operation oil passage 4511B.
  • the pilot oil passage 450 connected to the bucket adjustment oil passage 4522A is appropriately referred to as a bucket operation oil passage 4512A
  • the pilot oil passage 450 connected to the bucket adjustment oil passage 4522B is appropriately referred to as a bucket operation oil passage 4512B. .
  • the boom operation oil passages (4510A, 4510B) and the boom adjustment oil passages (4520A, 4520B) are connected to the pilot hydraulic operation device 25. Pilot oil whose pressure is adjusted according to the operation amount of the operating device 25 flows through the boom operation oil passages (4510A, 4510B).
  • the arm operation oil passages (4511A, 4511B) and the arm adjustment oil passages (4521A, 4521B) are connected to the pilot hydraulic operation device 25. Pilot oil whose pressure is adjusted according to the operation amount of the operating device 25 flows through the arm operating oil passages (4511A, 4511B).
  • the bucket operation oil passages (4512A, 4512B) and the bucket adjustment oil passages (4522A, 4522B) are connected to the pilot hydraulic operation device 25. Pilot oil whose pressure is adjusted in accordance with the operation amount of the operating device 25 flows through the bucket operating oil passages (4512A, 4512B).
  • the boom operation oil passage 4510A, the boom operation oil passage 4510B, the boom adjustment oil passage 4520A, and the boom adjustment oil passage 4520B are boom oil passages through which pilot oil for operating the boom 6 flows.
  • the arm operation oil passage 4511A, the arm operation oil passage 4511B, the arm adjustment oil passage 4521A, and the arm adjustment oil passage 4521B are arm oil passages through which pilot oil for operating the arm 7 flows.
  • Bucket operation oil passage 4512A, bucket operation oil passage 4512B, bucket adjustment oil passage 4522A, and bucket adjustment oil passage 4522B are bucket oil passages through which pilot oil for operating bucket 8 flows.
  • the boom 6 performs two types of operations, that is, a lowering operation and a raising operation.
  • the operation device 25 When the operation device 25 is operated so that the lowering operation of the boom 6 is performed, the directional control valve 640 connected to the boom cylinder 10 is connected to the boom operation oil passage 4510A and the boom adjustment oil passage 4520A. Pilot oil is supplied.
  • the direction control valve 640 operates based on the pilot hydraulic pressure. As a result, the hydraulic oil from the hydraulic pumps 36 and 37 is supplied to the boom cylinder 10 and the boom 6 is lowered.
  • the directional control valve 640 connected to the boom cylinder 10 is connected to the boom operation oil passage 4510B and the boom adjustment oil passage 4520B. Pilot oil is supplied.
  • the direction control valve 640 operates based on the pilot hydraulic pressure. As a result, the hydraulic oil from the hydraulic pumps 36 and 37 is supplied to the boom cylinder 10 and the boom 6 is raised.
  • the boom operation oil passage 4510A and the boom adjustment oil passage 4520A are connected to the second pressure receiving chamber of the direction control valve 640, and the boom lowering flow through which pilot oil for lowering the boom 6 flows. It is an oil passage.
  • the boom operation oil passage 4510B and the boom adjustment oil passage 4520B are connected to the first pressure receiving chamber of the direction control valve 640, and are boom raising oil passages through which pilot oil for raising the boom 6 flows.
  • the arm 7 performs two types of operations, a lowering operation and a raising operation, by operating the operating device 25.
  • the directional control valve 641 connected to the arm cylinder 11 is connected to the oil passage 4511A for arm operation and the oil passage 4521A for arm adjustment. Pilot oil is supplied.
  • the direction control valve 641 operates based on the pilot hydraulic pressure. As a result, the hydraulic oil from the hydraulic pumps 36 and 37 is supplied to the arm cylinder 11, and the raising operation of the arm 7 is executed.
  • the directional control valve 641 connected to the arm cylinder 11 is connected to the directional control valve 641 via the arm operation oil passage 4511B and the arm adjustment oil passage 4521B. Pilot oil is supplied.
  • the direction control valve 641 operates based on the pilot hydraulic pressure. As a result, the hydraulic oil from the hydraulic pumps 36 and 37 is supplied to the arm cylinder 11 and the lowering operation of the arm 7 is executed.
  • the arm operation oil passage 4511A and the arm adjustment oil passage 4521A are connected to the second pressure receiving chamber of the direction control valve 641, and the arm raising oil flow through which pilot oil for raising the arm 7 flows. It is an oil passage.
  • the arm operation oil passage 4511B and the arm adjustment oil passage 4521B are connected to the first pressure receiving chamber of the direction control valve 641, and are arm lowering oil passages through which pilot oil for lowering the arm 7 flows.
  • the operation of the operation device 25 causes the bucket 8 to perform two types of operations, a lowering operation and a raising operation.
  • the direction control valve 642 connected to the bucket cylinder 12 is connected to the bucket operation oil passage 4512A and the bucket adjustment oil passage 4522A. Pilot oil is supplied.
  • the direction control valve 642 operates based on the pilot hydraulic pressure. As a result, the hydraulic oil from the hydraulic pumps 36 and 37 is supplied to the bucket cylinder 12 and the raising operation of the bucket 8 is executed.
  • the directional control valve 642 connected to the bucket cylinder 12 is connected to the bucket operation oil passage 4512B and the bucket adjustment oil passage 4522B. Pilot oil is supplied.
  • the direction control valve 642 operates based on the pilot hydraulic pressure. As a result, the hydraulic oil from the hydraulic pumps 36 and 37 is supplied to the bucket cylinder 12 and the lowering operation of the bucket 8 is executed.
  • the bucket operation oil passage 4512A and the bucket adjustment oil passage 4522A are connected to the second pressure receiving chamber of the direction control valve 642, and for raising the bucket through which pilot oil for raising the bucket 8 flows. It is an oil passage.
  • the bucket operation oil passage 4512B and the bucket adjustment oil passage 4522B are connected to the first pressure receiving chamber of the direction control valve 642, and are bucket lowering oil passages through which pilot oil for lowering the bucket 8 flows.
  • the control valve 27 adjusts the pilot hydraulic pressure based on a control signal (current) from the work machine controller 26.
  • the control valve 27 is, for example, an electromagnetic proportional control valve, and is controlled based on a control signal from the work machine controller 26.
  • the control valve 27 includes a control valve 27A and a control valve 27B.
  • the control valve 27B adjusts the pilot oil pressure of the pilot oil supplied to the first pressure receiving chamber of the direction control valve 64, and the hydraulic oil supplied to the cap side oil chamber 48R of the hydraulic cylinder 60 via the direction control valve 64. Adjust the amount.
  • the control valve 27A adjusts the pilot oil pressure of the pilot oil supplied to the second pressure receiving chamber of the direction control valve 64, and the hydraulic oil supplied to the rod side oil chamber 47R of the hydraulic cylinder 60 via the direction control valve 64. Adjust the amount.
  • a pressure sensor 66 and a pressure sensor 67 for detecting the pilot oil pressure are provided on both sides of the control valve 27.
  • the pressure sensor 66 is disposed between the operating device 25 and the control valve 27 in the pilot oil passage 451.
  • the pressure sensor 67 is disposed between the control valve 27 and the direction control valve 64 in the pilot oil passage 452.
  • the pressure sensor 66 can detect the pilot hydraulic pressure before being adjusted by the control valve 27.
  • the pressure sensor 67 can detect the pilot hydraulic pressure adjusted by the control valve 27.
  • the pressure sensor 66 can detect the pilot hydraulic pressure adjusted by the operation of the operating device 25.
  • the detection results of the pressure sensor 66 and the pressure sensor 67 are output to the work machine controller 26.
  • the control valve 27 that can adjust the pilot hydraulic pressure for the direction control valve 640 that supplies hydraulic oil to the boom cylinder 10 will be appropriately referred to as boom pressure reducing valves 270A and 270B.
  • the boom pressure reducing valves 270A and 270B are disposed in the boom operation oil passage.
  • the control valve 27 that can adjust the pilot hydraulic pressure for the direction control valve 641 that supplies hydraulic oil to the arm cylinder 11 will be appropriately referred to as arm pressure reducing valves 271A and 271B.
  • the arm pressure reducing valves 271A and 271B are disposed in the arm operation oil passage.
  • control valve 27 that can adjust the pilot hydraulic pressure for the direction control valve 642 that supplies hydraulic oil to the bucket cylinder 12 is appropriately referred to as a bucket pressure reducing valve 272.
  • Bucket pressure reducing valves 272A and 272B are disposed in the bucket operating oil passage.
  • the pressure sensor 66 that detects the pilot oil pressure of the pilot oil passage 451 connected to the direction control valve 640 that supplies the hydraulic oil to the boom cylinder 10 is appropriately referred to as a boom pressure sensor 660B, and direction control is performed.
  • the pressure sensor 67 that detects the pilot oil pressure of the pilot oil passage 452 connected to the valve 640 is appropriately referred to as a boom pressure sensor 670A.
  • the boom pressure sensor 660 disposed in the boom operation oil passage 4510A is appropriately referred to as a boom pressure sensor 660A
  • the boom pressure sensor 660 disposed in the boom operation oil passage 4510B is referred to as “boom pressure sensor 660A”.
  • This is appropriately referred to as a boom pressure sensor 660B.
  • the boom pressure sensor 670 disposed in the boom adjustment oil passage 4520A is appropriately referred to as a boom pressure sensor 670A
  • the boom pressure sensor 670 disposed in the boom adjustment oil passage 4520B is appropriately referred to as a boom pressure. This is referred to as sensor 670B.
  • the pressure sensor 66 for detecting the pilot oil pressure of the pilot oil passage 451 connected to the direction control valve 641 that supplies hydraulic oil to the arm cylinder 11 is appropriately referred to as an arm pressure sensor 661, and the direction control is performed.
  • the pressure sensor 67 that detects the pilot oil pressure of the pilot oil passage 452 connected to the valve 641 is appropriately referred to as an arm pressure sensor 671.
  • the arm pressure sensor 661 disposed in the arm operation oil passage 4511A is appropriately referred to as an arm pressure sensor 661A
  • the arm pressure sensor 661 disposed in the arm operation oil passage 4511B is referred to as “arm pressure sensor 661A”.
  • This will be referred to as an arm pressure sensor 661B as appropriate.
  • the arm pressure sensor 671 disposed in the arm adjustment oil passage 4521A is appropriately referred to as an arm pressure sensor 671A
  • the arm pressure sensor 671 disposed in the arm adjustment oil passage 4521B is appropriately referred to as an arm pressure. This is referred to as sensor 671B.
  • the pressure sensor 66 that detects the pilot oil pressure of the pilot oil passage 451 connected to the direction control valve 642 that supplies hydraulic oil to the bucket cylinder 12 is appropriately referred to as a bucket pressure sensor 662 and is used for direction control.
  • the pressure sensor 67 that detects the pilot oil pressure of the pilot oil passage 452 connected to the valve 642 is appropriately referred to as a bucket pressure sensor 672.
  • the bucket pressure sensor 661 disposed in the bucket operation oil passage 4512A is appropriately referred to as a bucket pressure sensor 661A
  • the bucket pressure sensor 661 disposed in the bucket operation oil passage 4512B is referred to as “bucket pressure sensor 661A”.
  • This will be appropriately referred to as a bucket pressure sensor 661B.
  • the bucket pressure sensor 672 disposed in the bucket adjustment oil passage 4522A is appropriately referred to as a bucket pressure sensor 672A
  • the bucket pressure sensor 672 disposed in the bucket adjustment oil passage 4522B is appropriately referred to as a bucket pressure. This is referred to as sensor 672B.
  • the work machine controller 26 controls the control valve 27 to open the pilot oil passage 450 (fully open).
  • the pilot oil passage 450 is opened, the pilot oil pressure in the pilot oil passage 451 and the pilot oil pressure in the pilot oil passage 452 become equal.
  • the pilot hydraulic pressure is adjusted based on the operation amount of the operating device 25.
  • pilot oil pressure acting on the pressure sensor 66 and the pilot oil pressure acting on the pressure sensor 67 are equal.
  • the pilot hydraulic pressure acting on the pressure sensor 66 is different from the pilot hydraulic pressure acting on the pressure sensor 67 due to the opening degree of the control valve 27 being reduced.
  • the work implement controller 26 When the work implement 2 is controlled by the work implement controller 26, such as excavation control, the work implement controller 26 outputs a control signal to the control valve 27.
  • the pilot oil passage 451 has a predetermined pressure (pilot oil pressure) by the action of a pilot relief valve, for example.
  • pilot oil in the pilot oil passage 451 is supplied to the pilot oil passage 452 via the control valve 27.
  • the pilot oil pressure in the pilot oil passage 452 is adjusted (depressurized) by the control valve 27. Pilot oil pressure in the pilot oil passage 452 acts on the direction control valve 64.
  • the direction control valve 64 operates based on the pilot hydraulic pressure controlled by the control valve 27.
  • the pressure sensor 66 detects the pilot hydraulic pressure before being adjusted by the control valve 27.
  • the pressure sensor 67 detects the pilot oil pressure after being adjusted by the control valve 27.
  • the work machine controller 26 can output a control signal to at least one of the boom pressure reducing valve 270 ⁇ / b> A and the boom pressure reducing valve 270 ⁇ / b> B to adjust the pilot hydraulic pressure for the direction control valve 640 connected to the boom cylinder 10. .
  • the work machine controller 26 can output a control signal to at least one of the arm pressure reducing valve 271 ⁇ / b> A and the arm pressure reducing valve 271 ⁇ / b> B to adjust the pilot hydraulic pressure with respect to the direction control valve 641 connected to the arm cylinder 11. .
  • the work machine controller 26 can output a control signal to at least one of the bucket pressure reducing valve 272A and the bucket pressure reducing valve 272B to adjust the pilot hydraulic pressure for the direction control valve 642 connected to the bucket cylinder 12. .
  • the work machine controller 26 As described above, the target excavation landform 43I (target excavation landform data U) indicating the design landform that is the target shape of the excavation target, and the bucket cutting edge position data S indicating the position of the bucket 8; Based on the above, the speed of the boom 6 is limited so that the speed at which the bucket 8 approaches the target excavation landform 43I decreases according to the distance d between the target excavation landform 43I and the bucket 8.
  • target excavation landform 43I target excavation landform data U
  • the bucket cutting edge position data S indicating the position of the bucket 8
  • the work machine controller 26 includes a boom limiter that outputs a control signal for limiting the speed of the boom 6.
  • the boom cutting portion of the work implement controller 26 is output so that the cutting edge 8T of the bucket 8 does not enter the target excavation landform 43I.
  • the movement of the boom 6 is controlled (boom intervention control) based on the control signal. Specifically, in the excavation control, the boom 6 is raised by the work machine controller 26 so that the cutting edge 8T does not enter the target excavation landform 43I.
  • an intervention valve 27C that operates based on a control signal related to boom intervention control that is output from the work machine controller 26 is provided in the pilot oil passage 50.
  • the pilot oil whose pressure is adjusted to the pilot hydraulic pressure flows through the pilot oil passage 50.
  • the intervention valve 27 ⁇ / b> C is arranged in the pilot oil passage 50 and can adjust the pilot oil pressure of the pilot oil passage 50.
  • the intervention oil passage oil passage 501 is connected to the boom operation oil passage 4510B and the boom adjustment oil passage 4520B connected to the direction control valve 640 via the shuttle valve 51.
  • the shuttle valve 51 has two inlets and one outlet. One inlet is connected to the intervention oil passage 501. The other inlet is connected to boom operating oil passage 4510B. The outlet is connected to boom adjusting oil passage 4520B.
  • Shuttle valve 51 connects between the oil passage 501 for intervention and the oil passage 4510B for boom operation, the oil passage having the higher pilot hydraulic pressure, and the oil passage 4520B for boom adjustment. For example, when the pilot oil pressure in the intervention oil passage 501 is higher than the pilot oil pressure in the boom operation oil passage 4510B, the shuttle valve 51 connects the intervention oil passage 501 and the boom adjustment oil passage 4520B to perform boom operation. It operates so as not to connect the oil passage 4510B and the boom adjustment oil passage 4520B.
  • pilot oil in the intervention oil passage 501 is supplied to the boom adjustment oil passage 4520B via the shuttle valve 51.
  • the shuttle valve 51 connects the boom operation oil passage 4510B and the boom adjustment oil passage 4520B to the intervention oil passage. It operates so as not to connect 501 and the boom adjustment oil passage 4520B.
  • the pilot oil in the boom operation oil passage 4510B is supplied to the boom adjustment oil passage 4520B via the shuttle valve 51.
  • the intervention oil passage 501 is provided with an intervention valve 27C and a pressure sensor 68 for detecting the pilot oil pressure of the pilot oil in the intervention oil passage 501.
  • the intervention oil passage 501 includes an intervention oil passage 501 through which pilot oil before passing through the intervention valve 27C flows, and an intervention oil passage 502 through which pilot oil passes through the intervention valve 27C.
  • the intervention valve 27C is controlled based on a control signal output from the work machine controller 26 in order to execute boom intervention control.
  • the direction control valve 64 is driven based on the pilot hydraulic pressure adjusted by the operation of the operation device 25.
  • the work machine controller 26 opens the boom operation oil passage 4510B by the boom pressure reducing valve 270B so that the direction control valve 640 is driven based on the pilot hydraulic pressure adjusted by the operation of the operation device 25 (fully opened).
  • the intervention oil passage 501 is closed by the intervention valve 27C.
  • the work machine controller 26 controls each control valve 27 so that the direction control valve 640 is driven based on the pilot hydraulic pressure adjusted by the intervention valve 27C. For example, when performing the boom intervention control that restricts the movement of the boom 6 in the excavation control, the work machine controller 26 adjusts the pilot hydraulic pressure of the intervention oil passage 50 adjusted by the intervention valve 27C by the operation device 25.
  • the intervention valve 27C is controlled so as to be higher than the pilot hydraulic pressure in the boom operation oil passage 4510B. By doing so, pilot oil from the intervention valve 27C is supplied to the direction control valve 640 via the shuttle valve 51.
  • the boom intervention control is not executed.
  • the operation device 25 is operated so that the boom 6 is raised at a high speed, and the pilot oil pressure is adjusted based on the operation amount, so that the boom operation oil passage is adjusted by the operation of the operation device 25.
  • the pilot hydraulic pressure of 4510B is higher than the pilot hydraulic pressure of the intervention oil passage 501 adjusted by the intervention valve 27C.
  • the pilot oil in the boom operation oil passage 4510 ⁇ / b> B whose pilot oil pressure is adjusted by the operation of the operating device 25 is supplied to the direction control valve 640 via the shuttle valve 51.
  • the work machine controller 26 determines whether the restriction condition is satisfied.
  • the limiting condition includes that the distance d is smaller than the first predetermined value dth1 and that the boom limiting speed Vc_bm_lmt is larger than the boom target speed Vc_bm. For example, when the boom 6 is lowered, when the magnitude of the boom limit speed Vc_bm_lmt below the boom 6 is smaller than the magnitude of the boom target speed Vc_bm below, the work machine controller 26 satisfies the restriction condition.
  • the work machine controller 26 When the limit condition is satisfied, the work machine controller 26 generates a boom intervention command CBI so that the boom is raised at the boom limit speed Vc_bm_lmt, and controls the control valve 27 of the boom cylinder 10. By doing in this way, the direction control valve 640 of the boom cylinder 10 supplies the hydraulic oil to the boom cylinder 10 so that the boom rises at the boom limit speed Vc_bm_lmt. Therefore, the boom cylinder 10 has the boom limit speed Vc_bm_lmt. 6 is raised.
  • the restriction condition may include that the absolute value of the arm speed limit Vc_am_lmt is smaller than the absolute value of the arm target speed Vc_am.
  • the restriction condition may further include other conditions.
  • the restriction condition may further include that the arm operation amount is zero.
  • the limiting condition may not include that the distance d is smaller than the first predetermined value dth1.
  • the limiting condition may be only that the limiting speed of the boom 6 is larger than the boom target speed.
  • the second predetermined value dth2 may be larger than 0 as long as it is smaller than the first predetermined value dth1.
  • both the restriction of the boom 6 and the restriction of the arm 7 are performed before the cutting edge 8T of the boom 6 reaches the target excavation landform 43I. For this reason, even before the cutting edge 8T of the boom 6 reaches the target excavation landform 43I, when the cutting edge 8T of the boom 6 is likely to exceed the target excavation landform 43I, the restriction of the boom 6 and the restriction of the arm 7 You can do both.
  • the work implement controller 26 acquires an electrical signal from a potentiometer or the like corresponding to the operating lever 25L and the right operating lever 25R. This electric signal is referred to as an operation command current value.
  • the work machine controller 26 outputs an opening / closing command based on the operation command current value to the control valve 27. From the control valve 27, hydraulic oil having a pressure corresponding to the opening / closing command is supplied to the spool of the directional control valve to move the spool, so that the boom cylinder 10, the arm cylinder 11 or the bucket cylinder 12 is operated via the directional control valve. Oil is supplied and these expand and contract.
  • the work machine controller 26 outputs an opening / closing command based on the command value of the excavation control and the operation command current value to the control valve 27.
  • the command value for excavation control is, for example, the boom intervention command CBI described above, and is a command value for executing boom intervention control in excavation control.
  • the control valve 27 to which the opening / closing command is input moves the spool by supplying hydraulic oil having a pressure corresponding to the opening / closing command to the spool of the direction control valve. Since the hydraulic oil having a pressure corresponding to the command value for excavation control is supplied to the spool of the direction control valve of the boom cylinder 10, the boom cylinder 10 extends to raise the boom 6.
  • FIG. 17, FIG. 18, FIG. 19A and FIG. 19B are views showing the relationship between the bucket 8 and the groove 70 when the groove 70 is excavated.
  • 16 and 19A show a state seen from the rear of the excavator 100
  • FIGS. 17 and 19B show a state seen from the side of the excavator 100.
  • FIG. The groove 70 is formed by groove walls 71 and 72 facing each other and a groove bottom 73 between the groove walls 71 and 72.
  • the groove 70 is excavated, for example, to bury a buried object such as a water pipe, and is refilled when the buried object is installed.
  • the positional accuracy of the groove bottom 73 is important, and the positional accuracy of the groove walls 71 and 72 is not so required.
  • the groove walls 71 and 72 may be excavated to some extent.
  • the work machine controller 26 shown in FIG. 5 sets the target excavation landform 43I (target excavation landform data U) and the cutting edge of the groove bottom 73 so that the cutting edge 8T of the bucket 8 does not dig too much into the groove bottom 73.
  • Excavation control is executed based on 8T position information.
  • excavation control is executed based on the shortest distance d between the cutting edge 8T of the bucket 8 and the target excavation landform 43I.
  • the distance to (more specifically, the groove wall 71) is the shortest.
  • the distance d is negative, that is, the cutting edge 8T is located below the target excavation landform 43I of the groove wall 71.
  • FIG. 20 is a diagram for explaining a position where the longitudinal excavation target excavation landform data U is cut out from the target excavation landform 43I.
  • FIG. 21 is a diagram for explaining a plane in which the longitudinal target excavation landform data U is cut out from the target excavation landform 43I.
  • the bucket 8 and the target excavation landform 43I are inclined in the yz plane.
  • the distance dm between the cutting edge 8T of the outermost blade 8Bt in the width direction (y-axis direction) and the target excavation landform 43I is the shortest.
  • a plane 42m shown in FIG. 21 is parallel to the xz plane and passes through the cutting edge 8T of the outermost blade 8Bt in the width direction of the bucket 8 shown in FIG. Therefore, the information of the portion where the plane 42m and the target construction surface 41 intersect becomes the front-rear direction target excavation landform data U at the position of the shortest distance d between the cutting edge 8T of the bucket 8 and the target excavation landform 43I.
  • the front-rear direction target excavation landform data U may be cut out from the target excavation landform 43I at a position in the center of the bucket 8 in the width direction.
  • the front-rear direction target excavation landform data U may be cut out from the target excavation landform 43I at a position in the center of the bucket 8 in the width direction.
  • FIG. 20 based on the distance dc between the cutting edge 8T of the blade 8Bc and the target excavation landform 43I at the center in the width direction and the longitudinal target excavation landform data U cut out at the position of the cutting edge 8T of the blade 8Bc at the center in the width direction.
  • Excavation control is performed.
  • a plane 42 shown in FIG. 21 is parallel to the xz plane and passes through the cutting edge 8T of the blade 8Bt at the center in the width direction of the bucket 8 shown in FIG. Accordingly, the information of the portion where the plane 42 and the target excavation landform 43I intersect becomes the front-rear direction target excavation landform data U at the center of the bucket 8
  • the excavation control based on the shortest distance d between the cutting edge 8T of the bucket 8 and the target excavation landform 43I, and the cutting edge 8T of the blade 8Bc and the target excavation landform 43I at the center of the bucket 8 in the width direction.
  • excavation control based on the distance dc
  • excavation control based on the distance between the outermost cutting edge 8T in the width direction of the bucket 8 and the target excavation landform 43I.
  • the operator of the excavator 100 can switch these by operating the switch 29S shown in FIG.
  • the work machine controller 26 uses the longitudinal target excavation landform data U at the center in the width direction of the bucket 8, the outer side in the width direction of the bucket 8 is the groove wall 71 or groove wall shown in FIGS. 18 and 19A. Even if 72 is dug, the rise of the bucket 8 unintended by the operator is suppressed.
  • the longitudinal target excavation landform data U is obtained even when the outer side in the width direction of the bucket 8 dug the groove wall 71 or the groove wall 72. This is because is generated from the target construction information T corresponding to the groove bottom 73. In this way, the work machine controller 26 can operate the work machine 2 as intended by the operator.
  • the groove 70 when excavating the groove 70 using the excavation control, for example, when the mode using the front-rear direction target excavation landform data U at the center position in the width direction of the bucket 8 is selected, the groove 70 is excavated.
  • the operation unintended by the operator can be avoided to some extent.
  • the operator forgets to select the mode using the front-rear direction target excavation landform data U at the center position in the width direction of the bucket 8. There is. In such a case, an operation unintended by the operator may occur.
  • the operator In order to suppress the operation of the bucket 8 that is not intended, the above-described width direction target excavation landform data Uw is used.
  • ⁇ Excavation control when excavating the groove 70> 22 and 23 are diagrams for explaining a plane 45 for cutting out the width direction target excavation landform data Uw.
  • the plane 45 as the first cut-out surface is the second target construction that connects the width direction target excavation landform data Uw to the side of the target construction surface 41 and the target construction surface 41 as the first target construction surface indicating the target shape. Cut out from the target construction surface 41S as a surface.
  • the plane 42 as the second cut-out surface cuts out the longitudinal target excavation landform data U described above from the target construction surface 41 as the first target construction surface indicating the target shape.
  • the plane 45 intersects with the work machine operation plane (orthogonal in the present embodiment) and is a plane parallel to the vertical direction in the global coordinate system.
  • the plane 42 is an operation plane of the work machine 2 or a plane parallel to the operation plane.
  • a predetermined plane on which the arm 2 operates in the working machine 2 shown in FIG. 1, that is, the above-described arm operation plane or a plane parallel to the arm operation plane is the plane 42.
  • the excavation target position 44 is an intersection of the perpendicular line drawn down in the vertical direction and the target construction surface 41 passing through the cutting edge position P4 of the cutting edge 8T at the current time in the global coordinate system.
  • the cutting edge position P4 is the shortest distance between the cutting edge 8T and the target excavation landform 43I, whether the target excavation landform 43I is cut out from the target construction surface 41 at the center in the width direction of the bucket 8, or the target excavation landform 43I is cut out outside in the width direction.
  • the position in the width direction of the bucket 8 changes.
  • the position information of the target construction surface 41 at the portion where the plane 42 and the target construction surface 41 intersect is the longitudinal target excavation landform data U.
  • the target excavation landform 43I in the front-rear direction is generated by the front-rear direction target excavation landform data U.
  • the position information of the portion where the plane 45 and the target construction surface 41 shown in FIG. 22 intersect in the side view of the excavator 100 with respect to the intersection line 43 that is, the position information of the intersection line 46.
  • a target excavation landform 46I in the width direction is generated based on the width-direction target excavation landform data Uw.
  • FIG. 24 is a diagram showing a relationship between the target excavation landform 46I and the bucket 8 of the excavator 100 when excavating the groove 70.
  • the groove 70 shown in FIG. 24 includes the first inflection point Pv1, the second inflection point Pv2, the third inflection point Pv3, and the first inflection landform 46I, that is, the information included in the width direction target excavation landform data Uw. It is represented by four inflection points Pv4 and a straight line connecting them. Between the first inflection point Pv1 and the second inflection point Pv2 is the groove bottom 73, and between the second inflection point Pv2 and the third inflection point Pv3 is the groove wall 71, and the first inflection point.
  • the groove wall 72 is between the point Pv1 and the third inflection point Pv3.
  • the straight lines LN1, LN2, and LN3 in FIG. 24 are horizontal lines in the yz plane in the local coordinate system (x, y, z), that is, lines parallel to the y axis.
  • a plane including the straight line LN1, the straight line LN2, or the straight line LN3 and orthogonal to the z axis in the local coordinate system (x, y, z) is a plane parallel to the xy plane in the local coordinate system (x, y, z), that is, the local It is a horizontal plane of a coordinate system (x, y, z).
  • the relationship between the horizontal plane in the local coordinate system (x, y, z) and the vertical direction varies depending on the attitude of the excavator 100.
  • the coordinates of the first inflection point Pv1 are (y1, z1)
  • the coordinates of the second inflection point Pv2 are (y2, z2)
  • the coordinates of the third inflection point Pv3 are (y3, z3)
  • the fourth inflection point is (y4, z4)
  • the angle ⁇ of the target excavation landform 46I with respect to the horizontal plane of the local coordinate system (x, y, z) can be obtained using coordinates such as the first inflection point Pv1 and the second inflection point Pv2. For example, in the example shown in FIG.
  • the angle ⁇ 1 formed by the straight line connecting the straight line LN1 and the straight line LN1 can be obtained by arctan ((z2-z1) / (y2-y1)).
  • the angle ⁇ 2 of the target excavation landform 46I on the right side when viewed from the rear of the excavator 100 with respect to the horizontal plane of the local coordinate system (x, y, z) is obtained by arctan ((z3-z2) / (y3-y2)). Can do.
  • the angle ⁇ 3 of the target excavation landform 46I on the left side when viewed from the rear of the excavator 100 with respect to the horizontal plane of the local coordinate system (x, y, z) is obtained by arctan ((z1-z4) / (y1-y4)). Can do.
  • the angle ⁇ of the target excavation landform 46I with respect to the horizontal plane of the local coordinate system (x, y, z) can be obtained from the coordinates of at least two inflection points.
  • the target excavation landform 43I in the front-rear direction is also acquired in the same manner.
  • the work machine controller 26 excavates based on the position of the work machine 2 acquired from the display controller 28, more specifically, the blade edge position P4 of the bucket 8, the longitudinal target excavation landform data U, and the width direction target excavation landform data Uw. Execute control. More specifically, the work machine controller 26 performs excavation control in the front-rear direction of the work machine 2 based on the front-rear direction target excavation landform data U, and the control availability determination unit 58 of the work machine controller 26 illustrated in FIG. Based on the width direction target excavation landform data Uw, the excavation control being executed is stopped or the excavation control being stopped is resumed. Thus, in this embodiment, the control amount of the boom 6 in the excavation control is obtained based on the longitudinal target excavation landform data U. The width direction target excavation landform data Uw is used to determine whether to stop or execute excavation control.
  • the control availability determination unit 58 of the work machine controller 26 acquires the width direction target excavation landform data Uw from the display controller 28.
  • the control availability determination unit 58 performs excavation control when the angle ⁇ with respect to the horizontal plane of the width-direction target excavation landform data Uw immediately below the bucket 8 is equal to or greater than a predetermined size (hereinafter referred to as an appropriate inclination angle threshold) ⁇ c.
  • a predetermined size hereinafter referred to as an appropriate inclination angle threshold
  • the inclination angle threshold ⁇ c is 70 degrees, but is not limited to this. In the example shown in FIG.
  • the angle ⁇ 1 of the width-direction target excavation landform data Uw immediately below the bucket 8 with respect to the horizontal plane corresponding to the straight line LN1 is smaller than the inclination angle threshold value ⁇ c.
  • the control availability determination unit 58 continues the excavation control being executed.
  • the control availability determination unit 58 stops the excavation control being executed. As a result, even if the bucket 8 excavates the groove wall 71, the work machine controller 26 does not move the bucket 8 in the direction away from the groove wall 71, and moves the boom 6, the arm 7 and the bucket 8 to the respective boom target speeds.
  • Control is performed based on Vc_bm, arm target speed Vc_am, and bucket target speed Vc_bkt.
  • the upper swing body 3 rotates leftward as viewed from the rear of the excavator 100, and the groove bottom 73 is positioned again immediately below the bucket 8. .
  • the angle ⁇ 1 of the width direction target excavation landform data Uw immediately below the bucket 8 with respect to the horizontal plane corresponding to the straight line LN1 is smaller than the inclination angle threshold value ⁇ c.
  • the control availability determination unit 58 resumes the stopped excavation control.
  • the work machine controller 26 may execute excavation control based on the target excavation landform in the width direction.
  • the mode for setting the longitudinal target excavation landform data U at the center position in the width direction of the bucket 8 has been described. May be included. Next, an example of control when excavating the groove 70 by using the work machine control method according to the present embodiment will be described.
  • FIG. 25 is a flowchart showing a control example when excavating the groove 70.
  • the display controller 28 shown in FIG. 5 sets the inclination angles ⁇ 1, ⁇ 2, and ⁇ 3 from the sensor controller 39 in step S102.
  • the bucket edge position data S is generated from the acquired inclination angles ⁇ 1, ⁇ 2, ⁇ 3 and the turning center position data XR of the excavator 100.
  • the work machine controller 26 illustrated in FIG. 5 obtains a distance d between the target excavation landform 43I and the blade edge 8T of the bucket 8.
  • step S104 the work machine controller 26 obtains the cutting edge speed in the direction of the target excavation landform 43I, specifically, the boom target speed Vc_bm when the operator of the excavator 100 operates the work machine 2.
  • step S105 the control availability determination unit 58 of the work machine controller 26 shown in FIG. 26 to obtain an angle ⁇ of the target excavation landform 46I with respect to the horizontal plane.
  • the control availability determination unit 58 compares the obtained angle ⁇ with the inclination angle threshold value ⁇ c. As a result of the comparison, if ⁇ ⁇ ⁇ c (step S105, Yes), the groove walls 71 and 72 of the groove 70 are directly below the bucket 8. For this reason, in step S106, the control availability determination unit 58 stops the excavation control. In this case, the work implement 2 operates according to the operation of the work implement controller 26 by the operator.
  • step S105 If ⁇ ⁇ c (step S105, No), the portion immediately below the bucket 8 is not the groove walls 71 and 72 of the groove 70, so that excavation control may be executed. In this case, in step S107, the control availability determination unit 58 executes excavation control. For this reason, when the cutting edge 8T of the bucket 8 tries to excavate the object to be excavated beyond the target excavation landform 46I, the work machine controller 26 raises the boom 6, for example, and the bucket 8 exceeds the target excavation landform 46I. Suppress digging.
  • FIG. 26 is a diagram illustrating a state in which the bucket 8 of the excavator 100 faces the side wall 71a when the groove 70 is excavated.
  • FIG. 27 is a diagram illustrating a state in which the bucket 8 is viewed from the rear of the excavator 100.
  • FIG. 28 is a diagram for explaining a speed component when the bucket 8 approaches the side wall 71a.
  • FIG. 29 is a diagram illustrating the distance d between the blade edge 8T of the bucket 8 and the side wall 71a.
  • FIG. 30 is a diagram for explaining the boom speed limit Vc_bm_lmt.
  • the target excavation landform 46I width direction target excavation landform data Uw
  • excavation control is executed. For example, as shown in FIG. 26, when the excavator 100 is excavating the ground 73A, for example, when the upper swing body 3 turns (in this example, the direction indicated by the arrow RD in FIG. 26), the work machine 2 May move toward the side wall 71a.
  • the excavation control is stopped in the first embodiment for excavation of the groove, but in this embodiment, the working machine 2 is configured so that the bucket 8 does not dig beyond the target excavation landform 74 of the side wall 71a.
  • Excavation control is also executed in the width direction. Specifically, for example, when the bucket 8 is approaching at a speed Vct toward the side wall 71a as shown in FIG. 27, the work machine controller 26 exceeds the target excavation landform 74 of the side wall 71a. If it is determined that there is a possibility of digging, for example, the boom 6 shown in FIG.
  • the work machine controller 26 performs excavation control in the width direction when the speed component in the width direction is generated in the work machine 2.
  • the speed component in the width direction of the work machine 2 is generated by the turning of the upper swing body 3 shown in FIG. Further, even when the work implement 2 is inclined with respect to the traveling direction of the traveling device 5 on the xy plane in the local coordinate system of the excavator 100, a speed component in the width direction of the work implement 2 is generated.
  • excavation control in the width direction is executed when the turning of the upper-part turning body 3 occurs will be described, but when a speed component in the width direction of the work implement 2 is generated by the traveling of the traveling device 5
  • excavation control in the width direction may be executed. Further, when the traveling device 5 is traveling, the excavation control in the width direction may be stopped.
  • FIG. 31 is a flowchart showing a processing example of excavation control in the width direction.
  • excavation control in the width direction is performed so that the bucket 8 does not dug the side wall 71a of the groove 70 excessively will be described.
  • the target excavation landform 74 in the width direction is acquired in the same manner as when the target excavation landform 46I (width direction target excavation landform data Uw) is acquired based on the excavation target position 44 shown in FIG.
  • the storage unit 26M of the work machine controller 26 illustrated in FIG. 5 stores information that defines the relationship between the turning operation amount MR and the turning target angular velocity ⁇ ct as target speed information. .
  • the target speed determination unit 52 shown in FIG. 5 acquires the turning operation amount MR from the operating device 25, and obtains the turning target angular speed ⁇ ct from the obtained turning operation amount MR.
  • the target speed determination unit 52 determines the rotation axis shown in FIG. 3A from the inclination angles ⁇ 1, ⁇ 2, ⁇ 3, the length L1 of the boom 6, the length L2 of the arm 7, and the length L3 of the bucket 8.
  • a distance LR between z and the cutting edge 8T of the bucket 8 is obtained.
  • This distance LR is the turning radius of the cutting edge 8T.
  • the target speed determination unit 52 obtains the turning target speed Vct of the cutting edge 8T by multiplying the turning target angular speed ⁇ ct by the turning radius (distance LR) of the cutting edge 8T.
  • step S24 the target speed determination unit 52 converts the turning target speed Vct into a speed component in the direction perpendicular to the target excavation landform 74 (width direction target excavation landform data Uw) (hereinafter, Vcy_t (referred to as a vertical velocity component as appropriate) and a velocity component in a direction parallel to the target excavation landform 74 (width direction target excavation landform data Uw) (hereinafter referred to as a horizontal velocity component as appropriate) Vcx_t.
  • the vertical velocity component Vcy_t and the horizontal velocity component Vcx_t are obtained for the target excavation landform 74 corresponding to the side wall 71a.
  • FIG. 28 the vertical velocity component in the vertical velocity component Vcy_t and the horizontal velocity component Vcx_t are obtained for the target excavation landform 74 corresponding to the side wall 71a.
  • the side wall 71a is inclined by an angle ⁇ with respect to the horizontal plane HL of the local coordinate system (x, y, z) of the excavator 100, that is, a plane parallel to the xy plane. Therefore, the vertical velocity component Vcy_t can be obtained by Vct ⁇ cos ( ⁇ / 2 ⁇ ), and the horizontal velocity component Vcx_t can be obtained by Vct ⁇ sin ( ⁇ / 2 ⁇ ).
  • step S25 the distance acquisition unit 53 of the work machine controller 26 shown in FIG. 5 acquires the distance d between the cutting edge 8T of the bucket 8 and the target excavation landform 74 corresponding to the side wall 71a, as shown in FIG. .
  • the distance acquisition unit 53 determines the blade edge 8T and the target in the width direction center of the bucket 8 from the position information of the blade edge 8T acquired as described above and the width direction target excavation landform data Uw indicating the position of the target excavation landform 74.
  • a distance d from the excavation landform 74 is calculated.
  • the distance acquisition unit 53 calculates the shortest distance between the cutting edge 8T of the bucket 8 and the target excavation landform 74, and the work machine controller 26 executes excavation control in the width direction based on this distance. Also good.
  • step S26 the speed limit determining unit 54 of the work machine controller 26 shown in FIG. 5 limits the work machine 2 as a whole shown in FIG.
  • the speed Vcy_lmt is calculated.
  • the speed limit Vcy_lmt of the work machine 2 as a whole is the same as that in the first embodiment, and thus the description thereof is omitted.
  • step S27 the speed limit determining unit 54 subtracts the vertical speed component Vcy_t of the turning target speed Vct from the speed limit Vcy_lmt of the entire work machine 2, as shown in FIG. Is calculated.
  • step S28 the speed limit determining unit 54 converts the limited vertical speed component Vcy_bm_lmt of the boom 6 into a speed limit (boom speed limit) Vc_bm_lmt of the boom 6, as shown in FIG. Specifically, the boom speed limit Vc_bm_lmt is obtained by multiplying the limited vertical speed component Vcy_bm_lmt by sin ( ⁇ / 2 ⁇ ).
  • step S29 when the pilot pressure based on the boom intervention command CBI is higher than the pilot pressure generated based on the operation of the boom 6, the work machine control unit 57 of the work machine controller 26 determines that the speed of the boom 6 is the boom limit speed.
  • the boom command signal CB is generated so as to be Vc_bm_lmt, and the intervention valve 27C shown in FIGS. 2 and 15 is controlled.
  • the work machine controller 26a may execute both the excavation control in the width direction and the excavation control in the front-rear direction in parallel.
  • the work machine controller 26 may switch between excavation control in the front-rear direction and excavation control in the width direction depending on whether the work machine 2 is turned.
  • the work machine controller 26 stops the excavation control in the front-rear direction, executes only the excavation control in the width direction, and stops turning of the work machine 2
  • the excavation control in the width direction may be stopped and the excavation control in the front-rear direction may be resumed.
  • the work machine controller 26 may execute excavation control based on the target excavation landform in the width direction. Next, excavation control based on a speed obtained by combining the turning target speed Vct and the target speed Vft in the front-rear direction will be described.
  • FIG. 32 is a flowchart showing excavation control processing based on a speed obtained by synthesizing the turning target speed Vct and the longitudinal target speed Vft.
  • FIG. 33 is an explanatory diagram of a method for obtaining the target speed Vft in the front-rear direction.
  • FIG. 34 is a diagram illustrating a method of obtaining a speed Vt obtained by combining the turning target speed Vct and the target speed Vft in the front-rear direction.
  • FIG. 35 is a diagram for explaining a speed component when the bucket 8 approaches the target excavation landform 74 corresponding to the side wall 71a.
  • FIG. 36 is a diagram for explaining the boom speed limit Vt_bm_lmt.
  • step S31 the target speed determination unit 52 shown in FIG. 5 obtains the turning target speed Vct of the work implement 2 and the target speed Vft in the front-rear direction. Since the method for obtaining the turning target speed Vct is as described above, a description thereof will be omitted.
  • the target speed Vft in the front-rear direction of the work machine 2 is obtained as follows. As shown in FIG. 33, the target speed determination unit 52 calculates the boom target speed Vc_bm in the vertical axis direction of the local coordinate system from the angle ⁇ 2 formed by the vertical axis of the local coordinate system and the direction of the boom target speed Vc_bm by a trigonometric function. Speed component VL1_bm and a horizontal axis direction speed component VL2_bm.
  • the target speed determination unit 52 calculates the arm target speed Vc_am from the angle ⁇ 3 formed by the vertical axis of the local coordinate system and the direction of the arm target speed Vc_am by using a trigonometric function and the horizontal component of the speed component VL1_am in the vertical axis direction of the local coordinate system. It converts into the direction velocity component VL2_am.
  • the target speed determination unit 52 calculates the bucket target speed Vc_bk from the angle ⁇ 4 between the vertical axis of the local coordinate system and the direction of the bucket target speed Vc_bk by using a trigonometric function and the horizontal axis of the speed component VL1_bk in the vertical direction of the local coordinate system It converts into the direction velocity component VL2_bk.
  • the target speed determination unit 52 subtracts the speed component VL2_bm in the boom horizontal axis direction from the speed component VL2_am in the horizontal axis direction of the arm and the speed component VL2_bk in the horizontal axis direction of the bucket. This value is the target speed Vft in the front-rear direction.
  • the target speed determination unit 52 obtains a speed Vt obtained by combining these in step S32 (see FIG. 34).
  • the speed Vt obtained by combining the turning target speed Vct and the target speed Vft in the front-rear direction is referred to as a control target speed Vt.
  • Control target speed Vt can be determined by ⁇ (Vct 2 + Vft 2) .
  • step S33 the target speed determination unit 52 sets the control target speed Vt to a speed component in the direction perpendicular to the target excavation landform 74 (width direction target excavation landform data Uw) (hereinafter, Vty_t (referred to as a vertical velocity component as appropriate) and a velocity component in a direction parallel to the target excavation landform 74 (width direction target excavation landform data Uw) (hereinafter referred to as a horizontal velocity component as appropriate) Vtx_t.
  • Vty_t referred to as a vertical velocity component as appropriate
  • a velocity component in a direction parallel to the target excavation landform 74 width direction target excavation landform data Uw
  • the side wall 71a is inclined by an angle ⁇ with respect to the horizontal plane HL of the local coordinate system (x, y, z) of the excavator 100, that is, a plane parallel to the xy plane. Therefore, the vertical velocity component Vty_t can be obtained by Vt ⁇ cos ( ⁇ / 2 ⁇ ), and the horizontal velocity component Vtx_t can be obtained by Vt ⁇ sin ( ⁇ / 2 ⁇ ).
  • step S34 the distance acquisition unit 53 of the work machine controller 26 shown in FIG. 5 performs the distance between the cutting edge 8T of the bucket 8 and the target excavation landform 74 corresponding to the side wall 71a as shown in FIG. d is acquired. Specifically, the distance acquisition unit 53 obtains the cutting edge 8T and the target in the width direction center of the bucket 8 from the position information of the cutting edge 8T acquired as described above and the width direction target excavation landform data Uw indicating the position of the target excavation landform 46I. A distance d between the excavation landform 46I is calculated. In this case, the distance acquisition unit 53 calculates the shortest distance between the cutting edge 8T of the bucket 8 and the target excavation landform 46I, and the work machine controller 26 executes excavation control in the width direction based on this distance. Also good.
  • step S35 the speed limit determining unit 54 of the work machine controller 26 illustrated in FIG. 5 limits the entire work machine 2 illustrated in FIG. 1 based on the distance d between the cutting edge 8T of the bucket 8 and the target excavation landform 46I.
  • the speed Vty_lmt is calculated.
  • the speed limit Vty_lmt of the work machine 2 as a whole is the same as that in the first embodiment, and thus the description thereof is omitted.
  • step S36 the speed limit determining unit 54 subtracts the vertical speed component Vty_t of the turning target speed Vct from the speed limit Vty_lmt of the work implement 2 as a whole, as shown in FIG. 36, thereby limiting the vertical speed component Vty_bm_lmt of the boom 6 Is calculated.
  • step S37 the speed limit determining unit 54 converts the limited vertical speed component Vty_bm_lmt of the boom 6 into a speed limit (boom speed limit) Vt_bm_lmt of the boom 6, as shown in FIG. Specifically, the boom limit speed Vt_bm_lmt is obtained by multiplying the limited vertical speed component Vty_bm_lmt by sin ( ⁇ / 2 ⁇ ).
  • step S38 when the pilot pressure based on the boom intervention command CBI is higher than the pilot pressure generated based on the operation of the boom 6, the work machine control unit 57 of the work machine controller 26 determines that the speed of the boom 6 is the boom limit speed.
  • a boom command signal CB is generated so as to be Vt_bm_lmt, and the intervention valve 27C shown in FIG. 2 is controlled.
  • the work machine controller 26 uses a control target speed Vt obtained by synthesizing the turning target speed Vct and the front-rear direction target speed Vft, so that the target in consideration of the operation in the front-rear direction and the width direction of the work machine 2 is considered.
  • the excavation landform 74 can be acquired. For this reason, in the excavation control, switching between the front-rear direction and the width direction of the work machine 2 is not necessary, so that smooth excavation control can be realized.
  • the turning target speed Vct of the cutting edge 8T is obtained based on the turning operation amount MR obtained from the operating device 25.
  • the turning target speed Vct of the cutting edge 8T is turned based on the detection result of the IMU 24 shown in FIG. 2 and the reference position data P1, P2 of the GNSS antennas 21, 22 detected by the position detection device 19.
  • a target speed Vct is obtained.
  • the position of the work machine 2 is predicted using the detection result of the IMU 24 and the reference position data P1 and P2 of the GNSS antennas 21 and 22 detected by the position detection device 19.
  • FIG. 37 is a block diagram showing the display controller 28 and a work machine controller 26a and a sensor controller 39a according to a modification.
  • 38A and 38B are views showing the posture of the excavator 100.
  • the work machine controller 26a is the same as the work machine controller 26 (see FIG. 5) described in the first embodiment, but is different in that it includes a prediction correction unit 59.
  • the prediction correction unit 59 acquires, from the display controller 28, the swing body orientation data Q indicating the orientation of the upper swing body 3, that is, the work implement 2 is facing.
  • the prediction correction unit 59 acquires the turning angular velocity ⁇ of the upper turning body 3 from the IMU 24.
  • the prediction correction unit 59 predicts and corrects the turning body orientation data Q based on the turning angular velocity data D ⁇ .
  • the prediction correction unit 59 calculates the predicted rotation angle ⁇ ⁇ t by multiplying the turning angular velocity ⁇ by the delay time t.
  • the delay time t is a time predicted to be required to generate the bucket edge position data S and the target excavation landform data U.
  • the position detection device 19 is, for example, 100 msec. Since the reference position data P1 and P2 of the GNSS antennas 21 and 22 are detected and output to the display controller 28 with a period of about, the bucket edge position data S and the target excavation landform data U output from the display controller 28 are used as the work machine controller. 26 for acquisition, at least 100 msec. It takes some time. Further, when an interrupt calculation occurs in the display controller 28, it takes more time for the work implement controller 26 to acquire the bucket blade tip position data S and the target excavation landform data U.
  • the prediction correction unit 59 performs prediction based on the orientation of the swing body orientation data Q of the upper swing body 3 acquired from the bucket blade position data generation unit 28B, the angular velocity ⁇ acquired from the IMU 29, and the predicted delay time t. Corrected revolving body azimuth data R indicating the predicted azimuth at the time of rotation by the rotation angle ⁇ ⁇ t is generated. The predicted direction indicated by the corrected turning body orientation data R is the orientation of the upper turning body 3, that is, the work implement 2 at the time when the target excavation landform data U is generated.
  • the prediction correction unit 59 obtains the inclination angle ⁇ 4 with respect to the width direction of the upper swing body 3 and the tilt angle ⁇ 5 with respect to the front-rear direction of the upper swing body 3 from the IMU 24.
  • the prediction correction unit 59 calculates the predicted orientation of the upper swing body 3 based on the corrected swing body orientation data R from the predicted bearing data R, the tilt angle ⁇ 4, and the tilt angle ⁇ 5.
  • the prediction correction unit 59 calculates predicted tilt angles ⁇ 4 ′ and ⁇ 5 ′ in the predicted direction.
  • FIG. 38A after the hydraulic excavator 100 is working forward on an inclined ground having an inclination angle ⁇ 6, the prediction is made while assuming that the upper swing body 3 turns sideways as shown in FIG. 38B.
  • the inclination angles ⁇ 4 ′ and ⁇ 5 ′ will be described.
  • the tilt angle ⁇ 5 with respect to the longitudinal direction of the upper swing body 3 before and after the turning operation gradually decreases from ⁇ 6 to zero.
  • the inclination angle ⁇ 4 with respect to the lateral direction gradually increases from 0 to ⁇ 6. Therefore, the prediction correction unit 59 can calculate the predicted inclination angles ⁇ 4 ′ and ⁇ 5 ′ after the delay time t has elapsed based on the turning angular velocity ⁇ .
  • the prediction correction unit 59 outputs the predicted inclination angles ⁇ 4 ′ and ⁇ 5 ′ to the bucket blade edge position data generation unit 28B.
  • FIG. 39 is a flowchart for explaining processing in which the prediction correction unit 59 updates the corrected turning body orientation data R.
  • FIG. 40 is a diagram for explaining the processing of the prediction correction unit 59 that is executed in accordance with the operation of the upper swing body 3. The update of the corrected turning body orientation data R of the prediction correction unit 59 will be described with reference to FIGS. 38A, 38B, and 40.
  • step S202 the prediction correction unit 59 calculates a turning angular velocity ⁇ centered on the turning axis z, an inclination angle ⁇ 4 with respect to the front-rear direction of the upper turning body 3, and an inclination angle ⁇ 5 with respect to the left-right direction of the upper turning body 3, for example. Obtained from the IMU 24 at a 100 Hz period (an example of a first period).
  • step S203 the prediction correction unit 59 obtains the turning body orientation data Q and uses the latest turning angular velocity ⁇ to turn the upper turning body 3 after turning by ⁇ ⁇ t.
  • step S204 the prediction correction unit 59 outputs the updated corrected turning body orientation data R and the predicted inclination angles ⁇ 4 ′ and ⁇ 5 ′ to the bucket edge position data generation unit 28B.
  • the prediction correction unit 59 updates the corrected turning body orientation data R and the predicted inclination angles ⁇ 4 ′ and ⁇ 5 ′ by repeating steps S201 to S204 each time the turning body orientation data Q is acquired.
  • the prediction correction unit 59 uses the turning angular velocity ⁇ and the inclination angles ⁇ 4 and ⁇ 5 generated by the IMU 24 whose measurement cycle is earlier than the turning body orientation data Q, so that the corrective turning is performed at a period higher than the turning body orientation data Q.
  • Body orientation data R and predicted inclination angles ⁇ 4 ′ and ⁇ 5 ′ can be generated.
  • the corrected swing body orientation data R and the predicted tilt angles ⁇ 4 ′ and ⁇ 5 ′ are the swing bodies in which the swing angular velocity ⁇ and the tilt angles ⁇ 4 and ⁇ 5 that may include fluctuations in thermal drift are acquired from the global coordinate calculation unit 23. It can also be updated with the direction data Q. Therefore, it is possible to output the corrected turning body azimuth data R and the predicted inclination angles ⁇ 4 ′ and ⁇ 5 ′ related to the period for generating the target excavation landform data U with respect to the delay time t.
  • the prediction correction unit 59 corrects the turning body orientation data Q based on the turning angular speed ⁇ (an example of motion data) indicating the turning angular speed ⁇ of the upper turning body 3 and the delay time t, thereby correcting the corrected turning body direction data.
  • R an example of corrected swivel arrangement data
  • the bucket blade tip position data generation unit 28B uses bucket blade tip position data S (work machine position data) indicating the position of the blade tip 8T of the bucket 8. Example).
  • the target excavation landform data generation unit 28C generates the target excavation landform data U based on the bucket blade tip position data S and the target construction information T.
  • the delay time t includes a time required for generating the bucket edge position data S and the target excavation landform data U and a communication time necessary for the work implement controller 26 to acquire the generated target excavation landform data U. Yes.
  • the time required for generating the bucket edge position data S and the target excavation landform data U takes into account a calculation delay when an interrupt calculation is generated in the display controller 28.
  • the delay time t is assumed to be about 0.4 seconds. However, the delay time t is appropriately changed according to the specifications of the work machine controller 26 and the display controller 28. it can.
  • the prediction correction unit 59 can predict the direction in which the upper swing body 3 is facing when the target excavation landform data U is generated, based on the swing angular velocity ⁇ of the upper swing body 3. Therefore, the bucket blade tip position data generation unit 28B can predict the position of the blade tip 8T of the bucket 8 (the position of the work implement 2) at the time when the delay time t has elapsed. As a result, the target excavation landform data generation unit 28C can generate the target excavation landform data U corresponding to the position of the cutting edge 8T of the bucket 8 when the delay time t has elapsed.
  • the bucket 8 Since the work machine controller 26 executes the excavation control in the width direction using the target excavation landform data U in which the delay time t is taken into account, the bucket 8 is based on the target excavation landform data U that is close to the portion to be excavated from now on.
  • the work machine 2 can be controlled.
  • the prediction correction unit 59 acquires the turning angular velocity ⁇ , for example, at 100 Hz (an example of the first cycle), and acquires the turning body orientation data Q, for example, at 10 Hz (an example of the second cycle). Therefore, the prediction correction unit 59 can generate the corrected turning body orientation data R by using the turning body orientation data Q acquired periodically. For this reason, even if a thermal drift occurs in the IMU 24 that generates the turning angular velocity ⁇ , for example, the corrected orientation can be calculated based on the turning body orientation data Q updated every 10 Hz. As a result, the corrected turning body direction data R indicating the corrected direction can be continuously generated.
  • the IMU 24 acquires the turning angular velocity ⁇ indicating the turning angular velocity ⁇ of the upper swing body 3 and the inclination angles ⁇ 4 and ⁇ 5 as the operation data indicating the operation of the upper swing body 3. It is not something that can be done.
  • the IMU 24 may acquire a change in the inclination angle indicating the inclination of the upper swing body 3.
  • the inclination angle of the upper swing body 3 is a change amount of the inclination angles ⁇ 4 and ⁇ 5 (see FIGS. 3A and 3B) per unit time.
  • the topographic data generation unit 28C can generate the target excavation topographic data U corresponding to the position of the cutting edge 8T of the bucket 8 when the delay time t has elapsed.
  • the prediction correction unit 59 acquires the turning angular velocity ⁇ generated by the IMU 24, but is not limited thereto.
  • the prediction correction unit 59 can acquire the turning angular velocity ⁇ based on the rotation angle detected by the potentiometer installed on the upper turning body 3 and the turning operation amount MR output from the operating device 25.
  • the prediction correction unit 59 can also acquire the reference position data P1 and P2 of the GNSS antennas 21 and 22 from the global coordinate calculation unit 23, and can acquire the turning angular velocity ⁇ based on the two reference position data P1 and P2. .
  • the bucket blade edge position data generation unit 28B calculates the position of the turning center of the excavator 100 based on the reference position data P1 and the turning body orientation data Q.
  • the bucket blade tip position data generation unit 28B replaces the swing body orientation data Q with data acquired by an orientation sensor such as a magnetic sensor indicating the orientation of the upper swing body 3 at the time when the GNSS antenna 21 receives the reference position data P1. It may be used.
  • the prediction correction unit 59 acquires the turning body orientation data Q from the global coordinate calculation unit 23 at, for example, a 10 Hz period (an example of the second period), but it is necessary to consider the thermal drift of the IMU 24. If not, the revolving body orientation data Q may be acquired at least once. In this case, the prediction correction unit 59 updates the orientation of the upper swing body 3 with, for example, a 100 Hz cycle (an example of the first cycle) by adding the turning angular velocity ⁇ as needed based on the acquired swing body orientation data Q. be able to.
  • the display controller 28 generates the bucket blade edge position data S as the work machine position data, but is not limited thereto.
  • the display controller 28 may acquire position data indicating an arbitrary position of the bucket 8 in place of the bucket blade edge position data S. Further, the display controller 28 may acquire position data indicating an arbitrary position closer to the target excavation landform data Ua of the bucket edge position data S.
  • the work implement controller 26 may execute at least one of the storage of the target construction information performed by the display controller 28, the generation of the bucket edge position data, and the generation of the target excavation landform data. Each process executed by the sensor controller 39 may be executed by the work machine controller 26.
  • the excavator 100 can execute both excavation control based on the target excavation landform 46I in the width direction of the work machine 2 and excavation control in the front-rear direction based on the target excavation landform 43I in the front-rear direction of the excavator 100. Also good.
  • the excavator 100 may be capable of executing excavation control based only on the target excavation landform 46I in the width direction of the work machine 2.
  • Embodiment 1 and Embodiment 2 were demonstrated, Embodiment 1 and Embodiment 2 are not limited by the content mentioned above.
  • the above-described constituent elements include those that can be easily assumed by those skilled in the art, those that are substantially the same, and those in a so-called equivalent range.
  • the above-described components can be appropriately combined.
  • at least one of various omissions, substitutions, and changes of the components can be made without departing from the gist of the first and second embodiments.
  • the work machine 2 includes the boom 6, the arm 7, and the bucket 8, but the attachment attached to the work machine 2 is not limited to this, and is not limited to the bucket 8.
  • the work machine is not limited to the hydraulic excavator 100, and may be, for example, a bulldozer or a motor grader.

Landscapes

  • Engineering & Computer Science (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Operation Control Of Excavators (AREA)

Abstract

 作業具を有する作業機を備える作業機械を制御する作業機械の制御システムであって、前記作業機械の位置情報を検出する位置検出部と、前記位置検出部によって検出された前記位置情報に基づき前記作業機の位置を求め、かつ前記アームが動作する平面であるアーム動作平面と交差し、かつ鉛直方向と平行な第1切り出し面とが交差する部分の情報である第2目標掘削地形情報を生成する生成部と、前記生成部から取得した前記作業機の位置、前記第1目標掘削地形情報に基づいて、前記作業機が掘削対象に接近する方向の速度が制限速度以下になるように制御する掘削制御を実行する作業機制御部と、を含む。

Description

作業機械の制御システム、作業機械及び作業機械の制御方法
 本発明は、作業機を備えた作業機械の制御システム、作業機械及び作業機械の制御方法に関する。
 従来、バケットを含むフロント装置を備える建設機械において、掘削対象の目標とする地形に沿ってバケットを移動させて、目標とする地形を侵食しないようにするための制御が提案されている(例えば、特許文献1)。
特開2013-217137号公報
 ところで、目標とする地形を侵食しないように作業機が制御されているときに、不要な目標とする地形が出現することがある。このような場合、作業機が急に上昇する等、作業機の操作と異なる動作にオペレータは違和感を覚えることがある。
 本発明は、オペレータが意図する通りに作業機を動作させることを目的とする。
 本発明は、作業具を有する作業機を備える作業機械を制御する制御システムであって、前記作業機械の位置情報を検出する位置検出部と、前記位置検出部によって検出された前記位置情報に基づき前記作業機の位置を求め、かつ目標形状を示す少なくとも1つの目標施工面と、前記作業機が動作する平面である作業機動作平面と交差し、かつ鉛直方向と平行な第1切り出し面とが交差する部分の情報である第1目標掘削地形情報を生成する生成部と、前記生成部から取得した前記第1目標掘削地形情報に基づいて、前記作業機が掘削対象に接近する方向の速度が制限速度以下になるように制御する掘削制御を実行する作業機制御部と、を含む、作業機械の制御システムである。
 前記生成部は、少なくとも一つの前記目標施工面と、前記作業機動作平面又は前記作業機動作平面と平行な第2切り出し面とが交差する部分の情報である第2目標掘削地形情報を生成し、前記作業機制御部は、前記設定部から取得した前記第1目標掘削地形情報及び前記第2目標掘削地形情報に基づいて、前記掘削制御を実行することが好ましい。
 本発明は、作業具を有する作業機を備える作業機械を制御する制御システムであって、前記作業機械の位置情報を検出する位置検出部と、前記位置検出部によって検出された前記位置情報に基づき前記作業機の位置を求め、かつ前記作業機が動作する平面である作業機動作平面と交差し、かつ鉛直方向と平行な第1切り出し面と、目標形状を示す第1の目標施工面及び前記第1の目標施工面の側方に連なる第2の目標施工面とが交差する部分の情報である第1目標掘削地形情報を生成する生成部と、前記生成部から取得した前記第1目標掘削地形情報に基づいて、前記作業機が掘削対象に接近する方向の速度が制限速度以下になるように制御する掘削制御を実行する作業機制御部と、を含む、作業機械の制御システムである。
 前記生成部は、前記第1の目標施工面と、前記作業機動作平面又は前記作業機動作平面と平行な第2切り出し面とが交差する部分の情報である第2目標掘削地形情報を生成し、前記作業機制御部は、前記設定部から取得した前記第1目標掘削地形情報及び前記第2目標掘削地形情報に基づいて、前記掘削制御を実行することが好ましい。
 前記作業機制御部は、前記第2目標掘削地形情報に基づいて前記掘削制御を実行し、前記第1目標掘削地形情報に基づいて実行中の前記掘削制御を停止し又は停止中の前記掘削制御を再開することが好ましい。
 前記作業機制御部は、前記作業具の直下における前記第1目標掘削地形情報の、前記作業機械の水平面に対する角度が予め定められた大きさ以上である場合に、前記掘削制御を停止することが好ましい。
 前記作業機制御部は、前記作業具の刃先と前記第1目標掘削地形情報との間における最も小さい距離に基づいて前記掘削制御を実行することが好ましい。
 前記作業機制御部は、前記作業具の刃先と、前記第1目標掘削地形情報との距離に基づいて、前記第1目標掘削地形情報に対応した目標施工面に対して前記掘削制御を実行するか否かを決定することが好ましい。
 前記作業機械は、前記作業機が取り付けられて所定の軸線周りを回動する旋回体を備えており、前記作業機制御部は、前記作業機が前記旋回体とともに旋回しているときに前記掘削制御を実行することが好ましい。
 前記作業機制御部は、前記作業機が旋回する方向における目標速度と、前記作業具の前後方向における目標速度とを合成した速度に基づいて前記掘削制御を実行することが好ましい。
 前記作業機械に備えられて、角速度及び加速度を検出する検出装置を有し、前記検出装置が検出した前記作業機の旋回速度を用いて前記作業機の位置を予測することが好ましい。
 本発明は、前述した作業機械の制御システムを備える、作業機械である。
 本発明は、作業具を有する作業機を備える作業機械を制御する制御方法であって、前記作業機の位置を検出し、検出された前記位置情報に基づき前記作業機の位置を求め、かつ目標形状を示す少なくとも1つの目標施工面と、前記作業機が動作する平面である作業機動作平面と交差し、かつ鉛直方向と平行な第1切り出し面とが交差する部分の情報である第1目標掘削地形情報を生成し、前記第1目標掘削地形情報に基づいて、前記作業機が掘削対象に接近する方向の速度が制限速度以下になるように制御する、作業機械の制御方法である。
 前記第1目標掘削地形情報、及び少なくとも一つの前記目標施工面と前記作業機動作平面又は前記作業機動作平面と平行な第2切り出し面とが交差する部分の情報である前記第2目標掘削地形情報に基づいて、前記作業機が掘削対象に接近する方向の速度が制限速度以下になるように制御することが好ましい。
 前記作業機が掘削対象に接近する方向の速度が制限速度以下になるように制御するにあたって、前記作業具の刃先と、前記第1目標掘削地形情報との距離に基づいて、前記第1目標掘削地形情報に対応した目標施工面に対して前記掘削制御を実行するか否かを決定することが好ましい。
 前記作業機が前記作業機械に備えられた前記旋回体とともに旋回しているときに前記掘削制御を実行することが好ましい。
 本発明は、オペレータが意図する通りに作業機を動作させることができる。
図1は、実施形態1に係る作業機械の斜視図である。 図2は、油圧ショベルの駆動系と制御システムとの構成を示すブロック図である。 図3Aは、油圧ショベルの側面図である。 図3Bは、油圧ショベルの背面図である。 図4は、目標施工情報の一例を示す模式図である。 図5は、作業機コントローラ及び表示コントローラを示すブロック図である。 図6は、表示部に表示される目標掘削地形の一例を示す図である。 図7は、目標速度と垂直速度成分と水平速度成分との関係を示す模式図である。 図8は、垂直速度成分と水平速度成分との算出方法を示す図である。 図9は、垂直速度成分と水平速度成分との算出方法を示す図である。 図10は、刃先と目標掘削地形との間の距離を示す模式図である。 図11は、制限速度情報の一例を示すグラフである。 図12は、ブームの制限速度の垂直速度成分の算出方法を示す模式図である。 図13は、ブームの制限速度の垂直速度成分とブームの制限速度との関係を示す模式図である。 図14は、刃先の移動によるブームの制限速度の変化の一例を示す図である。 図15は、油圧ショベル100が備える油圧システム300の詳細な構造を示す図である。 図16は、溝を掘削するときのバケットと溝との関係を示す図である。 図17は、溝を掘削するときのバケットと溝との関係を示す図である。 図18は、溝を掘削するときのバケットと溝との関係を示す図である。 図19Aは、溝を掘削するときのバケットと溝との関係を示す図である。 図19Bは、溝を掘削するときのバケットと溝との関係を示す図である。 図20は、目標掘削地形から前後方向目標掘削地形データを切り出す位置を説明するための図である。 図21は、目標掘削地形から前後方向目標掘削地形データを切り出す平面を説明するための図である。 図22は、幅方向目標掘削地形データを切り出す平面を説明するための図である。 図23は、幅方向目標掘削地形データを切り出す平面を説明するための図である。 図24は、溝を掘削する際の目標掘削地形と油圧ショベルのバケットとの関係を示す図である。 図25は、溝を掘削する際の制御例を示すフローチャートである。 図26は、溝を掘削しているときに油圧ショベルのバケットが溝壁に向かう状態を示す図である。 図27は、油圧ショベルの後方からバケットを見た状態を示す図である。 図28は、バケットが溝壁に接近するときの速度成分を説明するための図である。 図29は、バケットの刃先と溝壁との距離を示す図である。 図30は、ブームの制限速度を説明するための図である。 図31は、幅方向における掘削制御の処理例を示すフローチャートである。 図32は、旋回目標速度と前後方向の目標速度とを合成した速度に基づく掘削制御の処理を示すフローチャートである。 図33は、前後方向の目標速度を求める方法の説明図である。 図34は、旋回目標速度と前後方向の目標速度とを合成した速度を求める方法を示す図である。 図35は、バケットが側壁に対応する目標掘削地形に接近するときの速度成分を説明するための図である。 図36は、ブーム制限速度を説明するための図である。 図37は、表示コントローラ及び変形例に係る作業機コントローラ及びセンサコントローラを示すブロック図である。 図38Aは、油圧ショベルの姿勢を示す図である。 図38Bは、油圧ショベルの姿勢を示す図である。 図39は、予測補正部が補正旋回体方位データを更新する処理を説明するためのフロー図である。 図40は、上部旋回体の動作に合わせて実行される予測補正部の処理を説明するための図である。
 本発明を実施するための形態(実施形態)につき、図面を参照しつつ詳細に説明する。
(実施形態1)
<作業機械の全体構成>
 図1は、実施形態1に係る作業機械の斜視図である。図2は、油圧ショベル100の油圧システム300と制御システム200との構成を示すブロック図である。作業機械としての油圧ショベル100は、本体部としての車両本体1と作業機2とを有する。車両本体1は、旋回体としての上部旋回体3と走行体としての走行装置5とを有する。上部旋回体3は、機関室3EGの内部に、動力発生装置としてのエンジン及び油圧ポンプ等の装置を収容している。機関室3EGは、上部旋回体3の一端側に配置されている。
 本実施形態において、油圧ショベル100は、動力発生装置としてのエンジンに、例えばディーゼルエンジン等の内燃機関が用いられるが、動力発生装置はこのようなものに限定されない。油圧ショベル100の動力発生装置は、例えば、内燃機関と発電電動機と蓄電装置とを組み合わせた、いわゆるハイブリッド方式の装置であってもよい。また、油圧ショベル100の動力発生装置は、内燃機関を有さず、蓄電装置と発電電動機とを組み合わせたものであってもよい。
 上部旋回体3は、運転室4を有する。運転室4は、上部旋回体3の他端側に設置されている。すなわち、運転室4は、機関室3EGが配置されている側とは反対側に設置されている。運転室4内には、図2に示す、表示部29及び操作装置25が配置される。これらについては後述する。上部旋回体3の上方には、手すり9が取り付けられている。
 走行装置5は、上部旋回体3を搭載する。走行装置5は、履帯5a、5bを有している。走行装置5は、左右に設けられた走行モータ5cの一方又は両方が駆動し、履帯5a、5bが回転することにより、油圧ショベル100を走行させる。作業機2は、上部旋回体3の運転室4の側方側に取り付けられている。
 油圧ショベル100は、履帯5a、5bの代わりにタイヤを備え、エンジンの駆動力を、トランスミッションを介してタイヤへ伝達して走行が可能な走行装置を備えたものであってもよい。このような形態の油圧ショベル100としては、例えば、ホイール式油圧ショベルがある。また、油圧ショベル100は、このようなタイヤを有した走行装置を備え、さらに車両本体(本体部)に作業機が取り付けられ、図1に示すような上部旋回体3及びその旋回機構を備えていない構造を有する、例えばバックホウローダであってもよい。すなわち、バックホウローダは、車両本体に作業機が取り付けられ、車両本体の一部を構成する走行装置を備えたものである。
 上部旋回体3は、作業機2及び運転室4が配置されている側が前であり、機関室3EGが配置されている側が後である(x方向)。前に向かって左側が上部旋回体3の左であり、前に向かって右側が上部旋回体3の右である。上部旋回体3の左右方向は、幅方向とも言う(y方向)。油圧ショベル100又は車両本体1は、上部旋回体3を基準として走行装置5側が下であり、走行装置5を基準として上部旋回体3側が上である(z方向)。油圧ショベル100が水平面に設置されている場合、下は鉛直方向、すなわち重力の作用方向側であり、上は鉛直方向とは反対側である。
 作業機2は、ブーム6とアーム7と作業具としてのバケット8とブームシリンダ10とアームシリンダ11とバケットシリンダ12とを有する。ブーム6の基端部は、ブームピン13を介して車両本体1の前部に回動可能に取り付けられている。アーム7の基端部は、アームピン14を介してブーム6の先端部に回動可能に取り付けられている。アーム7の先端部には、バケットピン15を介してバケット8が取り付けられている。バケット8は、バケットピン15を中心として回動する。バケット8は、バケットピン15とは反対側に複数の刃8Bが取り付けられている。刃先8Tは、刃8Bの先端である。
 バケット8は、複数の刃8Bを有していなくてもよい。つまり、図1に示すような刃8Bを有しておらず、刃先が鋼板によってストレート形状に形成されたようなバケットであってもよい。作業機2は、例えば、単数の刃を有するチルトバケットを備えていてもよい。チルトバケットとは、バケットチルトシリンダを備え、バケットが左右にチルト傾斜することで油圧ショベルが傾斜地にあっても、斜面、平地を自由な形に成形、整地をすることができ、底板プレートによる転圧作業もできるバケットである。この他にも、作業機2は、バケット8の代わりに、法面バケット又は削岩用のチップを備えた削岩用のアタッチメント等を備えていてもよい。
 図1に示すブームシリンダ10とアームシリンダ11とバケットシリンダ12とは、それぞれ作動油の圧力(以下、適宜油圧という)によって駆動される油圧シリンダである。ブームシリンダ10はブーム6を駆動して、これを昇降させる。アームシリンダ11は、アーム7を駆動して、アームピン14の周りを回動させる。バケットシリンダ12は、バケット8を駆動して、バケットピン15の周りを回動させる。
 ブームシリンダ10、アームシリンダ11及びバケットシリンダ12等の油圧シリンダと図2に示す油圧ポンプ36、37との間には、図2に示す方向制御弁64が設けられている。方向制御弁64は、油圧ポンプ36、37からブームシリンダ10、アームシリンダ11及びバケットシリンダ12等に供給される作動油の流量を制御するとともに、作動油が流れる方向を切り替える。方向制御弁64は、走行モータ5cを駆動するための走行用方向制御弁と、ブームシリンダ10、アームシリンダ11及びバケットシリンダ12並びに上部旋回体3を旋回させる旋回モータを制御するための作業機用方向制御弁とを含む。
 操作装置25から供給される、所定のパイロット圧力に調整された作動油が方向制御弁64のスプールを動作させると、方向制御弁64から流出する作動油の作動油の流量が調整されて、油圧ポンプ36、37からブームシリンダ10、アームシリンダ11、バケットシリンダ12、旋回モータ又は走行モータ5cに供給される作動油の流量が制御される。その結果、ブームシリンダ10、アームシリンダ11及びバケットシリンダ12等の動作が制御される。
 また、図2に示す作業機コントローラ26が、図2に示す制御弁27を制御することにより、操作装置25から方向制御弁64に供給される作動油のパイロット圧が制御されるので、方向制御弁64からブームシリンダ10、アームシリンダ11、バケットシリンダ12に供給される作動油の流量が制御される。その結果、作業機コントローラ26は、ブームシリンダ10、アームシリンダ11及びバケットシリンダ12等の動作を制御することができる。
 上部旋回体3の上部には、アンテナ21、22が取り付けられている。アンテナ21、22は、油圧ショベル100の現在位置を検出するために用いられる。アンテナ21、22は、図2に示す、油圧ショベル100の現在位置を検出するための位置検出部としての位置検出装置19と電気的に接続されている。位置検出装置19は、RTK-GNSS(Real Time Kinematic - Global Navigation Satellite Systems、GNSSは全地球航法衛星システムを言う)を利用して油圧ショベル100の現在位置を検出する。以下の説明において、アンテナ21、22を、適宜GNSSアンテナ21、22という。GNSSアンテナ21、22が受信したGNSS電波に応じた信号は、位置検出装置19に入力される。位置検出装置19は、GNSSアンテナ21、22の設置位置を検出する。位置検出装置19は、例えば、3次元位置センサを含む。
 GNSSアンテナ21、22は、図1に示すように、上部旋回体3の上であって、油圧ショベル100の左右方向に離れた両端位置に設置されることが好ましい。本実施形態において、GNSアンテナ21、22は、上部旋回体3の幅方向両側にそれぞれ取り付けられた手すり9に取り付けられる。GNSアンテナ21、22が上部旋回体3に取り付けられる位置は手すり9に限定されるものではないが、GNSアンテナ21、22は、可能な限り離れた位置に設置される方が、油圧ショベル100の現在位置の検出精度は向上するので好ましい。また、GNSSアンテナ21、22は、オペレータの視界を極力妨げない位置に設置されることが好ましい。
 図2に示すように、油圧ショベル100の油圧システム300は、動力発生源としてのエンジン35と油圧ポンプ36、37とを備える。油圧ポンプ36、37は、エンジン35によって駆動され、作動油を吐出する。油圧ポンプ36、37から吐出された作動油は、ブームシリンダ10とアームシリンダ11とバケットシリンダ12とに供給される。また、油圧ショベル100は、旋回モータ38を備える。旋回モータ38は、油圧モータであり、油圧ポンプ36、37から吐出された作動油によって駆動される。旋回モータ38は、上部旋回体3を旋回させる。なお、図2では、2つの油圧ポンプ36、37が図示されているが、1つの油圧ポンプのみが設けられてもよい。旋回モータ38は、油圧モータに限らず、電気モータであってもよい。
 作業機械の制御システムとしての制御システム200は、位置検出装置19と、グローバル座標演算部23と、角速度及び加速度を検出する検出装置としてのIMU(Inertial Measurement Unit:慣性計測装置)24と、操作装置25と、作業機制御部としての作業機コントローラ26と、センサコントローラ39と、生成部としての表示コントローラ28と、表示部29とを含む。操作装置25は、図1に示す作業機2を操作するための装置である。操作装置25は、作業機2を駆動するためのオペレータによる操作を受け付けて、操作量に応じた作動油を出力する。
 例えば、操作装置25は、オペレータの左側に設置される左操作レバー25Lと、オペレータの右側に配置される右操作レバー25Rと、を有する。左操作レバー25L及び右操作レバー25Rは、前後左右の動作が2軸の動作に対応されている。例えば、右操作レバー25Rの前後方向の操作は、ブーム6の操作に対応されている。右操作レバー25Rが前方へ操作されるとブーム6が下がり、後方へ操作されるとブーム6が上がる。前後方向の操作に応じてブーム6の下げ上げの動作が実行される。右操作レバー25Rの左右方向の操作は、バケット8の操作に対応されている。右操作レバー25Rが左側に操作されるとバケット8が掘削し、右側に操作されるとバケット8がダンプする。左右方向の操作に応じてバケット8の掘削又は開放動作が実行される。左操作レバー25Lの前後方向の操作は、アーム7の旋回に対応されている。左操作レバー25Lが前方に操作されるとアーム7がダンプし、後方に操作されるとアーム7が掘削する。左操作レバー25Lの左右方向の操作は、上部旋回体3の旋回に対応されている。左操作レバー25Lが左側に操作されると左旋回し、右側に操作されると右旋回する。
 本実施形態において、ブーム6の上げ動作は、ダンプ動作に相当する。ブーム6の下げ動作は、掘削動作に相当する。アーム7の掘削動作は、下げ動作に相当する。アーム7のダンプ動作は、上げ動作に相当する。バケット8の掘削動作は、下げ動作に相当する。バケット8のダンプ動作は、上げ動作に相当する。なお、アーム7の下げ動作を曲げ動作と称してもよい。アーム7の上げ動作を伸長動作と称してもよい。
 本実施形態において、操作装置25は、パイロット油圧方式が用いられる。操作装置25には、油圧ポンプ36から、図示しない減圧弁によって所定のパイロット圧力に減圧された作動油がブーム操作、バケット操作、アーム操作及び旋回操作に基づいて供給される。
 右操作レバー25Rの前後方向の操作に応じて、パイロット油路450へパイロット油圧が供給可能とされて、オペレータによるブーム6の操作が受け付けられる。右操作レバー25Rの操作量に応じて右操作レバー25Rが備える弁装置が開き、パイロット油路450へ作動油が供給される。また、圧力センサ66は、そのときのパイロット油路450内における作動油の圧力をパイロット圧として検出する。圧力センサ66は、検出したパイロット圧を、ブーム操作量MBとして作業機コントローラ26へ送信する。右操作レバー25Rの前後方向の操作量を、以下、適宜ブーム操作量MBと称する。操作装置25とブームシリンダ10との間のパイロット油路50には、圧力センサ68、制御弁(以下、適宜介入弁と称する)27C及びシャトル弁51が設けられる。介入弁27C及びシャトル弁51については後述する。
 右操作レバー25Rの左右方向の操作に応じて、パイロット油路450へパイロット油圧が供給可能とされて、オペレータによるバケット8の操作が受け付けられる。右操作レバー25Rの操作量に応じて右操作レバー25Rが備える弁装置が開き、パイロット油路450に作動油が供給される。また、圧力センサ66は、そのときのパイロット油路450内における作動油の圧力をパイロット圧として検出する。圧力センサ66は、検出したパイロット圧を、バケット操作量MTとして作業機コントローラ26へ送信する。右操作レバー25Rの左右方向の操作量を、以下、適宜バケット操作量MTと称する。
 左操作レバー25Lの前後方向の操作に応じて、パイロット油路450へパイロット油圧が供給可能とされて、オペレータによるアーム7の操作が受け付けられる。左操作レバー25Lの操作量に応じて左操作レバー25Lが備える弁装置が開き、パイロット油路450へ作動油が供給される。また、圧力センサ66は、そのときのパイロット油路450内における作動油の圧力をパイロット圧として検出する。圧力計66は、検出したパイロット圧を、アーム操作量MAとして作業機コントローラ26へ送信する。左操作レバー25Lの左右方向の操作量を、以下、適宜アーム操作量MAと称する。
 左操作レバー25Lの左右方向の操作に応じて、パイロット油路450へパイロット油圧が供給可能とされて、オペレータによる上部旋回体3の旋回操作が受け付けられる。左操作レバー25Lの操作量に応じて左操作レバー25Lが備える弁装置が開き、パイロット油路450へ作動油が供給される。また、圧力センサ66は、そのときのパイロット油路450内における作動油の圧力をパイロット圧として検出する。圧力センサ66は、検出したパイロット圧を、旋回操作量MRとして作業機コントローラ26へ送信する。左操作レバー25Lの前後方向の操作量を、以下、適宜旋回操作量MRと称する。
 右操作レバー25Rが操作されることにより、操作装置25は、右操作レバー25Rの操作量に応じた大きさのパイロット油圧を方向制御弁64に供給する。左操作レバー25Lが操作されることにより、操作装置25は、左操作レバー25Lの操作量に応じた大きさのパイロット油圧を制御弁27に供給する。このパイロット油圧によって、方向制御弁64のスプールが動作する。
 パイロット油路450には、制御弁27が設けられている。右操作レバー25R及び左操作レバー25Lの操作量は、パイロット油路450に設置される圧力センサ66によって検出される。圧力センサ66が検出したパイロット油圧は、作業機コントローラ26に入力される。作業機コントローラ26は、入力されたパイロット油圧に応じた、パイロット油路450の制御信号Nを制御弁27に出力して、パイロット油路450を開閉する。
 左操作レバー25L及び右操作レバー25Rの操作量が、例えば、ポテンショメータ及びホールIC等によって検出され、作業機コントローラ26は、これらの検出値に基づいて方向制御弁64及び制御弁27を制御することによって、作業機2を制御してもよい。このように、左操作レバー25L及び右操作レバー25Rは、電気方式であってもよい。旋回操作とアーム操作とは入れ替えられてもよい。この場合、左操作レバー25Lの左右方向における操作に応じてアーム7の伸長又は曲げ動作が実行され、左操作レバー25Lの前後方向における操作に応じて上部旋回体3の左右の旋回動作が実行される。
 制御システム200は、第1ストロークセンサ16と第2ストロークセンサ17と第3ストロークセンサ18とを有する。例えば、第1ストロークセンサ16はブームシリンダ10に、第2ストロークセンサ17はアームシリンダ11に、第3ストロークセンサ18バケットシリンダ12に、それぞれ設けられる。第1ストロークセンサ16は、ブームシリンダ10のストローク長さLS1を検出する。第1ストロークセンサ16は、ブームシリンダ10の伸長に対応する変位量を検出して、センサコントローラ39に出力する。センサコントローラ39は、第1ストロークセンサ16の変位量に対応するブームシリンダ10のシリンダ長(以下、適宜ブームシリンダ長と称する)を算出する。センサコントローラ39は、第1ストロークセンサ16が検出したブームシリンダ長から、油圧ショベル100のローカル座標系、具体的には車両本体1のローカル座標系における水平面と直交する方向(z軸方向)に対するブーム6の傾斜角θ1を算出して、作業機コントローラ26及び表示コントローラ28に出力する。
 第2ストロークセンサ17は、アームシリンダ11のストローク長さLS2を検出する。第2ストロークセンサ17は、アームシリンダ11の伸長に対応する変位量を検出して、センサコントローラ39に出力する。センサコントローラ39は、第2ストロークセンサ17の変位量に対応するアームシリンダ11のシリンダ長(以下、適宜アームシリンダ長と称する)を算出する。
 センサコントローラ39は、第2ストロークセンサ17が検出したアームシリンダ長から、ブーム6に対するアーム7の傾斜角θ2を算出して、作業機コントローラ26及び表示コントローラ28に出力する。第3ストロークセンサ18は、バケットシリンダ12のストローク長さLS3を検出する。第3ストロークセンサ18は、バケットシリンダ12の伸長に対応する変位量を検出して、センサコントローラ39に出力する。センサコントローラ39は、第3ストロークセンサ18の変位量に対応するバケットシリンダ12のシリンダ長(以下、適宜バケットシリンダ長と称する)を算出する。
 センサコントローラ39は、第3ストロークセンサ18が検出したバケットシリンダ長から、アーム7に対するバケット8が有するバケット8の刃先8Tの傾斜角θ3を算出して、作業機コントローラ26及び表示コントローラ28に出力する。ブーム6、アーム7及びバケット8の傾斜角θ1、傾斜角θ2及び傾斜角θ3は、第1ストロークセンサ16等で計測する以外に、ブーム6に取り付けられてブーム6の傾斜角を計測するロータリーエンコーダと、アーム7に取り付けられてアーム7の傾斜角を計測するロータリーエンコーダと、バケット8に取り付けられてバケット8の傾斜角を計測するロータリーエンコーダとによって取得されてもよい。
 作業機コントローラ26は、RAM(Random Access Memory)及びROM(Read Only Memory)等の記憶部26Mと、CPU(Central Processing Unit)等の処理部26Pとを有する。作業機コントローラ26は、図2に示す圧力センサ66の検出値に基づいて、制御弁27及び介入弁27Cを制御する。
 図2に示す方向制御弁64は、例えば比例制御弁であり、操作装置25から供給される作動油によって制御される。方向制御弁64は、ブームシリンダ10、アームシリンダ11、バケットシリンダ12及び旋回モータ38等の油圧アクチュエータと、油圧ポンプ36、37との間に配置される。方向制御弁64は、油圧ポンプ36、37からブームシリンダ10、アームシリンダ11、バケットシリンダ12及び旋回モータ38に供給される作動油の流量を制御する。
 制御システム200が備える位置検出装置19は、油圧ショベル100の位置を検出する。位置検出装置19は、前述したGNSSアンテナ21、22とを含む。GNSSアンテナ21、22で受信されたGNSS電波に応じた信号が、グローバル座標演算部23に入力される。GNSSアンテナ21は、自身の位置を示す基準位置データP1を測位衛星から受信する。GNSSアンテナ22は、自身の位置を示す基準位置データP2を測位衛星から受信する。GNSSアンテナ21、22は、例えば10Hz周期で基準位置データP1、P2を受信する。基準位置データP1、P2は、GNSSアンテナが設置されている位置の情報である。GNSSアンテナ21、22は、基準位置データP1、P2を受信する毎に、グローバル座標演算部23に出力する。
 グローバル座標演算部23は、グローバル座標系で表される2つの基準位置データP1、P2(複数の基準位置データ)を取得する。グローバル座標演算部23は、2つの基準位置データP1、P2に基づいて、上部旋回体3の配置を示す旋回体配置データを生成する。本実施形態において、旋回体配置データには、2つの基準位置データP1、P2の一方の基準位置データPと、2つの基準位置データP1、P2に基づいて生成された旋回体方位データQとが含まれる。旋回体方位データQは、GNSSアンテナ21、22が取得した基準位置データPから決定される方位が、グローバル座標の基準方位(例えば北)に対してなす角に基づいて決定される。旋回体方位データQは、上部旋回体3、すなわち作業機2が向いている方位を示している。グローバル座標演算部23は、例えば10Hzの周波数でGNSSアンテナ21、22から2つの基準位置データP1、P2を取得する毎に、旋回体配置データ、すなわち基準位置データPと旋回体方位データQとを更新して、作業機コントローラ26及び表示コントローラ28に出力する。
 IMU24は、上部旋回体3に取り付けられている。IMU24は、上部旋回体3の動作を示す動作データを検出する。IMU24が検出する動作データは、例えば、加速度及び角速度である。本実施形態において、動作データは、図1に示す、上部旋回体3の旋回軸zを中心として上部旋回体3が旋回する旋回角速度ωである。旋回角速度ωは、例えば、IMU24が検出した上部旋回体3の旋回角度を時間で微分することにより求められる。上部旋回体3の旋回角度は、GNSSアンテナ21、22の位置情報から取得されてもよい。
 図3Aは、油圧ショベル100の側面図である。図3Bは、油圧ショベル100の背面図である。IMU24は、図3A及び図3Bに示すように、車両本体1の左右方向に対する傾斜角θ4と、車両本体1の前後方向に対する傾斜角θ5と、加速度と、角速度とを検出する。IMU24は、例えば100Hzの周波数で旋回角速度ω、傾斜角θ4及び傾斜角θ5を更新する。IMU24における更新周期は、グローバル座標演算部23における更新周期よりも短いことが好ましい。IMU24が検出した旋回角速度ω、傾斜角θ5は、センサコントローラ39に出力される。センサコントローラ39は、旋回角速度ω及び傾斜角θ5に対してフィルタ処理等を施してから、作業機コントローラ26及び表示コントローラ28に出力する。
 表示コントローラ28は、グローバル座標演算部23から旋回体配置データ(基準位置データP及び旋回体方位データQ)を取得する。本実施形態において、表示コントローラ28は、作業機位置データとして、バケット8の刃先8Tの3次元位置を示すバケット刃先位置データSを生成する。そして、表示コントローラ28は、バケット刃先位置データSと、後述する目標施工情報Tとを用いて、掘削対象の目標形状を示す情報としての目標掘削地形データUを生成する。表示コントローラ28は、目標掘削地形データUに基づく表示用の目標掘削地形データUaを導出し、表示用の目標掘削地形データUaに基づいて、表示部29に目標掘削地形43Iを表示させる。
 表示部29は、例えば、液晶表示装置等であるが、これに限定されるものではない。本実施形態においては、表示部29に隣接して、スイッチ29Sが設置されている。スイッチ29Sは、後述する掘削制御を実行するか否かを選択するための入力装置である。
 作業機コントローラ26は、図1に示す旋回軸zを中心として上部旋回体3が旋回する旋回角速度ωを示す旋回角速度ωをセンサコントローラ39から取得する。また、作業機コントローラ26は、圧力センサ66からブーム操作信号MB、バケット操作信号MT、アーム操作信号MA及び旋回操作信号MRを取得する。作業機コントローラ26は、センサコントローラ39からブーム6の傾斜角度θ1、アーム7の傾斜角度θ2、バケット8の傾斜角度θ3を取得する。
 作業機コントローラ26は、表示コントローラ28から、目標掘削地形データUを取得する。作業機コントローラ26は、センサコントローラ39から取得した作業機2の角度からバケット8の刃先8Tの位置(以下、適宜刃先位置と称する)を算出する。作業機コントローラ26は、目標掘削地形データUに沿ってバケット8の刃先8Tが移動するように、操作装置25から入力されたブーム操作量MB、バケット操作量MT及びアーム操作量MAを、目標掘削地形データUとバケット8の刃先8Tとの距離と速度に基づき調整する。作業機コントローラ26は、目標掘削地形データUに沿ってバケット8の刃先8Tが移動するように作業機2を制御するための制御信号Nを生成して、図2に示す制御弁27に出力する。このような処理により、作業機2が目標掘削地形データUに近づく速度は、目標掘削地形データUに対する距離に応じて制限される。
 作業機コントローラ26からの制御信号Nに応じて、ブームシリンダ10、アームシリンダ11及びバケットシリンダ12のそれぞれに対して2個ずつ設けられた制御弁27が開閉する。左操作レバー25L又は右操作レバー25Rの操作と制御弁27の開閉指令とに基づき、方向制御弁64のスプールが動作して、ブームシリンダ10、アームシリンダ11及びバケットシリンダ12へ作動油が供給される。
 グローバル座標演算部23は、グローバル座標系におけるGNSSアンテナ21、22の基準位置データP1、P2を検出する。グローバル座標系は、油圧ショベル100の作業エリアGDに設置された基準となる、例えば基準杭60の基準位置PGを基準とした、(X、Y、Z)で示される3次元座標系である。図3Aに示すように、基準位置PGは、例えば、作業エリアGDに設置された基準杭60の先端60Tに位置する。本実施形態において、グローバル座標系とは、例えば、GNSSにおける座標系である。
 図2に示す表示コントローラ28は、位置検出装置19による検出結果に基づいて、グローバル座標系で見たときのローカル座標系の位置を算出する。ローカル座標系とは、油圧ショベル100を基準とした、(x、y、z)で示される3次元座標系である。本実施形態において、ローカル座標系の基準位置PLは、例えば、上部旋回体3が旋回するためのスイングサークル上に位置する。本実施形態において、例えば、作業機コントローラ26は、次のようにしてグローバル座標系で見たときのローカル座標系の位置を算出する。
 センサコントローラ39は、第1ストロークセンサ16が検出したブームシリンダ長から、ローカル座標系における水平面と直交する方向(z軸方向)に対するブーム6の傾斜角θ1を算出する。作業機コントローラ26は、第2ストロークセンサ17が検出したアームシリンダ長から、ブーム6に対するアーム7の傾斜角θ2を算出する。作業機コントローラ26は、第3ストロークセンサ18が検出したバケットシリンダ長から、アーム7に対するバケット8の傾斜角θ3を算出する。
 作業機コントローラ26の記憶部26Mは、作業機2のデータ(以下、適宜作業機データという)を記憶している。作業機データは、ブーム6の長さL1、アーム7の長さL2及びバケット8の長さL3を含む。図3Aに示すように、ブーム6の長さL1は、ブームピン13からアームピン14までの長さに相当する。アーム7の長さL2は、アームピン14からバケットピン15までの長さに相当する。バケット8の長さL3は、バケットピン15からバケット8の刃先8Tまでの長さに相当する。刃先8Tは、図1に示す刃8Bの先端である。また、作業機データは、ローカル座標系の基準位置PLに対するブームピン13までの位置情報を含む。
 図4は、目標施工面の一例を示す模式図である。図4に示すように、油圧ショベル100が備える作業機2の掘削対象の掘削後における仕上がりの目標となる目標施工情報Tは、三角形ポリゴンによってそれぞれ表現される複数の目標施工面41を含む。図4では複数の目標施工面41のうち1つのみに符号41が付されており、他の目標施工面41の符号は省略されている。作業機コントローラ26は、バケット8が目標掘削地形43Iを侵食することを抑制するために、作業機2が掘削対象に接近する方向の速度が制限速度以下になるように制御する。この制御を、適宜掘削制御という。次に、作業機コントローラ26によって実行される掘削制御について説明する。
<掘削制御について>
 図5は、作業機コントローラ26及び表示コントローラ28を示すブロック図である。図6は、表示部に表示される目標掘削地形43Iの一例を示す図である。図7は、目標速度と垂直速度成分と水平速度成分との関係を示す模式図である。図8は、垂直速度成分と水平速度成分との算出方法を示す図である。図9は、垂直速度成分と水平速度成分との算出方法を示す図である。図10は、刃先と目標施工面との間の距離を示す模式図である。図11は、制限速度情報の一例を示すグラフである。図12は、ブームの制限速度の垂直速度成分の算出方法を示す模式図である。図13は、ブームの制限速度の垂直速度成分とブームの制限速度との関係を示す模式図である。図14は、刃先の移動によるブームの制限速度の変化の一例を示す図である。
 図4及び図5に示すように、表示コントローラ28は、目標掘削地形データUを生成して作業機コントローラ26に出力する。掘削制御は、例えば、油圧ショベル100のオペレータが、図2に示すスイッチ29Sを用いて掘削制御を実行することを選択した場合に実行される。掘削制御が実行されるにあたって、作業機コントローラ26は、ブーム操作量MB、アーム操作量MA及びバケット操作量MT並びに表示コントローラ28から取得した目標掘削地形データU及びセンサコントローラ39から取得した傾斜角度θ1、θ2、θ3、θ5を用いて、掘削制御に必要なブーム指令信号CBIを生成し、また必要に応じてアーム指令信号及びバケット指令信号を生成し、制御弁27及び介入弁27Cを駆動して作業機2を制御する。
 まず、表示コントローラ28について説明する。表示コントローラ28は、目標施工情報格納部28Aと、バケット刃先位置データ生成部28Bと、目標掘削地形データ生成部28Cとを含む。目標施工情報格納部28Aは、作業エリアにおける目標形状を示す情報としての目標施工情報Tを格納している。目標施工情報Tは、掘削対象の目標形状を示す情報としての目標掘削地形データUを生成するために必要とされる座標データ及び角度データを含んでいる。目標施工情報Tは、複数の目標施工面41の位置情報を含む。掘削制御作業機コントローラ26が作業機2を制御したり、表示部29に目標掘削地形データUaを表示させたりするために必要な目標施工情報Tは、例えば、無線通信によって目標施工情報格納部28Aにダウンロードされる。また、必要な目標施工情報Tは、これを保存している端末装置を表示コントローラ28に接続して、目標施工情報格納部28Aにダウンロードされてもよいし、持ち出し可能な記憶装置をコントローラ28に接続して転送してもよい。
 バケット刃先位置データ生成部28Bは、グローバル座標演算部23から取得する基準位置データP及び旋回体方位データQに基づいて、上部旋回体3の旋回軸zを通る油圧ショベル100の旋回中心の位置を示す旋回中心位置データXRを生成する。旋回中心位置データXRは、ローカル座標系の基準PLとxy座標が一致する。
 バケット刃先位置データ生成部28Bは、旋回中心位置データXRと作業機2の傾斜角θ1、θ2、θ3とに基づいて、バケット8の刃先8Tの現在位置を示すバケット刃先位置データSを生成する。
 バケット刃先位置データ生成部28Bは、前述したように、例えば10Hzの周波数で基準位置データPと旋回体方位データQとをグローバル座標演算部23から取得する。したがって、バケット刃先位置データ生成部28Bは、例えば10Hzの周波数でバケット刃先位置データSを更新することができる。バケット刃先位置データ生成部28Bは、更新したバケット刃先位置データSを目標掘削地形データ生成部28Cに出力する。
 目標掘削地形データ生成部28Cは、目標施工情報格納部28Aに格納された目標施工情報Tと、バケット刃先位置データ生成部28Bからのバケット刃先位置データSと、を取得する。目標掘削地形データ生成部28Cは、ローカル座標系において刃先8Tの現時点における刃先位置P4を通る垂線と目標施工面41との交点を掘削対象位置44として設定する。掘削対象位置44は、バケット8の刃先位置P4の直下の点である。目標掘削地形データ生成部28Cは、目標施工情報Tとバケット刃先位置データSとに基づいて、図4に示すように、上部旋回体3の前後方向で規定され、かつ掘削対象位置44を通る作業機2の平面42と、複数の目標施工面41で表される目標施工情報Tとの交線43を、目標掘削地形43Iの候補線として取得する。掘削対象位置44は、候補線上の一点である。平面42は、作業機2が動作する平面(作業機動作平面)と平行な平面又は作業機動作平面である。
 作業機動作平面は、ブーム6及びアーム7が油圧ショベル100のローカル座標系のz軸と平行な軸周りを回動しない場合、油圧ショベル100のxz平面と平行な平面である。ブーム6及びアーム7の少なくとも一方が油圧ショベル100のローカル座標系のz軸と平行な軸周りを回動する場合、作業機動作平面は、アームが回動する軸、すなわち図1に示すアームピン14の軸線と直交する平面である。以下において、作業機動作平面を、適宜アーム動作平面と称する。
 目標掘削地形データ生成部28Cは、目標施工情報Tの掘削対象位置44の前後における単数又は複数の変曲点とその前後の線とを、掘削対象となる目標掘削地形43Iとして決定する。図4に示す例では、2個の変曲点Pv1、Pv2とその前後の線とが目標掘削地形43Iとして決定される。そして、目標掘削地形データ生成部28Cは、掘削対象位置44の前後における単数又は複数の変曲点の位置情報とその前後の線の角度情報とを、掘削対象の目標形状を示す情報である目標掘削地形データUとして生成する。本実施形態において、目標掘削地形43Iは線で規定しているが、例えばバケット8の幅等に基づき、面として規定されていてもよい。このようにして生成された目標掘削地形データUは、複数の目標施工面41の一部の情報を有している。目標掘削地形データ生成部28Cは、生成した目標掘削地形データUを作業機コントローラ26に出力する。本実施形態において、表示コントローラ28と作業機コントローラとは直接信号のやり取りをするが、例えば、CAN(Controller Area Network)のような車内信号線を介して信号をやり取りしてもよい。
 本実施形態において、目標掘削地形データUは、作業機2が動作する作業機動作平面としての平面42と、目標形状を示す少なくとも1つの目標施工面(第1の目標施工面)41とが交差する部分における情報である。平面42は、図3A、図3Bに示すローカル座標系(x、y、z)におけるxz平面である。平面42によって、複数の目標施工面41を切り出すことによって得られた目標掘削地形データUの他に、平面42と交差(又は直交)し、かつ鉛直方向と平行な平面と、目標形状を示す少なくとも1つの目標施工面41とが交差する部分における情報もある。この情報は、作業機2の幅方向(ローカル座標系におけるy方向)における掘削対象の目標形状を示す情報である。この情報を、適宜幅方向目標掘削地形データUwと称する。幅方向目標掘削地形データUwによって、幅方向の目標掘削地形46Iが生成される。幅方向目標掘削地形データUw及び目標掘削地形46Iの詳細は後述する。また、平面42によって、複数の目標施工面41を切り出すことによって得られた目標掘削地形データUを、適宜前後方向目標掘削地形データUと称する。
 表示コントローラ28は、必要に応じて、第1目標掘削地形情報としての幅方向目標掘削地形データUw又は第2目標掘削地形情報としての前後方向目標掘削地形データUに基づいて表示部29に目標掘削地形43Iを表示させる。表示用の情報としては、表示用の目標掘削地形データUaが用いられる。表示用の目標掘削地形データUaに基づき、例えば、図5に示すような、バケット8の掘削対象として設定された目標掘削地形43Iと刃先8Tとの位置関係を示す画像が、表示部29に表示される。表示コントローラ28は、表示用の目標掘削地形データUaに基づいて表示部29に目標掘削地形(表示用の目標掘削地形)43Iを表示する。作業機コントローラ26に出力された前後方向目標掘削地形データU及び幅方向目標掘削地形データUwは掘削制御に用いられる。掘削制御に用いられる目標掘削地形データU及び幅方向目標掘削地形データUwを、適宜作業用目標掘削地形データと称する。
 目標掘削地形データ生成部28Cは、前述したように、例えば10Hzの周波数でバケット刃先位置データSをバケット刃先位置データ生成部28Bから取得する。したがって、目標掘削地形データ生成部28Cは、例えば10Hzの周波数で前後方向目標掘削地形データU及び幅方向目標掘削地形データUwを更新し、作業機コントローラ26に出力することができる。次に、作業機コントローラ26について説明する。
 作業機コントローラ26は、目標速度決定部52と、距離取得部53と、制限速度決定部54と、作業機制御部57と、掘削制御可否判定部(以下、適宜制御可否判定部と称する)58とを有する。作業機コントローラ26は、前述した前後方向目標掘削地形データU又は幅方向目標掘削地形データUwに基づく目標掘削地形43Iを用いて掘削制御を実行する。このように、本実施形態では、表示に用いられる目標掘削地形43Iと、掘削制御に用いられる目標掘削地形43Iとがある。前者を表示用目標掘削地形と称し、後者を掘削制御用目標掘削地形と称する。
 本実施形態において、目標速度決定部52、距離取得部53、制限速度決定部54、作業機制御部57及び制御化批判底部58の機能は、図2に示す処理部26Pが実現する。次に、作業機コントローラ26による掘削制御について説明する。この掘削制御は、作業機2の前後方向における掘削制御の例であるが、作業機2の幅方向においても掘削制御は可能である。作業機2の幅方向における掘削制御については後述する。
 目標速度決定部52は、ブーム目標速度Vc_bmと、アーム目標速度Vc_amと、バケット目標速度Vc_bktとを決定する。ブーム目標速度Vc_bmは、ブームシリンダ10のみが駆動されるときの刃先8Tの速度である。アーム目標速度Vc_amは、アームシリンダ11のみが駆動されるときの刃先8Tの速度である。バケット目標速度Vc_bktは、バケットシリンダ12のみが駆動されるときの刃先8Tの速度である。ブーム目標速度Vc_bmは、ブーム操作量MBに応じて算出される。アーム目標速度Vc_amは、アーム操作量MAに応じて算出される。バケット目標速度Vc_bktは、バケット操作量MTに応じて算出される。
 記憶部26Mは、ブーム操作量MBとブーム目標速度Vc_bmとの関係を規定する目標速度情報を記憶している。目標速度決定部52は、目標速度情報を参照することにより、ブーム操作量MBに対応するブーム目標速度Vc_bmを決定する。目標速度情報は、例えば、ブーム操作量MBに対するブーム目標速度Vc_bmの大きさが記述されたグラフである。目標速度情報は、テーブル又は数式等の形態でもよい。目標速度情報は、アーム操作量MAとアーム目標速度Vc_amとの関係を規定する情報を含む。目標速度情報は、バケット操作量MTとバケット目標速度Vc_bktとの関係を規定する情報を含む。目標速度決定部52は、目標速度情報を参照することにより、アーム操作量MAに対応するアーム目標速度Vc_amを決定する。目標速度決定部52は、目標速度情報を参照することにより、バケット操作量MTに対応するバケット目標速度Vc_bktを決定する。目標速度決定部52は、図7に示すように、ブーム目標速度Vc_bmを、目標掘削地形43I(目標掘削地形データU)に垂直な方向の速度成分(以下、適宜垂直速度成分と称する)Vcy_bm及び目標掘削地形43I(目標掘削地形データU)に平行な方向の速度成分(以下、適宜水平速度成分と称する)Vcx_bmに変換する。
 例えば、まず、目標速度決定部52は、傾斜角θ5をセンサコントローラ39から取得し、グローバル座標系の垂直軸に対して目標掘削地形43Iと直交する方向における傾きとを求める。そして、目標速度決定部52は、これらの傾きからローカル座標系の垂直軸と目標掘削地形43Iに直交する方向との傾きを表す角度β2(図8参照)を求める。
 次に、目標速度決定部52は、図8に示すように、ローカル座標系の垂直軸とブーム目標速度Vc_bmの方向とのなす角度β2とから、三角関数によりブーム目標速度Vc_bmをローカル座標系の垂直軸方向の速度成分VL1_bmと水平軸方向の速度成分VL2_bmとに変換する。そして、図9に示すように、目標速度決定部52は、前述したローカル座標系の垂直軸と目標掘削地形43Iに直交する方向との傾きβ1から、三角関数により、ローカル座標系の垂直軸方向における速度成分VL1_bmと水平軸方向における速度成分VL2_bmとを、前述した目標掘削地形43Iに対する垂直速度成分Vcy_bm及び水平速度成分Vcx_bmとに変換する。同様に、目標速度決定部52は、アーム目標速度Vc_amを、ローカル座標系の垂直軸方向における垂直速度成分Vcy_am及び水平速度成分Vcx_amに変換する。目標速度決定部52は、バケット目標速度Vc_bktを、ローカル座標系の垂直軸方向における垂直速度成分Vcy_bkt及び水平速度成分Vcx_bktに変換する。
 距離取得部53は、図10に示すように、バケット8の刃先8Tと目標掘削地形43Iとの間の距離dを取得する。詳細には、距離取得部53は、前述したように取得した刃先8Tの位置情報及び目標掘削地形43Iの位置を示す目標掘削地形データU等から、バケット8の刃先8Tと目標掘削地形43Iとの間の最短となる距離dを算出する。本実施形態では、バケット8の刃先8Tと目標掘削地形43Iとの間の最短となる距離dに基づいて、掘削制御が実行される。
 制限速度決定部54は、バケット8の刃先8Tと目標掘削地形43Iとの間の距離dに基づいて、図1に示す作業機2全体の制限速度Vcy_lmtを算出する。作業機2全体の制限速度Vcy_lmtは、バケット8の刃先8Tが目標掘削地形43Iに接近する方向において許容できる刃先8Tの移動速度である。図2に示す記憶部26Mは、距離dと制限速度Vcy_lmtとの関係を規定する制限速度情報を記憶している。
 図11は、制限速度情報の一例を示している。図11中の横軸は距離d、縦軸は制限速度Vcyである。本実施形態において、刃先8Tが目標掘削地形43Iの外方、すなわち油圧ショベル100の作業機2側に位置しているときの距離dは正の値であり、刃先8Tが目標掘削地形43Iの内方、すなわち目標掘削地形43Iよりも掘削対象の内部側に位置しているときの距離dは負の値である。これは、例えば、図10に図示されるように、刃先8Tが目標掘削地形43Iの上方に位置しているときの距離dは正の値であり、刃先8Tが目標掘削地形43Iの下方に位置しているときの距離dは負の値であるとも言える。また、刃先8Tが目標掘削地形43Iに対して侵食しない位置にあるときの距離dは正の値であり、刃先8Tが目標掘削地形43Iに対して侵食する位置にあるときの距離dは負の値であるとも言える。刃先8Tが目標掘削地形43I上に位置しているとき、すなわち刃先8Tが目標掘削地形43Iと接しているときの距離dは0である。
 本実施形態において、刃先8Tが目標掘削地形43Iの内方から外方に向かうときの速度を正の値とし、刃先8Tが目標掘削地形43Iの外方から内方に向かうときの速度を負の値とする。すなわち、刃先8Tが目標掘削地形43Iの上方に向かうときの速度を正の値とし、刃先8Tが下方に向かうときの速度を負の値とする。
 制限速度情報において、距離dがd1とd2との間であるときの制限速度Vcy_lmtの傾きは、距離dがd1以上又はd2以下のときの傾きより小さい。d1は0より大きい。d2は0より小さい。目標掘削地形43I付近の操作においては制限速度をより詳細に設定するために、距離dがd1とd2との間であるときの傾きを、距離dがd1以上又はd2以下であるときの傾きよりも小さくする。距離dがd1以上のとき、制限速度Vcy_lmtは負の値であり、距離dが大きくなるほど制限速度Vcy_lmtは小さくなる。つまり、距離dがd1以上のとき、目標掘削地形43Iより上方において刃先8Tが目標掘削地形43Iから遠いほど、目標掘削地形43Iの下方へ向かう速度が大きくなり、制限速度Vcy_lmtの絶対値は大きくなる。距離dが0以下のとき、制限速度Vcy_lmtは正の値であり、距離dが小さくなるほど制限速度Vcy_lmtは大きくなる。つまり、バケット8の刃先8Tが目標掘削地形43Iから遠ざかる距離dが0以下のとき、目標掘削地形43Iより下方において刃先8Tが目標掘削地形43Iから遠いほど、目標掘削地形43Iの上方へ向かう速度が大きくなり、制限速度Vcy_lmtの絶対値は大きくなる。
 距離dが第1所定値dth1以上では、制限速度Vcy_lmtは、Vminとなる。第1所定値dth1は正の値であり、d1より大きい。Vminは、目標速度の最小値よりも小さい。つまり、距離dが第1所定値dth1以上では、作業機2の動作の制限が行われない。したがって、刃先8Tが目標掘削地形43Iの上方において目標掘削地形43Iから大きく離れているときには、作業機2の動作の制限、すなわち掘削制御が行われない。距離dが第1所定値dth1より小さいときに、作業機2の動作の制限が行われる。詳細には、後述するように、距離dが第1所定値dth1より小さいときに、ブーム6の動作の制限が行われる。
 制限速度決定部54は、作業機2全体の制限速度Vcy_lmtとアーム目標速度Vc_amとバケット目標速度Vc_bktとからブーム6の制限速度の垂直速度成分(以下、適宜ブーム6の制限垂直速度成分と称する)Vcy_bm_lmtを算出する。制限速度決定部54は、図12に示すように、作業機2全体の制限速度Vcy_lmtから、アーム目標速度の垂直速度成分Vcy_amと、バケット目標速度の垂直速度成分Vcy_bktとを減算することにより、ブーム6の制限垂直速度成分Vcy_bm_lmtを算出する。
 制限速度決定部54は、図13に示すように、ブーム6の制限垂直速度成分Vcy_bm_lmtを、ブーム6の制限速度(ブーム制限速度)Vc_bm_lmtに変換する。制限速度決定部54は、前述したブーム6の傾斜角θ1、アーム7の傾斜角θ2、バケット8の傾斜角θ3、GNSSアンテナ21、22の基準位置データ及び目標掘削地形データU等から、目標掘削地形43Iに垂直な方向とブーム制限速度Vc_bm_lmtの方向との間の関係を求め、ブーム6の制限垂直速度成分Vcy_bm_lmtを、ブーム制限速度Vc_bm_lmtに変換する。この場合の演算は、前述したブーム目標速度Vc_bmから目標掘削地形43Iに垂直な方向の垂直速度成分Vcy_bmを求めた演算と逆の手順により行われる。
 図2に示すシャトル弁51は、ブーム6の操作に基づいて生成されたパイロット圧力と、ブーム介入指令CBIに基づいて介入弁27Cが生成したパイロット圧力とのうち大きい方を選択して方向制御弁64に供給する。ブーム介入指令CBIに基づくパイロット圧力がブーム6の操作に基づいて生成されたパイロット圧力よりも大きい場合、ブーム介入指令CBIに基づくパイロット圧力によってブームシリンダ10に対応する方向制御弁64が動作する。その結果、ブーム制限速度Vc_bm_lmtに基づくブーム6の駆動が実現される。
 作業機制御部57は、作業機2を制御する。作業機制御部57は、アーム指令信号とブーム指令信号とブーム介入指令CBIとバケット指令信号とを図2に示す制御弁27及び介入弁27Cに出力することによって、ブームシリンダ10とアームシリンダ11とバケットシリンダ12とを制御する。アーム指令信号とブーム指令信号とブーム介入指令CBIとバケット指令信号とは、それぞれブーム指令速度とアーム指令速度とバケット指令速度とに応じた電流値を有する。
 ブーム6の上げ操作に基づいて生成されたパイロット圧力がブーム介入指令CBIに基づくパイロット圧力よりも大きい場合、シャトル弁51がレバー操作に基づくパイロット圧を選択する。ブーム6の操作に基づきシャトル弁51によって選択されたパイロット圧力によってブームシリンダ10に対応する方向制御弁64が動作する。すなわち、ブーム6は、ブーム目標速度Vc_bmに基づいて駆動されるので、ブーム制限速度Vc_bm_lmtに基づいては駆動されない。
 ブーム6の操作に基づいて生成されたパイロット圧力がブーム介入指令CBIに基づくパイロット圧力よりも大きい場合、作業機制御部57は、ブーム目標速度Vc_bm、アーム目標速度Vc_am及びバケット目標速度Vc_bktのそれぞれを、ブーム指令速度、アーム指令速度及びバケット指令速度として選択する。作業機制御部57は、ブーム目標速度Vc_bm、アーム目標速度Vc_am及びバケット目標速度Vc_bktに応じてブームシリンダ10、アームシリンダ11及びバケットシリンダ12の速度(シリンダ速度)を決定する。そして、作業機制御部57は、決定したシリンダ速度に基づいて制御弁27を制御することにより、ブームシリンダ10、アームシリンダ11及びバケットシリンダ12を動作させる。
 このように、通常運転時において、作業機制御部57は、ブーム操作量MBとアーム操作量MAとバケット操作量MTとに応じて、ブームシリンダ10とアームシリンダ11とバケットシリンダ12とを動作させる。したがって、ブームシリンダ10はブーム目標速度Vc_bmで動作し、アームシリンダ11はアーム目標速度Vc_amで動作し、バケットシリンダ12はバケット目標速度Vc_bktで動作する。
 ブーム介入指令CBIに基づくパイロット圧力がブーム6の操作に基づいて生成されたパイロット圧力よりも大きい場合、介入の指令に基づく介入弁27Cから出力されたパイロット圧をシャトル弁51が選択する。その結果、ブーム6は、ブーム制限速度Vc_bm_lmtで動作するとともに、アーム7は、アーム目標速度Vc_amで動作する。また、バケット8は、バケット目標速度Vc_bktで動作する。
 前述したように、作業機2全体の制限速度Vcy_lmtから、アーム目標速度の垂直速度成分Vcy_amとバケット目標速度の垂直速度成分Vcy_bktとを減算することにより、ブーム6の制限垂直速度成分Vcy_bm_lmtが算出される。したがって、作業機2全体の制限速度Vcy_lmtが、アーム目標速度の垂直速度成分Vcy_amとバケット目標速度の垂直速度成分Vcy_bktとの和よりも小さいときには、ブーム6の制限垂直速度成分Vcy_bm_lmtは、ブームが上昇する負の値となる。
 したがって、ブーム制限速度Vc_bm_lmtは、負の値となる。この場合、作業機制御部57は、ブーム6を下降させるが、ブーム目標速度Vc_bmよりも減速させる。このため、オペレータの違和感を小さく抑えながらバケット8が目標掘削地形43Iを侵食すること抑制することができる。
 作業機2全体の制限速度Vcy_lmtが、アーム目標速度の垂直速度成分Vcy_amとバケット目標速度の垂直速度成分Vcy_bktとの和よりも大きいときには、ブーム6の制限垂直速度成分Vcy_bm_lmtは、正の値となる。したがって、ブーム制限速度Vc_bm_lmtは、正の値となる。この場合、操作装置25がブーム6を下降させる方向に操作されていても、図2に示す介入弁27Cからの指令信号に基づき、ブーム6が上昇する。このため、目標掘削地形43Iの侵食の拡大を迅速に抑えることができる。
 刃先8Tが目標掘削地形43Iより上方に位置しているときには、刃先8Tが目標掘削地形43Iに近づくほど、ブーム6の制限垂直速度成分Vcy_bm_lmtの絶対値が小さくなるとともに、目標掘削地形43Iに平行な方向へのブーム6の制限速度の速度成分(以下、適宜制限水平速度成分と称する)Vcx_bm_lmtの絶対値も小さくなる。したがって、刃先8Tが目標掘削地形43Iより上方に位置しているときには、刃先8Tが目標掘削地形43Iに近づくほど、ブーム6の目標掘削地形43Iに垂直な方向への速度と、ブーム6の目標掘削地形43Iに平行な方向への速度とがともに減速される。油圧ショベルのオペレータによって左操作レバー25L及び右操作レバー25Rが同時に操作されることにより、ブーム6とアーム7とバケット8とが同時に動作する。このとき、ブーム6とアーム7とバケット8との各目標速度Vc_bm、Vc_am、Vc_bktが入力されたとして前述した制御を説明すると次の通りである。
 図14は、目標掘削地形43Iとバケット8の刃先8Tとの間の距離dが第1所定値dth1より小さく、バケット8の刃先が位置Pn1から位置Pn2に移動する場合のブーム6の制限速度の変化の一例を示している。位置Pn2での刃先8Tと目標掘削地形43Iとの間の距離は、位置Pn1での刃先8Tと目標掘削地形43Iとの間の距離よりも小さい。このため、位置Pn2でのブーム6の制限垂直速度成分Vcy_bm_lmt2は、位置Pn1でのブーム6の制限垂直速度成分Vcy_bm_lmt1よりも小さい。したがって、位置Pn2でのブーム制限速度Vc_bm_lmt2は、位置Pn1でのブーム制限速度Vc_bm_lmt1よりも小さくなる。また、位置Pn2でのブーム6の制限水平速度成分Vcx_bm_lmt2は、位置Pn1でのブーム6の制限水平速度成分Vcx_bm_lmt1よりも小さくなる。ただし、このとき、アーム目標速度Vc_am及びバケット目標速度Vc_bktに対しては、制限は行われない。このため、アーム目標速度の垂直速度成分Vcy_am及び水平速度成分Vcx_amと、バケット目標速度の垂直速度成分Vcy_bkt及び水平速度成分Vcx_bktに対しては、制限は行われない。
 前述したように、アーム7に対して制限を行わないことにより、オペレータの掘削意思に対応するアーム操作量の変化は、バケット8の刃先8Tの速度変化として反映される。このため、本実施形態は、目標掘削地形43Iの侵食の拡大を抑制しながらオペレータの掘削時の操作における違和感を抑えることができる。
 図5に示す制御可否判定部58は、横方向目標掘削地形データUwに基づいて、掘削制御を実行するか否かを判定する。制御可否判定部58は、例えば、バケット8の直下における横方向目標掘削地形データUwが水平面に対して所定の角度以上である場合には、実行中の掘削制御を停止する。制御可否判定部58が実行する処理については後述する。
 刃先8Tの刃先位置P4は、GNSSに限らず、他の測位手段によって測位されもよい。したがって、刃先8Tと目標掘削地形43Iとの距離dは、GNSSに限らず、他の測位手段によって測位されてもよい。バケット制限速度の絶対値は、バケット目標速度の絶対値よりも小さい。バケット制限速度は、例えば前述したアーム制限速度と同様の手法で算出されてもよい。なお、アーム7の制限とともにバケット8の制限が行われてもよい。次に、図2に示す油圧システム300の詳細及び掘削制御時における油圧システム300の動作を説明する。
 図15は、油圧ショベル100が備える油圧システム300の詳細な構造を示す図である。図15に示すように、油圧システム300は、ブームシリンダ10、アームシリンダ11及びバケットシリンダ12を含む油圧シリンダ60を備える。油圧シリンダ60は、図2に示す油圧ポンプ36、37から供給された作動油によって作動する。
 本実施形態においては、作動油が流れる方向を制御する方向制御弁64が設けられる。方向制御弁64は、ブームシリンダ10、アームシリンダ11及びバケットシリンダ12のそれぞれに配置される。以下において、ブームシリンダ10、アームシリンダ11及びバケットシリンダ12を区別しないときには、油圧シリンダ60と称する。方向制御弁64は、ロッド状のスプール64Sを動かして作動油が流れる方向を切り替えるスプール方式である。スプール64Sは、図2に示す操作装置25から供給された作動油パイロット油により移動する。方向制御弁64は、スプールの移動により油圧シリンダ60に作動油(以下、適宜パイロット油と称する)を供給して油圧シリンダ60を動作させる。
 図2に示す油圧ポンプ36、37から供給された作動油は、方向制御弁64を介して、油圧シリンダ60に供給される。スプール64Sが軸方向に移動することにより、油圧シリンダ60のキャップ側油室48Rに対する作動油の供給と、ロッド側油室47Rに対する作動油の供給とが切り替わる。また、スプール64Sが軸方向に移動することにより、油圧シリンダ60に対する作動油の供給量(単位時間当たりの供給量)が調整される。油圧シリンダ60に対する作動油の供給量が調整されることにより、油圧シリンダ60のシリンダ速度が調整される。後述するブームシリンダ10に作動油を供給する方向制御弁640及びアームシリンダ11に作動油を供給する方向制御弁641には、スプール64Sの移動量(移動距離)を検出するスプールストロークセンサ65設けられている。
 方向制御弁64の動作は、操作装置25によって調整される。油圧ポンプ36から送出され、減圧弁によって減圧された作動油がパイロット油として操作装置25に供給される。油圧ポンプ36とは異なるパイロット油圧ポンプから送出されたパイロット油が操作装置25に供給されてもよい。操作装置25は、各操作レバーの操作に基づいてパイロット油圧が調整される。そのパイロット油圧によって、方向制御弁64が駆動される。操作装置25によりパイロット油圧が調整されることによって、軸方向に関するスプール64Sの移動量が調整される。
 方向制御弁64は、ブームシリンダ10、アームシリンダ11及びバケットシリンダ12のそれぞれに設けられる。以下の説明において、ブームシリンダ10に接続される方向制御弁64を適宜、方向制御弁640、と称する。アームシリンダ11に接続される方向制御弁64を適宜、方向制御弁641、と称する。バケットシリンダ12に接続される方向制御弁64を適宜、方向制御弁642、と称する。
 操作装置25と方向制御弁64とは、パイロット油路450を介して接続される。方向制御弁64のスプール64Sを移動するためのパイロット油は、パイロット油路450を流れる。本実施形態において、パイロット油路450に、制御弁27、圧力センサ66及び圧力センサ67が配置されている。
 方向制御弁64に、パイロット油路450が接続される。パイロット油路450を介して、パイロット油が方向制御弁64に供給される。方向制御弁64は、第1受圧室及び第2受圧室を有する。パイロット油路450は、第1受圧室と第2受圧室とに接続される。後述するパイロット油路4520B、4521B、4522Bを介して方向制御弁64の第1受圧室にパイロット油が供給されると、そのパイロット油圧に応じてスプール64Sが移動し、方向制御弁64を介して油圧シリンダ60のキャップ側油室48Rに作動油が供給される。キャップ側油圧室48Rに対する作動油の供給量は、操作装置25の操作量(スプール64Sの移動量)により調整される。
 後述するパイロット油路4520A、4521A、4522Aを介して方向制御弁64の第2受圧室にパイロット油が供給されると、そのパイロット油圧に応じてスプールが移動し、方向制御弁64を介して油圧シリンダ60のロッド側油室47Rに作動油が供給される。ロッド側油圧室47Rに対する作動油の供給量は、操作装置25の操作量(スプール64Sの移動量)により調整される。
 すなわち、操作装置25によりパイロット油圧が調整されたパイロット油が方向制御弁64に供給されることにより、スプール64Sは軸方向に関して一方側に移動する。操作装置25によりパイロット油圧が調整されたパイロット油が方向制御弁64に供給されることにより、スプール64Sは軸方向に関して他方側に移動する。その結果、軸方向に関するスプール64Sの位置が調整される。
 以下の説明において、ブームシリンダ10に対して作動油を供給する方向制御弁640に接続されるパイロット油路450を適宜、ブーム調整用油路4520A、4520B、と称する。アームシリンダ11に対する作動油の供給を行う方向制御弁641に接続されるパイロット油路450を適宜、アーム調整用油路4521A、4521B、と称する。バケットシリンダ12に対する作動油の供給を行う方向制御弁642に接続されるパイロット油路450を適宜、バケット調整用油路4522A、4522B、と称する。
 以下の説明において、ブーム調整用油路4520Aに接続されるパイロット油路450を適宜、ブーム操作用油路4510A、と称し、ブーム調整用油路4520Bに接続されるパイロット油路450を適宜、ブーム操作用油路4510B、と称する。アーム調整用油路4521Aに接続されるパイロット油路450を適宜、アーム操作用油路4511A、と称し、アーム調整用油路4521Bに接続されるパイロット油路450を適宜、アーム操作用油路4511B、と称する。バケット調整用油路4522Aに接続されるパイロット油路450を適宜、バケット操作用油路4512A、と称し、バケット調整用油路4522Bに接続されるパイロット油路450を適宜、バケット操作用油路4512B、と称する。
 ブーム操作用油路(4510A、4510B)及びブーム調整用油路(4520A、4520B)は、パイロット油圧方式の操作装置25と接続される。ブーム操作用油路(4510A、4510B)に、操作装置25の操作量に応じて圧力が調整されたパイロット油が流れる。アーム操作用油路(4511A、4511B)及びアーム調整用油路(4521A、4521B)は、パイロット油圧方式の操作装置25と接続される。アーム操作用油路(4511A、4511B)に、操作装置25の操作量に応じて圧力が調整されたパイロット油が流れる。バケット操作用油路(4512A、4512B)及びバケット調整用油路(4522A、4522B)は、パイロット油圧方式の操作装置25と接続される。バケット操作用油路(4512A、4512B)に、操作装置25の操作量に応じて圧力が調整されたパイロット油が流れる。
 ブーム操作用油路4510A、ブーム操作用油路4510B、ブーム調整用油路4520A及びブーム調整用油路4520Bは、ブーム6を動作させるためのパイロット油が流れるブーム用油路である。アーム操作用油路4511A、アーム操作用油路4511B、アーム調整用油路4521A及びアーム調整用油路4521Bは、アーム7を動作させるためのパイロット油が流れるアーム用油路である。バケット操作用油路4512A、バケット操作用油路4512B、バケット調整用油路4522A及びバケット調整用油路4522Bは、バケット8を動作させるためのパイロット油が流れるバケット用油路である。
 前述したように、操作装置25の操作により、ブーム6は、下げ動作及び上げ動作の2種類の動作を実行する。ブーム6の下げ動作が実行されるように操作装置25が操作されることにより、ブームシリンダ10に接続された方向制御弁640に、ブーム操作用油路4510A及びブーム調整用油路4520Aを介して、パイロット油が供給される。方向制御弁640はパイロット油圧に基づいて作動する。その結果、油圧ポンプ36、37からの作動油がブームシリンダ10に供給され、ブーム6の下げ動作が実行される。
 ブーム6の上げ動作が実行されるように操作装置25が操作されることにより、ブームシリンダ10に接続された方向制御弁640に、ブーム操作用油路4510B及びブーム調整用油路4520Bを介して、パイロット油が供給される。方向制御弁640はパイロット油圧に基づいて作動する。その結果、油圧ポンプ36、37からの作動油がブームシリンダ10に供給され、ブーム6の上げ動作が実行される。
 すなわち、本実施形態において、ブーム操作用油路4510A及びブーム調整用油路4520Aは、方向制御弁640の第2受圧室と接続され、ブーム6を下げ動作させるためのパイロット油が流れるブーム下げ用油路である。ブーム操作用油路4510B及びブーム調整用油路4520Bは、方向制御弁640の第1受圧室と接続され、ブーム6を上げ動作させるためのパイロット油が流れるブーム上げ用油路である。
 また、操作装置25の操作により、アーム7は、下げ動作及び上げ動作の2種類の動作を実行する。アーム7の上げ動作が実行されるように操作装置25が操作されることにより、アームシリンダ11に接続された方向制御弁641に、アーム操作用油路4511A及びアーム調整用油路4521Aを介して、パイロット油が供給される。方向制御弁641はパイロット油圧に基づいて作動する。その結果、油圧ポンプ36、37からの作動油がアームシリンダ11に供給され、アーム7の上げ動作が実行される。
 アーム7の下げ動作が実行されるように操作装置25が操作されることにより、アームシリンダ11に接続された方向制御弁641に、アーム操作用油路4511B及びアーム調整用油路4521Bを介して、パイロット油が供給される。方向制御弁641はパイロット油圧に基づいて作動する。その結果、油圧ポンプ36、37からの作動油がアームシリンダ11に供給され、アーム7の下げ動作が実行される。
 すなわち、本実施形態において、アーム操作用油路4511A及びアーム調整用油路4521Aは、方向制御弁641の第2受圧室と接続され、アーム7を上げ動作させるためのパイロット油が流れるアーム上げ用油路である。アーム操作用油路4511B及びアーム調整用油路4521Bは、方向制御弁641の第1受圧室と接続され、アーム7を下げ動作させるためのパイロット油が流れるアーム下げ用油路である。
 操作装置25の操作により、バケット8は、下げ動作及び上げ動作の2種類の動作を実行する。バケット8の上げ動作が実行されるように操作装置25が操作されることにより、バケットシリンダ12に接続された方向制御弁642に、バケット操作用油路4512A及びバケット調整用油路4522Aを介して、パイロット油が供給される。方向制御弁642はパイロット油圧に基づいて作動する。その結果、油圧ポンプ36、37からの作動油がバケットシリンダ12に供給され、バケット8の上げ動作が実行される。
 バケット8の下げ動作が実行されるように操作装置25が操作されることにより、バケットシリンダ12に接続された方向制御弁642に、バケット操作用油路4512B及びバケット調整用油路4522Bを介して、パイロット油が供給される。方向制御弁642はパイロット油圧に基づいて作動する。その結果、油圧ポンプ36、37からの作動油がバケットシリンダ12に供給され、バケット8の下げ動作が実行される。
 すなわち、本実施形態において、バケット操作用油路4512A及びバケット調整用油路4522Aは、方向制御弁642の第2受圧室と接続され、バケット8を上げ動作させるためのパイロット油が流れるバケット上げ用油路である。バケット操作用油路4512B及びバケット調整用油路4522Bは、方向制御弁642の第1受圧室と接続され、バケット8を下げ動作させるためのパイロット油が流れるバケット下げ用油路である。
 制御弁27は、作業機コントローラ26からの制御信号(電流)に基づいて、パイロット油圧を調整する。制御弁27は、例えば、電磁比例制御弁であり、作業機コントローラ26からの制御信号に基づいて制御される。制御弁27は、制御弁27Aと、制御弁27Bとを含む。制御弁27Bは、方向制御弁64の第1受圧室に供給されるパイロット油のパイロット油圧を調整して、方向制御弁64を介して油圧シリンダ60のキャップ側油室48Rに供給される作動油の量を調整する。制御弁27Aは、方向制御弁64の第2受圧室に供給されるパイロット油のパイロット油圧を調整して、方向制御弁64を介して油圧シリンダ60のロッド側油室47Rに供給される作動油の量を調整する。
 制御弁27の両側に、パイロット油圧を検出する圧力センサ66及び圧力センサ67が設けられる。本実施形態において、圧力センサ66は、パイロット油路451において操作装置25と制御弁27との間に配置される。圧力センサ67は、パイロット油路452において制御弁27と方向制御弁64との間に配置される。圧力センサ66は、制御弁27によって調整される前のパイロット油圧を検出可能である。圧力センサ67は、制御弁27によって調整されたパイロット油圧を検出可能である。圧力センサ66は、操作装置25の操作によって調整されるパイロット油圧を検出可能である。圧力センサ66及び圧力センサ67の検出結果は、作業機コントローラ26に出力される。
 以下の説明において、ブームシリンダ10に対する作動油の供給を行う方向制御弁640に対するパイロット油圧を調整可能な制御弁27を適宜、ブーム用減圧弁270A、270B、と称する。ブーム用減圧弁270A、270Bは、ブーム操作用油路に配置される。以下の説明において、アームシリンダ11に対する作動油の供給を行う方向制御弁641に対するパイロット油圧を調整可能な制御弁27を適宜、アーム用減圧弁271A、271B、と称する。アーム用減圧弁271A、271Bは、アーム操作用油路に配置される。以下の説明において、バケットシリンダ12に対する作動油の供給を行う方向制御弁642に対するパイロット油圧を調整可能な制御弁27を適宜、バケット用減圧弁272、と称する。バケット用減圧弁272A、272Bは、バケット操作用油路に配置される。
 以下の説明において、ブームシリンダ10に対する作動油の供給を行う方向制御弁640に接続されるパイロット油路451のパイロット油圧を検出する圧力センサ66を適宜、ブーム用圧力センサ660B、と称し、方向制御弁640に接続されるパイロット油路452のパイロット油圧を検出する圧力センサ67を適宜、ブーム用圧力センサ670A、と称する。
 また、以下の説明において、ブーム操作用油路4510Aに配置されるブーム用圧力センサ660を適宜、ブーム用圧力センサ660A、と称し、ブーム操作用油路4510Bに配置されるブーム用圧力センサ660を適宜、ブーム用圧力センサ660B、と称する。また、ブーム調整用油路4520Aに配置されるブーム用圧力センサ670を適宜、ブーム用圧力センサ670A、と称し、ブーム調整用油路4520Bに配置されるブーム用圧力センサ670を適宜、ブーム用圧力センサ670B、と称する。
 以下の説明において、アームシリンダ11に対する作動油の供給を行う方向制御弁641に接続されるパイロット油路451のパイロット油圧を検出する圧力センサ66を適宜、アーム用圧力センサ661、と称し、方向制御弁641に接続されるパイロット油路452のパイロット油圧を検出する圧力センサ67を適宜、アーム用圧力センサ671、と称する。
 また、以下の説明において、アーム操作用油路4511Aに配置されるアーム用圧力センサ661を適宜、アーム用圧力センサ661A、と称し、アーム操作用油路4511Bに配置されるアーム用圧力センサ661を適宜、アーム用圧力センサ661B、と称する。また、アーム調整用油路4521Aに配置されるアーム用圧力センサ671を適宜、アーム用圧力センサ671A、と称し、アーム調整用油路4521Bに配置されるアーム用圧力センサ671を適宜、アーム用圧力センサ671B、と称する。
 以下の説明において、バケットシリンダ12に対する作動油の供給を行う方向制御弁642に接続されるパイロット油路451のパイロット油圧を検出する圧力センサ66を適宜、バケット用圧力センサ662、と称し、方向制御弁642に接続されるパイロット油路452のパイロット油圧を検出する圧力センサ67を適宜、バケット用圧力センサ672、と称する。
 また、以下の説明において、バケット操作用油路4512Aに配置されるバケット用圧力センサ661を適宜、バケット用圧力センサ661A、と称し、バケット操作用油路4512Bに配置されるバケット用圧力センサ661を適宜、バケット用圧力センサ661B、と称する。また、バケット調整用油路4522Aに配置されるバケット用圧力センサ672を適宜、バケット用圧力センサ672A、と称し、バケット調整用油路4522Bに配置されるバケット用圧力センサ672を適宜、バケット用圧力センサ672B、と称する。
 掘削制御を実行しない場合、作業機コントローラ26は、制御弁27を制御して、パイロット油路450を開ける(全開にする)。パイロット油路450が開くことにより、パイロット油路451のパイロット油圧とパイロット油路452のパイロット油圧とは等しくなる。制御弁27によりパイロット油路450が開いた状態で、パイロット油圧は、操作装置25の操作量に基づいて調整される。
 制御弁27によりパイロット油路450が全開したとき、圧力センサ66に作用するパイロット油圧と圧力センサ67に作用するパイロット油圧とは等しい。制御弁27の開度が小さくなることによって、圧力センサ66に作用するパイロット油圧と圧力センサ67に作用するパイロット油圧とは異なる。
 掘削制御等のように、作業機2が作業機コントローラ26によって制御される場合、作業機コントローラ26は、制御弁27に制御信号を出力する。パイロット油路451は、例えばパイロットリリーフ弁の作用により所定の圧力(パイロット油圧)を有する。作業機コントローラ26から制御弁27に制御信号が出力されると、制御弁27は、その制御信号に基づいて作動する。パイロット油路451のパイロット油は、制御弁27を介して、パイロット油路452に供給される。パイロット油路452のパイロット油圧は、制御弁27により調整(減圧)される。パイロット油路452のパイロット油圧が、方向制御弁64に作用する。これにより、方向制御弁64は、制御弁27で制御されたパイロット油圧に基づいて作動する。本実施形態において、圧力センサ66は、制御弁27によって調整される前のパイロット油圧を検出する。圧力センサ67は、制御弁27によって調整された後のパイロット油圧を検出する。
 減圧弁27Aにより圧力が調整されたパイロット油が方向制御弁64に供給されることにより、スプール64Sは軸方向に関して一側に移動する。減圧弁27Bにより圧力が調整されたパイロット油が方向制御弁64に供給されることにより、スプール64Sは軸方向に関して他側に移動する。その結果、軸方向に関するスプール64Sの位置が調整される。
 例えば、作業機コントローラ26は、ブーム用減圧弁270A及びブーム用減圧弁270Bの少なくとも一方に制御信号を出力して、ブームシリンダ10に接続された方向制御弁640に対するパイロット油圧を調整することができる。
 また、作業機コントローラ26は、アーム用減圧弁271A及びアーム用減圧弁271Bの少なくとも一方に制御信号を出力して、アームシリンダ11に接続された方向制御弁641に対するパイロット油圧を調整することができる。
 また、作業機コントローラ26は、バケット用減圧弁272A及びバケット用減圧弁272Bの少なくとも一方に制御信号を出力して、バケットシリンダ12に接続された方向制御弁642に対するパイロット油圧を調整することができる。
 作業機コントローラ26は、掘削制御において、前述したように、掘削対象の目標形状である設計地形を示す目標掘削地形43I(目標掘削地形データU)とバケット8の位置を示すバケット刃先位置データSとに基づき、目標掘削地形43Iとバケット8との距離dに応じてバケット8が目標掘削地形43Iに近づく速度が小さくなるように、ブーム6の速度を制限する。
 本実施形態において、作業機コントローラ26は、ブーム6の速度を制限するための制御信号を出力するブーム制限部を有する。本実施形態においては、操作装置25の操作に基づいて作業機2が駆動する場合において、バケット8の刃先8Tが目標掘削地形43Iに侵入しないように、作業機コントローラ26のブーム制限部から出力される制御信号に基づいて、ブーム6の動きが制御(ブーム介入制御)される。具体的には、掘削制御において、刃先8Tが目標掘削地形43Iに侵入しないように、ブーム6は、作業機コントローラ26により、上げ動作が実行される。
 本実施形態においては、ブーム介入制御を実現するために、作業機コントローラ26から出力された、ブーム介入制御に関する制御信号に基づいて作動する介入弁27Cがパイロット油路50に設けられる。ブーム介入制御において、パイロット油路50に、圧力がパイロット油圧に調整されたパイロット油が流れる。介入弁27Cは、パイロット油路50に配置され、パイロット油路50のパイロット油圧を調整可能である。
 以下の説明において、ブーム介入制御において圧力が調整されたパイロット油が流れるパイロット油路50を適宜、介入用油路501、502と称する。
 介入用油路501に、ブームシリンダ10に接続された方向制御弁640に供給されるパイロット油が流れる。介入用油路油路501は、方向制御弁640と接続されたブーム操作用油路4510B及びブーム調整用油路4520Bにシャトル弁51を介して接続されている。
 シャトル弁51は、2つの入口と、1つの出口とを有する。一方の入口は、介入用油路501と接続される。他方の入口は、ブーム操作用油路4510Bと接続される。出口は、ブーム調整用油路4520Bと接続される。シャトル弁51は、介入用油路501及びブーム操作用油路4510Bのうち、パイロット油圧が高い方の油路と、ブーム調整用油路4520Bとを接続する。例えば、介入用油路501のパイロット油圧がブーム操作用油路4510Bのパイロット油圧よりも高い場合、シャトル弁51は、介入用油路501とブーム調整用油路4520Bとを接続し、ブーム操作用油路4510Bとブーム調整用油路4520Bとを接続しないように作動する。その結果、介入用油路501のパイロット油がシャトル弁51を介してブーム調整用油路4520Bに供給される。ブーム操作用油路4510Bのパイロット油圧が介入用油路501のパイロット油圧よりも高い場合、シャトル弁51は、ブーム操作用油路4510Bとブーム調整用油路4520Bとを接続し、介入用油路501とブーム調整用油路4520Bとを接続しないように作動する。これにより、ブーム操作用油路4510Bのパイロット油がシャトル弁51を介してブーム調整用油路4520Bに供給される。
 介入用油路501に、介入弁27Cと、介入用油路501のパイロット油のパイロット油圧を検出する圧力センサ68とが設けられている。介入用油路501は、介入弁27Cを通過する前のパイロット油が流れる介入用油路501と、介入弁27Cを通過した後のパイロット油が流れる介入用油路502とを含む。介入弁27Cは、ブーム介入制御を実行するために作業機コントローラ26から出力された制御信号に基づいて制御される。
 ブーム介入制御が実行されないとき、操作装置25の操作によって調整されたパイロット油圧に基づいて方向制御弁64が駆動されるようにする。例えば、作業機コントローラ26は、操作装置25の操作によって調整されたパイロット油圧に基づいて方向制御弁640が駆動されるように、ブーム用減圧弁270Bによりブーム操作用油路4510Bを開ける(全開にする)とともに、介入弁27Cにより介入用油路501を閉じる。
 ブーム介入制御が実行されるとき、作業機コントローラ26は、介入弁27Cによって調整されたパイロット油圧に基づいて方向制御弁640が駆動されるように、各制御弁27を制御する。例えば、掘削制御においてブーム6の移動を制限するブーム介入制御を実行する場合、作業機コントローラ26は、介入弁27Cによって調整された介入用油路50のパイロット油圧が、操作装置25によって調整されるブーム操作用油路4510Bのパイロット油圧よりも高くなるように、介入弁27Cを制御する。このようにすることで、介入弁27Cからのパイロット油がシャトル弁51を介して方向制御弁640に供給される。
 バケット8が目標掘削地形43Iに侵入しないように操作装置25によりブーム6が高速で上げ動作される場合、ブーム介入制御は実行されない。この場合、ブーム6が高速で上げ動作されるように操作装置25が操作され、その操作量に基づいてパイロット油圧が調整されることにより、操作装置25の操作によって調整されるブーム操作用油路4510Bのパイロット油圧は、介入弁27Cによって調整される介入用油路501のパイロット油圧よりも高くなる。その結果、操作装置25の操作によってパイロット油圧が調整されたブーム操作用油路4510Bのパイロット油がシャトル弁51を介して方向制御弁640に供給される。
 ブーム介入制御において、作業機コントローラ26は、制限条件が満たされているか否かを判定する。制限条件は、距離dが前述した第1所定値dth1より小さいこと及びブーム制限速度Vc_bm_lmtがブーム目標速度Vc_bmよりも大きいことを含む。例えば、ブーム6を下降させる場合、ブーム6の下方へのブーム制限速度Vc_bm_lmtの大きさが、下方へのブーム目標速度Vc_bmの大きさよりも小さいときには、作業機コントローラ26は、制限条件が満たされていると判定する。また、ブーム6を上昇させる場合、ブーム6の上方へのブーム制限速度Vc_bm_lmtの大きさが、上方へのブーム目標速度Vc_bmの大きさよりも大きいときには、作業機コントローラ26は、制限条件が満たされていると判定する。
 制限条件が満たされている場合、作業機コントローラ26は、ブーム制限速度Vc_bm_lmtでブームが上昇するようにブーム介入指令CBIを生成し、ブームシリンダ10の制御弁27を制御する。このようにすることで、ブームシリンダ10の方向制御弁640は、ブーム制限速度Vc_bm_lmtでブームが上昇するように作動油をブームシリンダ10に供給するので、ブームシリンダ10は、ブーム制限速度Vc_bm_lmtでブーム6を上昇させる。
 実施形態1において、アーム制限速度Vc_am_lmtの絶対値が、アーム目標速度Vc_amの絶対値よりも小さいことが、制限条件に含まれてもよい。制限条件は、他の条件をさらに含んでもよい。例えば、制限条件は、アーム操作量が0であることをさらに含んでもよい。制限条件は、距離dが第1所定値dth1より小さいことを含まなくてもよい。例えば、制限条件は、ブーム6の制限速度がブーム目標速度よりも大きいことのみであってもよい。
 第2所定値dth2は、第1所定値dth1より小さければ、0より大きくてもよい。この場合には、ブーム6の刃先8Tが目標掘削地形43Iに到達する前に、ブーム6の制限とアーム7の制限との両方が行われる。このため、ブーム6の刃先8Tが目標掘削地形43Iに到達する前であっても、ブーム6の刃先8Tが目標掘削地形43Iを超えそうなときに、ブーム6の制限とアーム7の制限との両方を行うことができる。
(操作レバーが電気方式である場合)
 左操作レバー25L及び右操作レバー25Rが電気方式である場合、操作レバー25L及び右操作レバー25Rに対応するポテンショメータ等の電気信号を作業機コンコントローラ26が取得する。この電気信号を、操作指令電流値と称する。作業機コントローラ26は、操作指令電流値に基づく開閉指令を制御弁27へ出力する。制御弁27からは、開閉指令に応じた圧力の作動油が方向制御弁のスプールに供給されてスプールを移動させるので、方向制御弁を介してブームシリンダ10、アームシリンダ11又はバケットシリンダ12に作動油が供給されてこれらが伸縮する。
 掘削制御において、作業機コントローラ26は、掘削制御の指令値及び操作指令電流値に基づく開閉指令を制御弁27に出力する。掘削制御の指令値は、例えば、前述したブーム介入指令CBIであり、掘削制御においてブーム介入制御を実行するための指令値である。開閉指令が入力された制御弁27は、開閉指令に応じた圧力の作動油が方向制御弁のスプールに供給されてスプールを移動させる。ブームシリンダ10の方向制御弁のスプールには、掘削制御の指令値に応じた圧力の作動油が供給されるので、ブームシリンダ10が伸びてブーム6を上昇させる。次に、油圧ショベル100の作業機2が溝を掘削する際の掘削制御について説明する。
<溝掘削について>
 図16、図17、図18、図19A及び図19Bは、溝70を掘削するときのバケット8と溝70との関係を示す図である。図16及び図19Aは、油圧ショベル100の後方から見た状態を示し、図17及び図19Bは、油圧ショベル100の側方から見た状態を示す。溝70は、対向する溝壁71、72と、溝壁71、72との間の溝底73とで形成される。溝70は、例えば、水道管のような埋設物を埋め込むために掘削され、埋設物が設置されると埋め戻される。このため、一般には、溝70は溝底73の位置精度が重要であり、溝壁71、72の位置精度はそれ程要求されない。このため、溝70の掘削においては、溝壁71、72はある程度掘り込まれてもよい。溝70の掘削において、図5に示す作業機コントローラ26は、バケット8の刃先8Tが溝底73を掘り込み過ぎないように、溝底73の目標掘削地形43I(目標掘削地形データU)と刃先8Tの位置情報とに基づいて掘削制御を実行する。
 本実施形態においては、例えば、バケット8の刃先8Tと目標掘削地形43Iとの間の最短となる距離dに基づいて掘削制御が実行される。このため、図18及び図19Aに示すように、例えば掘削により一方の溝壁71に向かってバケット8が接近し、バケット8の幅方向外側の部分が掘削すると、その部分の刃先8Tと溝70(より具体的には溝壁71)との距離が最短となる。この場合、図19Bに示すように、距離dは負、すなわち刃先8Tは、溝壁71の目標掘削地形43Iの下方に位置するので、掘削制御が実行中である場合、作業機コントローラ26は、バケット8が溝壁71から離れるように油圧ショベル100のブーム6を制御して、バケット8を上昇させる。その結果、油圧ショベル100のオペレータが意図しない動作をすることになり、オペレータに違和感を与える。これは、例えば、バケット8の幅方向における最も外側の刃先8Tと目標掘削地形43Iとの間の距離に基づいて掘削制御が実行される場合も同様である。
 図20は、目標掘削地形43Iから前後方向目標掘削地形データUを切り出す位置を説明するための図である。図21は、目標掘削地形43Iから前後方向目標掘削地形データUを切り出す平面を説明するための図である。図20に示す例において、バケット8と目標掘削地形43Iとはyz平面内において傾斜している。この場合、幅方向(y軸方向)における最も外側の刃8Btの刃先8Tと、目標掘削地形43Iとの距離dmが最短になる。図21に示す平面42mは、xz平面と平行であり、かつ図20に示すバケット8の幅方向における最も外側の刃8Btの刃先8Tを通る。したがって、平面42mと目標施工面41とが交差する部分の情報が、バケット8の刃先8Tと目標掘削地形43Iとの間の最短となる距離dの位置における前後方向目標掘削地形データUになる。
 前後方向目標掘削地形データUは、バケット8の幅方向中央における位置において、目標掘削地形43Iから切り出されてもよい。図20に示す例において、幅方向中央における刃8Bcの刃先8Tと目標掘削地形43Iとの距離dc及び幅方向中央における刃8Bcの刃先8Tの位置で切り出された前後方向目標掘削地形データUに基づいて、掘削制御が行われる。図21に示す平面42は、xz平面と平行であり、かつ図20に示すバケット8の幅方向中央における刃8Btの刃先8Tを通る。したがって、平面42と目標掘削地形43Iとが交差する部分の情報が、バケット8の幅方向中央の位置における前後方向目標掘削地形データUになる。
 本実施形態においては、バケット8の刃先8Tと目標掘削地形43Iとの間の最短となる距離dに基づく掘削制御と、バケット8の幅方向中央における刃8Bcの刃先8Tと目標掘削地形43Iとの距離dcに基づく掘削制御と、バケット8の幅方向における最も外側の刃先8Tと目標掘削地形43Iとの間の距離に基づく掘削制御とがある。油圧ショベル100のオペレータは、例えば、図2に示すスイッチ29Sを操作して、これらを切り替えることができる。
 掘削制御において、作業機コントローラ26は、バケット8の幅方向中央の位置における前後方向目標掘削地形データUを用いれば、バケット8の幅方向外側が図18及び図19Aに示す溝壁71又は溝壁72を掘り込んだとしても、オペレータが意図しないバケット8の上昇は抑制される。バケット8の幅方向中央の位置における前後方向目標掘削地形データUが用いられることにより、バケット8の幅方向外側が溝壁71又は溝壁72を掘り込んだ場合でも、前後方向目標掘削地形データUは溝底73に対応する目標施工情報Tから生成されたものだからである。このように、作業機コントローラ26は、オペレータが意図する通りに作業機2を動作させることができる。
 本実施形態において、掘削制御を用いて溝70を掘削する場合、例えば、バケット8の幅方向中央の位置における前後方向目標掘削地形データUを用いるモードを選択すれば、溝70を掘削する場合にオペレータが意図しない動作をある程度は回避できる。しかし、溝70の掘削と他の作業とが継続して行われるような場合、オペレータがバケット8の幅方向中央の位置における前後方向目標掘削地形データUを用いるモードを選択し忘れるようになることがある。このような場合、オペレータが意図しない動作が発生する可能性がある。本実施形態は、バケット8の刃先8Tと目標掘削地形43Iとの間の最短となる距離dを用いるモードを維持した状態で、掘削制御を用いて溝70を掘削する場合であっても、オペレータの意図しないバケット8の動作を抑制するため、前述した幅方向目標掘削地形データUwを用いる。
<溝70を掘削する際の掘削制御>
 図22及び図23は、幅方向目標掘削地形データUwを切り出す平面45を説明するための図である。第1切り出し面としての平面45は、幅方向目標掘削地形データUwを、目標形状を示す第1の目標施工面としての目標施工面41及び目標施工面41の側方に連なる第2の目標施工面としての目標施工面41Sから切り出す。第2切り出し面としての平面42は、前述した前後方向目標掘削地形データUを、目標形状を示す第1の目標施工面としての目標施工面41から切り出す。平面45は、作業機動作平面と交差(本実施形態では直交)し、かつグローバル座標系における鉛直方向と平行な平面である。平面42は、作業機2の動作平面又は動作平面と平行な平面である。本実施形態においては、図1に示す作業機2のうちアーム2が動作する所定の平面、すなわち前述したアーム動作平面又はアーム動作平面と平行な平面が、平面42となる。
 平面42及び平面45が目標施工面41から目標掘削地形43Iを切り出す場合、平面42及び平面45は、いずれも掘削対象位置44を通る。掘削対象位置44は、グローバル座標系において刃先8Tの現時点における刃先位置P4を通る、鉛直方向に下ろされた垂線と目標施工面41との交点である。刃先位置P4は、バケット8の幅方向中央で目標施工面41から目標掘削地形43Iを切り出すか、幅方向外側で目標掘削地形43Iを切り出すか、刃先8Tと目標掘削地形43Iとの最短距離となる位置で目標掘削地形43Iを切り出すかによって、バケット8の幅方向の位置が変化する。
 平面42と目標施工面41とが交差する部分における目標施工面41の位置情報、すなわち交線43の位置情報が、前後方向目標掘削地形データUである。前後方向目標掘削地形データUによって、前後方向における目標掘削地形43Iが生成される。図23に示すように、交線43を基準として、油圧ショベル100の側方視において、平面45と図22に示す目標施工面41とが交差する部分の位置情報、すなわち交線46の位置情報が、幅方向目標掘削地形データUwである。幅方向目標掘削地形データUwによって、幅方向における目標掘削地形46Iが生成される。
 図24は、溝70を掘削する際の目標掘削地形46Iと油圧ショベル100のバケット8との関係を示す図である。図24に示す溝70は、目標掘削地形46I、すなわち幅方向目標掘削地形データUwに含まれる情報のうち、第1変曲点Pv1、第2変曲点Pv2、第3変曲点Pv3及び第4変曲点Pv4と、これらを接続する直線とで表される。第1変曲点Pv1と第2変曲点Pv2との間が溝底73であり、第2変曲点Pv2と第3変曲点Pv3との間が溝壁71であり、第1変曲点Pv1と第3変曲点Pv3との間が溝壁72である。
 図24中の直線LN1、LN2、LN3は、ローカル座標系(x、y、z)におけるyz平面内における水平線、すなわちy軸に平行な線である。直線LN1、直線LN2又は直線LN3を含み、ローカル座標系(x、y、z)におけるz軸と直交する平面は、ローカル座標系(x、y、z)におけるxy平面と平行な平面、すなわちローカル座標系(x、y、z)の水平面である。ローカル座標系(x、y、z)における水平面は、油圧ショベル100の姿勢によって鉛直方向との関係が変化する。
 第1変曲点Pv1の座標は(y1、z1)、第2変曲点Pv2の座標は(y2、z2)、第3変曲点Pv3の座標は(y3、z3)、第4変曲点Pv4の座標は(y4、z4)である。ローカル座標系(x、y、z)の水平面に対する目標掘削地形46Iの角度αは、第1変曲点Pv1及び第2変曲点Pv2等の座標を用いて求めることができる。例えば、図24に示す例において、バケット8の直下における目標掘削地形46Iの、ローカル座標系(x、y、z)の水平面に対する角度、すなわち第1変曲点Pv1と第2変曲点Pv2とを結ぶ直線と直線LN1とのなす角度α1は、arctan((z2-z1)/(y2-y1))で求めることができる。油圧ショベル100の後方から見て右側における目標掘削地形46Iの、ローカル座標系(x、y、z)の水平面に対する角度α2は、arctan((z3-z2)/(y3-y2))で求めることができる。油圧ショベル100の後方から見て左側における目標掘削地形46Iの、ローカル座標系(x、y、z)の水平面に対する角度α3は、arctan((z1-z4)/(y1-y4))で求めることができる。このように、目標掘削地形46Iの、ローカル座標系(x、y、z)の水平面に対する角度αは、少なくとも2つの変曲点の座標から求めることができる。前後方向における目標掘削地形43Iも同様に取得される。
 作業機コントローラ26は、表示コントローラ28から取得した作業機2の位置、より具体的にはバケット8の刃先位置P4、前後方向目標掘削地形データU及び幅方向目標掘削地形データUwに基づいて、掘削制御を実行する。より具体的には、作業機コントローラ26は、前後方向目標掘削地形データUに基づいて作業機2の前後方向における掘削制御を実行し、図5に示す作業機コントローラ26の制御可否判定部58は、幅方向目標掘削地形データUwに基づいて実行中の掘削制御を停止したり、停止中の掘削制御を再開したりする。このように、本実施形態において、掘削制御におけるブーム6の制御量は、前後方向目標掘削地形データUに基づいて求められる。幅方向目標掘削地形データUwは、掘削制御を停止するか実行するかの判定に用いられる。
 本実施形態において、作業機コントローラ26の制御可否判定部58は、表示コントローラ28から幅方向目標掘削地形データUwを取得する。制御可否判定部58は、バケット8の直下における幅方向目標掘削地形データUwの水平面に対する角度αが予め定められた大きさ(以下、適宜傾斜角度閾値と称する)αc以上である場合に、掘削制御を停止する。本実施形態において、傾斜角度閾値αcは70度であるが、これに限定されるものではない。図24に示す例において、バケット8の直下における幅方向目標掘削地形データUwの、直線LN1に対応する水平面に対する角度α1は、傾斜角度閾値αcよりも小さい。この場合、制御可否判定部58は実行中の掘削制御を継続する。
 図24に示す例において、上部旋回体3が、例えば、油圧ショベル100の後方から見て右側に旋回し、バケット8の直下に溝壁71が位置するようになったとする。溝壁71に対応する幅方向目標掘削地形データUwの、直線LN2に対応する水平面に対する角度α2は、傾斜角度閾値αc以上である。この場合、制御可否判定部58は実行中の掘削制御を停止する。その結果、作業機コントローラ26は、バケット8が溝壁71を掘削しても、バケット8を溝壁71から離れる方向に移動させず、ブーム6、アーム7及びバケット8を、それぞれのブーム目標速度Vc_bm、アーム目標速度Vc_am及びバケット目標速度Vc_bktに基づいて制御する。このようにすることで、油圧ショベル100が、掘削制御を実行しながら溝70を掘削している場合にバケット8が溝壁71、72を掘削した場合には、オペレータの操作にしたがって作業機2が動作する。その結果、作業機2はオペレータの意図した通りに動作するので、オペレータが受ける違和感が低減される。
 バケット8が溝壁71の上方に位置する状態から、上部旋回体3が、油圧ショベル100の後方から見て左側に旋回し、バケット8の直下に再び溝底73が位置するようになったとする。この場合、バケット8の直下における幅方向目標掘削地形データUwの、直線LN1に対応する水平面に対する角度α1は、傾斜角度閾値αcよりも小さくなる。すると、制御可否判定部58は停止の掘削制御を再開する。このような制御により、油圧ショベル100が溝底73を掘削する場合は掘削制御が実行されるので、バケット8の刃先8Tが溝底73の目標掘削地形43I、46Iを超えて掘削することが抑制されるので、溝底73の寸法及び位置の精度低下が抑制される。作業機コントローラ26は、幅方向における目標掘削地形に基づき掘削制御を実行してもよい。本実施形態では、バケット8の幅方向中央位置において前後方向目標掘削地形データUを設定するモードを使用しない場合について説明したが、モード設定を使用した場合又はモード設定がない場合も本実施形態に含まれてよい。次に、本実施形態に係る作業機械の制御方法を用いて溝70を掘削する際の制御例を説明する。
(本実施形態に係る作業機械の制御方法の制御例)
 図25は、溝70を掘削する際の制御例を示すフローチャートである。ステップS101において、図2に示すスイッチ29Sをオペレータが操作することにより掘削制御が開始されると、ステップS102において、図5に示す表示コントローラ28は、センサコントローラ39から傾斜角θ1、θ2、θ3を取得し、傾斜角θ1、θ2、θ3及び油圧ショベル100の旋回中心位置データXRから、バケット刃先位置データSを生成する。ステップS103において、図5に示す作業機コントローラ26は、目標掘削地形43Iとバケット8の刃先8Tとの距離dを求める。
 ステップS104において、作業機コントローラ26は、油圧ショベル100のオペレータが作業機2を操作することによる目標掘削地形43I方向の刃先速度、具体的にはブーム目標速度Vc_bmを求める。次に、ステップS105において、図5に示す作業機コントローラ26の制御可否判定部58は、バケット8の直下における目標掘削地形46I(幅方向目標掘削地形データUw)を及び刃先位置P4を作業機コントローラ26から取得し、目標掘削地形46Iの水平面に対する角度αを求める。そして、制御可否判定部58は、得られた角度αと傾斜角度閾値αcとを比較する。比較の結果、α≧αcである場合(ステップS105、Yes)、バケット8の直下は溝70の溝壁71、72である。このため、ステップS106において、制御可否判定部58は掘削制御を停止する。この場合、オペレータによる作業機コントローラ26の操作にしたがって作業機2が動作する。
 α<αcである場合(ステップS105、No)、バケット8の直下は溝70の溝壁71、72ではないので、掘削制御を実行してもよい状態である。この場合、ステップS107において、制御可否判定部58は掘削制御を実行する。このため、バケット8の刃先8Tが、目標掘削地形46Iを超えて掘削対象を掘削しようとした場合、作業機コントローラ26は、例えばブーム6を上昇させて、バケット8が目標掘削地形46Iを超えて掘り込むことを抑制する。
(実施形態2)
 図26は、溝70を掘削しているときに油圧ショベル100のバケット8が側壁71aに向かう状態を示す図である。図27は、油圧ショベル100の後方からバケット8を見た状態を示す図である。図28は、バケット8が側壁71aに接近するときの速度成分を説明するための図である。図29は、バケット8の刃先8Tと側壁71aとの距離dを示す図である。図30は、ブーム制限速度Vc_bm_lmtを説明するための図である。
 実施形態2は、作業機2、より具体的にはバケット8が、その幅方向の速度成分を有する場合に、作業機2の幅方向の目標掘削地形46I(幅方向目標掘削地形データUw)に基づいて、掘削制御を実行する。例えば、図26に示すように、油圧ショベル100が地面73Aを掘削しているときに、例えば上部旋回体3が旋回することにより(本例では図26の矢印RDで示す方向)、作業機2が側壁71aの方向に向かって移動することがある。この場合、溝の掘削を対象とした実施形態1では掘削制御が停止されるが、本実施形態では、バケット8が側壁71aの目標掘削地形74を超えて掘り込まないように、作業機2の幅方向においても掘削制御が実行される。具体的には、例えば、作業機コントローラ26は、図27に示すようにバケット8が側壁71aに向かって速度Vctで接近している場合に、バケット8が側壁71aの目標掘削地形74を超えて掘り込む可能性があると判定したら、例えば、図1に示すブーム6を上昇させてこれを回避する。
 本実施形態において、作業機コントローラ26は、作業機2に、その幅方向の速度成分が発生した場合に、幅方向における掘削制御を実行する。作業機2の幅方向の速度成分は、図1に示す上部旋回体3の旋回によって発生する。また、油圧ショベル100のローカル座標系におけるxy平面において、作業機2が走行装置5の進行方向に対して傾いている場合にも、作業機2の幅方向の速度成分が発生する。本実施形態においては、上部旋回体3の旋回が発生した場合に幅方向における掘削制御を実行する例を説明するが、走行装置5の走行によって作業機2の幅方向の速度成分が発生した場合に、幅方向における掘削制御を実行してもよい。また、走行装置5が走行している場合、幅方向における掘削制御を停止するようにしてもよい。
 図31は、幅方向における掘削制御の処理例を示すフローチャートである。次の説明においては、バケット8が溝70の側壁71aを掘り込み過ぎないように幅方向における掘削制御を実行する例を説明するが、掘削対象は側壁71a以外、例えば法面等であってもよい。幅方向における目標掘削地形74は、幅方向を図22に示す掘削対象位置44に基づいて目標掘削地形46I(幅方向目標掘削地形データUw)が取得される場合と同様の方法で取得される。
 幅方向における掘削制御を実行するにあたり、図5に示す作業機コントローラ26の記憶部26Mは、目標速度情報として、旋回操作量MRと旋回目標角速度ωctとの関係を規定する情報を記憶している。ステップS21において、図5に示す目標速度決定部52は、操作装置25から旋回操作量MRを取得し、得られた旋回操作量MRにより旋回目標角速度ωctを求める。次に、ステップS22において、目標速度決定部52は、傾斜角θ1、θ2、θ3及びブーム6の長さL1、アーム7の長さL2及びバケット8の長さL3から、図3Aに示す旋回軸zとバケット8の刃先8Tとの距離LRを求める。この距離LRは、刃先8Tの旋回半径である。ステップS23において、目標速度決定部52は、旋回目標角速度ωctと刃先8Tの旋回半径(距離LR)とを乗ずることにより、刃先8Tの旋回目標速度Vctを求める。
 次に、ステップS24において、目標速度決定部52は、図28に示すように、旋回目標速度Vctを、目標掘削地形74(幅方向目標掘削地形データUw)に垂直な方向の速度成分(以下、適宜垂直速度成分と称する)Vcy_t及び目標掘削地形74(幅方向目標掘削地形データUw)に平行な方向の速度成分(以下、適宜水平速度成分と称する)Vcx_tに変換する。図28に示す例では、側壁71aに対応する目標掘削地形74に対して垂直速度成分Vcy_t及び水平速度成分Vcx_tが求められる。図28に示す例は、側壁71aが油圧ショベル100のローカル座標系(x、y、z)の水平面HL、すなわちxy平面と平行な平面に対して角度αだけ傾斜している。このため、垂直速度成分Vcy_tはVct×cos(π/2-α)、水平速度成分Vcx_tはVct×sin(π/2-α)で求めることができる。
 ステップS25において、図5に示す作業機コントローラ26の距離取得部53は、図29に示すように、バケット8の刃先8Tと側壁71aに対応する目標掘削地形74との間の距離dを取得する。詳細には、距離取得部53は、前述したように取得した刃先8Tの位置情報及び目標掘削地形74の位置を示す幅方向目標掘削地形データUwから、バケット8の幅方向中央の刃先8Tと目標掘削地形74との間の距離dを算出する。この場合、距離取得部53は、バケット8の刃先8Tと目標掘削地形74との間の最短となる距離を算出し、作業機コントローラ26は、これに基づいて幅方向における掘削制御を実行してもよい。
 ステップS26において、図5に示す作業機コントローラ26の制限速度決定部54は、バケット8の刃先8Tと目標掘削地形74との間の距離dに基づいて、図1に示す作業機2全体の制限速度Vcy_lmtを算出する。作業機2全体の制限速度Vcy_lmtについては、実施形態1と同様であるので説明を省略する。ステップS27において、制限速度決定部54は、図30に示すように、作業機2全体の制限速度Vcy_lmtから旋回目標速度Vctの垂直速度成分Vcy_tを減算することにより、ブーム6の制限垂直速度成分Vcy_bm_lmtを算出する。
 ステップS28において、制限速度決定部54は、図30に示すように、ブーム6の制限垂直速度成分Vcy_bm_lmtを、ブーム6の制限速度(ブーム制限速度)Vc_bm_lmtに変換する。具体的には、制限垂直速度成分Vcy_bm_lmtにsin(π/2-α)を乗ずることにより、ブーム制限速度Vc_bm_lmtが得られる。ステップS29において、ブーム介入指令CBIに基づくパイロット圧力がブーム6の操作に基づいて生成されたパイロット圧力よりも大きい場合、作業機コントローラ26の作業機制御部57は、ブーム6の速度がブーム制限速度Vc_bm_lmtとなるようにブーム指令信号CBを生成し、図2及び図15に示すに示す介入弁27Cを制御する。
 本実施形態は、幅方向における掘削制御を実行することにより、例えば、掘削後に上部旋回体3を旋回させたときにバケットが法面等に接触するような事態を回避できる。本実施形態において、作業機コントローラ26aは、幅方向における掘削制御と、前後方向における掘削制御との両方を並行して実行してもよい。また、作業機コントローラ26は、作業機2の旋回の有無により、前後方向における掘削制御と幅方向における掘削制御とを切り替えて実行してもよい。例えば、前後方向における掘削制御に作業機2が旋回した場合、作業機コントローラ26は、前後方向における掘削制御を停止して幅方向における掘削制御のみを実行し、作業機2の旋回が停止した場合、幅方向における掘削制御を停止して前後方向における掘削制御を再開してもよい。作業機コントローラ26は、幅方向における目標掘削地形に基づき掘削制御を実行してもよい。次に、旋回目標速度Vctと前後方向の目標速度Vftとを合成した速度に基づいた掘削制御を説明する。
(合成速度に基づく掘削制御)
 図32は、旋回目標速度Vctと前後方向の目標速度Vftとを合成した速度に基づく掘削制御の処理を示すフローチャートである。図33は、前後方向の目標速度Vftを求める方法の説明図である。図34は、旋回目標速度Vctと前後方向の目標速度Vftとを合成した速度Vtを求める方法を示す図である。図35は、バケット8が側壁71aに対応する目標掘削地形74に接近するときの速度成分を説明するための図である。図36は、ブーム制限速度Vt_bm_lmtを説明するための図である。ステップS31において、図5に示す目標速度決定部52は、作業機2の旋回目標速度Vctと前後方向の目標速度Vftを求める。旋回目標速度Vctを求める手法は前述した通りなので省略する。
 作業機2の前後方向の目標速度Vftは、次のようにして求められる。図33に示すように、目標速度決定部52は、ローカル座標系の垂直軸とブーム目標速度Vc_bmの方向とのなす角度β2とから、三角関数によりブーム目標速度Vc_bmをローカル座標系の垂直軸方向の速度成分VL1_bmと水平軸方向の速度成分VL2_bmとに変換する。目標速度決定部52は、ローカル座標系の垂直軸とアーム目標速度Vc_amの方向とのなす角度β3とから、三角関数によりアーム目標速度Vc_amをローカル座標系の垂直軸方向の速度成分VL1_amと水平軸方向の速度成分VL2_amとに変換する。目標速度決定部52は、ローカル座標系の垂直軸とバケット目標速度Vc_bkの方向とのなす角度β4とから、三角関数によりバケット目標速度Vc_bkをローカル座標系の垂直軸方向の速度成分VL1_bkと水平軸方向の速度成分VL2_bkとに変換する。
 目標速度決定部52はアームの水平軸方向における速度成分VL2_am及びバケットの水平軸方向における速度成分VL2_bkからブーム水平軸方向の速度成分VL2_bmを減算する。この値が、前後方向の目標速度Vftである。
 旋回目標速度Vct及び前後方向の目標速度Vftが求められたら、ステップS32において、目標速度決定部52は、これらを合成した速度Vtを求める(図34参照)。以下において、旋回目標速度Vctと前後方向の目標速度Vftとが合成された速度Vtを、制御目標速度Vtと称する。制御目標速度Vtは、√(Vct+Vft)で求めることができる。
 次に、ステップS33において、目標速度決定部52は、図35に示すように、制御目標速度Vtを、目標掘削地形74(幅方向目標掘削地形データUw)に垂直な方向の速度成分(以下、適宜垂直速度成分と称する)Vty_t及び目標掘削地形74(幅方向目標掘削地形データUw)に平行な方向の速度成分(以下、適宜水平速度成分と称する)Vtx_tに変換する。図35に示す例では、図34に示す側壁71aに対応する目標掘削地形74に対して垂直速度成分Vty_t及び水平速度成分Vtx_tが求められる。図35に示す例は、側壁71aが油圧ショベル100のローカル座標系(x、y、z)の水平面HL、すなわちxy平面と平行な平面に対して角度αだけ傾斜している。このため、垂直速度成分Vty_tはVt×cos(π/2-α)、水平速度成分Vtx_tはVt×sin(π/2-α)で求めることができる。
 ステップS34において、図5に示す作業機コントローラ26の距離取得部53は、先に説明した図29に示すように、バケット8の刃先8Tと側壁71aに対応する目標掘削地形74との間の距離dを取得する。詳細には、距離取得部53は、前述したように取得した刃先8Tの位置情報及び目標掘削地形46Iの位置を示す幅方向目標掘削地形データUwから、バケット8の幅方向中央の刃先8Tと目標掘削地形46Iとの間の距離dを算出する。この場合、距離取得部53は、バケット8の刃先8Tと目標掘削地形46Iとの間の最短となる距離を算出し、作業機コントローラ26は、これに基づいて幅方向における掘削制御を実行してもよい。
 ステップS35において、図5に示す作業機コントローラ26の制限速度決定部54は、バケット8の刃先8Tと目標掘削地形46Iとの間の距離dに基づいて、図1に示す作業機2全体の制限速度Vty_lmtを算出する。作業機2全体の制限速度Vty_lmtについては、実施形態1と同様であるので説明を省略する。ステップS36において、制限速度決定部54は、図36に示すように、作業機2全体の制限速度Vty_lmtから旋回目標速度Vctの垂直速度成分Vty_tを減算することにより、ブーム6の制限垂直速度成分Vty_bm_lmtを算出する。
 ステップS37において、制限速度決定部54は、図30に示すように、ブーム6の制限垂直速度成分Vty_bm_lmtを、ブーム6の制限速度(ブーム制限速度)Vt_bm_lmtに変換する。具体的には、制限垂直速度成分Vty_bm_lmtにsin(π/2-α)を乗ずることにより、ブーム制限速度Vt_bm_lmtが得られる。ステップS38において、ブーム介入指令CBIに基づくパイロット圧力がブーム6の操作に基づいて生成されたパイロット圧力よりも大きい場合、作業機コントローラ26の作業機制御部57は、ブーム6の速度がブーム制限速度Vt_bm_lmtとなるようにブーム指令信号CBを生成し、図2に示す介入弁27Cを制御する。
 本例において、作業機コントローラ26は、旋回目標速度Vctと前後方向の目標速度Vftとを合成した制御目標速度Vtを用いることにより、作業機2の前後方向と幅方向との操作を考慮した目標掘削地形74を取得することができる。このため、掘削制御においては作業機2の前後方向と幅方向との切替が不要になるので、滑らかな掘削制御が実現できる。
(変形例)
 本実施形態は、刃先8Tの旋回目標速度Vctを操作装置25から得られる旋回操作量MRに基づいて求めた。本変形例では、刃先8Tの旋回目標速度Vctを図2に示すIMU24の検出結果及び位置検出装置19によって検出されたGNSSアンテナ21、22の基準位置データP1、P2に基づいて、刃先8Tの旋回目標速度Vctを求める。本変形例は、IMU24の検出結果及び位置検出装置19によって検出されたGNSSアンテナ21、22の基準位置データP1、P2を用いて、作業機2の位置を予測する。
 図37は、表示コントローラ28及び変形例に係る作業機コントローラ26a及びセンサコントローラ39aを示すブロック図である。図38A及び図38Bは、油圧ショベル100の姿勢を示す図である。作業機コントローラ26aは、実施形態1で説明した作業機コントローラ26(図5参照)と同様であるが、予測補正部59を備える点が異なる。予測補正部59は、上部旋回体3、すなわち、作業機2が向いている方位を示す旋回体方位データQを表示コントローラ28から取得する。予測補正部59は、上部旋回体3の旋回角速度ωをIMU24から取得する。予測補正部59は、旋回角速度データDωに基づいて、旋回体方位データQを予測補正する。
 例えば、予測補正部59は、旋回角速度ωを遅れ時間tに乗算することによって、予測回転角ω・tを算出する。遅れ時間tとは、バケット刃先位置データS及び目標掘削地形データUの生成に要すると予測される時間である。例えば、本実施形態において、位置検出装置19は、例えば、100msec.程度の周期でGNSSアンテナ21、22の基準位置データP1、P2を検出して表示コントローラ28に出力するので、表示コントローラ28から出力されるバケット刃先位置データS及び目標掘削地形データUを作業機コントローラ26が取得するためには、少なくとも100msec.程度の時間を要する。また、表示コントローラ28に割り込み演算が発生した場合、バケット刃先位置データS及び目標掘削地形データUを作業機コントローラ26が取得するためには、さらに時間を要する。
 予測補正部59は、バケット刃先位置データ生成部28Bから取得する上部旋回体3の旋回体方位データQの方位と、IMU29から取得する角速度ωと、予測される遅れ時間tと、に基づき、予測回転角ω・tだけ回転した時点における予測方位を示す補正旋回体方位データRを生成する。補正旋回体方位データRによって示される予測方位は、目標掘削地形データUの生成時点における上部旋回体3、すなわち、作業機2の方位である。
 予測補正部59は、上部旋回体3の幅方向に対する傾斜角θ4及び上部旋回体3の前後方向に対する傾斜角θ5をIMU24から取得する。予測補正部59は、予測方位データR及び傾斜角θ4及び傾斜角θ5から、補正旋回体方位データRに基づく上部旋回体3の予測方位を算出する。予測補正部59は、予測方位における予測傾斜角θ4’、θ5’を算出する。次に、図38Aに示すように傾斜角θ6の傾斜地において油圧ショベル100が前向きで作業した後に、図38Bに示すように上部旋回体3が旋回して横向きになった場合を想定しながら、予測傾斜角θ4’、θ5’について説明する。
 旋回動作の前後で上部旋回体3の前後方向に対する傾斜角θ5はθ6から徐々に小さくなって0になる。一方で側方方向に対する傾斜角θ4は0から徐々に大きくなってθ6になる。したがって、予測補正部59は、旋回角速度ωに基づいて、遅れ時間tが経過した後の予測傾斜角θ4’、θ5’を算出することができる。予測補正部59は予測傾斜角θ4’、θ5’をバケット刃先位置データ生成部28Bに出力する。傾斜地等で油圧ショベル100が作業を行う場合、旋回に伴って上部旋回体3の傾斜角θ4、θ5が変化する状況においても、上部旋回体3の傾斜の予測補正が可能となる。
 図39は、予測補正部59が補正旋回体方位データRを更新する処理を説明するためのフロー図である。図40は、上部旋回体3の動作に合わせて実行される予測補正部59の処理を説明するための図である。予測補正部59の補正旋回体方位データRの更新について、図38A、図38B及び図40を参照しながら説明する。ステップS201において、予測補正部59は、上部旋回体3が向いている方位を示す旋回体方位データQを、例えば10Hz周期(第2周期の一例)でグローバル座標演算部23から取得する。
 ステップS202において、予測補正部59は、旋回軸zを中心とする旋回角速度ωと、上部旋回体3の前後方向に対する傾斜角θ4と、上部旋回体3の左右方向に対する傾斜角θ5とを、例えば100Hz周期(第1周期の一例)でIMU24から取得する。ステップS203において、予測補正部59は、旋回体方位データQを取得したことに応じて、最新の旋回角速度ωを用いて上部旋回体3がω・tだけ旋回した後における上部旋回体3の方位を示す補正旋回体方位データRと、上部旋回体3の前後方向に対する予測傾斜角θ4’と、上部旋回体3の左右方向に対する予測傾斜角θ5’とに更新する。
 ステップS204において、予測補正部59は、更新した補正旋回体方位データR、予測傾斜角θ4’、θ5’をバケット刃先位置データ生成部28Bに出力する。予測補正部59は、旋回体方位データQを取得するたびにステップS201からS204を繰り返すことによって補正旋回体方位データR、予測傾斜角θ4’、θ5’を更新する。
 このように、予測補正部59は、旋回体方位データQより計測周期の早いIMU24が生成した旋回角速度ω及び傾斜角θ4、θ5を用いることにより、旋回体方位データQよりも高い周期で補正旋回体方位データR及び予測傾斜角θ4’、θ5’を生成することができる。また、補正旋回体方位データR及び予測傾斜角θ4’、θ5’は、熱ドリフトの変動を含む可能性のある旋回角速度ω及び傾斜角θ4、θ5を、グローバル座標演算部23から取得した旋回体方位データQにより更新することもできる。このため、遅れ時間tに対して目標掘削地形データUを生成するための周期に関連する補正旋回体方位データR及び予測傾斜角θ4’、θ5’を出力可能となる。
 予測補正部59は、上部旋回体3の旋回角速度ωを示す旋回角速度ω(動作データの一例)と遅れ時間tとに基づいて旋回体方位データQを予測補正することによって、補正旋回体方位データR(補正旋回体配置データの一例)を生成する。バケット刃先位置データ生成部28Bは、基準位置データP1と旋回体方位データQと補正旋回体方位データRとに基づいて、バケット8の刃先8Tの位置を示すバケット刃先位置データS(作業機位置データの一例)を生成する。目標掘削地形データ生成部28Cは、バケット刃先位置データS及び目標施工情報Tに基づいて、目標掘削地形データUを生成する。遅れ時間tには、バケット刃先位置データS及び目標掘削地形データUの生成に必要な時間及び生成された目標掘削地形データUを作業機コントローラ26が取得するために必要な通信時間が含まれている。バケット刃先位置データS及び目標掘削地形データUの生成に必要な時間は、表示コントローラ28内に割り込み演算が発生したときの演算遅れが考慮されている。これらを考慮して、本実施形態においては、遅れ時間tとして、0.4秒程度が想定されているが、遅れ時間tは、作業機コントローラ26及び表示コントローラ28の仕様等に応じて適宜変更できる。
 このように、予測補正部59は、上部旋回体3の旋回角速度ωに基づいて、目標掘削地形データUの生成時点において上部旋回体3が向いている方位を予測できる。そのため、バケット刃先位置データ生成部28Bは、遅れ時間tが経過した時点におけるバケット8の刃先8Tの位置(作業機2の位置)を予測できる。その結果、目標掘削地形データ生成部28Cは、遅れ時間tが経過した時点におけるバケット8の刃先8Tの位置に対応した目標掘削地形データUを生成することができる。作業機コントローラ26は、遅れ時間tが考慮された目標掘削地形データUを用いて幅方向における掘削制御を実行するので、バケット8がこれから掘削対象とする部分に近い目標掘削地形データUに基づいて作業機2を制御できる。
 予測補正部59は、旋回角速度ωを、例えば100Hz(第1周期の一例)で取得し、旋回体方位データQを例えば10Hz(第2周期の一例)で取得する。したがって、予測補正部59は、定期的に取得される旋回体方位データQを用いて、補正旋回体方位データRを生成できる。このため、旋回角速度ωを生成するIMU24に熱ドリフトが発生したとしても、例えば10Hz毎に更新される旋回体方位データQを基準として補正方位を算出できる。その結果、補正方位を示す補正旋回体方位データRを持続して生成することができる。
 本実施形態において、IMU24は、上部旋回体3の動作を示す動作データとして、上部旋回体3の旋回角速度ωを示す旋回角速度ω、傾斜角θ4、θ5を取得することとしたが、これに限られるものではない。IMU24は、上部旋回体3の傾斜を示す傾斜角度の変化を取得してもよい。上部旋回体3の傾斜角とは、単位時間当たりにおける傾斜角θ4、θ5(図3A及び図3B参照)の変化量である。このような傾斜角度の変化を旋回角速度ωに代えて用いることによっても、油圧ショベル100が回動した場合に、遅れ時間tの経過時点におけるバケット8の刃先8Tの位置を取得できるため、目標掘削地形データ生成部28Cは、遅れ時間tが経過した時点におけるバケット8の刃先8Tの位置に対応した目標掘削地形データUを生成することができる。
 本実施形態において、予測補正部59は、IMU24によって生成される旋回角速度ωを取得することとしたが、これに限られるものではない。予測補正部59は、上部旋回体3に設置するポテンショメータによって検出される回転角度及び操作装置25から出力される旋回操作量MRに基づいて旋回角速度ωを取得することができる。また、予測補正部59は、グローバル座標演算部23からGNSSアンテナ21、22の基準位置データP1、P2を取得し、2つの基準位置データP1、P2に基づいて旋回角速度ωを取得することもできる。
 本実施形態において、バケット刃先位置データ生成部28Bは、基準位置データP1と旋回体方位データQとに基づいて、油圧ショベル100の旋回中心の位置を算出することとしたが、これに限られるものではない。バケット刃先位置データ生成部28Bは、旋回体方位データQに代えて、GNSSアンテナ21が基準位置データP1を受信した時点における上部旋回体3の方位を示す磁気センサ等の方位センサにより取得するデータを用いてもよい。
 本実施形態において、予測補正部59は、例えば10Hz周期(第2周期の一例)で旋回体方位データQをグローバル座標演算部23から取得することとしたが、IMU24の熱ドリフトを考慮する必要がないのであれば、旋回体方位データQを少なくとも1回取得すればよい。この場合、予測補正部59は、取得した旋回体方位データQを基準に旋回角速度ωを随時加算することによって、上部旋回体3の方位を、例えば100Hz周期(第1周期の一例)で更新することができる。
 本実施形態において、表示コントローラ28は、作業機位置データとしてバケット刃先位置データSを生成することとしたが、これに限られるものではない。表示コントローラ28は、バケット刃先位置データSに代えて、バケット8の任意の位置を示す位置データを取得してもよい。また、表示コントローラ28は、バケット刃先位置データSの目標掘削地形データUaに対し、より近い任意の位置を示す位置データを取得してもよい。また、表示コントローラ28で行われる目標施工情報の格納、バケット刃先位置データの生成及び目標掘削地形データの生成のうち少なくとも1つは作業機コントローラ26が実行してもよい。センサコントローラ39が実行する各処理は、作業機コントローラ26が実行してもよい。
 油圧ショベル100は、作業機2の幅方向における目標掘削地形46Iに基づく掘削制御と、油圧ショベル100の前後方向における目標掘削地形43Iに基づく前後方向の掘削制御との両方が実行できるものであってもよい。また、油圧ショベル100は、作業機2の幅方向における目標掘削地形46Iのみに基づく掘削制御を実行できるものであってもよい。
 以上、実施形態1及び実施形態2を説明したが、前述した内容により実施形態1及び実施形態2が限定されるものではない。また、前述した構成要素には、当業者が容易に想定できるもの、実質的に同一のもの、いわゆる均等の範囲のものが含まれる。さらに、前述した構成要素は適宜組み合わせることが可能である。さらに、実施形態1及び実施形態2の要旨を逸脱しない範囲で構成要素の種々の省略、置換及び変更のうち少なくとも1つを行うことができる。例えば、作業機2は、ブーム6、アーム7、バケット8を有しているが、作業機2に装着されるアタッチメントはこれに限られず、バケット8には限定されない。作業機械は油圧ショベル100に限定されず、例えば、ブルドーザ又はモータグレーダ等であってもよい。
1 車両本体
2 作業機
3 上部旋回体
6 ブーム
7 アーム
8 バケット
8T 刃先
10 ブームシリンダ
11 アームシリンダ
12 バケットシリンダ
19 位置検出装置
21、22 アンテナ
23 グローバル座標演算部
25 操作装置
25R 右操作レバー
25L 左操作レバー
26、26a 作業機コントローラ
26M 記憶部
26P 処理部
27 電磁弁
28 表示コントローラ
28A 目標施工情報格納部
28B バケット刃先位置データ生成部
28C 目標掘削地形データ生成部
29S スイッチ
29 表示部
35 エンジン
36、37 油圧ポンプ
38 旋回モータ
41 目標施工面
42、42m、42c、44、45 平面
43、46 交線
43I、46I 目標掘削地形
44 掘削対象位置
52 目標速度決定部
53 距離取得部
54 制限速度決定部
57 作業機制御部
58 制御可否判定部
59 予測補正部
60 基準杭
60T 先端
70 溝
71、72 溝壁
73 溝底
100 油圧ショベル
200 作業機械の制御システム(制御システム)
300 油圧システム

Claims (16)

  1.  作業具を有する作業機を備える作業機械を制御する制御システムであって、
     前記作業機械の位置情報を検出する位置検出部と、
     前記位置検出部によって検出された前記位置情報に基づき前記作業機の位置を求め、かつ目標形状を示す少なくとも1つの目標施工面と、前記作業機が動作する平面である作業機動作平面と交差し、かつ鉛直方向と平行な第1切り出し面とが交差する部分の情報である第1目標掘削地形情報を生成する生成部と、
     前記生成部から取得した前記第1目標掘削地形情報に基づいて、前記作業機が掘削対象に接近する方向の速度が制限速度以下になるように制御する掘削制御を実行する作業機制御部と、
     を含む、作業機械の制御システム。
  2.  前記生成部は、少なくとも一つの前記目標施工面と、前記作業機動作平面又は前記作業機動作平面と平行な第2切り出し面とが交差する部分の情報である第2目標掘削地形情報を生成し、
     前記作業機制御部は、前記設定部から取得した前記第1目標掘削地形情報及び前記第2目標掘削地形情報に基づいて、前記掘削制御を実行する、請求項1に記載の作業機の制御システム。
  3.  作業具を有する作業機を備える作業機械を制御する制御システムであって、
     前記作業機械の位置情報を検出する位置検出部と、
     前記位置検出部によって検出された前記位置情報に基づき前記作業機の位置を求め、かつ前記作業機が動作する平面である作業機動作平面と交差し、かつ鉛直方向と平行な第1切り出し面と、目標形状を示す第1の目標施工面及び前記第1の目標施工面の側方に連なる第2の目標施工面とが交差する部分の情報である第1目標掘削地形情報を生成する生成部と、
     前記生成部から取得した前記第1目標掘削地形情報に基づいて、前記作業機が掘削対象に接近する方向の速度が制限速度以下になるように制御する掘削制御を実行する作業機制御部と、
     を含む、作業機械の制御システム。
  4.  前記生成部は、前記第1の目標施工面と、前記作業機動作平面又は前記作業機動作平面と平行な第2切り出し面とが交差する部分の情報である第2目標掘削地形情報を生成し、
     前記作業機制御部は、前記設定部から取得した前記第1目標掘削地形情報及び前記第2目標掘削地形情報に基づいて、前記掘削制御を実行する、請求項3に記載の作業機の制御システム。
  5.  前記作業機制御部は、
     前記第2目標掘削地形情報に基づいて前記掘削制御を実行し、前記第1目標掘削地形情報に基づいて実行中の前記掘削制御を停止し又は停止中の前記掘削制御を再開する、請求項2又は請求項4に記載の作業機械の制御システム。
  6.  前記作業機制御部は、
     前記作業具の直下における前記第1目標掘削地形情報の、前記作業機械の水平面に対する角度が予め定められた大きさ以上である場合に、前記掘削制御を停止する、請求項5に記載の作業機械の制御システム。
  7.  前記作業機制御部は、
     前記作業具の刃先と前記第1目標掘削地形情報との間における最も小さい距離に基づいて前記掘削制御を実行する、請求項1から請求項請求項6のいずれか1項に記載の作業機械の制御システム。
  8.  前記作業機制御部は、
     前記作業具の刃先と、前記第1目標掘削地形情報との距離に基づいて、前記第1目標掘削地形情報に対応した目標施工面に対して前記掘削制御を実行するか否かを決定する、請求項1又は請求項3に記載の作業機械の制御システム。
  9.  前記作業機械は、前記作業機が取り付けられて所定の軸線周りを回動する旋回体を備えており、
     前記作業機制御部は、
     前記作業機が前記旋回体とともに旋回しているときに前記掘削制御を実行する、請求項8に記載の作業機械の制御システム。
  10.  前記作業機制御部は、
     前記作業機が旋回する方向における目標速度と、前記作業具の前後方向における目標速度とを合成した速度に基づいて前記掘削制御を実行する、請求項9に記載の作業機械の制御システム。
  11.  前記作業機械に備えられて、角速度及び加速度を検出する検出装置を有し、前記検出装置が検出した前記作業機の旋回速度を用いて前記作業機の位置を予測する、請求項8から請求項10のいずれか1項に記載の作業機械の制御システム。
  12.  請求項1から請求項11のいずれか1項に記載の作業機械の制御システムを備える、作業機械。
  13.  作業具を有する作業機を備える作業機械を制御する制御方法であって、
     前記作業機の位置を検出し、
     検出された前記位置情報に基づき前記作業機の位置を求め、かつ目標形状を示す少なくとも1つの目標施工面と、前記作業機が動作する平面である作業機動作平面と交差し、かつ鉛直方向と平行な第1切り出し面とが交差する部分の情報である第1目標掘削地形情報を生成し、
     前記第1目標掘削地形情報に基づいて、前記作業機が掘削対象に接近する方向の速度が制限速度以下になるように制御する、
     作業機械の制御方法。
  14.  前記第1目標掘削地形情報、及び少なくとも一つの前記目標施工面と前記作業機動作平面又は前記作業機動作平面と平行な第2切り出し面とが交差する部分の情報である前記第2目標掘削地形情報に基づいて、前記作業機が掘削対象に接近する方向の速度が制限速度以下になるように制御する、請求項13に記載の作業機の制御システム。
  15.  前記作業機が掘削対象に接近する方向の速度が制限速度以下になるように制御するにあたって、前記作業具の刃先と、前記第1目標掘削地形情報との距離に基づいて、前記第1目標掘削地形情報に対応した目標施工面に対して前記掘削制御を実行するか否かを決定する、請求項14に記載の作業機械の制御方法。
  16.  前記作業機が前記作業機械に備えられた前記旋回体とともに旋回しているときに前記掘削制御を実行する、請求項15に記載の作業機械の制御方法。
PCT/JP2014/064543 2014-05-30 2014-05-30 作業機械の制御システム、作業機械及び作業機械の制御方法 WO2015181989A1 (ja)

Priority Applications (6)

Application Number Priority Date Filing Date Title
CN201480000998.3A CN105408554B (zh) 2014-05-30 2014-05-30 作业机械的控制系统、作业机械以及作业机械的控制方法
US14/386,094 US9540793B2 (en) 2014-05-30 2014-05-30 Work machine control system, work machine, and work machine control method
KR1020157031858A KR101751164B1 (ko) 2014-05-30 2014-05-30 작업 기계의 제어 시스템, 작업 기계 및 작업 기계의 제어 방법
PCT/JP2014/064543 WO2015181989A1 (ja) 2014-05-30 2014-05-30 作業機械の制御システム、作業機械及び作業機械の制御方法
DE112014000074.4T DE112014000074B4 (de) 2014-05-30 2014-05-30 Arbeitsmaschinen-Steuersystem, Arbeitsmaschine und Arbeitsmaschinensteuerverfahren
JP2014528347A JP5823044B1 (ja) 2014-05-30 2014-05-30 作業機械の制御システム、作業機械及び作業機械の制御方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2014/064543 WO2015181989A1 (ja) 2014-05-30 2014-05-30 作業機械の制御システム、作業機械及び作業機械の制御方法

Publications (1)

Publication Number Publication Date
WO2015181989A1 true WO2015181989A1 (ja) 2015-12-03

Family

ID=54696274

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2014/064543 WO2015181989A1 (ja) 2014-05-30 2014-05-30 作業機械の制御システム、作業機械及び作業機械の制御方法

Country Status (6)

Country Link
US (1) US9540793B2 (ja)
JP (1) JP5823044B1 (ja)
KR (1) KR101751164B1 (ja)
CN (1) CN105408554B (ja)
DE (1) DE112014000074B4 (ja)
WO (1) WO2015181989A1 (ja)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017180079A (ja) * 2017-02-16 2017-10-05 株式会社小松製作所 作業機械の制御装置、作業機械及び作業機械の制御方法
JP2017179961A (ja) * 2016-03-31 2017-10-05 日立建機株式会社 建設機械
JP2018003514A (ja) * 2016-07-06 2018-01-11 日立建機株式会社 作業機械
EP3480371A4 (en) * 2016-06-30 2020-03-18 Hitachi Construction Machinery Co., Ltd. WORKING MACHINE
WO2020255622A1 (ja) * 2019-06-19 2020-12-24 株式会社小松製作所 作業機械および作業機械の制御方法
WO2021033365A1 (ja) * 2019-08-21 2021-02-25 コベルコ建機株式会社 作業機械

Families Citing this family (33)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20160098637A1 (en) * 2014-10-03 2016-04-07 Caterpillar Inc. Automated Data Analytics for Work Machines
JP6419585B2 (ja) * 2015-01-13 2018-11-07 株式会社小松製作所 掘削機械、掘削機械の制御方法及び掘削システム
JP6721291B2 (ja) * 2015-03-19 2020-07-15 住友建機株式会社 ショベル
US9926077B2 (en) 2015-07-17 2018-03-27 Teal Drones, Inc. Modular arms on a rotor-based remote vehicle
CN108138459B (zh) * 2015-09-16 2021-05-11 住友重机械工业株式会社 挖土机
JP6532797B2 (ja) * 2015-10-08 2019-06-19 日立建機株式会社 建設機械
EP3680400B1 (en) 2015-12-28 2021-09-22 Sumitomo (S.H.I.) Construction Machinery Co., Ltd. Shovel
JP6732539B2 (ja) * 2016-05-26 2020-07-29 日立建機株式会社 作業機械
JP6666208B2 (ja) * 2016-07-06 2020-03-13 日立建機株式会社 作業機械
ES2935968T3 (es) * 2016-07-15 2023-03-13 Cqms Pty Ltd Sistema de monitorización de un miembro de desgaste y procedimiento para monitorizar un miembro de desgaste
US9976285B2 (en) * 2016-07-27 2018-05-22 Caterpillar Trimble Control Technologies Llc Excavating implement heading control
JP2018021651A (ja) * 2016-08-05 2018-02-08 トヨタ自動車株式会社 ガス充填システム
WO2018026021A1 (ja) * 2016-08-05 2018-02-08 株式会社小松製作所 管理システム
EP3521517B1 (en) * 2016-09-30 2021-04-07 Sumitomo (S.H.I.) Construction Machinery Co., Ltd. Excavator
US10273124B2 (en) * 2016-12-15 2019-04-30 Caterpillar Inc. Rotation control system for material handling machines
US10731322B2 (en) 2017-01-13 2020-08-04 Komatsu Ltd. Work machine control system and work machine control method
WO2018171856A1 (en) * 2017-03-20 2018-09-27 Volvo Construction Equipment Ab A method for determining object position information
US11987949B2 (en) 2017-08-30 2024-05-21 Topcon Positioning Systems, Inc. Method and apparatus for machine operator command attenuation
US11299870B2 (en) * 2017-08-31 2022-04-12 Komatsu Ltd. Display system for excavation machine, excavation machine, and display method for excavation machine
CN110945187B (zh) * 2017-09-08 2022-08-16 住友重机械工业株式会社 挖土机
JP6878226B2 (ja) * 2017-09-19 2021-05-26 日立建機株式会社 作業機械
JP6843039B2 (ja) * 2017-12-22 2021-03-17 日立建機株式会社 作業機械
CN110520575B (zh) * 2018-03-22 2021-11-02 日立建机株式会社 作业机械
JP7274831B2 (ja) * 2018-07-31 2023-05-17 株式会社小松製作所 作業機械
CN109407563A (zh) * 2018-12-26 2019-03-01 北京百度网讯科技有限公司 无人工程机械的控制系统及其控制方法
JP7197392B2 (ja) * 2019-02-01 2022-12-27 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
JP7283910B2 (ja) * 2019-02-01 2023-05-30 株式会社小松製作所 建設機械の制御システム、建設機械、及び建設機械の制御方法
JP7276046B2 (ja) * 2019-09-26 2023-05-18 コベルコ建機株式会社 作業機械の動作教示システム
US11828040B2 (en) * 2019-09-27 2023-11-28 Topcon Positioning Systems, Inc. Method and apparatus for mitigating machine operator command delay
US11408449B2 (en) 2019-09-27 2022-08-09 Topcon Positioning Systems, Inc. Dithering hydraulic valves to mitigate static friction
CN111578988A (zh) * 2020-04-27 2020-08-25 辽宁科技大学 一种基于调度系统的电铲工作状态监控系统
CN112081165A (zh) * 2020-10-14 2020-12-15 江苏徐工工程机械研究院有限公司 平地机及其刮坡控制方法、装置
EP4267807A1 (en) * 2020-12-28 2023-11-01 Volvo Autonomous Solutions AB Method and device for controlling excavator

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2012127913A1 (ja) * 2011-03-24 2012-09-27 株式会社小松製作所 掘削制御システムおよび建設機械
WO2012127914A1 (ja) * 2011-03-24 2012-09-27 株式会社小松製作所 掘削制御システム
JP2013217138A (ja) * 2012-04-11 2013-10-24 Komatsu Ltd 油圧ショベルの掘削制御システム

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5835874A (en) * 1994-04-28 1998-11-10 Hitachi Construction Machinery Co., Ltd. Region limiting excavation control system for construction machine
JP3609164B2 (ja) 1995-08-14 2005-01-12 日立建機株式会社 建設機械の領域制限掘削制御の掘削領域設定装置
US7979181B2 (en) * 2006-10-19 2011-07-12 Caterpillar Inc. Velocity based control process for a machine digging cycle
JP6025372B2 (ja) 2012-04-11 2016-11-16 株式会社小松製作所 油圧ショベルの掘削制御システム及び掘削制御方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2012127913A1 (ja) * 2011-03-24 2012-09-27 株式会社小松製作所 掘削制御システムおよび建設機械
WO2012127914A1 (ja) * 2011-03-24 2012-09-27 株式会社小松製作所 掘削制御システム
JP2013217138A (ja) * 2012-04-11 2013-10-24 Komatsu Ltd 油圧ショベルの掘削制御システム

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017179961A (ja) * 2016-03-31 2017-10-05 日立建機株式会社 建設機械
EP3480371A4 (en) * 2016-06-30 2020-03-18 Hitachi Construction Machinery Co., Ltd. WORKING MACHINE
US10801187B2 (en) 2016-06-30 2020-10-13 Hitachi Construction Machinery Co., Ltd. Work machine
JP2018003514A (ja) * 2016-07-06 2018-01-11 日立建機株式会社 作業機械
WO2018008188A1 (ja) * 2016-07-06 2018-01-11 日立建機株式会社 作業機械
US10774502B2 (en) 2016-07-06 2020-09-15 Hitachi Construction Machinery Co., Ltd. Work machine
JP2017180079A (ja) * 2017-02-16 2017-10-05 株式会社小松製作所 作業機械の制御装置、作業機械及び作業機械の制御方法
JP2021001435A (ja) * 2019-06-19 2021-01-07 株式会社小松製作所 作業機械および作業機械の制御方法
WO2020255622A1 (ja) * 2019-06-19 2020-12-24 株式会社小松製作所 作業機械および作業機械の制御方法
KR20210134756A (ko) * 2019-06-19 2021-11-10 가부시키가이샤 고마쓰 세이사쿠쇼 작업 기계 및 작업 기계의 제어 방법
CN113692469A (zh) * 2019-06-19 2021-11-23 株式会社小松制作所 作业机械以及作业机械的控制方法
JP7229109B2 (ja) 2019-06-19 2023-02-27 株式会社小松製作所 作業機械および作業機械の制御方法
KR102615966B1 (ko) 2019-06-19 2023-12-19 가부시키가이샤 고마쓰 세이사쿠쇼 작업 기계 및 작업 기계의 제어 방법
WO2021033365A1 (ja) * 2019-08-21 2021-02-25 コベルコ建機株式会社 作業機械
JP2021031899A (ja) * 2019-08-21 2021-03-01 コベルコ建機株式会社 作業機械
CN114258447A (zh) * 2019-08-21 2022-03-29 神钢建机株式会社 作业机械
JP7318414B2 (ja) 2019-08-21 2023-08-01 コベルコ建機株式会社 作業機械

Also Published As

Publication number Publication date
KR20160004297A (ko) 2016-01-12
CN105408554B (zh) 2017-05-03
US20160244950A1 (en) 2016-08-25
JPWO2015181989A1 (ja) 2017-04-20
KR101751164B1 (ko) 2017-06-26
DE112014000074T5 (de) 2016-02-18
JP5823044B1 (ja) 2015-11-25
CN105408554A (zh) 2016-03-16
DE112014000074B4 (de) 2020-07-30
US9540793B2 (en) 2017-01-10

Similar Documents

Publication Publication Date Title
JP5823044B1 (ja) 作業機械の制御システム、作業機械及び作業機械の制御方法
JP5840298B1 (ja) 作業機械の制御システム、作業機械、油圧ショベルの制御システム及び作業機械の制御方法
JP5807120B1 (ja) 作業機械の姿勢演算装置、作業機械及び作業機械の姿勢演算方法
JP5893144B1 (ja) 作業機械の姿勢演算装置、作業機械及び作業機械の姿勢演算方法
JP5990642B2 (ja) 建設機械の制御システム、建設機械、及び建設機械の制御方法
JP6096988B2 (ja) 作業機械の制御装置、作業機械及び作業機械の制御方法
KR101859263B1 (ko) 작업 기계의 제어 시스템 및 작업 기계의 제어 방법
JP5921692B1 (ja) 掘削機械の制御システム及び掘削機械
KR101839467B1 (ko) 건설 기계의 제어 시스템, 건설 기계, 및 건설 기계의 제어 방법
JP6894847B2 (ja) 作業機械および作業機械の制御方法
JP2017180079A (ja) 作業機械の制御装置、作業機械及び作業機械の制御方法
JP6876623B2 (ja) 作業機械および作業機械の制御方法
JP6901406B2 (ja) 作業機械および作業機械の制御方法

Legal Events

Date Code Title Description
WWE Wipo information: entry into national phase

Ref document number: 201480000998.3

Country of ref document: CN

ENP Entry into the national phase

Ref document number: 2014528347

Country of ref document: JP

Kind code of ref document: A

WWE Wipo information: entry into national phase

Ref document number: 14386094

Country of ref document: US

WWE Wipo information: entry into national phase

Ref document number: 1120140000744

Country of ref document: DE

Ref document number: 112014000074

Country of ref document: DE

ENP Entry into the national phase

Ref document number: 20157031858

Country of ref document: KR

Kind code of ref document: A

121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 14893331

Country of ref document: EP

Kind code of ref document: A1

122 Ep: pct application non-entry in european phase

Ref document number: 14893331

Country of ref document: EP

Kind code of ref document: A1