WO2023053900A1 - 作業機械 - Google Patents

作業機械 Download PDF

Info

Publication number
WO2023053900A1
WO2023053900A1 PCT/JP2022/033805 JP2022033805W WO2023053900A1 WO 2023053900 A1 WO2023053900 A1 WO 2023053900A1 JP 2022033805 W JP2022033805 W JP 2022033805W WO 2023053900 A1 WO2023053900 A1 WO 2023053900A1
Authority
WO
WIPO (PCT)
Prior art keywords
pilot pressure
target
pressure
controller
command
Prior art date
Application number
PCT/JP2022/033805
Other languages
English (en)
French (fr)
Inventor
輝樹 五十嵐
亮平 福地
悠介 鈴木
宏明 田中
充彦 金濱
Original Assignee
日立建機株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 日立建機株式会社 filed Critical 日立建機株式会社
Priority to KR1020237029445A priority Critical patent/KR20230136647A/ko
Priority to EP22875772.0A priority patent/EP4283049A1/en
Priority to CN202280017828.0A priority patent/CN116917578A/zh
Publication of WO2023053900A1 publication Critical patent/WO2023053900A1/ja

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/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
    • 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
    • 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/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2278Hydraulic circuits
    • E02F9/2296Systems with a variable displacement pump
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/261Surveying the work-site to be treated
    • E02F9/262Surveying the work-site to be treated with follow-up actions to control the work tool, e.g. controller
    • 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)
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60YINDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
    • B60Y2200/00Type of vehicle
    • B60Y2200/40Special vehicles
    • B60Y2200/41Construction vehicles, e.g. graders, excavators
    • B60Y2200/412Excavators
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2203Arrangements for controlling the attitude of actuators, e.g. speed, floating function

