WO2019012699A1 - Work machine and control method for work machine - Google Patents
Work machine and control method for work machine Download PDFInfo
- Publication number
- WO2019012699A1 WO2019012699A1 PCT/JP2017/025778 JP2017025778W WO2019012699A1 WO 2019012699 A1 WO2019012699 A1 WO 2019012699A1 JP 2017025778 W JP2017025778 W JP 2017025778W WO 2019012699 A1 WO2019012699 A1 WO 2019012699A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- boom
- speed
- target
- work machine
- control
- Prior art date
Links
Images
Classifications
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
- E02F3/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
- E02F9/2203—Arrangements for controlling the attitude of actuators, e.g. speed, floating function
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2004—Control mechanisms, e.g. control levers
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/2025—Particular purposes of control systems not otherwise provided for
- E02F9/2037—Coordinating the movements of the implement and of the frame
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
- E02F9/2221—Control of flow rate; Load sensing arrangements
- E02F9/2232—Control of flow rate; Load sensing arrangements using one or more variable displacement pumps
- E02F9/2235—Control of flow rate; Load sensing arrangements using one or more variable displacement pumps including an electronic controller
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
- E02F9/2278—Hydraulic circuits
- E02F9/2292—Systems with two or more pumps
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
- E02F9/22—Hydraulic or pneumatic drives
- E02F9/2278—Hydraulic circuits
- E02F9/2296—Systems with a variable displacement pump
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
- E02F9/261—Surveying the work-site to be treated
- E02F9/262—Surveying the work-site to be treated with follow-up actions to control the work tool, e.g. controller
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/26—Indicating devices
- E02F9/264—Sensors and their calibration for indicating the position of the work tool
- E02F9/265—Sensors 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)
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
- E02F3/30—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom
- E02F3/32—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom working downwardly and towards the machine, e.g. with backhoes
Definitions
- the present invention relates to a working machine provided with a working machine and a control method of the working machine.
- control for moving a bucket along a boundary surface indicating a target shape to be constructed has been proposed (see, for example, Patent Document 1). Such control is called intervention control.
- intervention control for example, when there is no target shape to be constructed, or when the work machine does not erode the target shape by the operation of the operator, it is not necessary to execute the intervention control. It is not necessary to carry out the control for raising the working machine so that the working machine does not erode the target shape.
- the present disclosure has been made to solve the above-described problems, and it is an object of the present disclosure to provide a work machine and a control method of the work machine capable of suppressing the discomfort of the operator's operation of the operation device. .
- a work machine includes a work machine, an operating device that operates the work machine, and a controller that controls the work machine.
- the controller executes intervention control to raise the working machine based on the operation command from the operation device, determines switching from the intervention control to control of the work machine according to the operation command of the operation device, and operates in switching based on the determination result It is determined whether the operation command of the device is the lifting of the work machine or the neutral command, and if the operation command of the operating device is the lifting of the work machine or the neutral command based on the determination result, intervention control is performed.
- the controller switches the intervention control unit that executes intervention control to raise the working machine based on the operation command from the operation device, and switching to determine switching from the intervention control to control of the work machine according to the operation command of the operation device
- a determination unit an operation command determination unit that determines whether or not an operation command of the operation device is the lifting of the work machine or a neutral command in switching based on the determination result of the switching determination unit, and a determination result of the operation command determination unit
- the speed difference between the target speed of the work machine as a target for the intervention control and the target speed according to the operation command of the operation device If the speed difference is equal to or greater than the predetermined value based on the judgment result of the judgment unit and the speed difference judgment unit, the rising target speed of the working machine gradually changes to the target speed according to the operation command of the operating device.
- a and a speed adjustment unit configured to adjust.
- the controller switches the elevation target speed of the work implement to the target speed according to the operation command of the operating device.
- a control method of a working machine is a control method of a working machine including a working machine and an operating device for operating the working machine, wherein the intervention control raises the working machine based on an operation command from the operating device.
- the step of executing the step, the step of determining the switching from the intervention control to the control of the working machine according to the operating command of the operating device, and the switching of the operating device in the switching based on the determination result is the lifting of the working machine or the neutral command
- the operation command of the operating device based on the determination result is the lifting of the work machine or the neutral command
- the target target speed of increase of the working machine by the intervention control and the operation command of the operating device In the step of determining the speed difference from the target speed according to the above, if the speed difference is greater than or equal to the predetermined value, the rising target speed of the working machine is gradually changed to the target speed according to the operation command And a step of adjusting to.
- the work machine and the control method of the work machine can suppress the sense of discomfort of the operation of the operating device by the operator.
- FIG. 1 is a block diagram showing a configuration of a control system 200 and a hydraulic system 300 of a hydraulic shovel 100 based on an embodiment. It is a figure showing an example of hydraulic circuit 301 of boom cylinder 10 based on an embodiment. It is a block diagram of work machine controller 26 based on an embodiment. It is a figure showing target excavation topography data U and bucket 8 based on an embodiment. It is a figure for explaining boom limit speed Vcy_bm based on an embodiment. It is a figure for demonstrating speed limit Vc_lmt based on an embodiment. It is a figure which shows the relationship between the bucket 8 based on embodiment, and the target excavation landform 43I. It is a figure which shows the relationship between the boom target speed Vbm which is the speed in which the boom 6 based on embodiment operates, and the time t. It is a figure explaining the flow which shows the control method of the working machine based on an embodiment.
- FIG. 1 is a perspective view of a working machine based on the embodiment.
- FIG. 2 is a block diagram showing configurations of a control system 200 and a hydraulic system 300 of the hydraulic shovel 100 based on the embodiment.
- a hydraulic shovel 100 which is a working machine has a vehicle body 1 and a working machine 2.
- the vehicle body 1 has an upper revolving unit 3 which is a revolving unit and a traveling device 5 as a traveling unit.
- the upper revolving superstructure 3 accommodates devices such as an internal combustion engine and a hydraulic pump as a power generation device inside the engine chamber 3EG.
- the engine room 3EG is disposed on one end side of the upper swing body 3.
- the hydraulic shovel 100 uses, for example, a diesel engine or the like for an internal combustion engine as a power generation device, the power generation device is not limited to this.
- the power generation device of the hydraulic shovel 100 may be, for example, a hybrid device in which an internal combustion engine, a generator motor and a storage device are combined.
- the power generation device of the hydraulic shovel 100 may not have an internal combustion engine, and may combine a power storage device and a generator motor.
- the upper swing body 3 has a driver's cab 4.
- the operator's cab 4 is installed on the other end side of the upper swing body 3.
- the operator's cab 4 is installed on the opposite side to the side where the engine room 3EG is disposed.
- a display unit 29 and an operating device 25 shown in FIG. 2 are arranged.
- the traveling device 5 supports the upper swing body 3.
- the traveling device 5 has crawler belts 5a and 5b.
- the traveling device 5 causes the hydraulic shovel 100 to travel by causing one or both of the traveling motors 5c provided on the left and right to drive and rotate the crawler belts 5a and 5b.
- the work implement 2 is attached to the side of the cab 4 of the upper swing body 3.
- the hydraulic shovel 100 may include a tire instead of the crawler belts 5a and 5b, and may include a traveling device capable of traveling by transmitting the driving force of the engine to the tire via a transmission.
- a hydraulic shovel 100 of such a form there exists a wheel type hydraulic shovel, for example.
- the hydraulic shovel 100 may be, for example, a backhoe loader.
- the side where the working machine 2 and the cab 4 are disposed is the front, and the side where the engine room 3EG is disposed is the rear.
- 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 and right direction of the upper swing body 3 is also referred to as a width direction.
- the traveling device 5 side of the hydraulic shovel 100 or the vehicle body 1 is below with reference to the upper swing body 3, and the upper swing body 3 is above with respect to the traveling device 5.
- the longitudinal direction of the hydraulic shovel 100 is the x direction, the width direction is the y direction, and the vertical direction is the z direction.
- the lower side is the action direction side of gravity which is the vertical direction
- the upper side is the opposite side to the vertical direction.
- the work machine 2 has a boom 6, an arm 7, a bucket 8 which is a work tool, a boom cylinder 10, an arm cylinder 11 and a bucket cylinder 12.
- the base end of the boom 6 is attached to the front of the vehicle body 1 via a boom pin 13.
- the proximal end of the arm 7 is attached to the distal end of the boom 6 via an arm pin 14.
- the bucket 8 is attached to the tip of the arm 7 via a bucket pin 15.
- the bucket 8 moves around the bucket pin 15.
- the bucket 8 has a plurality of blades 8 B attached to the side opposite to the bucket pin 15.
- the blade tip 8T is the tip of the blade 8B.
- that the work implement 2 is raised means an operation in which the work implement 2 moves in a direction from the ground contact surface of the hydraulic shovel 100 toward the upper swing body 3.
- the descent of the work implement 2 means an operation of the work implement 2 moving in a direction from the upper swing body 3 of the hydraulic shovel 100 toward the ground contact surface.
- the ground contact surface of the hydraulic shovel 100 is a plane defined by at least three points in the contact portion of the crawler belts 5a and 5b.
- raising of the working machine 2 means an operation of moving the working machine 2 in a direction away from the ground contact surface of the working machine.
- the descent of the work implement 2 means an operation of moving the work implement 2 in a direction approaching the ground contact surface of the work machine.
- the ground plane is the plane defined by the part where at least three wheels touch.
- the bucket 8 may not have a plurality of blades 8B. It may be a bucket which does not have a blade 8B as shown in FIG. 1 and whose cutting edge is formed in a straight shape by a steel plate.
- the work implement 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 hydraulic shovel is on a slope, the slope and flat ground can be shaped and ground freely, and the bottom plate turns It is a bucket that can be pressed.
- the working machine 2 may be provided with a drilling bucket attachment or the like provided with a slope bucket or a rock drilling tip as a working tool.
- the boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12 shown in FIG. 1 are hydraulic cylinders driven by the pressure of the hydraulic fluid (hereinafter referred to as "hydraulic" as appropriate).
- the boom cylinder 10 drives the boom 6 to raise and lower it.
- the arm cylinder 11 drives the arm 7 to move around the arm pin 14.
- the bucket cylinder 12 drives the bucket 8 to operate around the bucket pin 15.
- a direction control valve 64 shown in FIG. 2 is provided between the hydraulic cylinders such as the boom cylinder 10, the arm cylinder 11 and the bucket cylinder 12 and the hydraulic pumps 36 and 37 shown in FIG.
- 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 flow direction of the hydraulic oil.
- the direction control valve 64 is a traveling direction control valve for driving the traveling motor 5c, and a working machine for controlling the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12, and the swing motor for swinging the upper swing body 3. And a directional control valve.
- the work implement controller 26 shown in FIG. 2 controls the control valve 27 shown in FIG. 2 to control the pilot pressure of the hydraulic fluid supplied from the operating device 25 to the direction control valve 64.
- the control valve 27 is provided in the hydraulic system of the boom cylinder 10, the arm cylinder 11 and the bucket cylinder 12.
- the work machine controller 26 can control the operation of the boom cylinder 10, the arm cylinder 11 and the bucket cylinder 12 by controlling the control valve 27 provided in the pilot oil passage 450.
- the work implement controller 26 can control the speed of the boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12 to be reduced by closing the control valve 27.
- the antennas 21 and 22 are attached to the upper portion of the upper swing body 3.
- the antennas 21 and 22 are used to detect the current position of the hydraulic shovel 100.
- the antennas 21 and 22 are electrically connected to a position detection device 19 shown in FIG. 2 which is a position detection unit for detecting the current position of the hydraulic shovel 100.
- the position detection device 19 detects the current position of the hydraulic shovel 100 using RTK-GNSS (Real Time Kinematic-Global Navigation Satellite Systems, GNSS means Global Navigation Satellite System).
- RTK-GNSS Real Time Kinematic-Global Navigation Satellite Systems
- GNSS Global Navigation Satellite System
- the antennas 21 and 22 will be 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 hydraulic system 300 of the hydraulic shovel 100 includes an internal combustion engine 35 and hydraulic pumps 36 and 37 as power generation sources.
- the hydraulic pumps 36 and 37 are driven by the internal combustion engine 35 and discharge hydraulic fluid.
- the hydraulic fluid 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 hydraulic shovel 100 is provided with a swing motor 38.
- the swing motor 38 is a hydraulic motor, and is driven by hydraulic fluid discharged from the hydraulic pumps 36 and 37.
- the swing motor 38 swings the upper swing body 3. Although two hydraulic pumps 36 and 37 are illustrated in FIG. 2, only one hydraulic pump may be provided.
- the swing motor 38 is not limited to a hydraulic motor, and may be an electric motor.
- a control system 200 which is a control system of a work machine is a work which is a control device of a work machine according to an embodiment, a position detection device 19, a global coordinate operation unit 23, an operation device 25.
- a machine controller 26, a sensor controller 39, a display controller 28, and a display unit 29 are included.
- the operating device 25 is a device for operating the work implement 2 and the upper swing body 3 shown in FIG.
- the operating device 25 is a device for operating the work machine 2.
- Operation device 25 receives an operation by an operator for driving work machine 2 and outputs a pilot hydraulic pressure according to the amount of operation.
- the pilot hydraulic pressure corresponding to the operation amount is an operation command.
- the operation command is a command for operating the work machine 2.
- the operation command is generated by the operating device 25. Since the operation device 25 is operated by the operator, the operation command is a command for operating the work machine 2 by the operation of the operator which is a manual operation.
- Control of the working machine 2 by manual operation is control of the working machine 2 in accordance with an operation command from the operating device 25. It is control of the working machine 2 by operating the operating device 25 of the working machine 2.
- the operating device 25 has a left operating lever 25L installed on the left side of the operator and a right operating lever 25R located on the right side of the operator.
- the left control lever 25L and the right control lever 25R correspond to the operation of the arm 7 and the two axes of turning in the front, rear, left and right operation.
- the operation in the front-rear direction of the right control lever 25R corresponds to the operation of the boom 6.
- the boom 6 is lowered, and when operated rightward, the boom 6 is raised.
- the operation of raising and lowering the boom 6 is executed according to the operation of the right control lever 25R in the front-rear direction.
- the operation of the right control lever 25R in the left-right direction corresponds to the operation of the bucket 8.
- the bucket 8 When the right control lever 25R is operated to the left, the bucket 8 is excavated, and when operated to the right, the bucket 8 is dumped.
- the digging or dumping operation of the bucket 8 is performed according to the operation of the right control lever 25R in the left-right direction.
- the operation of the left control lever 25L in the front-rear direction corresponds to the operation of the arm 7.
- the arm 7 dumps, and when operated rearward, the arm 7 excavates.
- the operation in the left-right direction of the left operation lever 25L corresponds to the operation of turning the upper swing body 3.
- the left control lever 25L When the left control lever 25L is operated to the left, it turns left, and when it is operated right, it turns right.
- a pilot hydraulic system is used for the operating device 25.
- a hydraulic oil whose pressure is reduced to a predetermined pilot pressure by the pressure reducing valve 25V is supplied from the hydraulic pump 36 to the controller 25 based on the boom operation, the bucket operation, the arm operation, and the turning operation.
- the pilot hydraulic pressure can be supplied to the pilot oil passage 450 according to the operation of the right control lever 25R in the front-rear direction, and the operator's operation of the boom 6 is accepted.
- the valve device provided in the right control lever 25R is opened in accordance with the amount of operation of the right control lever 25R, and the 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 as a pilot pressure.
- the pressure sensor 66 transmits the detected pilot pressure to the work machine controller 26 as the boom operation amount MB.
- the operation amount of the right control lever 25R in the front-rear direction is appropriately referred to as a boom operation amount MB.
- the pilot oil passage 50 is provided with a control valve (hereinafter appropriately referred to as an intervention valve) 27C and a shuttle valve 51.
- the intervention valve 27C and the shuttle valve 51 will be described later.
- the pilot oil pressure can be supplied to the pilot oil passage 450, and the operation of the bucket 8 by the operator is accepted.
- the valve device provided in the right control lever 25R is opened in accordance with the amount of operation of the right control lever 25R, and the 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 as a pilot pressure.
- the pressure sensor 66 transmits the detected pilot pressure to the work unit controller 26 as a bucket operation amount MT.
- the operation amount of the right control lever 25R in the left-right direction is 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 of the left control lever 25L in the front-rear direction, and the operation of the arm 7 by the operator is accepted.
- the valve device provided in the left control lever 25L is opened according to the amount of operation of the left control lever 25L, and the 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 as a pilot pressure.
- the pressure sensor 66 transmits the detected pilot pressure to the work unit controller 26 as an arm operation amount MA.
- the operation amount of the left control lever 25L in the front-rear direction is appropriately referred to as an arm operation amount MA.
- the operating device 25 supplies a pilot hydraulic pressure having a magnitude corresponding to the amount of operation of the right operating lever 25R to the direction control valve 64 by operating the right operating lever 25R.
- the operating device 25 supplies a pilot hydraulic pressure having a magnitude corresponding to the amount of operation of the left operating lever 25L to the direction control valve 64 by operating the left operating lever 25L.
- the pilot control hydraulic pressure supplied from the controller 25 to the directional control valve 64 operates the directional control valve 64.
- 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 to the boom cylinder 10
- the second stroke sensor 17 is provided to the arm cylinder 11
- the third stroke sensor 18 is provided to the bucket cylinder 12.
- the sensor controller 39 has a storage unit such as a random access memory (RAM) and a read only memory (ROM), and a processing unit such as a central processing unit (CPU).
- a storage unit such as a random access memory (RAM) and a read only memory (ROM)
- ROM read only memory
- CPU central processing unit
- the sensor controller 39 is a direction (z-axis) orthogonal to a horizontal coordinate system (xy plane) in the local coordinate system of the hydraulic shovel 100, more specifically, in the local coordinate system of the vehicle body 1, from the boom cylinder length LS1 detected by the first stroke sensor 16.
- the tilt angle ⁇ 1 of the boom 6 with respect to the direction is calculated and output to the work machine controller 26 and the display controller 28.
- the sensor controller 39 calculates an inclination angle ⁇ 2 of the arm 7 with respect to the boom 6 from the arm cylinder length LS2 detected by the second stroke sensor 17 and outputs the inclination angle ⁇ 2 to the work machine controller 26 and the display controller 28.
- the sensor controller 39 calculates the inclination angle ⁇ 3 of the cutting edge 8T of the blade 8 of the bucket 8 with respect to the arm 7 from the bucket cylinder length LS3 detected by the third stroke sensor 18, and outputs it to the work machine controller 26 and the display controller 28. Do.
- the detection of the inclination angles ⁇ 1, ⁇ 2, ⁇ 3 can be performed by means other than the first stroke sensor 16, the second stroke sensor 17, and the third stroke sensor 18.
- an angle sensor such as a potentiometer can also detect the inclination angles ⁇ 1, ⁇ 2, and ⁇ 3.
- the sensor controller 39 is connected to an IMU (Inertial Measurement Unit: inertial measurement device) 24.
- the IMU 24 acquires inclination information of the vehicle body such as a pitch around the y axis, a roll around the x axis, etc., of the hydraulic shovel 100 shown in FIG.
- the work machine controller 26 includes a storage unit 26Q such as a RAM and a ROM (Read Only Memory), and a processing unit 26P such as a CPU.
- a storage unit 26Q such as a RAM and a ROM (Read Only Memory)
- a processing unit 26P such as a CPU.
- the work machine controller 26 controls the intervention valve 27C and the control valve 27 based on the boom operation amount MB, the bucket operation amount MT, and the arm operation amount MA shown in FIG.
- the direction control valve 64 shown in FIG. 2 is, for example, a proportional control valve, and is controlled by the hydraulic oil supplied from the controller 25.
- the direction control valve 64 is disposed between the hydraulic pumps 36 and 37 and hydraulic actuators such as the boom cylinder 10, the arm cylinder 11, the bucket cylinder 12 and the swing motor 38.
- the direction control valve 64 controls the flow rate and direction of hydraulic fluid 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 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 operation unit 23.
- the GNSS antenna 21 receives reference position data P1 indicating its position from the positioning satellites.
- the GNSS antenna 22 receives reference position data P2 indicating its position from the positioning satellites.
- the GNSS antennas 21 and 22 receive the reference position data P1 and P2 at a predetermined cycle.
- the reference position data P1 and P2 are information on the position where the GNSS antenna is installed.
- the GNSS antennas 21 and 22 output the reference position data P1 and P2 to the global coordinate calculator 23 each time they are received.
- the global coordinate calculation unit 23 includes storage units such as a RAM and a ROM, and processing units such as a CPU.
- the global coordinate calculation unit 23 generates revolving unit arrangement data indicating the arrangement of the upper revolving unit 3 based on the two reference position data P1 and P2.
- the swing body arrangement data includes one reference position data P of two reference position data P1, P2 and a swing body orientation data Q generated based on the two reference position data P1, P2.
- the swinging body orientation data Q indicates the direction in which the work implement 2 which is the upper swinging body 3 is facing.
- the global coordinate operation unit 23 updates the reference position data P and the rotating body orientation data Q which are the rotating body arrangement data each time the two reference position data P1 and P2 are obtained from the GNSS antennas 21 and 22 at a predetermined cycle. And output to the display controller 28.
- the display controller 28 includes storage units such as a RAM and a ROM, and processing units such as a CPU.
- the display controller 28 acquires reference position data P and revolving unit orientation data Q, which are revolving unit arrangement data, from the global coordinate operation 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 machine position data.
- the display controller 28 generates the target excavation landform data U using the bucket blade tip position data S and the target construction information T.
- the target construction information T is information to be a target of the work target of the work machine 2 provided in the hydraulic shovel 100, and in the embodiment, the finish of the target to be excavated.
- the target construction information T includes, for example, design information of a construction target of the hydraulic shovel 100.
- the work target of the work machine 2 is, for example, the ground. Examples of the work of the work machine 2 include, but are not limited to, excavating work and leveling work on the ground.
- the display controller 28 derives target excavated landform data Ua for display based on the target excavated landform data U, and based on the target excavated landform data Ua for display, the display unit 29 becomes the target of the work object of the working machine 2 Display the shape, eg terrain.
- the display unit 29 is, for example, a liquid crystal display device that receives an input by a touch panel, but is not limited to this.
- the switch 29S is disposed adjacent to the display unit 29.
- the switch 29S is an input device for executing intervention control to be described later or stopping intervention control in progress.
- the work machine controller 26 acquires the boom operation amount MB, the bucket operation amount MT, and the arm operation amount MA 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 target excavation landform data U from the display controller 28.
- the target excavation landform data U is information of a range in which the hydraulic shovel 100 is to work from now on among the target construction information T.
- the target excavation topography data U is a part of the target construction information T.
- the target excavation landform data U similarly to the target construction information T, represents a shape that is a target of the finish of the work object of the work machine 2.
- the target shape of the finish is hereinafter referred to as a target excavation topography as appropriate.
- the work machine controller 26 calculates the position of the cutting edge 8T of the bucket 8 (hereinafter referred to as a cutting edge position as appropriate) from the angle of the work machine 2 acquired from the sensor controller 39.
- the working machine controller 26 operates the working machine based on the distance between the target excavation landform data U and the cutting edge 8T of the bucket 8 and the speed of the work machine 2 so that the cutting edge 8T of the bucket 8 moves along the target excavation landform data U Control the operation of 2.
- the speed in the direction in which the work machine 2 approaches the construction target is Control to be below the speed limit. This control is appropriately referred to as intervention control.
- the intervention control is executed, for example, when the operator of the hydraulic shovel 100 selects to execute the intervention control using the switch 29S shown in FIG.
- the position serving as the reference of the bucket 8 is not limited to the blade edge 8T, and may be any place.
- the work machine controller 26 In intervention control, the work machine controller 26 generates a boom command signal CBI to control the work machine 2 to move the cutting edge 8T of the bucket 8 along the target excavation landform data U, as shown in FIG. It outputs to the intervention valve 27C.
- Boom 6 operates in accordance with boom command signal CBI.
- the movement of the boom 6 in response to the boom command signal CBI controls the speed of the work implement 2, more specifically, the bucket 8.
- the speed at which the bucket 8 approaches the target excavation landform data U is limited.
- FIG. 3 is a diagram showing an example of a hydraulic circuit 301 of the boom cylinder 10 based on the embodiment.
- the hydraulic circuit 301 is provided with a pilot oil passage 450 between the operating device 25 and the direction control valve 64.
- the direction control valve 64 is a valve that controls the direction in which the hydraulic oil supplied to the boom cylinder 10 flows.
- the direction control valve 64 is a spool type valve that switches the flow direction of the hydraulic oil by moving the rod-like spool 64S.
- the spool 64S is moved by the hydraulic oil (hereinafter appropriately referred to as pilot oil) supplied from the operating device 25 shown in FIG.
- the direction control valve 64 supplies hydraulic fluid to the boom cylinder 10 by the movement of the spool 64S to operate the boom cylinder 10.
- the pilot oil passage 50 and the pilot oil passage 450 B are connected to the shuttle valve 51.
- One of the shuttle valve 51 and the direction control valve 64 is connected by an oil passage 452B.
- the other of the direction control valve 64 and the operating device 25 are connected by a pilot oil passage 450A and a pilot oil passage 452A.
- the pilot oil passage 50 is provided with an intervention valve 27C.
- the intervention valve 27C adjusts the pilot pressure of the pilot oil passage 50.
- the pilot oil passage 450B is provided with a pressure sensor 66B and a control valve 27B.
- the pilot oil passage 450A is provided with a pressure sensor 66A between the control valve 27A and the operating device 25.
- the detection value of the pressure sensor 66 is acquired by the work machine controller 26 shown in FIG. 2 and used to control the boom cylinder 10.
- the pressure sensor 66A and the pressure sensor 66B correspond to the pressure sensor 66 shown in FIG.
- the control valve 27A and the control valve 27B correspond to the control valve 27 shown in FIG.
- the hydraulic oil supplied from the hydraulic pumps 36 and 37 is supplied to the boom cylinder 10 via the direction control valve 64.
- the spool 64S moves in the axial direction, the supply of the hydraulic fluid to the cap side oil chamber 48R of the boom cylinder 10 and the supply of the hydraulic fluid to the rod side oil chamber 47R are switched.
- the axial movement of the spool 64S adjusts the flow rate, which is the amount supplied of hydraulic fluid to the boom cylinder 10 per unit time. By adjusting the flow rate of hydraulic fluid to the boom cylinder 10, the operating speed of the boom cylinder 10 is adjusted.
- the movement amount of the spool 64S of the direction control valve 64 is adjusted to change the flow rate of the hydraulic oil supplied to the boom cylinder 10 and returned from the boom cylinder 10 to the direction control valve 64.
- the moving speeds of the piston 10P and the rod 10L, which are speeds, are changed.
- the operation of the directional control valve 64 is controlled by the operating device 25.
- the hydraulic oil discharged from the hydraulic pump 36 shown in FIG. 2 and reduced in pressure by the pressure reducing valve 25V is supplied to the operating device 25 as a pilot oil.
- the operating device 25 adjusts the pilot hydraulic pressure based on the operation of each operating lever.
- the direction control valve 64 is driven by the adjusted pilot pressure.
- the magnitude of the pilot hydraulic pressure and the direction of the pilot hydraulic pressure by the operation device 25 the amount and direction of movement of the spool 64S in the axial direction are adjusted. As a result, the operating speed and direction of the boom cylinder 10 are changed.
- the work machine controller 26 determines the target excavation landform (target excavation landform data U) indicating the design topography which is the target shape to be excavated and the inclination angles ⁇ 1 and ⁇ 2 for determining the position of the bucket 8 , ⁇ 3, the speed of the boom 6 is limited so that the speed at which the bucket 8 approaches the target excavation land shape 43I becomes smaller according to the distance between the target excavation land shape 43I and the bucket 8.
- the work machine controller 26 when the work machine 2 operates based on the operation of the operation device 25, the work machine controller 26 generates the boom command signal CBI so that the cutting edge 8T of the bucket 8 does not intrude into the target excavation landform 43I. To control the operation of the boom 6.
- the work machine controller 26 raises the boom 6 so that the cutting edge 8T does not intrude into the target excavation land shape 43I in the intervention control.
- Control for raising the boom 6 executed in the intervention control is appropriately referred to as boom intervention control.
- work implement controller 26 in order for work implement controller 26 to implement boom intervention control, work implement controller 26 generates boom command signal CBI for boom intervention control and outputs it to intervention valve 27C.
- the intervention valve 27C can adjust the pilot oil pressure of the pilot oil passage 50.
- Shuttle valve 51 has two inlets 51Ia and 51Ib and one outlet 51E. One inlet 51Ia is connected to the intervention valve 27C. The other inlet 51b is connected to the control valve 27B. The outlet 51E is connected to an oil passage 452B connected to the direction control valve 64.
- the shuttle valve 51 connects the oil passage 452B to one of the two inlets 51Ia and 51Ib, which has the higher pilot hydraulic pressure.
- the shuttle valve 51 connects the intervention valve 27C to the oil path 452B.
- the pilot oil that has passed the intervention valve 27C is supplied to the oil passage 452B via the shuttle valve 51.
- the shuttle valve 51 connects the control valve 27B to the oil path 452B.
- the pilot oil that has passed through the control valve 27B is supplied to the oil passage 452B via the shuttle valve 51.
- the directional control valve 64 is driven based on the pilot hydraulic pressure adjusted by the operation of the operating device 25.
- the work implement controller 26 opens (fully opens) the pilot oil passage 450B by the control valve 27B so that the directional control valve 64 is driven based on the pilot hydraulic pressure adjusted by the operation of the operating device 25.
- the intervention valve 27C is controlled to close the pilot oil passage 50.
- the work implement controller 26 controls the control valve 27 such that the directional control valve 64 is driven based on the pilot hydraulic pressure adjusted by the intervention valve 27C.
- the work implement controller 26 controls the pilot oil pressure of the pilot oil passage 50 adjusted by the intervention valve 27C
- the intervention valve 27C is controlled to be higher than the pilot oil pressure of the pilot oil passage 450B adjusted by 25. By doing this, the pilot oil from the intervention valve 27C is supplied to the directional control valve 64 via the shuttle valve 51.
- the work implement controller 26 When executing the boom intervention control, the work implement controller 26 generates a boom command signal CBI, which is a speed command for raising the boom 6, for example, and controls the intervention valve 27C. By doing this, the direction control valve 64 of the boom cylinder 10 supplies hydraulic fluid to the boom cylinder 10 so that the boom 6 is lifted at a speed corresponding to the boom command signal CBI. Raise
- the hydraulic circuit 301 of the boom cylinder 10 has been described, the hydraulic circuit of the arm cylinder 11 and the hydraulic circuit of the bucket cylinder 12 exclude the intervention valve 27 C, the shuttle valve 51 and the pilot oil passage 50 from the hydraulic circuit 301 of the boom cylinder 10 It is a structure.
- the boom intervention control is control for raising the boom 6 executed in the intervention control, but in the intervention control, the work machine controller 26 controls the arm 7 and the arm 6 in addition to or instead of raising the boom 6. At least one of the buckets 8 may be raised.
- the work implement controller 26 lifts at least one of the boom 6, the arm 7 and the bucket 8 constituting the work implement 2 to obtain the target shape of the work target of the work implement 2, in the embodiment, the target excavation topography Move work implement 2 in the direction away from 43I.
- intervention control is performed to control at least one of the boom 6, the arm 7, and the bucket 8 that the work machine controller 26 configures the work machine 2. It is called.
- the intervention control is control in which the work implement controller 26 operates the work implement 2 when the work implement 2 operates based on the manual operation which is the operation of the operation device 25.
- the boom intervention control described above is an aspect of the intervention control.
- FIG. 4 is a block diagram of work implement controller 26 based on the embodiment.
- FIG. 5 is a diagram showing the target excavation landform data U and the bucket 8 based on the embodiment.
- FIG. 6 is a diagram for explaining the boom speed limit Vcy_bm based on the embodiment.
- FIG. 7 is a diagram for explaining the speed limit Vc_lmt based on the embodiment.
- the work implement controller 26 includes a determination unit 26J and a control unit 26CNT.
- Control unit 26CNT includes relative position calculation unit 26A, distance calculation unit 26B, target speed calculation unit 26C, intervention speed calculation unit 26D, intervention command calculation unit 26E, and intervention speed correction unit 26F.
- the functions of the determination unit 26J, the relative position calculation unit 26A, the distance calculation unit 26B, the target speed calculation unit 26C, the intervention speed calculation unit 26D, the intervention command calculation unit 26E, and the intervention speed correction unit 26F are shown in FIG.
- the processing unit 26P of the controller 26 implements this.
- the work machine controller 26 When the intervention control is executed, the work machine controller 26 includes 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, the bucket blade tip position data S and the sensor controller 39.
- the boom command signal CBI required for intervention control is generated using the inclination angles ⁇ 1, ⁇ 2 and ⁇ 3 obtained from the above, the arm command signal and the bucket command signal are generated as necessary, and the control valve 27 and the intervention valve 27C are It drives and controls the work machine 2.
- the relative position calculation unit 26A acquires bucket blade tip position data S from the display controller 28, and acquires inclination angles ⁇ 1, ⁇ 2, and ⁇ 3 from the sensor controller 39.
- the relative position calculation unit 26A obtains a blade edge position Pb which is a position of the blade edge 8T of the bucket 8 from the acquired inclination angles ⁇ 1, ⁇ 2, ⁇ 3.
- the distance calculation unit 26B is a part of the cutting edge 8T of the bucket 8 and a part of the target construction information T from the cutting edge position Pb obtained by the relative position calculating unit 26A and the target excavation landform data U acquired from the display controller 28.
- a shortest distance d between the target excavation landform 431 represented by the target excavation landform data U is calculated.
- the distance d is a distance between the cutting edge position Pb, and a position Pu at which a straight line passing through the cutting edge position Pb is orthogonal to the target excavation topography 43I and the target excavation topography data U intersects.
- the target excavation landform 43I is determined from the intersection line between the plane of the working machine 2 defined in the front-rear direction of the upper revolving superstructure 3 and passing through the drilling target position Pdg and the target construction information T represented by a plurality of target construction surfaces.
- one or more inflection points before and after the digging target position Pdg of the target construction information T and lines before and after that are the target excavation landforms 43I among the intersection lines described above.
- the target excavation landform 43I is a part of the target construction information T.
- the target excavation landform 431 is generated by the display controller 28 shown in FIG.
- the target speed calculation unit 26C 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 the boom cylinder 10 is driven.
- the arm target speed Vc_am is the speed of the cutting edge 8T when the arm cylinder 11 is driven.
- the bucket target speed Vc_bkt is the speed of the cutting edge 8T when 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 intervention speed calculation unit 26D obtains the speed limit Vc_bm of the boom 6 (boom speed limit) based on the distance d between the blade tip 8T of the bucket 8 and the target excavation land shape 43I.
- the intervention speed calculation unit 26D subtracts the arm target speed Vc_am and the bucket target speed Vc_bkt from the speed limit Vc_lmt of the entire work machine 2 shown in FIG. 1 to obtain the boom speed limit Vcy_bm. Ask.
- the speed limit Vc_lmt is a movement speed of the cutting edge 8T that can be tolerated in the direction in which the cutting edge 8T of the bucket 8 approaches the target excavation land shape 43I.
- the speed limit Vc_lmt is a negative value when the distance d is positive is a negative value when the work implement 2 descends, and is a positive value when the distance d is negative. It is a rising speed when the work implement 2 rises.
- the negative value of the distance d means that the bucket 8 has eroded the target excavation topography 43I.
- the speed limit Vc_lmt decreases, the absolute value of the speed decreases as the distance d decreases, and when the distance d becomes a negative value, the absolute value of the speed increases as the absolute value of the distance d increases.
- the determination unit 26J determines whether to correct the boom speed limit Vcy_bm. When the determination unit 26J determines to correct the boom speed limit Vcy_bm, the intervention speed correction unit 26F corrects and outputs the boom speed limit Vcy_bm.
- the boom speed limit after correction is represented by Vcy_bm '.
- the intervention speed correction unit 26F When the determination unit 26J determines that the boom speed limit Vcy_bm is not corrected, the intervention speed correction unit 26F outputs the boom speed limit Vcy_bm without correction.
- the intervention command calculation unit 26E generates a boom command signal CBI from the boom speed limit Vcy_bm obtained by the intervention speed correction unit 26F.
- the boom command signal CBI is a command for setting the degree of opening of the intervention valve 27C to a level necessary for applying a pilot pressure necessary for the boom 6 to rise at the boom speed limit Vcy_bm to the shuttle valve 51.
- the boom command signal CBI is an electric current value according to the boom command speed in the embodiment.
- Determination unit 26J includes a switching determination unit 26K, an operation command determination unit 26L, and a speed difference determination unit 26M.
- the switching determination unit 26K determines whether or not the intervention control becomes unnecessary.
- the operation command determination unit 26L determines whether the operator performs an operation to raise the boom 6 or the neutral operation with respect to the right control lever 25R.
- the neutral operation is a state in which the operation to raise or lower is not performed.
- the right control lever 25R is in the middle position.
- the speed difference determination unit 26M determines the speed difference between the boom speed limit Vcy_bm and the boom target speed Vc_bm according to the operation by the operator to raise the boom 6 with respect to the right control lever 25R. Alternatively, the speed difference determination unit 26M determines the speed difference between the boom speed limit Vcy_bm and the boom target speed 0 according to the neutral operation of the right control lever 25R by the operator. Specifically, it is determined whether the speed difference is equal to or greater than a threshold value Dr.
- the boom speed limit Vcy_bm and the right control lever 25R by the operator are operated when the operator performs an operation to raise the boom 6 with respect to the right control lever 25R. If the speed difference from the boom target speed Vc_bm according to the operation to raise the boom 6 with respect to is larger than the threshold value Dr, the boom speed limit Vcy_bm is corrected.
- the determination unit 26J is a boom target according to the boom speed limit Vcy_bm and the neutral operation of the right control lever 25R by the operator. If the speed difference from the speed 0 is equal to or more than the threshold value Dr, the boom speed limit Vcy_bm is corrected.
- FIG. 8 is a diagram showing the relationship between the bucket 8 and the target excavation landform 43I based on the embodiment.
- the intervention control is control for moving the bucket 8 so that the bucket 8 does not erode the target excavation land shape 43I.
- the work implement controller 26 executes boom intervention control when the bucket 8 tries to erode the target excavation land form 43I.
- the intervention control is executed when the working machine tries to erode the target excavation land shape 43I by the operator operation as shown in FIG.
- the intervention control is not executed when the bucket 8 moves in the direction of the arrow Y shown in FIG. 8 and the operator's operation causes the work machine not to erode the target excavation land form 43I.
- Intervention control becomes unnecessary when the operator's operation causes the work machine not to erode the target excavation landform 43I.
- the operator of the hydraulic shovel 100 may execute an operation of moving the work machine 2 and the bucket 8 upward.
- the intervention control when the intervention control is released when the bucket 8 deviates from the area where the target excavation landform 431 exists, the intervention control is switched to the control of the work machine 2 by the manual operation.
- FIG. 9 is a view showing a relationship between a boom target speed Vbm, which is a speed at which the boom 6 operates based on the embodiment, and time t.
- the vertical axis is the boom target speed Vbm
- the horizontal axis is the time t.
- the boom target speed Vbm represents a rising speed which is a speed at which the boom 6 moves up when taking a positive value, and a lowering speed which shows a moving down speed of the boom 6 when taking a negative value.
- the boom target speed Vbm is the speed of the work machine 2.
- the rising speed of the boom 6 corresponds to the rising speed of the working machine 2
- the lowering speed of the boom 6 corresponds to the falling speed of the working machine 2.
- the rising speed and the falling speed of the work implement 2 are referred to as the movement speed of the work implement 2.
- the moving speed of the work implement 2 takes a positive value when the work implement 2 rises, and takes a negative value when the work implement 2 descends.
- the work implement controller 26 determines the boom target speed Vbm by the operation of the operator of the hydraulic shovel 100 when the boom intervention control becomes unnecessary when the bucket 8 is out of the area where the target excavation landform 431 exists. Target boom speed Vbop.
- the work machine controller 26 sets the boom target speed Vbm to a boom target speed Vbop by decreasing the boom target speed Vbm from the boom speed limit Vcy_bm1 before the boom intervention control becomes unnecessary at a constant rate of change VRC under a predetermined condition.
- the control is switched from the intervention control to the work machine 2 to the control of the work machine 2 based on the operation command from the operating device 25.
- the work machine controller 26 controls the boom speed limit according to the boom intervention control when the operation command from the operating device 25 is the boom 6 elevation command or the neutral command.
- Vcy_bm1 is compared with the boom target speed Vbop or 0 determined by the operation of the operator. Then, the difference D between the boom speed limit Vcy_bm1 and the boom target speed Vbop or 0 is calculated. The larger the difference D between the boom speed limit Vcy_bm1 and the boom target speed Vbop or 0, the larger the speed change.
- the work implement controller 26 sets the boom speed limit Vcy_bm1 and the boom target speed Vbop or 0 when the operation command from the operation device 25 is the boom 6 uplift command or the neutral command. If the difference D is smaller than the threshold value Dr, the boom target speed Vbm before the boom intervention control becomes unnecessary is decreased at a constant rate of change VRC and changed to the boom target speed Vbop instructed by the operator.
- the impact due to the rapid deceleration of the boom 6 can be reduced, and the influence on the soil loaded on the bucket 8 can be alleviated.
- the intervention speed calculation unit 26D of the work machine controller shown in FIG. 4 obtains the boom speed limit Vcy_bm.
- the switching determination unit 26K determines whether or not the boom intervention control becomes unnecessary.
- the operation command determination unit 26L determines whether the operator performs an operation to raise the boom 6 or the neutral operation with respect to the right control lever 25R when the boom intervention control is not required.
- the speed difference determination unit 26M controls the boom speed limit Vcy_bm and the boom by the operator when the operator performs an operation to raise the boom 6 or the neutral operation with respect to the right control lever 25R when the boom intervention control is not necessary.
- the speed difference with the boom target speed Vc_bm according to the operation of raising 6 or the boom target speed 0 according to the neutral operation is determined.
- the determination unit 26J determines that the boom speed limit Vcy_bm is to be corrected and corrects the boom speed limit Vcy_bm in the intervention speed correction unit 26F. Instruct
- the intervention speed correction unit 26F of the control unit 26CNT obtains the corrected boom speed limit Vcy_bm ', and outputs it to the intervention command calculation unit 26E of the control unit 26CNT.
- the intervention command calculation unit 26E of the control unit 26CNT generates a boom command signal CBI using the corrected boom speed limit Vcy_bm 'to control the intervention valve 27C. By such processing, the work machine controller 26 changes the rising speed of the boom 6.
- the intervention speed correction unit 26F controls the boom speed limit Vcy_bm to change to the boom target speed Vbop according to the change rate VRC.
- the rate of change VRC is set in a range in which the change to the boom target speed Vbop does not become too rapid.
- the rate of change VRC is determined by, for example, sensory evaluation of the operator, but the method of determining the rate of change VRC is not limited to such a method.
- FIG. 10 is a diagram for explaining the flow showing the control method of the working machine based on the embodiment.
- control method of the working machine according to the embodiment is realized by the working machine controller 26.
- step S2 the switching determination unit 26K of the working unit controller 26 illustrated in FIG. 4 determines whether or not boom intervention control is unnecessary. If the switching determination unit 26K determines that the boom intervention control is unnecessary (YES in step S2), the operation command determination unit 26L performs an operation to raise the boom 6 or a neutral operation in step S4. It is determined whether or not it is (step S4).
- step S4 when the operation command determination unit 26L determines that the operator performs the operation of raising the boom 6 or performs the neutral operation (YES in step S4), the speed difference determination unit 26M controls the boom speed limit Vcy_bm. And, the speed difference between the boom target speed Vc_bm or the boom target speed 0 according to the operation of raising the boom 6 by the operator is determined (step S5).
- the speed difference determination unit 26M determines whether the speed difference is equal to or greater than the threshold value Dr (step S6).
- step S6 when the speed difference determination unit 26M determines that the speed difference is equal to or greater than the threshold value Dr (YES in step S6), the intervention command calculation unit 26E of the work machine controller 26 determines the intervention speed in step S8.
- a boom command signal CBI is generated from the corrected boom speed limit Vcy_bm 'obtained by the correction unit 26F, and the intervention valve 27C is controlled based on the boom command signal.
- the process ends (end).
- the switch determination unit 26K determines that the boom intervention control is not unnecessary in step S2 (YNO in step S2)
- the intervention command calculation unit 26E of the work machine controller 26 does not correct the boom in step S16.
- the intervention valve 27C is controlled based on the boom command signal CBI using the speed limit Vcy_bm.
- step S4 determines whether the operator has not performed the operation for raising boom 6 or the neutral operation (NO in step S4), or if it is determined in step S6 that the speed difference is less than threshold value Dr.
- work implement controller 26 At (NO in step S6), work implement controller 26 generates boom command signal CBI using the target speed according to the command of the operating lever, and controls intervention valve 27C based on the boom command signal (step S12).
- the operating device 25 has the pilot hydraulic control lever, but may have the electric left control lever 25La and the right control lever 25Ra.
- the respective operation amounts are detected by the potentiometers.
- the operation amount of the left control lever 25La and the right control lever 25Ra detected by the potentiometer is acquired by the work implement controller 26.
- the work machine controller 26 that has detected the operation signal of the control lever of the electrical system executes the same control as the pilot hydraulic system.
- the boom speed limit Vcy_bm and the boom 6 are raised when the operator performs an operation to raise the boom 6 or the neutral operation with respect to the right control lever 25R when the intervention control becomes unnecessary. If the boom target speed Vc_bm according to the operation to be made or the speed difference with the boom target speed 0 according to the neutral operation is equal to or more than the threshold value Dr, the boom speed limit Vcy_bm is corrected. The boom speed limit Vcy_bm is decreased at a constant rate of change VRC and changed to the boom target speed Vbop or 0 instructed by the operator.
- work implement 2 has boom 6, arm 7, and bucket 8
- the attachment with which work implement 2 is attached is not restricted to this, and it is not limited to bucket 8.
- the work machine may have a work machine, and is not limited to the hydraulic shovel 100.
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)
- Fluid Mechanics (AREA)
- Operation Control Of Excavators (AREA)
Abstract
Description
図1は、実施形態に基づく作業機械の斜視図である。 <Overall configuration of working machine>
FIG. 1 is a perspective view of a working machine based on the embodiment.
上部旋回体3は、作業機2および運転室4が配置されている側が前であり、機関室3EGが配置されている側が後である。前に向かって左側が上部旋回体3の左であり、前に向かって右側が上部旋回体3の右である。上部旋回体3の左右方向は、幅方向とも言う。油圧ショベル100又は車両本体1は、上部旋回体3を基準として走行装置5側が下であり、走行装置5を基準として上部旋回体3側が上である。油圧ショベル100の前後方向がx方向、幅方向がy方向、上下方向がz方向である。油圧ショベル100が水平面に設置されている場合、下は鉛直方向である重力の作用方向側であり、上は鉛直方向とは反対側である。 The
As for the upper revolving
図2に示されるように、油圧ショベル100の油圧システム300は、動力発生源としての内燃機関35と油圧ポンプ36,37とを備える。油圧ポンプ36,37は、内燃機関35によって駆動され、作動油を吐出する。油圧ポンプ36,37から吐出された作動油は、ブームシリンダ10とアームシリンダ11とバケットシリンダ12とに供給される。 <
As shown in FIG. 2, the
図2に示されるように、作業機械の制御システムである制御システム200は、位置検出装置19と、グローバル座標演算部23と、操作装置25と、実施形態に係る作業機械の制御装置である作業機コントローラ26と、センサコントローラ39と、表示コントローラ28と、表示部29とを含む。 <
As shown in FIG. 2, a
図3は、実施形態に基づくブームシリンダ10の油圧回路301の一例を示す図である。 <Configuration of
FIG. 3 is a diagram showing an example of a
図5は、実施形態に基づく目標掘削地形データUおよびバケット8を示す図である。 FIG. 4 is a block diagram of work implement
FIG. 5 is a diagram showing the target excavation landform data U and the
図7は、実施形態に基づく制限速度Vc_lmtを説明するための図である。 FIG. 6 is a diagram for explaining the boom speed limit Vcy_bm based on the embodiment.
FIG. 7 is a diagram for explaining the speed limit Vc_lmt based on the embodiment.
判定部26Jがブーム制限速度Vcy_bmを補正すると判定した場合、介入速度修正部26Fはブーム制限速度Vcy_bmを補正して出力する。補正後のブーム制限速度は、Vcy_bm’で表される。 The
When the
操作指令判断部26Lは、オペレータが右操作レバー25Rに対してブーム6を上昇させる操作あるいは中立操作をしているか否かを判断する。中立操作は、上昇あるいは下降させる操作をしていない状態である。右操作レバー25Rが中間位置にある状態である。 The switching
The operation
図8は、実施形態に基づくバケット8と目標掘削地形43Iとの関係を示す図である。 <Aspect of boom intervention control>
FIG. 8 is a diagram showing the relationship between the
図10は、実施形態に基づく作業機械の制御方法を示すフローを説明する図である。 <Control method of working machine based on the embodiment>
FIG. 10 is a diagram for explaining the flow showing the control method of the working machine based on the embodiment.
一方、ステップS2において、切替判定部26Kが、ブーム介入制御が不要でないと判定した場合(ステップS2においてYNO)には、ステップS16において、作業機コントローラ26の介入指令算出部26Eは、補正しないブーム制限速度Vcy_bmを用いてブーム指令信号CBIに基づき介入弁27Cを制御する。 Then, the process ends (end).
On the other hand, when the
実施形態において、操作装置25はパイロット油圧方式の操作レバーを有するが、電気方式の左操作レバー25Laおよび右操作レバー25Raを有してもよい。 <Electric control lever>
In the embodiment, the operating
Claims (4)
- 作業機と、
前記作業機を操作する操作装置と、
前記作業機を制御するコントローラとを備え、
前記コントローラは、
前記操作装置からの操作指令に基づいて前記作業機を上昇させる介入制御を実行し、
前記介入制御から前記操作装置の操作指令に従う前記作業機の制御への切替を判定し、
判定結果に基づく前記切替において前記操作装置の操作指令が前記作業機の上昇、もしくは中立指令であるか否かを判断し、
判断結果に基づいて前記操作装置の操作指令が前記作業機の上昇、もしくは中立指令である場合には、前記介入制御による前記作業機の上昇目標速度と、前記操作装置の操作指令に従う目標速度との速度差を判断し、
前記速度差が所定値以上である場合には、前記作業機の上昇目標速度が前記操作装置の操作指令に従う目標速度に徐々に変化するように調整する、作業機械。 Working machine,
An operating device for operating the work machine;
A controller for controlling the work machine;
The controller
Executing intervention control for raising the work machine based on an operation command from the operation device;
Determining the switching from the intervention control to the control of the work machine according to the operation command of the operating device;
In the switching based on the determination result, it is determined whether or not the operation command of the operating device is the lifting or neutral command of the work machine,
When the operation command of the operating device is the elevation or neutral command of the working machine based on the determination result, the target target speed according to the operation command of the operating device according to the target target speed of elevation of the work machine by the intervention control To determine the speed difference of
A working machine which adjusts so that the elevation target speed of the working machine gradually changes to a target speed according to an operation command of the operating device when the speed difference is equal to or greater than a predetermined value. - 前記コントローラは、
前記操作装置からの操作指令に基づいて前記作業機を上昇させる介入制御を実行する介入制御部と、
前記介入制御から前記操作装置の操作指令に従う前記作業機の制御への切替を判定する切替判定部と、
前記切替判定部の判定結果に基づく前記切替において前記操作装置の操作指令が前記作業機の上昇、もしくは中立指令であるか否かを判断する操作指令判断部と、
前記操作指令判断部の判断結果に基づいて前記操作装置の操作指令が前記作業機の上昇、もしくは中立指令である場合には、前記介入制御による前記作業機の上昇目標速度と、前記操作装置の操作指令に従う目標速度との速度差を判断する速度差判断部と、
前記速度差判断部の判断結果に基づいて前記速度差が所定値以上である場合には、前記作業機の上昇目標速度が前記操作装置の操作指令に従う目標速度に徐々に変化するように調整する速度調整部とを含む、請求項1記載の作業機械。 The controller
An intervention control unit that executes intervention control that raises the work machine based on an operation command from the operation device;
A switching determination unit that determines switching from the intervention control to control of the work machine according to an operation command of the operating device;
An operation command determination unit that determines whether or not the operation command of the operation device is the lifting or neutral command of the work machine in the switching based on the determination result of the switching determination unit;
In the case where the operation command of the operating device is the lifting or neutral command of the working device based on the determination result of the operation command determining unit, an increase target speed of the working device by the intervention control and the operating device A speed difference determination unit that determines a speed difference from a target speed according to the operation command;
If the speed difference is equal to or greater than a predetermined value based on the judgment result of the speed difference judging unit, the target speed to be increased by the working machine is adjusted to gradually change to the target speed according to the operation command of the operating device. The work machine according to claim 1, further comprising: a speed adjustment unit. - 前記コントローラは、
前記速度差が前記所定値未満である場合には、前記作業機の上昇目標速度を前記操作装置の操作指令に従う目標速度に切り替える、請求項1記載の作業機械。 The controller
The work machine according to claim 1, wherein, when the speed difference is less than the predetermined value, the work target lift target speed is switched to a target speed according to an operation command of the operating device. - 作業機と、前記作業機を操作する操作装置とを備える、作業機械の制御方法であって、
前記操作装置からの操作指令に基づいて前記作業機を上昇させる介入制御を実行するステップと、
前記介入制御から前記操作装置の操作指令に従う前記作業機の制御への切替を判定するステップと、
判定結果に基づく前記切替において前記操作装置の操作指令が前記作業機の上昇、もしくは中立指令であるか否かを判断するステップと、
判断結果に基づいて前記操作装置の操作指令が前記作業機の上昇、もしくは中立指令である場合には、前記介入制御による前記作業機の上昇目標速度と、前記操作装置の操作指令に従う目標速度との速度差を判断するステップと、
前記速度差が所定値以上である場合には、前記作業機の上昇目標速度が前記操作装置の操作指令に従う目標速度に徐々に変化するように調整するステップとを備える、作業機械の制御方法。 A control method of a working machine, comprising a working machine and an operating device for operating the working machine,
Executing intervention control for raising the work machine based on an operation command from the operation device;
Determining switching from the intervention control to the control of the work machine according to the operation command of the operating device;
Determining whether or not an operation command of the operating device in the switching based on the determination result is the lifting or neutral command of the work machine;
When the operation command of the operating device is the elevation or neutral command of the working machine based on the determination result, the target target speed according to the operation command of the operating device according to the target target speed of elevation of the work machine by the intervention control Determining the speed difference of
Adjusting the target target speed of the work machine to gradually change to a target speed according to the operation command of the operating device if the speed difference is equal to or greater than a predetermined value.
Priority Applications (6)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020187004640A KR102088784B1 (en) | 2017-07-14 | 2017-07-14 | Working machine and control method of working machine |
DE112017000085.8T DE112017000085T5 (en) | 2017-07-14 | 2017-07-14 | WORK MACHINE AND CONTROL PROCESS FOR WORK MACHINE |
PCT/JP2017/025778 WO2019012699A1 (en) | 2017-07-14 | 2017-07-14 | Work machine and control method for work machine |
US15/756,656 US20190078289A1 (en) | 2017-07-14 | 2017-07-14 | Work machine and control method for work machine |
JP2017560641A JP6901406B2 (en) | 2017-07-14 | 2017-07-14 | Work machine and control method of work machine |
CN201780002863.4A CN109511268A (en) | 2017-07-14 | 2017-07-14 | The control method of Work machine and Work machine |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2017/025778 WO2019012699A1 (en) | 2017-07-14 | 2017-07-14 | Work machine and control method for work machine |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2019012699A1 true WO2019012699A1 (en) | 2019-01-17 |
Family
ID=65002558
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2017/025778 WO2019012699A1 (en) | 2017-07-14 | 2017-07-14 | Work machine and control method for work machine |
Country Status (6)
Country | Link |
---|---|
US (1) | US20190078289A1 (en) |
JP (1) | JP6901406B2 (en) |
KR (1) | KR102088784B1 (en) |
CN (1) | CN109511268A (en) |
DE (1) | DE112017000085T5 (en) |
WO (1) | WO2019012699A1 (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20220037405A (en) * | 2019-04-05 | 2022-03-24 | 볼보 컨스트럭션 이큅먼트 에이비 | construction machinery |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102295186B1 (en) | 2019-09-24 | 2021-09-01 | (주)세고스 | Bearing assembly |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3056254B2 (en) * | 1994-04-28 | 2000-06-26 | 日立建機株式会社 | Excavation control device for construction machinery |
JP2007030610A (en) * | 2005-07-25 | 2007-02-08 | Toyota Motor Corp | Brake control device |
JP2015196968A (en) * | 2014-03-31 | 2015-11-09 | 住友建機株式会社 | Shovel |
WO2015186180A1 (en) * | 2014-06-02 | 2015-12-10 | 株式会社小松製作所 | Construction machine control system, construction machine, and construction machine control method |
WO2016111384A1 (en) * | 2016-02-29 | 2016-07-14 | 株式会社小松製作所 | Control device for work machine, work machine, and control method for work machine |
Family Cites Families (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS55119118A (en) * | 1979-03-09 | 1980-09-12 | Nisshin Steel Co Ltd | Denitrification method for iron alloy containing chromium |
GB2250108B (en) * | 1990-10-31 | 1995-02-08 | Samsung Heavy Ind | Control system for automatically controlling actuators of an excavator |
SE523988C2 (en) * | 2002-04-22 | 2004-06-15 | Volvo Constr Equip Holding Se | Device and method for controlling a machine |
DE10250694B3 (en) * | 2002-10-31 | 2004-02-12 | CNH Österreich GmbH | Agricultural vehicle control method provides automatic travel and field end management by detection, storage and controlled alteration of vehicle operating parameters |
CN101821457B (en) * | 2007-08-09 | 2012-08-29 | 株式会社小松制作所 | Working vehicle and amount controlling method of working oil thereof |
US9328478B2 (en) * | 2011-08-24 | 2016-05-03 | Volvo Construction Equipment Ab | Method for controlling a working machine |
WO2015102058A1 (en) * | 2014-05-30 | 2015-07-09 | 株式会社小松製作所 | Method for controlling industrial vehicle, device for controlling industrial vehicle, and industrial vehicle |
US20170121930A1 (en) * | 2014-06-02 | 2017-05-04 | Komatsu Ltd. | Construction machine control system, construction machine, and method of controlling construction machine |
DE112015000035B4 (en) * | 2014-06-04 | 2019-01-10 | Komatsu Ltd. | Construction machine control system, construction machine and construction machine control method |
KR101658326B1 (en) * | 2014-09-10 | 2016-09-22 | 가부시키가이샤 고마쓰 세이사쿠쇼 | Work vehicle and method of controlling work vehicle |
JP5732598B1 (en) * | 2014-09-10 | 2015-06-10 | 株式会社小松製作所 | Work vehicle |
-
2017
- 2017-07-14 CN CN201780002863.4A patent/CN109511268A/en not_active Withdrawn
- 2017-07-14 US US15/756,656 patent/US20190078289A1/en not_active Abandoned
- 2017-07-14 DE DE112017000085.8T patent/DE112017000085T5/en not_active Withdrawn
- 2017-07-14 KR KR1020187004640A patent/KR102088784B1/en active IP Right Grant
- 2017-07-14 JP JP2017560641A patent/JP6901406B2/en active Active
- 2017-07-14 WO PCT/JP2017/025778 patent/WO2019012699A1/en active Application Filing
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3056254B2 (en) * | 1994-04-28 | 2000-06-26 | 日立建機株式会社 | Excavation control device for construction machinery |
JP2007030610A (en) * | 2005-07-25 | 2007-02-08 | Toyota Motor Corp | Brake control device |
JP2015196968A (en) * | 2014-03-31 | 2015-11-09 | 住友建機株式会社 | Shovel |
WO2015186180A1 (en) * | 2014-06-02 | 2015-12-10 | 株式会社小松製作所 | Construction machine control system, construction machine, and construction machine control method |
WO2016111384A1 (en) * | 2016-02-29 | 2016-07-14 | 株式会社小松製作所 | Control device for work machine, work machine, and control method for work machine |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20220037405A (en) * | 2019-04-05 | 2022-03-24 | 볼보 컨스트럭션 이큅먼트 에이비 | construction machinery |
KR102705219B1 (en) * | 2019-04-05 | 2024-09-11 | 볼보 컨스트럭션 이큅먼트 에이비 | Construction machinery |
Also Published As
Publication number | Publication date |
---|---|
US20190078289A1 (en) | 2019-03-14 |
JPWO2019012699A1 (en) | 2020-05-07 |
JP6901406B2 (en) | 2021-07-14 |
CN109511268A (en) | 2019-03-22 |
KR20190019037A (en) | 2019-02-26 |
DE112017000085T5 (en) | 2019-04-18 |
KR102088784B1 (en) | 2020-03-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6096988B2 (en) | Work machine control device, work machine, and work machine control method | |
JP6209276B2 (en) | Work machine control device, work machine, and work machine control method | |
KR101737389B1 (en) | Work machine control device, work machine, and work machine control method | |
JP6894847B2 (en) | Work machine and control method of work machine | |
JP5864775B2 (en) | Work vehicle | |
KR101839467B1 (en) | Construction machinery control system, construction machinery, and construction machinery control method | |
US11591768B2 (en) | Control system of work machine and method for controlling work machine | |
JP2017180079A (en) | Control device of working machine, working machine and control method of working machine | |
JP6901406B2 (en) | Work machine and control method of work machine | |
JP6876623B2 (en) | Work machine and control method of work machine | |
WO2023276421A1 (en) | Construction machine | |
US11608610B2 (en) | Control of a hydraulic system | |
WO2020194559A1 (en) | Hydraulic shovel |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
ENP | Entry into the national phase |
Ref document number: 2017560641 Country of ref document: JP Kind code of ref document: A |
|
ENP | Entry into the national phase |
Ref document number: 20187004640 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: 17917411 Country of ref document: EP Kind code of ref document: A1 |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 17917411 Country of ref document: EP Kind code of ref document: A1 |