WO2020003994A1 - 作業機械 - Google Patents

作業機械 Download PDF

Info

Publication number
WO2020003994A1
WO2020003994A1 PCT/JP2019/022947 JP2019022947W WO2020003994A1 WO 2020003994 A1 WO2020003994 A1 WO 2020003994A1 JP 2019022947 W JP2019022947 W JP 2019022947W WO 2020003994 A1 WO2020003994 A1 WO 2020003994A1
Authority
WO
WIPO (PCT)
Prior art keywords
control
speed
input
actuator
change
Prior art date
Application number
PCT/JP2019/022947
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 US16/979,281 priority Critical patent/US11913198B2/en
Priority to KR1020207023887A priority patent/KR102443900B1/ko
Priority to CN201980014750.5A priority patent/CN111771027B/zh
Priority to EP19826906.0A priority patent/EP3816350B1/en
Publication of WO2020003994A1 publication Critical patent/WO2020003994A1/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/2278Hydraulic circuits
    • E02F9/2285Pilot-operated systems
    • 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/2004Control mechanisms, e.g. control levers
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2025Particular purposes of control systems not otherwise provided for
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2025Particular purposes of control systems not otherwise provided for
    • E02F9/2041Automatic repositioning of implements, i.e. memorising determined positions of the implement
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2203Arrangements for controlling the attitude of actuators, e.g. speed, floating function
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2203Arrangements for controlling the attitude of actuators, e.g. speed, floating function
    • E02F9/2207Arrangements for controlling the attitude of actuators, e.g. speed, floating function for reducing or compensating oscillations
    • 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/267Diagnosing or detecting failure of vehicles
    • E02F9/268Diagnosing or detecting failure of vehicles with failure correction follow-up actions
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/30Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom
    • E02F3/32Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets with a dipper-arm pivoted on a cantilever beam, i.e. boom working downwardly and towards the machine, e.g. with backhoes
    • 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/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
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2278Hydraulic circuits
    • E02F9/2292Systems with two or more pumps