Definitions

  • the present invention relates to working machines.
  • a work machine includes a controller that controls a In such a working machine, if there is a long delay time from when the controller outputs the control signal to the solenoid valve to when the hydraulic actuator starts driving, there is a risk that the working accuracy will be reduced.
  • Patent Document 1 discloses a method for reducing the delay time from when a control signal is output to a solenoid valve to when a hydraulic actuator starts driving. is opened at high speed, and after the valve is opened, a holding current is applied to maintain the required hydraulic pressure.
  • the purpose of the present invention is to improve work accuracy by equalizing variations in delay time caused by the effects of gravity acting on work equipment.
  • a work machine includes a work device having a plurality of hydraulic actuators, a plurality of driven members driven by the plurality of hydraulic actuators, and an attitude detection device that detects posture information of the work device.
  • a hydraulic pump for supplying hydraulic fluid to the plurality of hydraulic actuators; a control valve unit for controlling the flow of hydraulic fluid supplied from the hydraulic pump to the plurality of hydraulic actuators; and a control valve unit for driving the control valve unit.
  • a solenoid valve unit having a plurality of solenoid valves that generate pilot pressure; and a controller that calculates a command value for the pilot pressure generated by the solenoid valve and outputs a control signal to the solenoid valve according to the command value.
  • the controller calculates a gravity direction component of the motion direction vector of the member to be driven based on the posture information detected by the posture detection device.
  • a command value for the pilot pressure is corrected based on the direction component, and a control signal corresponding to the corrected command value is output to the solenoid valve.
  • work accuracy can be improved by equalizing variations in delay time caused by the effect of gravity acting on the work device.
  • FIG. 1 is a side view of a hydraulic excavator according to a first embodiment of the invention.
  • FIG. 2 is a diagram showing a hydraulic system provided in the hydraulic excavator.
  • FIG. 3 is an explanatory diagram of a method of calculating the reference point of the working device.
  • FIG. 4 is a hardware configuration diagram of the controller of the hydraulic excavator.
  • FIG. 5 is a diagram showing an example of the display screen of the display device.
  • FIG. 6 is a functional block diagram of the controller according to the first embodiment of the invention.
  • FIG. 7 is a diagram showing an example of the trajectory of the toe of the bucket when the toe of the bucket is controlled according to the corrected target speed vector Vca.
  • FIG. 8 is a diagram showing the relationship between the target surface distance H and the control intervention ratio a.
  • FIG. 9A is a diagram schematically showing time history waveforms of the operation pilot pressure Pi0 and the corrected operation pilot pressure Pi0'.
  • FIG. 9B is a diagram schematically showing time history waveforms of the target pilot pressure Pi1 and the corrected target pilot pressure Pi1'.
  • FIG. 10 is a diagram showing the motion direction vector of the member to be driven and its gravitational direction component.
  • FIG. 11 is a diagram showing the relationship between the gravity direction component of the motion direction vector and the correction pressure.
  • FIG. 12 is a flow chart showing the flow from the calculation processing of the target surface distance H to the calculation processing of the area restriction ratio c executed by the controller according to the second embodiment of the present invention.
  • FIG. 13 is a flow chart showing the contents of the calculation processing of the command pilot pressure in consideration of the motion direction of the member to be driven.
  • FIG. 14A is a diagram showing the angle ⁇ BkD of the movement direction vector VBkD of the bucket with respect to the target plane St during the bucket dump operation.
  • FIG. 14B is a diagram showing the angle ⁇ BkC of the movement direction vector VBkC of the bucket with respect to the target plane St during the bucket cloud operation.
  • FIG. 15 is a diagram showing the relationship between the angle ⁇ of the motion direction vector VD with respect to the target surface St and the target surface erosion rate b.
  • FIG. 16 is a functional block diagram of a controller according to the third embodiment of the invention.
  • FIG. 17 is a diagram showing a correction coefficient table.
  • FIG. 1 is a side view of a hydraulic excavator 1 according to a first embodiment of the invention.
  • a hydraulic excavator in which a bucket 10 is attached as an attachment (working tool) to the tip of the working device 1A will be described as an example, but the present invention can also be applied to a hydraulic excavator in which an attachment other than a bucket is attached. .
  • the hydraulic excavator 1 includes a vehicle body (machine body) 1B and an articulated working device 1A attached to the vehicle body 1B.
  • the vehicle body 1B has a traveling body 11 that travels by left and right traveling motors (hydraulic motors) 3a and 3b (see FIG. 2), and a revolving body 12 attached to the traveling body 11 so as to be able to turn.
  • the work device 1A is attached to the revolving body 12 .
  • the revolving body 12 revolves with respect to the traveling body 11 by a revolving motor (hydraulic motor) 4 (see FIG. 2).
  • the traveling body 11 has a pair of left and right crawlers.
  • the traveling motor 3a drives the right crawler, and the traveling motor 3b drives the left crawler.
  • the pivot axis of the swing body 12 is vertical when the hydraulic excavator 1 is parked on the horizontal ground.
  • a driver's cab 16 is provided in the revolving body 12 .
  • electric operating devices A1 to A6 for operating the work device 1A, the traveling body 11 and the revolving body 12 are installed.
  • the revolving structure 12 includes an engine 18 (see FIG. 2) which is a prime mover, a main pump 2 (see FIG. 2) and a pilot pump 48 (see FIG. 2) driven by the engine 18, and a controller for controlling each part of the hydraulic excavator 1. 140 is installed.
  • the work device 1A includes a plurality of hydraulic cylinders (boom cylinder 5, arm cylinder 6, bucket cylinder 7) and a plurality of drive target members (boom 8, arm 9 and bucket 10) and A plurality of members to be driven (8 to 10) are connected in series and rotate in a vertical plane.
  • a base end portion of the boom 8 is rotatably connected to a front portion of the revolving body 12 via a boom pin.
  • An arm 9 is rotatably connected to the tip of the boom 8 via an arm pin.
  • a bucket 10 is rotatably connected to the tip of the arm 9 via a bucket pin.
  • the boom 8 is driven by a boom cylinder 5 that is a hydraulic actuator
  • the arm 9 is driven by an arm cylinder 6 that is a hydraulic actuator
  • the bucket 10 is driven by a bucket cylinder 7 that is a hydraulic actuator.
  • a boom angle sensor 30 is attached to the boom pin, an arm angle sensor 31 is attached to the arm pin, a bucket angle sensor 32 is attached to the bucket link 13, and a vehicle body tilt angle sensor 33 is attached to the revolving body 12.
  • Angle sensors 30, 31, and 32 detect information representing rotation angles ⁇ , ⁇ , and ⁇ (see FIG. 3) of boom 8, arm 9, and bucket 10, respectively, as attitude information of working device 1A, and use the detection results as posture information. Output to controller 140 .
  • the angle sensors 30, 31, 32 are, for example, potentiometers that output a signal (voltage) corresponding to the rotation angle of the member to be driven.
  • the angle sensors 30, 31, 32 may be ground angle sensors.
  • the vehicle body tilt angle sensor 33 detects information representing the tilt angle ⁇ (see FIG.
  • the vehicle body tilt angle sensor 33 acquires the angular velocity and acceleration of the three orthogonal axes as information about the posture, calculates the tilt angle ⁇ based on this information, and outputs a signal representing the tilt angle ⁇ to the controller 140 IMU (Inertial Measurement). Unit: Inertial measurement device) can be adopted. The calculation of the tilt angle ⁇ may be performed by the controller 140 based on the output signal of the IMU.
  • the angle sensors 30-33 function as attitude sensors that detect information about the attitude of the hydraulic excavator 1.
  • the attitude sensor of the work apparatus 1A may be a sensor such as an IMU capable of measuring the inclination angle with respect to the reference plane instead of the angle sensors 30-32.
  • the attitude sensor of the working device 1A may be a stroke sensor for detecting the stroke of the hydraulic cylinder instead of the angle sensors 30-32.
  • the revolving body 12 is provided with a plurality of GNSS (Global Navigation Satellite System) antennas (hereinafter referred to as GNSS antennas) G1 and G2.
  • a positioning calculation device (not shown) is connected to the GNSS antennas G1 and G2.
  • the positioning calculation device calculates the position coordinates ( position information) and an azimuth angle (azimuth information) that is an angle from the reference azimuth.
  • the positioning calculation device calculates the position of the reference point of the work device 1A in the geographic coordinate system (global coordinate system) based on the information from the GNSS antennas G1 and G2.
  • the positioning calculation device outputs position information and azimuth information of the revolving body 12 in the geographic coordinate system to the controller 140 .
  • the toe of the bucket 10 is used as the reference point of the working device 1A
  • the position of the reference point can be changed as appropriate.
  • the reference point may be set on the back surface (outer surface) of the bucket 10 or the bucket link 13 .
  • a point that is the shortest distance from the target excavation surface in the entire bucket may be set as the reference point. In this case, the position of the reference point changes depending on the situation.
  • FIG. 2 is a diagram showing a hydraulic system provided in the hydraulic excavator 1.
  • the hydraulic system includes a main pump 2, a pilot pump 48, a control valve unit 61, an electromagnetic valve unit 62, a boom cylinder 5 that drives the boom 8, and an arm cylinder that drives the arm 9. 6 , a bucket cylinder 7 that drives the bucket 10 , a swing motor 4 that drives the swing body 12 , and traveling motors 3 a and 3 b that drive the traveling body 11 .
  • the main pump 2 is a variable displacement hydraulic pump whose displacement is controlled by a regulator 2a.
  • the main pump 2 is driven by the engine 18 and sucks and discharges the working oil in the tank.
  • the main pump 2 supplies hydraulic fluid to a plurality of hydraulic actuators (3a, 3b, 4-7).
  • the pilot pump 48 is a fixed displacement hydraulic pump.
  • the control valve unit 61 has a plurality of flow control valves D1-D6 that control the flow of hydraulic oil supplied from the main pump 2 to the plurality of hydraulic actuators (3a, 3b, 4-7).
  • the solenoid valve unit 62 has a plurality of solenoid valves 54 a - 59 b that generate pilot pressure for driving the control valve unit 61 .
  • the pilot pressure generated by the solenoid valves 54a-59b increases as the control current supplied to the solenoids of the solenoid valves 54a-59b increases.
  • the solenoid valves 54a-59b are controlled by control signals output from the controller 140.
  • the solenoid valves 54a-59b reduce the primary pressure, which is the discharge pressure of the pilot pump 48, to the secondary pressure corresponding to the control signal from the controller 140, thereby reducing the pilot pressure for driving the flow control valves D1-D6. It is an electromagnetic proportional pressure reducing valve that produces.
  • the controller 140 calculates a command value for the pilot pressure generated by the solenoid valves 54a to 59b based on the operation amount and the operation direction of the operation devices A1 to A6, and outputs a control signal (driving voltage) according to the command value to the solenoid valve. 54a-59b.
  • the solenoid valves 54a-59b output the generated pilot pressures to the pressure receiving chambers (E1-E12) of the flow control valves D1-D6 in accordance with the operating directions and operating amounts of the operating devices A1-A6.
  • the details of how the controller 140 calculates the pilot pressure command value will be described later.
  • the flow control valves D1 to D6 control the flow of hydraulic oil supplied from the main pump 2 to the boom cylinder 5, arm cylinder 6, bucket cylinder 7, swing motor 4, and travel motors 3a and 3b.
  • the flow control valve D1 is driven by pilot pressures output from the solenoid valves 54a, 54b in accordance with the operation of the operating device A1, and input to the pressure receiving chambers E1, E2 through the pilot lines C1, C2.
  • the flow control valve D ⁇ b>1 controls the direction and flow rate of hydraulic oil supplied from the main pump 2 to the boom cylinder 5 to drive the boom cylinder 5 .
  • the flow control valve D2 is driven by pilot pressures output from the solenoid valves 55a, 55b in accordance with the operation of the operating device A2, and input to the pressure receiving chambers E3, E4 through the pilot lines C3, C4. As a result, the flow control valve D2 controls the direction and flow rate of the hydraulic oil supplied from the main pump 2 to the arm cylinder 6 to drive the arm cylinder 6 .
  • the flow control valve D3 is driven by pilot pressures output from the solenoid valves 56a, 56b in accordance with the operation of the operating device A3, and input to the pressure receiving chambers E5, E6 through the pilot lines C5, C6. As a result, the flow control valve D3 controls the direction and flow rate of hydraulic oil supplied from the main pump 2 to the bucket cylinder 7 to drive the bucket cylinder 7 .
  • the flow control valve D4 is driven by the pilot pressure output from the solenoid valves 57a and 57b according to the operation of the operating device A4 being input to the pressure receiving chambers E7 and E8 through the pilot lines C7 and C8. As a result, the flow control valve D4 controls the direction and flow rate of hydraulic oil supplied from the main pump 2 to the swing motor 4 to drive the swing motor 4 .
  • the flow control valve D5 is driven by pilot pressures output from the solenoid valves 58a, 58b in accordance with the operation of the operating device A5, and input to the pressure receiving chambers E9, E10 through the pilot lines C9, C10.
  • the flow control valve D5 controls the direction and flow rate of hydraulic oil supplied from the main pump 2 to the travel motor 3a to drive the travel motor 3a.
  • the flow control valve D6 is driven by pilot pressures output from the solenoid valves 59a and 59b in accordance with the operation of the operating device A6 and input to the pressure receiving chambers E11 and E12 through the pilot lines C11 and C12. As a result, the flow control valve D6 controls the direction and flow rate of hydraulic oil supplied from the main pump 2 to the travel motor 3b to drive the travel motor 3b.
  • the operating devices A1 and A3 share, for example, the operating lever B1 arranged on the right side of the driver's seat.
  • the electromagnetic valves 54a and 54b are operated by the controller 140 to drive the boom cylinder 5 (boom 8).
  • the solenoid valves 56a and 56b are operated by the controller 140 to drive the bucket cylinder 7 (bucket 10).
  • the operation devices A2 and A4 share, for example, an operation lever B2 arranged on the left side of the driver's seat.
  • the electromagnetic valves 55a and 55b are operated by the controller 140 to drive the arm cylinder 6 (arm 9).
  • the electromagnetic valves 57a and 57b are operated by the controller 140, and the swing motor 4 (swing body 12) is driven.
  • the operating device A5 has an operating lever B3, and the operating device A6 has an operating lever B4.
  • the operating levers B3 and B4 are arranged side by side on the right and left sides in front of the driver's seat.
  • the electromagnetic valves 58a and 58b are operated by the controller 140 to drive the traveling motor 3a (the crawler on the right side of the traveling body 11).
  • the electromagnetic valves 59a and 59b are operated by the controller 140 to drive the traveling motor 3b (the crawler on the left side of the traveling body 11).
  • the controller 140 controls the discharge flow rate of the main pump 2 by driving the regulator 2a based on the manipulated variables of the operating devices A1 to A6.
  • a lock valve 39 is provided in the pump line 170 which is the discharge pipe of the pilot pump 48 .
  • the downstream side of the lock valve 39 in the pump line 170 is branched into a plurality of pilot lines C1-C12 and connected to solenoid valves 54a-59b.
  • the lock valve 39 of this embodiment is an electromagnetic switching valve, the solenoid of which is electrically connected to a position sensor of a gate lock lever (not shown) arranged in the operator's cab 16 (see FIG. 1) of the revolving body 12. there is The position of the gate lock lever is detected by the position sensor, and a signal corresponding to the position of the gate lock lever is input to the lock valve 39 from the position sensor.
  • the lock valve 39 When the gate lock lever is in the locked position, the lock valve 39 is closed and the supply of hydraulic oil from the pilot pump 48 to the solenoid valves 54a-59b is cut off. If the gate lock lever is in the unlocked position, the lock valve 39 opens and hydraulic oil is supplied from the pilot pump 48 to the solenoid valves 54a-59b. In other words, when the pump line 170 is shut off by the lock valve 39, the operation of the operating devices A1-A6 is disabled and the hydraulic actuators (3a, 3b, 4-7) are prohibited from operating.
  • FIG. 3 is an explanatory diagram of a method of calculating the reference point of the working device 1A.
  • the attitude of the working device 1A can be defined by a local coordinate system based on the excavator.
  • the local coordinate system shown in FIG. 3 is a coordinate system set with the revolving body 12 as a reference.
  • the fulcrum of the boom 8 (center point of the boom pin) is the origin O of the local coordinate system
  • the Z-axis is parallel to the central axis of rotation of the rotating body 12 (directly above the rotating body 12).
  • the X-axis is set in a direction orthogonal to the Z-axis (in front of the revolving body 12).
  • the boom angle ⁇ detected by the boom angle sensor 30 described above is the tilt angle of the boom 8 with respect to the X axis.
  • the arm angle ⁇ detected by the arm angle sensor 31 described above is the tilt angle of the arm 9 with respect to the boom 8 .
  • the bucket angle ⁇ detected by the bucket angle sensor 32 described above is the tilt angle of the bucket 10 with respect to the arm 9 .
  • the tilt angle ⁇ detected by the vehicle body tilt angle sensor 33 described above is the tilt angle of the vehicle body 1B (revolving body 12) with respect to the horizontal plane (reference plane).
  • the boom angle ⁇ is the minimum when the boom 8 is raised to the upper limit (the boom cylinder 5 is fully extended) and the maximum when the boom 8 is lowered to the lower limit (the boom cylinder 5 is fully retracted).
  • the arm angle ⁇ is minimum when the arm cylinder 6 is fully contracted and maximum when the arm cylinder 6 is fully extended.
  • the bucket angle ⁇ is the smallest value when the bucket cylinder 7 is in the most contracted state (the state shown in FIG. 3) and the largest value when the bucket cylinder 7 is in the most extended state.
  • the position (Xbk, Zbk) of the reference point Pbk of the work device 1A in the local coordinate system is represented by the following equations (1) and (2).
  • Xbk L1cos( ⁇ )+L2cos( ⁇ + ⁇ )+L3cos( ⁇ + ⁇ + ⁇ ) (1)
  • Zbk L1sin( ⁇ )+L2sin( ⁇ + ⁇ )+L3sin( ⁇ + ⁇ + ⁇ ) (2)
  • L1 is the length from the origin O (the center point of the boom pin) to the connecting portion between the boom 8 and the arm 9 (the center point of the arm pin), and L2 is the length from the connecting portion between the arm 9 and the boom 8 (the center point of the arm pin).
  • L3 is the length from the connecting portion (the center point of the bucket pin) of the arm 9 and the bucket 10 to the connecting portion (the center point of the bucket pin) of the arm 9 and the bucket 10, and from the connecting portion (the center point of the bucket pin) to the reference point Pbk (toe of the bucket 10). is the length of
  • the controller 140 has a function of MC (Machine Control) that, when at least one of the operation devices A1 to A3 is operated, intervenes in the operation of the operator under certain conditions to restrict the operation of the work device 1A.
  • MC includes "area limit control” and "stop control”. Area limit control is executed by the controller 140 when an arm operation is performed by the operation device A2 or a boom operation is performed by the operation device A1. The stop control is executed by the controller 140 when a boom lowering operation is performed by the operation device A1 or a bucket operation is performed by the operation device A3.
  • Area limit control is also called "land leveling control".
  • the area limit control at least the boom cylinder 5, the arm cylinder 6, and the bucket cylinder 7 are controlled so that the work device 1A does not excavate the area below the target plane St when the operator performs arm operation or boom operation. one is controlled.
  • the toe of the bucket (the reference point Pbk of the bucket 10) moves along the target surface St.
  • the controller 140 issues a command to raise or lower the boom so that the velocity vector of the toe of the bucket in the direction perpendicular to the target plane St becomes zero.
  • the controller 140 also issues a command to decelerate the motion of the arm 9 according to the arm operation by the operator.
  • the controller 140 issues an arm crowding or arm dumping operation command when the boom is being operated.
  • the trajectory of the toe of the bucket due to the arm motion and boom motion, which are rotational motions, is corrected to a straight trajectory along the target surface St.
  • the stop control at least the boom cylinder 5 and the bucket cylinder 7 are controlled so that the toe of the bucket (the reference point Pbk of the bucket 10) does not enter the area below the target plane St when the boom lowering operation is performed by the operator. one is controlled. As a result, the boom lowering operation and the bucket operation are stopped before the toe of the bucket enters the area below the target surface St.
  • the controller 140 decelerates the boom lowering motion and the bucket motion as the bucket toe approaches the target surface St.
  • the MC includes "automatic control” in which the controller 140 controls the operation of the working device 1A when the operating devices A1 to A3 are not operated, and “automatic control” in which the controller 140 controls the operation of the working device 1A when the operating devices A1 to A3 are operated.
  • the semi-automatic control is also called “intervention control” because the control by the controller 140 intervenes in the operator's operation according to the positional relationship between the target surface St and the bucket 10 .
  • the operating state in which the work implement 1A is operated by intervention control is referred to as "semi-automatic operating state”.
  • An operating state in which the work device 1A operates according to the operation amounts and operating directions of the operating devices A1 to A4 without execution of intervention control is called a "manual operating state.”
  • FIG. 4 is a hardware configuration diagram of the controller 140 of the hydraulic excavator 1. As shown in FIG. As shown in FIG. 4, the controller 140 includes an attitude detection device 50, a target plane data input device 51, a position detection device 52, operation devices A1 to A6, a mode changeover switch 96, a display device 53, and electromagnetic valves 54a to 59b. It is connected.
  • the controller 140 includes an attitude detection device 50, a target plane data input device 51, a position detection device 52, operation devices A1 to A6, a mode changeover switch 96, a display device 53, and electromagnetic valves 54a to 59b. It is connected.
  • the controller 140 includes a processor 92 such as a CPU (Central Processing Unit), MPU (Micro Processing Unit), DSP (Digital Signal Processor), etc., ROM (Read Only Memory), flash memory, non-volatile memory such as a hard disk drive which is a magnetic storage device. It is composed of a computer having a memory 93, a volatile memory 94 called RAM (Random Access Memory), an input interface 91, an output interface 95, and other peripheral circuits. Note that the controller 140 may be composed of one computer, or may be composed of a plurality of computers.
  • the non-volatile memory 93 stores information such as programs and data necessary for executing various processes, including control programs for realizing the MC function.
  • the non-volatile memory 93 is a storage medium (storage device) capable of reading a program that implements the functions of this embodiment.
  • the processor 92 is a processing device that expands the program stored in the nonvolatile memory 93 to the volatile memory 94 and executes operations, and is a processing device that reads data from the input interface 91, the nonvolatile memory 93, and the volatile memory 94 according to the program. A predetermined arithmetic processing is performed on the .
  • the input interface 91 converts signals input from each device (posture detection device 50, target plane data input device 51, position detection device 52, operation devices A1 to A6, mode changeover switch 96, etc.) into data that can be calculated by the processor 92. Convert to Also, the output interface 95 generates an output signal according to the calculation result of the processor 92, and outputs the signal to each device (display device 53, electromagnetic valves 54a to 59b, etc.). As a result, each device (display device 53, electromagnetic valves 54a to 59b, etc.) is activated.
  • the display device 53 is, for example, a touch panel type liquid crystal monitor, and is installed in the driver's cab 16 .
  • FIG. 5 is a diagram showing an example of the display screen of the display device 53. As shown in FIG. As shown in FIG. 5, the display device 53 displays various display images on the display screen based on display control signals from the controller 140 .
  • the controller 140 can cause the display screen of the display device 53 to display a display image representing the positional relationship between the target surface St and the work device 1A (for example, the bucket 10). In the illustrated example, an image representing the target surface St and the bucket 10, and the distance H from the target surface St to the reference point Pbk (for example, the toe) of the bucket 10 (hereinafter also referred to as the target surface distance) are displayed. .
  • the target plane distance H takes a positive value in the upward direction and a negative value in the downward direction with respect to the target plane St.
  • the operator can operate the working device 1A with reference to the display screen of the display device 53.
  • FIG. the controller 140 controls the display device 53 to display on the display screen of the display device 53 information necessary for the operator's operation, information prompting the operator to perform a predetermined operation, and the like. That is, the controller 140 has a machine guidance function for assisting operator's operations.
  • the attitude detection device 50 shown in FIG. 4 has the boom angle sensor 30, the arm angle sensor 31, the bucket angle sensor 32, and the vehicle body tilt angle sensor 33 described above. These angle sensors (30, 31, 32, 33) acquire information about the posture of the working device 1A and output signals according to the information.
  • the operation devices A1 to A6 have operation sensors for detecting the operation directions and amounts of operation of the operation levers B1 to B4, and output detection results of the operation sensors to the controller 140 as operation signals.
  • the target plane data input device 51 is an interface capable of inputting target shape data (the position of the target plane St, the inclination angle of the target plane St with respect to the reference plane (horizontal plane), etc.) to the controller 140 .
  • the target plane data input device 51 is a flash memory storing three-dimensional target shape data defined by a geographic coordinate system (absolute coordinate system), or a non-volatile memory such as a hard disk drive that is a magnetic storage device.
  • the target plane data input device 51 controls a communication device capable of communicating with an external terminal (not shown), acquires three-dimensional target shape data from the external terminal by controlling the communication device, and stores the three-dimensional data in the nonvolatile memory. and a computer capable of updating data.
  • the position detection device 52 has the above-described multiple GNSS antennas G1, G2 and a positioning calculation device (not shown).
  • the position detection device 52 detects position information and direction information of the vehicle body 1B in the geographic coordinate system, and outputs the detection result to the controller 140 .
  • a mode changeover switch 96 is an input device for setting a control mode (work mode), and is installed in the operator's cab 16 .
  • the mode changeover switch 96 has a leveling control mode in which the controller 140 performs leveling control, a stop control mode in which the controller 140 performs stop control, a manual control mode in which neither the leveling control nor the stop control is performed by the controller 140, and a It is a switch for switching between an automatic operation control mode for performing a predetermined operation.
  • FIG. 6 is a functional block diagram of the controller 140.
  • Controller 140 executes a program stored in nonvolatile memory 93, which is a storage device, to obtain operation amount calculation unit 141, attitude calculation unit 142, target plane setting unit 143, target speed calculation unit 144, target pilot pressure It functions as a calculation section 145 , a command pilot pressure correction section 146 , a valve command calculation section 147 and a display control section 148 .
  • the target pilot pressure calculation unit 145, the command pilot pressure correction unit 146, and the valve command calculation unit 147 control the solenoid valves 54a to 59b, thereby controlling the hydraulic actuators (3a, 3b, 4 to 7). function as
  • the operation amount calculation unit 141 calculates the operation pilot pressures PiBMU0 and PiBMD0 to be applied to the pressure receiving chambers E1 and E2 of the flow control valve D1 based on the operation signal for raising the boom and lowering the boom output from the operation device A1.
  • the operation amount calculation unit 141 calculates the operation pilot pressure acting on the pressure receiving chambers E3 and E4 of the flow control valve D2 based on the operation signals of arm crowd (arm pull) and arm dump (arm push) output from the operation device A2.
  • PiAMC0 and PiAMD0 are calculated.
  • the operation amount calculation unit 141 operates an operation pilot that acts on the pressure receiving chambers E5 and E6 of the flow control valve D3 based on operation signals for bucket crowding (bucket excavation) and bucket dumping (bucket dumping) output from the operation device A3. Pressures PiBKC0 and PiBKD0 are calculated.
  • the operation amount calculation unit 141 calculates the operation pilot pressures PiSR0 and PiSL0 to be applied to the pressure receiving chambers E7 and E8 of the flow control valve D4 based on the operation signals for turning to the right and turning to the left output from the operation device A4.
  • the operation amount calculation unit 141 sets the operation pilot pressures PiRF0 and PiRR0 to be applied to the pressure receiving chambers E9 and E10 of the flow control valve D5 based on the operation signals for the forward movement of the right traveling body and the backward movement of the right traveling body output from the operation device A5. calculate.
  • the operation amount calculation unit 141 sets the operation pilot pressures PiLF0 and PiLR0 to be applied to the pressure receiving chambers E11 and E12 of the flow control valve D6 based on the operation signals for the forward movement of the left traveling body and the backward movement of the left traveling body output from the operation device A6. calculate. In this way, the operation amount calculation unit 141 calculates the operation pilot pressures PiBMU0, PiBMD0, PiAMC0, PiAMC0, PiBMU0, PiBMD0, PiAMC0, which are the first command values for the pilot pressures generated by the solenoid valves 54a to 59b, based on the operation amounts of the operation devices A1 to A6. Compute PiAMD0, PiBKC0 and PiBKD0.
  • the posture calculator 142 calculates the boom angle ⁇ , the arm angle ⁇ , the bucket angle ⁇ , and the inclination angle (pitch angle) ⁇ based on the posture information detected by the posture detection device 50 .
  • the attitude calculation unit 142 calculates the local coordinate system (excavator (reference coordinate system) and the reference point Pbk (Xbk, Zbk) of the bucket 10 are calculated. As described above, the reference point Pbk (Xbk, Zbk) of the bucket 10 can be calculated using equations (1) and (2).
  • the attitude calculator 142 calculates the position information of the revolving superstructure 12 in the geographic coordinate system detected by the position detection device 52 and the Based on the azimuth information and the inclination angle of the vehicle body 1B detected by the attitude detection device 50, the position and attitude of the revolving structure 12 in the geographic coordinate system are calculated, and the local coordinate system coordinates are converted into the geographic coordinate system coordinates.
  • the attitude calculation unit 142 calculates a target surface distance H, which is the distance from the reference point Pbk of the bucket 10 to the target surface St set by the target surface setting unit 143, which will be described later.
  • the target surface distance H may be the vertical distance between the reference point Pbk of the bucket 10 and the target surface St, or may be the shortest distance between the reference point Pbk of the bucket 10 and the target surface St.
  • the target plane setting unit 143 acquires three-dimensional target shape data from the target plane data input device 51 .
  • the target surface setting unit 143 calculates the position information of the target surface St based on the target shape data, and stores the calculation result in the volatile memory 94, which is a storage device.
  • the target plane setting unit 143 calculates the position information of the target plane St (two-dimensional target plane shown in FIG. 3), which is the cross-sectional shape of the target shape data cut along the operation plane of the work device 1A.
  • the action plane of the work device 1A is calculated based on the position coordinates of each part of the work device 1A in the geographic coordinate system calculated by the attitude calculation unit 142.
  • the position coordinates of each part of the working device 1A are calculated based on the position information of the vehicle body 1B and the attitude information of the hydraulic excavator 1, as described above. That is, the target plane setting unit 143 sets the target plane St based on the target shape data acquired from the target plane data input device 51, the position information of the vehicle body 1B, and the posture information of the hydraulic excavator 1.
  • target surface St there is one target surface St in the example shown in FIG. 3, there may be a plurality of target surfaces St. If there are a plurality of target surfaces St, for example, the one closest to the reference point Pbk of the bucket 10 may be set as the target surface St, or the one located vertically below the reference point Pbk of the bucket 10 may be set as the target surface St. It may be set as the surface St, or an arbitrarily selected one may be set as the target surface St.
  • the display control unit 148 shown in FIG. 6 displays an image (Fig. 5) on the display screen of the display device 53 is generated.
  • the display control unit 148 outputs the generated display control signal to the display device 53 .
  • the target speed calculation unit 144 calculates a target value of the expansion/contraction speed of each hydraulic cylinder (5, 6, 7) (hereinafter referred to as target speed ) is calculated.
  • target speed a target value of the expansion/contraction speed of each hydraulic cylinder (5, 6, 7)
  • the mode changeover switch 96 is set to the area limit control (ground leveling control) mode
  • the target speed calculation unit 144 controls each area so that the work implement 1A does not excavate the ground beyond the target surface St. Calculate the target speed of the hydraulic cylinders (5, 6, 7).
  • FIG. 7 is a diagram showing an example of the trajectory of the toe of the bucket 10 when the toe of the bucket 10 is controlled according to the corrected target velocity vector Vca.
  • the Xt axis and the Yt axis are set as illustrated.
  • the Xt-axis is an axis parallel to the target plane St
  • the Yt-axis is an axis orthogonal to the target plane St.
  • the target speed calculation unit 144 calculates the primary target speed of each hydraulic cylinder (5, 6, 7) based on the operation pilot pressure calculated by the operation amount calculation unit 141.
  • the target speed calculation unit 144 stores the primary target speed of each hydraulic cylinder (5, 6, 7), the position of the toe (reference point Pbk) of the bucket 10 calculated by the attitude calculation unit 142, and the nonvolatile memory 93.
  • the target velocity vector Vc of the toe of the bucket 10 is calculated based on the dimensions (L1, L2, L3, etc.) of each part of the working device 1A.
  • the target speed calculator 144 calculates the secondary target speed by correcting the primary target speed according to the target surface distance H, which is the distance between the toe of the bucket 10 and the target surface St.
  • the target speed calculation unit 144 determines that the component Vcy (speed component in the Yt-axis direction) of the target speed vector Vc of the toe of the bucket 10 orthogonal to the target surface St becomes 0 (zero). ) of the hydraulic cylinders (5, 6, 7) are calculated. As a result, the velocity vector Vc of the tip of the bucket 10 is converted into Vca.
  • the target velocity vector Vca ( ⁇ 0) when the target plane distance H is 0 (zero) is only the component Vcx (velocity component in the Xt-axis direction) parallel to the target plane St.
  • the toe of the bucket 10 is held on or above the target surface St so that the toe of the bucket 10 does not enter the area below the target surface St.
  • the target speed calculation unit 144 performs control (hereinafter also referred to as direction change control) for converting the speed vector Vc into Vca.
  • direction change control for example, when the arm crowd is operated independently by the operation device A2, the arm cylinder 6 is extended and the boom cylinder 5 is extended, thereby converting the velocity vector Vc to Vca.
  • the target speed calculation unit 144 corrects the primary target speed of the arm cylinder 6 calculated based on the operating pilot pressure of the arm 9 as necessary to calculate a secondary target speed lower than the primary target speed. do.
  • the arm crowd operation is decelerated, so that it is possible to prevent the bucket 10 from exceeding the target surface St and excavating the ground below the target surface St due to the boom raising operation being delayed.
  • Direction change control may be executed by a combination of boom raising or boom lowering and arm crowding, or by a combination of boom raising or boom lowering and arm dumping.
  • the target speed calculation unit 144 calculates a target speed of the boom cylinder 5 in the boom raising direction that cancels the downward component.
  • the target speed calculation unit 144 calculates a target speed of the boom cylinder 5 in the boom lowering direction that cancels the upward component.
  • the target speed calculator 144 sets the target speed of each hydraulic cylinder (5-7) according to the operation of the operating devices A1-A3. Calculate speed. That is, when the manual control mode is set, the target speed calculation unit 144 does not execute direction change control.
  • Each target speed calculated by the target speed calculator 144 is converted into a target pilot pressure based on the relationship between the expansion and contraction speeds.
  • the target pilot pressure calculation unit 145 calculates target pilot pressures PiBMU1 and PiBMD1 based on target speeds of the boom cylinder 5 corresponding to boom raising operation and boom lowering operation.
  • the target pilot pressure calculation unit 145 calculates the target pilot pressures PiAMC1 and PiAMD1 based on the target speed of the arm cylinder 6 corresponding to the arm crowd operation and the arm dump operation.
  • the target pilot pressure calculation unit 145 calculates the target pilot pressures PiBKC1 and PiBKD1 based on the target speed of the bucket cylinder 7 corresponding to the bucket cloud operation and the bucket dump operation. In this way, the target pilot pressure calculation unit 145 calculates the target pilot pressure PiBMU1, which is the second command value of the pilot pressure generated by the solenoid valves 54a to 56b, based on the target speed calculated by the target speed calculation unit 144. Calculate PiBMD1, PiAMC1, PiAMD1, PiBKC1 and PiBKD1.
  • the command pilot pressure correction unit 146 calculates the operation pilot pressures PiBMU0, PiBMD0, PiAMC0, PiAMD0, PiBKC0, and PiBKD0 calculated by the operation amount calculation unit 141 and the target pilot pressure based on the calculation result of the attitude calculation unit 142. By correcting the target pilot pressures PiBMU1, PiBMD1, PiAMC1, PiAMD1, PiBKC1, and PiBKD1 calculated in section 145, command pilot pressures PiBMU2, PiBMD2, PiAMC2, PiAMD2, PiBKC2, and PiBKD2 are calculated. A method of calculating the command pilot pressure will be described in detail below.
  • operation pilot pressures PiBMU0, PiBMD0, PiAMC0, PiAMD0, PiBKC0, and PiBKD0 are collectively referred to as operation pilot pressure Pi0
  • target pilot pressures PiBMU1, PiBMD1, PiAMC1, PiAMD1, PiBKC1, and PiBKD1 are collectively referred to as target pilot pressures. It is described as pressure Pi1.
  • the command pilot pressure correction unit 146 When the operation pilot pressure Pi0 exceeds the actuator non-drive equivalent pressure ps and reaches the actuator drive equivalent pressure (Pi0>ps), the command pilot pressure correction unit 146 performs correction to temporarily increase the operation pilot pressure Pi0.
  • the command pilot pressure correction unit 146 assumes that the intervention control is not executed, and the hydraulic cylinders (5-7) are driven after the control current corresponding to the operation of the operating devices A1-A3 is applied to the solenoid valves 54a-56b.
  • Correction operation pilot pressures PiBMU0', PiBMD0', PiAMC0', PiAMD0', PiBKC0', PiBKD0' for reducing the delay time until the start of operation are calculated.
  • the corrected operation pilot pressures PiBMU0', PiBMD0', PiAMC0', PiAMD0', PiBKC0', PiBKD0' are values greater than the respective operation pilot pressures PiBMU0, PiBMD0, PiAMC0, PiAMD0, PiBKC0, PiBKD0.
  • the command pilot pressure correction unit 146 changes the corrected operation pilot pressures PiBMU0′, PiBMD0′, PiAMC0′, PiAMD0′, PiBKC0′, PiBKD0′ over time to the operation pilot pressures PiBMU0, PiBMD0, PiAMC0, PiAMD0, Asymptotic to PiBKC0 and PiBKD0.
  • the command pilot pressure correction unit 146 When the target pilot pressure Pi1 exceeds the actuator non-driving equivalent pressure ps and reaches the actuator driving equivalent pressure (Pi1>ps), the command pilot pressure correction unit 146 performs correction to temporarily increase the target pilot pressure Pi1.
  • the command pilot pressure correction unit 146 assumes that intervention control is executed, and the control current corresponding to the command from the controller 140 is applied to the solenoid valves 54a-56b until the hydraulic cylinders (5-7) are driven. , are calculated to be constant regardless of the attitudes of the members to be driven (8 to 10).
  • the corrected target pilot pressures PiBMU1', PiBMD1', PiAMC1', PiAMD1', PiBKC1', PiBKD1' are values greater than the respective target pilot pressures PiBMU1, PiBMD1, PiAMC1, PiAMD1, PiBKC1, PiBKD1.
  • the command pilot pressure correction unit 146 changes the corrected target pilot pressures PiBMU1′, PiBMD1′, PiAMC1′, PiAMD1′, PiBKC1′, PiBKD1′ over time to the target pilot pressures PiBMU1, PiBMD1, PiAMC1, PiAMD1, Asymptotic to PiBKC1 and PiBKD1.
  • the corrected operation pilot pressures PiBMU0′, PiBMD0′, PiAMC0′, PiAMD0′, PiBKC0′, and PiBKD0′ are collectively referred to as the corrected operation pilot pressures Pi0′
  • the corrected target pilot pressures PiBMU1′, PiBMD1′, PiAMC1′ are collectively referred to as corrected target pilot pressure Pi1′.
  • the command pilot pressure correction unit 146 calculates a control intervention ratio (pilot ratio) a according to the target surface distance H in order to mediate between the corrected operation pilot pressure Pi0' and the corrected target pilot pressure Pi1'.
  • FIG. 8 is a diagram showing the relationship between the target surface distance H and the control intervention ratio a.
  • the horizontal axis represents the target surface distance H
  • the vertical axis represents the control intervention ratio a.
  • the control intervention ratio a is 0.0 when the target surface distance H is equal to or greater than the second distance H2 (for example, 1000 mm).
  • the control intervention ratio a is 1.0 when the target surface distance H is equal to or less than the first distance H1 (for example, 300 mm).
  • the control intervention ratio a increases as the target surface distance H decreases within the range from the first distance H1 to the second distance H2.
  • the relationship between the target surface distance H and the control intervention ratio a shown in FIG. 8 is stored in the nonvolatile memory 93 in the form of a table.
  • Command pilot pressure correction unit 146 refers to the ratio calculation table shown in FIG.
  • the command pilot pressure correction unit 146 shown in FIG. 6 calculates the command pilot pressure Pi2 by the following equation (3).
  • Pi2 Pi0' ⁇ (1-a)+Pi1' ⁇ a (3)
  • Command pilot pressure Pi2 calculated by equation (3) that is, PiBMU2, PiBMD2, PiAMC2, PiAMD2, PiBKC2, and PiBKD2, is used for calculation in valve command calculation section 147.
  • the control intervention ratio a is a parameter for determining the degree of influence of each of the corrected target pilot pressure Pi1' and the corrected operation pilot pressure Pi0' on the command pilot pressure Pi2. .
  • the command pilot pressure correction unit 146 calculates the right turning, left turning, right running body forward, right running body backward, left running body By correcting the operation pilot pressures PiSR0, PiSL0, PiRF0, PiRR0, PiLF0, and PiLR0 corresponding to the forward and backward operation signals of the left running body, the command pilot pressures PiSR2, PiSL2, PiRF2, PiRR2, PiLF2, and PiLR2 are corrected. Calculate.
  • the corrections to the operation pilot pressures PiSR0, PiSL0, PiRF0, PiRR0, PiLF0, and PiLR0 are the same as the corrections to the above-described PiBMU0, PiBMD0, PiAMC0, PiAMD0, PiBKC0, and PiBKD0, so description thereof will be omitted.
  • the command pilot pressure correction unit 146 corrects the operation pilot pressures PiSR0′ and PiSL0 corresponding to the operation signals for turning right, turning left, advancing the right traveling body, reversing the right traveling body, advancing the left traveling body, and reversing the left traveling body.
  • PiRF0', PiRR0', PiLF0' and PiLR0' are calculated as command pilot pressures PiSR2, PiSL2, PiRF2, PiRR2, PiLF2 and PiLR2.
  • a valve command calculation unit 147 calculates a control current value based on the command pilot pressures PiBMU2, PiBMD2, PiAMC2, PiAMD2, PiBKC2, PiBKD2, PiSR2, PiSL2, PiRF2, PiRR2, PiLF2, and PiLR2 calculated by the command pilot pressure correction unit 146. do.
  • the valve command calculation unit 147 outputs a control signal (driving voltage) to the solenoid valves 54a-59b so that a control current corresponding to the calculation result flows through the solenoids of the solenoid valves 54a-59b.
  • a pilot pressure corresponding to the command pilot pressure is generated by the solenoid valves 54a-59b.
  • the pilot pressure generated by the solenoid valves 54a-59b acts on the pressure receiving chambers E1-E12 of the flow control valves D1-D6, the flow control valves D1-D6 are operated.
  • the solenoid valves 54a and 55a are controlled so that the toe of the bucket 10 does not enter the area below the target surface St. be.
  • the deceleration motion of the arm crowd and the boom raising motion are automatically combined with the arm crowd motion according to the operator's operation.
  • the horizontal excavation operation is performed only by the arm crowd operation.
  • the command pilot pressure correction unit 146 determines whether or not the operation pilot pressure Pi0 and the target pilot pressure Pi1 have exceeded an actuator non-driving equivalent pressure ps (for example, 0.3 MPa).
  • the actuator non-driving equivalent pressure ps is a pressure slightly lower than the pilot pressure (actuator driving equivalent pressure) at which the hydraulic actuators (3a, 3b, 4 to 7) start operating, and is stored in advance in the nonvolatile memory 93. .
  • the actuator non-driving equivalent pressure ps is determined for each hydraulic actuator (3a, 3b, 4-7).
  • the command pilot pressure correction unit 146 corrects the operation pilot pressure Pi0 to the actuator non-driving equivalent pressure when the operation pilot pressure Pi0 switches from a state equal to or lower than the actuator non-driving equivalent pressure ps to a state higher than the actuator non-driving equivalent pressure ps. It is determined that ps has been exceeded.
  • the command pilot pressure correction unit 146 corrects the operation pilot pressure Pi0 from the time point when it is determined that the operation pilot pressure Pi0 has exceeded the actuator non-driving equivalent pressure ps. When the operation pilot pressure Pi0 exceeds the actuator non-driving equivalent pressure ps, the command pilot pressure correction unit 146 calculates a corrected operation pilot pressure Pi0' higher than the operation pilot pressure Pi0.
  • the command pilot pressure correction unit 146 when the target pilot pressure Pi1 switches from a state equal to or lower than the actuator non-driving equivalent pressure ps to a state higher than the actuator non-driving equivalent pressure ps, causes the target pilot pressure Pi1 to increase to It is determined that the drive equivalent pressure ps has been exceeded.
  • the command pilot pressure correction unit 146 corrects the target pilot pressure Pi1 from the time point when it is determined that the target pilot pressure Pi1 has exceeded the actuator non-driving equivalent pressure ps.
  • the command pilot pressure correction unit 146 calculates a corrected target pilot pressure Pi1' higher than the target pilot pressure Pi1.
  • FIG. 9A is a diagram schematically showing time history waveforms of the operation pilot pressure Pi0 and the corrected operation pilot pressure Pi0'.
  • FIG. 9B is a diagram schematically showing time history waveforms of the target pilot pressure Pi1 and the corrected target pilot pressure Pi1'.
  • the operation pilot pressure Pi0 starts rising from the actuator non-driving equivalent pressure ps at time ta0. Therefore, as indicated by the dashed line in FIG. 9A, correction of the operation pilot pressure Pi0 is started from time ta0.
  • Time ta0 is the time when the operation pilot pressure Pi0 switches from being equal to or lower than the actuator non-driving pressure ps to being higher than the actuator non-driving pressure ps, and is hereinafter referred to as the drive start time.
  • Pi0' (Pmax0-Pi0)exp(-Ka ⁇ a)+Pi0 (4)
  • Ka is a predetermined positive value.
  • the function exp(x) represents an exponential function with Napier's number as the exponent base and x as the exponent.
  • the exponential function exp(-Ka ⁇ a) has exp(-Ka) as the base and ⁇ a as the exponent. Also, since Ka is a predetermined positive value, exp(-Ka) is a value smaller than one. Therefore, the exponential function exp(-Ka ⁇ a) asymptotically approaches 0 (zero) as the elapsed time ⁇ a from the driving start time ta0 increases. Therefore, the corrected operation pilot pressure Pi0' gradually approaches the operation pilot pressure Pi0 as the elapsed time ⁇ a increases, and the difference between them becomes substantially zero at time ta1. The degree of asymptotic approach of the corrected pilot pressure Pi0' to the pilot pressure Pi0 can be adjusted by changing the predetermined value Ka.
  • the predetermined value Ka may be set to a common value for each of the hydraulic cylinders (5-7), or may be set to a different value for each of the hydraulic cylinders (5-7).
  • the corrected pressure Pmax0 is the maximum value of the corrected operation pilot pressure Pi0' in the control range from time ta0 to time ta1.
  • the larger the corrected pressure Pmax0 the smaller the delay time from the application of the control current to the solenoid valves 54a to 56b to the actuation of the hydraulic cylinders (5 to 7).
  • the correction pressure Pmax0 is set to a different parameter for each hydraulic cylinder (5-7) so as to match the operation feeling at the start of operation of each hydraulic cylinder (5-7).
  • a common parameter may be set for each hydraulic cylinder (5 to 7).
  • the target pilot pressure Pi1 starts rising from the actuator non-driving equivalent pressure ps at time tb0. Therefore, as indicated by the dashed line in FIG. 9B, correction of the target pilot pressure Pi1 is started from time tb0.
  • Time tb0 is the time when the target pilot pressure Pi1 switches from being equal to or lower than the actuator non-driving pressure ps to being higher than the actuator non-driving pressure ps, and is hereinafter referred to as the drive start time.
  • Pi1′ (Pmax1 ⁇ Pi1) exp( ⁇ Kb ⁇ b)+Pi1 (5)
  • Kb is a positive predetermined value.
  • the function exp(x) represents an exponential function with Napier's number as the exponent base and x as the exponent.
  • the exponential function exp(-Kb ⁇ b) has a base of exp(-Kb) and an exponent of ⁇ b. Also, since Kb is a predetermined positive value, exp(-Kb) is a value smaller than one. Therefore, the exponential function exp(-Kb ⁇ b) asymptotically approaches 0 (zero) as the elapsed time ⁇ b from the driving start time tb0 increases. Therefore, the corrected target pilot pressure Pi1' gradually approaches the target pilot pressure Pi1 as the elapsed time ⁇ b increases, and the difference between them becomes substantially zero at time tb1. The degree of asymptotic approach of the corrected target pilot pressure Pi1' to the target pilot pressure Pi1 can be adjusted by changing the predetermined value Kb.
  • the predetermined value Kb may be set to a common value for each of the hydraulic cylinders (5-7), or may be set to a different value for each of the hydraulic cylinders (5-7).
  • the corrected pressure Pmax1 is the maximum value of the corrected operation pilot pressure Pi0' in the control range from time tb0 to time tb1.
  • the corrected pressure Pmax1 is the delay from when the control current is applied to the solenoid valves 54a to 56b to when the hydraulic cylinders (5 to 7) are driven, regardless of the posture of the work implement 1A when the area limiting control is performed. Set to keep time constant.
  • the correction pressure Pmax1 is calculated based on the posture of the drive target members (8 to 10) that constitute the working device 1A.
  • FIG. 10 is a diagram showing motion direction vectors of driven members (8 to 10) and their gravitational direction components.
  • the command pilot pressure correction unit 146 calculates the motion direction vectors VBmU, VBmD, VAmC, VAmD, VBkC, Calculate VBkD.
  • motion direction vectors VBmU, VBmD, VAmC, VAmD, VBkC, and VBkD are also collectively referred to as motion direction vector VD.
  • the motion direction vector VBmU is a unit vector of the motion direction of the tip of the boom 8 assuming a boom raising motion.
  • the motion direction vector VBmD is a unit vector in the motion direction of the tip of the boom 8 assuming a boom lowering motion.
  • the motion direction vectors VBmU and VBmD extend from the arm pin in a direction perpendicular to the line connecting the boom pin and the arm pin.
  • the motion direction vector VAmC is a unit vector in the motion direction of the distal end of the arm 9 assuming an arm-crowd motion.
  • the motion direction vector VAmD is a unit vector in the motion direction of the tip of the arm 9 assuming an arm dump motion.
  • the motion direction vectors VAmC and VAmD extend from the bucket pin in a direction perpendicular to the line connecting the arm pin and the bucket pin.
  • the motion direction vector VBkC is a unit vector in the motion direction of the tip (toe) of the bucket 10 assuming bucket cloud motion.
  • the movement direction vector VBkD is a unit vector in the movement direction of the tip (toe) of the bucket 10 assuming a bucket dump operation.
  • the motion direction vectors VBkC and VBkD extend from the bucket toe in a direction orthogonal to the line segment connecting the bucket pin and the bucket toe.
  • the command pilot pressure correction unit 146 calculates the gravitational direction components VGBmU, VGBmD, VGAmC, VGAmD, VGBkC, VGBkD of the motion direction vectors of the driven members (8 to 10) based on the calculation result of the attitude calculation unit 142 using the following equations: Calculate from (6) to (11).
  • VGBmU VBmUcos( ⁇ + ⁇ ) (6)
  • VGBmD VBmDcos( ⁇ + ⁇ ) (7)
  • VGAmC VAmCcos( ⁇ + ⁇ + ⁇ ) (8)
  • VGAmD VAmDcos( ⁇ + ⁇ + ⁇ ) (9)
  • VGBkC VBkCcos( ⁇ + ⁇ + ⁇ + ⁇ ) (10)
  • VGBkD VBkDcos( ⁇ + ⁇ + ⁇ + ⁇ ) (11)
  • is the boom angle calculated by the posture calculation unit 142
  • is the arm angle calculated by the posture calculation unit 142
  • is the bucket angle calculated by the posture calculation unit 142
  • is the posture calculation unit. This is the tilt angle (pitch angle) in the longitudinal direction of the revolving body 12 (body 1B) calculated at 142 .
  • the gravitational direction components VGBmU, VGBmD, VGAmC, VGAmD, VGBkC, and VGBkD of the motion direction vector VD are negative values in the direction of gravity (vertically downward direction), and are opposite to the direction of gravity. In the case of (vertical upward direction), it becomes a positive value.
  • the gravitational direction components VGBmU, VGBmD, VGAmC, VGAmD, VGBkC, and VGBkD of the motion direction vector VD can be represented by numerical values from -1.0 to 1.0.
  • the gravitational direction components VGBmU, VGBmD, VGAmC, VGAmD, VGBkC, and VGBkD of the motion direction vector VD are also collectively referred to as the gravitational direction component VG.
  • FIG. 11 is a diagram showing the relationship between the gravity direction component VG of the motion direction vector VD and the corrected pressure Pmax1.
  • the horizontal axis represents the gravity direction component VG of the motion direction vector VD
  • the vertical axis represents the correction pressure Pmax1.
  • the correction pressure Pmax1 is 0 (zero) when the gravity direction component VG of the motion direction vector VD is equal to or less than a predetermined value Vn, and Px ( >0).
  • the corrected pressure Pmax1 increases as the value of the gravitational direction component VG of the motion direction vector VD increases within the range from the predetermined value Vn to the predetermined value Vp.
  • the predetermined value Vn is -1 or less
  • the predetermined value Vp is 1 or more.
  • the relationship between the gravity direction component VG of the motion direction vector VD shown in FIG. 11 and the corrected pressure Pmax1 is stored in the nonvolatile memory 93 in the form of a table.
  • the command pilot pressure correction unit 146 refers to the correction pressure table shown in FIG. 11 and calculates the correction pressure Pmax1 based on the gravity direction component VG of the motion direction vector VD.
  • the command pilot pressure correction unit 146 calculates the operation direction vector VD, its gravitational direction component VG, and the correction pressure Pmax1 repeatedly at a predetermined control cycle regardless of the operation state of the operation devices A1 to A3 by the operator. In other words, the command pilot pressure correction unit 146 always calculates the motion direction vector VD, its gravitational direction component VG, and the correction pressure Pmax1, including when the operating devices A1 to A3 are not operated.
  • the controller 140 When the target pilot pressure Pi1 exceeds the actuator non-driving equivalent pressure ps, the controller 140 according to the present embodiment increases the corrected pressure Pmax1 as the gravitational direction component VG of the motion direction vector VD increases. Accordingly, the target pilot pressure Pi1 is corrected based on the gravity direction component VG of the motion direction vector VD. Therefore, the larger the gravitational force component VG of the motion direction vector VD is, the more the delay time from the application of the control current to the solenoid valves 54a to 56b to the actual start of driving of the hydraulic cylinders (5 to 7) can be reduced. can. As a result, it is possible to equalize the delay times of the actuators that operate in the direction of gravity regardless of the posture of the working device 1A.
  • the correction pressure table shown in FIG. 11 is based on the measured values of the delay time of each hydraulic cylinder (5-7), and considers the balance of the delay time of each hydraulic cylinder (5-7). ), different tables are set.
  • a common table may be set for each hydraulic cylinder (5 to 7).
  • the delay time is The delay time increases when the members to be driven (8 to 10) move in the direction opposite to the direction of gravity. In other words, in the comparative example, the delay time varies depending on the attitude and movement direction of the working device 1A. Therefore, when the work device 1A starts to move, there is a possibility that the work device 1A cannot be moved along the target plane St with high accuracy.
  • the correction pressure Pmax1 is adjusted according to the posture and movement direction of the working device 1A. Therefore, the delay time from when the control signal is output to the solenoid valves 54a to 56b to when the hydraulic cylinders (5 to 7) start to be driven can be made constant, regardless of the attitude and movement direction of the member to be driven. , the work device 1A can be moved along the target plane St with high accuracy when the work device 1A starts to move.
  • a hydraulic excavator (work machine) 1 includes a plurality of hydraulic actuators (boom cylinder 5, arm cylinder 6, bucket cylinder 7) and a plurality of driven members (boom 8, arm 9, a work device 1A having a bucket 10), a posture detection device 50 for detecting posture information (boom angle, arm angle, bucket angle) of the work device 1A and posture information (vehicle body tilt angle) of the revolving body 12;
  • a main pump (hydraulic pump) 2 that supplies hydraulic fluid to the hydraulic actuators, a control valve unit 61 that controls the flow of hydraulic fluid supplied from the main pump 2 to the plurality of hydraulic actuators, and a control valve unit 61 are driven.
  • a solenoid valve unit 62 having a plurality of solenoid valves 54a to 56b for generating pilot pressures for the control and a command pilot pressure Pi2, which is a command value for the pilot pressures generated by the solenoid valves 54a to 56b, is calculated to obtain the command pilot pressure Pi2. and a controller 140 for outputting corresponding control signals to the solenoid valves 54a to 56b.
  • the controller 140 calculates the operation pilot pressure Pi0, which is the first command value of the pilot pressure generated by the solenoid valves 54a-56b, based on the operation amounts of the operation devices A1-A3.
  • the controller 140 is a second command value of the pilot pressure generated by the solenoid valves 54a to 56b so that the predetermined reference point Pbk in the working device 1A does not exceed the target plane St along the target plane St.
  • a target pilot pressure Pi1 is calculated.
  • the controller 140 calculates a command pilot pressure Pi2 based on the operation pilot pressure Pi0 and the target pilot pressure Pi1.
  • the controller 140 calculates the gravitational direction component VG of the motion direction vector VD of the member to be driven (8 to 10).
  • target pilot pressure Pi1 exceeds a predetermined pressure (actuator non-driving equivalent pressure) ps
  • controller 140 corrects target pilot pressure Pi1 based on gravity direction component VG of motion direction vector VD.
  • the controller 140 corrects the operation pilot pressure Pi0 when the operation pilot pressure Pi0 exceeds a predetermined pressure (actuator non-driving equivalent pressure) ps.
  • the controller 140 calculates the command pilot pressure Pi2 based on the corrected target pilot pressure Pi1' and the corrected operation pilot pressure Pi0'.
  • the controller 140 outputs a control signal corresponding to the command pilot pressure Pi2 to which the correction calculated according to the gravitational direction component VG of the motion direction vector VD of the member to be driven (8 to 10) is applied to the plurality of solenoid valves 54a to 56b. output to
  • the controller 140 sets the gravity direction component VG of the motion direction vector VD in the opposite direction (vertically upward direction) to the direction of gravity to a positive value, and sets the motion in the direction of gravity (vertically downward direction).
  • the target pilot pressure Pi1 which is the pilot pressure command value
  • the controller 140 increases the correction pressure Pmax1 as the gravity direction component VG of the motion direction vector VD increases.
  • the controller 140 determines that when the members to be driven (8 to 10) move in the direction opposite to the direction of gravity, the target pilots after correction are higher than when the members to be driven (8 to 10) move in the direction of gravity.
  • the corrected pressure Pmax1 which is the maximum value of the pressure Pi1', is increased.
  • the corrected target pilot pressure Pi1 is lower than when the members to be driven (8 to 10) operate in the direction opposite to the direction of gravity. ' is reduced.
  • the delay time when the members to be driven (8 to 10) move in the direction opposite to the direction of gravity can be made approximately equal to the delay time when the members to be driven (8 to 10) move in the direction of gravity.
  • the delay time can be made uniform regardless of the attitude and motion direction of the members to be driven (8 to 10).
  • the controller 140 sets a predetermined correction pressure higher than the operation pilot pressure Pi0 before correction (in this embodiment, the operation pilot pressure after correction).
  • the maximum value of the pressure Pi0′) Pmax0 is set as the corrected operation pilot pressure Pi0′, and the corrected operation pilot pressure Pi0′ gradually approaches the uncorrected operation pilot pressure Pi0 as the elapsed time ⁇ a increases.
  • a subsequent operation pilot pressure Pi0' is calculated.
  • the pilot pressure generated by the solenoid valves 54a-56b can be made to quickly follow the operation pilot pressure Pi0 according to the operation of the operating devices A1-A3. As a result, it is possible to improve the operational feeling during manual operation and improve the working efficiency. As described above, when the correction pressure Pmax0 is set for each member to be driven (8 to 10), the operation cost is higher than when the correction pressure Pmax0 is the same for the members to be driven (8 to 10). Rings can be improved.
  • the controller 140 sets a predetermined correction pressure higher than the target pilot pressure Pi1 before correction (in this embodiment, the target pilot pressure after correction).
  • the maximum value of the pressure Pi1′) Pmax1 is set as the target pilot pressure Pi1′ after correction, and as the elapsed time ⁇ b increases, the target pilot pressure Pi1′ after correction asymptotically approaches the target pilot pressure Pi1 before correction. A later target pilot pressure Pi1' is calculated.
  • the delay time from when the control current according to the command from the controller 140 is applied to the solenoid valves 54a to 56b to when the hydraulic cylinders (5 to 7) are driven can be reduced.
  • the pilot pressures generated by the solenoid valves 54a to 56b can quickly follow the target pilot pressure Pi1 calculated along the target surface St.
  • the responsiveness of the hydraulic cylinders (5 to 7) at the start of driving the working device 1A by semi-automatic operation is improved.
  • the correction pressure table see FIG. 11
  • correction is performed for the member to be driven (8 to 10).
  • the delay time can be made uniform compared to the case of using the same pressure table.
  • the work device 1A can be operated with higher accuracy, and the machining accuracy of the excavated surface can be improved.
  • the hydraulic excavator 1 includes a position detection device 52 for detecting position information of the vehicle body 1B, and operation devices A1 to A3 for operating the working device 1A.
  • the controller 140 acquires the target shape data, and sets the target plane St based on the acquired target shape data, the position information of the vehicle body 1B, and the posture information of the working device 1A.
  • the controller 140 calculates the operation pilot pressure Pi0 along the target plane St based on the operation amounts of the operation devices A1 to A3. Controller 140 calculates target pilot pressure Pi1 such that reference point Pbk, which is predetermined in working device 1A, does not exceed target plane St along target plane St.
  • the controller 140 calculates the control intervention ratio a that increases as the distance (target surface distance) H from the reference point Pbk of the work implement 1A to the target surface St decreases.
  • the controller 140 calculates a command pilot pressure Pi2 based on the operation pilot pressure Pi0, the target pilot pressure Pi1, and the control intervention ratio a, and outputs a control signal corresponding to the command pilot pressure Pi2 to the solenoid valves 54a-56b.
  • the controller 140 corrects the target pilot pressure Pi1 based on the gravitational direction component VG of the motion direction vector VD.
  • Equation (3) the greater the control intervention ratio a, the greater the degree of influence of the corrected target pilot pressure Pi1' on the command pilot pressure Pi2. This prevents a sudden change in the command pilot pressure Pi2 when the state transitions between the semi-automatic operation (operation under intervention control) state and the manual operation state. As a result, the transition of the driving state is smoothly performed without causing a shock.
  • FIG. 12 to 15 A hydraulic excavator 1 according to a second embodiment of the present invention will be described with reference to FIGS. 12 to 15.
  • FIG. 12 to 15 The same reference numerals are given to the same or corresponding configurations as those described in the first embodiment, and the differences will be mainly described.
  • the hydraulic excavator 1 according to the second embodiment has the same configuration as the hydraulic excavator 1 according to the first embodiment (see FIGS. 4, 6, etc.).
  • the command pilot pressure Pi2 is calculated based on the corrected operation pilot pressure Pi0', the corrected target pilot pressure Pi1', and the control intervention ratio a (see equation (3)).
  • the driven members (8 to 10) move away from the target surface St. If so, the corrected operation pilot pressure Pi0' is set to the command pilot pressure Pi2.
  • the controller 140 of the hydraulic excavator 1 controls the angles ⁇ BmU, ⁇ BmD, ⁇ AmC, ⁇ AmD, ⁇ BkC and ⁇ BkD are calculated.
  • angles ⁇ BmU, ⁇ BmD, ⁇ AmC, ⁇ AmD, ⁇ BkC, and ⁇ BkD are also collectively referred to as angle ⁇ .
  • the controller 140 determines the angle ⁇ of the motion direction vector VD of the operated driven members (8 to 10) and the control intervention ratio a , it is determined whether or not the operation on the driven member (8 to 10) is an operation in the direction of eroding the target surface St, that is, an operation in the direction of approaching the target surface St.
  • the controller 140 determines that the operation on the driven members (8 to 10) is not in the direction of eroding the target surface St, the controller 140 sets the command pilot pressure (first command pilot pressure) Pi2 based on the operation pilot pressure Pi0. and outputs a control signal corresponding to the command pilot pressure (first command pilot pressure) Pi2 to the solenoid valves 54a to 56b.
  • a command pilot pressure (second command pilot pressure) Pi2 is calculated, and a control signal corresponding to the command pilot pressure (second command pilot pressure) Pi2 is output to the solenoid valves 54a to 56b.
  • FIG. 12 is a flow chart showing the flow from the computation processing of the target surface distance H to the computation processing of the area restriction ratio c.
  • FIG. 13 is a flow chart showing the contents of the calculation processing of the command pilot pressure in consideration of the motion direction of the member to be driven.
  • the processing of the flowcharts shown in FIGS. 12 and 13 is started, for example, when an ignition switch (not shown) is turned on, and after initialization (not shown) is performed, it is repeatedly executed at a predetermined control cycle.
  • step S105 the attitude calculation unit 142 calculates the position coordinates of the reference point Pbk of the bucket 10 based on the attitude information. Furthermore, the attitude calculation unit 142 calculates a target surface distance H, which is the distance between the target surface St calculated by the target surface setting unit 143 and the reference point Pbk of the bucket 10 , and proceeds to step 110 .
  • step S110 the command pilot pressure correction unit 146 refers to the ratio calculation table (see FIG. 8) stored in the nonvolatile memory 93, and calculates the control intervention ratio a based on the target surface distance H calculated in step S105. is calculated, and the process proceeds to step S120.
  • step S120 the command pilot pressure correction unit 146 first calculates the angles ⁇ BmU, ⁇ BmD, ⁇ AmC, ⁇ AmD of the motion direction vectors VBmU, VBmD, VAmC, VAmD, VBkC, and VBkD of the members to be driven (8 to 10) with respect to the target surface St. , ⁇ BkC, ⁇ BkD.
  • FIG. 14A is a diagram showing the angle ⁇ BkD of the movement direction vector VBkD of the bucket 10 with respect to the target plane St during the bucket dump operation.
  • FIG. 14B is a diagram showing the angle ⁇ BkC of the movement direction vector VBkC of the bucket 10 with respect to the target plane St during the bucket cloud operation.
  • the angle ⁇ corresponds to the angle formed by the motion direction vector VD and the target plane vector Vst, that is, the angle obtained from the inner product of the motion direction vector VD and the target plane vector Vst.
  • the target plane vector Vst is a unit vector parallel to the target plane St and directed toward the excavator 1 .
  • the illustrated counterclockwise angle from the target surface vector Vst to the motion direction vector VD is represented by a positive value.
  • the illustrated clockwise angle from the target plane vector Vst to the motion direction vector VD is represented by a negative value.
  • angles ⁇ BmU, ⁇ BmD, ⁇ AmC, ⁇ AmD, ⁇ BkC, and ⁇ BkD formed by the motion direction vectors VBmU, VBmD, VAmC, VAmD, VBkC, and VBkD and the target plane vector Vst are the starting points of the motion direction vectors VD and the target plane vectors Vst.
  • the angle is represented by a value within the range of -180° or more and 180° or less.
  • the angle ⁇ BkD between the movement direction vector VBkD of the bucket 10 and the target surface vector Vst during the bucket dump operation is about 150°.
  • the angle ⁇ BkC formed between the movement direction vector VBkC of the bucket 10 and the target plane vector Vst during the bucket cloud operation is approximately ⁇ 30°.
  • the command pilot pressure correction unit 146 calculates the angle ⁇ from the inner product of the motion direction vector VD and the target plane vector Vst.
  • Command pilot pressure correction unit 146 calculates target surface erosion rates bBmU, bBmD, bAmC, bAmD, bBkC, bBkD based on angles ⁇ BmU, ⁇ BmD, ⁇ AmC, ⁇ AmD, ⁇ BkC, ⁇ BkD.
  • the target surface erosion rates bBmU, bBmD, bAmC, bAmD, bBkC, and bBkD are also collectively referred to as the target surface erosion rate b.
  • FIG. 15 is a diagram showing the relationship between the angle ⁇ of the motion direction vector VD with respect to the target surface St and the target surface erosion rate b.
  • the horizontal axis represents the angle ⁇ of the motion direction vector VD with respect to the target surface St
  • the vertical axis represents the target surface erosion rate b.
  • the target surface erosion rate b is a parameter representing the movement direction of the driven members (8 to 10) with respect to the target surface St.
  • the target surface erosion rate b is used to determine whether or not the operation on the driven members (8 to 10) is in the direction of eroding the target surface St.
  • the relationship between the target surface erosion rate b and the angle ⁇ shown in FIG. 15 is stored in advance in the nonvolatile memory 93 in the form of a table.
  • the target surface erosion rate b is 1 when the angle ⁇ is -180° or more and 0° or less.
  • the target surface erosion rate b is 1 when the driven members (8 to 10) of the work device 1A are operated in a direction to approach the target surface St (in a direction to erode the target surface St).
  • the target surface erosion rate b is less than 1 when the driven members (8 to 10) are operated in a direction away from the target surface St (a direction in which the target surface St is not eroded).
  • the target surface erosion rate b decreases as the angle ⁇ increases.
  • the target surface erosion rate b is 0 when the angle ⁇ is in the range of ⁇ 1 to ⁇ 2. In the range where the angle ⁇ is greater than ⁇ 2 and 180° or less, the target surface erosion rate b increases as the angle ⁇ increases.
  • ⁇ 1 is, for example, a value of about 10° to 20°
  • ⁇ 2 is a value of, for example, about 160° to 170°.
  • the target surface erosion rate table is defined so that the target surface erosion rate b is 0 in the range of ⁇ 1 or more, which is larger than 0°, and ⁇ 2 or less, which is smaller than 180°. It is Therefore, it is possible to prevent the bucket 10 from unintentionally contacting the target surface St.
  • step S120 shown in FIG. 12 the command pilot pressure correction unit 146 refers to the target surface erosion rate table shown in FIG. is calculated, and the process proceeds to step S130.
  • step S130 the command pilot pressure correction unit 146 selects the smaller one of the control intervention ratio a calculated in step S110 and the target surface erosion rate b calculated in step S120 as the region restriction ratio c. do. That is, the command pilot pressure correction unit 146 compares each of the target surface erosion rates bBmU, bBmD, bAmC, bAmD, bBkC, and bBkD with the control intervention ratio a, and selects the minimum value to obtain the region restriction ratios cBmU, cBmD. , cAmC, cAmD, cBkC, cBkD.
  • a method of calculating the area restriction ratios cBmU, cBmD, cAmC, cAmD, cBkC, and cBkD will be specifically described below.
  • the command pilot pressure correction unit 146 calculates the minimum value of the target surface erosion rate bBmU obtained from the movement direction vector VBmU of the boom 8 assuming a boom raising operation and the control intervention ratio a, using the following equation (12).
  • the area restriction ratio cBmU is calculated by the selection.
  • the command pilot pressure correction unit 146 calculates the minimum value of the target surface erosion rate bBmD obtained from the movement direction vector VBmD of the boom 8 assuming a boom lowering operation and the control intervention ratio a by the following equation (13).
  • the area restriction ratio cBmD is calculated by the selection.
  • the command pilot pressure correction unit 146 calculates the minimum value of the target surface erosion rate bAmC obtained from the motion direction vector VAmC of the arm 9 assuming an arm crowd operation and the control intervention ratio a by the following equation (14).
  • the area restriction ratio cAmC is calculated by the selection.
  • the command pilot pressure correction unit 146 calculates the minimum value of the target surface erosion rate bAmD obtained from the motion direction vector VAmD of the arm 9 assuming an arm dump operation and the control intervention rate a by the following equation (15).
  • the region restriction ratio cAmD is calculated by the selection.
  • the command pilot pressure correction unit 146 calculates the minimum value of the target surface erosion rate bBkC obtained from the movement direction vector VBkC of the bucket 10 assuming bucket cloud operation and the control intervention ratio a by the following equation (16).
  • the region restriction ratio cBkC is calculated by the selection.
  • the command pilot pressure correction unit 146 calculates the minimum value of the target surface erosion rate bBkD obtained from the movement direction vector VBkD of the bucket 10 assuming a bucket dump operation and the control intervention ratio a by the following equation (17).
  • the area restriction ratio cBkD is calculated by the selection.
  • area restriction ratios cBmU, cBmD, cAmC, cAmD, cBkC, and cBkD are also collectively referred to as area restriction ratio c.
  • the area restriction ratio c is such that the target surface distance H is the first distance H1 (eg, 300 mm) or less, and the angle ⁇ of the motion direction vector VD of the member to be driven (8 to 10) is ⁇ 180° or more and 0° or less. is 1.0.
  • the area restriction ratio c is 180 when the target surface distance H is greater than the first distance H1 (for example, 300 mm), or when the angle ⁇ of the motion direction vector VD of the member to be driven (8 to 10) is greater than 0°. ° or less, the value is smaller than 1.0.
  • the area restriction ratio c is set when the target surface distance H is the second distance H2 (for example, 1000 mm) or more, or when the angle ⁇ of the motion direction vector VD of the member to be driven (8 to 10) is ⁇ 1 or more and ⁇ 2 or less. becomes 0.0.
  • step S130 When the area restriction ratios cBmU, cBmD, cAmC, cAmD, cBkC, and cBkD have been calculated in step S130, the process shown in the flowchart of FIG. 12 ends. That is, the process proceeds to step S105 in the next control cycle (calculation cycle). In this manner, the controller 140 calculates the repetition area restriction ratios cBmU, cBmD, cAmC, cAmD, cBkC, cBkD at predetermined control cycles.
  • the calculated area restriction ratios cBmU, cBmD, cAmC, cAmD, cBkC, cBkD are stored in the volatile memory 94, which is a storage device.
  • step S140 the operation amount calculation unit 141 calculates the operation pilot pressure Pi0 based on the operation direction and operation amount of the operation devices A1 to A3, and proceeds to step S145.
  • step S145 the target speed calculation unit 144 calculates the target speed of each hydraulic cylinder (5, 6, 7) based on the calculation result of the posture calculation unit 142 and the calculation result of the operation amount calculation unit 141, Proceed to step S150.
  • step S150 the target pilot pressure calculation unit 145 calculates the target pilot pressure Pi1 based on the target speed calculated in step S145, and proceeds to step S155.
  • step S155 the command pilot pressure correction unit 146 reads from the volatile memory 94 the area restriction ratio c corresponding to the movement direction of all the driven members that have been operated based on the calculation result of the operation amount calculation unit 141. , the process proceeds to step S160. For example, when an arm crowding operation is performed, the command pilot pressure correction unit 146 reads the area restriction ratio cAmC from the volatile memory 94 . Also, when the arm dump operation is performed, the command pilot pressure correction unit 146 reads the region restriction ratio cAmD from the volatile memory 94 .
  • step S160 the command pilot pressure correction unit 146 determines the direction in which the operation of the drive target member (8 to 10) erodes the target surface St based on the region restriction ratio c read out from the volatile memory 94 in step S155. is the operation.
  • the operation in the direction of encroaching on the target surface St means that the reference point Pbk of the bucket 10 will enter the target surface St if the operation is continued and the intervention control is not executed. refers to operations.
  • the operation of eroding the target surface St can also be said to be an operation in which the reference point Pbk of the bucket 10 approaches the target surface St.
  • the corrected operating pilot pressure Pi0' is calculated by Equation (4) based on the corrected pressure Pmax0 and the operating pilot pressure Pi0
  • the corrected target pilot pressure Pi1' is calculated by Equation (5) based on the corrected pressure Pmax1 and the target pilot pressure Pi1. is calculated by
  • step S160 in FIG. 13 when the controller 140 according to the second embodiment determines that the operation on the driven members (8 to 10) is not in the direction of approaching the target surface St (in the direction of eroding the target surface St) ( If No in step S160 in FIG. 13), the command pilot pressure (first command pilot pressure) Pi2 is calculated based on the operation pilot pressure Pi0 (step S180 in FIG. 13), and the command pilot pressure (first command pilot pressure) is calculated. Manual control is executed to output a control signal corresponding to Pi2 to the solenoid valves 54a to 56b.
  • the controller 140 determines that the operation on the driven members (8 to 10) is the operation in the direction of approaching the target surface St (the direction of eroding the target surface St) (Yes in step S160 of FIG.
  • the command pilot pressure (second command pilot pressure) Pi2 is calculated (step S170 in FIG. 13), and the command pilot pressure (second command Intervention control is executed to output a control signal corresponding to the pilot pressure Pi2 to the solenoid valves 54a to 56b.
  • the corrected operation pilot pressure Pi0' is calculated as the command pilot pressure (first command pilot pressure) Pi2. Therefore, even when the leveling control mode is set and the reference point Pbk of the bucket 10 is close to the target plane St, the members to be driven (8 to 10) are moved so that the reference point Pbk of the bucket 10 is away from the target plane St.
  • the working device 1A operates as intended by the operator. As a result, work efficiency can be improved without giving the operator a sense of discomfort.
  • the target surface erosion rate b is defined by the angles ⁇ BmU, ⁇ BmD, ⁇ AmC, ⁇ AmD, ⁇ BmU, ⁇ BmD, ⁇ AmC, ⁇ AmD, ⁇ BmU, ⁇ BmD, ⁇ AmC, ⁇ AmD, ⁇ AmD, It is calculated based on ⁇ BkC and ⁇ BkD.
  • the region restriction ratio c is calculated based on the control intervention ratio a and the target surface erosion ratio b, and determines whether manual control using equation (19) or intervention control using equation (18) is to be performed. Used for judgment.
  • the area restriction ratio c is calculated before the operator's operation is started (see FIG. 12). Therefore, it is possible to easily adjust the pilot pressure at the start of the operation, thereby preventing the occurrence of a shock caused by switching between the intervention control and the manual control.
  • FIG. 16 is a functional block diagram of the controller 340 according to the third embodiment.
  • the hydraulic excavator 1 according to the third embodiment has the same configuration as the hydraulic excavator 1 described in the first embodiment, and in addition, as shown in FIG. A weight input device 60 for inputting is provided.
  • the weight input device 60 has, for example, a plurality of switches, stick operation members, etc. operated by an operator.
  • the weight input device 60 may be a touch sensor provided on the display screen of the display device 53 . By operating the weight input device 60, the operator can input the weight information of the members to be driven (8 to 10) to the controller 340.
  • the controller 340 has a function as a weight setting unit 360 in addition to the functions described in the first embodiment.
  • the display control unit 348 causes the display device 53 to display a screen for selecting the type of the bucket 10 .
  • the non-volatile memory 93 stores in advance the types of a plurality of buckets 10 and the weight associated with the type of each bucket 10 .
  • the nonvolatile memory 93 stores in advance the types of the arms 9 and the weights associated with the types of the arms 9 .
  • a plurality of types of booms 8 and weights associated with the types of each boom 8 are stored in advance in the nonvolatile memory 93 .
  • the weight input device 60 inputs the selected type of bucket 10 to the controller 340 as weight information.
  • the weight setting unit 360 refers to the nonvolatile memory 93 and sets the weight associated with the selected type of bucket 10 to the weight of the bucket 10 currently attached to the hydraulic excavator 1 (hereinafter referred to as the first set weight). set as
  • the weight input device 60 inputs the selected type of arm 9 to the controller 340 as weight information.
  • the weight setting unit 360 refers to the nonvolatile memory 93 and sets the weight associated with the selected type of the arm 9 as the weight of the arm 9 currently attached to the hydraulic excavator 1 . Further, the weight setting unit 360 sets the weight obtained by adding the first set weight to the set weight of the arm 9 as the second set weight.
  • the weight input device 60 inputs the selected type of boom 8 to the controller 340 as weight information.
  • the weight setting unit 360 refers to the nonvolatile memory 93 and sets the weight associated with the selected type of boom 8 as the weight of the boom 8 currently attached to the hydraulic excavator 1 . Furthermore, the weight setting unit 360 sets the weight obtained by adding the second set weight to the set weight of the boom 8 as the third set weight.
  • the command pilot pressure correction unit 346 corrects the gravitational direction component VG of the motion direction vector VD of the member to be driven (8 to 10) based on the first to third set weights set by the weight setting unit 360. to calculate the third correction coefficient.
  • the first to third set weights are collectively referred to as set weights
  • the first to third correction coefficients are collectively referred to as correction coefficients.
  • FIG. 17 is a diagram showing a correction coefficient table.
  • the correction coefficient table is a data table in which correction coefficients for set weights are defined.
  • the nonvolatile memory 93 stores a first correction coefficient table that defines the relationship between the first set weight and the first correction coefficient, a second correction coefficient table that defines the relationship between the second set weight and the second correction coefficient, and a third set weight.
  • a third correction coefficient table is stored that defines the relationship between the weight and the third correction coefficient.
  • the command pilot pressure correction unit 346 refers to the first correction coefficient table and calculates the first correction coefficient based on the first set weight.
  • the command pilot pressure correction unit 346 refers to the second correction coefficient table and calculates the second correction coefficient based on the second set weight.
  • the command pilot pressure correction unit 346 refers to the third correction coefficient table and calculates the third correction coefficient based on the third set weight.
  • the correction coefficient when the set weight is greater than or equal to the first weight W1 and less than or equal to the second weight W2, the correction coefficient is 1.0.
  • the set weight is less than the first weight W1, the smaller the set weight, the smaller the correction coefficient. That is, when the set weight is less than the first weight W1, the correction coefficient is less than 1.0.
  • the correction coefficient increases as the set weight increases. That is, when the set weight is greater than the second weight W2, the correction coefficient is greater than 1.0.
  • the weight of a specific type (a type with a high frequency of use) of the members to be driven (8 to 10) is set as the reference weight W0, and a value obtained by subtracting a predetermined weight from the reference weight W0 is set as the first weight W1. ing. A value obtained by adding a predetermined weight to the reference weight W0 is set as the second weight W2.
  • the reference weight W0 in the first correction coefficient table is the weight of the bucket 10 of a specific type.
  • the reference weight W0 in the second correction coefficient table is the total weight obtained by adding the weight of the specific type of bucket 10 and the specific type of arm 9 weight.
  • the reference weight W0 in the third correction coefficient table is the total weight obtained by adding the weight of the specific type of bucket 10, the specific type of arm 9 weight, and the specific type of boom 8 weight.
  • the command pilot pressure correction unit 346 calculates the gravitational direction component VG of the motion direction vector VD based on the posture information of the work device 1A and the posture information of the revolving body 12 .
  • the command pilot pressure correction unit 346 adds the weight of the driven member (8 to 10) to each of the gravitational direction components VGBmU, VGBmD, VGAmC, VGAmD, VGBkC, and VGBkD of the motion direction vector VD of the driven member (8 to 10).
  • the corrected gravitational direction components VGBmU', VGBmD', VGAmC', VGAmD', VGBkC', VGBkD' after correction are calculated by multiplying the correction coefficients obtained from .
  • the command pilot pressure correction unit 346 refers to the correction pressure table shown in FIG. 11, and calculates the correction pressure Pmax1 based on the corrected gravity direction components VGBmU′, VGBmD′, VGAmC′, VGAmD′, VGBkC′, VGBkD′. Calculate.
  • the gravity direction component was a value in the range of -1 or more and 1 or less.
  • the corrected gravity direction component may be smaller than -1 or larger than 1 in some cases.
  • the controller 340 sets the weight of the members to be driven (8 to 10) based on weight information input from the weight input device 60, which is an external device.
  • the controller 340 corrects the gravitational direction component VG of the movement direction vector VD based on the weights of the driven members (8 to 10).
  • the delay time is as follows.
  • the member to be driven for example, the bucket 10
  • the corrected pressure Pmax1 becomes smaller than before replacement. Therefore, it is possible to prevent the delay time from becoming shorter than that before the replacement, and to set the delay time to the same degree before and after the replacement.
  • the member to be driven for example, the bucket 10) is operated in a direction opposite to the direction of gravity, the corrected pressure Pmax1 becomes greater than before replacement. For this reason, it is possible to prevent the delay time from becoming longer than before the replacement, and the delay time before and after the replacement can be made approximately the same.
  • the delay time will be as follows.
  • the member to be driven for example, the bucket 10) is operated in the direction of gravity
  • the correction pressure Pmax1 becomes greater than before replacement. For this reason, it is possible to prevent the delay time from becoming longer than before the replacement, and the delay time before and after the replacement can be made approximately the same.
  • the member to be driven for example, the bucket 10) is operated in a direction opposite to the direction of gravity
  • the corrected pressure Pmax1 becomes smaller than before replacement. Therefore, it is possible to prevent the delay time from becoming shorter than that before the replacement, and to set the delay time to the same degree before and after the replacement. That is, according to the third embodiment, the delay time can be made uniform regardless of the motion direction and weight of the member to be driven. As a result, the working device 1A can be operated with high precision.
  • controllers 140 and 340 correct target pilot pressure Pi1 based on gravity direction component VG of motion direction vector VD in the above embodiment, the present invention is not limited to this. Controllers 140 and 340 may correct operation pilot pressure Pi0 based on gravity direction component VG of action direction vector VD. With this configuration, it is possible to equalize variations in the delay time due to the influence of gravity acting on the work device 1A at the start of the manual operation. As a result, the operational feeling can be improved. That is, the present invention can also be applied to a hydraulic excavator that does not have the MC function, and by correcting the operation pilot pressure Pi0 at the start of operation, the operation feeling at the start of operation is improved, and the work accuracy is improved. can be made
  • a target pilot pressure is output from an electromagnetic valve (electromagnetic proportional pressure reducing valve) driven by a control signal from a controller, separately from a pilot line to which an operation pilot pressure is output from a pressure reducing valve of an operating device. It has a pilot line.
  • Controllers 140 and 340 may correct target pilot pressure Pi1 based on gravity direction component VG of operation direction vector VD at the start of automatic control. This makes it possible to equalize variations in the delay time caused by the influence of gravity acting on the working device 1A. As a result, the work accuracy can be improved by automatic control of the hydraulic excavator 1 .
  • the bucket toe is used as a reference point (control point), and the target surface distance H used to calculate the control intervention ratio a and the operation direction vectors VBkC and VBkD of the bucket 10 are calculated.
  • the invention is not limited to this.
  • the target surface distance H and the motion direction vectors VBkC and VBkD of the bucket 10 may be calculated using an arbitrary point on the rear end side of the bucket as a reference point (control point).
  • the controller 140 has the same configuration as that of the first embodiment (see FIGS. 4, 6, etc.).
  • the vehicle body tilt angle sensor 33 of the posture detection device 50 detects not only the tilt angle (pitch angle) of the revolving structure 12 in the longitudinal direction, but also the tilt angle (roll angle) of the revolving structure 12 in the lateral direction. It detects it as posture information and outputs the detection result to the controller 140 .
  • the controller 140 calculates the gravitational direction component of the motion direction vector of the revolving superstructure 12 based on the posture information of the work device 1A and the posture information of the revolving superstructure 12 detected by the posture detection device 50 .
  • the reference point of the revolving superstructure 12, which is the starting point of the motion direction vector of the revolving superstructure 12, is, for example, the position of the center of gravity of the revolving superstructure 12 including the work device 1A.
  • the controller 140 controls the rotation of the revolving body 12 based on the detection result of the posture detection device 50 and information such as the weight of each driven member stored in the nonvolatile memory 93, the weight of the revolving body 12, and the dimensions of each member.
  • the controller 140 calculates an operation direction vector with the tangential direction at the reference point of the revolving structure 12 on the circle centered on the central axis of revolving as the operation direction.
  • the controller 140 also calculates the gravitational direction component of the motion direction vector of the revolving superstructure 12 .
  • the controller 140 controls the operation pilot pressure, which is the command value of the pilot pressure generated by the solenoid valves (motor solenoid valves) 57a and 57b and acting on the pressure receiving chambers E7 and E8 of the flow control valve (motor control valve) D4, to the turning motor 4. exceeds the non-driving equivalent pressure (predetermined pressure) and reaches the driving equivalent pressure, the operation pilot pressure of the solenoid valves (motor solenoid valves) 57a and 57b is increased based on the gravitational direction component of the operation direction vector of the rotating body 12. to correct.
  • the controller 140 outputs control signals to the solenoid valves (motor solenoid valves) 57a and 57b according to the corrected operation pilot pressures of the solenoid valves (motor solenoid valves) 57a and 57b.
  • Modified Example 5 when the left turning of the turning body 12 is started from a state in which the turning body 12 is tilted such that the left side of the turning body 12 is positioned lower than the right side, the left turning and the right turning are started.
  • the delay time from when the control current corresponding to the operating device A4 is applied to the solenoid valves 57a and 57b to when the turning motor 4 is driven can be made uniform.
  • the bucket 10 may be connected to the arm 9 so as to be rotatable in multiple directions.
  • the bucket 10 is rotatable in a second direction orthogonal to the first direction when the direction of the central axis of the bucket pin is defined as a first direction, and can rotate in a second direction orthogonal to the first direction and the second direction. It may be configured to be rotatable in three directions.
  • the controller sets the operation pilot pressure according to the operation of the bucket 10 in the second direction (tilt operation) and the operation in the third direction (rotary operation). You may correct
  • the target plane data input device 51 may be an input device such as a switch or a keyboard that allows the operator to input a plurality of coordinate values representing the target plane.
  • the target surface data input device 51 acquires the position of the toe of the bucket 10 from the controller 140 based on the operator's operation, and inputs the numerical value representing the depth from that position to obtain the coordinates representing the target surface. It may be a device capable of inputting a value to the controller 140 .
  • the working machine is the hydraulic excavator 1 in the above embodiment
  • the present invention is not limited to this.
  • INDUSTRIAL APPLICABILITY The present invention can be applied to various working machines equipped with a hydraulic actuator, a control valve that controls the flow of hydraulic oil supplied from a hydraulic pump to the hydraulic actuator, and an electromagnetic valve that outputs a pilot pressure to the control valve. can.
  • Each configuration related to the controllers 140 and 340, the functions and execution processing of each configuration may be implemented partially or entirely by hardware (for example, logic for executing each function is designed by an integrated circuit). good.
  • SYMBOLS 1... Hydraulic excavator, 1A... Working device, 1B... Vehicle body (body), 2... Main pump (hydraulic pump), 4... Swing motor (hydraulic motor), 5... Boom cylinder (hydraulic actuator), 6...
  • Arm cylinder (hydraulic Actuator), 7: Bucket cylinder (hydraulic actuator), 8: Boom (member to be driven), 9: Arm (member to be driven), 10: Bucket (member to be driven), 11: Traveling body, 12: Revolving body, 18 Engine 30 Boom angle sensor (attitude sensor) 31 Arm angle sensor (attitude sensor) 32 Bucket angle sensor (attitude sensor) 33 Body tilt angle sensor (attitude sensor) 48 Pilot pump 50 Attitude detection device 51 Target plane data input device 52 Position detection device 53 Display device 54a, 54b, 55a, 55b, 56a, 56b Solenoid valve 57a, 57b Solenoid valve (solenoid valve for motor ), 58a, 58b, 59a, 59b...
  • Solenoid valve 60 Weight input device 61... Control valve unit 62... Solenoid valve unit 92... Processor 93... Non-volatile memory (storage device) 94... Volatile memory (Storage device) 96 Mode switch 140 Controller 141 Manipulated amount calculation unit 142 Attitude calculation unit 143 Target surface setting unit 144 Target speed calculation unit 145 Target pilot pressure calculation unit 146... Command pilot pressure correction unit 147... Valve command calculation unit 148... Display control unit 149... Actuator control unit 340... Controller 346... Command pilot pressure correction unit 348... Display control unit 360... Weight setting unit , A1 to A6... operation device, a... control intervention ratio, b... target surface erosion rate, c... area restriction ratio, D1 to D3...
  • Target pilot pressure Pi1 ' Corrected target pilot pressure, Pi2 Command pilot pressure, Pmax0, Pmax1 Corrected pressure, ps Predetermined pressure (actuator non-driving equivalent pressure), St Target surface, VD Operating direction vector, VG Gravity of operating direction vector Components Vst: Target plane vector ⁇ : Boom angle ⁇ : Arm angle ⁇ : Bucket angle ⁇ : Inclination angle (pitch angle) ⁇ : Angle of operation direction vector with respect to the target plane

