[go: up one dir, main page]

WO2020049623A1 - 作業機械 - Google Patents

作業機械 Download PDF

Info

Publication number
WO2020049623A1
WO2020049623A1 PCT/JP2018/032671 JP2018032671W WO2020049623A1 WO 2020049623 A1 WO2020049623 A1 WO 2020049623A1 JP 2018032671 W JP2018032671 W JP 2018032671W WO 2020049623 A1 WO2020049623 A1 WO 2020049623A1
Authority
WO
WIPO (PCT)
Prior art keywords
arm
jack
angle
target
pressure
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Ceased
Application number
PCT/JP2018/032671
Other languages
English (en)
French (fr)
Inventor
悠介 鈴木
田中 宏明
寿身 中野
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hitachi Construction Machinery Co Ltd
Original Assignee
Hitachi Construction Machinery Co Ltd
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 Hitachi Construction Machinery Co Ltd filed Critical Hitachi Construction Machinery Co Ltd
Priority to PCT/JP2018/032671 priority Critical patent/WO2020049623A1/ja
Priority to US16/645,505 priority patent/US11352761B2/en
Priority to KR1020207004933A priority patent/KR102413885B1/ko
Priority to JP2020509565A priority patent/JP6872666B2/ja
Priority to EP18932319.9A priority patent/EP3848515B1/en
Priority to CN201880054990.3A priority patent/CN111148879B/zh
Publication of WO2020049623A1 publication Critical patent/WO2020049623A1/ja
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

Images

Classifications

    • 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/431Control of dipper or bucket position; Control of sequence of drive operations for bucket-arms, front-end loaders, dumpers or the like
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/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/2221Control of flow rate; Load sensing arrangements
    • E02F9/2225Control of flow rate; Load sensing arrangements using pressure-compensating valves
    • E02F9/2228Control of flow rate; Load sensing arrangements using pressure-compensating valves including an electronic controller
    • 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/437Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like providing automatic sequences of movements, e.g. linear excavation, keeping dipper angle constant
    • 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/2264Arrangements or adaptations of elements for hydraulic drives
    • E02F9/2267Valves or distributors
    • 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/2264Arrangements or adaptations of elements for hydraulic drives
    • E02F9/2271Actuators and supports therefor and protection therefor
    • 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
    • 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/2285Pilot-operated systems
    • 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
    • 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)