Definitions

  • the present invention relates to a working machine capable of operating a working device according to predetermined conditions.
  • a work machine including a hydraulic excavator has a control function that acquires the position and orientation of an articulated working device using a sensor, and moves an attachment attached to the tip of the working device along the target shape to be constructed.
  • Control is sometimes called machine control or semi-automatic control).
  • Such a work machine is, like other general work machines, a manual control for controlling the work device based on an input from an operator to an operation device (for example, an operation lever) (hereinafter referred to as “first control”). )
  • first control for example, an operation lever
  • semi-automatic control that controls the working device according to predetermined conditions during operation of the operating device by the operator irrespective of the operation or by using a part of the operation (in this paper, "second control"). May be referred to).
  • Patent Document 1 when the control is switched to manual control while the semi-automatic control is operating the working device upward, or immediately after the switching, the operator inputs an operation for operating the working device downward, Since the working device rises for a certain period of time contrary to the operation of the operator, the operator may feel uncomfortable.
  • the reduction rate is equal to or greater than the reduction rate when the moving speed of the working device at the time of control switching is the threshold.
  • the moving speed of the working device is changed. More specifically, when the moving speed of the working device at the time of the control switching is equal to or higher than the threshold value, the time t required from the time of the control switching to the time at which the moving speed of the working device becomes zero (that is, the control after the switching is regulated In which the working device starts operating in the direction in which the working device starts moving, in other words, the time during which the working device does not operate in the direction defined by the control after switching) is always a constant time tc. Is changing. Thus, when the moving speed of the working device at the time of switching is equal to or higher than the threshold value, the time for performing the reverse movement of the control after switching is shortened and made constant, thereby suppressing an uncomfortable feeling of the operator. I have.
  • the limit value of the change amount (decrease rate) of the speed of the working device is determined at the time of control switching, and does not change at least until the speed of the working device once reaches zero. Therefore, for example, even after the control is switched, even if the operator inputs an operation intended to stop the working device (for example, returning the operating lever to the neutral position) to the operating device in order to stop the working device promptly, There is a case where a state where the operation is not stopped immediately and continues to operate for a certain period of time against the intention of the operator occurs, and the operator may still feel uncomfortable.
  • the present application includes a plurality of means for solving the above-mentioned problems.
  • a working device an actuator for driving the working device, an operating device for operating the actuator, and The first control for controlling the actuator based on the input of the operation device; and the second control for controlling the actuator based on a distance between a predetermined design surface and the working device during operation of the operation device.
  • a controller for controlling the actuator by one of the two controls wherein the controller switches between the two controls based on an input of a state switching signal, and the speed of the actuator defines a control before switching among the two controls.
  • the actuator at that time The time change rate limit of the speed is set to a first change rate, and the two controls are switched based on the input of the state switching signal, and the speed of the actuator is set to the speed specified by the control after the switch. If the input to the operating device changes before the change, the time change rate of the speed of the actuator is changed from the first change rate to a second change rate larger than the first change rate.
  • ADVANTAGE OF THE INVENTION while switching a control, it can suppress that a vehicle body becomes in an unstable state, and can advance the timing which an operator's operation is reflected on operation
  • FIG. 1 is a perspective view of a hydraulic shovel according to a first embodiment.
  • FIG. 1 is a configuration diagram of a hydraulic system of a hydraulic shovel according to a first embodiment.
  • FIG. 2 is a functional block diagram of a vehicle body controller, a guidance controller, a GNSS controller, and a guidance monitor according to the first embodiment.
  • FIG. 4 is a diagram illustrating a relationship between a distance d and a speed correction coefficient k in semi-automatic control.
  • FIG. 4 is a schematic diagram illustrating velocity vectors before and after correction according to a distance d at the tip of a bucket. The figure which shows the hydraulic shovel and design data which concern on 1st Embodiment.
  • FIG. 1 is a perspective view of a hydraulic shovel according to a first embodiment.
  • FIG. 1 is a configuration diagram of a hydraulic system of a hydraulic shovel according to a first embodiment.
  • FIG. 2 is a functional block diagram of a vehicle body controller, a guidance controller
  • FIG. 2 is a diagram illustrating an orthogonal posture of the hydraulic shovel according to the first embodiment.
  • 4 is a flowchart illustrating a flow of semi-automatic control of the hydraulic shovel according to the first embodiment.
  • 5 is a flowchart illustrating a flow of speed transition control of the hydraulic shovel according to the first embodiment.
  • 4 is a flowchart illustrating a flow of manual control of the hydraulic shovel according to the first embodiment.
  • FIG. 3 is a diagram illustrating a change in a boom cylinder speed of the hydraulic shovel according to the first embodiment.
  • 9 is a flowchart illustrating a flow of speed transition control of the hydraulic shovel according to the second embodiment.
  • FIG. 8 is a diagram illustrating a change in a boom cylinder speed of the hydraulic shovel according to the second embodiment.
  • FIG. 8 is a diagram illustrating a change in a boom cylinder speed of the hydraulic shovel according to the second embodiment.
  • a hydraulic excavator will be described as an example of a working machine.
  • the working machine in the present invention is not limited to a hydraulic shovel, but may be applied to another working machine having a working device such as a bulldozer.
  • a working machine according to a first embodiment will be described with reference to FIGS. 1 to 7.
  • Fig. 1 shows the external appearance of a hydraulic shovel according to the first embodiment.
  • the excavator 1 includes a lower traveling body 12 including a crawler driven by a traveling hydraulic motor (not shown), an upper revolving body 11 rotatably mounted on the upper part of the lower traveling body 12, and a A multi-joint type working device (front working device) 4 that is rotatably attached to the front and performs work such as excavation is provided.
  • the upper swing body 11 is driven to rotate relative to the lower traveling body 12 by a swing hydraulic motor 19 (shown in FIG. 2).
  • the working device 4 includes a boom 13, an arm 14, a bucket 15, and a boom cylinder 18 a that drives a bucket link 16, 17, which is one of elements constituting a four-bar link mechanism between the arm 14 and the bucket 15, and the boom 13.
  • An arm cylinder 18b for driving the arm 14, and a bucket cylinder 18c for driving the bucket 15 via the bucket links 16 and 17 (the boom cylinder 18a, the arm cylinder 18b, and the bucket cylinder 18c are collectively referred to as a hydraulic cylinder 18 as appropriate). It is configured.
  • One end (base end) of the boom 13 is rotatably supported by the upper swing body 11.
  • the bottom side (base end side) of the boom cylinder 18a is rotatably supported by the upper swing body 11, and the rod side (distal end side) of the boom cylinder 18a is rotatably supported by the boom 13.
  • the boom 13 is driven to rotate relative to the upper swing body 11 in accordance with the expansion and contraction of the boom cylinder 18a.
  • One end (base end) of the arm 14 is rotatably supported by the other end (tip) of the boom 13.
  • the bottom side (base end side) of the arm cylinder 18 b is rotatably supported by the boom 13, and the rod side (top end side) of the arm cylinder 18 b is rotatably supported by the arm 14.
  • the arm 14 is driven to rotate relative to the boom 13 in accordance with the expansion and contraction of the arm cylinder 18b.
  • the bucket 15 is rotatably supported by the other end (tip) of the arm 14.
  • One end of the bucket link 16 is also rotatably supported by the tip of the arm 14.
  • the other end of the bucket link 16 is rotatably supported by one end of the bucket link 17, and the other end of the bucket link 17 is rotatably supported by the bucket 15.
  • the bottom side (base end side) of the bucket cylinder 18c is rotatably supported by the arm 14, and the rod side (top end side) of the bucket cylinder 18c is rotatably supported by the bucket link 16.
  • the arm 14, the bucket links 16, 17, and the bucket 15 constitute a four-node link mechanism, and the bucket link 16 is driven to rotate relative to the arm 14 in accordance with expansion and contraction of the bucket cylinder 18c.
  • the bucket 15 constituting the four-bar linkage is also driven to rotate relative to the arm 14.
  • the hydraulic excavator 1 having such a configuration drives the boom cylinder 18a, the arm cylinder 18b, and the bucket cylinder 18c to an appropriate stroke length, thereby driving the bucket 15 to an arbitrary position and posture, excavation, etc. Desired work can be performed.
  • the boom 13, the arm 14, and the bucket (work implement) 15 may be respectively referred to as front members.
  • the boom 13, the arm 14, and the bucket 15 operate on a plane including the working device 4, and this plane may be hereinafter referred to as an operation plane. That is, the operating plane is a plane orthogonal to the rotation axis of the boom 13, the arm 14, and the bucket 15, and is, for example, the center in the width direction of the boom 13, the arm 14, and the bucket 15 (that is, the front members 13, 14, 15). (The center of the rotation axis).
  • GNSS Global Navigation Satellite System
  • the GNSS antenna 2 receives signals (radio waves) from a plurality of GNSS satellites (not shown) located above the earth, sends the obtained signals to a GNSS controller 53 (shown in FIG. 2), At 53, the position of each antenna 2a, 2b is calculated from these signals.
  • ⁇ Attached to the upper swing body 11 is a vehicle body IMU 3a (Inertial Measurement Unit, inertial measurement device) for measuring the inclination (inclination angle) of the upper swing body 11.
  • the boom 13 has a boom IMU 3b for measuring the tilt (tilt angle) of the boom 13
  • the arm 14 has an arm IMU 3c for measuring the tilt (tilt angle) of the arm 14, and the bucket link 16 has a bucket link.
  • a bucket IMU 3d for measuring the inclination (inclination angle) of 16 is attached (IMUs 3a to 3d are collectively referred to as IMU 3 as appropriate).
  • the IMU 3 is a sensor unit that can measure acceleration and angular velocity, and information acquired by the IMU 3 is output to the guidance controller 52 (shown in FIG. 2).
  • the IMU 3 can function as a posture sensor of the working device 4.
  • FIG. 2 is a configuration diagram of a hydraulic system of the hydraulic shovel according to the first embodiment.
  • the hydraulic excavator 1 includes an engine 41 and hydraulic pumps 42 and 43.
  • the hydraulic pumps 42 and 43 are driven by the engine 41 and supply the pressure oil pumped from the tank into the hydraulic circuit.
  • the hydraulic excavator 1 controls an operation device 44 including a plurality of operation levers 44 a to 44 d and a flow rate and a direction of hydraulic oil supplied to a hydraulic actuator including a hydraulic cylinder 18 and a hydraulic motor 19 mounted on the hydraulic excavator 1.
  • Direction control valve 45 a plurality of control valves (electromagnetic valves) 47 for controlling the pressure of pilot oil applied to the direction control valve 45, and a control signal for the plurality of control valves 47, which controls the body of the excavator 1. (A command current or a command voltage), and controls a monitor (guidance monitor) 54 and a speaker (sound output device) 55 for guidance provided in the driver's seat of the excavator 1.
  • Reference numeral 51 denotes a trigger for switching the position information of the working device 4, the position information of the design surface 60, and the control of the hydraulic cylinder 18.
  • the guidance controller 52 for outputting a state switching signal or the like to be provided with a GNSS controller 53 for calculating the two positions of the GNSS antenna 2.
  • the operating device 44 includes an arm operating lever 44a for operating the arm 14 (arm cylinder 18b), a boom operating lever 44b for operating the boom 13 (boom cylinder 18a), and a bucket 15 (bucket).
  • a bucket operation lever 44c for operating the cylinder 18c) and a swing operation lever 44d for operating the upper swing body 11 (swing hydraulic motor 19) (these may be collectively referred to as the operation lever 44) are included.
  • the pilot oil from the hydraulic pump 42 is supplied to the operation lever 44, and when the operator operates the operation lever 44, the pilot oil from the hydraulic pump 42 is appropriately reduced in pressure in accordance with the lever operation amount, and is supplied to the direction control valve 45. It has a flowing mechanism.
  • two traveling operation levers for operating left and right traveling hydraulic motors mounted on the lower traveling body 12 are omitted.
  • the direction control valve 45 controls the amount and direction of hydraulic oil supplied from the hydraulic pump 43 to each of the hydraulic cylinders 18 and the swing hydraulic motor 19. It is determined which hydraulic fluid flows in which direction in which actuator of the hydraulic motor 18 and the turning hydraulic motor 19. Therefore, by operating the operation lever 44, each hydraulic cylinder 18 and the turning hydraulic motor 19 can be driven by a desired amount in a desired direction. That is, the operator can operate the work device 4 via the operation device 44 to take an arbitrary posture, and as a result, can perform a desired work.
  • a shutoff valve 46 is provided in an oil passage connecting the hydraulic pump 42 and each operation lever 44. When the shut-off valve 46 is closed, the supply of the pilot oil from the hydraulic pump 42 to each operation lever 44 stops. This makes it possible to create a state in which pilot oil does not flow through the direction control valve 45 even when the operation lever 44 is operated, and the hydraulic cylinder 18 and the turning hydraulic motor 19 are not driven.
  • the shut-off valve 46 may be configured to be physically opened and closed according to the position of a lock lever (not shown) operated by an operator when getting on and off the hydraulic excavator 1, or may be appropriately controlled by a control signal output from the vehicle body controller 51. It may be configured to be electrically opened and closed.
  • the control valve 47a is provided with one of the two oil paths for supplying pilot oil from the arm operation lever 44a to the direction control valve 45 in one of the oil paths through which pilot oil flows during an arm bending operation (at the time of arm cloud operation).
  • a control valve 47b is inserted into the other oil passage through which the pilot oil flows during the extension operation (at the time of the arm dump operation).
  • a control valve 47c is inserted into one of the two oil passages for supplying the pilot oil from the boom operation lever 44b to the direction control valve 45 during the boom lowering operation.
  • a shuttle valve 48a is inserted into the other oil passage through which the pilot oil flows.
  • One inlet of the shuttle valve 48a is connected to the hydraulic pump 42 via a control valve 47d.
  • a control valve 47f and a shuttle valve 48b are connected in series to one of the two oil passages for supplying pilot oil from the bucket operation lever 44c to the direction control valve 45 when the bucket cloud is operated.
  • a control valve 47g and a shuttle valve 48c are connected in series to the other oil passage through which the pilot oil flows during the bucket dump operation.
  • One inlet of the shuttle valve 48b is connected to the hydraulic pump 42 via a control valve 47e, and one inlet of the shuttle valve 48c is connected to the hydraulic pump 42 via a control valve 47h.
  • One control valve 47a-47h may be collectively referred to as a control valve 47, and three shuttle valves 48a-48c may be collectively referred to as a shuttle valve 48).
  • the shuttle valve 48 has two inlets and one outlet, and the inlet on the high pressure side of the two inlets is connected to the outlet.
  • Each control valve 47 is an electromagnetic valve electrically connected to the vehicle body controller 51, and its valve opening is controlled based on a control signal (command voltage or command current) output from the vehicle body controller 51.
  • a pilot pressure corresponding to the opening is generated.
  • the generated pilot pressure is output to the direction control valve 45 during semi-automatic control.
  • the remaining control valves 47d, 47e and 47h are directly connected to the hydraulic pump 42 without the intervention of the operation lever 44, so that pilot oil can be sent to the directional control valve 45 by increasing the valve opening.
  • the vehicle body controller 51 can make the speed of the working device 4 that actually moves faster than the speed specified by the operation input of the operation lever 44 by the operator. With such a configuration, the vehicle body controller 51 can increase or decrease (stop) the actual speed of the working device 4 with respect to the operation of the operator.
  • a plurality of hydraulic sensors (pressure sensors) 49 for detecting pressures (pilot pressures) before and after the shut-off valve 46 and each control valve 47 are provided downstream of the shut-off valve 46 and upstream and downstream of each control valve 47.
  • the hydraulic pressure sensor 49a is provided downstream of the shut-off valve 46 and is used to check whether the shut-off valve 46 is correctly opened.
  • the hydraulic sensors 49b and 49c are used for acquiring the arm operating speed
  • the hydraulic sensors 49d and 49j are used for acquiring the boom operating speed
  • the hydraulic sensors 49e and 49f are used for acquiring the bucket operating speed.
  • the hydraulic pressure sensors 49g to 49l are used to obtain the actual command speed after being controlled by the control valve 47.
  • the conversion from the pressure detected by each of the hydraulic sensors 49b to 49l to the command speed is performed by a conversion table prepared by performing calibration or the like in advance.
  • the vehicle body controller 51 opens the control valves 47a, 47b, 47c, 47f, 47g.
  • the degree to the maximum (open) and the degree of opening of the control valves 47d, 47e, and 47h to the minimum (shut off)
  • the pilot pressure from the operation lever 44 flows to the direction control valve 45 as it is, and is operated by the operator.
  • the operating device 4 is ready to be operated.
  • the actuator is operated in accordance with a predetermined condition (in this embodiment, a distance d (described later) between the design surface 60 and the bucket tip 150) irrespective of the operation or a part of the operation.
  • a predetermined condition in this embodiment, a distance d (described later) between the design surface 60 and the bucket tip 150
  • the vehicle controller 51 calculates the target speeds of the actuators 18a, 18b, 18c satisfying the predetermined condition, and calculates the calculated target speeds.
  • the control valve 47 By setting the control valve 47 to a valve opening corresponding to the above, the working device 4 can be controlled according to the predetermined condition.
  • the vehicle body controller 51 can switch the control of the actuators (hydraulic cylinders) 18a, 18b, 18c to one of two controls, manual control and semi-automatic control.
  • the operator can instruct the vehicle body controller 51 which of the two controls is to be used via a changeover switch 56 (shown in FIG. 3) provided in the cab on the upper swing body 11.
  • the two controls may be switched based on a state transition signal (described later) input to a state transition unit 51a (shown in FIG. 3) in the vehicle body controller 51.
  • the vehicle body controller 51, the guidance controller 52, and the GNSS controller 53 each include a processing device (for example, a CPU) and a storage device (for example, a ROM or a RAM) in which a program executed by the processing device and data necessary for executing the program are stored. Hardware corresponding to a computer having a semiconductor memory.
  • FIG. 3 is a functional block diagram illustrating various arithmetic processes performed by the vehicle body controller 51, the guidance controller 52, and the GNSS controller 53.
  • three controllers 51, 52, and 53 are provided according to the actual device. However, these may be integrated into, for example, one controller, or the functions may be separated and four or more controllers may be used. A system that can realize the same function may be configured.
  • the GNSS controller 53 is a positioning controller for measuring the positions of the two antennas 2 from the signals received by the two antennas 2.
  • the GNSS controller 53 is a positioning controller for measuring the positions of the two antennas 2 from the signals received by the two antennas 2.
  • a method called RTK-GNSS Real Time Kinetic-GNSS
  • the excavator 1 needs a receiver for receiving the correction information from the reference station, but the self-position of the antenna 2 can be measured more accurately.
  • the GNSS controller 53 includes a latitude / longitude calculation unit 53a as shown in FIG.
  • the GNSS controller 53 calculates the position (for example, latitude, longitude, and altitude) of the GNSS antennas 2a and 2b on the earth based on signals from a plurality of GNSS satellites input from the GNSS antennas 2a and 2b in a latitude / longitude calculation unit 53a. Then, the result is transmitted to the guidance controller 52.
  • the guidance controller 52 includes a working device position / posture calculation unit 52a that calculates the positions and postures of the front members 13, 14, and 15 of the working device 4 based on the outputs of the IMU 3 and the GNSS controller 53.
  • a design data storage unit 52b in which three-dimensional design data indicating a target shape to be constructed of the hydraulic shovel 1 is recorded, and an intersection between the three-dimensional design data stored in the design data storage unit 52b and the operation plane of the working device 4.
  • a design surface calculation unit 52c that calculates two-dimensional design surface data (line segment data of the design surface) from the line, and guidance for managing the operation status of the IMU 3 and the GNSS controller 53, the presence or absence of the design surface 60 near the bucket tip 150, and the like.
  • a state management unit 52d is provided.
  • the guidance controller 52 stores information on which position of the upper revolving superstructure 11 the GNSS antenna 2 is arranged in a storage device, and the working device position / posture calculation unit 52 a stores the information of the GNSS antenna 2 input from the GNSS controller 53.
  • the position of the upper rotating body 11 on the earth the position on the geographic coordinate system
  • the GNSS antenna 2 can function as a position sensor for the working device 4 and the upper swing body 11 to which the working device 4 is attached.
  • the direction of the upper revolving unit 11 (in which direction the boom 13, the arm 14, and the bucket 15 face) from the positions of the two GNSS antennas 2. You know).
  • the position and orientation of the upper revolving superstructure 11 on the geographic coordinate system calculated by the GNSS controller 53 can be used by appropriately converting the position and orientation on an arbitrary coordinate system.
  • the working device position / posture calculation unit 52a can calculate the self-posture of each IMU 3 based on measurement information such as acceleration and angular velocity input from the IMU 3. For this reason, the working device position / posture calculation unit 52a can calculate the front / rear inclination and the left / right inclination of the upper revolving unit 11 based on information from the vehicle body IMU 3a, the rotation posture of the boom 13 based on information from the boom IMU 3b, and the arm based on information from the arm IMU 3c. 14 rotation postures can be calculated.
  • the working device position / posture calculation unit 52a can know the rotation posture of the bucket link 16 from the information from the bucket IMU 3d, and the rotation posture of the arm 14 and the four postures of the arm 14, the bucket links 16, 17 and the bucket 15.
  • the rotation attitude of the bucket 15 can be calculated by calculating based on the dimensional information of the joint link mechanism.
  • the working device position / posture calculation unit 52a can calculate the position, azimuth, front / rear inclination, left / right inclination of the upper revolving unit 11 in the geographical coordinate system, It can calculate whether it exists in the posture.
  • the dimensional information of the rotation center of each of the boom 13, the arm 14, and the bucket 15 and the tip of the bucket 150 (also referred to as a bucket tip) adjacent to each other on the operation plane of the working device 4 is stored in the storage device in the guidance controller 52. Is stored in Therefore, the working device position / posture calculation unit 52a combines the upper revolving unit 11 (for example, the rotation center of the base end side of the boom 13 with the rotation posture information of each of the front members 13, 14, 15 acquired by each IMU 3).
  • the position of the bucket tip 150 with respect to the position) can be known.
  • the work device position / posture calculation unit 52a obtains information on the position, posture, and orientation of the upper revolving unit 11 and the front members 13, 14, 15 of the work device 4 in the geographic coordinate system (including the position information of the bucket tip 150). Can be requested. These pieces of information are output to the guidance state management unit 52d and the design surface calculation unit 52c in the guidance controller 52, the target operation generation unit 51c in the vehicle body controller 51, the guidance monitor 54, and the like.
  • the design plane calculation unit 52c calculates the latest operation plane of the work device 4 from the information on the position, posture, and orientation of the front members 13, 14, 15 input from the work device position / posture calculation unit 52a. From the line of intersection with the three-dimensional design data stored in the design data storage unit 52b, line segment data of the design surface 60 used for semi-automatic control is calculated. The design surface calculation unit 52c outputs the line segment data of the design surface 60 to the guidance monitor 54, the target operation generation unit 51c in the vehicle body controller 51, and the like.
  • the guidance state management unit 52d manages the operation state of the IMU 3 and the GNSS controller 53, the presence or absence of the design surface 60 near the bucket tip 150, and the like.
  • the guidance state management unit 52d monitors the sensor output of each IMU 3 and determines whether an abnormality has occurred in the IMU 3 or not. For example, when the stop of the signal from the IMU 3 is detected, it is determined that an abnormality has occurred in the IMU 3 due to the stop of the function of the IMU 3 or disconnection.
  • the guidance state management unit 52d outputs a first state switching signal to the state transition unit 51a in the vehicle body controller 51.
  • the "first state switching signal” indicates that the hardware and software necessary for controlling the hydraulic cylinder 18 by the semi-automatic control have become abnormal and the semi-automatic control cannot be executed.
  • This is a signal for switching to control.
  • it is a signal for forcibly switching to a semi-automatic control prohibition mode (manual control mode) in which the execution of semi-automatic control by the vehicle body controller 51 is prohibited and only the execution of manual control is permitted.
  • the state switching signal according to the present embodiment further includes a second state switching signal and a third switching signal.
  • the "second state switching signal” is a signal for switching the semi-automatic control to the manual control at an arbitrary timing desired by the operator.
  • the "third state switching signal” is a signal for switching manual control to semi-automatic control at an arbitrary timing desired by the operator.
  • it is a signal that arbitrarily switches a semi-automatic control prohibition mode (manual control mode) for prohibiting semi-automatic control to a semi-automatic control permission mode (semi-automatic control mode) for permitting semi-automatic control.
  • the guidance state management unit 52d monitors the positioning information of the antenna 2 input from the GNSS controller 53, and determines whether an abnormality has occurred in the positioning of the antenna 2. For example, when the stop of the signal from the GNSS controller 53 is detected, or when the positioning accuracy input from the GNSS controller 53 falls below a predetermined threshold, the information indicating that the positioning of the antenna 2 is impossible is transmitted to the GNSS controller. When input from the controller 53, it is determined that an abnormality has occurred in the positioning (GNSS) of the antenna 2. When determining that an abnormality has occurred in the GNSS, the guidance state management unit 52d outputs a first state switching signal to the state transition unit 51a in the vehicle body controller 51. As for the GNSS, the abnormality may be detected in the GNSS controller 53 and transmitted to the guidance state management unit 52d in the guidance controller 52 or directly to the state transition unit 51a in the vehicle body controller 51.
  • the abnormality may be detected in the GNSS controller 53 and transmitted to the guidance state management unit 52d in the guidance controller
  • the guidance state management unit 52d also stores the position information of the design surface 60 input from the design surface calculation unit 52c and the position information / posture information of the bucket 15 input from the work device position / posture calculation unit 52a. (Including position information) to determine whether or not the design surface 60 to be controlled by the semi-automatic control exists near the bucket 15. For example, when an arbitrary point on the bucket 15 goes out of the area R where the design surface 60 is located (see FIG. 8, but the design surface in FIG. 8 is denoted by reference numeral 61) when viewed from the vertical direction. , It can be determined that the design surface 60 does not exist near the bucket 15 (in other words, the bucket 15 exists outside the region where the design surface 60 exists). When determining that the design surface 60 does not exist near the bucket 15, the guidance state management unit 52d outputs a first state switching signal to the state transition unit 51a in the vehicle body controller 51.
  • the guidance monitor 54 is a monitor that displays the current posture of the working device 4, the shape of the design surface 60 (design data) near the bucket tip 150, and distance information (d) between the bucket tip 150 and the design surface 60. is there.
  • a touch panel type monitor having a function of receiving an input operation from an operator is configured, and a processing device (for example, a CPU) and a display and input related program executed by the processing device and execution of the program are executed. It has built-in hardware equivalent to a computer having a storage device (for example, a semiconductor memory such as a ROM and a RAM) in which necessary data and the like are stored.
  • the guidance monitor 54 includes a display control unit 54a that controls information displayed on the monitor, and an input information processing unit 54b that converts an operator's touch operation input to the monitor into input information.
  • the display control unit 54a displays on the guidance monitor 54 information such as design data input from the guidance controller 52, the posture of the working device 4 of the hydraulic shovel 1, and the relative positional relationship between the bucket tip 150 and the design data. For example, by displaying the line segment data of the design surface 60 and the side image of the bucket 15, the operator can be notified of the latest positional relationship between the bucket 15 and the design surface 60. The operator operates the working device 4 on the basis of the information obtained from the guidance monitor 54 so that the distance d between the design data (design surface 60) and the bucket tip 150 is maintained at zero. Excavation work can be performed to achieve the desired shape.
  • the guidance controller 52 can also use the speaker 55 to transmit the relative positional relationship between the design surface 60 and the bucket tip 150 to the operator based on the volume of the alarm, the sound interval, the tone color, and the like. For example, as the bucket tip 150 gets closer to the design surface 60, the volume can be increased, the sounding interval can be shortened, and the frequency can be increased. Thus, the operator can operate the work device 4 so that the distance between the target shape and the bucket tip 150 becomes zero by a change in the alarm from the speaker 55 without watching the guidance monitor 54, for example.
  • the guidance controller 52 transmits to the vehicle body controller 51 information such as design data (design surface 60), the attitude of the working device 4, and the relative positional relationship between the design surface 60 and the bucket tip 150.
  • the body controller 51 controls the working device 4 based on the information so that, for example, the distance d between the design surface 60 and the bucket tip 150 becomes zero, and sets the target according to the design data.
  • the excavation work having the shape can be performed without depending on the operation of the operator or by intervening in the operation of the operator. Next, details of the semi-automatic control performed by the vehicle body controller 51 will be described.
  • the vehicle body controller 51 performs manual control (first control) for controlling the actuators (hydraulic cylinders) 18 a, 18 b, 18 c based on an operation input to the operation device 44, and the design surface 60 and the work device during operation of the operation device 44.
  • the vehicle body controller 51 performs manual control (first control) and semi-automatic control (second control) based on the input of the state switching signal (first, second, and third state switching signals).
  • a target operation generating unit 51c for calculating the target speed of the actuator and an actuator control unit 51d for calculating and outputting a control command to the control valve 47 for operating the hydraulic cylinders (actuators) 18a to 18c at the target speed.
  • the state transition unit 51a controls the control method of the hydraulic cylinders (actuators) 18a to 18c performed by the target operation generation unit 51c with the changeover switch 56, the guidance state management unit 52d in the guidance controller 52, and the target operation generation unit in the vehicle body controller 51. Switching between manual control (first control) and semi-automatic control (second control) based on a state switching signal (first, second, and third state switching signals) input from 51c.
  • the first state switching signal is input from the guidance state management unit 52d in the guidance controller 52 and the target operation generation unit 51c in the vehicle body controller 51.
  • the second and third state switching signals are input from a switch 56 provided in the driver's seat of the excavator 1.
  • the changeover switch 56 is a two-position changeover switch that is operated by the operator at an arbitrary timing, and enables a semi-automatic control prohibition mode (manual control mode) in which a semi-automatic control prohibition mode (manual control mode) is selected and a semi-automatic control. And a second position at which a semi-automatic control permission mode (semi-automatic control mode) is selected.
  • a semi-automatic control prohibition mode in which a semi-automatic control prohibition mode (manual control mode) is selected and a semi-automatic control.
  • a second position at which a semi-automatic control permission mode (semi-automatic control mode) is selected.
  • a second state switching signal is output to the state transition unit 51a.
  • a third state switching signal is output to the state transition unit 51a.
  • the state transition unit 51a When the semi-automatic control (second control) is being executed at the time of input of the state switching signal, the state transition unit 51a that has received the first and second state switching signals performs manual control (first control) of semi-automatic control (second control). If the manual control (first control) is being executed when the state switching signal is input, the subsequent execution of semi-automatic control is prohibited. On the other hand, when the condition for executing semi-automatic control at the time of input of the state switching signal is satisfied, the state transition unit 51a that has received the third state switching signal changes from manual control (first control) to semi-automatic control (second control). Control), and the manual control (first control) is continued if the condition for performing the semi-automatic control when the state switching signal is input is not satisfied.
  • the speed transition unit 51b switches between two controls including manual control and semi-automatic control by the state transition unit 51a, and controls the speeds of the actuators (hydraulic cylinders) 18a, 18b, and 18c to be controlled before switching between the two controls.
  • the change rate is set to I1.
  • the speed transition unit 51b operates between the two controls being switched by the state transition unit 51a until the speeds of the actuators (hydraulic cylinders) 18a, 18b, 18c change to the speeds specified by the control after switching.
  • the time change rate of the speed of the actuators (hydraulic cylinders) 18a, 18b, 18c is changed from the first change rate I1 to the second change rate I2 which is larger than the first change rate. I do.
  • the rate of change in speed at the time of switching between the two controls is changed from the first rate of change I1 to the second rate of change I2, the time required to switch the speed between the two controls can be reduced, and the speed can be switched. The waiting time until starting the subsequent control can be reduced.
  • the target operation generation unit 51c is a part that calculates a target speed of each of the hydraulic cylinders 18a, 18b, 18c during manual control and a target speed of each of the hydraulic cylinders 18a, 18b, 18c during semi-automatic control. Whether to use the manual control or the semi-automatic control is determined based on an instruction from the state transition unit 51a.
  • the target motion generation unit 51c calculates a distance d between the design surface 60 and the work device 4 (bucket tip 150) based on information input from the guidance controller 52. Then, when the operation device 44 is operated, the target speed of each of the hydraulic cylinders 18a, 18b, 18c is calculated according to the distance d such that the operation range of the working device 4 is limited on the design surface 60 and above. In the present embodiment, the following calculation is performed.
  • the target operation generation unit 51c calculates a required speed (boom cylinder required speed) to the boom cylinder 18a from a voltage value (boom operation amount) input from the operation lever 44b, and inputs the required speed from the operation lever 44c.
  • the required speed to the arm cylinder 18b is calculated from the voltage value (arm operation amount)
  • the required speed to the bucket cylinder 18c is calculated from the voltage value (bucket operation amount) input from the operation lever 44d.
  • the speed vector (request speed vector) V0 of the work device 4 at the bucket tip 150 (required speed vector) V0 (See the left diagram of FIG. 5).
  • a velocity component V0z of the velocity vector V0 in the vertical direction on the design surface and a velocity component V0x in the horizontal direction of the design surface are also calculated.
  • FIG. 4 is a graph showing a relationship between the distance d between the bucket tip 150 and the design surface 60 and the speed correction coefficient k.
  • the distance d is positive when the distance when the bucket tip 150 (the control point of the working device 4) is located above the design surface 60 is positive and the distance when the bucket tip 150 is located below the design surface 60 is negative.
  • a negative correction coefficient is output as a value less than or equal to 1 when the distance d is negative.
  • the velocity vector is positive in a direction approaching the design surface 60 from above the design surface 60.
  • the target motion generation unit 51c multiplies the velocity component V0z of the velocity vector V0 in the direction perpendicular to the design plane by the correction coefficient k determined according to the distance d to obtain the velocity component V1z (see the right diagram in FIG. 5). ) Is calculated.
  • the synthesized speed vector (target speed vector) V1 is calculated by synthesizing the speed component V1z and the speed component V0x of the speed vector V0 in the horizontal direction of the design plane, and the boom cylinder speed capable of generating the synthesized speed vector V1 is calculated as follows. , Arm cylinder speed (Va1) and bucket cylinder speed are calculated as target speeds.
  • the attitude of each of the front members 13, 14, 15 of the work apparatus 4 calculated by the work apparatus position and attitude calculation unit 52a may be used.
  • the target operation generation unit 51c outputs the calculated target speed of each hydraulic cylinder to the actuator control unit 51d.
  • FIG. 5 is a schematic diagram showing velocity vectors before and after correction according to the distance d at the bucket tip 150.
  • FIG. 5 By multiplying the vertical component V0z (see the left diagram in FIG. 5) of the required speed vector V0 by the speed correction coefficient k, the speed vector V1z in the vertical direction on the design surface below V0z (see the right diagram in FIG. 5). ) Is obtained.
  • a composite speed vector V1 of V1z and a horizontal component V0x of the required speed vector V0 is calculated, and an arm cylinder target speed capable of outputting V1, a boom cylinder target speed, and a bucket cylinder target speed are calculated.
  • the target operation generation unit 51c first calculates a target speed of the boom cylinder 18a (same as the required speed of the boom cylinder of the semi-automatic control) from a voltage value (boom operation amount) input from the operation lever 44b.
  • the target speed of the arm cylinder 18b (same as the required arm cylinder speed of semi-automatic control) is calculated from the voltage value (arm operation amount) input from the operation lever 44c, and the voltage value (bucket operation amount) input from the operation lever 44d is calculated.
  • the target speed of the bucket cylinder 18c (same as the required speed of the bucket cylinder of the semi-automatic control) is calculated.
  • the target operation generation unit 51c outputs the calculated target speed of each hydraulic cylinder to the actuator control unit 51d.
  • the target operation generation unit 51c when abnormality is detected> Further, the target operation generation unit 51c is disposed before and after the shutoff valve 46 and each control valve 47, and detects a plurality of hydraulic sensors (pressure sensors) that detect pressures (pilot pressures) before and after the shutoff valve 46 and each control valve 47. 49, a shut-off valve 46, and a plurality of control valves 47 are managed to determine whether or not there is an abnormality in hardware necessary for semi-automatic control.
  • the target operation generation unit 51c is configured to output a pilot pressure value (target value) defined by a control signal (for example, a command current) output from the vehicle body controller 51 (for example, the actuator control unit 51d) to the shutoff valve 46 and each control valve 47.
  • each hydraulic pressure sensor 49 by comparing the pilot pressure value (actual value) detected by each hydraulic pressure sensor 49 with each other, it is determined whether or not an abnormality has occurred in the shutoff valve 46, each control valve 47, and each hydraulic pressure sensor 49. For example, in a state where the pressure detection value on the upstream side of the control valve 47 by the hydraulic pressure sensor 49 is sufficiently high, a command current that regulates to output a constant pressure on the downstream side of the control valve 47 is output from the vehicle body controller 51. When the pressure detected by the hydraulic pressure sensor 49 on the downstream side of the control valve 47 is clearly higher or lower than the command value, an abnormality has occurred in the control valve 47 or the hydraulic pressure sensor 49 (normal). Not).
  • the target operation generation unit 51c compares each actuator control target speed calculated by itself (the target operation generation unit 51c) with a pilot pressure value (actual value) detected by each hydraulic pressure sensor 49, thereby controlling each control valve. It may be determined whether or not an abnormality has occurred in the oil pressure sensor 47 and each hydraulic pressure sensor 49.
  • the actuators (hydraulic cylinders) 18a, 18b, and 18c are controlled by the semi-automatic control
  • the target operation generation unit 51c and the pressure value defined by the control signal generated by the vehicle body controller 51 and the pressure sensor If it is determined that an abnormality has occurred in any of the shutoff valve 46, the control valve 47, and the hydraulic pressure sensor 49 by comparing the detected value with the detected value, the semi-automatic control (second control) is switched to manual control (first control).
  • the one-state switching signal is output to the state transition unit 51a.
  • the actuator control unit 51d calculates a control signal (control valve command current) to each control valve 47 based on the target speed of each of the hydraulic cylinders 18a, 18b, 18c calculated by the target operation generation unit 51c, and controls the control signal. This is a part for controlling the direction control valve 45 by outputting a signal to the corresponding control valve 47. By the directional control valve 45 controlled in this way, each of the hydraulic cylinders 18a, 18b, 18c operates according to the target speed calculated by the target operation generator 51c.
  • FIG. 6 is a diagram showing a relationship between the excavator 1 and a design surface (design data) 60.
  • the design plane 60 indicating the target shape to be constructed includes single plane data composed of one plane, and multiple plane data obtained by combining a plurality of planes.
  • the plane 60 is recorded in the guidance controller 52 as a design plane, and an example in which the work apparatus 4 is controlled using the plane 60 as a target shape will be described below.
  • the working device 4 including the boom 13, the arm 14, and the bucket 15 is appropriately operated, and the bucket tip 150 is set to the target shape. It is necessary to move along. That is, if the bucket 15 is operated such that the distance d between the plane 60 and the bucket tip 150 is always zero, the trajectory of the bucket tip 150, that is, the excavated surface coincides with the plane 60.
  • the hydraulic excavator 1 according to the present embodiment is provided with a guidance monitor 54. As described above, the guidance monitor 54 has information on the current attitude of the working device 4 and information on the target shape, and the relative position between the target shape and the bucket tip 150.
  • the positional relationship (information of the distance d) and the like are displayed. For this reason, in the manual control, the operator appropriately refers to these pieces of information to perform the operation of pulling the bucket 15 toward the vehicle body by the arm bending operation (arm cloud operation) and the distance d by the boom raising / lowering operation.
  • Excavation work that achieves the target shape can be performed by adjusting the value to zero as much as possible.
  • the boom 13 (boom cylinder 18a) is driven at an appropriate speed according to the distance d, excavation work can be performed while maintaining the distance d near zero.
  • information such as the current posture of the working device 4, the moving speed of the arm 14, and the relative positional relationship between the design surface 60 including the design surface 60 and the distance d and the working device 4 obtained from the guidance controller 52 are stored.
  • the vehicle controller 51 calculates the target speed of the boom cylinder 18a so as to keep the distance d near zero, and controls the valve opening of the control valves 47c and 47d so that the boom cylinder 18a operates in accordance with the calculated target speed. Drive.
  • the posture of the working device 4 when the straight line L connecting the bucket tip 150 and the joint 140 is orthogonal to the plane 60 is referred to as an orthogonal posture.
  • the bucket tip 150 is moved along the plane 60 by performing a boom raising operation and a boom lowering operation immediately after the arm bending operation becomes an orthogonal posture, and immediately after the arm bending operation.
  • the boom raising operation can be executed by the vehicle controller 51 increasing the valve opening of the control valve 47d.
  • the boom lowering operation cannot be executed only by the vehicle body controller 51 adjusting the valve opening of the control valve 47c.
  • the operation lever 44b is provided between the control valve 47c and the hydraulic pump 42, and the pilot oil does not flow through the control valve 47c unless the operation lever 44b is operated in the boom lowering direction. Therefore, in order to control the boom lowering operation, the operator must input an operation in the boom lowering direction to the operation lever 44b, and the pilot oil is supplied from the operation lever 44b to the control valve 47c.
  • the moving speed in the boom lowering direction can be controlled by the vehicle body controller 51 adjusting the valve opening of the control valve 47c.
  • the vehicle body controller 51 performs the boom raising operation by setting the valve opening of the control valve 47c to the minimum (cutoff) and appropriately increasing the valve opening of the control valve 47d until the orthogonal posture. Then, after the orthogonal posture, the excavation work for achieving the target shape can be executed by minimizing (cutting off) the valve opening of the control valve 47d and performing the boom lowering operation by increasing the valve opening of the control valve 47c. Further, the operator does not need to adjust the boom operation, but only needs to keep inputting the maximum input (tilting the operation lever 44b to the maximum in the boom lowering direction).
  • FIG. 8 is a view showing the relationship between the excavator and the design surface 61 as in FIG. In FIG. 8, it is assumed that a plane 61 is recorded in the guidance controller 52 as a design surface indicating a target shape.
  • the plane 61 is a single plane existing only within the range R.
  • the vehicle controller 51 calculates the target speed of the boom cylinder 18a based on information such as the distance d as described above, and controls the operation of the boom 13.
  • the distance d and the like the target shape and the working device 4 Cannot be obtained, and the semi-automatic control cannot be executed.
  • the vehicle body controller 51 limits the rate of change in the speed of the boom cylinder 18a to prevent occurrence of sudden acceleration.
  • the restriction of the speed change rate is relaxed or released, and the operator's operation and the actual movement of the work device 4 are different. Reduce discomfort.
  • FIG. 9 is a flowchart showing the flow of processing by the vehicle controller 51 and the guidance controller 52 during semi-automatic control.
  • the vehicle controller 51 and the guidance controller 52 start the processing of FIG. 9 when the operation device 44 is operated by the operator.
  • the working device position / posture calculation unit 52a in the guidance controller 52 transmits the GNSS controller 53 based on the information of the inclination angles of the front members 13, 14, 15 and the upper revolving unit 11 from the IMU 3 and the navigation signal of the GNSS antenna 2.
  • attitude information attitude information
  • azimuth information of the hydraulic excavator 1 calculated by the above, and the dimension information of each of the front members 13, 14, 15 stored in advance, etc.
  • the bucket tip 150 control The position information of (point) is calculated (procedure S1).
  • the design surface calculation unit 52c in the guidance controller 52 may use the position information of the bucket tip 150 (the position information of the excavator 1) in the geographical coordinate system calculated by the work device position and orientation calculation unit 52a. ),
  • the position information (design data) of the design surface 60 included in the predetermined range is acquired from the design data storage unit 52b, and is output to the target operation generation unit 51c in the vehicle body controller 51.
  • the target operation generation unit 51c sets the design surface located closest to the bucket tip 150 from the design data as the design surface 60 to be controlled, that is, the design surface 60 for calculating the distance d.
  • step S3 the target action generation unit 51c calculates the distance d based on the position information of the bucket tip 150 obtained in step S1 and the position information of the design surface 60 obtained in step S2.
  • step S4 the target operation generating unit 51c determines whether the working device 4 operates based on the distance d calculated in step S3 and the operation amount (pressure value) of each operation lever input from the operation device 44.
  • the target speed of each of the hydraulic cylinders 18a, 18b, 18c is calculated such that the bucket tip 150 is held on or above the design surface 60.
  • step S5 the actuator control unit 51d calculates a control signal (for example, a command current) for driving each control valve 47 based on the target speed of each hydraulic cylinder, and outputs the control signal to the control valve 47 corresponding to the control signal. Accordingly, the hydraulic cylinders 18a, 18b, 18c are driven based on the target speeds (actuator target speeds) of the hydraulic cylinders 18a, 18b, 18c, and the front members 13, 14, 15 operate.
  • a control signal for example, a command current
  • step S6 the target operation generation unit 51c outputs a control switching instruction for switching the semi-automatic control to the manual control (this instruction is output when the first state switching signal or the second state switching signal is input to the state transition unit 51a). ) Is input from the state transition unit 51a.
  • the control switching instruction is input, the speed transition control described with reference to FIG. 10 is executed.
  • the process returns to the initial step S1 to continue the semi-automatic control.
  • FIG. 10 is a flowchart showing the flow of processing (speed transition control) of the vehicle body controller 51 when switching from semi-automatic control to manual control.
  • t the elapsed time from the time (t0) at which the control is switched
  • t the time t at the time t0 is 0
  • the boom cylinder target speed by the semi-automatic control at time t is Va (t)
  • the boom cylinder target speed by manual control at time t is Vo (t).
  • the target speeds Va (t) and Vo (t) are functions of the time t.
  • the steps for executing the same processing are denoted by the same reference numerals.
  • step S21 when an instruction to switch the semi-automatic control to the manual control (control switching instruction) is input from the state transition unit 51a, the speed transition unit 51b in the vehicle body controller 51 controls the hydraulic cylinder used in the target operation generation unit 51c.
  • the speed change rates of 18a, 18b, 18c are set to the first change rate I1.
  • Va (0) is a value calculated in step S4 of FIG. 9
  • Vo (0) is the same as a value calculated in step S21 of FIG. 11 described later
  • step S23 the target action generation unit 51c compares Va (0) with Vo (0). If Vo (0) ⁇ Va (0) holds (ie, if Va (0) is equal to or greater than Vo (0)), the process proceeds to step S24; otherwise (ie, Va (0) becomes Vo (0)). If it is less than (0), the process proceeds to step S24A.
  • step S25 the target operation generation unit 51c calculates the boom cylinder target speed Vo (t) by manual control at time t based on the input operation amount to the operation device 44 by the operator.
  • the calculation of this procedure may be performed by the state transition unit 51b.
  • step S26 the target action generation unit 51c determines whether Va (t) calculated in step S24 or S24A matches Vo (t) calculated in step S25. If Va (t) and Vo (t) do not match, it is determined that speed transition control is still necessary, and the process proceeds to step S27. On the other hand, when Va (t) and Vo (t) match, even if the semi-automatic control is switched to the manual control, the speed of the boom cylinder 18a does not change and the operator does not feel uncomfortable. Shift to normal manual control.
  • step S27 based on the pilot pressure (operation input to the operation device 44) detected by the oil pressure sensor 49, the state transition unit 51a operates the operation device 44 of the hydraulic cylinder (here, the boom cylinder 18a) to be semi-automatically controlled. It is determined whether or not the absolute value of the amount of change (change rate) per unit time of the operation amount input by the operator (here, the operation lever 44b) is equal to or greater than a threshold value I'0. If the absolute value of the change rate of the operation input is less than the threshold value I'0, the process returns to step S24 to maintain the speed change rate at I1. On the other hand, if the absolute value of the change rate of the operation input is equal to or larger than the threshold value I'0, the process proceeds to step S28.
  • the threshold value I'0 is determined by, for example, recording the boom operation input of the operator during normal work for a certain period of time, obtaining the amount of change per unit time of the operation input, and obtaining a value near the maximum value of the change amount within the certain period.
  • there is a method of setting a value larger than the maximum value This is considered to be a situation of high urgency when there is an operation that is rarely input during normal work, and it can be determined that it is necessary to increase the change rate limit value, for example, to stop the boom 13 immediately. Because.
  • the threshold value I'0 can be set to a value larger than the value I'1 obtained by converting the speed change rate I1 into the change rate of the operation amount. According to the present invention, in a state where the rate of change is restricted, the intention of the operator to change faster is read from the operation input and the speed change rate is changed to a larger value I2, which is higher than the speed change rate I1. This is because a large change in operator operation input is considered as one condition of the intention.
  • the threshold value I0 of the speed in this case is set to a value equivalent to I'0 determined based on the same concept as the threshold value I'0 of the operation amount. In FIG. 12 described later, the effect of the present invention is described using the threshold value I0 of the speed.
  • the speed limit is relaxed, so that the time required to increase the speed of the boom cylinder 18a and shift to manual control can be reduced.
  • the speed limit is relaxed, so that the time required to increase the speed of the boom cylinder 18a and shift to manual control can be reduced.
  • step S30 the target operation generation unit 51c calculates the boom cylinder target speed Vo (t) by manual control at time t based on the input operation amount to the operation device 44 by the operator.
  • the calculation of this procedure may be performed by the state transition unit 51b.
  • step S31 the target action generation unit 51c determines whether Va (t) calculated in step S29 or step S29A matches Vo (t) calculated in step S30. If Va (t) and Vo (t) do not match, it is determined that speed transition control is still necessary, and the process returns to step S29. On the other hand, when Va (t) and Vo (t) match, even if the semi-automatic control is switched to the manual control, the speed of the boom cylinder 18a does not change and the operator does not feel uncomfortable. Shift to normal manual control.
  • FIG. 11 is a flowchart showing the flow of processing by the vehicle body controller 51 during manual control.
  • the target operation generation unit 51c calculates the target speed of each of the hydraulic cylinders 18a, 18b, 18c based on the operation amount (pressure value) of each operation lever input from the operation device 44.
  • step S42 the actuator control unit 51d calculated in step S41 calculates a control signal (for example, a command current) for driving each control valve 47 based on the target speed of each hydraulic cylinder, and the control valve 47 corresponding to the control signal. Respectively.
  • a control signal for setting the valve opening of the control valves 47a, 47b, 47c, 47f, and 47g to the maximum (opening) and setting the valve opening of the control valves 47d, 47e, and 47h to the minimum (off) is given. Is output.
  • the pilot pressure from the operation lever 44 flows directly to the direction control valve 45, and the operation device 4 can be operated as operated by the operator.
  • step S43 the target action generation unit 51c sends a control switching instruction to switch the manual control to the semi-automatic control (this instruction is output when the third state switching signal is input to the state transition unit 51a) from the state transition unit 51a. It is determined whether or not an input has been made.
  • the control switching instruction is input, the semi-automatic control described with reference to FIG. 9 is executed.
  • the process returns to the initial step S41 to continue the manual control.
  • the control corresponding to the speed transition control in FIG. 10 is not performed, but the same speed transition control may be performed in the case of the manual control to the semi-automatic control. good.
  • FIG. 12 is a diagram showing a change in boom cylinder speed when switching from semi-automatic control to manual control.
  • the vertical axis represents the boom cylinder speed, with a positive value representing the operating speed in the boom raising direction and a negative value representing the operating speed in the boom lowering direction.
  • the horizontal axis is time t.
  • semi-automatic control is performed, and the boom cylinder target speed Va (t) matches the target speed Vc based on semi-automatic control.
  • a control switching instruction for switching the semi-automatic control to the manual control is output from the state transition unit 51a in the vehicle body controller 51 to the target operation generating unit 51c, and it is determined that switching from the semi-automatic control to the manual control is necessary. Since the change amount of the target speed Vo (t) based on the operator operation at the time t0 is substantially zero and smaller than the aforementioned speed threshold value I0, the boom cylinder target speed Va (t) is calculated based on the procedure S24 in FIG. You. As a result, the rate of change of the boom cylinder target speed Va (t) is limited to the predetermined first rate of change I1.
  • the rate of change of the target speed Vo (t) based on the operator's operation is smaller than the threshold value I0, so the processing based on the procedure S24 is continued.
  • the rate of change of the target speed Vo (t) based on the operator operation becomes equal to or greater than the threshold value I0.
  • the process of step S28 is executed, and the value limiting the rate of change of the boom cylinder target speed Va (t) is changed from the first speed change rate I1 to the second speed change rate I2.
  • the second speed change rate I2 is a value larger than the first speed change rate I1 (a value that allows a larger change per time).
  • the time change of the target speed Vo (t) based on the operator operation shown in FIG. 12 is based on the assumption that the operator makes the following determinations (1) to (3). That is, (1) there is a request from the operator to lower the boom 13 for the purpose of further excavation immediately after the working device 4 comes out of the range R where the design data exists at the time t0. (2) However, if the semi-automatic control becomes impossible at time t0, the operator predicts that the boom 13 will be rapidly lowered in accordance with the input of the boom lowering operation which is the condition for activating the semi-automatic control before time t0. The operation lever 44b was operated so as to loosen the boom lowering operation input between the times t0 and t1. (3) However, since the rate of change of the target speed Va (t) of the boom cylinder 18a is limited, the boom 13 did not immediately lower against the operator's expectation. Then, the operator performed an operation to increase the boom lowering operation input again at time t2.
  • first speed change rate I1 used during control
  • second speed change rate I2 a larger value
  • the speed limit is relaxed.
  • the control can be switched to the manual control at a time t2 earlier than the time t3 at which the semi-automatic control is completely switched to the manual control. That is, since the time at which the operation device 4 can be operated at the target speed intended by the operator is earlier than before, the occurrence of discomfort due to the deviation of the operation of the operator from the actual boom operation can be suppressed.
  • the effect of the present embodiment is that it is possible to read from the change in the operation input to the operation device 44 that the operator has a positive operation intention, and to make the actual operation of the operation device 4 closer to the operator operation more quickly. is there.
  • the operator's operation input is constant, the presence or absence of the operator's operation intention is unknown, and the limitation at the first speed change rate is continued.
  • abrupt operation of the working device 4 is prevented, stability of the vehicle body is ensured, and when the operator has a positive operation intention, the timing at which the operator operation is reflected in the operation of the working device 4 is advanced. Therefore, it is possible to suppress the operator from feeling uncomfortable with the difference between the operation and the operation.
  • FIG. 13 is a flowchart showing the flow of processing (speed transition control) of the vehicle body controller 51 when switching from semi-automatic control to manual control.
  • operation determination processing is performed instead of step S27.
  • the target action generation unit 51c determines whether Va (t) calculated in step S24 or S24A matches Vo (t) calculated in step S25. If Va (t) and Vo (t) do not match, it is determined that speed transition control is still necessary, and the operation determination process shown in FIG. 14 is started.
  • FIG. 14 is a flowchart showing the flow of the operation determination process.
  • the state transition unit 51a determines whether or not the operation input to the operation lever 44b of the operator stored in step S54 of the operation determination process one step before is zero. If the operation input one step before is zero, the process proceeds to step S52; otherwise, the process proceeds to step S53.
  • the determination as to whether or not the operation input performed here is zero is based on the detection value of the hydraulic pressure sensor 49d that detects the boom lowering pilot pressure disposed directly below the boom operation lever 44b within the range of the neutral pressure of the operation lever 44b. Alternatively, the determination may be made based on whether or not it is within. That is, the determination may be made based on whether the detection value of the hydraulic pressure sensor 49d is equal to or less than a predetermined threshold value. This is the same for the other procedures S52 and S53.
  • step S52 the state transition unit 51a determines whether the current operation input to the operation lever 44b by the operator is other than zero. If the operation input is other than zero, the operation determination processing is terminated, and the process proceeds to step S28, where the speed change rate is changed to the second speed change rate I2. On the other hand, if the operation input is zero, the current operation input value is stored in step S54, and the process returns to step S24.
  • step S53 the state transition unit 51a determines whether the current operation input to the operation lever 44b by the operator is zero. If the operation input is zero, the operation determining process ends, and the process proceeds to step S28, where the speed change rate is changed to the second speed change rate I2. On the other hand, if the operation input is not zero, the current operation input value is stored in step S54, and the process returns to step S24.
  • FIG. 15 is a diagram illustrating a first example of a change in boom cylinder speed when switching from semi-automatic control to manual control.
  • the vertical axis represents the boom cylinder speed, with a positive value representing the operating speed in the boom raising direction and a negative value representing the operating speed in the boom lowering direction.
  • a control switching instruction for switching the semi-automatic control to the manual control is output from the state transition unit 51a in the vehicle body controller 51 to the target operation generating unit 51c, and it is determined that switching from the semi-automatic control to the manual control is necessary.
  • Both the target speed Vo (t) based on the operator's operation at the time t0 and the time one step before are smaller than zero, and the operation input to the operation lever 44b is not zero. Therefore, in the operation determination process of FIG. 14, the process proceeds to steps S51, S53, and S54, and returns to step S24. That is, the rate of change of the boom cylinder target speed Va (t) is held at the predetermined first speed change rate I1. After that, until time t1, the target speed Vo (t) based on the operator's operation is smaller than zero as in time t0, so that the process of limiting the boom cylinder speed at the first speed change rate I1 continues.
  • the target speed Vo (t) based on the operator operation is zero, and the operation input to the operation lever 44b becomes zero. Further, the target speed Vo (t) based on the operator operation at the time one step before is smaller than zero, and the operation input to the operation lever 44b is not zero. Therefore, in the operation determination process of FIG. 14, the process proceeds to steps S51 and S53, and proceeds to step S28. As a result, the value limiting the rate of change of the boom cylinder target speed Va (t) is changed from the first rate of change I1 to the second rate of change I2.
  • the second speed change rate I2 is a value larger than the first speed change rate I1 (a value that allows a larger change per time).
  • the time change of the target speed Vo (t) based on the operator operation shown in FIG. 15 is caused by the operator wanting to immediately stop the boom raising operation immediately after the working device 4 comes out of the range of the design data. Considering the situation, it is assumed that the boom operation lever 44b is returned to the neutral position between the times t0 and t1.
  • FIG. 16 is a diagram showing a second example of a change in the boom cylinder speed when switching from semi-automatic control to manual control.
  • a control switching instruction for switching the semi-automatic control to the manual control is output from the state transition unit 51a in the vehicle body controller 51 to the target operation generating unit 51c, and it is determined that switching from the semi-automatic control to the manual control is necessary.
  • the target speed Vo (t) based on the operator's operation at time t0 and the time one step before is both zero, and in both cases, the operation input to the operation lever 44b is zero. Therefore, in the operation determination process of FIG. 14, the process proceeds to steps S51, S52, and S54, and returns to step S24. That is, the rate of change of the boom cylinder target speed Va (t) is held at the predetermined first speed change rate I1. After that, until time t1, the target speed Vo (t) based on the operator's operation is held at zero as in the case of time t0, so that the process of limiting the boom cylinder speed at the first speed change rate I1 continues.
  • the target speed Vo (t) based on the operator operation becomes smaller than zero, and the operation input to the operation lever 44b is not zero. Further, the target speed Vo (t) based on the operator operation at the time one step before is zero, and the operation input to the operation lever 44b is also zero. Therefore, in the operation determination process of FIG. 14, the process proceeds to steps S51 and S52, and proceeds to step S28. As a result, the value limiting the rate of change of the boom cylinder target speed Va (t) is changed from the first rate of change I1 to the second rate of change I2.
  • the second speed change rate I2 is a value larger than the first speed change rate I1 (a value that allows a larger change per time).
  • the temporal change of the target speed Vo (t) based on the operator operation shown in FIG. 16 is caused by the fact that the bucket 15 or the bucket tip 150 is moved from the range R in which the design data exists before the working device 4 reaches the orthogonal posture.
  • the operator is working under semi-automatic control without inputting the boom lowering operation for reasons such as going out, but immediately after the working device 4 comes out of the range of the design data, the operator wants to excavate the boom 15 further. It is assumed that there is a demand to lower it.
  • the operator actively operates the boom 13 at the time (time t1) when an operation is input to the boom operation lever 44b at the neutral position at time t0 when the switching from the semi-automatic control to the manual control is started.
  • the speed limit value (first speed change rate I1) used during the speed transition control is changed to a larger value (second speed change rate I2), and the speed limit is relaxed.
  • the operation of the boom can be started at a time t2 earlier than the time t3 when the semi-automatic control is completely switched to the manual control. That is, since the start timing of the boom operation intended by the operator is advanced, it is possible to suppress the occurrence of discomfort due to the deviation of the operation of the operator from the actual boom operation.
  • the effect of the above-described embodiments that the timing at which the operator operation is reflected in the operation of the work device 4 can be advanced is the first state switching. It can be said that this is significant in the scene where the signal was output.
  • the present invention can be applied to a case where the other hydraulic cylinders (the arm cylinder 18b and the bucket cylinder 18c) are semi-automatically controlled under predetermined conditions.
  • the condition for shifting from the speed transition control to the manual control is that the two speeds Va (t) and Vo (t) match.
  • the flowchart may be configured to shift to the manual control in FIG. 11 when the absolute value of the difference between the two becomes equal to or less than a predetermined threshold.
  • the speed transition control is performed when switching from the semi-automatic control to the manual control.
  • the speed transition control may be similarly performed when switching from the manual control to the semi-automatic control.
  • the input change to the operating device 44 functioning as a trigger for changing the time rate of change of the target speed Va (t) of the boom cylinder 18a from the first rate of change I1 to the second rate of change I2
  • the present invention is not limited to the above embodiment, and includes various modifications without departing from the gist of the present invention.
  • the present invention is not limited to one having all the configurations described in the above embodiments, but also includes one in which some of the configurations are deleted. Further, a part of the configuration according to one embodiment can be added to or replaced by the configuration according to another embodiment.
  • a part or all of the components are designed by hardware (for example, a logic that executes each function is designed by an integrated circuit. Etc.).
  • the configuration of the controllers 51, 52, and 53 is a program (software) that realizes each function of the configuration of the controllers 51, 52, and 53 by being read and executed by an arithmetic processing device (for example, a CPU). ).
  • Information relating to the program can be stored in, for example, a semiconductor memory (flash memory, SSD, etc.), a magnetic storage device (hard disk drive, etc.), a recording medium (magnetic disk, optical disk, etc.), and the like.
  • control lines and the information lines are understood to be necessary for the description of the embodiments, but all the control lines and the information lines related to the product are not necessarily required. Does not necessarily mean that In fact, it can be considered that almost all components are interconnected.
  • SYMBOLS 1 Hydraulic excavator, 2 ... GNSS antenna (position sensor), 3 ... IMU (posture sensor), 4 ... Working device (front working device), 11 ... Upper revolving unit, 12 ... Lower traveling unit, 13 ... Boom, 14 ... Arm, 140 joint, 15 bucket, 150 bucket tip, 16, 17 bucket link, 18 hydraulic cylinder (actuator), 19 swing hydraulic motor, 41 engine, 42, 43 hydraulic pump, 44 operation Lever (operating device), 45: Direction control valve, 46: Shutoff valve, 47: Control valve, 48: Shuttle valve, 47: Control valve, 49: Pressure sensor, 51: Body controller, 51a: State transition section, 51b ...
  • Speed transition section 51c target action generation section, 51d actuator control section, 52 guidance controller, 52a working device position / posture calculation section, 2b ... design data storage unit, 52c ... design surface calculation unit, 52 d ... guidance state management unit, 53 ... GNSS controller, 54 ... guidance monitor, 55 ... speaker, 60 and 61 ... design surface