Landscapes

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

Abstract

作業機械は、複数の油圧アクチュエータ及び複数の駆動対象部材を有する作業装置と、作業装置の姿勢情報を検出する姿勢検出装置と、油圧ポンプから複数の油圧アクチュエータに供給される作動油の流れを制御する制御弁ユニットと、制御弁ユニットを駆動するためのパイロット圧を生成する複数の電磁弁と、電磁弁で生成するパイロット圧の指令値を演算し、指令値に応じた制御信号を電磁弁に出力するコントローラと、を備える。コントローラは、姿勢検出装置で検出される姿勢情報に基づいて、駆動対象部材の動作方向ベクトルの重力方向成分を演算し、指令値が所定圧力を超えると、動作方向ベクトルの重力方向成分に基づいてパイロット圧の指令値を補正し、補正後の指令値に応じた制御信号を電磁弁に出力する。

Description

作業機械
 本発明は、作業機械に関する。
 ブーム、アーム及びバケット等を駆動させる複数の油圧アクチュエータと、複数の油圧アクチュエータを制御するための制御弁ユニットと、制御弁ユニットを駆動するためのパイロット圧を生成する複数の電磁弁と、電磁弁を制御するコントローラと、を備えた作業機械が知られている。このような作業機械では、コントローラから制御信号が電磁弁に出力されてから、油圧アクチュエータが駆動を開始するまでの遅れ時間が長いと、作業精度の低下につながるおそれがある。
 特許文献1には、制御信号が電磁弁に出力されてから油圧アクチュエータが駆動を開始するまでの遅れ時間を低減させる方法として、電磁弁の駆動開始時にソレノイドに過励磁電流を流すことで電磁弁を高速に開弁させ、開弁後は所要の油圧力を保持するために保持電流を流す方法が開示されている。