Definitions

  • the present invention relates to a working machine used for structural demolition work, road work, construction work, civil engineering work, and the like.
  • an articulated working device consisting of a plurality of front members is attached to the main body, and each front member is driven by a hydraulic cylinder.
  • Things are known.
  • One example is a hydraulic shovel having a working device including a boom, an arm, a bucket, and the like.
  • Some types of hydraulic excavators are capable of executing a so-called machine control, in which an area in which a working device is operable is provided and the working device is semi-automatically operated within the range. For example, when a construction target plane is set at the boundary between the operable area and the non-operable area of the working device and the operator operates the arm, the working device is semi-automatically controlled by the machine control so as to follow the construction target surface. Can work.
  • Patent Document 1 discloses a technique of detecting a combined operation including an arm closing operation and a boom lowering operation by an operator and controlling a boom cylinder pressure so that the vehicle body is not jacked up.
  • the pressure of hydraulic oil supplied to the boom cylinder is adjusted so as not to exceed the boom cylinder pressure when the work machine is jacked up.
  • the angle between the ground and the traveling body when the hydraulic excavator is in the jack-up state is sometimes referred to as a jack-up angle, and the operator intuitively grasps the magnitude of the excavating power based on the magnitude of the jack-up angle.
  • Excavation force may be adjusted.
  • the boom cylinder pressure is controlled so that the vehicle body is not always jacked up. That is, in the technique of Patent Document 1, the jack-up angle is always kept almost zero by the controller regardless of the intention of the operator. Therefore, the operator cannot intuitively grasp the state of the excavating force from the magnitude of the jack-up angle, and it becomes difficult to adjust the excavating force by his / her own operation. As a result, some operators may determine that the machine has poor operability.
  • the present invention has been made in view of the above problems, and an object of the present invention is to provide a work machine in which machine control is performed, in which the operability of an operator in a so-called jack-up state is excellent.
  • the present invention has a vehicle body including a traveling body and a swing body, a boom, an arm, and a boom, a working device attached to the swing body, and hydraulic oil discharged from a hydraulic pump.
  • a plurality of hydraulic cylinders driven by the operating device to operate the operating device, an operating device for instructing the operation of the operating device according to an operation of an operator, and a target arbitrarily set while the operating device is operated.
  • a control device that executes a region limit control that controls at least one hydraulic cylinder of the plurality of hydraulic cylinders, such that the work device is located on or above a surface, wherein the control device includes: During execution of the area restriction control, when a jack-up angle that is an inclination angle of the vehicle body with respect to the ground is larger than a predetermined target value, Yakkiappu angle correcting control of the at least one hydraulic cylinder so as to come close to the target value, the target value shall be set to vary according to the posture of the arm.
  • operability and work efficiency can be improved without excavating a target surface in machine control excavation work.
  • FIG. 1 is a side view of a hydraulic excavator according to an embodiment of the present invention.
  • FIG. 2 is a system configuration diagram of the hydraulic shovel of FIG. 1. It is the side view which showed the jack-up state of the hydraulic shovel.
  • FIG. 3 is a diagram illustrating a functional configuration of a controller.
  • FIG. 4 is an explanatory diagram of correction of a trajectory of a bucket tip. The figure which shows the calculation table of the speed limit vertical component V1y '. It is a figure which shows the vehicle body pitch angle obtained by analyzing the excavation work of a skilled operator.
  • 6 is a flowchart illustrating a procedure according to the embodiment. The figure which shows the correlation of an arm angle and target jack-up angle (phi) t. The figure which shows the correlation of an arm angle, the target jack-up angle (phi) t, and the target surface distance D.
  • FIG. 1 is a schematic configuration diagram of a hydraulic shovel according to an embodiment of the present invention.
  • the excavator includes a crawler type traveling body 401 and a revolving body 402 that is pivotably mounted on the traveling body 401.
  • the traveling body 401 is driven by the traveling hydraulic motor 33.
  • the revolving superstructure 402 is driven by the torque generated by the revolving hydraulic motor 28, and revolves left and right.
  • the traveling body 401 and the revolving body 402 may be collectively referred to as a vehicle body 1A.
  • the traveling body 401 is not limited to one having a crawler belt, but may be one having traveling wheels or legs.
  • a driver's seat 403 is installed on the revolving superstructure 402, and a multi-joint type front working device (working device) 400 capable of forming a target surface is mounted in front of the revolving superstructure 402.
  • the front working device 400 includes a boom 405 driven by a boom cylinder (first hydraulic actuator) 32a, an arm 406 driven by an arm cylinder (second hydraulic actuator) 32b, and a bucket 407 driven by a bucket cylinder 32c.
  • the boom cylinder 32a, the arm cylinder 32b, and the bucket cylinder 32c are each driven by hydraulic oil discharged from the hydraulic pump 23, and operate the working device 400.
  • the boom 405, the arm 406, and the bucket 407 are sometimes referred to as front members.
  • the front working device 400 also includes a first link 407B connecting the bucket 407 and the tip of the bucket cylinder 32c, and a second link 407C connecting the arm 406 and the tip of the bucket cylinder 32c.
  • the bucket cylinder (hydraulic cylinder) 32c is connected to the second link 407C and the arm 406.
  • the bucket 407 can be arbitrarily exchanged for a working tool (not shown) such as a grapple, a breaker, a ripper, and a magnet.
  • a working tool such as a grapple, a breaker, a ripper, and a magnet.
  • the boom 405 and the arm 406 include a boom IMU (IMU: Inertial Measurement Unit (Inertial Measurement Unit)) 36 for detecting the posture (inclination angle) of the boom 405 and the arm 406 with respect to a predetermined surface (for example, a horizontal plane).
  • the arm IMU 37 is attached.
  • the second link 407C is provided with a bucket IMU 38 for detecting the attitude (inclination angle) of the bucket 407 with respect to a predetermined surface (for example, a horizontal plane).
  • Each of these IMUs 36, 37, and 38 is composed of an angular velocity sensor and an acceleration sensor, and can also calculate a tilt angle.
  • an operation lever (operation device) 26 for instructing the operation of the front working device 400, the revolving unit 402, and the traveling unit 401 in accordance with the operation of the operator, and a target rotation speed of the engine 21 (see FIG. 2).
  • a commanding engine control dial 51 (see FIG. 2) is provided.
  • the operation lever 26 controls a boom cylinder 32a, an arm cylinder 32b, a bucket cylinder 32c, a travel hydraulic motor 33, and a control signal (a pilot pressure (hereinafter referred to as "Pi pressure") output from a gear pump 24 (see FIG. 2). ) Is generated according to the operation direction and the operation amount, and the boom 405, the arm 406, the bucket 407, the revolving unit 402, and the traveling unit 401 are operated by the control signal.
  • a pilot pressure hereinafter referred to as "Pi pressure”
  • the Pi pressure output from the operation lever 26 is detected by the pressure sensor 44, and the pressure sensor 44 outputs the detected value to the controller 20.
  • the detection value of the pressure sensor 44 is used by the controller 20 to detect the operation amount, operation direction, and operation target of the operation lever 26. That is, the pressure sensor 44 functions as an operation amount sensor that detects an operation input amount to the operation lever 26. There are twice as many pressure sensors 44 as there are control valves.
  • the operation lever 26 may be of an electric type. In this case, the operation amount, operation direction, and operation target of the operation lever 26 are detected by an operation amount sensor that detects an inclination amount (operation amount) of the operation lever 26.
  • the operation amount sensor can convert an operation speed requested by the operator to the work device 400 into an electric signal by detecting an amount by which the operator tilts the operation lever 26.
  • FIG. 2 is a system configuration diagram of the hydraulic shovel of FIG.
  • the hydraulic shovel of the present embodiment is driven by the engine 21, an engine control unit (ECU) 22 which is a controller (control device) for controlling the engine 21, and mechanically connected to an output shaft of the engine 21.
  • the hydraulic pump 23 and the gear pump (pilot pump) 24, and the pressure oil discharged from the gear pump 24, which is reduced in pressure according to the operation amount, are proportionally supplied as control signals for the hydraulic actuators 28, 33, 32a, 32b, 32c.
  • the operation lever 26 that outputs to the control valve 25 via the electromagnetic valve 27 and the flow rate and direction of the hydraulic oil introduced from the hydraulic pump 23 to each of the hydraulic actuators 28, 33, 32 a, 32 b, and 32 c are controlled by the operation lever 26 or the proportional
  • the control signal (pilot pressure (hereinafter referred to as P )
  • controller 20 for calculating a corrected Pi pressure based on the vehicle information and outputting a command voltage capable of generating the corrected Pi pressure to the proportional solenoid valve 27;
  • a target plane setting device 50 for inputting information on a target plane as a shape to the controller 20 is provided.
  • the torque and flow rate of the hydraulic pump 23 are mechanically controlled so that the vehicle body operates according to a target output (described later) of each of the hydraulic actuators 28, 33, 32a, 32b, and 32c.
  • control valves 25 There are the same number of control valves 25 as the number of hydraulic actuators 28, 33, 32a, 32b, 32c to be controlled, but FIG. 2 shows one of them.
  • Two Pi pressures act on each control valve to move the internal spool to one or the other in the axial direction. For example, a Pi pressure for raising the boom and a Pi pressure for lowering the boom act on the control valve 25 for the boom cylinder 32a.
  • the pressure sensors 41 detect the Pi pressure acting on each control valve 25, and there are twice the number of control valves.
  • the pressure sensor 41 is provided immediately below the control valve 25, and detects the Pi pressure that actually acts on the control valve 25.
  • proportional solenoid valves 27 Although there are a plurality of proportional solenoid valves 27, they are collectively shown in one block in FIG. There are two types of proportional solenoid valves 27. One is a pressure reducing valve which reduces the Pi pressure input from the operating lever 26 to a desired corrected Pi pressure specified by an output or a command voltage and outputs the same, and the other is a Pi which the operating lever 26 outputs. This is a pressure increasing valve that reduces the Pi pressure input from the gear pump 24 to a desired corrected Pi pressure specified by the command voltage and outputs the Pi pressure when a Pi pressure larger than the pressure is required.
  • a pressure reducing valve which reduces the Pi pressure input from the operating lever 26 to a desired corrected Pi pressure specified by an output or a command voltage and outputs the same
  • Pi which the operating lever 26 outputs.
  • the Pi pressure When a Pi pressure with respect to a certain control valve 25 is required to be higher than the Pi pressure output from the operation lever 26, the Pi pressure is generated via a pressure increasing valve, and the Pi pressure output from the operation lever 26 is generated.
  • the Pi pressure When a Pi pressure smaller than the required pressure is required, the Pi pressure is generated via a pressure reducing valve, and when the Pi pressure is not output from the operation lever 26, the Pi pressure is generated via a pressure increasing valve. That is, the pressure reducing valve and the pressure increasing valve allow the Pi pressure having a pressure value different from the Pi pressure (Pi pressure based on the operator's operation) input from the operation lever 26 to act on the control valve 25, and control of the control valve 25
  • the desired operation can be performed by the target hydraulic actuator.
  • ⁇ ⁇ ⁇ There can be up to two pressure reducing valves and two pressure increasing valves per control valve 25.
  • two pressure reducing valves and two pressure increasing valves are provided for the control valve 25 of the boom cylinder 32a, and one pressure reducing valve is provided for the control valve 25 of the arm cylinder 32b.
  • a first pressure reducing valve provided in a first conduit for guiding the boom raising Pi pressure from the operation lever 26 to the control valve 25 and the boom raising Pi pressure bypassing the operation lever 26 from the gear pump 24.
  • the hydraulic shovel includes a third pressure reducing valve provided in the pipeline.
  • the proportional solenoid valve 27 of this embodiment is provided only for the control valve 25 of the boom cylinder 32a and the arm cylinder 32b, and the proportional solenoid valve 27 for the control valve 25 of the other actuators 28, 33, 32c is not exist. Therefore, the bucket cylinder 32c, the turning hydraulic motor 28, and the traveling hydraulic motor 33 are driven based on the Pi pressure output from the operation lever 26.
  • the boom cylinder 32a and the arm cylinder 32b are controlled based on the Pi pressure corrected by the proportional solenoid valve 27 in order to operate the front working device 400 according to a predetermined condition while the operation lever 26 is operated. Doing so is sometimes referred to as machine control (MC).
  • MC machine control
  • a plurality of hydraulic cylinders are set as MCs so that the front working device 400 (the bucket 407 in the present embodiment) is located on or above an arbitrarily set target plane 60 (see FIG. 5).
  • Area limit control for controlling at least one of the hydraulic cylinders 32a, 32b, 32c is possible.
  • the MC is controlled by the controller 20 to control the operation of the front work device 400 when the operation lever 26 is not operated, whereas the operation of the front work device 400 is controlled only when the operation lever 26 is operated. May be referred to as “semi-automatic control”.
  • the controller (control device) 20 has an input unit, a central processing unit (CPU) as a processor, a read-only memory (ROM) and a random access memory (RAM) as storage devices, and an output unit. .
  • the input unit converts various information input to the controller 20 so that the CPU can calculate the information.
  • the ROM is a recording medium in which a control program for executing the arithmetic processing described later and various kinds of information necessary for executing the arithmetic processing are stored.
  • the CPU executes an input unit, the ROM, and the ROM in accordance with the control program stored in the ROM. A predetermined arithmetic processing is performed on the signal taken from the RAM.
  • a command for driving the engine 21 at the target rotational speed, a command necessary for applying a command voltage to the proportional solenoid valve 27, and the like are output.
  • the storage device is not limited to the above-described semiconductor memory such as ROM and RAM, but can be replaced with a magnetic storage device such as a hard disk drive.
  • the controller 20 includes an ECU 22, a plurality of pressure sensors 41, two GNSS antennas 40, a bucket IMU 38, an arm IMU 37, a boom IMU 36, a vehicle body IMU 39, and hydraulic actuators 28, 33, 32a, 32b, A plurality of pressure sensors 42 for detecting the pressure of 32c, a plurality of speed sensors 43 for detecting the operating speed of each hydraulic actuator 28, 33, 32a, 32b, 32c, and a target surface setting device 50 are connected. ing.
  • the controller 20 calculates the position and orientation (azimuth) target plane 60 of the revolving superstructure 402 and the front working device 400 in the global coordinate system (geographic coordinate system) based on the input signals from the two GNSS antennas 40, and calculates the bucket IMU 38,
  • the attitude of the front working device 400 is calculated based on input signals from the arm IMU 37, the boom IMU 36, and the vehicle body IMU 39. That is, in the present embodiment, the GNSS antenna 40 functions as a position sensor, and the bucket IMU 38, arm IMU 37, boom IMU 36, and vehicle body IMU 39 function as posture sensors.
  • a stroke sensor is used as the speed sensor 43 of the hydraulic cylinders 32a, 32b, 32c.
  • each hydraulic cylinder 32a, 32b, 32c is provided with a bottom pressure detection sensor and a rod pressure detection sensor.
  • the pressure sensor 42 for detecting the bottom pressure of the boom cylinder 32a may be referred to as a boom bottom pressure sensor 42BBP
  • the pressure sensor 42 for detecting the rod pressure of the boom cylinder 32a may be referred to as a boom rod pressure sensor 42BRP.
  • the means and method used in calculating the vehicle body position, the attitude of the front working device 400, the pressure of each actuator, and the speed of each actuator described in this document are merely examples, and known calculation means and methods can be used. .
  • the target plane setting device 50 is an interface capable of inputting information on the target plane 60 (see FIGS. 3 and 5) (including position information and tilt angle information of each target plane).
  • the target plane setting device 50 is connected to an external terminal (not shown) that stores the three-dimensional data of the target plane defined on the global coordinate system (geographic coordinate system), and receives the target plane input from the external terminal.
  • the information is stored in the storage device in the controller 20 via the target plane setting device 50.
  • the input of the target plane via the target plane setting device 50 may be manually performed by the operator.
  • the jack-up (jack-up state) of the vehicle body 1 ⁇ / b> A means that the rear end of the traveling body 401 (the end farther from the working device 400) and the bucket 407 respectively contact the ground, and the traveling body 401 Shows a state in which the front end (the end closer to the working device 400) is floating in the air.
  • the inclination angle of the traveling body 401 (the vehicle body 1A) with respect to the ground is called a jack-up angle ⁇ .
  • the jack-up angle ⁇ is zero, the bottom surface of the traveling body 401 is in contact with the ground over the entire area.
  • the orientation of the revolving unit 402 and the traveling unit 401 may be opposite to the illustrated direction or the lateral direction depending on the working posture.
  • the inclination angle of the traveling body 401 with respect to the ground is defined as a jack-up angle ⁇ .
  • the calculation is performed on the assumption that the distance between the front idler and the sprocket of the traveling body 401 and the distance between the left and right crawler tracks are the same.
  • FIG. 4 is a block diagram (functional block diagram) showing the contents of a program executed by the controller 20.
  • the controller 20 includes a position calculation unit 740, a target surface distance calculation unit 700, a target operation speed calculation unit 710, an operation command value generation unit 720, a drive command unit 730, a cylinder pressure detection Unit 810, vehicle body pitch angle detecting unit 820, front attitude detecting unit 830, jack-up determining unit 910, jack-up angle calculating unit 920, target jack-up angle determining unit 930, and command value correction amount calculating unit 940.
  • the position calculation unit 740 calculates the position and orientation of the revolving unit 402 and the work apparatus 400 in the global coordinate system from signals (navigation signals) received by the two GNSS antennas 40.
  • the vehicle body pitch angle detection unit 820 detects and calculates a pitch angle (inclination angle) of the revolving unit 402 based on the acceleration signal and the angular velocity signal obtained from the vehicle body IMU 39 attached to the revolving unit 402.
  • the front posture detection unit 830 estimates the postures of the boom 405, the arm 406, and the bucket 407 based on the acceleration signal and the angular velocity signal obtained from the boom IMU 36, the arm IMU 37, and the bucket IMU 38.
  • the target plane distance calculation unit 700 detects the position and orientation of the revolving unit 402 and the working device 400 calculated by the position calculation unit 740, the pitch angle of the revolving unit 402 calculated by the vehicle body pitch angle detection unit 820, and detects the front attitude.
  • the posture of each of the front members 405, 406, and 407 calculated by the unit 830 and the three-dimensional shape of the target surface 60 input from the target surface setting device 50 are input.
  • the target plane distance calculation unit 700 obtains a cross-sectional view of a target plane obtained when the three-dimensional target plane 60 is cut by a plane parallel to the pivot axis of the revolving unit 402 and passing through the center of gravity of the bucket 407 from the input information.
  • a distance (target surface distance) D between the toe position of the bucket 407 and the target surface 60 is calculated in this cross section.
  • the distance D is the distance between the intersection of the perpendicular drawn from the toe of the bucket 407 to the target surface 60 and this cross section and the toe (tip) of the bucket 407.
  • the target operation speed calculation unit 710 includes a plurality of target operation speed calculation units 710 necessary to operate the working device 400 such that the toe 407a of the bucket 407 moves along the target surface 60 (that is, necessary to execute the region restriction control).
  • a target value (target operation speed) Vt of the speed of at least one of the hydraulic cylinders 32a, 32b, 32c is calculated.
  • the operator only operates the arm 406 with the operation lever 26 during the excavation work of the working device 400 (that is, the operator does not operate the boom 405 and the bucket 407).
  • the case where the bucket toe 407a is moved along the target surface 60 by correcting the velocity vector V1 generated at the bucket toe 407a by the arm operation only by the operation of the boom cylinder 32a by the MC will be described.
  • the target operation speed calculation unit 710 calculates a component of the speed vector of the bucket toe 407a perpendicular to the target surface 60 (hereinafter, a “vertical component”).
  • a vertical component a component of the speed vector of the bucket toe 407a perpendicular to the target surface 60
  • the limit value means a lower limit value, and a value smaller than the limit value is set as the limit value.
  • the speed limit vertical component V1'y is 0 when the distance D is 0, and is set so as to monotonously decrease as the distance D increases. When the distance D exceeds a predetermined value d1, - ⁇ Once set, there is virtually no limit (ie, a velocity vector of any vertical component can be output).
  • the method of determining the speed limit vertical component V1'y is not limited to the table shown in FIG. 6, but may be any method in which the speed limit vertical component V1'y monotonically decreases at least in a range from 0 to a predetermined positive value. Can be replaced if necessary.
  • the target operation speed calculation unit 710 determines the speed of each of the hydraulic cylinders 32a, 32b, and 33c (the speed of each of the hydraulic cylinders 32a, 32b, and 33c based on the operator's operation). Speed). This calculation can use, for example, a correlation table for converting the operation amount of the operation lever 26 into the cylinder speed. Then, taking into account the attitude information of the work apparatus 400 input from the front attitude detection section 830 and the pitch angle information of the vehicle body 1A input from the vehicle body pitch angle detection section 820, this hydraulic cylinder 32a, A speed vector V1 that causes the speeds of 32b and 33c to be generated at the tip of the bucket is calculated. In this embodiment, since only the arm cylinder 32b is operated by the operation lever 26, the speed vector V1 is generated on the bucket toe 407a only by the operation of the arm cylinder 32b.
  • the velocity vector V2 is generated by the MC at the bucket toe 407a, and the V2 is added to the velocity vector V1 of the bucket toe 407a. Is corrected to the target speed vertical component V1′y, and the toe speed vector of the bucket 407 is corrected to V1 ′.
  • the target operation speed calculation section 710 of the present embodiment generates the speed vector V2 only by the operation of the boom cylinder 32a (boom raising operation). Then, the target operation speed calculation unit 710 calculates the corrected target speed of each of the cylinders 32a, 32b, 32c as the target operation speed Vt.
  • the speeds (Voa, Vob, Voc) of the cylinders 32a, 32b, 32c before correction are (0, Vb1, 0), and the speed (target operation speed Vta) of the boom cylinder 32a after correction is Va1.
  • the target operation speeds (Vta, Vtb, Vtc) of the cylinders 32a, 32b, 32c are (Va1, Vb1, 0).
  • the vector V1 is input from the front attitude detector 830, and the cylinder speed information of each of the hydraulic cylinders 32a, 32b, 33c calculated from the operation signal (operation amount) input from the pressure sensor 44.
  • This is a pre-correction toe speed vector of the bucket tip calculated from the posture information and the vehicle body pitch angle information input from the vehicle body pitch angle detection unit 820. Since the direction of the vertical component of the vector V1 is the same as the direction of the target speed vertical component V1'y, and the magnitude thereof exceeds the limit value V1'y, the velocity vector V2 generated by raising the boom is added.
  • the vector V1 must be corrected so that the vertical component of the corrected bucket toe speed vector becomes V1'y.
  • the direction of the vector V2 is a tangential direction of a circle whose radius is the distance from the rotation center of the boom 405 to the bucket toe 407a, and can be calculated from the attitude of the front working device 400 at that time. Then, a vector having the calculated direction and having such a magnitude that the vertical component of the corrected vector V1 'becomes V1'y by adding to the vector V1 before correction is determined as V2.
  • the magnitude of V2 may be obtained by applying the cosine theorem using the magnitude of V1 and V1 'and the angle ⁇ between V1 and V1'.
  • the vertical component of the toe speed vector gradually approaches 0 as the bucket toe 407a approaches the target surface 60. Of the toe 407a can be prevented from entering the lower part of the toe.
  • the operation command value generation unit 720 corresponds to each of the cylinders 32a, 32b, 32c in order to operate each of the cylinders 32a, 32b, 32c at the target operation speed (Vta, Vtb, Vtc) calculated by the target operation speed calculation unit 710.
  • the correction Pi pressure (operation command value Pi) to be output to the control valve 25 is calculated.
  • Vta, Vtb, Vtc target operation speed
  • Vtc correction amount
  • the correction amount Vc may be calculated only for the target operating speed Vta of the boom cylinder 32a, but the target operating speeds Vtb and Vtc of the remaining arm cylinder 32b and the bucket cylinder 32c are not corrected. Absent.
  • the drive command unit 730 generates a control current required for driving the proportional solenoid valve 27 based on the corrected Pi pressure generated by the operation command value generation unit 720, and outputs the control current to the proportional solenoid valve 27.
  • the correction Pi pressure acts on the control valve 25, the cylinders 32a, 32b, 32c operate at the target operating speed Vt (Vta, Vtb, Vtc), and when the correction amount Vc is zero (the jack-up angle ⁇ becomes smaller).
  • the bucket toe 407a operates so as to draw a locus above the case where the correction amount Vc is zero. Therefore, when the correction amount Vc exists in the target operation speed Vta of the boom cylinder 32a, the operation is such that the jack-up angle ⁇ becomes smaller and approaches the target value ⁇ t.
  • the cylinder pressure detector 810 receives pressure signals of the bottom pressure sensor 42BBP and the rod pressure sensor 42BRP attached to the bottom hydraulic chamber and the rod hydraulic chamber of the boom cylinder 32a, respectively, and receives the bottom pressure of the boom cylinder 32a. Pbb and rod pressure Pbr are detected.
  • the jack-up determination unit 910 includes a target operation speed Vt obtained from the target operation speed calculation unit 710, cylinder pressure information (rod pressure Pbr and bottom pressure Pbb of the boom cylinder 32a) obtained from the cylinder pressure detection unit 810, and a vehicle body pitch. Based on the vehicle body pitch angle information obtained from the angle detection unit 820, it is determined whether or not the excavator 1 is in a jack-up state. Next, the details of this determination method will be described.
  • the determination whether the hydraulic excavator 1 is in the jack-up state is performed using the target operating speed Vt, the rod pressure Pbr and the bottom pressure Pbb of the boom cylinder, and the vehicle body pitch angle information.
  • the pressure of the boom cylinder 32a is higher at the bottom pressure Pbb than at the rod pressure Pbr (that is, Pbb> Pbr).
  • the thrust of the entire cylinder is determined in proportion to the pressure receiving area of the bottom hydraulic chamber and the rod hydraulic chamber, but here it is assumed that the pressure receiving area of the bottom hydraulic chamber and the rod hydraulic chamber are the same. I will explain.
  • the threshold value P1 of the differential pressure at this time is obtained from the supporting force for supporting the mass of each part constituting the hydraulic excavator 1 and the thrust of the boom cylinder 32a calculated from the bottom pressure Pbb of the boom cylinder 32a and the rod pressure Pbr.
  • the bottom pressure Pbb and the rod pressure Pbr of the boom cylinder 32a when the vehicle body 1A is actually jacked up may be measured and obtained from the differential pressure.
  • the bottom pressure at the time of jacking up may be measured in advance by an experiment, and the jack up may be determined when the bottom pressure is lower than the measured value. Note that the threshold value P1 can be set to zero.
  • the above method can correctly determine that the vehicle body 1A is jacked up in a static state.
  • the boom 405 is suddenly moved downward from a state of being stopped in the air, only the bottom pressure Pbb of the boom cylinder 32a may suddenly decrease for a short time due to the structure of the hydraulic system.
  • the bottom pressure of the boom cylinder 32a becomes smaller than the rod pressure, and the vehicle body 1A may be erroneously determined to be in the jack-up state.
  • the first judgment is that the pressure difference between the bottom side and the rod side of the boom cylinder 32a is maintained until a predetermined time T1 elapses after the boom lowering operation is input to the operation lever 26 and the lowering operation of the boom 405 is started. Is smaller than the threshold value P1, it is determined that the vehicle body 1A is not jacked up.
  • the time T1 can be determined based on the time when the bottom pressure Pbb suddenly decreases due to the boom lowering operation and the possibility of erroneous determination is measured in advance, and based on the measured time.
  • Another determination utilizes the fact that the pitch angle of the excavator 1 changes slightly when the bucket 407 touches the ground. That is, it is determined whether or not the amount of change in the vehicle body pitch angle is equal to or more than a predetermined amount (change amount threshold value) ⁇ 1 from the start of the lowering operation of the boom 405 to the elapse of the predetermined time T1. When there is a change equal to or more than the fixed amount ⁇ 1, it is determined that the vehicle body 1A is jacked up.
  • a predetermined amount change amount threshold value
  • the jack-up angle calculating section 920 calculates the jack-up angle ⁇ of the hydraulic shovel 1 based on the jack-up state information of the hydraulic shovel 1 obtained from the jack-up determining section 910 and the vehicle body pitch angle information obtained from the vehicle body pitch angle detecting section 820. Is calculated.
  • the jack-up determination unit 910 determines whether or not the vehicle body IMU (inclination angle sensor) 39 immediately before the time when the determination that the jack-up state is not made is made to the determination that the jack-up state is made.
  • a vehicle body pitch angle calculated based on a detected value is regarded as an inclination angle of the ground, and a deviation between the inclination angle and a current inclination angle is set as a jack-up angle ⁇ .
  • the shape of the ground can be measured with a stereo camera or a laser scanner and the inclination angle of the ground can be obtained, the deviation between the inclination angle and the vehicle body pitch angle can be used as the jack-up angle ⁇ .
  • the jack-up angle ⁇ can be calculated.
  • the target jack-up angle determination unit 930 determines the target jack-up angle ⁇ t of the excavator 1 based on the target operation speed Vt obtained from the target operation speed calculation unit 710 and the posture information obtained from the front posture detection unit 830. In the present embodiment, the target jack-up angle ⁇ t is changed according to the angle (posture) of the arm 406.
  • FIG. 7 shows a change in the vehicle body pitch angle when a skilled operator is excavating hard soil.
  • the jack-up angle ⁇ at the start of excavation is large and the jack-up angle ⁇ at the end of excavation is small.
  • the reason for this is that the jack-up is increased at the beginning of digging, and the operator grasps the state of the soil and feels the digging power, which affects operability.
  • no jack-up is performed in order to improve the work efficiency by enabling a prompt transition to the transport operation by the boom raising operation subsequent to the excavation operation.
  • the target jack-up angle ⁇ t of the present embodiment was set to a maximum of 6 degrees at the start of excavation, and set to 0 degrees (a state in which jack-up was not performed) at the end of excavation.
  • FIG. 9 is a diagram showing a correlation table defining a correlation between the arm angle and the target jack-up angle ⁇ t in the present embodiment.
  • the table 1 on the left in the figure is a correlation table for an arm pulling operation
  • the table 2 on the right is a correlation table for an arm pushing operation.
  • the “arm angle” indicated by the horizontal axis of each table is defined as the minimum angle of the arm 406 when the tip of the arm 406 is folded closest to the boom 405 (when the length of the arm cylinder 32b is extended to the maximum).
  • the left table in FIG. 9 defines the target jack-up angle when the pulling operation of the arm is input to the operation lever 26, and the posture of the arm 406 is such that the distal end of the arm 406 is in the vehicle body 1A.
  • the target jack-up angle ⁇ t is set to be smaller as the posture is closer (that is, as the length of the arm cylinder 32b is longer).
  • the table on the right side of FIG. 9 defines the target jack-up angle when the push operation of the arm is input to the operation lever 26, and the posture of the arm 406 is such that the distal end of the arm 406 is in the body 1A.
  • the target jack-up angle ⁇ t is set to increase as the posture is closer (that is, as the length of the arm cylinder 32b increases).
  • the arm angle can be calculated from the detection value of the arm IMU 37, and the arm cylinder length can be calculated from the detection value of the stroke sensor (speed sensor 43).
  • the two tables in FIG. 9 can calculate the target jack-up angle by using one of the arm angle and the arm cylinder length.
  • the start and end of the excavation are determined by the arm operation amount (detected value of the pressure sensor 44), the stroke information of the arm cylinder 32b obtained from the detected value of the stroke sensor (speed sensor 43), and the jack-up determination unit 910 The determination can be made by using the up state determination result.
  • the excavation operation the excavation is started in a state where the arm cylinder 32b is shortened (the working device 400 is extended), and the excavation is ended in a state where the arm cylinder 32b is extended (the working device 400 is folded) by the arm pulling operation. .
  • the target jack-up angle is obtained by linearly interpolating the target angles of the excavation start state and the excavation end state (ie, 6 degrees and 0 degrees) according to the stroke of the arm cylinder 32b. ⁇ t.
  • the command value correction amount calculation unit 940 compares the target jack-up angle information obtained from the jack-up angle determination unit 930 with the jack-up angle information obtained from the jack-up angle calculation unit 920, and calculates the hydraulic shovel from the target jack-up angle ⁇ t.
  • the actual jack-up angle (actual jack-up angle) ⁇ is large, the jack-up angle ⁇ approaches the target jack-up angle ⁇ t in accordance with the target operating speed Vt (the target operating speed Vta of the boom cylinder 32a).
  • the correction amount Vc is calculated and output to the operation command value generation section 720.
  • the correction amount Vc is set to 0 and the Pi pressure is not corrected.
  • the target operation speed Vta of the boom cylinder 32a calculated by the target operation speed calculator 710 (boom cylinder speed in the boom raising direction). What is necessary is just to operate so that the bucket 407 may be separated from the ground faster by increasing the speed. Therefore, when the actual jack-up angle ⁇ is larger than the target jack-up angle ⁇ t, the target operation speed Vt (Vta) of the boom cylinder 32a is multiplied by a constant K (Vt) as shown in Expression (1). The correction amount Vc is calculated. As a result, when the vehicle body 1A is excessively jacked up, the boom raising speed is increased, and the jackup angle ⁇ is reduced.
  • the constant value K (Vt) for increasing the boom raising speed may be obtained experimentally in advance, or determined as a variable value according to the arm operation amount, the distance from the target surface, the target operation speed Vt, and the like. May be.
  • a function K (Vt) corresponding to the target operation speed Vt is used because correction by the target operation speed Vt is necessary due to the characteristics of the hydraulic system.
  • the correction amount Vc is added to the target operation speed Vt calculated by the target operation speed calculation unit 710, and the corrected Pi pressure is calculated by the function F (Vt). Is converted.
  • the function F (Vt) is a function based on the target operation speed Vt.
  • Vc Vt ⁇ K (Vt) [Jack-up angle> Target jack-up angle] ... Equation (1)
  • Vc 0 [jack-up angle ⁇ target jack-up angle] ... Equation (2)
  • Pi (Vt + Vc) ⁇ F (Vt) ... Equation (3) ⁇ Control procedure> A processing flow executed by the controller 20 configured as described above will be described with reference to FIG.
  • the controller 20 starts the processing in FIG. 8 when the pressure sensor 44 confirms that the operation signal for pushing or pulling the arm 406 or the operation signal for lowering the boom has been output via the operation lever 26, and proceeds to step S10. Proceed to.
  • step S10 the jack-up determination unit 910 resets the time t to zero, starts measuring the time t, and proceeds to step S110.
  • step S110 the jack-up determination unit 910 determines whether the change amount of the vehicle body pitch angle within the time t is equal to or more than the predetermined amount ⁇ 1. If the vehicle body pitch angle has changed by the predetermined amount ⁇ 1 or more, it is determined that the vehicle body 1A may have been in a jack-up state due to the boom lowering operation, and the process proceeds to step S130. If there is only a change in the vehicle body pitch angle smaller than the predetermined amount ⁇ 1 within the time t, the process proceeds to step S120.
  • step S120 the jack-up determination unit 910 determines whether a predetermined time T1 has elapsed since the start of the measurement of the time t in step S10. If it is determined that the time T1 has elapsed (t> T1), the process proceeds to step S130. On the other hand, if it is determined that the time T1 has not elapsed, the process returns to step S110.
  • step S130 the jack-up determination unit 910 determines whether the difference (differential pressure) between the bottom pressure Pbb of the boom cylinder 32a and the rod pressure Pbr is smaller than a predetermined threshold value P1 (that is, Pbb-Pbr ⁇ P1). Is determined. If the differential pressure is smaller than the threshold value P1, the process proceeds to step S150. Conversely, if the differential pressure is equal to or greater than the threshold value P1, it is determined that no jack-up has occurred, and the process proceeds to step S320.
  • a predetermined threshold value P1 that is, Pbb-Pbr ⁇ P1.
  • step S130 it is preferable to perform the determination of step S130 from the start to the end of the excavation operation in the case where the process has passed through step S120. That is, if YES is determined in step S120 and NO is subsequently determined in step S130, the jack-up determination unit 910 determines the presence or absence of an arm operation based on the detection value of the pressure sensor 44, and determines whether the arm operation is performed. It is preferable to return to step S130 when the operation is continued, and to proceed to step S320 when the arm operation is completed.
  • step S150 the jack-up determination unit 910 determines that the vehicle body 1A is jacking up, and proceeds to step S160.
  • step S160 the jack-up angle calculation unit 920 stores the vehicle body pitch angle immediately before the jack-up is determined in step S150, and calculates the vehicle body pitch angle from the difference between the stored vehicle body pitch angle and the vehicle body pitch angle at that time.
  • the jack-up angle ⁇ of 1A is calculated.
  • step S210 the target jack-up angle determination unit 930 determines whether the arm operation is a pull operation based on the operation signal detected by the pressure sensor 44. If the arm operation is a pull operation, the process proceeds to step S220. If the arm operation is a push operation, the process proceeds to step S230.
  • jack-up occurs due to boom lowering (that is, when YES is determined in step S110 and YES is also determined in step S130), an operation of pulling the arm or pushing the arm is input after lowering the boom. There is no particular problem because it is normal
  • step S220 the target jack-up angle determination unit 930 determines the target jack-up angle ⁇ t according to the arm angle at that time with reference to Table 1 in FIG.
  • step S230 the target jack-up angle determination unit 930 determines the target jack-up angle ⁇ t according to the arm angle at that time with reference to Table 2 in FIG.
  • step S240 the command value correction amount calculation unit 940 determines whether the jack-up angle ⁇ calculated in step S160 is larger than the target jack-up angle ⁇ t determined in step S220 or S230. If it is larger than the target jack-up angle ⁇ t, the process proceeds to step S310. On the other hand, if it is equal to or smaller than the target jack-up angle ⁇ t, the process proceeds to step S320.
  • step S310 the command value correction amount calculation unit 940 calculates a correction amount Vc related to the speed of the boom cylinder 32a based on Expression (1), and uses the correction amount Vc, the target operating speed Vt, and Expression (3). Then, the corrected Pi pressure of the boom cylinder 32a is calculated, and the process proceeds to step S330.
  • the corrected Pi pressure is calculated from the target operating speed Vt for the speeds of the arm cylinder 32b and the bucket cylinder 32c.
  • step S320 the command value correction amount calculation unit 940 sets the correction amount Vc related to the speed of the boom cylinder 32a to zero based on Expression (2), and uses the target operation speed Vt and Expression (3) to calculate the correction value of the boom cylinder 32a.
  • the corrected Pi pressure is calculated, and the process proceeds to step S330. In this case, the correction Pi pressure is not corrected.
  • the corrected Pi pressure is calculated from the target operating speed Vt for the speeds of the arm cylinder 32b and the bucket cylinder 32c.
  • step S330 drive command section 730 calculates a control current for outputting corrected Pi pressure calculated in step S310 or S320 by proportional solenoid valve 27, and outputs the control current to corresponding proportional solenoid valve 27. Accordingly, the corresponding hydraulic cylinders 32a, 32b, 32c are driven.
  • the flow in FIG. 8 is started when an arm operation or a boom lowering operation is performed.
  • the flow may be started with only the boom lowering operation as a trigger.
  • the arm operation determination process is performed in step S210. This is because the arm operation is input before the operation is performed, and it is considered that the determination in step S210 will not be affected.
  • the target value of the jack-up angle is set to be smaller as the angle of the arm becomes smaller (that is, as the excavation operation approaches the end) in accordance with the tendency of the jack-up angle when the skilled operator excavates hard soil.
  • the actual jack-up angle is configured to semi-automatically approach the target value by the MC according to the progress of the excavation operation.
  • the excavating force can be maximized as much as possible, so that hard soil can be excavated efficiently.
  • digging can be performed at a jack-up angle equivalent to that of a skilled operator irrespective of the skill of the operator, so it can be expected that an unskilled operator can effectively dig hard soil.
  • the skilled operator can adjust the excavating force by his / her own operation in the range where the actual jack-up angle is equal to or less than the target value, so that the operability does not decrease. Therefore, according to the present embodiment, the operability of the operator in the jack-up state can be favorably maintained in the hydraulic shovel in which the area restriction control (MC) is executed.
  • MC area restriction control
  • the target jack-up angle is set to be relatively large at the start of excavation, and set at the end of excavation so that the target jack-up angle approaches zero. Since the transport operation can be started immediately, a decrease in work efficiency can be prevented.
  • the target jack-up angle ⁇ t is preferably set to be smaller as the target surface distance D becomes smaller as shown in FIG. If the vehicle body 1A is jacked up too much, the soil may suddenly become soft and may dig too much from the target surface 60, and when the excavation is completed, it may not be possible to immediately shift to the transport operation, and the work efficiency may be reduced.
  • the target jack-up angle ⁇ t is set as described above, when the target surface distance D is small and the distance between the target surface 60 and the bucket toe 407a is short, the target jack-up angle ⁇ t is set to be small and the jack-up angle to be implemented is reduced.
  • the jacking-up can increase the excavating force, which can improve the working efficiency.
  • the command value correction amount calculating section 940 calculates the correction amount Vc for the target operating speed Vt of the MC cylinder.
  • steps S10, S110, and S120 in FIG. 8 described above can be omitted.
  • the present invention is not limited to the above embodiments, and includes various modifications without departing from the gist of the present invention.
  • the present invention is not limited to one having all the configurations described in the above embodiment, but also includes one in which a part of the configuration is deleted. Further, a part of the configuration according to one embodiment can be added to or replaced by the configuration according to another embodiment.
  • control device 20 for each configuration related to the above-described control device (controller 20) and the function and execution processing of each configuration, part or all of them are implemented by hardware (for example, logic for executing each function is designed by an integrated circuit, etc.).
  • the configuration according to the above control device may be a program (software) that is read and executed by an arithmetic processing device (for example, a CPU) to realize each function according to the configuration of the control device.
  • Information relating to the program can be stored in, for example, a semiconductor memory (flash memory, SSD, etc.), a magnetic storage device (hard disk drive, etc.), a recording medium (magnetic disk, optical disk, etc.), and the like.
  • control lines and the information lines are understood to be necessary for the description of the embodiment, but all the control lines and the information lines related to the product are not necessarily required. Does not necessarily mean that In fact, it can be considered that almost all components are interconnected.
  • SYMBOLS 1 Hydraulic excavator, 20 ... Controller (control device), 21 ... Engine, 21c ... Bucket cylinder, 22 ... Engine control unit (ECU), 23 ... Hydraulic pump, 24 ... Gear pump (pilot pump), 25 ... Control valve, 26 ... operating lever (operating device), 27 ... proportional solenoid valve, 28 ... swing hydraulic motor, 32a ... boom cylinder, 32b ... arm cylinder, 32c ... bucket cylinder, 33 ... traveling hydraulic motor, 40 ... antenna, 41 ... pressure sensor, 42 ... pressure sensor, 42BBP ... boom bottom pressure sensor, 42BBP ... boom bottom pressure sensor, 43 ... speed sensor, 44 ... pressure sensor, 50 ...
  • target surface setting device 51 ... engine control dial, 60 ... target surface, 400 ... front Working device (working device), 401 ... running , 402: Revolving body, 403: Driver's seat, 405: Boom, 406: Arm, 407: Bucket, 407a: Bucket toe, 700: Target surface distance calculation unit, 710: Target operation speed calculation unit, 720: Operation command value generation Unit, 730: drive command unit, 740: position calculation unit, 810: cylinder pressure detection unit, 820: body pitch angle detection unit, 830: front attitude detection unit, 910: jack-up determination unit, 920: jack-up angle calculation unit , 930: target jack-up angle determination unit, 940: command value correction amount calculation unit

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)
  • General Life Sciences & Earth Sciences (AREA)
  • Paleontology (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Operation Control Of Excavators (AREA)
  • Component Parts Of Construction Machinery (AREA)

Abstract

操作レバー(26)が操作されている間、任意に設定された目標面(60)上またはその上方に作業装置(400)が位置するように、複数の油圧シリンダ(32)のうち少なくとも1つの油圧シリンダ(32a)を制御する領域制限制御を実行するコントローラ(20)とを備える作業機械において、コントローラは、領域制限制御の実行中に、地面に対する車体(1A)の傾斜角度であるジャッキアップ角度(φ)が予め設定された目標値(φt)より大きい場合、ジャッキアップ角度が目標値に近づくように少なくとも1つの油圧シリンダ(32a)の制御を補正する。目標値はアーム(406)の姿勢に応じて変化するように設定する。

Description

作業機械
 本発明は、構造物解体工事、道路工事、建設工事、土木工事等に使用される作業機械に関する。
 構造物解体工事、道路工事、建設工事、土木工事等に使用される作業機械として、複数のフロント部材からなる多関節型の作業装置を本体に取り付け、その各フロント部材を油圧シリンダにて駆動するものが知られている。その一例にブーム、アーム、バケット等から構成される作業装置を有する油圧ショベルがある。この種の油圧ショベルには作業装置の稼働可能な領域を設けてその範囲内で作業装置を半自動的に動作させる、いわゆるマシンコントロールを実行可能なものがある。例えば、この作業装置の稼働可能な領域と稼働不可能な領域の境界に施工目標面を設定してオペレータがアーム操作をすると、マシンコントロールによりその施工目標面に沿うように半自動的に作業装置を動作させることができる。
 油圧ショベルによるマシンコントロールを用いた掘削作業では、予め定められた条件に従ってブームやバケットが半自動的に動作する。そのため、スムーズな掘削が困難な硬い土壌を作業装置で掘削しようとした場合には、地面からバケットに作用する掘削反力が大きくなり、走行体(クローラ)において作業装置から遠い側の端部とバケットは地面に接触しているものの走行体において作業装置に近い側の端部が地面から浮上った状態、いわゆるジャッキアップ状態になり易い。
 ジャッキアップに関する技術として、特許文献1には、オペレータによるアーム閉じ操作とブーム下げ操作を含む複合操作を検知して、車体がジャッキアップしないようにブームシリンダ圧を制御する技術が開示されている。この技術では、作業機械がジャッキアップするときのブームシリンダ圧を超えないように、ブームシリンダへ供給される作動油の圧力が調整されている。
特開2014-122510号公報
 油圧ショベルがジャッキアップ状態にあるときに地面と走行体がなす角度はジャッキアップ角度と称されることがあるが、オペレータはこのジャッキアップ角度の大小により掘削力の大小を直感的に把握して掘削力を調整する場合がある。しかしながら、特許文献1に記載の技術では、常に車体がジャッキアップしないようにブームシリンダ圧が制御される。すなわち、特許文献1の技術ではオペレータの意図にかかわらずコントローラによってジャッキアップ角度は常にほぼ零に保持される。そのため、オペレータはジャッキアップ角度の大小から掘削力の状態を直感的に把握することができず、自身の操作によって掘削力を調整することが難しくなる。その結果、オペレータによっては操作性が劣る機械と判断されるおそれがある。
 本発明は上記課題を鑑みてなされたものであり、その目的は、マシンコントロールが行われる作業機械において、いわゆるジャッキアップ状態時のオペレータの操作性が良好な作業機械を提供することにある。
 本発明は、上記目的を達成するために、走行体及び旋回体からなる車体と、ブーム及びアーム及びブームを有し、前記旋回体に取り付けられた作業装置と、油圧ポンプから吐出される作動油によって駆動され、前記作業装置を動作させる複数の油圧シリンダと、オペレータの操作に応じて前記作業装置の動作を指示する操作装置と、前記操作装置が操作されている間、任意に設定された目標面上またはその上方に前記作業装置が位置するように、前記複数の油圧シリンダのうち少なくとも1つの油圧シリンダを制御する領域制限制御を実行する制御装置とを備える作業機械において、前記制御装置は、前記領域制限制御の実行中に、地面に対する前記車体の傾斜角度であるジャッキアップ角度が予め設定された目標値より大きい場合、前記ジャッキアップ角度が前記目標値に近づくように前記少なくとも1つの油圧シリンダの制御を補正し、前記目標値は、前記アームの姿勢に応じて変化するように設定するものとする。
 本発明によれば、マシンコントロールの掘削作業において、目標面を掘り過ぎることなく、操作性と作業効率を良好にできる。
本発明の実施形態に係る油圧ショベルの側面図。 図1の油圧ショベルのシステム構成図。 油圧ショベルのジャッキアップ状態を示した側面図である。 コントローラの機能構成を示す図である。 バケット爪先の軌跡補正の説明図。 制限速度垂直成分V1y’の演算テーブルを示す図。 熟練オペレータの掘削作業を分析して得られた車体ピッチ角度を示す図である。 実施形態に係る手順を示すフローチャートである。 アーム角度と目標ジャッキアップ角度φtの相関関係を示す図。 アーム角度と目標ジャッキアップ角度φtと目標面距離Dの相関関係を示す図。
 以下、本発明の実施の形態について図面を用いて説明する。 
 <対象装置>
 図1は本発明の実施の形態に係る油圧ショベルの概略構成図である。図1において,油圧ショベルは,クローラ式の走行体401と,走行体401の上部に旋回可能に取り付けられた旋回体402を備えている。走行体401は,走行油圧モータ33によって駆動される。旋回体402は,旋回油圧モータ28の発生するトルクによって駆動され,左右方向に旋回する。
 本稿では,走行体401と旋回体402を合わせて車体1Aと称することがある。走行体401は、履帯を備えたものに限定されることなく、走行輪や脚を備えたものであってもよい。
 旋回体402上には運転席403が設置され,旋回体402の前方には目標面の形成作業を行うことの可能な多関節型のフロント作業装置(作業装置)400が取り付けられている。
 フロント作業装置400は,ブームシリンダ(第1油圧アクチュエータ)32aによって駆動されるブーム405と,アームシリンダ(第2油圧アクチュエータ)32bによって駆動されるアーム406と,バケットシリンダ32cによって駆動されるバケット407とを備える。ブームシリンダ32a,アームシリンダ32b,バケットシリンダ32cはそれぞれ油圧ポンプ23から吐出される作動油によって駆動され,作業装置400を動作させる。本稿では,ブーム405,アーム406,バケット407をそれぞれフロント部材と称することがある。
 またフロント作業装置400は,バケット407とバケットシリンダ32cの先端部を連結する第1リンク407Bと、アーム406とバケットシリンダ32cの先端部を連結する第2リンク407Cとを備えている。バケットシリンダ(油圧シリンダ)32cは、第2リンク407Cとアーム406に連結されている。
 なお、バケット407は、グラップル、ブレーカ、リッパ、マグネット等の図示しない作業具に任意に交換可能である。
 ブーム405とアーム406には、それぞれ、所定の面(例えば水平面)に対するブーム405とアーム406の姿勢(傾斜角)を検出するためのブームIMU(IMU:Inertial Measurement Unit(慣性計測装置))36とアームIMU37が取り付けられている。第2リンク407Cには、同じく所定の面(例えば水平面)に対するバケット407の姿勢(傾斜角)を検出するためのバケットIMU38が備えられている。これらIMU36,37,38は、それぞれ角速度センサと加速度センサから構成されており,傾斜角の演算も可能である。
 運転席403には,オペレータの操作に応じてフロント作業装置400,旋回体402及び走行体401の動作を指示する操作レバー(操作装置)26と,エンジン21(図2参照)の目標回転数を指令するエンジンコントロールダイヤル51(図2参照)が設置されている。操作レバー26は,ブームシリンダ32a,アームシリンダ32b,バケットシリンダ32c,走行油圧モータ33及び旋回油圧モータ28に対する制御信号(ギヤポンプ24(図2参照)から出力されるパイロット圧(以下では「Pi圧」とも称する))を操作方向及び操作量に応じて発生し,その制御信号によりブーム405,アーム406,バケット407,旋回体402及び走行体401を動作させる。
 操作レバー26の出力するPi圧は圧力センサ44によって検出されており,圧力センサ44はその検出値をコントローラ20に出力している。圧力センサ44の検出値はコントローラ20において操作レバー26の操作量,操作方向,操作対象の検出に利用されている。すなわち圧力センサ44は操作レバー26への操作入力量を検出する操作量センサとして機能している。圧力センサ44は,コントロールバルブの2倍の数が存在している。なお,操作レバー26は電気式によるものでもよい。この場合の操作レバー26による操作量,操作方向,操作対象の検出は,操作レバー26の傾倒量(操作量)を検出する操作量センサにより構成する。操作量センサは、オペレータが操作レバー26を倒す量を検出することで、オペレータが作業装置400に要求する動作速度をそれぞれ電気信号に変換することができる。
 図2は図1の油圧ショベルのシステム構成図である。本実施形態の油圧ショベルは,エンジン21と,エンジン21を制御するためのコントローラ(制御装置)であるエンジンコントロールユニット(ECU)22と,エンジン21の出力軸に機械的に連結されエンジン21によって駆動される油圧ポンプ23及びギヤポンプ(パイロットポンプ)24と,ギヤポンプ24から吐出される圧油を操作量に応じて減圧したものを,各油圧アクチュエータ28,33,32a,32b,32cの制御信号として比例電磁弁27を介してコントロールバルブ25に出力する操作レバー26と,油圧ポンプ23から各油圧アクチュエータ28,33,32a,32b,32cに導入される作動油の流量及び方向を,操作レバー26又は比例電磁弁27から出力される制御信号(パイロット圧(以下ではPi圧と称することがある))に基づいて制御する複数のコントロールバルブ25と,各コントロールバルブ25に作用するPi圧の圧力値を検出する複数の圧力センサ41と,フロント作業装置400の位置・姿勢及びその他の車体情報に基づいて補正Pi圧を算出し,その補正Pi圧が発生可能な指令電圧を比例電磁弁27に出力するコントローラ(制御装置)20と,フロント作業装置400の作業対象の目標形状である目標面の情報をコントローラ20に入力するための目標面設定装置50を備えている。
 油圧ポンプ23は,各油圧アクチュエータ28,33,32a,32b,32cの目標出力(後述)の通りに車体が動作するよう,機械的にトルク・流量が制御されている。
 コントロールバルブ25は,制御対象の油圧アクチュエータ28,33,32a,32b,32cと同数存在するが,図2ではそれらをまとめて1つで示している。各コントロールバルブには,その内部のスプールを軸方向の一方又は他方に移動させる2つのPi圧が作用している。例えば,ブームシリンダ32a用のコントロールバルブ25には,ブーム上げのPi圧と,ブーム下げのPi圧が作用する。
 圧力センサ41は,各コントロールバルブ25に作用するPi圧を検出するもので,コントロールバルブの2倍の数が存在している。圧力センサ41は,コントロールバルブ25の直下に設けられており,実際にコントロールバルブ25に作用するPi圧を検出している。
 比例電磁弁27は複数存在するが,図2中ではまとめて1つのブロックで示している。比例電磁弁27は2種類ある。1つは,操作レバー26から入力されるPi圧をそのまま出力又は指令電圧で指定される所望の補正Pi圧まで減圧して出力する減圧弁で,もう1つは,操作レバー26の出力するPi圧より大きなPi圧が必要な場合にギヤポンプ24から入力されるPi圧を指令電圧で指定される所望の補正Pi圧まで減圧して出力する増圧弁である。或るコントロールバルブ25に対するPi圧に関して,操作レバー26から出力されているPi圧より大きなPi圧が必要な場合には増圧弁を介してPi圧を生成し,操作レバー26から出力されているPi圧より小さなPi圧が必要な場合には減圧弁を介してPi圧を生成し,操作レバー26からPi圧が出力されていない場合には増圧弁を介してPi圧を生成する。つまり,減圧弁と増圧弁により,操作レバー26から入力されるPi圧(オペレータ操作に基づくPi圧)と異なる圧力値のPi圧をコントロールバルブ25に作用させることができ,そのコントロールバルブ25の制御対象の油圧アクチュエータに所望の動作をさせることができる。
 1つのコントロールバルブ25につき,減圧弁と増圧弁はそれぞれ最大で2つ存在し得る。本実施形態では,ブームシリンダ32aのコントロールバルブ25用に2つの減圧弁と2つの増圧弁が設けられており,アームシリンダ32bのコントロールバルブ25用に1つの減圧弁が設けられている。具体的には,ブーム上げのPi圧を操作レバー26からコントロールバルブ25に導く第1管路に設けられた第1減圧弁と,ブーム上げのPi圧をギヤポンプ24から操作レバー26を迂回してコントロールバルブ25に導く第2管路に設けられた第1増圧弁と,ブーム下げのPi圧を操作レバー26からコントロールバルブ25に導く第3管路に設けられた第2減圧弁と,ブーム下げのPi圧をギヤポンプ24から操作レバー26を迂回してコントロールバルブ25に導く第4管路に設けられた第2増圧弁と,アームクラウドのPi圧を操作レバー26からコントロールバルブ25に導く第5管路に設けられた第3減圧弁とを油圧ショベルは備えている。
 本実施形態の比例電磁弁27は,ブームシリンダ32aとアームシリンダ32bのコントロールバルブ25用に設けられているのみであり,他のアクチュエータ28,33,32cのコントロールバルブ25用の比例電磁弁27は存在しない。したがって,バケットシリンダ32c,旋回油圧モータ28及び走行油圧モータ33は,操作レバー26から出力されるPi圧に基づいて駆動される。
 なお,本稿では,ブームシリンダ32aとアームシリンダ32bのコントロールバルブ25に入力されるPi圧(ブーム及びアームに対する制御信号)は全て「補正Pi圧」(又は補正制御信号)と称し,比例電磁弁27によるPi圧の補正の有無は問わないものとする。
 また,本稿では,操作レバー26の操作中にフロント作業装置400を予め定められた条件に従って動作させるために,比例電磁弁27によって補正されたPi圧に基づいてブームシリンダ32aやアームシリンダ32bを制御することをマシンコントロール(Machine Control:MC)と称することがある。例えば本実施形態ではMCとして,任意に設定された目標面60(図5参照)上又はその上方の領域にフロント作業装置400(本実施形態ではバケット407)が位置するように,複数の油圧シリンダ32a,32b,32cのうち少なくとも1つの油圧シリンダを制御する領域制限制御が可能である。また,本稿ではMCを,操作レバー26の非操作時にフロント作業装置400の動作をコントローラ20により制御する「自動制御」に対して,操作レバー26の操作時にのみフロント作業装置400の動作をコントローラ20により制御する「半自動制御」と称することがある。
 コントローラ(制御装置)20は,入力部と,プロセッサである中央処理装置(CPU)と,記憶装置であるリードオンリーメモリ(ROM)及びランダムアクセスメモリ(RAM)と,出力部とを有している。入力部は,コントローラ20に入力される各種情報を,CPUが演算可能なように変換する。ROMは,後述する演算処理を実行する制御プログラムと,当該演算処理の実行に必要な各種情報等が記憶された記録媒体であり,CPUは,ROMに記憶された制御プログラムに従って入力部及びROM,RAMから取り入れた信号に対して所定の演算処理を行う。出力部からは,エンジン21を目標回転数で駆動するための指令や,比例電磁弁27に指令電圧を作用させるために必要な指令等が出力される。なお,記憶装置は上記のROM及びRAMという半導体メモリに限られず,例えばハードディスクドライブ等の磁気記憶装置に代替可能である。
 コントローラ20には,ECU22と,複数の圧力センサ41と,2本のGNSSアンテナ40と,バケットIMU38と,アームIMU37と,ブームIMU36と,車体IMU39と,各油圧アクチュエータ28,33,32a,32b,32cの圧力を検出するための複数の圧力センサ42と,各油圧アクチュエータ28,33,32a,32b,32cの動作速度を検出するための複数の速度センサ43と,目標面設定装置50が接続されている。
 コントローラ20は,2本のGNSSアンテナ40から入力信号に基づいてグローバル座標系(地理座標系)における旋回体402及びフロント作業装置400の位置及び向き(方位)目標面60を算出し,バケットIMU38,アームIMU37,ブームIMU36および車体IMU39からの入力信号に基づいてフロント作業装置400の姿勢を算出する。つまり,本実施形態では,GNSSアンテナ40は位置センサとして機能し,バケットIMU38,アームIMU37,ブームIMU36および車体IMU39は姿勢センサとして機能している。
 本実施形態では,油圧シリンダ32a,32b,32cの速度センサ43として,ストロークセンサを利用している。また,油圧シリンダ32a,32b,32cの圧力センサ42として,各油圧シリンダ32a,32b,32cにボトム圧検出センサとロッド圧検出センサを備えている。ここでは,ブームシリンダ32aのボトム圧を検出する圧力センサ42をブームボトム圧センサ42BBPと,ブームシリンダ32aのロッド圧を検出する圧力センサ42をブームロッド圧センサ42BRPと称することがある。
 なお,本稿で説明する車体位置,フロント作業装置400の姿勢,各アクチュエータの圧力,各アクチュエータの速度の算出に際して利用する手段・方法は一例に過ぎず,公知の算出手段・方法が利用可能である。
 目標面設定装置50は,目標面60(図3,5参照)に関する情報(各目標面の位置情報や傾斜角度情報を含む)を入力可能なインターフェースである。目標面設定装置50は,グローバル座標系(地理座標系)上に規定された目標面の3次元データを格納した外部端末(図示せず)と接続され,その外部端末から入力される目標面の情報が目標面設定装置50を介してコントローラ20内の記憶装置に格納される。なお,目標面設定装置50を介した目標面の入力は,オペレータが手動で行っても良い。
 <ジャッキアップ>
 図3に示すように、車体1Aのジャッキアップ(ジャッキアップ状態)とは,走行体401の後端(作業装置400から遠い方の端部)とバケット407がそれぞれ地面に接地し、走行体401の前端(作業装置400に近い方の端部)が空中に浮きがっている状態を示す。このとき、地面に対する走行体401(車体1A)の傾斜角度をジャッキアップ角度φと言う。ジャッキアップ角度φが零の場合は、走行体401の底面が全域にわたって接地している状態である。
 なお,旋回体402は走行体401に対して旋回可能であるため、作業姿勢によっては旋回体402と走行体401の向きが図示と逆方向や横方向になることがある。この場合も地面に対する走行体401の傾斜角度をジャッキアップ角度φと定義する。本実施形態では演算を簡易にするため、走行体401のフロントアイドラとスプロケットの距離、および左右の履帯の距離は同一距離であるとして仮定して演算を行った。
 <コントローラ>
 図4はコントローラ20によって実行されるプログラムの内容をブロックで示した図(機能ブロック図)である。この図に示すように、コントローラ20は、位置演算部740と、目標面距離演算部700と、目標動作速度演算部710と、動作指令値生成部720と、駆動指令部730と、シリンダ圧検出部810と、車体ピッチ角度検出部820と、フロント姿勢検出部830と、ジャッキアップ判定部910と、ジャッキアップ角度演算部920と、目標ジャッキアップ角度決定部930と、指令値補正量演算部940として機能する。
 位置演算部740は,コントローラ20は、2本のGNSSアンテナ40が受信した信号(航法信号)からグローバル座標系における旋回体402及び作業装置400の位置と方位を演算する。
 車体ピッチ角度検出部820は、旋回体402に取り付けられた車体IMU39から得られる加速度信号と角速度信号に基づいて旋回体402のピッチ角度(傾斜角)を検出・演算する。
 フロント姿勢検出部830は、ブームIMU36、アームIMU37及びバケットIMU38から得られる加速度信号と角速度信号に基づいて、ブーム405、アーム406、バケット407の姿勢をそれぞれ推定する。
 目標面距離演算部700は、位置演算部740で演算された旋回体402及び作業装置400の位置及び方位と、車体ピッチ角度検出部820で演算された旋回体402のピッチ角度と、フロント姿勢検出部830で演算された各フロント部材405,406,407の姿勢と、目標面設定装置50から入力される目標面60の3次元形状とを入力する。目標面距離演算部700は、これらの入力情報から旋回体402の旋回軸に平行でバケット407の重心を通る平面で3次元形状の目標面60を切断したときに得られる目標面の断面図(2次元形状)を作成し,この断面においてバケット407の爪先位置と目標面60の距離(目標面距離)Dを算出する。距離Dは,バケット407の爪先から目標面60に下ろした垂線とこの断面の交点とバケット407の爪先(先端)との距離とする。
 目標動作速度演算部710は、目標面60に沿ってバケット407の爪先407aが移動するように作業装置400を動作させるために必要な(すなわち領域制限制御を実行するために必要な)、複数の油圧シリンダ32a,32b,32cのうちの少なくとも1つの油圧シリンダの速度の目標値(目標動作速度)Vtを演算する。本実施形態では説明を簡単にするために,作業装置400の掘削作業に際してオペレータは操作レバー26でアーム406を操作するのみとし(すなわち、オペレータはブーム405とバケット407の操作は行わないものとし)、そのアーム操作によりバケット爪先407aに生じる速度ベクトルV1をMCによるブームシリンダ32aの動作のみで補正することでバケット爪先407aを目標面60に沿って移動させる場合を例に挙げて説明する。
 まず、目標動作速度演算部710は、目標面距離演算部700で演算した距離Dと図6のテーブルを基にバケット爪先407aの速度ベクトルの目標面60に垂直な成分(以下,「垂直成分」と略する)の制限値(制限速度垂直成分)V1’yを算出する。ここにおける制限値とは下限値の意味であり,制限値より小さい値は制限値に設定される。制限速度垂直成分V1’yは,距離Dが0のとき0であり,距離Dの増加に応じて単調に減少するように設定されており,距離Dが所定の値d1を越えると-∞に設定されて実質的に制限が掛からなくなる(すなわち任意の垂直成分の速度ベクトルを出力できる)。制限速度垂直成分V1’yの決め方は図6のテーブルに限らず,少なくとも距離Dが0から所定の正の値に至るまでの範囲で,制限速度垂直成分V1’yが単調減少するものであれば,代替可能である。
 次に目標動作速度演算部710は、圧力センサ44から入力される操作信号(操作量)に基づいて各油圧シリンダ32a,32b,33cの速度(オペレータ操作に基づく各油圧シリンダ32a,32b,33cの速度)を演算する。この演算は例えば操作レバー26の操作量をシリンダ速度に変換する相関テーブルを使うこと可能である。そして,この速度に,フロント姿勢検出部830から入力される作業装置400の姿勢情報と、車体ピッチ角度検出部820から入力される車体1Aのピッチ角度情報とを考慮して,各油圧シリンダ32a,32b,33cの速度がバケット爪先に発生させる速度ベクトルV1を演算する。本実施形態では、操作レバー26によってアームシリンダ32bだけが操作されているので、そのアームシリンダ32bの動作だけでバケット爪先407aに速度ベクトルV1が生じている。
 図5に示すように,本実施形態では,バケット爪先407aにMCで速度ベクトルV2を発生させ、そのV2をバケット爪先407aの速度ベクトルV1に加えることで,バケット407の爪先の速度ベクトルの垂直成分が目標速度垂直成分V1’yに保持されるようにバケット407の爪先の速度ベクトルを補正してV1’とする。本実施形態の目標動作速度演算部710は,この速度ベクトルV2をブームシリンダ32aの動作(ブーム上げ動作)だけで発生させる。そして、目標動作速度演算部710は、補正後の各シリンダ32a,32b,32cの目標速度を目標動作速度Vtとして算出する。本実施形態では,補正前の各シリンダ32a,32b,32cの速度(Voa,Vob,Voc)を(0,Vb1,0)とし、補正後のブームシリンダ32aの速度(目標動作速度Vta)をVa1とすると、各シリンダ32a,32b,32cの目標動作速度(Vta,Vtb,Vtc)は(Va1,Vb1,0)となる。
 図5の場合において,ベクトルV1は,圧力センサ44から入力される操作信号(操作量)から演算される各油圧シリンダ32a,32b,33cのシリンダ速度情報と,フロント姿勢検出部830から入力される姿勢情報と、車体ピッチ角度検出部820から入力される車体ピッチ角度情報とから算出される補正前のバケット爪先の速度ベクトルである。このベクトルV1の垂直成分は目標速度垂直成分V1’yと方向が同じで,その大きさが制限値V1’yの大きさを超えているので,ブーム上げで発生する速度ベクトルV2を加えて,補正後のバケット爪先速度ベクトルの垂直成分がV1’yとなるようにベクトルV1を補正しなければならない。ベクトルV2の方向は,ブーム405の回動中心からバケット爪先407aまでの距離を半径とする円の接線方向であり,そのときのフロント作業装置400の姿勢から算出できる。そして,この算出した方向を有するベクトルであって,補正前のベクトルV1に加えることで補正後のベクトルV1’の垂直成分がV1’yになるような大きさを有するベクトルをV2として決定する。なお,V2の大きさは,V1とV1’の大きさと,V1とV1’のなす角θを用いて余弦定理を適用することにより求めても良い。
 図6のテーブルのように爪先速度ベクトルの目標速度垂直成分V1’yを決定すると,バケット爪先407aが目標面60に近づくにつれて,爪先速度ベクトルの垂直成分が徐々に0に近づくので,目標面60の下方に爪先407aが侵入することを防止できる。
 動作指令値生成部720は、各シリンダ32a,32b,32cを目標動作速度演算部710で演算した目標動作速度(Vta,Vtb,Vtc)で動作させるために、各シリンダ32a,32b,32cに対応するコントロールバルブ25に出力すべき補正Pi圧(動作指令値Pi)を演算する。ただし、指令値補正量演算部940が指令する補正量(補正動作速度)Vcがある場合にはこれを目標動作速度Vtに加算して補正Pi圧を算出する(後述の式(3)参照)。本実施形態ではブームシリンダ32aの目標動作速度Vtaに対してのみ補正量Vcが演算されることがあるが、残りのアームシリンダ32b,バケットシリンダ32cの目標動作速度Vtb,Vtcは補正されることはない。
 駆動指令部730は、動作指令値生成部720が生成した補正Pi圧に基づき、比例電磁弁27の駆動に必要な制御電流を生成し、その制御電流を比例電磁弁27に出力する。これによりコントロールバルブ25に補正Pi圧が作用して各シリンダ32a,32b,32cが目標動作速度Vt(Vta,Vtb,Vtc)で動作して、補正量Vcが零の場合(ジャッキアップ角度φが目標値φt以下の場合)にはバケット爪先407aが目標面60に沿って動作し,ブームシリンダ32aの目標動作速度Vtaに補正量Vcが存在する場合(ジャッキアップ角度φが目標値φtより大きい場合)には補正量Vcが零の場合よりもバケット爪先407aが上方で軌跡を描くように動作する。そのためブームシリンダ32aの目標動作速度Vtaに補正量Vcが存在する場合にはジャッキアップ角度φが小さくなって目標値φtに近づくような動作となる。
 シリンダ圧検出部810は、ブームシリンダ32aのボトム側の油圧室とロッド側の油圧室にそれぞれ取り付けられたボトム圧センサ42BBPとロッド圧センサ42BRPの圧力信号を入力して,ブームシリンダ32aのボトム圧Pbbとロッド圧Pbrを検出する。
 <ジャッキアップの判定方法>
 ジャッキアップ判定部910は、目標動作速度演算部710から得られる目標動作速度Vtと、シリンダ圧検出部810から得られるシリンダ圧情報(ブームシリンダ32aのロッド圧Pbrとボトム圧Pbb)と、車体ピッチ角度検出部820から得られる車体ピッチ角度情報とに基づいて、油圧ショベル1がジャッキアップ状態にあるか否かを判定する。次にこの判定方法の詳細について説明する。
 油圧ショベル1がジャッキアップ状態であるか否かの判定は、目標動作速度Vtと、ブームシリンダのロッド圧Pbrとボトム圧Pbb、車体ピッチ角度情報を用いて行う。車体1Aがジャッキアップしていないとき、作業装置400の自重はブームシリンダ32aにより支えられている。そのため、ブームシリンダ32aの圧力はボトム圧Pbbの方がロッド圧Pbrよりも高くなっている(すなわち、Pbb>Pbr)。ただし、厳密にはボトム側油圧室とロッド側油圧室の受圧面積に比例してシリンダ全体の推力が決定するが、ここではボトム側油圧室とロッド側油圧室の受圧面積は同じであると仮定して説明する。
 一方で車体1Aがジャッキアップしているときは、旋回体402と走行体401の自重の一部を作業装置400が支えるため、ブームシリンダ32aの圧力はボトム圧Pbbの方がロッド圧Pbrよりも低くなる(すなわち、Pbb<Pbr)。そこで、ブームシリンダ32aにおけるボトム側とロッド側の差圧が所定のしきい値(圧力閾値)P1より小さければ(すなわち、Pbb-Pbr<P1)、車体1Aはジャッキアップ状態であると判断することができる。
 このときの差圧のしきい値P1は、油圧ショベル1を構成する各部分の質量を支える支持力と、ブームシリンダ32aのボトム圧Pbbとロッド圧Pbrから計算されるブームシリンダ32aの推力により求めることもできるし、実際に車体1Aをジャッキアップさせたときのブームシリンダ32aのボトム圧Pbbとロッド圧Pbrを測定し、その差圧から求めても構わない。また、ジャッキアップするときのボトム圧を実験により予め計測しておき、その計測値よりもボトム圧が低下したことをもってジャッキアップと判定してもよい。なお,しきい値P1は零に設定することも可能である。
 ところで、上記方法は、静的状態であれば車体1Aがジャッキアップしていることを正しく判定することができる。しかし、ブーム405を空中で静止させた状態から下方に急動作させると、油圧システムの構造上、ブームシリンダ32aのボトム圧Pbbのみがわずかな時間、急激に低下することがある。その結果、ブームシリンダ32aのボトム圧がロッド圧よりも小さくなり、車体1Aがジャッキアップ状態であると誤判定することがある。
 そこで、本実施形態の実機への適用に際しては、誤判定を回避する観点から以下の2つの判断を追加することが好ましい。
 ひとつめの判断は、操作レバー26にブーム下げ操作が入力されてブーム405の下げ動作が開始してから所定の時間T1が経過するまでの間はブームシリンダ32aのボトム側とロッド側の差圧がしきい値P1より小さくても車体1Aがジャッキアップしていないと判断することである。時間T1は、ブーム下げ動作によりボトム圧Pbbが急減に低下して誤判定の可能性がある時間を予め計測しておき、その計測した時間を基に定めることができる。
 もうひとつの判断は、バケット407が地面に接地すると油圧ショベル1のピッチ角度が僅かに変化することを利用する。すなわち、ブーム405の下げ動作が開始してから所定の時間T1が経過するまでの間に、車体ピッチ角度の変化量が所定量(変化量しきい値)θ1以上あったか否かを判定し,所定量θ1以上の変化があった場合には、車体1Aがジャッキアップしていると判断することである。
 以上の2つの判断を追加することにより、車体1Aがジャッキアップ状態にあるか否かを正確に判断することができる。
 ジャッキアップ角度演算部920は、ジャッキアップ判定部910から得られる油圧ショベル1のジャッキアップ状態情報と、車体ピッチ角度検出部820から得られる車体ピッチ角度情報に基づき、油圧ショベル1のジャッキアップ角度φを演算する。ジャッキアップ角度φの演算方法としては,例えば,ジャッキアップ判定部910における判定がジャッキアップ状態でないという判定からジャッキアップ状態であるという判定に変わった時刻の直前における車体IMU(傾斜角センサ)39の検出値に基づいて演算された車体ピッチ角を地面の傾斜角とみなし,その傾斜角と現在の傾斜角との偏差をジャッキアップ角度φとする方法がある。また,ステレオカメラやレーザースキャナなどで地面の形状が計測でき地面の傾斜角を取得可能な場合には,その傾斜角と車体ピッチ角度の偏差をジャッキアップ角度φとすることができる。目標面設定装置50に最新の地面の形状の3次元データが格納されている場合も同様にジャッキアップ角度φを演算できる。
 <操作分析による目標ジャッキアップ角度の検討>
 目標ジャッキアップ角度決定部930では、目標動作速度演算部710から得られる目標動作速度Vtと、フロント姿勢検出部830から得られる姿勢情報に基づいて油圧ショベル1の目標ジャッキアップ角度φtを決定する。本実施形態では、アーム406の角度(姿勢)に応じて目標ジャッキアップ角度φtを変化させる構成とした。
 図7は熟練オペレータが硬い土壌を掘削しているときの車体ピッチ角の変化を示す。この図に示すように、硬い土壌を掘削するときの熟練オペレータの掘削動作では、掘り始めのジャッキアップ角度φが大きく、掘り終わるときのジャッキアップ角度φが小さいことが分かっている。この理由として、掘り始めはジャッキアップを大きくさせてオペレータが土壌の状態を把握し、掘削力を感じられることが操作性に影響するためである。一方で掘り終わりでは、掘削動作に後続するブーム上げ操作による運搬動作に速やかに移行可能にして作業効率を良くするため、ジャッキアップしていない。これに倣い本実施形態の目標ジャッキアップ角度φtは、掘削開始時に最大6度とし、掘削終了時は0度(ジャッキアップしていない状態)とした。
 また、掘削動作はアーム引きとアーム押しの2つの操作によって行われる。そこで、本実施形態では、アーム引き操作により掘削が行われる場合と、アーム押し操作により掘削が行われる場合の2つの場合に分けて、アーム角度と目標ジャッキアップ角度φtの相関関係を規定した相関テーブルを記憶している。図9は本実施形態におけるアーム角度と目標ジャッキアップ角度φtの相関関係を規定した相関テーブルを示す図である。図中左のテーブル1はアーム引き操作の場合の相関テーブルで、同右のテーブル2はアーム押し操作の場合の相関テーブルである。各テーブルの横軸が示す「アーム角度」とは、アーム406の先端をブーム405に最も近づけて折り畳んだとき(アームシリンダ32bの長さが最大まで伸長したとき)のアーム406の角度を最小とし、アーム406の先端をブーム405から最も離して伸ばしたとき(アームシリンダ32bの長さが最小まで短縮したとき)のアーム406の角度を最大としている。つまり、図9の左のテーブルは、操作レバー26にアームの引き操作が入力されている場合の目標ジャッキアップ角度を規定するものであり、アーム406の姿勢がアーム406の先端部が車体1Aに近い姿勢であるほど(すなわち、アームシリンダ32bの長さが伸びるほど)、目標ジャッキアップ角度φtが小さくなるように設定されている。一方、図9の右のテーブルは、操作レバー26にアームの押し操作が入力されている場合の目標ジャッキアップ角度を規定するものであり、アーム406の姿勢がアーム406の先端部が車体1Aに近い姿勢であるほど(すなわち、アームシリンダ32bの長さが伸びるほど)、目標ジャッキアップ角度φtが大きくなるように設定されている。なお、アーム角度はアームIMU37の検出値から演算可能であり、アームシリンダ長さはストロークセンサ(速度センサ43)の検出値から演算可能である。図9の2つのテーブルは、いずれも、アーム角度とアームシリンダ長さのいずれか一方を利用することで目標ジャッキアップ角度を演算できる。
 ところで、掘削の開始と終了の判定は、アーム操作量(圧力センサ44の検出値)、ストロークセンサ(速度センサ43)の検出値から得られるアームシリンダ32bのストローク情報、ジャッキアップ判定部910によるジャッキアップ状態判定結果を用いることで判定できる。掘削動作の場合、アームシリンダ32bが短縮した(作業装置400を伸ばした)状態から掘削を開始し、アーム引き動作によってアームシリンダ32bが伸長した(作業装置400を畳んだ)状態で掘削を終了する。そこで、アーム引き操作があり、かつアームシリンダ32bが短縮した状態でジャッキアップと判定された場合には、掘削開始状態(掘り始め)であると判定できる。また、アーム引き操作が継続し、アームシリンダ32bが伸長すると掘削終了状態(掘り終わり)と判定できる。なお、図9における掘削開始と終了の中間領域では、アームシリンダ32bのストロークに応じて掘削開始状態と掘削終了状態の目標角度(すなわち、6度と0度)を線形補間して目標ジャッキアップ角度φtとした。
 <補正量Vcの求め方>
 指令値補正量演算部940では、ジャッキアップ角度決定部930から得られる目標ジャッキアップ角度情報と、ジャッキアップ角度演算部920から得られるジャッキアップ角度情報を比較し、目標ジャッキアップ角度φtより油圧ショベル1の実際のジャッキアップ角度(実ジャッキアップ角度)φが大きい場合には、ジャッキアップ角度φが目標ジャッキアップ角度φtに近づくように目標動作速度Vt(ブームシリンダ32aの目標動作速度Vta)に応じた補正量Vcを演算して動作指令値生成部720に出力する。反対に実際のジャッキアップ角度φが目標ジャッキアップ角度φt以下の場合には補正量Vcを0としてPi圧の補正は行わない。次に補正量Vcの具体的な求め方について説明する。
 目標ジャッキアップ角度φtより実際のジャッキアップ角度φが大きい場合、目標動作速度Vtを補正する。このときの補正量Vcの求め方を、オペレータ操作に基づくアーム引きとMCによるブーム上げの複合動作により行われる掘削動作を例にして説明する。
 掘削中のジャッキアップ角度φを小さくすることで目標ジャッキアップ角度φtに近づけるためには、目標動作速度演算部710で演算されたブームシリンダ32aの目標動作速度Vta(ブーム上げ方向のブームシリンダ速度)よりも速度を大きくしてバケット407を地面からより早く離すように動作させれば良い。そこで、目標ジャッキアップ角度φtより実際のジャッキアップ角度φが大きい場合には、式(1)に示すようにブームシリンダ32aの目標動作速度Vt(Vta)をK(Vt)によって定数倍することで補正量Vcを演算する。これにより、車体1Aがジャッキアップし過ぎた場合はブーム上げ速度が速くなるため、ジャッキアップ角度φが小さくなる。
 一方、目標ジャッキアップ角度φtがジャッキアップ角度φ以下の場合には、目標動作速度Vt(Vta)を補正しないため、式(2)に示すようにVc=0とする。
 ブーム上げ速度を大きくするための定数値K(Vt)は、予め実験的に求めても良いし、アーム操作量や目標面との距離、目標動作速度Vtなどに応じて可変的な値として決めても良い。本実施形態では、油圧システムの特性上、目標動作速度Vtによる補正が必要だったため、目標動作速度Vtに応じた関数K(Vt)を用いた。
 動作指令値生成部720において、式(3)に示すように、補正量Vcは、目標動作速度演算部710で演算された目標動作速度Vtに加算され、関数F(Vt)により補正Pi圧へ変換される。関数F(Vt)は目標動作速度Vtによる関数である。
Vc= Vt × K(Vt) [ジャッキアップ角度>目標ジャッキアップ角度]
  ・・・式(1)
Vc= 0         [ジャッキアップ角度≦目標ジャッキアップ角度]
  ・・・式(2)
Pi =(Vt+Vc) × F(Vt)  
  ・・・式(3)
 <制御手順>
 上記のように構成されるコントローラ20によって実行される処理フローについて図8を用いて説明する。
 コントローラ20は、アーム406の押し若しくは引きの操作信号またはブーム下げの操作信号が操作レバー26を介して出力されたことが圧力センサ44で確認された場合に図8の処理を開始してステップS10に進む。
 ステップS10では、ジャッキアップ判定部910は、時間tを零にリセットするとともに、時間tの計測を開始してステップS110に進む。
 ステップS110では、ジャッキアップ判定部910は、時間t内において車体ピッチ角度の変化量が所定量θ1以上か否かを判定する。所定量θ1以上の車体ピッチ角度変化があった場合には、車体1Aはブーム下げ操作によりジャッキアップ状態になった可能性があると判定してステップS130に進む。時間t内で所定量θ1より小さい車体ピッチ角度変化しかなかった場合にはステップS120へ進む。
 ステップS120では、ジャッキアップ判定部910は、ステップS10で時間tの計測を開始してから所定の時間T1が経過したか否かを判定する。ここで時間T1が経過したと判定された場合(t>T1)にはステップS130へ進む。一方、時間T1はまだ経過していないと判定された場合にはステップS110へ戻る。
 ステップS130では、ジャッキアップ判定部910は、ブームシリンダ32aのボトム圧Pbbとロッド圧Pbrの差(差圧)が所定のしきい値P1より小さいか否か(すなわち、Pbb-Pbr<P1が成立するか否か)について判定する。この差圧がしきい値P1より差圧が小さい場合には、ステップS150へ進む。反対にこの差圧がしきい値P1以上の場合には、ジャッキアップは発生していないと判断してステップS320へ進む。
 なお、ステップS120を経由してきた場合におけるステップS130の判定は掘削動作の開始から終了まで行うことが好ましい。すなわち、ステップS120でYESと判定され、その後にステップS130でNOと判定された場合には、ジャッキアップ判定部910が圧力センサ44の検出値に基づいてアーム操作の有無を判定し,アーム操作が継続している場合にはステップS130に戻り、アーム操作が終了している場合にはステップS320に進むように構成することが好ましい。
 ステップS150では、ジャッキアップ判定部910は、車体1Aがジャッキアップ中であると判定し、ステップS160へ進む。
 ステップS160では、ジャッキアップ角度演算部920は、ステップS150でジャッキアップ中と判定される直前の車体ピッチ角度を記憶し、その記憶した車体ピッチ角度とその時点での車体ピッチ角度との差分から車体1Aのジャッキアップ角度φを演算する。
 ステップS210では、目標ジャッキアップ角度決定部930は、圧力センサ44が検出する操作信号に基づいてアーム操作が引き操作であるか否かを判定する。アーム操作が引き操作の場合にはステップS220へ進む。アーム操作が押し操作の場合には、ステップS230へ進む。なお、ブーム下げでジャッキアップが生じた場合(すなわちステップS110でYESと判定された後に、ステップS130でもYESと判定された場合)にも、ブーム下げの後にアーム引きまたはアーム押しの操作が入力されることが通常であるため特に支障は無い。
 ステップS220では、目標ジャッキアップ角度決定部930は、図9のテーブル1を参照し、そのときのアーム角度に応じて目標ジャッキアップ角度φtを決定する。
 ステップS230では、目標ジャッキアップ角度決定部930は、図9のテーブル2を参照し、そのときのアーム角度に応じて目標ジャッキアップ角度φtを決定する。
 ステップS240では、指令値補正量演算部940は、ステップS160で演算したジャッキアップ角度φが、ステップS220またはステップS230で決定した目標ジャッキアップ角度φtより大きいか否かを判定する。目標ジャッキアップ角度φtより大きい場合にはステップS310へ進む。一方、目標ジャッキアップ角度φt以下の場合にはステップS320へ進む。
 ステップS310では、指令値補正量演算部940は、式(1)に基づいてブームシリンダ32aの速度に関する補正量Vcを演算し、その補正量Vcと目標動作速度Vtと式(3)を利用してブームシリンダ32aの補正Pi圧を演算し、ステップS330に進む。なお、アームシリンダ32b,バケットシリンダ32cの速度は目標動作速度Vtから補正Pi圧を演算する。
 ステップS320では、指令値補正量演算部940は、式(2)に基づいてブームシリンダ32aの速度に関する補正量Vcを零とし、目標動作速度Vtと式(3)を利用してブームシリンダ32aの補正Pi圧を演算し、ステップS330に進む。この場合、補正Pi圧は補正されない。なお、アームシリンダ32b,バケットシリンダ32cの速度は目標動作速度Vtから補正Pi圧を演算する。
 ステップS330では、駆動指令部730は、ステップS310またはS320で演算された補正Pi圧を比例電磁弁27で出力するための制御電流を演算し、その制御電流を対応する比例電磁弁27に出力することで対応する油圧シリンダ32a,32b,32cを駆動する。
 なお、上記ではアーム操作かブーム下げ操作があったときに図8のフローを開始したが、ブーム下げ操作のみをトリガーにしてフローを開始しても良い。通常、掘削動作は、まずブーム下げによりバケットを掘削開始位置に移動させる動作が行われ、その後間もなくアームの引き操作または押し操作によって掘削動作が開始するため、ステップS210でアーム操作の判定処理が実行されるまでにはアーム操作が入力され、ステップS210の判定に支障は生じないと考えられるからである。
 <動作・効果>
 以上のように構成した本実施形態の油圧ショベルにおいて、アーム405を引き操作して掘削動作を開始した場合に、土壌が硬く車体1Aにジャッキアップが生じた場合には、そのジャッキアップ角度φが目標値(目標ジャッキアップ角度)φtを超えるまではジャッキアップ角度を小さくするMCは実行されない。そのため、ジャッキアップ角度が目標値を超えるまでの間は、オペレータはジャッキアップ角度の大小から掘削力の状態(土壌の硬さの状態)を直感的に把握することができるとともに、自身の操作によって掘削力を調整することができる。そして、ジャッキアップ角度の目標値は、熟練オペレータが硬い土壌を掘削する場合のジャッキアップ角度の傾向に合わせてアームの角度が小さくなるほど(すなわち、掘削動作が終了に近づくほど)小さくなるように設定されており、掘削動作の進捗に合わせて実際のジャッキアップ角度がMCによって半自動的に目標値に近づくように構成されている。これにより掘削の開始時には掘削力を可能な範囲で最大化できるので、硬い土壌を効率良く掘削できる。また、オペレータの技量に関わらず熟練オペレータと同等のジャッキアップ角度で掘削できるようになるので、未熟なオペレータでも硬い土壌を効果的に掘削できるようになることが期待できる。また、熟練オペレータについては実際のジャッキアップ角度が目標値以下の範囲では自身の操作によって掘削力を調整できるので操作性が低下することもない。したがって、本実施形態によれば、領域制限制御(MC)が実行される油圧ショベルにおいてジャッキアップ状態時のオペレータの操作性を良好に保持できる。
 また、上記の油圧ショベルでは、掘削の開始時は目標ジャッキアップ角度を相対的に大きく、掘削の終了時には目標ジャッキアップ角度が零に近づくように設定されているので、掘削動作の終了後に行われる運搬動作を速やかに開始できるため、作業効率の低下を防止できる。
 また、ジャッキアップの発生の有無をブームシリンダ32aのボトム側油圧室とロッド側油圧室の差圧に基づいて判定する方法では、作業装置400を静止させた状態から急にブーム下げを行った場合に、実際にはジャッキアップが未発生でもジャッキアップが発生したときと同じような差圧値をとるため、ジャッキアップを誤判定するおそれがあった。しかし、本実施形態では、ブーム下げ操作から所定時間T1が経過するまでの間に車体ピッチ角が所定量以上変化した場合にジャッキアップ角度が発生したと判定するように構成したので、そのような誤判定の発生を防止できる。
 <変形例>
 ところで、目標ジャッキアップ角度φtは、図10に示すように目標面距離Dが小さくなるほど小さく設定することが好ましい。車体1Aがジャッキアップし過ぎると土壌が急激に柔らかくなったときに目標面60より掘り過ぎるおそれや、掘削が終了するときに運搬動作へすぐに移行できず、作業効率が低下するおそれがあるが、このように目標ジャッキアップ角度φtを設定すると、目標面距離Dが小さく目標面60とバケット爪先407aの距離が近い場合には、目標ジャッキアップ角度φtが小さく設定されて実施のジャッキアップ角度が抑えられるので、目標面60を掘り過ぎてしまうという事態の発生を防止できる。また、目標面距離Dが大きく目標面60とバケット爪先407aの距離が離れている場合には、ジャッキアップにより掘削力を増大でき、作業効率の向上が見込める。
 <その他>
 上記ではコントローラ20が実行する領域制限制御の説明を簡単にするために掘削作業時にアーム操作のみをすることを前提とした箇所があるが、コントローラ20が実行する処理やプログラム(図4のコントローラ20内の各部)はブーム操作やバケット操作があっても領域制限制御が正常に機能するように構成されていることはいうまでもない。
 また上記では、ブームシリンダ32a(ブーム405)のみがMCされたが、アームシリンダ32bやバケットシリンダ32cもMCされるように構成してもよい。この場合、指令値補正量演算部940ではMCされたシリンダの目標動作速度Vtに対して補正量Vcが演算されることになる。
 また、上記の図8のステップS10,S110,S120の処理は省略可能である。
 なお,本発明は,上記の各実施の形態に限定されるものではなく,その要旨を逸脱しない範囲内の様々な変形例が含まれる。例えば,本発明は,上記の実施の形態で説明した全ての構成を備えるものに限定されず,その構成の一部を削除したものも含まれる。また,ある実施の形態に係る構成の一部を,他の実施の形態に係る構成に追加又は置換することが可能である。
 また,上記の制御装置(コントローラ20)に係る各構成や当該各構成の機能及び実行処理等は,それらの一部又は全部をハードウェア(例えば各機能を実行するロジックを集積回路で設計する等)で実現しても良い。また,上記の制御装置に係る構成は,演算処理装置(例えばCPU)によって読み出し・実行されることで当該制御装置の構成に係る各機能が実現されるプログラム(ソフトウェア)としてもよい。当該プログラムに係る情報は,例えば,半導体メモリ(フラッシュメモリ,SSD等),磁気記憶装置(ハードディスクドライブ等)及び記録媒体(磁気ディスク,光ディスク等)等に記憶することができる。
 また,上記の各実施の形態の説明では,制御線や情報線は,当該実施の形態の説明に必要であると解されるものを示したが,必ずしも製品に係る全ての制御線や情報線を示しているとは限らない。実際には殆ど全ての構成が相互に接続されていると考えて良い。
 1…油圧ショベル,20…コントローラ(制御装置),21…エンジン,21c…バケットシリンダ,22…エンジンコントロールユニット(ECU),23…油圧ポンプ,24…ギヤポンプ(パイロットポンプ),25…コントロールバルブ,26…操作レバー(操作装置),27…比例電磁弁,28…旋回油圧モータ,32a…ブームシリンダ,32b…アームシリンダ,32c…バケットシリンダ,33…走行油圧モータ,40…アンテナ,41…圧力センサ,42…圧力センサ,42BBP…ブームボトム圧センサ,42BBP…ブームボトム圧センサ,43…速度センサ,44…圧力センサ,50…目標面設定装置,51…エンジンコントロールダイヤル,60…目標面,400…フロント作業装置(作業装置),401…走行体,402…旋回体,403…運転席,405…ブーム,406…アーム,407…バケット,407a…バケット爪先,700…目標面距離演算部,710…目標動作速度演算部,720…動作指令値生成部,730…駆動指令部,740…位置演算部,810…シリンダ圧検出部,820…車体ピッチ角度検出部,830…フロント姿勢検出部,910…ジャッキアップ判定部,920…ジャッキアップ角度演算部,930…目標ジャッキアップ角度決定部,940…指令値補正量演算部

Claims (9)

  1.  走行体及び旋回体からなる車体と、
     ブーム及びアームを有し、前記旋回体に取り付けられた作業装置と、
     油圧ポンプから吐出される作動油によって駆動され、前記作業装置を動作させる複数の油圧シリンダと、
     オペレータの操作に応じて前記作業装置の動作を指示する操作装置と、
     前記操作装置が操作されている間、任意に設定された目標面上またはその上方に前記作業装置が位置するように、前記複数の油圧シリンダのうち少なくとも1つの油圧シリンダを制御する領域制限制御を実行する制御装置とを備える作業機械において、
     前記制御装置は、前記領域制限制御の実行中に、地面に対する前記車体の傾斜角度であるジャッキアップ角度が予め設定された目標値より大きい場合、前記ジャッキアップ角度が前記目標値に近づくように前記少なくとも1つの油圧シリンダの制御を補正し、
     前記目標値は、前記アームの姿勢に応じて変化するように設定されていることを特徴とする作業機械。
  2.  請求項1の作業機械において、
     前記制御装置は、前記操作装置に前記アームの引き操作が入力されている場合、前記アームの姿勢が前記アームの先端部が前記車体に近い姿勢であるほど、前記目標値を小さく設定することを特徴とする作業機械。
  3.  請求項1の作業機械において、
     前記制御装置は、前記操作装置に前記アームの押し操作が入力されている場合、前記アームの姿勢が前記アームの先端部が前記車体に近い姿勢であるほど、前記目標値を大きく設定することを特徴とする作業機械。
  4.  請求項1の作業機械において、
     前記制御装置は、前記操作装置に前記アームの引き操作が入力されている場合、前記複数の油圧シリンダのうち前記アームを駆動するアームシリンダの長さが伸びるほど前記目標値を小さく設定することを特徴とする作業機械。
  5.  請求項1の作業機械において、
     前記制御装置は、前記操作装置に前記アームの押し操作が入力されている場合、前記複数の油圧シリンダのうち前記アームを駆動するアームシリンダの長さが伸びるほど前記目標値を大きく設定することを特徴とする作業機械。
  6.  請求項1の作業機械において、
     前記制御装置は、さらに、前記作業装置と前記目標面の距離が近づくほど、前記目標値を小さく設定することを特徴とする作業機械。
  7.  請求項1の作業機械において、
     前記制御装置は、前記操作装置により前記ブームの下げ操作が開始されてから所定の時間が経過した後に、前記複数の油圧シリンダのうち前記ブームを駆動するブームシリンダのボトム圧とロッド圧の差が所定の圧力しきい値より小さいとき、前記車体がジャッキアップ状態であることを判定することを特徴とする作業機械。
  8.  請求項7の作業機械において、
     前記制御装置は、前記操作装置により前記ブームの下げ操作が開始されてから所定の時間が経過するまでの間に、前記車体の傾斜角の変化量が所定の変化量しきい値以上となり、かつ、前記複数の油圧シリンダのうち前記ブームを駆動するブームシリンダのボトム圧とロッド圧の差が所定の圧力しきい値より小さいとき、前記車体がジャッキアップ状態であることを判定することを特徴とする作業機械。
  9.  請求項1の作業機械において、
     前記車体の傾斜角を検出する傾斜角センサをさらに備え、
     前記制御装置は、前記車体とジャッキアップ状態であると判定された時刻の直前における前記傾斜角センサの検出値に基づいて前記ジャッキアップ角度を演算すること特徴とする作業機械。
PCT/JP2018/032671 2018-09-03 2018-09-03 作業機械 Ceased WO2020049623A1 (ja)

Priority Applications (6)

Application Number Priority Date Filing Date Title
PCT/JP2018/032671 WO2020049623A1 (ja) 2018-09-03 2018-09-03 作業機械
US16/645,505 US11352761B2 (en) 2018-09-03 2018-09-03 Work machine with jacked-up state control
KR1020207004933A KR102413885B1 (ko) 2018-09-03 2018-09-03 작업 기계
JP2020509565A JP6872666B2 (ja) 2018-09-03 2018-09-03 作業機械
EP18932319.9A EP3848515B1 (en) 2018-09-03 2018-09-03 Work machine
CN201880054990.3A CN111148879B (zh) 2018-09-03 2018-09-03 作业机械

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2018/032671 WO2020049623A1 (ja) 2018-09-03 2018-09-03 作業機械

Publications (1)

Publication Number Publication Date
WO2020049623A1 true WO2020049623A1 (ja) 2020-03-12

Family

ID=69721494

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2018/032671 Ceased WO2020049623A1 (ja) 2018-09-03 2018-09-03 作業機械

Country Status (6)

Country Link
US (1) US11352761B2 (ja)
EP (1) EP3848515B1 (ja)
JP (1) JP6872666B2 (ja)
KR (1) KR102413885B1 (ja)
CN (1) CN111148879B (ja)
WO (1) WO2020049623A1 (ja)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20210230843A1 (en) * 2019-03-27 2021-07-29 Hitachi Construction Machinery Co., Ltd. Work machine
JPWO2022162795A1 (ja) * 2021-01-27 2022-08-04
WO2022224624A1 (ja) * 2021-04-19 2022-10-27 日立建機株式会社 作業機械
US20230074375A1 (en) * 2020-04-17 2023-03-09 Komatsu Ltd. Control system and control method
JP2023140634A (ja) * 2022-03-23 2023-10-05 日立建機株式会社 油圧ショベル
WO2024247545A1 (ja) * 2023-05-31 2024-12-05 株式会社小松製作所 制御装置および制御方法

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020138027A1 (ja) * 2018-12-25 2020-07-02 株式会社クボタ 作業機
KR102090409B1 (ko) * 2018-12-27 2020-03-17 한양대학교 에리카산학협력단 과부하 방지를 위한 원격 제어 굴삭기의 제어 장치 및 방법
CN114207296A (zh) * 2019-07-08 2022-03-18 丹佛斯动力系统Ii技术有限公司 液压系统架构和可用于系统架构中的双向比例阀
JP7481908B2 (ja) * 2020-05-29 2024-05-13 株式会社小松製作所 掘削計画作成装置、作業機械および掘削計画作成方法
JP7706901B2 (ja) * 2021-03-08 2025-07-14 株式会社小松製作所 転倒評価システム、転倒評価方法及び作業機械
CN118974359A (zh) * 2022-03-31 2024-11-15 日立建机株式会社 轮式工程机械
CN117248589A (zh) * 2023-09-19 2023-12-19 徐州徐工挖掘机械有限公司 一种液压挖掘机重载挖掘防翘头的控制方法及系统

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04366235A (ja) * 1991-06-14 1992-12-18 Hitachi Constr Mach Co Ltd 建設機械の傾斜角度制御装置
US6450081B1 (en) * 1999-08-09 2002-09-17 Caterpillar Inc. Hydraulic system for controlling an attachment to a work machine such as thumb attachment used on an excavator
WO2011049079A1 (ja) * 2009-10-19 2011-04-28 日立建機株式会社 作業機械
JP2014122510A (ja) 2012-12-21 2014-07-03 Sumitomo (Shi) Construction Machinery Co Ltd ショベル及びショベル制御方法
JP2017223096A (ja) * 2016-06-17 2017-12-21 住友重機械工業株式会社 ショベル

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2983283B2 (ja) 1990-11-30 1999-11-29 日立建機株式会社 建設機械の傾斜角度制御装置
JP2983301B2 (ja) * 1990-12-28 1999-11-29 日立建機株式会社 建設機械の傾斜角度制御装置
JPH04366236A (ja) * 1991-06-14 1992-12-18 Hitachi Constr Mach Co Ltd 建設機械の傾斜角度制御装置
JP4741521B2 (ja) * 2007-01-12 2011-08-03 日立建機株式会社 油圧ショベルのフロント制御装置
WO2010101233A1 (ja) 2009-03-06 2010-09-10 株式会社小松製作所 建設機械、建設機械の制御方法、及びこの方法をコンピュータに実行させるプログラム
US8768581B2 (en) * 2010-05-24 2014-07-01 Hitachi Construction Machinery Co., Ltd. Work machine safety device
ES2537895B1 (es) * 2013-11-14 2016-05-17 Empresa De Transf Agraria S A (Tragsa) Sistema y metodo para control de estabilidad en maquinaria pesada
JP6521691B2 (ja) * 2015-03-26 2019-05-29 住友重機械工業株式会社 ショベル
JP6532797B2 (ja) * 2015-10-08 2019-06-19 日立建機株式会社 建設機械
EP3751060A4 (en) * 2018-02-09 2021-03-31 Sumitomo (S.H.I.) Construction Machinery Co., Ltd. EXCAVATOR
JP7005416B2 (ja) * 2018-04-11 2022-01-21 株式会社加藤製作所 建設機械の油圧回路

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04366235A (ja) * 1991-06-14 1992-12-18 Hitachi Constr Mach Co Ltd 建設機械の傾斜角度制御装置
US6450081B1 (en) * 1999-08-09 2002-09-17 Caterpillar Inc. Hydraulic system for controlling an attachment to a work machine such as thumb attachment used on an excavator
WO2011049079A1 (ja) * 2009-10-19 2011-04-28 日立建機株式会社 作業機械
JP2014122510A (ja) 2012-12-21 2014-07-03 Sumitomo (Shi) Construction Machinery Co Ltd ショベル及びショベル制御方法
JP2017223096A (ja) * 2016-06-17 2017-12-21 住友重機械工業株式会社 ショベル

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
See also references of EP3848515A4

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20210230843A1 (en) * 2019-03-27 2021-07-29 Hitachi Construction Machinery Co., Ltd. Work machine
US11970840B2 (en) * 2019-03-27 2024-04-30 Hitachi Construction Machinery Co., Ltd. Work machine
US20230074375A1 (en) * 2020-04-17 2023-03-09 Komatsu Ltd. Control system and control method
US12188200B2 (en) * 2020-04-17 2025-01-07 Komatsu Ltd. Control system and control method
KR102643536B1 (ko) 2021-01-27 2024-03-06 히다치 겡키 가부시키 가이샤 유압 셔블
JPWO2022162795A1 (ja) * 2021-01-27 2022-08-04
WO2022162795A1 (ja) * 2021-01-27 2022-08-04 日立建機株式会社 油圧ショベル
KR20220127933A (ko) * 2021-01-27 2022-09-20 히다치 겡키 가부시키 가이샤 유압 셔블
US12264451B2 (en) 2021-01-27 2025-04-01 Hitachi Construction Machinery Co., Ltd. Hydraulic excavator
JP7274671B2 (ja) 2021-01-27 2023-05-16 日立建機株式会社 油圧ショベル
EP4098804A4 (en) * 2021-01-27 2023-12-06 Hitachi Construction Machinery Co., Ltd. Hydraulic excavator
WO2022224624A1 (ja) * 2021-04-19 2022-10-27 日立建機株式会社 作業機械
JP7375260B2 (ja) 2021-04-19 2023-11-07 日立建機株式会社 作業機械
JPWO2022224624A1 (ja) * 2021-04-19 2022-10-27
JP2023140634A (ja) * 2022-03-23 2023-10-05 日立建機株式会社 油圧ショベル
JP7742797B2 (ja) 2022-03-23 2025-09-22 日立建機株式会社 油圧ショベル
WO2024247545A1 (ja) * 2023-05-31 2024-12-05 株式会社小松製作所 制御装置および制御方法

Also Published As

Publication number Publication date
EP3848515A4 (en) 2022-04-06
KR102413885B1 (ko) 2022-06-28
US11352761B2 (en) 2022-06-07
EP3848515A1 (en) 2021-07-14
EP3848515B1 (en) 2024-01-10
CN111148879A (zh) 2020-05-12
US20210148082A1 (en) 2021-05-20
JPWO2020049623A1 (ja) 2020-09-10
KR20200033911A (ko) 2020-03-30
CN111148879B (zh) 2022-04-05
JP6872666B2 (ja) 2021-05-19

Similar Documents

Publication Publication Date Title
JP6872666B2 (ja) 作業機械
US10774502B2 (en) Work machine
CN112639211B (zh) 作业机械、控制装置及控制方法
JP6618498B2 (ja) 作業機械
JP7342205B2 (ja) 積込機械の制御装置および制御方法
CN113423894B (zh) 作业机械
WO2020044711A1 (ja) 作業機械
JP6843039B2 (ja) 作業機械
JP7084129B2 (ja) ショベル
WO2022163168A1 (ja) 作業機械
KR20220086672A (ko) 작업 기계의 제어 시스템, 작업 기계, 및 작업 기계의 제어 방법
JP7274671B2 (ja) 油圧ショベル
US12084836B2 (en) Work machine
WO2025154761A1 (ja) 作業機械
WO2025206075A1 (ja) 作業機械
WO2022230417A1 (ja) 作業機械
WO2024171607A1 (ja) 作業機械
JP2025019774A (ja) 作業機械の制御システム、作業機械の制御方法および作業機械の遠隔操作システム
JP2020169558A (ja) 作業機械の制御装置及び制御方法

Legal Events

Date Code Title Description
ENP Entry into the national phase

Ref document number: 2020509565

Country of ref document: JP

Kind code of ref document: A

ENP Entry into the national phase

Ref document number: 20207004933

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: 18932319

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

ENP Entry into the national phase

Ref document number: 2018932319

Country of ref document: EP

Effective date: 20210406