Landscapes

  • Engineering & Computer Science (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Mechanical Engineering (AREA)
  • Operation Control Of Excavators (AREA)
  • Soil Working Implements (AREA)
  • Electrical Discharge Machining, Electrochemical Machining, And Combined Machining (AREA)

Abstract

油圧ショベルに搭載されたコントローラは,状態切替信号の入力に基づいて手動制御と半自動制御の2つの制御を切り替える状態遷移部と,状態遷移部によって2つの制御が切り替えられブームシリンダの速度が2つの制御の切り替え後の制御が規定する速度Vo(t)に変化するまでの間に操作レバーへの入力が変化した場合,ブームシリンダの速度の時間変化率を第1変化率I1から第1変化率より大きい第2変化率I2に変更する速度遷移部とを備える。

Description

作業機械
 本発明は予め定めた条件に従って作業装置を動作させ得る作業機械に関する。
 油圧ショベルを含む作業機械には,多関節型の作業装置の位置や姿勢をセンサにより取得し,作業装置の先端に取り付けられたアタッチメントを施工対象の目標形状に沿って動作させる制御機能(この種の制御はマシンコントロールや半自動制御等と呼ばれることがある)を有するものがある。このような作業機械は,その他の一般的な作業機械と同様にオペレータからの操作装置(例えば操作レバー)への入力に基づいて作業装置を制御する手動制御(本稿では「第1制御」と称することがある)と,オペレータの操作装置の操作中に当該操作とは無関係に又は当該操作の一部を利用して所定の条件に従って作業装置を制御する半自動制御(本稿では「第2制御」と称することがある)を行う。
 後者の半自動制御としては,例えば作業装置と所定の設計面(目標掘削地形)の距離に基づいて作業装置の速度を制御するものがある。この種の半自動制御において,例えば目標面の存在する範囲からアタッチメントが逸脱すると作業装置と設計面の距離が不明になるため半自動制御の継続が不可あるいは不要となり,作業装置の制御を半自動制御から手動制御へ切り替えることが考えられる。しかし,半自動制御が規定するアタッチメントの移動速度と,手動制御が規定するアタッチメントの移動速度との間に乖離があると,制御の切り替わり時に生じる急激な速度変化によって車体が不安定な状態になるおそれがある。この現象の発生を抑止するために,制御の切り替え時から作業装置の速度の変化量に制限を持たせ,徐々に速度を変化させる方法がある(例えば特許文献1参照)。
国際公開第2016/111384号
 まず,特許文献1の方法において,例えば半自動制御が作業装置を上に動作させている間に手動制御に制御が切り替わった際又は切り替わり直後にオペレータが作業装置を下に動作させる操作を入力すると,そのオペレータの操作に反して作業装置は一定時間上昇するため,オペレータは違和感を覚える可能性がある。
 次に,特許文献1では,制御の切り替えの時における作業装置の移動速度が閾値以上である場合に,制御の切り替え時における作業装置の移動速度が閾値である場合の減少率以上の減少率で作業装置の移動速度を変化させている。より具体的には,制御の切り替え時における作業装置の移動速度が閾値以上の場合,制御の切り替え時から作業装置の移動速度がゼロになるまでに要する時間t(すなわち,切り替え後の制御が規定する方向に作業装置が動作を開始するまでに要する時間,さらに換言すると,切り替え後の制御が規定する方向に作業装置が動作しない時間)が常に一定の時間tcになるように移動速度の減少率を変化させている。これにより切り替え時の作業装置の移動速度が閾値以上の場合には,切り替え後の制御が規定する方向と逆の動きをする時間を短縮して一定にすることでオペレータの違和感の抑制を図っている。
 しかし,特許文献1では,作業装置の速度の変化量(減少率)の制限値は制御の切り替え時に決定され,少なくとも作業装置の速度が一旦ゼロに達するまでは変わらない。そのため,例えば制御の切り替え後に,オペレータが速やかに作業装置を停止したいと考えて作業装置の停止を意図する操作(例えば操作レバーを中立位置に戻す)を操作装置に入力したとしても,作業装置が速やかに停止せずオペレータの意図に反して一定時間動作し続ける状態が発生し,依然としてオペレータに違和感を与える可能性がある。
 本発明の目的は,制御の切り替え中に,車体が不安定な状態になることを抑制できると共に,オペレータの操作が作業装置の動作に反映されるタイミングをオペレータの要求に応じて早めることができる作業機械を提供することにある。
 本願は上記課題を解決する手段を複数含んでいるが,その一例を挙げるならば,作業装置と,前記作業装置を駆動するアクチュエータと,前記アクチュエータを操作するための操作装置と,前記操作装置への入力に基づいて前記アクチュエータを制御する第1制御,及び,前記操作装置の操作中に所定の設計面と前記作業装置の距離に基づいて前記アクチュエータを制御する第2制御の2つの制御のいずれか一方によって前記アクチュエータを制御するコントローラとを備え,前記コントローラは,状態切替信号の入力に基づいて前記2つの制御が切り替えられ,前記アクチュエータの速度が前記2つの制御のうち切り替え前の制御が規定する速度から切り替え後の制御が規定する速度に変化するとき,そのときにおける前記アクチュエータの速度の時間変化率の制限値を第1変化率に設定し,前記状態切替信号の入力に基づいて前記2つの制御が切り替えられ,前記アクチュエータの速度が前記切り替え後の制御が規定する速度に変化するまでの間に,前記操作装置への入力が変化した場合,前記アクチュエータの速度の時間変化率を前記第1変化率から前記第1変化率より大きい第2変化率に変更する。
 本発明によれば,制御の切り替え中に,車体が不安定な状態になることを抑制できると共に,オペレータの操作が作業装置の動作に反映されるタイミングをオペレータの要求に応じて早めることができる。
第1の実施形態に係わる油圧ショベルの斜視図。 第1の実施形態に係わる油圧ショベルの油圧システムの構成図。 第1の実施形態に係わる車体コントローラ,ガイダンスコントローラ,GNSSコントローラ及びガイダンスモニタの機能ブロック図。 半自動制御における距離dと速度補正係数kの関係図。 バケット先端における距離dに応じた補正前後の速度ベクトルを表す模式図。 第1の実施形態に係わる油圧ショベルと設計データとを示す図。 第1の実施形態に係わる油圧ショベルの直交姿勢を示す図。 第1の実施形態に係わる油圧ショベルと設計データとを示す図。 第1の実施形態に係わる油圧ショベルの半自動制御の流れを示すフローチャート。 第1の実施形態に係わる油圧ショベルの速度遷移制御の流れを示すフローチャート。 第1の実施形態に係わる油圧ショベルの手動制御の流れを示すフローチャート。 第1の実施形態に係わる油圧ショベルのブームシリンダ速度の変化を示す図。 第2の実施形態に係わる油圧ショベルの速度遷移制御の流れを示すフローチャート。 第2の実施形態に係わる油圧ショベルの操作判定処理の流れを示すフローチャート。 第2の実施形態に係わる油圧ショベルのブームシリンダ速度の変化を示す図。 第2の実施形態に係わる油圧ショベルのブームシリンダ速度の変化を示す図。
 以下,本発明の実施の形態について図面を用いて説明する。以下の説明は本発明の内容の具体例を示すものであり,本発明がこれらの説明に限定されるものではなく,本明細書に開示される技術的思想の範囲内において当業者による様々な変更および修正が可能である。また,本発明を説明するための全図において,同一の機能を有するものは,同一の符号を付け,その繰り返しの説明は省略する場合がある。
 <第1の実施の形態>
 本実施の形態では,作業機械として油圧ショベルを例に説明する。ただし,本発明における作業機械は油圧ショベルに限定するものではなく,例えばブルドーザなど作業装置を持つ他の作業機械にも適用可能である。以下,図1から図7までを用いて第1の実施の形態である作業機械について説明する。
 図1は第1の実施の形態である油圧ショベルの外観を示している。油圧ショベル1は,走行油圧モータ(図示せず)によって駆動されるクローラを含む下部走行体12と,下部走行体12の上部に旋回可能に取り付けられた上部旋回体11と,上部旋回体11の前方に回動可能に取り付けられ掘削などの作業を行う多関節型の作業装置(フロント作業装置)4を備える。上部旋回体11は旋回油圧モータ19(図2に図示)によって下部走行体12に対して相対的に回転駆動される。
 作業装置4は,ブーム13,アーム14,バケット15,アーム14とバケット15との間の四節リンク機構を構成する要素の一つであるバケットリンク16,17,ブーム13を駆動するブームシリンダ18a,アーム14を駆動するアームシリンダ18b,バケット15をバケットリンク16,17を介して駆動するバケットシリンダ18c(ブームシリンダ18a,アームシリンダ18b,バケットシリンダ18cをまとめて,適宜油圧シリンダ18という)などから構成されている。
 ブーム13の一端(基端部)は上部旋回体11に回転可能に支持されている。ブームシリンダ18aのボトム側(基端側)は上部旋回体11に対して,同ロッド側(先端側)はブーム13に対してそれぞれ回転可能に支持されている。ブームシリンダ18aの伸縮に応じて,ブーム13が上部旋回体11に対して相対的に回転駆動される。アーム14の一端(基端部)はブーム13の他端(先端部)に回転可能に支持されている。アームシリンダ18bのボトム側(基端側)はブーム13に対して,同ロッド側(先端側)はアーム14に対してそれぞれ回転可能に支持されている。アームシリンダ18bの伸縮に応じて,アーム14がブーム13に対してそれぞれ相対的に回転駆動される。バケット15はアーム14の他端(先端部)に回転可能に支持されている。バケットリンク16の一端もアーム14の先端部に回転可能に支持されている。更に,バケットリンク16の他端はバケットリンク17の一端に回転可能に支持されており,バケットリンク17の他端はバケット15に回転可能に支持されている。バケットシリンダ18cのボトム側(基端側)はアーム14に対して,同ロッド側(先端側)はバケットリンク16に対してそれぞれ回転可能に支持されている。このように,アーム14,バケットリンク16,17,バケット15は四節リンク機構を構成しており,バケットシリンダ18cの伸縮に応じて,バケットリンク16がアーム14に対して相対的に回転駆動され,それと連動して,四節リンク機構を構成しているバケット15もアーム14に対して相対的に回転駆動される。このような構成である油圧ショベル1はブームシリンダ18a,アームシリンダ18b,バケットシリンダ18cのそれぞれを適切なストローク長さにまで駆動することにより,バケット15を任意の位置,姿勢に駆動し,掘削などの所望の作業を行うことができる。
 なお,以下では,ブーム13,アーム14及びバケット(作業具)15をそれぞれフロント部材と称することがある。また,ブーム13,アーム14及びバケット15は,作業装置4を含む平面上で動作し,以下ではこの平面を動作平面と称することがある。つまり動作平面とは,ブーム13,アーム14及びバケット15の回動軸に直交する平面であり,例えばブーム13,アーム14及びバケット15の幅方向の中心(すなわち各フロント部材13,14,15の回動軸の中心)に設定できる。
 上部旋回体11には二つのGNSS(Global Navigation Satellite System:全地球航法衛星システム)アンテナ2a,2b(これらをまとめて,適宜GNSSアンテナ2という)が配置されている。GNSSとは複数の衛星からの信号を受信し,地球上の自己位置を知る衛星測位システムを指す。GNSSアンテナ2は,地球上空に位置する複数のGNSS衛星(図示しない)からの信号(電波)を受信するものであり,得られた信号をGNSSコントローラ53(図2に図示)に送り,GNSSコントローラ53でこれらの信号から各アンテナ2a,2bの位置が演算される。
 上部旋回体11には,上部旋回体11の傾斜(傾斜角)を計測するための車体IMU3a(Inertial Measurement Unit,慣性計測装置)が取り付けられている。同様に,ブーム13にはブーム13の傾き(傾斜角)を計測するためのブームIMU3b,アーム14にはアーム14の傾き(傾斜角)を計測するためのアームIMU3c,バケットリンク16にはバケットリンク16の傾き(傾斜角)を計測するためのバケットIMU3dが取り付けられている(IMU3aから3dをまとめて,適宜IMU3という)。IMU3は加速度や角速度を計測できるセンサユニットであり,IMU3が取得した情報はガイダンスコントローラ52(図2に図示)に出力されている。IMU3は作業装置4の姿勢センサとして機能し得る。
 図2は第1の実施の形態の油圧ショベルの油圧システムの構成図である。油圧ショベル1は,エンジン41,油圧ポンプ42,43を備える。油圧ポンプ42,43はエンジン41により駆動され,タンクから汲み上げた圧油を油圧回路内に供給する。
 また,油圧ショベル1は,複数の操作レバー44a-44dからなる操作装置44と,油圧ショベル1に搭載された油圧シリンダ18及び油圧モータ19を含む油圧アクチュエータに供給する作動油の流量及び方向を制御する方向制御弁45と,方向制御弁45に作用されるパイロット油の圧力を制御する複数の制御弁(電磁弁)47と,油圧ショベル1の車体制御を司り,複数の制御弁47に対する制御信号(指令電流または指令電圧)を出力する車体コントローラ51と,油圧ショベル1の運転席内に搭載されたガイダンス用のモニタ(ガイダンスモニタ)54とスピーカ(音声出力装置)55の制御を司り,車体コントローラ51に作業装置4の位置情報,設計面60の位置情報,及び油圧シリンダ18の制御を切り替えるトリガーとなる状態切替信号等を出力するガイダンスコントローラ52と,2つのGNSSアンテナ2の位置を演算するGNSSコントローラ53を備える。
 図2において,操作装置44には,アーム14(アームシリンダ18b)を操作するためのアーム操作レバー44aと,ブーム13(ブームシリンダ18a)を操作するためのブーム操作レバー44bと,バケット15(バケットシリンダ18c)を操作するためのバケット操作レバー44cと,上部旋回体11(旋回油圧モータ19)を操作するための旋回操作レバー44d(これらをまとめて操作レバー44と称することがある)が含まれる。操作レバー44には油圧ポンプ42からのパイロット油が供給され,操作レバー44がオペレータに操作されると,油圧ポンプ42からのパイロット油がレバー操作量に応じて適宜減圧されて方向制御弁45に流れる仕組みとなっている。なお,図2では下部走行体12に搭載された左右の走行油圧モータをそれぞれ操作する2つの走行操作レバーは省略している。
 方向制御弁45は油圧ポンプ43から各油圧シリンダ18及び旋回油圧モータ19に供給される作動油の量及び方向を制御するものであり,操作レバー44から出力されるパイロット油に応じて,油圧シリンダ18及び旋回油圧モータ19のどのアクチュエータにどれだけの作動油をどの方向に流すかが決定される。このため,操作レバー44を操作することで各油圧シリンダ18及び旋回油圧モータ19を所望の方向に所望の量だけ駆動することができる。すなわち,オペレータは操作装置44を介して作業装置4を操って任意の姿勢をとらせることができ,その結果として所望の作業を行うことが可能となる。
 油圧ポンプ42と各操作レバー44とを接続する油路には遮断弁46が設けられている。遮断弁46が閉じられると,油圧ポンプ42から各操作レバー44へのパイロット油の供給は停止する。これにより,操作レバー44を操作しても方向制御弁45にパイロット油が流れず,油圧シリンダ18や旋回油圧モータ19が駆動されない状態を作ることができる。遮断弁46は油圧ショベル1への乗降時にオペレータに操作されるロックレバー(図示しない)の位置に応じて物理的に開閉駆動される構成でもよいし,車体コントローラ51から出力される制御信号によって適宜電気的に開閉駆動される構成としてもよい。
 アーム操作レバー44aから方向制御弁45にパイロット油を供給する2系統の油路のうち,アーム曲げ操作時(アームクラウド操作時)にパイロット油が流れる一方の油路には制御弁47aが,アーム伸ばし操作時(アームダンプ操作時)にパイロット油が流れる他方の油路には制御弁47bが挿入されている。ブーム操作レバー44bから方向制御弁45にパイロット油を供給する2系統の油路のうち,ブーム下げ操作時にパイロット油が流れる一方の油路には制御弁47cが挿入されており,ブーム上げ操作時にパイロット油が流れる他方の油路にはシャトル弁48aが挿入されている。このシャトル弁48aの一方の入口は制御弁47dを介して油圧ポンプ42に接続されている。バケット操作レバー44cから方向制御弁45にパイロット油を供給する2系統の油路のうち,バケットクラウド操作時にパイロット油が流れる一方の油路には制御弁47fとシャトル弁48bが直列に接続され,バケットダンプ操作時にパイロット油が流れる他方の油路には制御弁47gとシャトル弁48cが直列に接続されている。シャトル弁48bの一方の入口は制御弁47eを介して油圧ポンプ42に接続され,シャトル弁48cの一方の入口は制御弁47hを介して油圧ポンプ42に接続されている(以下では,適宜,8つの制御弁47a-47hをまとめて制御弁47と,3つのシャトル弁48a-48cをまとめてシャトル弁48と称することがある)。シャトル弁48は,2つの入口と1つの出口をもち,2つの入口のうち高圧側の入口が出口に接続されるものである。
 各制御弁47は,車体コントローラ51と電気的に接続された電磁弁であり,車体コントローラ51から出力される制御信号(指令電圧または指令電流)に基づいてその弁開度が制御され,その弁開度に応じたパイロット圧を生成する。生成されたパイロット圧は半自動制御時に方向制御弁45に出力される。制御弁47a,47b,47c,47f,47gの弁開度を小さくすれば操作レバー44からのパイロット油の流量を少なくすることができる。これはつまり,オペレータの操作レバー44の操作入力によって規定される速度よりも,実際に動く作業装置4の速度を車体コントローラ51が遅くしたり停止させたりすることができるということである。残りの制御弁47d,47e,47hは操作レバー44を介さず直接油圧ポンプ42に接続されているため,その弁開度を大きくすれば方向制御弁45にパイロット油を送ることができる。これはつまり,オペレータの操作レバー44の操作入力によって規定される速度よりも,実際に動く作業装置4の速度を車体コントローラ51が速くすることができるということである。このような構成により,車体コントローラ51はオペレータの操作に対して実際の作業装置4の速度を速くしたり遅くしたり(止めたり)することが可能となる。
 遮断弁46の下流側と各制御弁47の上流側及び下流側には,遮断弁46及び各制御弁47の前後の圧力(パイロット圧)を検出する複数の油圧センサ(圧力センサ)49が設けられている。油圧センサ49aは遮断弁46の下流に設置されており,遮断弁46が正しく開いているかどうかの確認に用いられる。油圧センサ49b,49cはアーム操作速度の取得,油圧センサ49d,49jはブーム操作速度の取得,油圧センサ49e,49fはバケット操作速度の取得に用いられる。油圧センサ49g~49lは制御弁47によって制御された後の実際の指令速度の取得に用いられる。各油圧センサ49b~49lで検出された圧力から指令速度への変換は予めキャリブレーションなどを行って用意された変換テーブルによって行われる。
 操作装置44への操作入力に基づいてアクチュエータ(油圧シリンダ)18a,18b,18cを制御する手動制御(第1制御)では,車体コントローラ51が制御弁47a,47b,47c,47f,47gの弁開度を最大(開放)に,制御弁47d,47e,47hの弁開度を最小(遮断)に設定することで,操作レバー44からのパイロット圧がそのまま方向制御弁45に流れ,オペレータの操作通りに作業装置4を操作できる状態となる。一方,操作装置44の操作中に当該操作とは無関係に又は当該操作の一部を利用して,所定の条件(本実施形態では設計面60とバケット先端150の距離d(後述))に従ってアクチュエータ(油圧シリンダ)18a,18b,18cを制御する半自動制御(第2制御)では,車体コントローラ51が当該所定の条件を満たす各アクチュエータ18a,18b,18cの目標速度を演算し,その演算した目標速度に応じた弁開度に制御弁47を設定することで,当該所定の条件に従って作業装置4を制御できる状態となる。つまり,車体コントローラ51はアクチュエータ(油圧シリンダ)18a,18b,18cの制御を手動制御と半自動制御の2つの制御のいずれか一方に切り換えることが可能である。車体コントローラ51に対して2つの制御のいずれを使用するかの指示は,上部旋回体11上の運転室内に設けられた切り替えスイッチ56(図3に図示)を介してオペレータが行うことができる。また,車体コントローラ51内の状態遷移部51a(図3に図示)に入力される状態遷移信号(後述)に基づいて2つの制御が切り替えられることもある。
 車体コントローラ51、ガイダンスコントローラ52及びGNSSコントローラ53は,それぞれ,処理装置(例えばCPU)と,処理装置が実行するプログラム及びそのプログラムの実行に必要なデータ等が格納される記憶装置(例えばROM,RAM等の半導体メモリ)を有するコンピュータ相当のハードウェアである。図3は車体コントローラ51、ガイダンスコントローラ52及びGNSSコントローラ53によって実行される各種演算処理を機能ブロックで示した図である。なお,本実施形態では実機に即して3つのコントローラ51,52,53を備えたが,これらを例えば1つのコントローラに統合しても良いし,さらに機能を分離して4つ以上のコントローラで同様の機能を実現できるシステムを構成しても良い。
 <GNSSコントローラ53>
 GNSSコントローラ53は,2つのアンテナ2が受信した信号から2つのアンテナ2の位置を測定するための測位用のコントローラである。なお,アンテナ測位の方法には様々な種類が存在し,本発明はこれらを限定するものではない。例えば現場に設置したGNSSアンテナを有する基準局から補正情報を受信し,より高精度に自己位置を取得するRTK-GNSS(Real Time Kinematic-GNSS)という手法を用いてもよい。この場合,油圧ショベル1には基準局からの補正情報を受信するための受信機が必要となるが,より精度良くアンテナ2の自己位置を測定できる。
 GNSSコントローラ53は図3に示すように緯度経度演算部53aを備えている。GNSSコントローラ53は,緯度経度演算部53aにおいて,GNSSアンテナ2a,2bから入力した複数のGNSS衛星からの信号を基にGNSSアンテナ2a,2bの地球上の位置(例えば緯度,経度,標高)を演算し,その結果をガイダンスコントローラ52へ送信する。
 <ガイダンスコントローラ52>
 ガイダンスコントローラ52は,図3に示すように,IMU3及びGNSSコントローラ53の出力に基づいて作業装置4の各フロント部材13,14,15の位置及び姿勢を演算する作業装置位置姿勢演算部52aと,油圧ショベル1の施工対象の目標形状を示す3次元の設計データが記録された設計データ記憶部52bと,設計データ記憶部52bに格納された3次元の設計データと作業装置4の動作平面の交線から2次元の設計面データ(設計面の線分データ)を演算する設計面演算部52cと,IMU3やGNSSコントローラ53の動作状況やバケット先端150付近の設計面60の有無等を管理するガイダンス状態管理部52dを備えている。
 ガイダンスコントローラ52は上部旋回体11のどの位置にGNSSアンテナ2が配置されているかという情報を記憶装置に格納しており,作業装置位置姿勢演算部52aはGNSSコントローラ53から入力されるGNSSアンテナ2の位置から逆算して,上部旋回体11の地球上の位置(地理座標系上の位置)を求めることができる。これによりGNSSアンテナ2は作業装置4及びそれが取り付けられた上部旋回体11の位置センサとして機能し得る。本実施形態の油圧ショベル1にはGNSSアンテナ2が2つ搭載されていることから,2つのGNSSアンテナ2の位置から上部旋回体11の方位(ブーム13,アーム14,バケット15がどの方向を向いているか)も知ることができる。GNSSコントローラ53によって演算された地理座標系上の上部旋回体11の位置と方位は適宜任意の座標系上の位置と方位に変換して利用することもできる。
 また,作業装置位置姿勢演算部52aは,IMU3から入力した加速度,角速度などの計測情報を基に各IMU3の自己姿勢を演算できる。このため,作業装置位置姿勢演算部52aは車体IMU3aからの情報により上部旋回体11の前後傾斜,左右傾斜を演算でき,ブームIMU3bからの情報によりブーム13の回転姿勢,アームIMU3cからの情報によりアーム14の回転姿勢を演算できる。また,作業装置位置姿勢演算部52aは,バケットIMU3dからの情報によりバケットリンク16の回転姿勢を知ることができ,アーム14の回転姿勢と,アーム14,バケットリンク16,17及びバケット15からなる四節リンク機構の寸法情報とを基に演算することで,バケット15の回転姿勢を演算できる。
 このようにして,作業装置位置姿勢演算部52aは,地理座標系における上部旋回体11の位置,方位,前後傾斜,左右傾斜を演算でき,上部旋回体11が地球上のどの位置にどのような姿勢で存在するかを演算できる。また,ブーム13,アーム14,バケット15のそれぞれの回転中心及びバケット先端(バケット爪先とも称する)150のうち作業装置4の動作平面上で隣接するもの同士の寸法情報がガイダンスコントローラ52内の記憶装置に記憶されている。そのため,作業装置位置姿勢演算部52aは,各IMU3で取得される各フロント部材13,14,15の回転姿勢の情報と組み合わせることで上部旋回体11(例えばブーム13の基端側の回転中心の位置)に対するバケット先端150の位置を知ることができる。
 したがって,作業装置位置姿勢演算部52aは,地理座標系における上部旋回体11と作業装置4の各フロント部材13,14,15の位置,姿勢及び方位の情報(バケット先端150の位置情報を含む)を求めることができる。これらの情報は,ガイダンスコントローラ52内のガイダンス状態管理部52d及び設計面演算部52c,車体コントローラ51内の目標動作生成部51c,ガイダンスモニタ54等に出力される。
 設計面演算部52cは,作業装置位置姿勢演算部52aから入力されるフロント部材13,14,15の位置,姿勢及び方位の情報から最新の作業装置4の動作平面を演算し,その動作平面と設計データ記憶部52bに格納された3次元の設計データとの交線から半自動制御に利用する設計面60の線分データを演算する。設計面演算部52cは設計面60の線分データをガイダンスモニタ54や車体コントローラ51内の目標動作生成部51c等に出力する。
 ガイダンス状態管理部52dは,IMU3やGNSSコントローラ53の動作状況やバケット先端150付近の設計面60の有無等を管理している。ガイダンス状態管理部52dは,各IMU3のセンサ出力を監視して,IMU3に異常が発生しているか否かを判断する。例えば,IMU3からの信号の停止が検知された場合には,IMU3の機能停止や断線などによりIMU3に異常が生じたと判断する。IMU3に異常が生じたと判断した場合,ガイダンス状態管理部52dは第1状態切替信号を車体コントローラ51内の状態遷移部51aに出力する。
 「第1状態切替信号」は,半自動制御による油圧シリンダ18の制御に必要なハードウェア及びソフトウェアに異常が発生して半自動制御の実行が不可能な状態になったため,半自動制御を強制的に手動制御に切り替える信号である。換言すると,車体コントローラ51による半自動制御の実行を禁止し,手動制御の実行のみを許可する半自動制御禁止モード(手動制御モード)への強制的な切り替え信号でもある。本実施形態における状態切替信号にはさらに第2状態切替信号と第3切替信号がある。「第2状態切替信号」は,オペレータが所望する任意のタイミングで半自動制御を手動制御に切り替える信号である。換言すると,半自動制御を許可する半自動制御許可モード(半自動制御モード)を,半自動制御を禁止する半自動制御禁止モード(手動制御モード)に任意に切り替える信号でもある。「第3状態切替信号」は,オペレータが所望する任意のタイミングで手動制御を半自動制御に切り替える信号である。換言すると,半自動制御を禁止する半自動制御禁止モード(手動制御モード)を,半自動制御を許可する半自動制御許可モード(半自動制御モード)に任意に切り替える信号でもある。
 また,ガイダンス状態管理部52dは,GNSSコントローラ53から入力されるアンテナ2の測位情報を監視して,アンテナ2の測位に異常が発生しているか否かを判断する。例えば,GNSSコントローラ53からの信号の停止が検知された場合,GNSSコントローラ53から入力される測位精度が所定の閾値を下回って低下した場合,アンテナ2の測位が不能であることを示す情報がGNSSコントローラ53から入力された場合には,アンテナ2の測位(GNSS)に異常が生じたと判断する。GNSSに異常が生じたと判断した場合,ガイダンス状態管理部52dは第1状態切替信号を車体コントローラ51内の状態遷移部51aに出力する。なお,GNSSについてはGNSSコントローラ53内で異常を検知し,それをガイダンスコントローラ52内のガイダンス状態管理部52dに伝えてもよいし,車体コントローラ51内の状態遷移部51aに直接伝えても良い。
 また,ガイダンス状態管理部52dは,設計面演算部52cから入力される設計面60の位置情報と,作業装置位置姿勢演算部52aから入力されるバケット15の位置情報・姿勢情報(バケット先端150の位置情報を含む)を監視して,バケット15の近傍に半自動制御の制御対象となる設計面60が存在しているか否かを判断する。例えば,設計面60が存在する領域R(図8参照。但し図8の設計面の符号は61)をその鉛直方向から見て,バケット15上の任意の点が当該領域の外に出た場合,バケット15の近傍に設計面60が存在しない(換言すれば,設計面60が存在する領域の外にバケット15が存在する)と判断することができる。バケット15の近傍に設計面60が存在しないと判断した場合,ガイダンス状態管理部52dは第1状態切替信号を車体コントローラ51内の状態遷移部51aに出力する。
 <ガイダンスモニタ・スピーカ>
 ガイダンスモニタ54は、現在の作業装置4の姿勢やバケット先端150近傍の設計面60(設計データ)の形状や,バケット先端150と設計面60との距離情報(d)などが表示されるモニタである。本実施形態では,オペレータからの入力操作を受け付ける機能を有するタッチパネル式のモニタで構成されており,処理装置(例えばCPU)と,処理装置が実行する表示や入力関係のプログラム及びそのプログラムの実行に必要なデータ等が格納される記憶装置(例えばROM,RAM等の半導体メモリ)を有するコンピュータ相当のハードウェアを内蔵している。ガイダンスモニタ54は,モニタに表示する情報を制御する表示制御部54aと,モニタに入力されるオペレータのタッチ操作を入力情報に変換する入力情報処理部54bを備えている。
 表示制御部54aは,ガイダンスコントローラ52から入力される設計データや油圧ショベル1の作業装置4の姿勢,バケット先端150と設計データとの相対位置関係などの情報をガイダンスモニタ54に表示する。例えば,設計面60の線分データとバケット15の側面画像を表示することで,バケット15と設計面60の最新の位置関係をオペレータに報せることができる。オペレータはガイダンスモニタ54から得られるこれらの情報を基に,例えば設計データ(設計面60)とバケット先端150との距離dがゼロに保持されるように作業装置4を操作することで,設計データ通りの目標形状となるように掘削作業を行うことができる。
 また,ガイダンスコントローラ52は,スピーカ55を用いて設計面60とバケット先端150との相対位置関係をアラームの音量,発音間隔,音色の変化などでオペレータへ伝達することもできる。例えば,バケット先端150が設計面60に近づくほど,音量を大きくしたり,発音間隔を短くしたり,周波数を高くしたりすることができる。これによりオペレータはガイダンスモニタ54を注視しなくても,スピーカ55からのアラームの変化によって,例えば目標形状とバケット先端150との距離がゼロとなるように作業装置4を操作することができる。
 ガイダンスコントローラ52は,設計データ(設計面60)や作業装置4の姿勢,設計面60とバケット先端150と相対位置関係などの情報を車体コントローラ51に送信する。車体コントローラ51では,半自動制御(第2制御)において,これらの情報を基に例えば設計面60とバケット先端150との距離dがゼロとなるように作業装置4を制御し,設計データ通りの目標形状となるような掘削作業をオペレータの操作によらず,またはオペレータの操作に介入して行うことができる。次に車体コントローラ51で行われる半自動制御の詳細について説明する。
 <車体コントローラ>
 車体コントローラ51は,操作装置44への操作入力に基づいてアクチュエータ(油圧シリンダ)18a,18b,18cを制御する手動制御(第1制御)と,操作装置44の操作中に設計面60と作業装置4(バケット先端150)との距離dに基づいてアクチュエータ(油圧シリンダ)18a,18b,18cを制御する半自動制御(第2制御)の2つの制御のいずれか一方によってアクチュエータ(油圧シリンダ)18a,18b,18cを制御する。この機能を発揮するために,車体コントローラ51は,状態切替信号(第1,第2,第3状態切替信号)の入力に基づいて手動制御(第1制御)と半自動制御(第2制御)を切り替える状態遷移部51aと,手動制御と半自動制御が切り替わる際の油圧シリンダ(アクチュエータ)18a-18cの速度の時間変化率の制限値を設定する速度遷移部51bと,油圧シリンダ(アクチュエータ)18a-18cの目標速度を演算する目標動作生成部51cと,油圧シリンダ(アクチュエータ)18a-18cを目標速度で動作するための制御弁47への制御指令を演算・出力するアクチュエータ制御部51dを備えている。
 状態遷移部51aは,目標動作生成部51cで行われる油圧シリンダ(アクチュエータ)18a-18cの制御方式を切替スイッチ56及びガイダンスコントローラ52内のガイダンス状態管理部52d及び車体コントローラ51内の目標動作生成部51cから入力される状態切替信号(第1,第2,第3状態切替信号)に基づいて手動制御(第1制御)と半自動制御(第2制御)のいずれかに切り替える。第1状態切替信号は,ガイダンスコントローラ52内のガイダンス状態管理部52dと,車体コントローラ51内の目標動作生成部51cから入力される。第2及び第3状態切替信号は,油圧ショベル1の運転席内に設置された切り替えスイッチ56から入力される。
 切り替えスイッチ56は,任意のタイミングでオペレータによって操作される2位置切替式のスイッチであり,半自動制御を禁止する半自動制御禁止モード(手動制御モード)が選択される第1位置と,半自動制御を許可する半自動制御許可モード(半自動制御モード)が選択される第2位置を有する。切替スイッチ56が第2位置から第1位置へ切り替えられると第2状態切替信号が状態遷移部51aに対して出力される。一方,切替スイッチ56が第1位置から第2位置へ切り替えられると第3状態切替信号が状態遷移部51aに対して出力される。
 第1及び第2状態切替信号を入力した状態遷移部51aは,状態切替信号の入力時に半自動制御(第2制御)が実行中の場合には半自動制御(第2制御)を手動制御(第1制御)に切り替え,状態切替信号の入力時に手動制御(第1制御)が実行中の場合にはそれ以後の半自動制御の実行を禁止する。一方,第3状態切替信号を入力した状態遷移部51aは,状態切替信号の入力時に半自動制御が実行される条件が満たされている場合には手動制御(第1制御)から半自動制御(第2制御)に切り替え,状態切替信号の入力時に半自動制御が実行される条件が満たされていない場合には手動制御(第1制御)を継続する。
 速度遷移部51bは,手動制御と半自動制御からなる2つの制御が状態遷移部51aによって切り替えられ,制御対象のアクチュエータ(油圧シリンダ)18a,18b,18cの速度が2つの制御のうち切り替え前の制御が規定する速度から切り替え後の制御が規定する速度に変化するときにおける当該アクチュエータ(油圧シリンダ)18a,18b,18cの速度の時間変化率の制限値(「速度変化率」とも称する)を第1変化率I1に設定する。そして,速度遷移部51bは,状態遷移部51aによって2つの制御が切り替えられ当該アクチュエータ(油圧シリンダ)18a,18b,18cの速度が,切り替え後の制御が規定する速度に変化するまでの間に操作装置44への操作入力が変化した場合,当該アクチュエータ(油圧シリンダ)18a,18b,18cの速度の時間変化率を,第1変化率I1から第1変化率よりも大きい第2変化率I2に変更する。2つの制御の切り替え時の速度変化率が第1変化率I1から第2変化率I2に変更されると,2つの制御間で速度の切り換えに要する時間を短縮することができるとともに,速度の切り換え後の制御を開始するまでの待ち時間を短縮できる。
 目標動作生成部51cは,手動制御時の各油圧シリンダ18a,18b,18cの目標速度と,半自動制御時の各油圧シリンダ18a,18b,18cの目標速度を演算する部分である。手動制御と半自動制御のいずれの制御を利用するかは状態遷移部51aからの指示に基づいて決定する。
 <半自動制御時の目標動作生成部51c>
 半自動制御時において,目標動作生成部51cは,ガイダンスコントローラ52から入力される情報に基づいて設計面60と作業装置4(バケット先端150)との距離dを演算する。そして,操作装置44の操作時に,作業装置4の動作範囲が設計面60上及びその上方に制限されるように各油圧シリンダ18a,18b,18cの目標速度を距離dに応じて演算する。本実施の形態では下記の演算を行う。
 まず,目標動作生成部51cは,まず,操作レバー44bから入力される電圧値(ブーム操作量)からブームシリンダ18aへの要求速度(ブームシリンダ要求速度)を計算し,操作レバー44cから入力される電圧値(アーム操作量)からアームシリンダ18bへの要求速度を計算し,操作レバー44dから入力される電圧値(バケット操作量)からバケットシリンダ18cへの要求速度を計算する。この3つの要求速度と作業装置位置姿勢演算部52aで演算された作業装置4の各フロント部材13,14,15の姿勢から,バケット先端150における作業装置4の速度ベクトル(要求速度ベクトル)V0(図5の左の図参照)を計算する。そして,速度ベクトルV0の設計面鉛直方向の速度成分V0zと設計面水平方向の速度成分V0xも計算する。
 次に,目標動作生成部51cは,距離dに応じて決定される補正係数kを演算する。図4はバケット先端150と設計面60の距離dと速度補正係数kとの関係を表すグラフである。バケット先端150(作業装置4の制御点)が設計面60の上方に位置している時の距離を正,設計面60の下方に位置している時の距離を負として,距離dが正の時は正の補正係数を,距離dが負の時は負の補正係数を,1以下の値として出力する。なお,速度ベクトルは設計面60の上方から設計面60に近づく方向を正としている。
 次に,目標動作生成部51cは,距離dに応じて決定される補正係数kを,速度ベクトルV0の設計面鉛直方向の速度成分V0zに乗ずることによって速度成分V1z(図5の右の図参照)を計算する。この速度成分V1zと,速度ベクトルV0の設計面水平方向の速度成分V0xとを合成することで合成速度ベクトル(目標速度ベクトル)V1を計算し,この合成速度ベクトルV1を発生可能なブームシリンダ速度と,アームシリンダ速度(Va1)と,バケットシリンダ速度をそれぞれ目標速度として演算する。この目標速度の演算の際には,作業装置位置姿勢演算部52aで演算された作業装置4の各フロント部材13,14,15の姿勢を利用しても良い。目標動作生成部51cは,計算した各油圧シリンダの目標速度をアクチュエータ制御部51dに出力する。
 図5はバケット先端150における距離dに応じた補正前後の速度ベクトルを表す模式図である。要求速度ベクトルV0の設計面鉛直方向の成分V0z(図5の左の図参照)に速度補正係数kを乗じることにより,V0z以下の設計面鉛直方向の速度ベクトルV1z(図5の右の図参照)が得られる。V1zと要求速度ベクトルV0の設計面水平方向の成分のV0xとの合成速度ベクトルV1を計算し,V1を出力可能なアームシリンダ目標速度と,ブームシリンダ目標速度と,バケットシリンダ目標速度とが計算される。
 <手動動制御時の目標動作生成部51c>
 手動制御時において,目標動作生成部51cは,まず,操作レバー44bから入力される電圧値(ブーム操作量)からブームシリンダ18aの目標速度(半自動制御のブームシリンダ要求速度と同じ)を計算し,操作レバー44cから入力される電圧値(アーム操作量)からアームシリンダ18bの目標速度(半自動制御のアームシリンダ要求速度と同じ)を計算し,操作レバー44dから入力される電圧値(バケット操作量)からバケットシリンダ18cの目標速度(半自動制御のバケットシリンダ要求速度と同じ)を計算する。目標動作生成部51cは,計算した各油圧シリンダの目標速度をアクチュエータ制御部51dに出力する。
 <異常検出時の目標動作生成部51c>
 また,目標動作生成部51cは,遮断弁46及び各制御弁47の前後に配置され,遮断弁46及び各制御弁47の前後の圧力(パイロット圧)を検出する複数の油圧センサ(圧力センサ)49と,遮断弁46と,複数の制御弁47とを含む半自動制御に必要なハードウェアの異常の有無を管理している。目標動作生成部51cは,車体コントローラ51(例えばアクチュエータ制御部51d)が遮断弁46及び各制御弁47に出力している制御信号(例えば指令電流)が規定するパイロット圧の値(目標値)と,各油圧センサ49が検出するパイロット圧の値(実際の値)とを比較することで遮断弁46及び各制御弁47及び各油圧センサ49に異常が発生したか否かを判断する。例えば,油圧センサ49による制御弁47の上流側の圧力検出値が十分高い状態で,車体コントローラ51からは制御弁47の下流側で一定の圧力を出力するように規定する指令電流を制御弁47に出力していた場合に,油圧センサ49による制御弁47の下流側の圧力検出値が指令値よりも明らかに高いまたは低いときには,制御弁47又は油圧センサ49に異常が発生している(正常でない)と推定できる。なお,目標動作生成部51cは,自身(目標動作生成部51c)が演算したアクチュエータ目標速度と,各油圧センサ49が検出するパイロット圧の値(実際の値)とを比較することで各制御弁47及び各油圧センサ49に異常が発生したか否かを判断しても良い。このように目標動作生成部51cは,半自動制御によってアクチュエータ(油圧シリンダ)18a,18b,18cが制御されている間に,車体コントローラ51で生成された制御信号が規定する圧力値と油圧センサ49の検出値とを比較して,遮断弁46,制御弁47及び油圧センサ49のいずれかに異常が発生したと判定した場合,半自動制御(第2制御)を手動制御(第1制御)に切り替える第1状態切替信号を状態遷移部51aに出力する。
 アクチュエータ制御部51dは,目標動作生成部51cで演算された各油圧シリンダ18a,18b,18cの目標速度に基づいて,各制御弁47への制御信号(制御弁指令電流)を演算し,その制御信号を対応する制御弁47に出力することで方向制御弁45を制御する部分である。このように制御される方向制御弁45によって,各油圧シリンダ18a,18b,18cは目標動作生成部51cで計算された目標速度に従って動作する。
 図6は油圧ショベル1と設計面(設計データ)60との関係を示す図である。施工対象の目標形状を示す設計面60には,一つの面からなる単平面データや,複数の面を組合せた複数面データなどがある。図6においては,平面60が設計面としてガイダンスコントローラ52に記録されているとし,この平面60を目標形状として作業装置4を制御する例について以下で説明する。
 <手動制御による設計面の掘削>
 手動制御(第1制御)の油圧ショベル1によって目標形状を達成する掘削作業を行うには,ブーム13,アーム14,バケット15からなる作業装置4を適切に動作させ,バケット先端150が目標形状に沿うように動かすことが必要となる。つまり,平面60とバケット先端150との距離dが常にゼロとなるようにバケット15が動作すれば,バケット先端150の通った軌跡,つまり掘削仕上げ面は平面60と一致する。本実施の形態に係わる油圧ショベル1にはガイダンスモニタ54が備わっており,前述の通りガイダンスモニタ54に現在の作業装置4の姿勢情報や目標形状の情報,及び目標形状とバケット先端150との相対位置関係(距離dの情報)などが表示される。このため,手動制御においては,オペレータはこれらの情報を適宜参照することによって,アーム曲げ操作(アームクラウド操作)によってバケット15を車体側に引き寄せる動作を行いながら,ブーム上げ/下げ操作によって距離dがなるべくゼロになるよう調整することで,目標形状を達成する掘削作業を行うことができる。
 <半自動制御による設計面の掘削>
 一方,半自動制御(第2制御)においては,オペレータは手動制御時の同様にアーム曲げ操作を行うが,ブーム上げ/下げ操作による距離dの調整を行う必要はなく,ブーム13の移動速度は車体コントローラ51によって制御される。図6の油圧ショベル1の作業装置4の姿勢においてオペレータがアーム曲げ操作を行うと,ブーム13とアーム14とを回転支持する関節140を中心にアーム14が平面60に近づく方向に駆動され,その結果バケット15も平面60に近づくので距離dはゼロに近づく。そのままアーム14が駆動されるとバケット先端150は平面60を通り過ぎ,距離dは離れていく。
 ここで,距離dに応じて適切な速度でブーム13(ブームシリンダ18a)が駆動されれば,距離dをゼロ付近に保ちつつ掘削作業を行うことができる。本実施の形態では,ガイダンスコントローラ52から得られる作業装置4の現在の姿勢やアーム14の移動速度,設計面60や距離dを含む設計面60と作業装置4との相対位置関係などの情報を基に,車体コントローラ51が距離dをゼロ付近に保つようなブームシリンダ18aの目標速度を演算し,制御弁47c,47dの弁開度を制御することによって演算された目標速度通りにブームシリンダ18aを駆動する。
 ここで,図7に示すように,バケット先端150と関節140とを結んだ直線Lと平面60とが直交するときの作業装置4の姿勢を直交姿勢ということとする。一連の掘削作業の中で,アーム曲げ操作に対して,直交姿勢になる瞬間まではブーム上げ動作,直交姿勢になった直後からはブーム下げ動作を行うことで,バケット先端150を平面60に沿うように動作させることができる。
 ブーム上げ動作については,車体コントローラ51が制御弁47dの弁開度を大きくすることによって実行できる。
 しかし,ブーム下げ動作については,車体コントローラ51が制御弁47cの弁開度を調整するだけでは実行できない。これは,制御弁47cと油圧ポンプ42との間に操作レバー44bがあるからであり,操作レバー44bをブーム下げ方向に操作しなければ,制御弁47cにはパイロット油は流れない。このため,ブーム下げ動作を制御するためには,オペレータに操作レバー44bに対してブーム下げ方向の操作を入力してもらわなければならず,操作レバー44bから制御弁47cにパイロット油が供給されれば,車体コントローラ51が制御弁47cの弁開度を調整することでブーム下げ方向の移動速度を制御できる。
 このような構成において,オペレータの操作としては操作レバー44bに対してブーム下げ方向に最大入力となる操作をしつつ,操作レバー44aに対してアーム曲げ方向の操作を入力するという場合が考えられる。この場合,直交姿勢までは車体コントローラ51が制御弁47cの弁開度を最小(遮断)にし,制御弁47dの弁開度を適切に大きくしてブーム上げ動作を行う。そして,直交姿勢後は制御弁47dの弁開度を最小(遮断)にし,制御弁47cの弁開度を大きくしてブーム下げ動作を行うことで,目標形状を達成する掘削作業を実行できる。また,オペレータはブーム操作を調整する必要はなく,ただ最大入力(操作レバー44bをブーム下げ方向に最大まで倒す)を入れ続ければよい。
 図8は図6と同様に油圧ショベルと設計面61との関係を示す図である。図8においては,目標形状を示す設計面として平面61がガイダンスコントローラ52に記録されているとする。平面61は範囲R内のみに存在する単平面である。
 半自動制御において,車体コントローラ51は前述の通り距離dなどの情報を基にブームシリンダ18aの目標速度を演算し,ブーム13の動作を制御する。ただし,図8に示すように,バケット15やバケット先端150が設計面61の存在する範囲外,つまり平面61の存在する範囲Rの外に出た場合,距離dなど(目標形状と作業装置4との相対位置関係)を得ることができず,半自動制御が実行できない状況となる。半自動制御においてこのような制御を継続できない状況になった場合には,強制的に手動制御に切り替えてオペレータに操作を委ねる必要がある。この時,オペレータが操作レバー44bに対して上記のような事情でブーム下げ方向に最大入力操作を行っていたとすると,半自動制御から手動制御に切り替わった瞬間にブーム下げ動作が急加速し,図8の矢印Aの方向に作業装置が急動作して車体が不安定な状態となる可能性がある。これを抑制するため,本実施の形態では,車体コントローラ51がブームシリンダ18aの速度変化率を制限し,急加速の発生を防止する。ただし,オペレータの操作レバーに対する操作入力が閾値以上の割合で変化した場合,速度変化率の制限を緩和又は解除することで,オペレータの操作と実際の作業装置4の動きとが異なることによるオペレータの違和感を抑制する。
 次に,半自動制御と,半自動制御から手動制御への遷移時に行われる速度遷移制御と,手動制御についてフローチャートを用いて説明する。ここでは説明を簡単にするために,半自動制御でブームシリンダ18a(すなわちブーム13)のみを制御するものとする。
 図9は半自動制御時の車体コントローラ51及びガイダンスコントローラ52による処理の流れを示すフローチャートである。車体コントローラ51及びガイダンスコントローラ52は操作装置44がオペレータにより操作されると図9の処理を開始する。まず,ガイダンスコントローラ52内の作業装置位置姿勢演算部52aは,IMU3から各フロント部材13,14,15及び上部旋回体11の傾斜角の情報や,GNSSアンテナ2の航法信号に基づいてGNSSコントローラ53で演算される油圧ショベル1の位置情報,姿勢情報(角度情報)及び方位情報や,予め記憶されている各フロント部材13,14,15の寸法情報等に基づき地理座標系におけるバケット先端150(制御点)の位置情報を演算する(手順S1)。
 手順S2では,ガイダンスコントローラ52内の設計面演算部52cが,作業装置位置姿勢演算部52aで演算された地理座標系におけるバケット先端150の位置情報(油圧ショベル1の位置情報を利用しても良い)を基準として所定の範囲に含まれる設計面60の位置情報(設計データ)を設計データ記憶部52bから取得して,それを車体コントローラ51内の目標動作生成部51cに出力する。目標動作生成部51cは,その設計データの中からバケット先端150に最も近い位置に在る設計面を制御対象の設計面60,すなわち距離dを演算する設計面60として設定する。
 手順S3では,目標動作生成部51cは,手順S1で取得したバケット先端150の位置情報と手順S2で取得した設計面60の位置情報に基づいて距離dを演算する。
 手順S4では,目標動作生成部51cは,手順S3で演算した距離dと,操作装置44から入力される各操作レバーの操作量(圧力値)とに基づいて,作業装置4が動作してもバケット先端150が設計面60上またはその上方に保持されるように各油圧シリンダ18a,18b,18cの目標速度を演算する。
 手順S5では,アクチュエータ制御部51dが各油圧シリンダの目標速度に基づいて各制御弁47を駆動する制御信号(例えば指令電流)を演算し,その制御信号に対応する制御弁47にそれぞれ出力する。これにより各油圧シリンダ18a,18b,18cの目標速度(アクチュエータ目標速度)に基づいて各油圧シリンダ18a,18b,18cが駆動して各フロント部材13,14,15が動作する。
 手順S6では,目標動作生成部51cは,半自動制御を手動制御に切り換える制御切替指示(この指示は,第1状態切替信号や第2状態切替信号が状態遷移部51aに入力された場合に出力される)が状態遷移部51aから入力されたか否かを判定する。当該制御切替指示が入力された場合には次に図10を用いて説明する速度遷移制御を実行する。一方,当該制御切替指示の入力の無い場合には最初の手順S1に戻って半自動制御を続行する。
 図10は半自動制御から手動制御に切り替わる際の車体コントローラ51の処理(速度遷移制御)の流れを示すフローチャートである。ここでは制御が切り替わった時刻(t0)からの経過時間をtとする(すなわち,時刻t0における時間tは0となる)。また,時刻tにおける半自動制御によるブームシリンダ目標速度をVa(t)とし,同様に時刻tにおける手動制御によるブームシリンダ目標速度をVo(t)とする。目標速度Va(t)とVo(t)は時間tの関数である。なお図中において内容が同じ処理を実行する手順は同じ符号を付している。
 手順S21では,半自動制御を手動制御に切り換える指示(制御切替指示)が状態遷移部51aから入力されると,車体コントローラ51内の速度遷移部51bは,目標動作生成部51cで利用される油圧シリンダ18a,18b,18cの速度変化率を第1変化率I1に設定する。
 手順S22では,目標動作生成部51cは,切り替わり時(t=0)における半自動制御によるブームシリンダ目標速度Va(0)と,切り替わり時(t=0)における手動制御によるブームシリンダ目標速度Vo(0)を取得する。Va(0)は図9の手順S4で演算される値であり,Vo(0)は後述の図11の手順S21で演算される値と同じであり,Va(0)とVo(0)は共に定数である。そこで,以下では半自動制御によるブームシリンダ目標速度Va(0)=Vcと表記することがある。
 手順S23では,目標動作生成部51cは,Va(0)とVo(0)の大小を比較する。そして,Vo(0)≦Va(0)が成立する場合(すなわち,Va(0)がVo(0)以上の場合)には手順S24に進み,そうでない場合(すなわち,Va(0)がVo(0)未満の場合)には手順S24Aに進む。
 手順S24では,目標動作生成部51cは,第1速度変化率I1(速度変化率)にtを乗じたものをVcから減じた値をブームシリンダ18aの目標速度(Va(t)=Vc-I1・t)として演算し,その目標速度に基づいて制御弁47を制御することでブームシリンダ18aの制御を行う。
 手順S24Aでは,目標動作生成部51cは,第1速度変化率I1(速度変化率)にtを乗じたものをVcに加えた値をブームシリンダ18aの目標速度(Va(t)=Vc+I1・t)として演算し,その目標速度に基づいて制御弁47を制御することでブームシリンダ18aの制御を行う。
 手順S25では,目標動作生成部51cは,時刻tにおける手動制御によるブームシリンダ目標速度Vo(t)をオペレータの操作装置44への入力操作量に基づいて演算する。この手順の演算は状態遷移部51bで行っても良い。
 手順S26では,目標動作生成部51cは,手順S24又は手順S24Aで演算したVa(t)と,手順S25で演算したVo(t)が一致したか否かを判定する。Va(t)とVo(t)が一致しない場合には速度遷移制御がまだ必要な状態と判断して手順S27に進む。一方,Va(t)とVo(t)が一致した場合には半自動制御を手動制御に切り換えてもブームシリンダ18aの速度変化は生じずオペレータに違和感を与えない状態となるため,図11に示す通常の手動制御に移行する。
 手順S27では,状態遷移部51aは,油圧センサ49で検出されるパイロット圧(操作装置44への操作入力)に基づいて,半自動制御の対象の油圧シリンダ(ここではブームシリンダ18a)の操作装置44(ここでは操作レバー44b)に対してオペレータが入力する操作量の時間当たりの変化量(変化率)の絶対値が閾値I’0以上か否かを判定する。操作入力の変化率の絶対値が閾値I’0未満の場合は手順S24に戻って速度変化率をI1に維持する。一方,操作入力の変化率の絶対値が閾値I’0以上の場合は手順S28に進む。
 閾値I’0の決め方は,例えば通常作業時のオペレータのブーム操作入力を一定期間記録し,その操作入力の時間当たりの変化量を求めて,一定期間内の変化量の最大値付近の値,もしくは最大値よりも大きな値を設定するという方法がある。これは,通常作業時にはほとんど入力しないような操作があった場合を緊急度の高い状況と考え,すぐにブーム13を止めたいなど変化率制限値を大きくすることが必要な場面であると判断できるからである。
 また,閾値I’0は速度変化率I1を操作量の変化率に変換した値I’1よりも大きい値に設定することもできる。本発明は,変化率の制限がかかった状態において,より早く変化させたいというオペレータの意図を操作入力から読み取り,速度変化率をより大きな値I2に変えるというものであり,速度変化率I1よりも大きなオペレータ操作入力の変化がその意図の一つの条件と考えられるからである。
 なお,本実施形態では操作レバー44bの操作入力の変化率が閾値I’0以上か否かを判定したが,これに代えて時刻tにおける手動制御によるブームシリンダ目標速度Vo(t)の時間当たりの変化量(変化率)の絶対値が閾値I0以上か否かを判定しても良い。但し,この場合の速度の閾値I0は上記の操作量の閾値I’0と同様の考え方で決められたI’0と同等の値とする。なお,後述の図12では速度の閾値I0を利用して本願の効果を説明している。
 手順S28では,速度遷移部51bは,半自動制御の制御対象の油圧シリンダ(ここではブームシリンダ18a)の速度変化率を第1変化率I1よりも大きい第2変化率I2に変更する。そして,目標動作生成部51cは,速度変化率の変更時(t=t1)における半自動制御によるブームシリンダ目標速度Va(t1)を取得する。以上の処理が完了したら手順S29又は手順S29Aに進む。
 手順S29では,目標動作生成部51cは,第2速度変化率I1に(t-t1)を乗じたものをVa(t1)から減じた値をブームシリンダ18aの目標速度(Va(t)=Va(t1)-I2(t-t1))として演算し,その目標速度に基づいて制御弁47を制御することでブームシリンダ18aの制御を行う。これにより速度制限が緩和されるのでブームシリンダ18aの速度が上昇して手動制御に移行する時間を短縮できる。
 手順S29Aでは,目標動作生成部51cは,第2速度変化率I1に(t-t1)を乗じたものをVa(t1)に加えた値をブームシリンダ18aの目標速度(Va(t)=Va(t1)+I2(t-t1))として演算し,その目標速度に基づいて制御弁47を制御することでブームシリンダ18aの制御を行う。これにより速度制限が緩和されるのでブームシリンダ18aの速度が上昇して手動制御に移行する時間を短縮できる。
 手順S30では,目標動作生成部51cは,時刻tにおける手動制御によるブームシリンダ目標速度Vo(t)をオペレータの操作装置44への入力操作量に基づいて演算する。この手順の演算は状態遷移部51bで行っても良い。
 手順S31では,目標動作生成部51cは,手順S29又は手順S29Aで演算したVa(t)と,手順S30で演算したVo(t)が一致したか否かを判定する。Va(t)とVo(t)が一致しない場合には速度遷移制御がまだ必要な状態と判断して手順S29に戻る。一方,Va(t)とVo(t)が一致した場合には半自動制御を手動制御に切り換えてもブームシリンダ18aの速度変化は生じずオペレータに違和感を与えない状態となるため,図11に示す通常の手動制御に移行する。
 図11は手動制御時の車体コントローラ51による処理の流れを示すフローチャートである。手順S41では,目標動作生成部51cは,操作装置44から入力される各操作レバーの操作量(圧力値)に基づいて,各油圧シリンダ18a,18b,18cの目標速度を演算する。
 手順S42では,手順S41で演算したアクチュエータ制御部51dが各油圧シリンダの目標速度に基づいて各制御弁47を駆動する制御信号(例えば指令電流)を演算し,その制御信号に対応する制御弁47にそれぞれ出力する。通常の手動制御では,制御弁47a,47b,47c,47f,47gの弁開度を最大(開放)に,制御弁47d,47e,47hの弁開度を最小(遮断)に設定する制御信号が出力される。これにより,操作レバー44からのパイロット圧がそのまま方向制御弁45に流れ,オペレータの操作通りに作業装置4を操作できる状態となる。
 手順S43では,目標動作生成部51cは,手動制御を半自動制御に切り換える制御切替指示(この指示は第3状態切替信号が状態遷移部51aに入力されると出力される)が状態遷移部51aから入力されたか否かを判定する。当該制御切替指示が入力された場合には図9を用いて説明した半自動制御を実行する。一方,当該制御切替指示の入力の無い場合には最初の手順S41に戻って手動制御を続行する。
 なお,本実施形態では手動制御から半自動制御に遷移する際には図10の速度遷移制御に相当する制御を行っていないが,手動制御から半自動制御の場合も同様の速度遷移制御を行っても良い。
 図12は半自動制御から手動制御に切り替わる際のブームシリンダ速度の変化を示す図である。縦軸がブームシリンダ速度であり,正の値がブーム上げ方向の動作速度,負の値がブーム下げ方向の動作速度を表す。横軸は時間tである。時間t0で半自動制御から手動制御への切替が必要と判断され,車体コントローラ51で演算される半自動制御に基づく目標速度Vc(=Va(0))から,オペレータの操作レバー44bに対する操作入力に基づく目標速度Vo(t)まで,ブームシリンダ目標速度Va(t)が時間の経過と共に変化する様子を表している。時間t0以前は半自動制御であり,ブームシリンダ目標速度Va(t)は半自動制御に基づく目標速度Vcと一致している。
 時刻t0では,半自動制御を手動制御に切り換える制御切替指示が車体コントローラ51内の状態遷移部51aから目標動作生成部51cに出力され,半自動制御から手動制御への切替が必要と判断される。その時刻t0におけるオペレータ操作に基づく目標速度Vo(t)の変化量は略ゼロで前述の速度の閾値I0より小さいため,図10の手順S24に基づいてブームシリンダ目標速度Va(t)が演算される。これによりブームシリンダ目標速度Va(t)の変化率が予め定められた第1速度変化率I1に制限される。
 時刻t0から時刻t1まではオペレータ操作に基づく目標速度Vo(t)の変化率が閾値I0よりも小さいため,手順S24に基づく処理が継続する。しかし,時刻t1でオペレータ操作に基づく目標速度Vo(t)の変化率が閾値I0以上となる。これにより手順S28の処理が実行され,ブームシリンダ目標速度Va(t)の変化率を制限する値が第1速度変化率I1から第2速度変化率I2に変更される。ここで第2速度変化率I2は第1速度変化率I1よりも大きい値(時間当たりに,より大きな変化を許容する値)である。
 時刻t2でブームシリンダ目標速度Va(t)がオペレータ操作に基づく目標速度Vo(t)と一致し,半自動制御から手動制御に完全に切り替わる(図11の制御に移行する)。時刻t2以降はオペレータの操作入力通りに動作する手動制御となるため,ブームシリンダ目標Va(t)はオペレータ操作に基づく目標速度Vo(t)と一致する。
 図12に示したオペレータ操作に基づく目標速度Vo(t)の時間変化は次の(1)-(3)のような判断をオペレータが行った状況を想定している。すなわち,(1)時刻t0で設計データの存在する範囲Rから作業装置4が出た直後にさらに掘削する目的などでオペレータにはブーム13を下げたい要求があった。(2)しかし,時刻t0で半自動制御が不可となった場合,オペレータは,時刻t0より前の半自動制御の発動の条件であるブーム下げ操作の入力に従ってブーム13が急激に下がることを予想して,時刻t0からt1の間にブーム下げ操作入力を緩めるように操作レバー44bを操作した。(3)しかし,ブームシリンダ18aの目標速度Va(t)の変化率に制限が掛かるため,オペレータの予想に反してブーム13はすぐに下がらなかった。そこでオペレータは時刻t2で再度ブーム下げ操作入力を強めるような操作をした。
 本実施の形態では,目標速度の演算方式の異なる2つの制御の切り換え時に行われる速度遷移制御中に操作装置44に対する操作入力を素早く変化させると,オペレータに操作の意思があるとみなし,速度遷移制御中に利用される速度制限値(第1速度変化率I1)がより大きい値(第2速度変化率I2)に変更されて速度制限が緩和される。その結果,第1速度変化率I1が継続して利用された場合に半自動制御が手動制御に完全に切り替わる時刻t3よりも早い時刻t2で手動制御に切り替えることができる。すなわちオペレータの意図する目標速度で作業装置4を操作できる時刻が従前より早まるので,オペレータの操作と実際のブーム動作が乖離することによる違和感の発生を抑制できる。
 このように,操作装置44に対する操作入力の変化からオペレータに積極的な操作意思があることを読み取り,実際の作業装置4の動作をより早くオペレータ操作に近づけられるというのが本実施形態の効果である。一方,オペレータの操作入力が一定であれば,オペレータの操作意思の有無が不明であるため,第1速度変化率での制限を継続する。これにより,作業装置4の急激な動作が防止され車体の安定性が確保されるとともに,オペレータに積極的な操作意思がある場合にはオペレータ操作が作業装置4の動作に反映されるタイミングが早まるため,オペレータが操作と動作の乖離に対して違和感を持つことを抑制できる。
<第2の実施の形態>
 図13から図16を用いて,本発明の第2の実施の形態について説明する。なお,第1の実施の形態と異なる点についてのみ説明し,説明のない部分については第2の実施の形態と同様である。
 図13は半自動制御から手動制御に切り替わる際の車体コントローラ51の処理(速度遷移制御)の流れを示すフローチャートである。図10と異なる点は手順S27に代えて操作判定処理を行っている点にある。手順S26では,目標動作生成部51cは,手順S24又は手順S24Aで演算したVa(t)と,手順S25で演算したVo(t)が一致したか否かを判定する。Va(t)とVo(t)が一致しない場合には速度遷移制御がまだ必要な状態と判断して図14に示す操作判定処理を開始する。
 図14は操作判定処理の流れを示すフローチャートである。手順S51では,状態遷移部51aは,1ステップ前の操作判定処理の手順S54で記憶したオペレータの操作レバー44bへの操作入力がゼロか否かを判定する。1ステップ前の操作入力がゼロの場合は手順S52に進み,ゼロ以外の場合は手順S53に進む。なお,ここで行われる操作入力がゼロか否かの判定は,ブーム操作レバー44b直下に配置されたブーム下げパイロット圧を検出する油圧センサ49dの検出値が操作レバー44bの中立時の圧力の範囲内にあるか否かで判定してもよい。すなわち油圧センサ49dの検出値が所定の閾値以下か否かで判定しても良い。これはその他の手順S52,S53についても同様である。
 手順S52では,状態遷移部51aは,現在のオペレータの操作レバー44bへの操作入力がゼロ以外か否かを判定する。操作入力がゼロ以外の場合には操作判定処理を終了して手順S28に進み,速度変化率を第2速度変化率I2に変更する。一方,操作入力がゼロの場合には手順S54で今回の操作入力値を記憶して手順S24に戻る。
 手順S53では,状態遷移部51aは,現在のオペレータの操作レバー44bへの操作入力がゼロか否かを判定する。操作入力がゼロの場合には操作判定処理を終了して手順S28に進み,速度変化率を第2速度変化率I2に変更する。一方,操作入力がゼロでない場合には手順S54で今回の操作入力値を記憶して手順S24に戻る。
 本実施形態の作用と効果について図15と図16を用いて説明する。 
 図15は半自動制御から手動制御に切り替わる際のブームシリンダ速度の変化の第1の例を示す図である。縦軸がブームシリンダ速度であり,正の値がブーム上げ方向の動作速度,負の値がブーム下げ方向の動作速度を表す。横軸は時間tである。時間t0で半自動制御から手動制御への切替が必要と判断され,車体コントローラ51で演算される半自動制御に基づく目標速度Vc(=Va(0))から,オペレータの操作レバー44bに対する操作入力に基づく目標速度Vo(t)まで,ブームシリンダ目標速度Va(t)が時間の経過と共に変化する様子を表している。時間t0以前は半自動制御であり,ブームシリンダ目標速度Va(t)は半自動制御に基づく目標速度Vcと一致している。
 時刻t0では,半自動制御を手動制御に切り換える制御切替指示が車体コントローラ51内の状態遷移部51aから目標動作生成部51cに出力され,半自動制御から手動制御への切替が必要と判断される。時刻t0と1ステップ前の時刻におけるオペレータ操作に基づく目標速度Vo(t)はどちらもゼロより小さく,どちらも操作レバー44bへの操作入力がゼロではない。そのため,図14の操作判定処理では,手順S51,S53,S54と進んで手順S24に戻る。すなわち,ブームシリンダ目標速度Va(t)の変化率は予め定められた第1速度変化率I1に保持される。その後,時刻t1までは,時刻t0と同様にオペレータ操作に基づく目標速度Vo(t)がゼロより小さいため,第1速度変化率I1でブームシリンダ速度を制限する処理が継続する。
 時刻t1では,オペレータ操作に基づく目標速度Vo(t)はゼロであり,操作レバー44bへの操作入力がゼロとなる。また,1ステップ前の時刻におけるオペレータ操作に基づく目標速度Vo(t)はゼロより小さく,操作レバー44bへの操作入力はゼロではない。そのため,図14の操作判定処理では,手順S51,S53と進んで手順S28に進む。これにより,ブームシリンダ目標速度Va(t)の変化率を制限する値が第1速度変化率I1から第2速度変化率I2に変更される。第2速度変化率I2は第1速度変化率I1よりも大きい値(時間当たりに,より大きな変化を許容する値)である。
 時刻t2でブームシリンダ目標速度Va(t)がオペレータ操作に基づく目標速度Vo(t)と一致し,半自動制御から手動制御に完全に切り替わる(図11の制御に移行する)。時刻t2以降はオペレータの操作入力通りに動作する手動制御となるため,ブームシリンダ目標Va(t)はオペレータ操作に基づく目標速度Vo(t)と一致する。
 ところで,上記の図15に示したオペレータ操作に基づく目標速度Vo(t)の時間変化は,設計データの範囲外に作業装置4が出た直後にオペレータが速やかにブーム上げ動作を停止したい等と考え,時刻t0からt1の間にブーム操作レバー44bを中立位置に戻した状況を想定している。
 本実施形態では,半自動制御から手動制御への切替が開始された時刻t0で操作されていたブーム操作レバー44bを中立位置に戻した時点(時刻t1)で,オペレータにブーム動作を積極的に停止したいという意思があるとみなして,速度遷移制御中に利用される速度制限値(第1速度変化率I1)がより大きい値(第2速度変化率I2)に変更されて速度制限が緩和される。その結果,第1速度変化率I1が継続して利用された場合に半自動制御が手動制御に完全に切り替わる時刻t3よりも早い時刻t2でブーム動作を停止できる。すなわちオペレータの意図するブーム動作の停止が完了するタイミングが早まるので,オペレータの操作と実際のブーム動作が乖離することによる違和感の発生を抑制できる。
 図16は半自動制御から手動制御に切り替わる際のブームシリンダ速度の変化の第2の例を示す図である。
 時刻t0では,半自動制御を手動制御に切り換える制御切替指示が車体コントローラ51内の状態遷移部51aから目標動作生成部51cに出力され,半自動制御から手動制御への切替が必要と判断される。時刻t0と1ステップ前の時刻におけるオペレータ操作に基づく目標速度Vo(t)はどちらもゼロで,どちらも操作レバー44bへの操作入力はゼロである。そのため,図14の操作判定処理では,手順S51,S52,S54と進んで手順S24に戻る。すなわち,ブームシリンダ目標速度Va(t)の変化率は予め定められた第1速度変化率I1に保持される。その後,時刻t1までは,時刻t0と同様にオペレータ操作に基づく目標速度Vo(t)がゼロに保持されるため,第1速度変化率I1でブームシリンダ速度を制限する処理が継続する。
 時刻t1では,オペレータ操作に基づく目標速度Vo(t)はゼロより小さくなり,操作レバー44bへの操作入力もゼロではなくなる。また,1ステップ前の時刻におけるオペレータ操作に基づく目標速度Vo(t)はゼロで,操作レバー44bへの操作入力もゼロである。そのため,図14の操作判定処理では,手順S51,S52と進んで手順S28に進む。これにより,ブームシリンダ目標速度Va(t)の変化率を制限する値が第1速度変化率I1から第2速度変化率I2に変更される。第2速度変化率I2は第1速度変化率I1よりも大きい値(時間当たりに,より大きな変化を許容する値)である。
 時刻t2でブームシリンダ目標速度Va(t)がオペレータ操作に基づく目標速度Vo(t)と一致し,半自動制御から手動制御に完全に切り替わる(図11の制御に移行する)。時刻t2以降はオペレータの操作入力通りに動作する手動制御となるため,ブームシリンダ目標Va(t)はオペレータ操作に基づく目標速度Vo(t)と一致する。
 ところで,上記の図16に示したオペレータ操作に基づく目標速度Vo(t)の時間変化は,作業装置4が直交姿勢に到達する前にバケット15またはバケット先端150が設計データの存在する範囲Rより外に出るなどの理由でオペレータはブーム下げ操作を入力せずに半自動制御で作業をしているが,設計データの範囲外に作業装置4が出た直後にオペレータはさらに掘削したいなどブーム15を下げたい要求がある状況を想定している。
 本実施形態では,半自動制御から手動制御への切替が開始された時刻t0で中立位置にあったブーム操作レバー44bに操作を入力した時点(時刻t1)で,オペレータにブーム13を積極的に操作したいという意思があるとみなして,速度遷移制御中に利用される速度制限値(第1速度変化率I1)がより大きい値(第2速度変化率I2)に変更されて速度制限が緩和される。その結果,第1速度変化率I1が継続して利用された場合に半自動制御が手動制御に完全に切り替わる時刻t3よりも早い時刻t2でブームの操作を開始できる。すなわちオペレータの意図するブーム操作の開始タイミングが早まるので,オペレータの操作と実際のブーム動作が乖離することによる違和感の発生を抑制できる。
 なお,上記の第2の実施形態の説明では,図15,図16を用いて,時刻t0で半自動制御から手動制御への制御の切り替えが開始され,ブームシリンダ18aの目標速度Va(t)がオペレータ操作に基づく目標速度Vo(t)に変化するまでの間に,ブーム操作レバー44bへの入力がブーム下げ方向への入力(図15,16における負の入力値)から中立位置(図15,16におけるゼロの入力値)に変化した場合と,ブーム操作レバー44bへの入力が中立位置(ゼロの入力値)からブーム下げ方向への入力(負の入力値)に変化した場合のいずれかの場合に,ブームシリンダ18aの目標速度Va(t)の時間変化率を第1変化率I1から第2変化率I2に変更することについて説明した。しかし,図13,図14のフローチャートの構成から明らかなように,時刻t0で半自動制御から手動制御への制御の切り替えが開始され,ブームシリンダ18aの目標速度Va(t)がオペレータ操作に基づく目標速度Vo(t)に変化するまでの間に,ブーム操作レバー44bへの入力がブーム上げ方向への入力(正の入力値)から中立位置(ゼロの入力値)に変化した場合と,ブーム操作レバー44bへの入力が中立位置(ゼロの入力値)からブーム上げ方向への入力(正の入力値)に変化した場合のいずれかの場合にも,ブームシリンダ18aの目標速度Va(t)の時間変化率を第1変化率I1から第2変化率I2に変更するように構成されていることは言うまでもない。
 <その他>
 上記では第1状態切替信号と第2状態切替信号が出力される場面を区別せずに説明したが、第1状態切替信号はオペレータの意思とは無関係に出力されるため、第1状態切替信号が出力された場面ではオペレータの意思とは無関係に半自動制御から手動制御への強制的な切替が行われることとなる。そのため、切替スイッチ56を使って自発的に第2状態切替信号を出力する場合に比して、作業装置4の操作中に制御の切替が行われやすいこと、そして、それ故に速度遷移制御中の速度制限にオペレータが違和感を持ち易いことが指摘できる。したがって、速度遷移制御中に操作装置44への入力を変化させることでオペレータ操作が作業装置4の動作に反映されるタイミングを早めることができるという上記の各実施形態の効果は、第1状態切替信号が出力された場面で顕著であると言うことができる。
 上記では半自動制御でブームシリンダ18aを制御する場合について説明したが,その他の油圧シリンダ(アームシリンダ18bやバケットシリンダ18c)を所定の条件で半自動制御した場合にも本発明は適用可能である。
 上記では,図10や図13の手順S26,S31において,速度遷移制御から手動制御(図11)に移行する条件を2つの速度Va(t),Vo(t)が一致することとしたが,両者の差の絶対値が所定の閾値以下となったときに図11の手動制御に移行するようにフローチャートを構成しても良い。
 上記では,半自動制御から手動制御に切り替わる際に速度遷移制御を実行したが,手動制御から半自動制御に切り替わる際にも同様に速度遷移制御を実行しても良い。
 上記では,ブームシリンダ18aの目標速度Va(t)の時間変化率を第1変化率I1から第2変化率I2に変更するトリガーとして機能する操作装置44への入力変化の具体例として,操作装置44への操作入力の変化率の絶対値が閾値I’0以上であること,操作装置44への操作入力が有りの状態から無しの状態(すなわち中立位置)に変化したこと,操作装置44への操作入力が無しの状態から有りの状態に変化したこと,の3つを挙げたが,これ以外の入力変化をトリガーにして変化率を変更しても良い。
 なお,本発明は,上記の実施の形態に限定されるものではなく,その要旨を逸脱しない範囲内の様々な変形例が含まれる。例えば,本発明は,上記の実施の形態で説明した全ての構成を備えるものに限定されず,その構成の一部を削除したものも含まれる。また,ある実施の形態に係る構成の一部を,他の実施の形態に係る構成に追加又は置換することが可能である。
 また,上記の各種コントローラ51,52,53に係る各構成や当該各構成の機能及び実行処理等は,それらの一部又は全部をハードウェア(例えば各機能を実行するロジックを集積回路で設計する等)で実現しても良い。また,上記のコントローラ51,52,53に係る構成は,演算処理装置(例えばCPU)によって読み出し・実行されることで当該コントローラ51,52,53の構成に係る各機能が実現されるプログラム(ソフトウェア)としてもよい。当該プログラムに係る情報は,例えば,半導体メモリ(フラッシュメモリ,SSD等),磁気記憶装置(ハードディスクドライブ等)及び記録媒体(磁気ディスク,光ディスク等)等に記憶することができる。
 また,上記の各実施の形態の説明では,制御線や情報線は,当該実施の形態の説明に必要であると解されるものを示したが,必ずしも製品に係る全ての制御線や情報線を示しているとは限らない。実際には殆ど全ての構成が相互に接続されていると考えて良い。
 1…油圧ショベル,2…GNSSアンテナ(位置センサ),3…IMU(姿勢センサ),4…作業装置(フロント作業装置),11…上部旋回体,12…下部走行体,13…ブーム,14…アーム,140…関節,15…バケット,150…バケット先端,16,17…バケットリンク,18…油圧シリンダ(アクチュエータ),19…旋回油圧モータ,41…エンジン,42,43…油圧ポンプ,44…操作レバー(操作装置),45…方向制御弁,46…遮断弁,47…制御弁,48…シャトル弁,47…制御弁,49…圧力センサ,51…車体コントローラ,51a…状態遷移部,51b…速度遷移部,51c…目標動作生成部,51d…アクチュエータ制御部,52…ガイダンスコントローラ,52a…作業装置位置姿勢演算部,52b…設計データ記憶部,52c…設計面演算部,52d…ガイダンス状態管理部,53…GNSSコントローラ,54…ガイダンスモニタ,55…スピーカ,60,61…設計面

Claims (8)

  1.  作業装置と,
     前記作業装置を駆動するアクチュエータと,
     前記アクチュエータを操作するための操作装置と,
     前記操作装置への入力に基づいて前記アクチュエータを制御する第1制御,及び,前記操作装置の操作中に所定の設計面と前記作業装置の距離に基づいて前記アクチュエータを制御する第2制御の2つの制御のいずれか一方によって前記アクチュエータを制御するコントローラとを備え,
     前記コントローラは,
      状態切替信号の入力に基づいて前記2つの制御が切り替えられ,前記アクチュエータの速度が前記2つの制御のうち切り替え前の制御が規定する速度から切り替え後の制御が規定する速度に変化するとき,そのときにおける前記アクチュエータの速度の時間変化率の制限値を第1変化率に設定し,
      前記状態切替信号の入力に基づいて前記2つの制御が切り替えられ,前記アクチュエータの速度が前記切り替え後の制御が規定する速度に変化するまでの間に,前記操作装置への入力が変化した場合,前記アクチュエータの速度の時間変化率を前記第1変化率から前記第1変化率より大きい第2変化率に変更することを特徴とする作業機械。
  2.  請求項1の作業機械において,
     前記コントローラは,前記状態切替信号の入力に基づいて前記2つの制御が切り替えられ,前記アクチュエータの速度が前記切り替え後の制御が規定する速度に変化するまでの間に,前記操作装置への入力の時間変化率が所定の閾値以上になった場合,前記アクチュエータの速度の時間変化率を前記第1変化率から前記第2変化率に変更することを特徴とする作業機械。
  3.  請求項1の作業機械において,
     前記操作装置への入力は,前記アクチュエータを一の方向に操作する場合の入力値である正の入力値,前記アクチュエータを他の方向に操作する場合の入力値である負の入力値,及び,前記一の方向及び前記他の方向のいずれにも前記アクチュエータを操作しない場合の入力値であるゼロの入力値からなり,
     前記コントローラは,前記状態切替信号の入力に基づいて前記2つの制御が切り替えられ,前記アクチュエータの速度が前記切り替え後の制御が規定する速度に変化するまでの間に,前記操作装置への入力が前記正の入力値及び前記負の入力値のいずれかから前記ゼロの入力値に変化した場合と,前記操作装置への入力が前記ゼロの入力値から前記正の入力値及び前記負の入力値のいずれかに変化した場合とのいずれかの場合,前記アクチュエータの速度の時間変化率を前記第1変化率から前記第2変化率に変更することを特徴とする作業機械。
  4.  請求項1の作業機械において,
     前記コントローラは,
      前記第2制御による前記アクチュエータの制御に必要なハードウェア及びソフトウェアに異常が発生したか否かを判定し,
      前記第2制御によって前記アクチュエータが制御されている間に前記異常が発生したと判定した場合,前記状態切替信号を出力することを特徴とする作業機械。
  5.  請求項4の作業機械において,
     前記コントローラは,
      前記設計面の存在する領域内に前記作業装置が存在するか否かを判定し,
      前記第2制御によって前記アクチュエータが制御されている間に前記設計面の存在する領域の外に前記作業装置が存在すると判定した場合,前記状態切替信号を出力することを特徴とする作業機械。
  6.  請求項4の作業機械において,
     前記コントローラは,
      前記作業装置の姿勢センサと前記作業機械の位置センサのいずれかに異常が発生したか否かを判定し,
      前記第2制御によって前記アクチュエータが制御されている間に前記姿勢センサと前記位置センサのいずれかに異常が発生したと判定した場合,前記状態切替信号を出力することを特徴とする作業機械。
  7.  請求項4の作業機械において,
     前記コントローラから出力される制御信号に基づいて,前記第2制御時に前記アクチュエータの方向制御弁に出力されるパイロット圧を生成する制御弁と,
     前記パイロット圧を検出する圧力センサとをさらに備え,
     前記コントローラは,
      前記制御信号の規定する圧力値と前記圧力センサで検出される圧力値を比較することで前記制御弁に異常が発生したか否かを判断し,
      前記第2制御によって前記アクチュエータが制御されている間に前記制御弁に異常が発生したと判定した場合,前記状態切替信号を出力することを特徴とする作業機械。
  8.  請求項2の作業機械において,
     前記所定の閾値は,前記第1変化率より大きい値であることを特徴とする作業機械。
PCT/JP2019/022947 2018-06-28 2019-06-10 作業機械 WO2020003994A1 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
US16/979,281 US11913198B2 (en) 2018-06-28 2019-06-10 Work machine
KR1020207023887A KR102443900B1 (ko) 2018-06-28 2019-06-10 작업 기계
CN201980014750.5A CN111771027B (zh) 2018-06-28 2019-06-10 作业机械
EP19826906.0A EP3816350B1 (en) 2018-06-28 2019-06-10 Work machine

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2018122946A JP6956688B2 (ja) 2018-06-28 2018-06-28 作業機械
JP2018-122946 2018-06-28

Publications (1)

Publication Number Publication Date
WO2020003994A1 true WO2020003994A1 (ja) 2020-01-02

Family

ID=68986409

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2019/022947 WO2020003994A1 (ja) 2018-06-28 2019-06-10 作業機械

Country Status (6)

Country Link
US (1) US11913198B2 (ja)
EP (1) EP3816350B1 (ja)
JP (1) JP6956688B2 (ja)
KR (1) KR102443900B1 (ja)
CN (1) CN111771027B (ja)
WO (1) WO2020003994A1 (ja)

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6956688B2 (ja) * 2018-06-28 2021-11-02 日立建機株式会社 作業機械
JP7046024B2 (ja) * 2019-02-26 2022-04-01 日立建機株式会社 作業機械
US11851844B2 (en) * 2020-01-21 2023-12-26 Caterpillar Inc. Implement travel prediction for a work machine
JP7433100B2 (ja) 2020-03-23 2024-02-19 住友重機械建機クレーン株式会社 作業機械の油圧駆動装置
KR102557030B1 (ko) 2020-08-25 2023-07-19 엘티소재주식회사 헤테로고리 화합물, 이를 포함하는 유기 발광 소자 및 유기 발광 소자의 유기물층용 조성물
EP4230805A1 (en) * 2020-10-19 2023-08-23 Hitachi Construction Machinery Co., Ltd. Work machine
US20230030029A1 (en) * 2021-08-02 2023-02-02 Deere & Company Ground engaging tool contact detection system and method
JP2024055024A (ja) * 2022-10-06 2024-04-18 日立建機株式会社 作業機械

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001254681A (ja) * 2000-03-13 2001-09-21 Kato Works Co Ltd 可変容量ポンプの入力トルク制御回路
JP2014502712A (ja) * 2010-12-30 2014-02-03 キャタピラー インコーポレイテッド レート制限機能を備える機械制御システムおよび方法
WO2016111384A1 (ja) 2016-02-29 2016-07-14 株式会社小松製作所 作業機械の制御装置、作業機械及び作業機械の制御方法

Family Cites Families (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20020104431A1 (en) * 1999-09-09 2002-08-08 Sohel Anwar Method and apparatus for controlling the actuation of a hydraulic cylinder
JP2005336731A (ja) * 2004-05-24 2005-12-08 Hitachi Constr Mach Co Ltd 作業機械
JP2012108608A (ja) * 2010-11-15 2012-06-07 Smc Corp アクチュエータ用駆動制御装置及びアクチュエータの駆動制御方法
KR101506411B1 (ko) * 2010-12-01 2015-03-26 미쓰비시덴키 가부시키가이샤 전기차의 제어장치
JP5512569B2 (ja) * 2011-02-23 2014-06-04 日立建機株式会社 建設機械制御システム
CN103874804B (zh) 2013-03-08 2015-11-25 株式会社小松制作所 推土机及推土铲控制方法
JP5391345B1 (ja) 2013-03-08 2014-01-15 株式会社小松製作所 ブルドーザ及びブレード制御方法
JP6053714B2 (ja) * 2014-03-31 2016-12-27 日立建機株式会社 油圧ショベル
JP6316776B2 (ja) * 2015-06-09 2018-04-25 日立建機株式会社 作業機械の油圧駆動システム
DE102016203398A1 (de) * 2016-03-02 2017-09-07 Bayerische Motoren Werke Aktiengesellschaft Vorrichtung zum Steuern der Längsführung eines zum zumindest teilautomatisierten Fahren ausgebildeten Fahrzeugs
JP6062115B1 (ja) * 2016-03-17 2017-01-18 株式会社小松製作所 作業車両の制御システム、制御方法、及び作業車両
CN105992850B (zh) * 2016-03-17 2019-05-03 株式会社小松制作所 作业车辆的控制系统、控制方法以及作业车辆
JP6666209B2 (ja) * 2016-07-06 2020-03-13 日立建機株式会社 作業機械
JP6770862B2 (ja) * 2016-09-23 2020-10-21 日立建機株式会社 建設機械の制御装置
US10358799B2 (en) * 2016-11-09 2019-07-23 Komatsu Ltd. Work vehicle and data calibration method
WO2018134994A1 (ja) * 2017-01-23 2018-07-26 本田技研工業株式会社 車両制御システム、車両制御方法、および車両制御プログラム
JP7158105B2 (ja) * 2017-06-15 2022-10-21 日立Astemo株式会社 走行制御装置
JP7036606B2 (ja) * 2018-01-31 2022-03-15 株式会社小松製作所 積込機械の制御装置および制御方法
JP6956688B2 (ja) * 2018-06-28 2021-11-02 日立建機株式会社 作業機械

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2001254681A (ja) * 2000-03-13 2001-09-21 Kato Works Co Ltd 可変容量ポンプの入力トルク制御回路
JP2014502712A (ja) * 2010-12-30 2014-02-03 キャタピラー インコーポレイテッド レート制限機能を備える機械制御システムおよび方法
WO2016111384A1 (ja) 2016-02-29 2016-07-14 株式会社小松製作所 作業機械の制御装置、作業機械及び作業機械の制御方法

Non-Patent Citations (1)

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

Also Published As

Publication number Publication date
US11913198B2 (en) 2024-02-27
EP3816350A1 (en) 2021-05-05
JP2020002625A (ja) 2020-01-09
CN111771027B (zh) 2022-07-26
KR102443900B1 (ko) 2022-09-16
US20210047808A1 (en) 2021-02-18
JP6956688B2 (ja) 2021-11-02
EP3816350B1 (en) 2023-06-21
KR20200106968A (ko) 2020-09-15
CN111771027A (zh) 2020-10-13
EP3816350A4 (en) 2022-04-06

Similar Documents

Publication Publication Date Title
WO2020003994A1 (ja) 作業機械
JP6526321B2 (ja) 作業機械
JP6633464B2 (ja) 作業機械
US20190249391A1 (en) Work machine
JP6957081B2 (ja) 作業機械
US20220403617A1 (en) Work machine control system, work machine, and work machine control method
WO2020049623A1 (ja) 作業機械
JP2021031904A (ja) ショベル
WO2020196116A1 (ja) 作業機械
JP2006214236A (ja) 建設機械の計測表示機構
WO2022201905A1 (ja) 作業機械
WO2020202393A1 (ja) 作業機械
US20240167250A1 (en) Work Machine
US20230033938A1 (en) Work machine control system, work machine, and method for controlling work machine
JP2020045714A (ja) 作業機械
JP7332835B2 (ja) 作業機械
US20220186458A1 (en) Work machine
JP2023138083A (ja) 作業機械
JP2022067548A (ja) 作業機械
JP2023151687A (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: 19826906

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 20207023887

Country of ref document: KR

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

WWE Wipo information: entry into national phase

Ref document number: 2019826906

Country of ref document: EP

ENP Entry into the national phase

Ref document number: 2019826906

Country of ref document: EP

Effective date: 20210128