特表2018-528899号公報
 しかしながら、特許文献1に記載の技術では、作業装置の重力の影響により、コントローラが制御信号を電磁弁に出力してから油圧アクチュエータが駆動するまでの遅れ時間にばらつきが生じるおそれがある。例えば、作業機械は、駆動対象部材を重力に逆らわずに動作させる場合に比べて、駆動対象部材を重力に逆らって動作させる場合の方が、コントローラが電磁弁に制御信号を出力してから油圧アクチュエータが駆動するまでの遅れ時間が長くなるおそれがある。その結果、作業機械は、精度よく作業を行うことができないおそれがある。
 本発明は、作業装置に作用する重力の影響に起因した遅れ時間のばらつきを均一化させることにより、作業精度の向上を図ることを目的とする。
 本発明の一態様による作業機械は、複数の油圧アクチュエータ、及び、前記複数の油圧アクチュエータにより駆動される複数の駆動対象部材を有する作業装置と、前記作業装置の姿勢情報を検出する姿勢検出装置と、前記複数の油圧アクチュエータに作動油を供給する油圧ポンプと、前記油圧ポンプから前記複数の油圧アクチュエータに供給される作動油の流れを制御する制御弁ユニットと、前記制御弁ユニットを駆動するためのパイロット圧を生成する複数の電磁弁を有する電磁弁ユニットと、前記電磁弁で生成するパイロット圧の指令値を演算し、前記指令値に応じた制御信号を前記電磁弁に出力するコントローラと、を備える。前記コントローラは、前記姿勢検出装置で検出される姿勢情報に基づいて、前記駆動対象部材の動作方向ベクトルの重力方向成分を演算し、前記指令値が所定圧力を超えると、前記動作方向ベクトルの重力方向成分に基づいて前記パイロット圧の指令値を補正し、補正後の前記指令値に応じた制御信号を前記電磁弁に出力する。
 本発明によれば、作業装置に作用する重力の影響に起因した遅れ時間のばらつきを均一化させることにより、作業精度の向上を図ることができる。
図1は本発明の第1実施形態に係る油圧ショベルの側面図である。 図2は油圧ショベルが備える油圧システムを示す図である。 図3は作業装置の基準点の演算方法の説明図である。 図4は油圧ショベルのコントローラのハードウェア構成図である。 図5は表示装置の表示画面の一例を示す図である。 図6は本発明の第1実施形態に係るコントローラの機能ブロック図である。 図7は、バケットの爪先が補正後の目標速度ベクトルVcaの通りに制御されたときの、バケットの爪先の軌跡の一例を示す図である。 図8は目標面距離Hと制御介入比率aとの関係を示す図である。 図9Aは、操作パイロット圧Pi0と、補正操作パイロット圧Pi0’の時刻歴波形を模式的に示す図である。 図9Bは、目標パイロット圧Pi1と、補正目標パイロット圧Pi1’の時刻歴波形を模式的に示す図である。 図10は駆動対象部材の動作方向ベクトル及びその重力方向成分を示す図である。 図11は、動作方向ベクトルの重力方向成分と、補正圧力との関係を示す図である。 図12は、本発明の第2実施形態に係るコントローラにより実行される目標面距離Hの演算処理から領域制限比率cの演算処理までの流れについて示すフローチャートである。 図13は、駆動対象部材の動作方向が加味された指令パイロット圧の演算処理の内容について示すフローチャートである。 図14Aは、バケットダンプ操作時における目標面Stに対するバケットの動作方向ベクトルVBkDの角度φBkDについて示す図である。 図14Bは、バケットクラウド操作時における目標面Stに対するバケットの動作方向ベクトルVBkCの角度φBkCについて示す図である。 図15は、目標面Stに対する動作方向ベクトルVDの角度φと目標面侵食率bとの関係を示す図である。 図16は、本発明の第3実施形態に係るコントローラの機能ブロック図である。 図17は、補正係数テーブルについて示す図である。
 図面を参照して、本発明の実施形態に係る作業機械について説明する。
 <第1実施形態>
 -油圧ショベル-
 図1は本発明の第1実施形態に係る油圧ショベル1の側面図である。なお、本実施形態では作業装置1Aの先端にアタッチメント(作業具)としてバケット10を装着した油圧ショベルを例示して説明するが、バケット以外のアタッチメントを装着した油圧ショベルにも本発明は適用され得る。
 図1に示すように、油圧ショベル1は、車体(機体)1Bと、車体1Bに取り付けられる多関節型の作業装置1Aと、を備える。車体1Bは、左右の走行モータ(油圧モータ)3a,3b(図2参照)により走行する走行体11と、走行体11に旋回可能に取り付けられた旋回体12と、を有する。作業装置1Aは、旋回体12に取り付けられる。旋回体12は、旋回モータ(油圧モータ)4(図2参照)により走行体11に対して旋回する。走行体11は、左右一対のクローラを有する。走行モータ3aは右側のクローラを駆動し、走行モータ3bは左側のクローラを駆動する。旋回体12の旋回中心軸は油圧ショベル1が水平地に停車した状態で鉛直である。旋回体12には運転室16が設けられている。運転室16内には、作業装置1A、走行体11及び旋回体12を操作するための電気式の操作装置A1~A6が設置されている。旋回体12には原動機であるエンジン18(図2参照)、エンジン18により駆動されるメインポンプ2(図2参照)及びパイロットポンプ48(図2参照)、並びに油圧ショベル1の各部を制御するコントローラ140が搭載されている。
 作業装置1Aは、複数の油圧シリンダ(ブームシリンダ5、アームシリンダ6、バケットシリンダ7)と、複数の油圧シリンダ(5~7)により駆動される複数の駆動対象部材(ブーム8、アーム9及びバケット10)と、を備える。複数の駆動対象部材(8~10)は、直列的に連結され鉛直面内でそれぞれ回動する。ブーム8の基端部はブームピンを介して旋回体12の前部に回動可能に連結されている。ブーム8の先端部にはアームピンを介してアーム9が回動可能に連結されている。アーム9の先端部にはバケットピンを介してバケット10が回動可能に連結されている。ブーム8は油圧アクチュエータであるブームシリンダ5によって駆動され、アーム9は油圧アクチュエータであるアームシリンダ6によって駆動され、バケット10は油圧アクチュエータであるバケットシリンダ7によって駆動される。
 ブームピンにはブーム角度センサ30、アームピンにはアーム角度センサ31、バケットリンク13にはバケット角度センサ32、旋回体12には車体傾斜角度センサ33が取り付けられている。角度センサ30,31,32は、それぞれブーム8、アーム9、バケット10の回動角度α,β,γ(図3参照)を表す情報を作業装置1Aの姿勢情報として検出し、その検出結果をコントローラ140に出力する。角度センサ30,31,32は、例えば、駆動対象部材の回動角度に応じた信号(電圧)を出力するポテンショメータである。なお、角度センサ30,31,32は、対地角センサであってもよい。車体傾斜角度センサ33は、基準面(例えば水平面)に対する旋回体12(車体1B)の傾斜角度θ(図3参照)を表す情報を旋回体12の姿勢情報として検出し、その検出結果をコントローラ140に出力する。車体傾斜角度センサ33には、姿勢に関する情報として直交3軸の角速度及び加速度を取得し、この情報に基づき傾斜角度θを演算し、傾斜角度θを表す信号をコントローラ140に出力するIMU(Inertial Measurement Unit:慣性計測装置)を採用することができる。なお、傾斜角度θの演算は、IMUの出力信号に基づき、コントローラ140が行うようにしてもよい。
 このように、角度センサ30~33は、油圧ショベル1の姿勢に関する情報を検出する姿勢センサとして機能する。なお、作業装置1Aの姿勢センサは、角度センサ30~32に代えて、基準面に対する傾斜角度を測定可能なIMU等のセンサとしてもよい。また、作業装置1Aの姿勢センサは、角度センサ30~32に代えて、油圧シリンダのストロークを検出するストロークセンサとしてもよい。
 旋回体12には複数のGNSS(Global Navigation Satellite System:全地球衛星測位システム)用のアンテナ(以下、GNSSアンテナと記す)G1,G2が設けられている。GNSSアンテナG1,G2には、測位演算装置(不図示)が接続されている。測位演算装置は、GNSSアンテナG1,G2で受信された複数の測位衛星からの衛星信号(GNSS電波)に基づいて、地理座標系(グローバル座標系)における旋回体12(車体1B)の位置座標(位置情報)及び基準方位からの角度である方位角(方位情報)を演算する。また、測位演算装置は、GNSSアンテナG1,G2からの情報を基に、地理座標系(グローバル座標系)における作業装置1Aの基準点の位置を演算する。測位演算装置は、旋回体12の地理座標系における位置情報及び方位情報をコントローラ140に出力する。
 なお、本実施形態では作業装置1Aの基準点をバケット10の爪先とした場合を例に挙げて説明する。但し、基準点の位置は適宜変更可能である。例えば、基準点は、バケット10の背側面(外面)、あるいはバケットリンク13に設定してもよい。また、バケット全体において掘削目標面と最短距離となる点を基準点として設定してもよい。この場合、状況に応じて基準点の位置が変化する。
 -油圧システム-
 図2は油圧ショベル1が備える油圧システムを示す図である。図2に示すように、油圧システムは、メインポンプ2と、パイロットポンプ48と、制御弁ユニット61と、電磁弁ユニット62と、ブーム8を駆動するブームシリンダ5と、アーム9を駆動するアームシリンダ6と、バケット10を駆動するバケットシリンダ7と、旋回体12を駆動する旋回モータ4と、走行体11を駆動する走行モータ3a,3bと、を備えている。
 メインポンプ2は、レギュレータ2aによって容量が制御される可変容量型の油圧ポンプである。メインポンプ2は、エンジン18により駆動され、タンク内の作動油を吸い込み、吐出する。メインポンプ2は、複数の油圧アクチュエータ(3a,3b,4~7)に作動油を供給する。パイロットポンプ48は固定容量型の油圧ポンプである。
 制御弁ユニット61は、メインポンプ2から複数の油圧アクチュエータ(3a,3b,4~7)に供給される作動油の流れを制御する複数の流量制御弁D1~D6を有する。電磁弁ユニット62は、制御弁ユニット61を駆動するためのパイロット圧を生成する複数の電磁弁54a~59bを有する。電磁弁54a~59bで生成されるパイロット圧は、電磁弁54a~59bのソレノイドに供給される制御電流が大きいほど高くなる。
 電磁弁54a~59bは、コントローラ140から出力される制御信号によって制御される。電磁弁54a~59bは、パイロットポンプ48の吐出圧である一次圧をコントローラ140からの制御信号に応じた二次圧に減圧することで、流量制御弁D1~D6を駆動するためのパイロット圧を生成する電磁比例減圧弁である。コントローラ140は、操作装置A1~A6の操作量及び操作方向に基づいて、電磁弁54a~59bで生成するパイロット圧の指令値を演算し、指令値に応じた制御信号(駆動電圧)を電磁弁54a~59bに出力する。電磁弁54a~59bは、操作装置A1~A6の操作方向及び操作量に応じて、生成したパイロット圧を流量制御弁D1~D6の受圧室(E1~E12)へ出力する。コントローラ140によるパイロット圧の指令値の演算方法の詳細については後述する。
 流量制御弁D1~D6は、メインポンプ2からブームシリンダ5、アームシリンダ6、バケットシリンダ7、旋回モータ4、及び、走行モータ3a,3bに供給される作動油の流れを制御する。流量制御弁D1は、操作装置A1の操作に応じて電磁弁54a,54bから出力されるパイロット圧が、パイロットラインC1,C2を通じて受圧室E1,E2に入力されることにより駆動される。これにより、流量制御弁D1は、メインポンプ2からブームシリンダ5に供給される作動油の方向及び流量を制御してブームシリンダ5を駆動する。流量制御弁D2は、操作装置A2の操作に応じて電磁弁55a,55bから出力されるパイロット圧が、パイロットラインC3,C4を通じて受圧室E3,E4に入力されることにより駆動される。これにより、流量制御弁D2は、メインポンプ2からアームシリンダ6に供給される作動油の方向及び流量を制御してアームシリンダ6を駆動する。流量制御弁D3は、操作装置A3の操作に応じて電磁弁56a,56bから出力されるパイロット圧が、パイロットラインC5,C6を通じて受圧室E5,E6に入力されることにより駆動される。これにより、流量制御弁D3は、メインポンプ2からバケットシリンダ7に供給される作動油の方向及び流量を制御してバケットシリンダ7を駆動する。
 流量制御弁D4は操作装置A4の操作に応じて電磁弁57a,57bから出力されるパイロット圧が、パイロットラインC7,C8を通じて受圧室E7,E8に入力されることにより駆動される。これにより、流量制御弁D4は、メインポンプ2から旋回モータ4に供給される作動油の方向及び流量を制御して、旋回モータ4を駆動する。流量制御弁D5は操作装置A5の操作に応じて電磁弁58a,58bから出力されるパイロット圧が、パイロットラインC9,C10を通じて受圧室E9,E10に入力されることにより駆動される。これにより、流量制御弁D5は、メインポンプ2から走行モータ3aに供給される作動油の方向及び流量を制御して、走行モータ3aを駆動する。流量制御弁D6は操作装置A6の操作に応じて電磁弁59a,59bから出力されるパイロット圧が、パイロットラインC11,C12を通じて受圧室E11,E12に入力されることにより駆動される。これにより、流量制御弁D6は、メインポンプ2から走行モータ3bに供給される作動油の方向及び流量を制御して、走行モータ3bを駆動する。
 操作装置A1,A3は、例えば、運転席の右側に配置された操作レバーB1を共有している。操作レバーB1で操作装置A1が操作されると、コントローラ140によって電磁弁54a,54bが作動され、ブームシリンダ5(ブーム8)が駆動される。操作レバーB1で操作装置A3が操作されると、コントローラ140によって電磁弁56a,56bが作動され、バケットシリンダ7(バケット10)が駆動される。操作装置A2,A4は、例えば、運転席の左側に配置された操作レバーB2を共有している。操作レバーB2で操作装置A2が操作されると、コントローラ140によって電磁弁55a,55bが作動され、アームシリンダ6(アーム9)が駆動される。操作レバーB2で操作装置A4が操作されると、コントローラ140によって電磁弁57a,57bが作動され、旋回モータ4(旋回体12)が駆動される。
 操作装置A5は操作レバーB3を有し、操作装置A6は操作レバーB4を有する。操作レバーB3,B4は運転席の前方の右側と左側に並べて配置されている。操作レバーB3で操作装置A5が操作されると、コントローラ140によって電磁弁58a,58bが作動され、走行モータ3a(走行体11の右側のクローラ)が駆動される。操作レバーB4で操作装置A6が操作されると、コントローラ140によって電磁弁59a,59bが作動され、走行モータ3b(走行体11の左側のクローラ)が駆動される。
 コントローラ140は、操作装置A1~A6の操作量に基づいてレギュレータ2aを駆動し、メインポンプ2の吐出流量を制御する。
 パイロットポンプ48の吐出配管であるポンプライン170にはロック弁39が設けられる。ポンプライン170におけるロック弁39の下流側は、複数のパイロットラインC1~C12に分岐されて電磁弁54a~59bに接続されている。本実施形態のロック弁39は電磁切換弁であり、そのソレノイドは旋回体12の運転室16(図1参照)に配置されたゲートロックレバー(不図示)の位置センサと電気的に接続されている。ゲートロックレバーのポジションがその位置センサで検出され、位置センサからゲートロックレバーのポジションに応じた信号がロック弁39に入力される。ゲートロックレバーのポジションがロック位置にあればロック弁39が閉じてパイロットポンプ48から電磁弁54a~59bへの作動油の供給が遮断される。ゲートロックレバーのポジションがロック解除位置にあればロック弁39が開いてパイロットポンプ48から電磁弁54a~59bへ作動油が供給される。つまり、ポンプライン170がロック弁39によって遮断された状態では、操作装置A1~A6による操作が無効化され、各油圧アクチュエータ(3a,3b,4~7)の動作が禁止される。
 -作業装置の基準点の演算方法-
 図3は作業装置1Aの基準点の演算方法の説明図である。図3に示すように、作業装置1Aの姿勢は、ショベル基準のローカル座標系で定義できる。図3に示すローカル座標系は、旋回体12を基準に設定された座標系である。本実施形態では、このローカル座標系は、ブーム8の支点(ブームピンの中心点)が原点Oとされ、旋回体12の旋回中心軸と平行に(旋回体12の真上方向に)Z軸が設定され、Z軸と直交する方向(旋回体12の前方)にX軸が設定される。
 上述したブーム角度センサ30で検出されるブーム角度αは、X軸に対するブーム8の傾斜角度である。上述したアーム角度センサ31で検出されるアーム角度βは、ブーム8に対するアーム9の傾斜角度である。上述したバケット角度センサ32で検出されるバケット角度γは、アーム9に対するバケット10の傾斜角度である。上述した車体傾斜角度センサ33で検出される傾斜角度θは、水平面(基準面)に対する車体1B(旋回体12)の傾斜角度である。
 ブーム角度αは、ブーム8を上限まで上げた状態(ブームシリンダ5が最伸長状態)で最小、ブーム8を下限まで下げた状態(ブームシリンダ5が最収縮状態)で最大となる値である。アーム角度βは、アームシリンダ6が最収縮状態で最小、アームシリンダ6が最伸長状態で最大となる値である。バケット角度γは、バケットシリンダ7が最収縮状態(図3で示す状態)で最小、バケットシリンダ7が最伸長状態で最大となる値である。
 ローカル座標系における作業装置1Aの基準点Pbkの位置(Xbk,Zbk)は、次の式(1),(2)で表される。
  Xbk=L1cos(α)+L2cos(α+β)+L3cos(α+β+γ)…(1)
  Zbk=L1sin(α)+L2sin(α+β)+L3sin(α+β+γ)…(2)
  L1は原点O(ブームピンの中心点)からブーム8とアーム9との連結部(アームピンの中心点)までの長さであり、L2はアーム9とブーム8の連結部(アームピンの中心点)からアーム9とバケット10の連結部(バケットピンの中心点)までの長さであり、L3はアーム9とバケット10の連結部(バケットピンの中心点)から基準点Pbk(バケット10の爪先)までの長さである。
 -マシンコントロール-
 コントローラ140には、操作装置A1~A3の少なくとも1つが操作された場合に、一定条件下でオペレータの操作に介入して作業装置1Aの動作を制限するMC(Machine Control)の機能が備わっている。MCには、「領域制限制御」及び「停止制御」が含まれる。領域制限制御は、操作装置A2によるアーム操作、または、操作装置A1によるブーム操作が行われる際にコントローラ140により実行される。停止制御は、操作装置A1によるブーム下げ操作、または、操作装置A3によるバケット操作が行われる際にコントローラ140により実行される。
 領域制限制御は「整地制御」とも呼ばれる。領域制限制御では、オペレータによるアーム操作またはブーム操作が行われたときに、目標面Stから下側の領域を作業装置1Aが掘削しないように、ブームシリンダ5、アームシリンダ6及びバケットシリンダ7の少なくとも1つが制御される。これにより、バケット爪先(バケット10の基準点Pbk)が目標面Stに沿って移動する。具体的には、コントローラ140は、アーム操作がなされているときには、目標面Stに垂直な方向のバケット爪先の速度ベクトルがゼロになるように、ブーム上げまたはブーム下げ動作の指令を行う。また、コントローラ140は、オペレータによるアーム操作に応じたアーム9の動作を減速させる指令も行う。コントローラ140は、ブーム操作がなされているときには、アームクラウドまたはアームダンプの動作指令を行う。これにより、回動運動であるアーム動作やブーム動作によるバケット爪先の軌跡が、目標面Stに沿った直線軌道に補正される。
 停止制御では、オペレータによるブーム下げ操作が行われたときに、目標面Stよりも下方の領域にバケット爪先(バケット10の基準点Pbk)が侵入しないように、ブームシリンダ5及びバケットシリンダ7の少なくとも1つが制御される。これにより、バケット爪先が目標面Stよりも下方の領域に侵入する前に、ブーム下げ動作やバケット動作が停止される。停止制御では、コントローラ140は、バケット爪先が目標面Stに接近するにつれブーム下げ動作やバケット動作を減速させる。
 MCには、操作装置A1~A3の非操作時に作業装置1Aの動作をコントローラ140により制御する「自動制御」と、操作装置A1~A3の操作時に作業装置1Aの動作をコントローラ140により制御する「半自動制御」と、がある。なお、半自動制御は、目標面Stとバケット10との位置関係に応じて、オペレータ操作にコントローラ140による制御が介入するため「介入制御」とも呼ばれる。以下では、介入制御により作業装置1Aが動作している運転状態のことを「半自動運転状態」と記す。介入制御が実行されることなく、操作装置A1~A4の操作量及び操作方向に応じて作業装置1Aが動作している運転状態のことを「マニュアル運転状態」と呼ぶ。
 -コントローラ(ハードウェア)-
 図4は油圧ショベル1のコントローラ140のハードウェア構成図である。図4に示すように、コントローラ140には、姿勢検出装置50、目標面データ入力装置51、位置検出装置52、操作装置A1~A6、モード切替スイッチ96、表示装置53及び電磁弁54a~59bが接続されている。
 コントローラ140は、CPU(Central Processing Unit)、MPU(Micro Processing Unit)、DSP(Digital Signal Processor)等のプロセッサ92、ROM(Read Only Memory)、フラッシュメモリ、磁気記憶装置であるハードディスクドライブ等の不揮発性メモリ93、所謂RAM(Random Access Memory)と呼ばれる揮発性メモリ94、入力インターフェース91、出力インターフェース95、及び、その他の周辺回路を備えたコンピュータで構成される。なお、コントローラ140は、1つのコンピュータで構成してもよいし、複数のコンピュータで構成してもよい。
 不揮発性メモリ93には、MC機能を実現するための制御プログラムを含む、各種処理の実行に必要なプログラム、データ等の情報が格納されている。すなわち、不揮発性メモリ93は、本実施形態の機能を実現するプログラムを読み取り可能な記憶媒体(記憶装置)である。プロセッサ92は、不揮発性メモリ93に記憶されたプログラムを揮発性メモリ94に展開して演算実行する処理装置であって、プログラムに従って入力インターフェース91、不揮発性メモリ93及び揮発性メモリ94から取り入れたデータに対して所定の演算処理を行う。
 入力インターフェース91は、各装置(姿勢検出装置50、目標面データ入力装置51、位置検出装置52、操作装置A1~A6、モード切替スイッチ96等)から入力された信号をプロセッサ92で演算可能なデータに変換する。また、出力インターフェース95は、プロセッサ92での演算結果に応じた出力用の信号を生成し、その信号を各装置(表示装置53、電磁弁54a~59b等)に出力する。これにより、各装置(表示装置53、電磁弁54a~59b等)が作動する。
 表示装置53は、例えば、タッチパネル式の液晶モニタであり、運転室16内に設置されている。図5は表示装置53の表示画面の一例を示す図である。図5に示すように、表示装置53は、コントローラ140からの表示制御信号に基づいて、様々な表示画像を表示画面に表示する。コントローラ140は、表示装置53の表示画面に目標面Stと作業装置1A(例えば、バケット10)の位置関係を表す表示画像を表示させることができる。図に示す例では、目標面St及びバケット10を表す画像と、目標面Stからバケット10の基準点Pbk(例えば、爪先)までの距離(以下、目標面距離とも記す)Hが表示されている。目標面距離Hは、目標面Stを基準に上方向に正の値、下方向に負の値をとる。オペレータは、表示装置53の表示画面を参考に作業装置1Aを操作することができる。このように、コントローラ140は、表示装置53を制御して、オペレータの操作に必要な情報、オペレータに所定の操作を促す情報等を表示装置53の表示画面に表示させる。つまり、コントローラ140は、オペレータの操作を補助するマシンガイダンス機能を有している。
 図4に示す姿勢検出装置50は、上述したブーム角度センサ30、アーム角度センサ31、バケット角度センサ32及び車体傾斜角度センサ33を有する。これらの角度センサ(30,31,32,33)は、作業装置1Aの姿勢に関する情報を取得し、その情報に応じた信号を出力する。操作装置A1~A6は、操作レバーB1~B4の操作方向及び操作量を検出する操作センサを有し、操作センサの検出結果を操作信号としてコントローラ140に出力する。
 目標面データ入力装置51は、目標形状データ(目標面Stの位置、目標面Stの基準面(水平面)に対する傾斜角度等)をコントローラ140に入力可能なインターフェースである。例えば、目標面データ入力装置51は、地理座標系(絶対座標系)で規定された3次元の目標形状データを格納したフラッシュメモリ、磁気記憶装置であるハードディスクドライブ等の不揮発性メモリである。また、目標面データ入力装置51は、外部端末(不図示)と通信可能な通信装置と、通信装置を制御して外部端末から3次元の目標形状データを取得し、不揮発性メモリ内の3次元データを更新可能なコンピュータと、を有する装置であってもよい。
 位置検出装置52は、上述した複数のGNSSアンテナG1,G2及び測位演算装置(不図示)を有する。位置検出装置52は、地理座標系における車体1Bの位置情報及び方位情報を検出し、検出結果をコントローラ140に出力する。モード切替スイッチ96は、制御モード(作業モード)を設定する入力装置であり、運転室16内に設置されている。モード切替スイッチ96は、コントローラ140により整地制御を実行させる整地制御モード、コントローラ140により停止制御を実行させる停止制御モード、コントローラ140により整地制御及び停止制御のいずれも実行させないマニュアル制御モード、コントローラ140により予め定められた動作を行わせる自動運転制御モードと、を切り替えるためのスイッチである。
 -コントローラ(機能)-
 図6等を参照し、コントローラ140の主な機能について説明する。図6はコントローラ140の機能ブロック図である。コントローラ140は、記憶装置である不揮発性メモリ93に記憶されているプログラムを実行することにより、操作量演算部141、姿勢演算部142、目標面設定部143、目標速度演算部144、目標パイロット圧演算部145、指令パイロット圧補正部146、バルブ指令演算部147、及び表示制御部148として機能する。目標パイロット圧演算部145、指令パイロット圧補正部146及びバルブ指令演算部147は、電磁弁54a~59bを制御することにより、油圧アクチュエータ(3a,3b,4~7)を制御するアクチュエータ制御部149として機能する。
 -操作量演算部-
 操作量演算部141は、操作装置A1から出力されるブーム上げ、ブーム下げの操作信号に基づいて、流量制御弁D1の受圧室E1,E2に作用させる操作パイロット圧PiBMU0,PiBMD0を算出する。操作量演算部141は、操作装置A2から出力されるアームクラウド(アーム引き)、アームダンプ(アーム押し)の操作信号に基づいて、流量制御弁D2の受圧室E3,E4に作用させる操作パイロット圧PiAMC0,PiAMD0を算出する。操作量演算部141は、操作装置A3から出力されるバケットクラウド(バケット掘削)、バケットダンプ(バケット放土)の操作信号に基づいて、流量制御弁D3の受圧室E5,E6に作用させる操作パイロット圧PiBKC0,PiBKD0を算出する。
 操作量演算部141は、操作装置A4から出力される右旋回、左旋回の操作信号に基づいて、流量制御弁D4の受圧室E7,E8に作用させる操作パイロット圧PiSR0,PiSL0を算出する。操作量演算部141は、操作装置A5から出力される右走行体前進、右走行体後進の操作信号に基づいて、流量制御弁D5の受圧室E9,E10に作用させる操作パイロット圧PiRF0,PiRR0を算出する。操作量演算部141は、操作装置A6から出力される左走行体前進、左走行体後進の操作信号に基づいて、流量制御弁D6の受圧室E11,E12に作用させる操作パイロット圧PiLF0,PiLR0を算出する。このように、操作量演算部141は、操作装置A1~A6の操作量に基づいて、電磁弁54a~59bで生成するパイロット圧の第1の指令値である操作パイロット圧PiBMU0,PiBMD0,PiAMC0,PiAMD0,PiBKC0,PiBKD0を演算する。
 -姿勢演算部-
 姿勢演算部142は、姿勢検出装置50で検出される姿勢情報に基づき、ブーム角度α、アーム角度β、バケット角度γ、及び傾斜角度(ピッチ角)θを演算する。姿勢演算部142は、ブーム角度α、アーム角度β及びバケット角度γ、並びに不揮発性メモリ93に記憶されている作業装置1Aの各部の寸法(L1,L2,L3)に基づき、ローカル座標系(ショベル基準座標系)における作業装置1Aの姿勢と、バケット10の基準点Pbk(Xbk,Zbk)を演算する。既述のとおり、バケット10の基準点Pbk(Xbk,Zbk)は、式(1)及び式(2)により演算できる。地理座標系における作業装置1Aの姿勢とバケット10の基準点Pbkの位置が必要な場合には、姿勢演算部142は、位置検出装置52で検出される地理座標系における旋回体12の位置情報及び方位情報並びに姿勢検出装置50で検出される車体1Bの傾斜角度に基づいて、旋回体12の地理座標系における位置と姿勢を算出して、ローカル座標系座標を地理座標系座標に変換する。
 姿勢演算部142は、バケット10の基準点Pbkから後述する目標面設定部143により設定される目標面Stまでの距離である目標面距離Hを演算する。なお、目標面距離Hは、バケット10の基準点Pbkと目標面Stとの鉛直方向の距離としてもよいし、バケット10の基準点Pbkと目標面Stとの最短距離としてもよい。
 -目標面設定部-
 目標面設定部143は、目標面データ入力装置51から3次元の目標形状データを取得する。目標面設定部143は、目標形状データに基づいて、目標面Stの位置情報を演算し、演算結果を記憶装置である揮発性メモリ94に記憶する。目標面設定部143は、作業装置1Aの動作平面で切断した目標形状データの断面形状を目標面St(図3に示す2次元の目標面)として、その位置情報を演算する。
 作業装置1Aの動作平面は、姿勢演算部142で演算された地理座標系の作業装置1Aの各部の位置座標に基づいて演算される。なお、作業装置1Aの各部の位置座標は、上述したように、車体1Bの位置情報と油圧ショベル1の姿勢情報に基づいて演算される。つまり、目標面設定部143は、目標面データ入力装置51から取得した目標形状データ、車体1Bの位置情報及び油圧ショベル1の姿勢情報に基づいて目標面Stを設定する。
 なお、図3に示す例では目標面Stは1つだが、目標面Stが複数存在する場合もある。目標面Stが複数存在する場合には、例えば、バケット10の基準点Pbkに最も近いものを目標面Stとして設定してもよいし、バケット10の基準点Pbkの鉛直下方に位置するものを目標面Stとして設定してもよいし、任意に選択したものを目標面Stとして設定してもよい。
 -表示制御部-
 図6に示す表示制御部148は、目標面設定部143で設定された目標面Stと、姿勢演算部142で演算されたバケット10の基準点(バケット爪先)との位置関係を表す画像(図5参照)を表示装置53の表示画面に表示させるための表示制御信号を生成する。表示制御部148は、生成した表示制御信号を表示装置53に出力する。
 -目標速度演算部-
 目標速度演算部144は、姿勢演算部142での演算結果及び操作量演算部141での演算結果に基づいて、各油圧シリンダ(5,6,7)の伸縮速度の目標値(以下、目標速度とも記す)を演算する。目標速度演算部144は、モード切替スイッチ96(図4参照)により領域制限制御(整地制御)モードが設定されている場合、作業装置1Aによって目標面Stを越えて地面を掘削しないように、各油圧シリンダ(5,6,7)の目標速度を演算する。
 以下、図7を参照して、整地制御における目標速度の演算方法について詳しく説明する。図7は、バケット10の爪先が補正後の目標速度ベクトルVcaの通りに制御されたときの、バケット10の爪先の軌跡の一例を示す図である。ここでの説明では、図示するように、Xt軸およびYt軸を設定する。Xt軸は、目標面Stに平行な軸であり、Yt軸は、目標面Stに直交する軸である。
 目標速度演算部144は、操作量演算部141によって演算された操作パイロット圧に基づいて、各油圧シリンダ(5,6,7)の一次目標速度を演算する。目標速度演算部144は、各油圧シリンダ(5,6,7)の一次目標速度と、姿勢演算部142で演算されたバケット10の爪先(基準点Pbk)の位置と、不揮発性メモリ93に記憶されている作業装置1Aの各部の寸法(L1,L2,L3等)とに基づいて、バケット10の爪先の目標速度ベクトルVcを演算する。目標速度演算部144は、バケット10の爪先と目標面Stとの距離である目標面距離Hに応じて、一次目標速度を補正することにより、二次目標速度を演算する。目標速度演算部144は、目標面距離Hが0(ゼロ)に近づくにつれて、バケット10の爪先の目標速度ベクトルVcにおける目標面Stに直交する成分Vcy(Yt軸方向の速度成分)が0(ゼロ)に近づくように油圧シリンダ(5,6,7)のうち必要な油圧シリンダの二次目標速度を演算する。これにより、バケット10の爪先の速度ベクトルVcがVcaに変換される。目標面距離Hが0(ゼロ)のときの目標速度ベクトルVca(≠0)は、目標面Stに平行な成分Vcx(Xt軸方向の速度成分)のみになる。これにより、目標面Stよりも下側の領域にバケット10の爪先が侵入しないように、目標面St上またはその上側の領域にバケット10の爪先が保持される。
 このように、目標速度演算部144は、速度ベクトルVcをVcaに変換する制御(以下、方向変換制御とも記す)を行う。方向変換制御では、例えば、操作装置A2によってアームクラウドの操作が単独で行われたときには、アームシリンダ6を伸長させるとともに、ブームシリンダ5を伸長させることにより、速度ベクトルVcをVcaに変換させる。なお、目標速度演算部144は、必要に応じて、アーム9の操作パイロット圧に基づいて演算されるアームシリンダ6の一次目標速度を補正して、一次目標速度よりも低い二次目標速度を演算する。これにより、アームクラウド動作が減速されるので、ブーム上げ動作が間に合わずにバケット10が目標面Stを越えて目標面Stの下方まで地面を掘削してしまうことを防止できる。
 方向変換制御は、ブーム上げまたはブーム下げとアームクラウドとの組み合わせにより実行される場合と、ブーム上げまたはブーム下げとアームダンプとの組み合わせにより実行される場合とがある。いずれの場合においても、目標速度ベクトルVcが目標面Stに接近する下向き成分(Vcy<0)を含むとき、目標速度演算部144は、その下向き成分を打ち消すブーム上げ方向のブームシリンダ5の目標速度を演算する。反対に目標速度ベクトルVcが目標面Stから離れる上向き成分(Vcy>0)を含むとき、目標速度演算部144は、その上向き成分を打ち消すブーム下げ方向のブームシリンダ5の目標速度を演算する。
 なお、モード切替スイッチ96(図4参照)により、マニュアル制御モードが設定されている場合、目標速度演算部144は、操作装置A1~A3の操作に応じた各油圧シリンダ(5~7)の目標速度を演算する。つまり、マニュアル制御モードが設定されている場合、目標速度演算部144は方向変換制御を実行しない。
 -目標パイロット圧演算部-
 図6に示す目標パイロット圧演算部145は、不揮発性メモリ93に記憶されている各油圧シリンダ(5~7)の流量制御弁D1~D3に作用させるパイロット圧と各油圧シリンダ(5~7)の伸縮速度の関係に基づいて、目標速度演算部144で演算された各目標速度を目標パイロット圧に変換する。目標パイロット圧演算部145は、ブーム上げ動作、ブーム下げ動作に対応するブームシリンダ5の目標速度に基づいて目標パイロット圧PiBMU1,PiBMD1を演算する。目標パイロット圧演算部145は、アームクラウド動作、アームダンプ動作に対応するアームシリンダ6の目標速度に基づいて目標パイロット圧PiAMC1,PiAMD1を演算する。目標パイロット圧演算部145は、バケットクラウド動作、バケットダンプ動作に対応するバケットシリンダ7の目標速度に基づいて目標パイロット圧PiBKC1,PiBKD1を演算する。このように、目標パイロット圧演算部145は、目標速度演算部144で演算された目標速度に基づいて、電磁弁54a~56bで生成するパイロット圧の第2の指令値である目標パイロット圧PiBMU1,PiBMD1,PiAMC1,PiAMD1,PiBKC1,PiBKD1を演算する。
 -指令パイロット圧補正部-
 指令パイロット圧補正部146は、姿勢演算部142の演算結果に基づいて、操作量演算部141で演算された各操作パイロット圧PiBMU0,PiBMD0,PiAMC0,PiAMD0,PiBKC0,PiBKD0、及び、目標パイロット圧演算部145で演算された目標パイロット圧PiBMU1,PiBMD1,PiAMC1,PiAMD1,PiBKC1,PiBKD1に対して補正を行うことにより、指令パイロット圧PiBMU2,PiBMD2,PiAMC2,PiAMD2,PiBKC2,PiBKD2を演算する。以下、指令パイロット圧の演算方法について詳しく説明する。
 以下では、操作パイロット圧PiBMU0,PiBMD0,PiAMC0,PiAMD0,PiBKC0,PiBKD0を総称して、操作パイロット圧Pi0と記し、目標パイロット圧PiBMU1,PiBMD1,PiAMC1,PiAMD1,PiBKC1,PiBKD1を総称して、目標パイロット圧Pi1と記す。
 指令パイロット圧補正部146は、操作パイロット圧Pi0がアクチュエータ非駆動相当圧psを超えてアクチュエータ駆動相当圧に達すると(Pi0>ps)、操作パイロット圧Pi0を一時的に高くする補正を行う。指令パイロット圧補正部146は、介入制御が実行されないことを想定し、操作装置A1~A3の操作に応じた制御電流が電磁弁54a~56bに印加されてから油圧シリンダ(5~7)が駆動するまでの遅れ時間を低減するための補正操作パイロット圧PiBMU0’,PiBMD0’,PiAMC0’,PiAMD0’,PiBKC0’,PiBKD0’を演算する。補正操作パイロット圧PiBMU0’,PiBMD0’,PiAMC0’,PiAMD0’,PiBKC0’,PiBKD0’は、各操作パイロット圧PiBMU0,PiBMD0,PiAMC0,PiAMD0,PiBKC0,PiBKD0よりも大きい値である。後述するように、指令パイロット圧補正部146は、補正操作パイロット圧PiBMU0’,PiBMD0’,PiAMC0’,PiAMD0’,PiBKC0’,PiBKD0’を時間の経過とともに操作パイロット圧PiBMU0,PiBMD0,PiAMC0,PiAMD0,PiBKC0,PiBKD0に漸近させる。
 指令パイロット圧補正部146は、目標パイロット圧Pi1がアクチュエータ非駆動相当圧psを超えてアクチュエータ駆動相当圧に達すると(Pi1>ps)、目標パイロット圧Pi1を一時的に高くする補正を行う。指令パイロット圧補正部146は、介入制御が実行されることを想定し、コントローラ140の指令に応じた制御電流が電磁弁54a~56bに印加されてから油圧シリンダ(5~7)が駆動するまでの遅れ時間を駆動対象部材(8~10)の姿勢に関わらず一定にするための補正目標パイロット圧PiBMU1’,PiBMD1’,PiAMC1’,PiAMD1’,PiBKC1’,PiBKD1’を演算する。補正目標パイロット圧PiBMU1’,PiBMD1’,PiAMC1’,PiAMD1’,PiBKC1’,PiBKD1’は、各目標パイロット圧PiBMU1,PiBMD1,PiAMC1,PiAMD1,PiBKC1,PiBKD1よりも大きい値である。後述するように、指令パイロット圧補正部146は、補正目標パイロット圧PiBMU1’,PiBMD1’,PiAMC1’,PiAMD1’,PiBKC1’,PiBKD1’を時間の経過とともに目標パイロット圧PiBMU1,PiBMD1,PiAMC1,PiAMD1,PiBKC1,PiBKD1に漸近させる。
 以下では、補正操作パイロット圧PiBMU0’,PiBMD0’,PiAMC0’,PiAMD0’,PiBKC0’,PiBKD0’を総称して、補正操作パイロット圧Pi0’と記し、補正目標パイロット圧PiBMU1’,PiBMD1’,PiAMC1’,PiAMD1’,PiBKC1’,PiBKD1’を総称して、補正目標パイロット圧Pi1’と記す。
 指令パイロット圧補正部146は、補正操作パイロット圧Pi0’と補正目標パイロット圧Pi1’の調停を行うために、目標面距離Hに応じて制御介入比率(パイロット比率)aを演算する。図8は目標面距離Hと制御介入比率aとの関係を示す図である。図8では、横軸が目標面距離Hを表し、縦軸が制御介入比率aを表している。図8に示すように、制御介入比率aは、目標面距離Hが第2距離H2(例えば1000mm)以上の場合には、0.0となる。制御介入比率aは、目標面距離Hが第1距離H1(例えば300mm)以下の場合には、1.0となる。制御介入比率aは、第1距離H1から第2距離H2の範囲において、目標面距離Hが小さくなるほど大きくなる。図8に示す目標面距離Hと制御介入比率aとの関係は、テーブル形式で不揮発性メモリ93に記憶されている。指令パイロット圧補正部146は、図8に示す比率演算テーブルを参照し、姿勢演算部142で演算された目標面距離Hに基づいて制御介入比率aを演算する。
 図6に示す指令パイロット圧補正部146は、以下の式(3)により、指令パイロット圧Pi2を演算する。
  Pi2=Pi0’×(1-a)+Pi1’×a…(3)
  式(3)により演算された指令パイロット圧Pi2、すなわちPiBMU2,PiBMD2,PiAMC2,PiAMD2,PiBKC2,PiBKD2は、バルブ指令演算部147での演算に用いられる。式(3)で表されるように、制御介入比率aは、補正目標パイロット圧Pi1’及び補正操作パイロット圧Pi0’のそれぞれが、指令パイロット圧Pi2に与える影響度合いを決定するためのパラメータである。制御介入比率aが大きいほど、補正目標パイロット圧Pi1’が指令パイロット圧Pi2に与える影響度合いが大きくなり、補正操作パイロット圧Pi0'が指令パイロット圧Pi2に与える影響度合いが小さくなる。指令パイロット圧補正部146による補正操作パイロット圧Pi0’と、補正目標パイロット圧Pi1’の演算方法の詳細については後述する。
 なお、指令パイロット圧補正部146は、姿勢演算部142の演算結果に基づいて、操作量演算部141で演算された右旋回、左旋回、右走行体前進、右走行体後進、左走行体前進、左走行体後進の操作信号に対応する操作パイロット圧PiSR0,PiSL0,PiRF0,PiRR0,PiLF0,PiLR0に対して補正を行うことにより、指令パイロット圧PiSR2,PiSL2,PiRF2,PiRR2,PiLF2,PiLR2を演算する。
 操作パイロット圧PiSR0,PiSL0,PiRF0,PiRR0,PiLF0,PiLR0に対する補正は、上述したPiBMU0,PiBMD0,PiAMC0,PiAMD0,PiBKC0,PiBKD0に対する補正と同様であるため、説明を省略する。指令パイロット圧補正部146は、右旋回、左旋回、右走行体前進、右走行体後進、左走行体前進、左走行体後進の操作信号に対応する補正後の操作パイロット圧PiSR0’,PiSL0’,PiRF0’,PiRR0’,PiLF0’,PiLR0’を指令パイロット圧PiSR2,PiSL2,PiRF2,PiRR2,PiLF2,PiLR2として演算する。
 -バルブ指令演算部-
 バルブ指令演算部147は、指令パイロット圧補正部146で演算された指令パイロット圧PiBMU2,PiBMD2,PiAMC2,PiAMD2,PiBKC2,PiBKD2,PiSR2,PiSL2,PiRF2,PiRR2,PiLF2,PiLR2に基づき制御電流値を演算する。バルブ指令演算部147は、演算結果に応じた制御電流が電磁弁54a~59bのソレノイドに流れるように、制御信号(駆動電圧)を電磁弁54a~59bに出力する。これにより、電磁弁54a~59bによって指令パイロット圧に相当するパイロット圧が生成される。電磁弁54a~59bにより生成されたパイロット圧が流量制御弁D1~D6の受圧室E1~E12に作用すると、流量制御弁D1~D6が作動する。
 例えば、整地制御モードが設定されている状態で、水平掘削を意図したアームクラウド操作が行われると、バケット10の爪先が目標面Stの下方領域に侵入しないように電磁弁54a,55aが制御される。この場合、オペレータの操作に応じたアームクラウド動作にアームクラウドの減速動作やブーム上げ動作が自動的に合成される。その結果、アームクラウド操作のみで水平掘削動作が行われる。
 -補正操作パイロット圧Pi0’と、補正目標パイロット圧Pi1’-
 指令パイロット圧補正部146による補正操作パイロット圧Pi0’と、補正目標パイロット圧Pi1’の演算方法の詳細について説明する。指令パイロット圧補正部146は、操作パイロット圧Pi0と、目標パイロット圧Pi1がアクチュエータ非駆動相当圧ps(例えば、0.3MPa)を超えたか否かを判定する。アクチュエータ非駆動相当圧psは、油圧アクチュエータ(3a,3b,4~7)が動作し始めるパイロット圧(アクチュエータ駆動相当圧)よりもわずかに小さい圧力であり、予め不揮発性メモリ93に記憶されている。アクチュエータ非駆動相当圧psは、油圧アクチュエータ(3a,3b,4~7)ごとに定められている。
 指令パイロット圧補正部146は、操作パイロット圧Pi0がアクチュエータ非駆動相当圧ps以下の状態からアクチュエータ非駆動相当圧psよりも高い状態に切り換わった場合に、操作パイロット圧Pi0がアクチュエータ非駆動相当圧psを超えたと判定する。指令パイロット圧補正部146は、操作パイロット圧Pi0がアクチュエータ非駆動相当圧psを超えたと判定した時点から操作パイロット圧Pi0を補正する。指令パイロット圧補正部146は、操作パイロット圧Pi0がアクチュエータ非駆動相当圧psを超えると、操作パイロット圧Pi0よりも高い補正操作パイロット圧Pi0’を演算する。
 同様に、指令パイロット圧補正部146は、目標パイロット圧Pi1がアクチュエータ非駆動相当圧ps以下の状態からアクチュエータ非駆動相当圧psよりも高い状態に切り換わった場合に、目標パイロット圧Pi1がアクチュエータ非駆動相当圧psを超えたと判定する。指令パイロット圧補正部146は、目標パイロット圧Pi1がアクチュエータ非駆動相当圧psを超えたと判定した時点から目標パイロット圧Pi1を補正する。指令パイロット圧補正部146は、目標パイロット圧Pi1がアクチュエータ非駆動相当圧psを超えると、目標パイロット圧Pi1よりも高い補正目標パイロット圧Pi1’を演算する。
 図9Aは、操作パイロット圧Pi0と、補正操作パイロット圧Pi0’の時刻歴波形を模式的に示す図である。図9Bは、目標パイロット圧Pi1と、補正目標パイロット圧Pi1’の時刻歴波形を模式的に示す図である。
 図9Aにおいて実線で示すように、操作パイロット圧Pi0は、時点ta0においてアクチュエータ非駆動相当圧psから上昇を始めている。このため、図9Aにおいて破線で示すように、時点ta0から操作パイロット圧Pi0に対する補正が開始される。
 時点ta0は、操作パイロット圧Pi0が、アクチュエータ非駆動相当圧ps以下の状態からアクチュエータ非駆動相当圧psよりも高い状態に切り換わった時刻であり、以下では駆動開始時点と記す。この駆動開始時点ta0から時刻tまでの経過時間をτaとして(すなわちτa=t-ta0)、指令パイロット圧補正部146は、以下の式(4)により、補正操作パイロット圧Pi0’を演算する。
  Pi0’=(Pmax0-Pi0)exp(-Ka・τa)+Pi0…(4)
  補正圧力Pmax0は、t=ta0における出力圧力であり、電磁弁54a~56bの使用範囲における最大出力圧力である。Kaは正の所定値である。関数exp(x)はネイピア数を指数の底とし、xを指数とした指数関数を表す。
 式(4)の右辺第1項には、指数関数exp(-Ka・τa)が含まれており、その指数は駆動開始時点ta0からの経過時間τaと定数値の積で表されている。したがって、駆動開始時点ta0においては、経過時間τa=0であり、指数関数exp(-Ka・τa)は1となるため、補正操作パイロット圧Pi0’は、補正圧力Pmax0となる。
 指数関数exp(-Ka・τa)は、底がexp(-Ka)、指数がτaである。また、Kaは、正の所定値であるため、exp(-Ka)は1よりも小さい値である。したがって、駆動開始時点ta0からの経過時間τaの増加とともに指数関数exp(-Ka・τa)は0(ゼロ)に漸近していく。このため、補正操作パイロット圧Pi0’は、経過時間τaの増加とともに操作パイロット圧Pi0に漸近し、時点ta1ではその差が略0となっている。なお、補正操作パイロット圧Pi0’の操作パイロット圧Pi0への漸近の度合いは、所定値Kaを変更することにより、調整できる。なお、所定値Kaは、各油圧シリンダ(5~7)に対して共通の値を設定してもよいし、油圧シリンダ(5~7)ごとに異なる値を設定してもよい。
 補正圧力Pmax0は、図9Aに示すように、時点ta0から時点ta1の補正を行う制御範囲において、補正操作パイロット圧Pi0’の最大値となる。補正圧力Pmax0は、大きいほど、電磁弁54a~56bに制御電流が印加されてから油圧シリンダ(5~7)が駆動するまでの遅れ時間を小さくすることができる。補正圧力Pmax0は、各油圧シリンダ(5~7)の操作開始時の操作フィーリングに合うように、油圧シリンダ(5~7)ごとに異なるパラメータが設定される。なお、補正圧力Pmax0は、各油圧シリンダ(5~7)に対して共通のパラメータを設定してもよい。
 図9Bにおいて実線で示すように、目標パイロット圧Pi1は、時点tb0においてアクチュエータ非駆動相当圧psから上昇を始めている。このため、図9Bにおいて破線で示すように、時点tb0から目標パイロット圧Pi1に対する補正が開始される。
 時点tb0は、目標パイロット圧Pi1が、アクチュエータ非駆動相当圧ps以下の状態からアクチュエータ非駆動相当圧psよりも高い状態に切り換わった時刻であり、以下では駆動開始時点と記す。この駆動開始時点tb0から時刻tまでの経過時間をτbとして(すなわちτb=t-tb0)、指令パイロット圧補正部146は、以下の式(5)により、補正目標パイロット圧Pi1’を演算する。
  Pi1’=(Pmax1-Pi1)exp(-Kb・τb)+Pi1…(5)
  補正圧力Pmax1は、t=tb0における出力圧力である。Kbは正の所定値である。関数exp(x)はネイピア数を指数の底とし、xを指数とした指数関数を表す。
 式(5)の右辺第1項には、指数関数exp(-Kb・τb)が含まれており、その指数は駆動開始時点tb0からの経過時間τbと定数値の積で表されている。したがって、駆動開始時点tb0においては、経過時間τb=0であり、指数関数exp(-Kb・τb)は1となるため、補正目標パイロット圧Pi1’は、補正圧力Pmax1となる。
 指数関数exp(-Kb・τb)は、底がexp(-Kb)、指数がτbである。また、Kbは、正の所定値であるため、exp(-Kb)は1よりも小さい値である。したがって、駆動開始時点tb0からの経過時間τbの増加とともに指数関数exp(-Kb・τb)は0(ゼロ)に漸近していく。このため、補正目標パイロット圧Pi1’は、経過時間τbの増加とともに目標パイロット圧Pi1に漸近し、時点tb1ではその差が略0となっている。なお、補正目標パイロット圧Pi1’の目標パイロット圧Pi1への漸近の度合いは、所定値Kbを変更することにより、調整できる。なお、所定値Kbは、各油圧シリンダ(5~7)に対して共通の値を設定してもよいし、油圧シリンダ(5~7)ごとに異なる値を設定してもよい。
 補正圧力Pmax1は、図9Bに示すように、時点tb0から時点tb1の補正を行う制御範囲において、補正操作パイロット圧Pi0’の最大値となる。補正圧力Pmax1は、領域制限制御が実施される際に、作業装置1Aの姿勢に関わらず、電磁弁54a~56bに制御電流が印加されてから油圧シリンダ(5~7)が駆動するまでの遅れ時間を一定にするために設定される。補正圧力Pmax1は、作業装置1Aを構成する駆動対象部材(8~10)の姿勢に基づいて演算される。
 補正圧力Pmax1の演算方法について、詳しく説明する。図10は、駆動対象部材(8~10)の動作方向ベクトル及びその重力方向成分を示す図である。図10に示すように、指令パイロット圧補正部146は、姿勢演算部142での演算結果に基づいて、各駆動対象部材(8~10)の動作方向ベクトルVBmU,VBmD,VAmC,VAmD,VBkC,VBkDを演算する。以下、動作方向ベクトルVBmU,VBmD,VAmC,VAmD,VBkC,VBkDを総称して、動作方向ベクトルVDとも記す。
 動作方向ベクトルVBmUは、ブーム上げ動作を想定したブーム8の先端部の動作方向の単位ベクトルである。動作方向ベクトルVBmDは、ブーム下げ動作を想定したブーム8の先端部の動作方向の単位ベクトルである。動作方向ベクトルVBmU,VBmDは、ブームピンとアームピンとを結んだ線分に直交する方向にアームピンから延びている。動作方向ベクトルVAmCは、アームクラウド動作を想定したアーム9の先端部の動作方向の単位ベクトルである。動作方向ベクトルVAmDは、アームダンプ動作を想定したアーム9の先端部の動作方向の単位ベクトルである。動作方向ベクトルVAmC,VAmDは、アームピンとバケットピンとを結んだ線分に直交する方向にバケットピンから延びている。動作方向ベクトルVBkCは、バケットクラウド動作を想定したバケット10の先端部(爪先)の動作方向の単位ベクトルである。動作方向ベクトルVBkDは、バケットダンプ動作を想定したバケット10の先端部(爪先)の動作方向の単位ベクトルである。動作方向ベクトルVBkC,VBkDは、バケットピンとバケット爪先とを結んだ線分に直交する方向にバケット爪先から延びている。
 指令パイロット圧補正部146は、姿勢演算部142の演算結果に基づいて、駆動対象部材(8~10)の動作方向ベクトルの重力方向成分VGBmU,VGBmD,VGAmC,VGAmD,VGBkC,VGBkDを以下の式(6)~(11)により演算する。
  VGBmU=VBmUcos(α+θ)…(6)
  VGBmD=VBmDcos(α+θ)…(7)
  VGAmC=VAmCcos(α+β+θ)…(8)
  VGAmD=VAmDcos(α+β+θ)…(9)
  VGBkC=VBkCcos(α+β+γ+θ)…(10)
  VGBkD=VBkDcos(α+β+γ+θ)…(11)
  αは姿勢演算部142で演算されるブーム角度であり、βは姿勢演算部142で演算されるアーム角度であり、γは姿勢演算部142で演算されるバケット角度であり、θは姿勢演算部142で演算される旋回体12(車体1B)の前後方向の傾斜角度(ピッチ角)である。
 本実施形態では、動作方向ベクトルVDの重力方向成分VGBmU,VGBmD,VGAmC,VGAmD,VGBkC,VGBkDは、重力の向き(鉛直下方向)の場合には負の値となり、重力の向きとは反対方向(鉛直上方向)の場合には正の値となる。動作方向ベクトルVDの重力方向成分VGBmU,VGBmD,VGAmC,VGAmD,VGBkC,VGBkDは-1.0から1.0の数値で表すことができる。以下、動作方向ベクトルVDの重力方向成分VGBmU,VGBmD,VGAmC,VGAmD,VGBkC,VGBkDを総称して、重力方向成分VGとも記す。
 図11は、動作方向ベクトルVDの重力方向成分VGと、補正圧力Pmax1との関係を示す図である。図11では、横軸が動作方向ベクトルVDの重力方向成分VGを表し、縦軸が補正圧力Pmax1を表している。図11に示すように、補正圧力Pmax1は、動作方向ベクトルVDの重力方向成分VGが所定値Vn以下では0(ゼロ)となり、動作方向ベクトルVDの重力方向成分VGが所定値Vp以上ではPx(>0)となる。補正圧力Pmax1は、所定値Vnから所定値Vpの範囲において、動作方向ベクトルVDの重力方向成分VGの値が大きくなるにつれ高くなる。なお、所定値Vnは-1以下の値であり、所定値Vpは1以上の値である。
 図11に示す動作方向ベクトルVDの重力方向成分VGと補正圧力Pmax1との関係は、テーブル形式で不揮発性メモリ93に記憶されている。指令パイロット圧補正部146は、図11に示す補正圧力テーブルを参照し、動作方向ベクトルVDの重力方向成分VGに基づいて、補正圧力Pmax1を演算する。
 指令パイロット圧補正部146は、オペレータによる操作装置A1~A3の操作状態に関わらず、所定の制御周期で繰り返し、動作方向ベクトルVD及びその重力方向成分VG、補正圧力Pmax1を演算する。つまり、指令パイロット圧補正部146は、操作装置A1~A3が操作されていない状態のときも含め、常時、動作方向ベクトルVD及びその重力方向成分VG、補正圧力Pmax1を演算する。
 動作方向ベクトルVDの重力方向成分VGが正の値の場合、駆動対象部材(8~10)は重力に逆らって動作することになる。したがって、補正圧力Pmax1が油圧ショベル1の姿勢に関わらず一定値である場合、正の値の動作方向ベクトルVDの重力方向成分VGが大きくなるほど、電磁弁54a~56bに制御電流が印加されてから油圧シリンダ(5~7)が実際に駆動し始めるまでの遅れ時間が大きくなる。
 動作方向ベクトルVDの重力方向成分VGが負の値の場合、駆動対象部材(8~10)は重力に逆らわずに動作することになる。したがって、補正圧力Pmax1が油圧ショベル1の姿勢に関わらず一定値である場合、負の値の動作方向ベクトルVDの重力方向成分VGが小さくなるほど(重力方向成分VGの絶対値が大きくなるほど)、電磁弁54a~56bに制御電流が印加されてから油圧シリンダ(5~7)が実際に駆動し始めるまでの遅れ時間は小さくなる。
 本実施形態に係るコントローラ140は、目標パイロット圧Pi1がアクチュエータ非駆動相当圧psを超えると、動作方向ベクトルVDの重力方向成分VGが大きいほど補正圧力Pmax1を高くする。これにより、動作方向ベクトルVDの重力方向成分VGに基づいて、目標パイロット圧Pi1が補正される。したがって、動作方向ベクトルVDの重力方向成分VGが大きいほど、電磁弁54a~56bに制御電流が印加されてから油圧シリンダ(5~7)が実際に駆動し始めるまでの遅れ時間を低減することができる。その結果、作業装置1Aの姿勢に関わらず、重力方向に動作するアクチュエータの遅れ時間の均一化を図ることができる。
 図11に示す補正圧力テーブルは、各油圧シリンダ(5~7)の遅れ時間の実測値に基づき、各油圧シリンダ(5~7)の遅れ時間のバランスを考慮して、油圧シリンダ(5~7)ごとに異なるテーブルが設定される。なお、各油圧シリンダ(5~7)に対して共通のテーブルを設定してもよい。
 ここで、本実施形態の比較例として、作業装置1Aの姿勢及び動作方向に関わらず補正圧力Pmax1を一定値とした場合、駆動対象部材(8~10)が重力方向に動作するときには遅れ時間が小さくなり、駆動対象部材(8~10)が重力方向とは反対方向に動作するときには遅れ時間が大きくなる。つまり、比較例では、作業装置1Aの姿勢及び動作方向によって、遅れ時間にばらつきが生じる。このため、作業装置1Aの動き出し時に、精度よく目標面Stに沿って作業装置1Aを動かすことができないおそれがある。
 これに対して本実施形態では、作業装置1Aの姿勢及び動作方向に応じて補正圧力Pmax1が調整される。このため、駆動対象部材の姿勢及び動作方向に関わらず、制御信号が電磁弁54a~56bに出力されてから油圧シリンダ(5~7)が駆動し始めるまでの遅れ時間を一定にすることができ、作業装置1Aの動き出し時に、精度よく目標面Stに沿って作業装置1Aを動かすことができる。
 -効果-
 上述した実施形態によれば、次の作用効果を奏する。
 (1)油圧ショベル(作業機械)1は、複数の油圧アクチュエータ(ブームシリンダ5、アームシリンダ6、バケットシリンダ7)、及び、複数の油圧アクチュエータにより駆動される複数の駆動対象部材(ブーム8、アーム9、バケット10)を有する作業装置1Aと、作業装置1Aの姿勢情報(ブーム角度、アーム角度、バケット角度)及び旋回体12の姿勢情報(車体傾斜角度)を検出する姿勢検出装置50と、複数の油圧アクチュエータに作動油を供給するメインポンプ(油圧ポンプ)2と、メインポンプ2から複数の油圧アクチュエータに供給される作動油の流れを制御する制御弁ユニット61と、制御弁ユニット61を駆動するためのパイロット圧を生成する複数の電磁弁54a~56bを有する電磁弁ユニット62と、電磁弁54a~56bで生成するパイロット圧の指令値である指令パイロット圧Pi2を演算し、指令パイロット圧Pi2に応じた制御信号を電磁弁54a~56bに出力するコントローラ140と、を備える。
 コントローラ140は、操作装置A1~A3の操作量に基づいて、電磁弁54a~56bで生成するパイロット圧の第1の指令値である操作パイロット圧Pi0を演算する。コントローラ140は、作業装置1Aにおいて予め定められた基準点Pbkが、目標面Stに沿って目標面Stを越えないように、電磁弁54a~56bで生成するパイロット圧の第2の指令値である目標パイロット圧Pi1を演算する。さらに、コントローラ140は、操作パイロット圧Pi0及び目標パイロット圧Pi1に基づいて指令パイロット圧Pi2を演算する。
 コントローラ140は、姿勢検出装置50で検出される姿勢情報に基づいて、駆動対象部材(8~10)の動作方向ベクトルVDの重力方向成分VGを演算する。コントローラ140は、目標パイロット圧Pi1が所定圧力(アクチュエータ非駆動相当圧)psを超えると、動作方向ベクトルVDの重力方向成分VGに基づいて、目標パイロット圧Pi1を補正する。コントローラ140は、操作パイロット圧Pi0が所定圧力(アクチュエータ非駆動相当圧)psを超えると、操作パイロット圧Pi0を補正する。コントローラ140は、補正後の目標パイロット圧Pi1’及び補正後の操作パイロット圧Pi0’に基づいて指令パイロット圧Pi2を演算する。コントローラ140は、駆動対象部材(8~10)の動作方向ベクトルVDの重力方向成分VGに応じて演算される補正が加味された指令パイロット圧Pi2に応じた制御信号を複数の電磁弁54a~56bに出力する。
 この構成によれば、作業装置1Aに作用する重力の影響に起因した遅れ時間のばらつきを均一化することにより、作業精度の向上を図ることができる。
 (2)本実施形態では、コントローラ140は、重力の向きとは反対方向(鉛直上方向)の動作方向ベクトルVDの重力方向成分VGを正の値とし、重力の向き(鉛直下方向)の動作方向ベクトルVDの重力方向成分VGを負の値としたとき、動作方向ベクトルVDの重力方向成分VGが大きいほど、パイロット圧の指令値である目標パイロット圧Pi1を高い値に補正する。本実施形態では、コントローラ140は、動作方向ベクトルVDの重力方向成分VGが大きいほど補正圧力Pmax1を高くする。
 コントローラ140は、駆動対象部材(8~10)が重力方向とは反対方向に動作する場合には、駆動対象部材(8~10)が重力方向に動作する場合に比べて、補正後の目標パイロット圧Pi1’の最大値となる補正圧力Pmax1を高くする。これにより、駆動対象部材(8~10)が重力方向とは反対方向に動作する場合の遅れ時間を低減できる。また、駆動対象部材(8~10)が重力方向に動作する場合には、駆動対象部材(8~10)が重力方向とは反対方向に動作する場合に比べて、補正後の目標パイロット圧Pi1’の最大値となる補正圧力Pmax1を低くする。これにより、駆動対象部材(8~10)が重力方向に動作する場合の遅れ時間が過剰に小さくなることを防止できる。したがって、駆動対象部材(8~10)が重力方向とは反対方向に動作する場合の遅れ時間と、駆動対象部材(8~10)が重力方向に動作する場合の遅れ時間を同程度にできる。すなわち、駆動対象部材(8~10)の姿勢及び動作方向に関わらず、遅れ時間を均一にすることができる。その結果、高精度で作業装置1Aを動作させることができる。
 (3)コントローラ140は、補正前の操作パイロット圧Pi0がアクチュエータ非駆動相当圧psを超えると、補正前の操作パイロット圧Pi0よりも高い所定の補正圧力(本実施形態では、補正後の操作パイロット圧Pi0’の最大値)Pmax0を補正後の操作パイロット圧Pi0’として設定し、経過時間τaの増加とともに補正後の操作パイロット圧Pi0’が補正前の操作パイロット圧Pi0に漸近するように、補正後の操作パイロット圧Pi0’を演算する。これにより、マニュアル運転を開始する際、操作装置A1~A3の操作に応じた制御電流が電磁弁54a~56bに印加されてから油圧シリンダ(5~7)が駆動するまでの遅れ時間を低減することができる。さらに、電磁弁54a~56bで生成されるパイロット圧を操作装置A1~A3の操作に応じた操作パイロット圧Pi0に速やかに追従させることができる。その結果、マニュアル運転の際の操作フィーリングが向上し、作業効率を向上することができる。なお、上述したように、駆動対象部材(8~10)ごとに補正圧力Pmax0が設定される場合には、駆動対象部材(8~10)で補正圧力Pmax0を同じにする場合に比べて操作フィーリングを向上することができる。
 (4)コントローラ140は、補正前の目標パイロット圧Pi1がアクチュエータ非駆動相当圧psを超えると、補正前の目標パイロット圧Pi1よりも高い所定の補正圧力(本実施形態では、補正後の目標パイロット圧Pi1'の最大値)Pmax1を補正後の目標パイロット圧Pi1’として設定し、経過時間τbの増加とともに補正後の目標パイロット圧Pi1’が補正前の目標パイロット圧Pi1に漸近するように、補正後の目標パイロット圧Pi1’を演算する。これにより、半自動運転を開始する際、コントローラ140の指令に応じた制御電流が電磁弁54a~56bに印加されてから油圧シリンダ(5~7)が駆動するまでの遅れ時間を低減することができる。さらに、電磁弁54a~56bで生成されるパイロット圧を、目標面Stに沿うように演算された目標パイロット圧Pi1に速やかに追従させることができる。その結果、半自動運転による作業装置1Aの駆動開始時の油圧シリンダ(5~7)の応答性が向上する。なお、上述したように、駆動対象部材(8~10)ごとに補正圧力Pmax1の演算に用いる補正圧力テーブル(図11参照)が設定される場合には、駆動対象部材(8~10)で補正圧力テーブルを同じにする場合に比べて遅れ時間を均一にすることができる。その結果、より高精度で作業装置1Aを動作させることができ、掘削面の加工精度を向上することができる。
 (5)油圧ショベル1は、車体1Bの位置情報を検出する位置検出装置52と、作業装置1Aを操作するための操作装置A1~A3と、を備える。コントローラ140は、目標形状データを取得し、取得した目標形状データ、車体1Bの位置情報及び作業装置1Aの姿勢情報に基づいて目標面Stを設定する。コントローラ140は、操作装置A1~A3の操作量に基づいて、目標面Stに沿うように操作パイロット圧Pi0を演算する。コントローラ140は、作業装置1Aにおいて予め定められた基準点Pbkが、目標面Stに沿って目標面Stを越えないように目標パイロット圧Pi1を演算する。コントローラ140は、作業装置1Aの基準点Pbkから目標面Stまでの距離(目標面距離)Hが小さくなるほど大きくなる制御介入比率aを演算する。コントローラ140は、操作パイロット圧Pi0、目標パイロット圧Pi1、及び、制御介入比率aに基づいて指令パイロット圧Pi2を演算し、指令パイロット圧Pi2に応じた制御信号を電磁弁54a~56bに出力する。コントローラ140は、目標パイロット圧Pi1がアクチュエータ非駆動相当圧psを超えてアクチュエータ駆動相当圧に達すると、動作方向ベクトルVDの重力方向成分VGに基づいて、目標パイロット圧Pi1を補正する。
 式(3)で表されるように、制御介入比率aが大きいほど、補正目標パイロット圧Pi1’が指令パイロット圧Pi2に与える影響度合いが大きくなる。これにより、半自動運転(介入制御による運転)状態とマニュアル運転状態との間で状態が遷移する際に指令パイロット圧Pi2の急変が防止される。その結果、ショックを生じさせることなくスムーズに運転状態の遷移が行われる。
 <第2実施形態>
 図12~図15を参照して、本発明の第2実施形態に係る油圧ショベル1ついて説明する。なお、第1実施形態で説明した構成と同一もしくは相当する構成には同一の参照番号を付し、相違点を主に説明する。
 第2実施形態に係る油圧ショベル1は、第1実施形態に係る油圧ショベル1と同様の構成を有している(図4、図6等参照)。第1実施形態に係る油圧ショベル1では、補正操作パイロット圧Pi0’及び補正目標パイロット圧Pi1’及び制御介入比率aに基づいて、指令パイロット圧Pi2が演算される(式(3)参照)。これに対して、第2実施形態に係る油圧ショベル1では、目標面距離Hが第2距離H2未満の場合であっても、駆動対象部材(8~10)が目標面Stから離れるように動作する場合には、補正操作パイロット圧Pi0’を指令パイロット圧Pi2とする。
 第2実施形態に係る油圧ショベル1のコントローラ140は、目標面Stに対する駆動対象部材(ブーム8、アーム9及びバケット10)の動作方向ベクトルVBmU,VBmD,VAmC,VAmD,VBkC,VBkDの角度φBmU,φBmD,φAmC,φAmD,φBkC,φBkDを演算する。以下では、角度φBmU,φBmD,φAmC,φAmD,φBkC,φBkDを総称して角度φとも記す。
 コントローラ140は、操作装置A1~A3により駆動対象部材(8~10)が操作された場合、操作された駆動対象部材(8~10)の動作方向ベクトルVDの角度φ、及び、制御介入比率aに基づいて、駆動対象部材(8~10)に対する操作が、目標面Stを侵食する方向の操作、すなわち目標面Stに近づく方向の操作であるか否かを判定する。
 コントローラ140は、駆動対象部材(8~10)に対する操作が目標面Stを侵食する方向の操作でないと判定した場合には、操作パイロット圧Pi0に基づいて指令パイロット圧(第1指令パイロット圧)Pi2を演算し、指令パイロット圧(第1指令パイロット圧)Pi2に応じた制御信号を電磁弁54a~56bに出力する。
 コントローラ140は、駆動対象部材(8~10)に対する操作が目標面Stを侵食する方向の操作であると判定した場合には、操作パイロット圧Pi0、目標パイロット圧Pi1、及び、制御介入比率aに基づいて、指令パイロット圧(第2指令パイロット圧)Pi2を演算し、指令パイロット圧(第2指令パイロット圧)Pi2に応じた制御信号を電磁弁54a~56bに出力する。
 以下、図12及び図13を参照して、第2実施形態に係るコントローラ140により行われる処理の内容について詳しく説明する。図12は、目標面距離Hの演算処理から領域制限比率cの演算処理までの流れについて示すフローチャートである。図13は、駆動対象部材の動作方向が加味された指令パイロット圧の演算処理の内容について示すフローチャートである。図12及び図13に示すフローチャートの処理は、例えば、図示しないイグニッションスイッチがオンされることにより開始され、図示しない初期設定が行われた後、所定の制御周期で繰り返し実行される。
 図12に示すように、ステップS105において、姿勢演算部142は、姿勢情報に基づいて、バケット10の基準点Pbkの位置座標を演算する。さらに、姿勢演算部142は、目標面設定部143で演算された目標面Stとバケット10の基準点Pbkとの間の距離である目標面距離Hを演算し、ステップ110へ進む。
 ステップS110において、指令パイロット圧補正部146は、不揮発性メモリ93に記憶されている比率演算テーブル(図8参照)を参照し、ステップS105で演算された目標面距離Hに基づいて制御介入比率aを演算し、ステップS120へ進む。
 ステップS120において、指令パイロット圧補正部146は、まず、目標面Stに対する駆動対象部材(8~10)の動作方向ベクトルVBmU,VBmD,VAmC,VAmD,VBkC,VBkDの角度φBmU,φBmD,φAmC,φAmD,φBkC,φBkDを演算する。
 図14A、図14Bを参照して、目標面Stに対する駆動対象部材の動作方向ベクトルVDの角度φの一例について説明する。図14Aは、バケットダンプ操作時における目標面Stに対するバケット10の動作方向ベクトルVBkDの角度φBkDについて示す図である。図14Bは、バケットクラウド操作時における目標面Stに対するバケット10の動作方向ベクトルVBkCの角度φBkCについて示す図である。
 図14A及び図14Bに示すように、角度φは、動作方向ベクトルVDと目標面ベクトルVstとのなす角度、すなわち動作方向ベクトルVDと目標面ベクトルVstの内積から求められる角度に相当する。目標面ベクトルVstは、目標面Stに平行で、かつ、油圧ショベル1に向かう方向の向きの単位ベクトルである。目標面ベクトルVstを基準として、目標面ベクトルVstから動作方向ベクトルVDまでの図示反時計回りの角度は正の値で表される。目標面ベクトルVstを基準として、目標面ベクトルVstから動作方向ベクトルVDまでの図示時計回りの角度は負の値で表される。
 動作方向ベクトルVBmU,VBmD,VAmC,VAmD,VBkC,VBkDと目標面ベクトルVstのなす角度φBmU,φBmD,φAmC,φAmD,φBkC,φBkDは、動作方向ベクトルVDの始点と目標面ベクトルVstの始点とを重ねた場合に2つのベクトルVD,Vstで作られる角度のうち、-180°以上180°以下の範囲内の値で表される角度である。図14Aに示す例では、バケットダンプ操作時におけるバケット10の動作方向ベクトルVBkDと目標面ベクトルVstのなす角度φBkDは約150°である。図14Bに示す例では、バケットクラウド操作時におけるバケット10の動作方向ベクトルVBkCと目標面ベクトルVstのなす角度φBkCは約-30°である。
 指令パイロット圧補正部146は、動作方向ベクトルVDと目標面ベクトルVstの内積から角度φを演算する。指令パイロット圧補正部146は、角度φBmU,φBmD,φAmC,φAmD,φBkC,φBkDに基づいて目標面侵食率bBmU,bBmD,bAmC,bAmD,bBkC,bBkDを演算する。以下では、目標面侵食率bBmU,bBmD,bAmC,bAmD,bBkC,bBkDを総称して、目標面侵食率bとも記す。
 図15は、目標面Stに対する動作方向ベクトルVDの角度φと目標面侵食率bとの関係を示す図である。図15では、横軸が目標面Stに対する動作方向ベクトルVDの角度φを表し、縦軸が目標面侵食率bを表している。目標面侵食率bは、目標面Stに対する駆動対象部材(8~10)の動作方向を表すパラメータである。目標面侵食率bは、駆動対象部材(8~10)に対する操作が目標面Stを侵食する方向の操作であるか否かを判定するために用いられる。図15に示す目標面侵食率bと角度φとの関係は、予め不揮発性メモリ93にテーブル形式で記憶されている。
 図15に示すように、角度φが-180°以上0°以下である場合、目標面侵食率bは1となる。つまり、作業装置1Aの駆動対象部材(8~10)が目標面Stに対して近づく方向(目標面Stに侵食する方向)に操作された場合には、目標面侵食率bは1となる。換言すれば、駆動対象部材(8~10)が目標面Stから遠ざかる方向(目標面Stに侵食しない方向)に操作された場合には、目標面侵食率bは1未満の値となる。角度φが0°よりも大きくφ1未満の範囲において、目標面侵食率bは角度φが大きくなるほど小さくなる。角度φがφ1以上φ2以下の範囲において、目標面侵食率bは0となる。角度φがφ2よりも大きく180°以下の範囲において、目標面侵食率bは角度φが大きくなるほど大きくなる。
 φ1は、例えば、10°~20°程度の値であり、φ2は、例えば、160°~170°程度の値である。ここで、0°以上180°以下の範囲において、目標面侵食率bが0°となる場合、後述する操作装置A1~A3の操作に応じた駆動対象部材の動作の誤差等の影響により、意図せずに目標面Stにバケット10が接触してしまうおそれがある。これに対して、本実施形態では、0°よりも大きいφ1以上であり、180°よりも小さいφ2以下の範囲において、目標面侵食率bが0となるように、目標面侵食率テーブルが定められている。このため、意図せずに目標面Stにバケット10が接触してしまうことを防止することができる。
 図12に示すステップS120において、指令パイロット圧補正部146は、図15に示す目標面侵食率テーブルを参照し、各角度φBmU,φBmD,φAmC,φAmD,φBkC,φBkDに基づいて目標面侵食率bを演算して、ステップS130へ進む。
 ステップS130において、指令パイロット圧補正部146は、ステップS110で演算された制御介入比率aと、ステップS120で演算された目標面侵食率bのうち、小さい方を選択したものを領域制限比率cとする。つまり、指令パイロット圧補正部146は、目標面侵食率bBmU,bBmD,bAmC,bAmD,bBkC,bBkDのそれぞれを制御介入比率aと比較し、最小値を選択することにより、領域制限比率cBmU,cBmD,cAmC,cAmD,cBkC,cBkDを演算する。以下、具体的に領域制限比率cBmU,cBmD,cAmC,cAmD,cBkC,cBkDの演算方法について説明する。
 指令パイロット圧補正部146は、以下の式(12)により、ブーム上げ操作を想定したブーム8の動作方向ベクトルVBmUから求められた目標面侵食率bBmU、及び、制御介入比率aのうち最小値を選択することで領域制限比率cBmUを演算する。指令パイロット圧補正部146は、以下の式(13)により、ブーム下げ操作を想定したブーム8の動作方向ベクトルVBmDから求められた目標面侵食率bBmD、及び、制御介入比率aのうち最小値を選択することで領域制限比率cBmDを演算する。指令パイロット圧補正部146は、以下の式(14)により、アームクラウド操作を想定したアーム9の動作方向ベクトルVAmCから求められた目標面侵食率bAmC、及び、制御介入比率aのうち最小値を選択することで領域制限比率cAmCを演算する。指令パイロット圧補正部146は、以下の式(15)により、アームダンプ操作を想定したアーム9の動作方向ベクトルVAmDから求められた目標面侵食率bAmD、及び、制御介入比率aのうち最小値を選択することで領域制限比率cAmDを演算する。指令パイロット圧補正部146は、以下の式(16)により、バケットクラウド操作を想定したバケット10の動作方向ベクトルVBkCから求められた目標面侵食率bBkC、及び、制御介入比率aのうち最小値を選択することで領域制限比率cBkCを演算する。指令パイロット圧補正部146は、以下の式(17)により、バケットダンプ操作を想定したバケット10の動作方向ベクトルVBkDから求められた目標面侵食率bBkD、及び、制御介入比率aのうち最小値を選択することで領域制限比率cBkDを演算する。
  cBmU=min(a,bBmU)…(12)
  cBmD=min(a,bBmD)…(13)
  cAmC=min(a,bAmC)…(14)
  cAmD=min(a,bAmD)…(15)
  cBkC=min(a,bBkC)…(16)
  cBkD=min(a,bBkD)…(17)
  以下では、領域制限比率cBmU,cBmD,cAmC,cAmD,cBkC,cBkDを総称して領域制限比率cとも記す。
 領域制限比率cは、目標面距離Hが第1距離H1(例えば、300mm)以下であり、かつ、駆動対象部材(8~10)の動作方向ベクトルVDの角度φが-180°以上0°以下の場合には、1.0となる。領域制限比率cは、目標面距離Hが第1距離H1(例えば、300mm)よりも大きい場合、または、駆動対象部材(8~10)の動作方向ベクトルVDの角度φが0°よりも大きく180°以下の場合には、1.0より小さい値となる。領域制限比率cは、目標面距離Hが第2距離H2(例えば、1000mm)以上の場合、または、駆動対象部材(8~10)の動作方向ベクトルVDの角度φがφ1以上φ2以下の場合には、0.0となる。
 ステップS130において、領域制限比率cBmU,cBmD,cAmC,cAmD,cBkC,cBkDの演算処理が完了すると、図12のフローチャートに示す処理を終了する。つまり、次の制御周期(演算サイクル)におけるステップS105へ進む。このように、コントローラ140は、所定の制御周期で繰り返し領域制限比率cBmU,cBmD,cAmC,cAmD,cBkC,cBkDを演算する。なお、演算された領域制限比率cBmU,cBmD,cAmC,cAmD,cBkC,cBkDは、記憶装置である揮発性メモリ94に記憶される。
 図13に示すように、ステップS140において、操作量演算部141は、操作装置A1~A3の操作方向及び操作量に基づいて、操作パイロット圧Pi0を演算し、ステップS145へ進む。ステップS145において、目標速度演算部144は、姿勢演算部142での演算結果及び操作量演算部141での演算結果に基づいて、各油圧シリンダ(5,6,7)の目標速度を演算し、ステップS150へ進む。ステップS150において、目標パイロット圧演算部145は、ステップS145で演算した目標速度に基づいて目標パイロット圧Pi1を演算し、ステップS155へ進む。
 ステップS155において、指令パイロット圧補正部146は、操作量演算部141での演算結果に基づいて、操作された全ての駆動対象部材の動作方向に応じた領域制限比率cを揮発性メモリ94から読み出し、ステップS160へ進む。例えば、アームクラウド操作が行われた場合には、指令パイロット圧補正部146は、領域制限比率cAmCを揮発性メモリ94から読み出す。また、アームダンプ操作が行われた場合には、指令パイロット圧補正部146は、領域制限比率cAmDを揮発性メモリ94から読み出す。
 ステップS160において、指令パイロット圧補正部146は、ステップS155で揮発性メモリ94から読み出された領域制限比率cに基づいて、駆動対象部材(8~10)に対する操作が目標面Stを侵食する方向の操作であるか否かを判定する。ここで、目標面Stを侵食する方向の操作とは、その操作が継続された場合であって介入制御が実行されなかったとしたら、バケット10の基準点Pbkが目標面Stに侵入することになる操作のことを指す。また、目標面Stを侵食する操作とは、バケット10の基準点Pbkが目標面Stに接近するような操作ともいえる。
 具体的には、指令パイロット圧補正部146は、領域制限比率cが0.0よりも大きいか否かを判定する。ステップS160において、指令パイロット圧補正部146は、領域制限比率cが0.0よりも大きい場合、駆動対象部材(8~10)に対する操作が目標面Stを侵食する方向の操作であると判定してステップS170へ進む。ステップS160において、指令パイロット圧補正部146は、領域制限比率cが0.0以下であると判定した場合(すなわちc=0の場合)、駆動対象部材(8~10)に対する操作が目標面Stを侵入する方向の操作ではないと判定してステップS180へ進む。
 ステップS170において、指令パイロット圧補正部146は、以下の式(18)に基づいて、指令パイロット圧Pi2を演算して図13のフローチャートに示す処理を終了する。
  Pi2=Pi0’×(1-a)+Pi1’×a…(18)
  なお、式(18)は、上述の式(3)と同じ式である。補正操作パイロット圧Pi0'は、補正圧力Pmax0と操作パイロット圧Pi0に基づいて式(4)により演算され、補正目標パイロット圧Pi1'は、補正圧力Pmax1と目標パイロット圧Pi1に基づいて式(5)により演算される。
 ステップS180において、指令パイロット圧補正部146は、以下の式(19)に基づいて、指令パイロット圧Pi2を演算して図13のフローチャートに示す処理を終了する。
  Pi2=Pi0’…(19)
  つまり、指令パイロット圧Pi2は、補正操作パイロット圧Pi0’となる。
 -効果-
 以上のとおり、本第2実施形態に係るコントローラ140は、駆動対象部材(8~10)に対する操作が、目標面Stに近づく方向(目標面Stを侵食する方向)の操作でないと判定した場合(図13のステップS160でNo)には、操作パイロット圧Pi0に基づいて指令パイロット圧(第1指令パイロット圧)Pi2を演算し(図13のステップS180)、指令パイロット圧(第1指令パイロット圧)Pi2に応じた制御信号を電磁弁54a~56bに出力するマニュアル制御を実行する。コントローラ140は、駆動対象部材(8~10)に対する操作が、目標面Stに近づく方向(目標面Stを侵食する方向)の操作であると判定した場合(図13のステップS160でYes)には、操作パイロット圧Pi0、目標パイロット圧Pi1、及び、制御介入比率aに基づいて、指令パイロット圧(第2指令パイロット圧)Pi2を演算し(図13のステップS170)、指令パイロット圧(第2指令パイロット圧)Pi2に応じた制御信号を電磁弁54a~56bに出力する介入制御を実行する。
 本第2実施形態によれば、第1実施形態と同様の作用効果に加え、次の作用効果を奏する。
 (6)操作装置A1~A3の操作が目標面Stを侵食する方向の操作でない場合、補正操作パイロット圧Pi0’が指令パイロット圧(第1指令パイロット圧)Pi2として演算される。したがって、整地制御モードが設定され、バケット10の基準点Pbkが目標面Stに近い場合であっても、バケット10の基準点Pbkが目標面Stから離れるように駆動対象部材(8~10)が操作されるときには、オペレータの意図するとおりに作業装置1Aが動作する。これにより、オペレータに違和感を与えることなく、作業の効率を向上することができる。
 (7)目標面侵食率bは、各駆動対象部材(8~10)の動作方向ベクトルVBmU,VBmD,VAmC,VAmD,VBkC,VBkDと目標面ベクトルVstのなす角度φBmU,φBmD,φAmC,φAmD,φBkC,φBkDに基づいて演算される。領域制限比率cは、制御介入比率a及び目標面侵食率bに基づいて演算され、式(19)を用いたマニュアル制御を実行するか、式(18)を用いた介入制御を実行するかの判定に用いられる。領域制限比率cは、オペレータの操作が開始される前から演算されている(図12参照)。このため、操作開始時点のパイロット圧の調停を簡易に行うことができるので、介入制御とマニュアル制御の切り換わりに起因するショックの発生を防止することができる。
 <第3実施形態>
 図16及び図17を参照して、本発明の第3実施形態に係る油圧ショベル1について説明する。なお、第1実施形態で説明した構成と同一もしくは相当する構成には同一の参照番号を付し、相違点を主に説明する。図16は、第3実施形態に係るコントローラ340の機能ブロック図である。
 第3実施形態に係る油圧ショベル1は、第1実施形態で説明した油圧ショベル1と同様の構成に加え、図16に示すように、駆動対象部材(8~10)の重量情報をコントローラ340に入力する重量入力装置60を備えている。重量入力装置60は、例えば、オペレータにより操作される複数のスイッチ、スティック操作部材等を有する。なお、重量入力装置60は、表示装置53の表示画面上に設けられるタッチセンサとしてもよい。オペレータは、重量入力装置60を操作することにより、駆動対象部材(8~10)の重量情報をコントローラ340に入力することができる。
 コントローラ340は、第1実施形態で説明した機能に加え、重量設定部360としての機能を有する。表示制御部348は、重量入力装置60により重量の入力を開始する操作が行われると、表示装置53にバケット10の種類を選択する画面を表示させる。不揮発性メモリ93には、複数のバケット10の種類と、各バケット10の種類に対応付けられた重量とが予め記憶されている。不揮発性メモリ93には、複数のアーム9の種類と、各アーム9の種類に対応付けられた重量とが予め記憶されている。不揮発性メモリ93には、複数のブーム8の種類と、各ブーム8の種類に対応付けられた重量とが予め記憶されている。
 重量入力装置60は、オペレータによりバケット10の種類の選択操作がなされると、選択されたバケット10の種類を重量情報としてコントローラ340に入力する。重量設定部360は、不揮発性メモリ93を参照し、選択されたバケット10の種類に対応付けられた重量を、現在油圧ショベル1に取り付けられているバケット10の重量(以下、第1設定重量)として設定する。
 重量入力装置60は、オペレータによりアーム9の種類の選択操作がなされると、選択されたアーム9の種類を重量情報としてコントローラ340に入力する。重量設定部360は、不揮発性メモリ93を参照し、選択されたアーム9の種類に対応付けられた重量を、現在油圧ショベル1に取り付けられているアーム9の重量として設定する。さらに、重量設定部360は、設定したアーム9の重量に第1設定重量を加算した重量を、第2設定重量として設定する。
 重量入力装置60は、オペレータによりブーム8の種類の選択操作がなされると、選択されたブーム8の種類を重量情報としてコントローラ340に入力する。重量設定部360は、不揮発性メモリ93を参照し、選択されたブーム8の種類に対応付けられた重量を、現在油圧ショベル1に取り付けられているブーム8の重量として設定する。さらに、重量設定部360は、設定したブーム8の重量に第2設定重量を加算した重量を、第3設定重量として設定する。
 指令パイロット圧補正部346は、重量設定部360で設定された第1~第3設定重量に基づいて、駆動対象部材(8~10)の動作方向ベクトルVDの重力方向成分VGを補正する第1~第3補正係数を演算する。以下では、第1~第3設定重量を総称して設定重量と記し、第1~第3補正係数を総称して補正係数と記す。
 図17を参照して、駆動対象部材(8~10)の動作方向ベクトルVDの重力方向成分VGを補正する補正係数の演算方法について説明する。図17は、補正係数テーブルについて示す図である。補正係数テーブルは、設定重量に対する補正係数が定められたデータテーブルである。不揮発性メモリ93には、第1設定重量と第1補正係数の関係を定める第1補正係数テーブルと、第2設定重量と第2補正係数の関係を定める第2補正係数テーブルと、第3設定重量と第3補正係数の関係を定める第3補正係数テーブルが記憶されている。
 指令パイロット圧補正部346は、第1補正係数テーブルを参照し、第1設定重量に基づいて第1補正係数を演算する。指令パイロット圧補正部346は、第2補正係数テーブルを参照し、第2設定重量に基づいて第2補正係数を演算する。指令パイロット圧補正部346は、第3補正係数テーブルを参照し、第3設定重量に基づいて第3補正係数を演算する。
 図17に示すように、設定重量が第1重量W1以上第2重量W2以下である場合、補正係数は1.0となる。設定重量が第1重量W1未満の場合、設定重量が小さくなるにつれて補正係数も小さくなる。つまり、設定重量が第1重量W1未満である場合、補正係数は1.0未満となる。設定重量が第2重量W2よりも大きい場合、設定重量が大きくなるにつれて補正係数も大きくなる。つまり、設定重量が第2重量W2よりも大きい場合、補正係数は1.0よりも大きい値となる。
 本実施形態では、駆動対象部材(8~10)の特定の種類(使用頻度の高い種類)の重量を基準重量W0として、基準重量W0から所定重量を減算した値が第1重量W1として設定されている。また、基準重量W0から所定重量を加算した値が第2重量W2として設定されている。なお、第1補正係数テーブルにおける基準重量W0は、特定の種類のバケット10の重量である。第2補正係数テーブルにおける基準重量W0は、特定の種類のバケット10の重量と特定の種類のアーム9の重量とを加算した合計重量である。第3補正係数テーブルにおける基準重量W0は、特定の種類のバケット10の重量と特定の種類のアーム9の重量と特定の種類のブーム8の重量とを加算した合計重量である。
 指令パイロット圧補正部346は、第1実施形態と同様、作業装置1Aの姿勢情報及び旋回体12の姿勢情報に基づいて、動作方向ベクトルVDの重力方向成分VGを演算する。指令パイロット圧補正部346は、駆動対象部材(8~10)の動作方向ベクトルVDの重力方向成分VGBmU,VGBmD,VGAmC,VGAmD,VGBkC,VGBkDのそれぞれに、駆動対象部材(8~10)の重量から求められた補正係数を乗算することにより、補正後の重力方向成分VGBmU’,VGBmD’,VGAmC’,VGAmD’,VGBkC’,VGBkD’を演算する。指令パイロット圧補正部346は、図11に示す補正圧力テーブルを参照し、補正後の重力方向成分VGBmU’,VGBmD’,VGAmC’,VGAmD’,VGBkC’,VGBkD’に基づいて、補正圧力Pmax1を演算する。
 第1実施形態では、重力方向成分は、-1以上1以下の範囲の値であった。これに対して、本第3実施形態では、補正後の重力方向成分が、-1よりも小さくなる場合、及び、1よりも大きくなる場合がある。
 -効果-
 以上のとおり、本第3実施形態に係るコントローラ340は、外部装置である重量入力装置60から入力される重量情報に基づいて駆動対象部材(8~10)の重量を設定する。コントローラ340は、駆動対象部材(8~10)の重量に基づいて、動作方向ベクトルVDの重力方向成分VGを補正する。
 本第3実施形態によれば、第1実施形態と同様の作用効果に加え、次の作用効果を奏する。
 (8)本第3実施形態によれば、駆動対象部材(例えば、バケット10)が交換されるなどして設定重量が重くなったり、軽くなったりした場合であっても遅れ時間が変化することを防止できる。駆動対象部材が交換されることにより設定重量が重くなった場合、遅れ時間は以下のとおりとなる。本第3実施形態では、駆動対象部材(例えば、バケット10)が重力方向に操作された場合には、交換前に比べて補正圧力Pmax1が小さくなる。このため、交換前よりも遅れ時間が小さくなることを防止し、交換前後で同程度の遅れ時間とすることができる。駆動対象部材(例えば、バケット10)が重力方向とは反対方向に操作された場合には、交換前に比べて補正圧力Pmax1が大きくなる。このため、交換前よりも遅れ時間が大きくなることを防止し、交換前後で同程度の遅れ時間とすることができる。
 駆動対象部材が交換されることにより設定重量が軽くなった場合、遅れ時間は以下のとおりとなる。本第3実施形態では、駆動対象部材(例えば、バケット10)が重力方向に操作された場合には、交換前に比べて補正圧力Pmax1が大きくなる。このため、交換前よりも遅れ時間が大きくなることを防止し、交換前後で同程度の遅れ時間とすることができる。駆動対象部材(例えば、バケット10)が重力方向とは反対方向に操作された場合には、交換前に比べて補正圧力Pmax1が小さくなる。このため、交換前よりも遅れ時間が小さくなることを防止し、交換前後で同程度の遅れ時間とすることができる。つまり、本第3実施形態によれば、駆動対象部材の動作方向及び重量によらず、遅れ時間を均一にすることできる。その結果、作業装置1Aを高精度で動作させることができる。
 次のような変形例も本発明の範囲内であり、変形例に示す構成と上述の実施形態で説明した構成を組み合わせたり、上述の異なる実施形態で説明した構成同士を組み合わせたり、以下の異なる変形例で説明する構成同士を組み合わせることも可能である。
 <変形例1>
 上記実施形態では、コントローラ140,340が、動作方向ベクトルVDの重力方向成分VGに基づいて、目標パイロット圧Pi1を補正する例について説明したが、本発明はこれに限定されない。コントローラ140,340は、動作方向ベクトルVDの重力方向成分VGに基づいて、操作パイロット圧Pi0を補正してもよい。この構成では、マニュアル操作開始時における作業装置1Aに作用する重力の影響に起因した遅れ時間のばらつきを均一化することができる。その結果、操作フィーリングを向上することができる。つまり、本発明は、MC機能を有していない油圧ショベルにも適用可能であり、操作開始時に操作パイロット圧Pi0を補正することにより、操作開始時の操作フィーリングを向上させ、作業精度を向上させることができる。
 <変形例2>
 上記実施形態では電気式の操作装置A1~A6を備える油圧ショベル1を例に説明したが、本発明はこれに限定されない。油圧パイロット式の操作装置を備え、介入制御が実行可能な油圧ショベル1に本発明を適用してもよい。この油圧ショベル1は、操作装置の減圧弁から操作パイロット圧が出力されるパイロットラインとは別に、コントローラからの制御信号により駆動される電磁弁(電磁比例減圧弁)から目標パイロット圧が出力されるパイロットラインを備えている。この油圧ショベル1では、介入制御が実行される際に目標パイロット圧を上記実施形態と同様に補正することにより、各駆動対象部材の姿勢及び動作方向に関わらず、油圧アクチュエータが駆動し始めるまでの遅れ時間を均一にすることができる。
 <変形例3>
 コントローラ140,340は、自動制御開始時に、動作方向ベクトルVDの重力方向成分VGに基づいて、目標パイロット圧Pi1を補正してもよい。これにより、作業装置1Aに作用する重力の影響に起因した遅れ時間のばらつきを均一化することができる。その結果、油圧ショベル1の自動制御による作業精度の向上を図ることができる。
 <変形例4>
 上記実施形態では、バケット爪先を基準点(制御点)として、制御介入比率aの演算に用いる目標面距離H、及びバケット10の動作方向ベクトルVBkC,VBkDの演算が行われる例について説明したが、本発明はこれに限定されない。例えば、バケット後端側の任意の点を基準点(制御点)として、目標面距離H及びバケット10の動作方向ベクトルVBkC,VBkDの演算を行ってもよい。
 <変形例5>
 旋回体12の左右方向の傾斜角度(ロール角)を加味して旋回体12の動作方向ベクトルの重力方向成分を演算し、その演算結果に基づいて、旋回体12を動作せるための電磁弁57a,57bで生成するパイロット圧の指令値を補正してもよい。
 本変形例に係るコントローラ140は、第1実施形態と同様の構成を有している(図4、図6等参照)。姿勢検出装置50の車体傾斜角度センサ33は、旋回体12の前後方向の傾斜角度(ピッチ角)だけでなく、旋回体12の左右方向の傾斜角度(ロール角)を表す情報を旋回体12の姿勢情報として検出し、その検出結果をコントローラ140に出力する。
 コントローラ140は、姿勢検出装置50で検出される作業装置1Aの姿勢情報及び旋回体12の姿勢情報に基づいて、旋回体12の動作方向ベクトルの重力方向成分を演算する。以下、具体的に説明する。旋回体12の動作方向ベクトルの始点となる旋回体12の基準点は、例えば、作業装置1Aを含む旋回体12の重心の位置である。コントローラ140は、姿勢検出装置50の検出結果と、不揮発性メモリ93に記憶されている各駆動対象部材の重量、旋回体12の重量、各部材の寸法等の情報に基づいて、旋回体12の基準点の位置を演算する。コントローラ140は、旋回中心軸を中心とする円上の旋回体12の基準点における接線方向を動作方向として、動作方向ベクトルを演算する。コントローラ140は、さらに、旋回体12の動作方向ベクトルの重力方向成分を演算する。
 コントローラ140は、電磁弁(モータ用電磁弁)57a,57bで生成され流量制御弁(モータ制御弁)D4の受圧室E7,E8に作用するパイロット圧の指令値である操作パイロット圧が旋回モータ4の非駆動相当圧(所定圧力)を超えて駆動相当圧に達すると、旋回体12の動作方向ベクトルの重力方向成分に基づいて、電磁弁(モータ用電磁弁)57a,57bの操作パイロット圧を補正する。コントローラ140は、電磁弁(モータ用電磁弁)57a,57bの補正後の操作パイロット圧に応じた制御信号を電磁弁(モータ用電磁弁)57a,57bに出力する。
 本変形例5によれば、例えば、旋回体12の左側が右側に比べて下方に位置するように旋回体12が傾いている状態から旋回体12の左旋回を開始する場合と右旋回を開始する場合とで、操作装置A4に応じた制御電流が電磁弁57a,57bに印加されてから旋回モータ4が駆動するまでの遅れ時間を均一化できる。
 <変形例6>
 上記実施形態では、バケット10がアーム9に対して一方向にのみ回動可能に連結される構成について説明したが、本発明はこれに限定されない。バケット10は、アーム9に対して複数方向に回動可能に連結されていてもよい。例えば、バケット10は、バケットピンの中心軸方向を第1方向としたときに、第1方向に直交する第2方向に回動可能であり、かつ、第1方向及び第2方向に直交する第3方向に回動可能である構成としてもよい。この場合、コントローラは、領域制限制御を実行する際に、バケット10の第2方向への操作(チルト操作)及び第3方向への操作(ロータリー操作)に応じた操作パイロット圧を上記実施形態と同様に補正してもよい。
 <変形例7>
 目標面データ入力装置51は、オペレータが、目標面を表す複数の座標値を入力可能なスイッチ、キーボード等の入力装置であってもよい。目標面データ入力装置51は、オペレータの操作に基づいてコントローラ140からバケット10の爪先の位置を取得し、その位置からの深さを表す数値の入力操作が行われることによって、目標面を表す座標値をコントローラ140に入力可能な装置であってもよい。
 <変形例8>
 上記実施形態では、作業機械が油圧ショベル1である例について説明したが、本発明はこれに限定されない。本発明は、油圧アクチュエータ、油圧ポンプから油圧アクチュエータへ供給される作動油の流れを制御する制御弁、及び、制御弁にパイロット圧を出力する電磁弁を備えた種々の作業機械に適用することができる。
 <変形例9>
 コントローラ140,340に係る各構成、当該各構成の機能及び実行処理等は、それらの一部または全部をハードウェア(例えば各機能を実行するロジックを集積回路で設計する等)で実現してもよい。
 <変形例10>
 上記実施形態では、説明に必要であると解される制御線、情報線を示したが、必ずしも製品に係る全ての制御線、情報線を示しているとは限らない。実際には殆ど全ての構成が相互に接続されていると考えてよい。
 以上、本発明の実施形態について説明したが、上記実施形態は本発明の適用例の一部を示したに過ぎず、本発明の技術的範囲を上記実施形態の具体的構成に限定する趣旨ではない。
 1…油圧ショベル、1A…作業装置、1B…車体(機体)、2…メインポンプ(油圧ポンプ)、4…旋回モータ(油圧モータ)、5…ブームシリンダ(油圧アクチュエータ)、6…アームシリンダ(油圧アクチュエータ)、7…バケットシリンダ(油圧アクチュエータ)、8…ブーム(駆動対象部材)、9…アーム(駆動対象部材)、10…バケット(駆動対象部材)、11…走行体、12…旋回体、18…エンジン、30…ブーム角度センサ(姿勢センサ)、31…アーム角度センサ(姿勢センサ)、32…バケット角度センサ(姿勢センサ)、33…車体傾斜角度センサ(姿勢センサ)、48…パイロットポンプ、50…姿勢検出装置、51…目標面データ入力装置、52…位置検出装置、53…表示装置、54a,54b,55a,55b,56a,56b…電磁弁、57a,57b…電磁弁(モータ用電磁弁)、58a,58b,59a,59b…電磁弁、60…重量入力装置、61…制御弁ユニット、62…電磁弁ユニット、92…プロセッサ、93…不揮発性メモリ(記憶装置)、94…揮発性メモリ(記憶装置)、96…モード切替スイッチ、140…コントローラ、141…操作量演算部、142…姿勢演算部、143…目標面設定部、144…目標速度演算部、145…目標パイロット圧演算部、146…指令パイロット圧補正部、147…バルブ指令演算部、148…表示制御部、149…アクチュエータ制御部、340…コントローラ、346…指令パイロット圧補正部、348…表示制御部、360…重量設定部、A1~A6…操作装置、a…制御介入比率、b…目標面侵食率、c…領域制限比率、D1~D3…流量制御弁、D4…流量制御弁(モータ制御弁)、D5,D6…流量制御弁、G1…GNSSアンテナ、G2…GNSSアンテナ、H…目標面距離、O…原点、Pbk…基準点、Pi0…操作パイロット圧、Pi0’…補正操作パイロット圧、Pi1…目標パイロット圧、Pi1’…補正目標パイロット圧、Pi2…指令パイロット圧、Pmax0,Pmax1…補正圧力、ps…所定圧力(アクチュエータ非駆動相当圧)、St…目標面、VD…動作方向ベクトル、VG…動作方向ベクトルの重力成分、Vst…目標面ベクトル、α…ブーム角度、β…アーム角度、γ…バケット角度、θ…傾斜角度(ピッチ角)、φ…目標面に対する動作方向ベクトルの角度

Claims (8)

  1.  複数の油圧アクチュエータ、及び、前記複数の油圧アクチュエータにより駆動される複数の駆動対象部材を有する作業装置と、
     前記作業装置の姿勢情報を検出する姿勢検出装置と、
     前記複数の油圧アクチュエータに作動油を供給する油圧ポンプと、
     前記油圧ポンプから前記複数の油圧アクチュエータに供給される作動油の流れを制御する制御弁ユニットと、
     前記制御弁ユニットを駆動するためのパイロット圧を生成する複数の電磁弁を有する電磁弁ユニットと、
     前記電磁弁で生成するパイロット圧の指令値を演算し、前記指令値に応じた制御信号を前記電磁弁に出力するコントローラと、を備えた作業機械において、
     前記コントローラは、
     前記姿勢検出装置で検出される姿勢情報に基づいて、前記駆動対象部材の動作方向ベクトルの重力方向成分を演算し、
     前記指令値が所定圧力を超えると、前記動作方向ベクトルの重力方向成分に基づいて前記パイロット圧の指令値を補正し、
     補正後の前記指令値に応じた制御信号を前記電磁弁に出力する
     ことを特徴とする作業機械。
  2.  請求項1に記載の作業機械において、
     前記コントローラは、重力の向きとは反対方向の前記動作方向ベクトルの重力方向成分を正の値とし、重力の向きの前記動作方向ベクトルの重力方向成分を負の値としたとき、前記動作方向ベクトルの重力方向成分が大きいほど、前記パイロット圧の指令値を高い値に補正する
     ことを特徴とする作業機械。
  3.  請求項2に記載の作業機械において、
     前記コントローラは、補正前の前記指令値が前記所定圧力を超えると、前記補正前の前記指令値よりも高い所定の補正圧力を前記補正後の指令値として設定し、経過時間の増加とともに前記補正後の指令値が前記補正前の指令値に漸近するように、前記補正後の指令値を演算する
     ことを特徴とする作業機械。
  4.  請求項3に記載の作業機械において、
     前記コントローラは、前記動作方向ベクトルの重力方向成分が大きいほど、前記補正圧力を高くする、
     ことを特徴とする作業機械。
  5.  請求項1に記載の作業機械において、
     前記コントローラは、
     外部装置から入力される重量情報に基づいて前記駆動対象部材の重量を設定し、
     前記駆動対象部材の重量に基づいて、前記動作方向ベクトルの重力方向成分を補正する
     ことを特徴とする作業機械。
  6.  請求項1に記載の作業機械において、
     前記作業機械の車体の位置情報を検出する位置検出装置と、
     前記作業装置を操作するための操作装置と、を備え、
     前記コントローラは、
     目標形状データを取得し、
     取得した前記目標形状データ、前記車体の位置情報及び前記作業装置の姿勢情報に基づいて目標面を設定し、
     前記操作装置の操作量に基づいて、前記目標面に沿うように操作パイロット圧を演算し、
     前記作業装置において予め定められた基準点が、前記目標面に沿って前記目標面を越えないように目標パイロット圧を演算し、
     前記作業装置の前記基準点から前記目標面までの距離が小さくなるほど大きくなる制御介入比率を演算し、
     前記操作パイロット圧、前記目標パイロット圧、及び、前記制御介入比率に基づいて、指令パイロット圧を演算し、
     前記指令パイロット圧に応じた制御信号を前記電磁弁に出力し、
     前記目標パイロット圧が前記所定圧力を超えると、前記動作方向ベクトルの重力方向成分に基づいて、前記目標パイロット圧を補正し、
     前記制御介入比率が大きいほど、前記目標パイロット圧が前記指令パイロット圧に与える影響度合いが大きくなる
     ことを特徴とする作業機械。
  7.  請求項6に記載の作業機械において、
     前記コントローラは、
     前記目標面に対する前記駆動対象部材の動作方向ベクトルの角度を演算し、
     前記操作装置により前記駆動対象部材が操作された場合、操作された前記駆動対象部材の動作方向ベクトルの前記角度、及び、前記制御介入比率に基づいて、前記駆動対象部材に対する操作が前記目標面に近づく方向の操作であるか否かを判定し、
     前記駆動対象部材に対する操作が前記目標面に近づく方向の操作でないと判定した場合には、前記操作パイロット圧に基づいて第1指令パイロット圧を演算し、前記第1指令パイロット圧に応じた制御信号を前記電磁弁に出力し、
     前記駆動対象部材に対する操作が前記目標面に近づく方向の操作であると判定した場合には、前記操作パイロット圧、前記目標パイロット圧、及び、前記制御介入比率に基づいて、第2指令パイロット圧を演算し、前記第2指令パイロット圧に応じた制御信号を前記電磁弁に出力する
     ことを特徴とする作業機械。
  8.  請求項1に記載の作業機械において、
     走行体と、
     前記走行体に旋回可能に取り付けられた旋回体と、
     前記旋回体を駆動する油圧モータと、
     前記旋回体に取り付けられた前記作業装置と、を備え、
     前記制御弁ユニットは、前記油圧ポンプから前記油圧モータに供給される作動油の流れを制御するモータ制御弁を有し、
     前記電磁弁ユニットは、前記モータ制御弁を駆動するためのパイロット圧を生成するモータ用電磁弁を有し、
     前記姿勢検出装置は、前記旋回体の姿勢情報を検出し、
     前記コントローラは、
     前記姿勢検出装置で検出される前記作業装置の姿勢情報及び前記旋回体の姿勢情報に基づいて、前記旋回体の動作方向ベクトルの重力方向成分を演算し、
     前記モータ用電磁弁で生成するパイロット圧の指令値が所定圧力を超えると、前記旋回体の動作方向ベクトルの重力方向成分に基づいて、前記モータ用電磁弁のパイロット圧の指令値を補正し、
     前記モータ用電磁弁の補正後の前記指令値に応じた制御信号を前記モータ用電磁弁に出力する
     ことを特徴とする作業機械。
PCT/JP2022/033805 2021-09-30 2022-09-08 作業機械 WO2023053900A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
KR1020237029445A KR20230136647A (ko) 2021-09-30 2022-09-08 작업 기계
EP22875772.0A EP4283049A1 (en) 2021-09-30 2022-09-08 Work machine
CN202280017828.0A CN116917578A (zh) 2021-09-30 2022-09-08 作业机械

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2021161526A JP7269301B2 (ja) 2021-09-30 2021-09-30 作業機械
JP2021-161526 2021-09-30

Publications (1)

Publication Number Publication Date
WO2023053900A1 true WO2023053900A1 (ja) 2023-04-06

Family

ID=85782378

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2022/033805 WO2023053900A1 (ja) 2021-09-30 2022-09-08 作業機械

Country Status (5)

Country Link
EP (1) EP4283049A1 (ja)
JP (1) JP7269301B2 (ja)
KR (1) KR20230136647A (ja)
CN (1) CN116917578A (ja)
WO (1) WO2023053900A1 (ja)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1995033100A1 (fr) * 1994-06-01 1995-12-07 Hitachi Construction Machinery Co., Ltd. Dispositif de commande d'excavation a limitation de surface pour engins de terrassement
JPH108492A (ja) * 1996-06-27 1998-01-13 Hitachi Constr Mach Co Ltd 建設機械の領域制限掘削制御装置
WO2016035898A1 (ja) * 2015-09-25 2016-03-10 株式会社小松製作所 作業機械の制御装置、作業機械、及び作業機械の制御方法
JP2018528899A (ja) 2015-10-08 2018-10-04 ローベルト ボッシュ ゲゼルシャフト ミット ベシュレンクテル ハフツング 電磁弁を制御するための方法および対応する流体システム
WO2019012700A1 (ja) * 2017-07-14 2019-01-17 株式会社小松製作所 作業機械および作業機械の制御方法
WO2019202673A1 (ja) * 2018-04-17 2019-10-24 日立建機株式会社 作業機械
JP2021004540A (ja) * 2019-06-27 2021-01-14 日立建機株式会社 油圧ショベル

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR102047355B1 (ko) 2016-07-14 2019-11-21 휴렛-팩커드 디벨롭먼트 컴퍼니, 엘.피. 화상형성장치 및 화상형성장치의 제어 방법

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO1995033100A1 (fr) * 1994-06-01 1995-12-07 Hitachi Construction Machinery Co., Ltd. Dispositif de commande d'excavation a limitation de surface pour engins de terrassement
JPH108492A (ja) * 1996-06-27 1998-01-13 Hitachi Constr Mach Co Ltd 建設機械の領域制限掘削制御装置
WO2016035898A1 (ja) * 2015-09-25 2016-03-10 株式会社小松製作所 作業機械の制御装置、作業機械、及び作業機械の制御方法
JP2018528899A (ja) 2015-10-08 2018-10-04 ローベルト ボッシュ ゲゼルシャフト ミット ベシュレンクテル ハフツング 電磁弁を制御するための方法および対応する流体システム
WO2019012700A1 (ja) * 2017-07-14 2019-01-17 株式会社小松製作所 作業機械および作業機械の制御方法
WO2019202673A1 (ja) * 2018-04-17 2019-10-24 日立建機株式会社 作業機械
JP2021004540A (ja) * 2019-06-27 2021-01-14 日立建機株式会社 油圧ショベル

Also Published As

Publication number Publication date
KR20230136647A (ko) 2023-09-26
JP7269301B2 (ja) 2023-05-08
CN116917578A (zh) 2023-10-20
JP2023051071A (ja) 2023-04-11
EP4283049A1 (en) 2023-11-29

Similar Documents

Publication Publication Date Title
JP6633464B2 (ja) 作業機械
KR101668199B1 (ko) 작업 차량
JP5732598B1 (ja) 作業車両
JPWO2018051511A1 (ja) 作業機械
KR102443900B1 (ko) 작업 기계
KR20180102137A (ko) 작업 기계
WO2018101313A1 (ja) 作業機制御装置および作業機械
WO2017203845A1 (ja) 作業機械
JP6731557B2 (ja) 作業機械
JP6817457B2 (ja) 作業機械
CN113454293B (zh) 作业机械
KR20190062584A (ko) 작업 기계
KR102520408B1 (ko) 작업 기계
WO2019202673A1 (ja) 作業機械
JP7269301B2 (ja) 作業機械
WO2022163168A1 (ja) 作業機械
US11970840B2 (en) Work machine
KR20210114024A (ko) 작업 기계
JP7149917B2 (ja) 作業機械
CN111201350B (zh) 作业机械
WO2021059931A1 (ja) 作業機械
JP2023138083A (ja) 作業機械

Legal Events

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

Ref document number: 22875772

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 22 875 772.0

Country of ref document: EP

Ref document number: 2022875772

Country of ref document: EP

ENP Entry into the national phase

Ref document number: 20237029445

Country of ref document: KR

Kind code of ref document: A

WWE Wipo information: entry into national phase

Ref document number: 18279224

Country of ref document: US

Ref document number: 202280017828.0

Country of ref document: CN

ENP Entry into the national phase

Ref document number: 2022875772

Country of ref document: EP

Effective date: 20230825