WO2020054154A1 - 作業機械 - Google Patents

作業機械 Download PDF

Info

Publication number
WO2020054154A1
WO2020054154A1 PCT/JP2019/022688 JP2019022688W WO2020054154A1 WO 2020054154 A1 WO2020054154 A1 WO 2020054154A1 JP 2019022688 W JP2019022688 W JP 2019022688W WO 2020054154 A1 WO2020054154 A1 WO 2020054154A1
Authority
WO
WIPO (PCT)
Prior art keywords
proximity
threshold
control
intrusion
operator
Prior art date
Application number
PCT/JP2019/022688
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 EP19861087.5A priority Critical patent/EP3812514B1/en
Priority to US17/054,797 priority patent/US11879233B2/en
Priority to CN201980051191.5A priority patent/CN112513378B/zh
Priority to KR1020217000365A priority patent/KR102459283B1/ko
Publication of WO2020054154A1 publication Critical patent/WO2020054154A1/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/2025Particular purposes of control systems not otherwise provided for
    • E02F9/2033Limiting the movement of frames or implements, e.g. to avoid collision between implements and the cabin
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/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/2264Arrangements or adaptations of elements for hydraulic drives
    • E02F9/2271Actuators and supports therefor and protection therefor
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/24Safety devices, e.g. for preventing overload
    • 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
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/261Surveying the work-site to be treated
    • E02F9/262Surveying the work-site to be treated with follow-up actions to control the work tool, e.g. controller
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/264Sensors and their calibration for indicating the position of the work tool
    • E02F9/265Sensors and their calibration for indicating the position of the work tool with follow-up actions (e.g. control signals sent to actuate the work tool)
    • 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
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2278Hydraulic circuits
    • E02F9/2285Pilot-operated systems
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2278Hydraulic circuits
    • E02F9/2292Systems with two or more pumps
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/22Hydraulic or pneumatic drives
    • E02F9/2278Hydraulic circuits
    • E02F9/2296Systems with a variable displacement pump

Definitions

  • the present invention relates to a working machine.
  • a working machine for example, a hydraulic excavator
  • a working device for example, an articulated front working device driven by a hydraulic actuator
  • work space is outdoors, In some cases, there may be wires or the like, or there may be a ceiling when indoors. Work machine operators need to operate the work machine to avoid contact between these obstacles and the work machine.
  • Patent Document 1 discloses a detection result of an object detection device that detects an object in a monitoring area set around a work machine. And determining whether the object in the monitoring area is a warning restriction object based on the marker image in the image captured by the imaging device mounted on the work machine.
  • a surroundings monitoring device that prohibits the output of a warning when the object is an object and outputs a warning when a warning-restricted object enters a predetermined area closer to the work machine included in the monitoring area is disclosed.
  • a danger zone (hereinafter also referred to as an “intrusion prohibition area”) is provided in an operation range space of a work machine (front work apparatus), and the speed of the work machine is reduced just before the danger zone.
  • a work machine operation range limiting device for stopping a work machine immediately before a danger zone is disclosed.
  • a marker may be attached to a warning restricted object.
  • the object to which the marker is attached is configured to be warned when approaching the work machine more than the object to which the marker is not attached.
  • the work machine may approach the object with the marker too close.
  • Patent Document 2 as a method of decelerating a work machine when approaching a danger area (intrusion prohibited area), a work machine speed based on a deceleration pattern according to a distance between the work machine and the danger area, and a work machine by an operator
  • the work machine speed is compared with the work machine speed proportional to the lever operation amount, and the work machine is driven by the command value of the smaller work machine speed.
  • the implement speed based on the deceleration pattern is lower than the implement speed proportional to the amount of operation of the implement lever, the implement will always be in the deceleration pattern regardless of whether the operator has recognized the danger area. It operates at the working machine speed based on Therefore, when the area where the hydraulic shovel normally performs the operation and the danger area are close to each other, control intervention based on approaching the danger area frequently occurs, and the work efficiency may be reduced.
  • an object of the present invention is to provide a work machine capable of preventing frequent control intervention, suppressing a decrease in work efficiency, and reliably preventing entry into an intrusion prohibited area.
  • the present application includes a plurality of means for solving the above-mentioned problems.
  • a working device installed in a machine body, a plurality of actuators for driving the machine body and the working device, and a machine body
  • a posture detection device for detecting posture information of the working device
  • an approach value which is an index value indicating a proximity between the work device and the machine body, and a position information of the intrusion prohibited region.
  • a work machine comprising: a work device; and a control device that performs an operation range limiting control that decelerates at least one of the plurality of actuators so that intrusion of the machine body is prevented.
  • a storage device for storing the history information of the proximity calculated by the control device, wherein the control device changes the proximity threshold based on the history information of the proximity stored in the storage device. I decided to.
  • FIG. 3 is a detailed view of a control hydraulic unit.
  • FIG. 2 is a hardware configuration diagram of a control controller of the hydraulic shovel.
  • FIG. 3 is a functional block diagram of a control controller.
  • FIG. 3 is a detailed functional block diagram of a control controller.
  • FIG. 6 is a diagram illustrating a flowchart of changing a distance threshold according to the first embodiment.
  • FIG. 17 is a diagram illustrating a situation in which the upper swing body has swiveled by ⁇ sw from the situation in FIG.
  • a hydraulic shovel having a bucket is exemplified as a working machine (attachment) at the tip of a working device, but the present invention may be applied to a working machine having an attachment other than the bucket. Further, as long as it has an articulated working device constituted by connecting a plurality of link members (attachments, booms, arms, etc.), the present invention can be applied to working machines other than hydraulic excavators.
  • the upper case of the alphabet may be added to the end of the reference numeral.
  • the plurality of components are collectively described by omitting the upper case of the alphabet.
  • FIG. 1 is a configuration diagram of a hydraulic shovel according to a first embodiment of the present invention
  • FIG. 2 is a diagram illustrating a control controller of the hydraulic shovel according to the embodiment of the present invention together with a hydraulic drive device
  • FIG. FIG. 3 is a detailed view of a front control hydraulic unit 160 in FIG.
  • the hydraulic excavator 1 includes an articulated front working device 1A and a vehicle body (machine body) 1B.
  • the vehicle body (machine body) 1B includes a lower traveling body 11 that travels by left and right traveling hydraulic motors 3a and 3b, and an upper revolving body 12 that is mounted on the lower traveling body 11 and pivots by the pivoting hydraulic motor 4.
  • the front working device 1A is configured by connecting a plurality of front members (the boom 8, the arm 9, and the bucket 10) that rotate vertically.
  • the base end of the boom 8 is rotatably supported at the front of the upper swing body 12 via a boom pin.
  • An arm 9 is rotatably connected to an end of the boom 8 via an arm pin, and a bucket 10 is rotatably connected to the end of the arm 9 via a bucket pin.
  • the boom 8 is driven by a boom cylinder 5, the arm 9 is driven by an arm cylinder 6, and the bucket 10 is driven by a bucket cylinder 7.
  • the boom pin has a boom angle sensor 30, the arm pin has an arm angle sensor 31, and the bucket link 14 has a bucket angle sensor so that the rotation angles ⁇ , ⁇ , and ⁇ (see FIG. 5) of the boom 8, the arm 9, and the bucket 10 can be measured.
  • the upper revolving unit 12 is provided with a vehicle body inclination angle sensor 33 for detecting an inclination angle ⁇ (see FIG. 5) of the upper revolving unit 12 (vehicle body 1B) with respect to a reference plane (for example, a horizontal plane).
  • Each of the angle sensors 30, 31, and 32 can be replaced with an angle sensor (for example, an inertial measurement unit (IMU: Inertial Measurement Unit)) with respect to a reference plane (for example, a horizontal plane), or a cylinder that detects each cylinder stroke.
  • IMU Inertial Measurement Unit
  • a stroke sensor that converts an obtained cylinder stroke into an angle can be used instead.
  • a turning angle sensor 19 (not shown) is mounted near the center of rotation of the upper revolving unit 12 and the lower traveling unit 11 so that the relative angle between the upper revolving unit 12 and the lower traveling unit 11 can be detected.
  • An operating device 47a having a traveling right lever 23a (FIG. 1) for operating the traveling right hydraulic motor 3a (lower traveling body 11) is provided in a cab provided on the upper revolving unit 12.
  • the operating device 47b (FIG. 2) for operating the traveling left hydraulic motor 3b (lower traveling body 11) having the left lever 23b (FIG. 1) and the operating right lever 22a (FIG. 1) are shared and the boom cylinder 5 (
  • the operating devices 45a and 46a for operating the boom 8) and the bucket cylinder 7 (bucket 10), and the arm cylinder 6 (arm 9) and the swing hydraulic motor 4 sharing the operating left lever 22b (FIG. 1) Operation devices 45b and 46b (FIG.
  • operation levers 22 and 23 2 and 23.
  • the hydraulic pump 2 is a variable displacement pump whose displacement is controlled by a regulator 2a
  • the pilot pump 48 is a fixed displacement pump.
  • a shuttle block 162 is provided in the middle of the pilot lines 144, 145, 146, 147, 148, 149.
  • the hydraulic signals output from the operating devices 45, 46, 47 are also input to the regulator 2a via the shuttle block 162.
  • a detailed configuration of the shuttle block 162 is omitted, a hydraulic signal is input to the regulator 2a via the shuttle block 162, and the discharge flow rate of the hydraulic pump 2 is controlled according to the hydraulic signal.
  • the pump line 150 which is the discharge pipe of the pilot pump 48, passes through the lock valve 39, is branched into a plurality of parts, and is connected to each of the operating devices 45, 46, 47 and each valve in the front control hydraulic unit 160.
  • the lock valve 39 is an electromagnetic switching valve in this embodiment, and its electromagnetic drive unit is electrically connected to a position detector of a gate lock lever (not shown) arranged in the cab (FIG. 1). The position of the gate lock lever is detected by a position detector, and a signal corresponding to the position of the gate lock lever is input to the lock valve 39 from the position detector.
  • the lock valve 39 is closed and the pump line 150 is shut off, and if it is at the unlock position, the lock valve 39 is opened and the pump line 150 is opened. That is, when the pump line 150 is shut off, the operations by the operation devices 45, 46, and 47 are invalidated, and operations such as turning and excavation are prohibited.
  • the position detector of the gate lock lever outputs a signal indicating the position information (position) of the gate lock lever to the controller 40 (described later).
  • this signal indicates the unlock position, it indicates that the operator can operate the excavator 1 and that the operator is about to perform, for example, a digging operation, a traveling, and a turning operation by the working device 1A.
  • the lock position is indicated, the operation of the excavator 1 by the operator is impossible, and the operator does not perform any operation except the excavator 1 (for example, setting a target surface, checking the terrain, taking a break, etc.). Indicates what you are about to do.
  • the operating devices 45, 46, and 47 are of a hydraulic pilot type, and each of the operating amounts (for example, lever strokes) of the operating levers 22, 23, which are operated by an operator, based on pressure oil discharged from a pilot pump 48.
  • a pilot pressure (sometimes referred to as an operation pressure) corresponding to the operation direction is generated.
  • the pilot pressure generated in this way is supplied to the hydraulic drive units 150a to 155b of the corresponding flow control valves 15a to 15f (see FIG. 2) in the control valve unit 20 via the pilot lines 144a to 149b (see FIG. 2). These are used as control signals for driving these flow control valves 15a to 15f.
  • the hydraulic oil discharged from the hydraulic pump 2 travels through the flow control valves 15a, 15b, 15c, 15d, 15e, and 15f (see FIG. 2) to travel right hydraulic motor 3a, travel left hydraulic motor 3b, swing hydraulic motor 4, It is supplied to the boom cylinder 5, the arm cylinder 6, and the bucket cylinder 7.
  • the boom cylinder 5, the arm cylinder 6, and the bucket cylinder 7 expand and contract by the supplied pressure oil, the boom 8, the arm 9, and the bucket 10 rotate, respectively, and the position and the posture of the bucket 10 change.
  • the turning hydraulic motor 4 is rotated by the supplied pressure oil, so that the upper turning body 12 turns with respect to the lower traveling body 11.
  • the traveling right hydraulic motor 3a and the traveling left hydraulic motor 3b are rotated by the supplied pressure oil, so that the lower traveling body 11 travels.
  • the traveling hydraulic motor 3, the swing hydraulic motor 4, the boom cylinder 5, the arm cylinder 6, and the bucket cylinder 7 may be collectively referred to as a hydraulic actuator 3-7.
  • FIG. 4 is a configuration diagram of an operation range limiting system provided in the hydraulic shovel according to the present embodiment.
  • the operation range limiting control deceleration control
  • the operation range limiting system for decelerating or stopping the hydraulic actuator 3-7 is executed. The details of the control of the hydraulic actuator 3-7 by the operation range limiting system will be described.
  • the entry prohibition area 60 (see FIG. 5) and the nearest point of the excavator 1 to the entry prohibition area 60 (after the arm 9 in FIG. 5).
  • a control signal for restricting the operation of the hydraulic actuator 3-7 that approaches the intrusion prohibition region 60 is output to the corresponding flow control valves 15a to 15f.
  • the operating range limiting system prevents each part of the excavator from entering the intrusion prohibition area 60, so that the operator can concentrate on the original excavation work.
  • the intrusion prohibition area 60 is set above the hydraulic shovel, but the intrusion prohibition area 60 is not limited to this position. For example, it can be set below or on the side of the hydraulic excavator, and includes shapes other than straight lines such as a fan shape.
  • the system shown in FIG. 4 includes a work machine posture detection device 51, an intrusion prohibition region setting device 52, an operator operation detection device 53, a control selection device 54 for selecting valid / invalid operation range restriction control, and an intrusion prohibition region 60.
  • a display device (monitor) 55 capable of displaying the positional relationship between the hydraulic shovel and the hydraulic shovel, a main controller 57 of the hydraulic shovel, and a control controller 40 for controlling the operation range limitation.
  • the work machine posture detection device 51 is a sensor that detects posture information of the vehicle body 1B and the work device 1A, and includes a boom angle sensor 30, an arm angle sensor 31, a bucket angle sensor 32, a vehicle body inclination angle sensor 33, and a turning angle sensor 34. Be composed.
  • the intrusion prohibition area setting device 52 is an interface capable of inputting information on the intrusion prohibition area 60 (for example, position information on the boundary of the intrusion prohibition area 60).
  • the setting of the intrusion prohibition area 60 via the intrusion prohibition area setting device 52 may be manually performed by an operator.
  • the intrusion prohibition area setting device 52 may be connected to an external terminal, and the intrusion prohibition area 60 may be set from the external terminal.
  • the intrusion prohibition area 60 can be set to a desired coordinate system such as a local coordinate system set on the shovel (for example, the upper revolving superstructure 12), global coordinates (geographic coordinates), or site coordinates set on the site.
  • the operator operation detecting device 53 includes pressure sensors 70a to 75a for acquiring operation pressures generated in the pilot lines 144 to 149 by the operation of the operation levers 22 and 23 by the operator, and pressure sensors 70b to 75b. That is, the operation related to the hydraulic actuator 3-7 is detected.
  • the control selection device 54 is, for example, a switch provided at the upper end of the front surface of the joystick-shaped operation lever 22a, and is depressed by the thumb of the operator holding the operation lever 22a.
  • the control selection device 54 is a momentary switch, and switches between valid (ON) and invalid (OFF) of the operation range restriction control each time the switch is pressed.
  • the switching position (ON position / OFF position) of the control selection device 54 is input to the controller 40.
  • the installation location of the control selection device 54 is not limited to the operation lever 22a (22b), and may be provided at another location. For example, it may be provided in the display device 55. Further, the display device does not need to be configured with hardware.
  • the display device may be configured as a 55 touch panel and configured as a graphical user interface (GUI) displayed on the screen.
  • GUI graphical user interface
  • the main controller 57 of the hydraulic shovel includes information (ON / OFF information) indicating the ON / OFF state of the engine 18 as information (operation availability information) indicating whether or not the operator can operate the hydraulic shovel 1. , A gate lock lever position information (lock position / unlock position), and information on the open / closed state (open / close information) of the door of the cab on the upper revolving unit 12 from the respective sensors.
  • the main controller 57 outputs the obtained information (information as to whether or not the operator can operate the work machine) to the controller 40.
  • the ON / OFF state of the engine 18 may be determined from the key switch positions (OFF position, ON position, START position).
  • FIG. 2 shows details of the control hydraulic unit 160.
  • the description will be made using the boom cylinder 5 as an example.
  • Electromagnetic proportional valves 84a and 84b electrically connected to the controller 40 are provided for the pilot lines 144a and 144b.
  • the electromagnetic proportional valves 84a and 84b can reduce and output the pilot pressure in the pilot lines 144a and 144b based on a control signal from the controller 40.
  • the pilot pressures for the other hydraulic actuators 3, 4, 6, and 7 are also set so that the pilot pressure can be reduced by a command from the control controller 40.
  • Valves 84-89 are provided.
  • the electromagnetic proportional valves 84 to 89 have the maximum opening when not energized, and the opening decreases as the current, which is a control signal from the controller 40, increases. That is, the pilot pressure reduced by the pilot pressure generated by the operation of the operation levers 22 and 23 can be generated, and the operation speeds of all the hydraulic actuators are forced to the operation of the operator. Can be effectively reduced.
  • the controller 40 includes an input interface 91, a central processing unit (CPU) 92 as a processor, a read-only memory (ROM) 93 and a random access memory (RAM) 94 as storage devices, and an output interface 95.
  • the input interface 91 is provided with signals from the angle sensors 30, 31, 32, 34 and the inclination angle sensor 33 which are the work machine posture detecting devices 51 and the intrusion prohibition region setting device 52 which is a device for setting the intrusion prohibition region 60.
  • a signal from an operator operation detecting device 53 which is a pressure sensor (including pressure sensors 70 to 75) for detecting an operation amount from the operating devices 45 to 47, and a switching position (operation range) of the control selecting device 54.
  • the ROM 93 is a recording medium in which a control program for executing the operation range restriction control including a process related to a flowchart described later and various kinds of information necessary for executing the flowchart are stored.
  • the CPU 92 is stored in the ROM 93.
  • predetermined arithmetic processing is performed on signals input from the input interface 91 and the memories 93 and 94.
  • the output interface 95 drives and controls the hydraulic actuator 3-7 by generating an output signal according to the calculation result of the CPU 92 and outputting the signal to the electromagnetic proportional valves 84 to 89 or the display device 55.
  • an image of the front work device 1A, the vehicle body 1B, the bucket 10, the intrusion prohibited area 60, and the like is displayed on the screen of the display device 55.
  • the controller 40 shown in FIG. 4 includes semiconductor memories, such as a ROM 93 and a RAM 94, as storage devices.
  • semiconductor memories such as a ROM 93 and a RAM 94
  • any other storage device can be used.
  • a magnetic storage device such as a hard disk drive may be provided.
  • FIG. 6 is a functional block diagram of the controller 40.
  • the controller 40 includes an operation range restriction control unit 78, an electromagnetic proportional valve control unit 76, and a display control unit 77.
  • the display control unit 77 controls the display device (monitor) 55 based on the work machine posture and the position information of the intrusion prohibition area 60 output from the operation range restriction control unit 78.
  • the display control unit 77 includes a display ROM that stores a large number of display-related data including images and icons of the front work machine 1A and the vehicle body 1B. Based on this, a predetermined program is read, and display control on the display device 55 is performed.
  • FIG. 7 is a functional block diagram of the operation range restriction control unit 78 in FIG.
  • the operation range restriction control unit 78 includes an operator operation speed estimation unit 101, a posture calculation unit 102, an intrusion prohibition region calculation unit 103, an approach calculation unit 104, a history storage unit 106, a deceleration command calculation unit 105, The speed command selector 107 is provided. Among them, the deceleration command calculation unit 105, the history storage unit 106, and the speed command selection unit 107 may be collectively referred to as a control command unit 108.
  • the control command unit 108 performs an operation range restriction control (deceleration control) for decelerating at least one of the plurality of hydraulic actuators 3-7 so that the front working device 1A and the vehicle body 1B do not enter the intrusion prohibition area 60. Execute.
  • the operator operation speed estimating unit 101 is based on the pilot pressure input from the operator operation detection device 53 including the pressure sensors 71 to 75, and stores a correlation table between the pilot pressure and the actuator speed stored in the controller 40 in advance.
  • the speed of the hydraulic actuator 3-7 operated by the operator is estimated.
  • the calculation of the operation amount by the pressure sensors 70, 71, 72 is only an example, and for example, the operation of the operation lever is detected by a position sensor (for example, a rotary encoder) that detects the rotational displacement of the operation lever of each of the operation levers 22, 23.
  • the speed of the hydraulic actuator 3-7 may be estimated by detecting the amount and calculating the pilot pressure from the detected lever operation amount using a correlation table between the lever operation amount and the pilot pressure.
  • the amount of expansion and contraction of the hydraulic cylinders 5, 6, and 7 is calculated from the detection values of the angle sensors 30 to 32, and the operation speed is calculated based on the time change of the amount of expansion and contraction. May be calculated. Further, the time change of the turning angle may be calculated based on the time change of the turning angle sensor 34.
  • the posture calculation unit 102 calculates the posture and position of the excavator 1 in the local coordinate system based on information from the work machine posture detection device 51.
  • the posture of the excavator 1 can be defined on a shovel coordinate system (local coordinate system) in FIG.
  • the excavator coordinate system in FIG. 5 has the turning center axis as the origin.
  • the traveling direction when the lower traveling body 11 travels straight is parallel to the operating plane of the front working device 1A, and the extending direction of the front working device 1A and the operating direction when the lower traveling body 11 is advanced.
  • the X-axis is defined as the coincident direction
  • the Z-axis is defined as the center of rotation of the upper rotating body 12
  • the Y-axis is defined so as to form a right-handed coordinate system with the X-axis and the Z-axis.
  • the state where the front working device 1A was parallel to the X axis was set to 0 degree.
  • the rotation angle of the boom 8 with respect to the X axis is the boom angle ⁇
  • the rotation angle of the arm 9 with respect to the boom 8 is the arm angle ⁇
  • the rotation angle of the tip of the bucket 10 with respect to the arm 9 is the bucket angle ⁇
  • the swing angle of the upper swing body with respect to the lower swing body Is defined as the turning angle ⁇ .
  • the boom angle ⁇ is detected by the boom angle sensor 30, the arm angle ⁇ is detected by the arm angle sensor 31, the bucket angle ⁇ is detected by the bucket angle sensor 32, and the turning angle ⁇ is detected by the turning angle sensor 34.
  • the posture and position of each part of the hydraulic shovel in the shovel coordinate system can be calculated.
  • the inclination angle ⁇ of the vehicle body 1B with respect to a horizontal plane (reference plane) perpendicular to the direction of gravity can be detected by the vehicle body inclination angle sensor 33.
  • the intrusion prohibition area calculation unit 103 performs an operation for converting the position information of the intrusion prohibition area 60 into the shovel coordinate system shown in FIG. 5 based on the information from the intrusion prohibition area setting device 52.
  • the intrusion prohibition region 60 represented in the two-dimensional space is shown, but the intrusion prohibition region 60 represented in the three-dimensional space may be used. Further, a plurality of intrusion prohibition areas 60 may exist.
  • the approach calculating unit 104 calculates the degree of approach of the hydraulic excavator 1 to the target area of the operating range limiting control of the excavator 1 when the operator operates the operating levers 22 and 23.
  • the degree of approach is an index value indicating the proximity between the target area of the operation range restriction control on the front working device 1A and the vehicle body 1B and the preset entry prohibition area 60.
  • the degree of proximity for example, the distance between the target region of the operation range restriction control and the intrusion prohibition area 60 may be used, or the target region of the operation range restriction control, which is information in which the operation speed of the shovel is added to this distance.
  • the estimated contact time between the area and the intrusion prohibition area 60 may be used.
  • a point on the shovel that can enter the intrusion-inhibited area 60 can be set as a target area of the operation range restriction control on the front working device 1A and the vehicle body 1B.
  • the tip of the bucket 10 or the arm rear end 9b ( 15) can be set.
  • the degree of approach at a plurality of points on the front work apparatus 1A and the vehicle body 1B is calculated, and a point evaluated as being closest to the intrusion prohibition area 60 (for example, when a distance is selected as the degree of approach, the distance is calculated). Is the shortest point) can be selected as the target part of the operation range restriction control.
  • the position of the target part of the operation range restriction control (hereinafter also referred to as the control target part) is calculated as follows.
  • the calculation of the position and speed of the control target portion based on the turning center 120 of the upper turning body 12 will be described.
  • the X-axis length of the revolving center 120 of the upper revolving unit 12 and the boom pin 8a is Lsb
  • the length from the boom pin 8a to the arm pin 9a is Lbm
  • the length from the arpin 9a to the bucket pin 10a is Ls Lam
  • the length from the bucket pin 10a to the bucket tip 10b is Lbk
  • the rotation angles of the boom 8, the arm 9, and the bucket 10 are ⁇ , ⁇ , and ⁇ .
  • the position and speed of other parts of the excavator 1 such as the arm rear end 9b (see FIG. 15) other than the bucket tip.
  • the position Xamr, Zamr and the speed V Xamr , V Zamr of the arm rear end 9b can be calculated by the following equations.
  • Lbs is the distance from the arm pin 9a to the arm rear end 9b
  • is the geometric information shown in FIG. In this way, by using the geometric information of the hydraulic excavator 1a, it is possible to similarly calculate the position and the speed of other parts of the front working device 1A.
  • the distance between the intrusion prohibition area 60 and the control target part can be calculated.
  • the control target portion is the bucket tip 10b
  • the distance Dzbk of the bucket tip 10b to the intrusion prohibition area 60 is expressed by the following equation. expressed.
  • the predicted contact time Tzbk between the intrusion prohibition area 60 and the bucket tip 10b can be calculated as follows.
  • the distance Dzamr and the predicted contact time Tzamr in the case of the arm rear end 9b can be calculated as follows.
  • the proximity calculation unit 140 calculates a plurality of distances (degrees of proximity) Tzbk and Tzamr as described above, a part having the minimum distance among them can be selected as a control target part. However, if the part does not operate based on the operator operation even if the distance is the minimum, the part related to the distance may be excluded from the control target part.
  • the deceleration command calculation unit 105 calculates a deceleration command according to the proximity based on the proximity calculated by the proximity calculation unit 104 and the history information of the proximity stored in the history storage unit 106 described later. More specifically, the deceleration command calculation unit 105 specifies the proximity of the control target portion calculated by the proximity calculation unit 104, rather than the proximity specified by the proximity threshold set as the threshold of the proximity. When the proximity is closer, a deceleration command for decelerating at least one of the hydraulic actuators driving the control target portion is calculated so that the control target portion does not enter the intrusion prohibition region 60.
  • the distance is set to the proximity threshold (proximity threshold).
  • the deceleration command is calculated when the degree is smaller than a “distance threshold”.
  • the deceleration command calculation unit 105 determines the relationship between the distance and the deceleration rate in advance based on a table (see FIGS. 11 and 12 described later) and the distance.
  • the deceleration rate of the hydraulic actuator for example, the boom cylinder 5 that operates the control target part is calculated.
  • the deceleration command calculation unit 105 prevents the intrusion into the intrusion prohibition area 60 by using the speed of the hydraulic actuator that operates the control target part calculated by the operator operation speed estimation unit 101 and the calculated deceleration rate. Calculate the hydraulic actuator speed required for this.
  • the threshold value changing unit 109 in the deceleration command calculation unit 105 changes the proximity threshold value using the history information of the proximity input from the history storage unit 106.
  • the proximity threshold is also used when calculating the deceleration rate of the hydraulic actuator that operates the control target portion, and is the proximity at which deceleration of the hydraulic actuator by the operation range restriction control is started. That is, the approach at which the deceleration of the actuator is started changes in accordance with the history information of the approach.
  • the speed command selecting unit 107 calculates the speed (operator operation speed) of the hydraulic actuator by the operator operation estimated by the operator operation speed estimating unit 101 and the hydraulic actuator calculated by the deceleration command calculating unit 105 for the same hydraulic actuator 3-7. The speed is compared with the speed, and the smaller absolute value is selected as the target speed of the hydraulic actuator. For example, when the hydraulic actuator speed calculated by the deceleration command calculation unit 105 is selected, the selected actuator speed is output to the electromagnetic proportional valve control unit 76 so as to reduce the speed of the target actuator.
  • the history storage unit 106 stores the proximity calculated by the proximity calculation unit 104 in time series, and stores the history as the history information of the proximity.
  • the history storage unit 106 is a storage area provided in a storage device (ROM 93, RAM 94) in the controller 40, and stores various information including history information of the degree of proximity. This storage area may be provided in another storage device located outside the controller 40 and mounted on the work machine.
  • the history information held in the history storage unit 106 is output to the deceleration command calculation unit 105.
  • the actuator speed calculated by the deceleration command calculation unit 105, the operator operation speed calculated by the operator operation speed estimation unit 101, and the ON / OFF state of the engine 18 from the main controller 57 (operator Key switch position status by operation (OFF position, ON position, START position), gate lock lever position information (lock position / unlock position), and information on the open / closed state (open / closed) of the cab door May be stored together with the acquisition time of each piece of information.
  • the electromagnetic proportional valve controller 76 calculates and outputs a command to each of the electromagnetic proportional valves 84 to 89 based on the target speed of each actuator 3-7 output from the speed command selector 107. As a result, the pilot pressure in the pilot lines 144-149 is appropriately adjusted according to the target speed, so that each actuator 3-7 operates at the speed selected by the speed command selecting unit 107.
  • FIG. 8 shows an example of restricting the operation of the actuator by the operation range restriction control.
  • FIG. 8 shows a state S1 in which the excavation work is completed and the front working device 1A is involved, and a state S2 in which a reaching work for the next excavation work is performed in one cycle of the excavation work repeatedly performed. ing.
  • the operator performs the raising operation of the boom 8 in order to prevent the bucket 10 from contacting the excavation surface 36.
  • the rear end 37 May enter the intrusion prohibition area 60.
  • the deceleration command calculation unit 105 prevents the rear end 37 of the arm 9 from entering the intrusion-inhibited area 60 when the operation of raising the boom 8 is excessive in the state of transition from the state S1 to S2 as shown in FIG.
  • a command to decelerate the boom raising operation (that is, the boom cylinder extension operation) is calculated.
  • an intervention operation operation range restriction control
  • no intervention operation is performed, and the shovel operates according to the operation of the operator.
  • the history storage unit 106 stores the proximity (for example, distance) calculated by the proximity calculation unit 104 and the actuator speed (deceleration command) calculated by the deceleration command calculation unit 105 regardless of whether or not the operation range limit control is executed. ), The actuator speed (operator operation speed) calculated by the operator operation speed estimation unit 101 is stored.
  • the deceleration command calculation unit 105 (control command unit 108) operates when the distance is smaller than the proximity threshold. Execute limit control.
  • the threshold value changing unit 109 calculates a distance variation (for example, variance or standard deviation) based on the distance history information, and sets the approach threshold at which the deceleration command calculation unit 105 starts calculating the deceleration command to the variation. Change according to the value of. For example, when the variation in distance is equal to or greater than a predetermined threshold (variation threshold), the approach threshold for the distance at which the deceleration command is calculated is kept at the initial value (dth1).
  • the value is changed to a value (dth2) smaller than the initial value. Thereby, it is possible to make it difficult for control intervention to occur.
  • the case where the proximity threshold is changed between two values depending on whether or not the variation in the distance is equal to or greater than the variation threshold has been described. However, it is necessary to set the proximity threshold so that the smaller the variation in the distance is, the smaller the value becomes. Is also possible.
  • the speed command selection unit 107 is provided when the operation range limiting control is set to valid (ON) by the control selection device 54 and when the deceleration command calculation unit 105 outputs a speed obtained by reducing the operator operation speed. A command is issued to the electromagnetic proportional valve control unit 76 so that the hydraulic actuator 3-7 is driven at that speed. On the other hand, when the deceleration command calculation unit 105 does not output the actuator speed, or when the operation range limiting control is set to invalid (OFF) by the control selection device 54, no signal is sent to the electromagnetic proportional valve control unit 76. , The hydraulic actuator 3-7 is driven as operated by the operator.
  • a control flow of the operation range restriction control unit 78 will be described with reference to FIGS.
  • the target of the operation range restriction control is the front working device 1A.
  • step S100 of FIG. 9 the proximity calculating unit 104 inputs the position information of the intrusion prohibition area 60 from the intrusion prohibition area calculation unit 103, and determines whether the intrusion prohibition area 60 is set. If the intrusion prohibition area 60 has been set, the process proceeds to step S101. On the other hand, if the intrusion prohibition area 60 has not been set, the process proceeds to step S107.
  • step S101 the degree-of-approach calculation unit 104 determines whether or not the operation range restriction control is set to valid (ON) by the control selection device 54. If the operation range restriction control is valid (ON), the process proceeds to step S102. Otherwise (ie, invalid (OFF)), the process proceeds to step S107.
  • step S102 the proximity calculating unit 104 compares the position of each part of the front work apparatus 1A with the position of the intrusion prohibition area 60 based on the information of the attitude calculation unit 102 and the intrusion prohibition area calculation unit 103, and prohibits intrusion.
  • the shortest distance from the boundary of the area 60 to the front work apparatus 1A is calculated, and this is defined as the degree of proximity.
  • a plurality of locations where the distance to the boundary of the intrusion prohibition area 60 is calculated in the front work apparatus 1A may be determined in advance, and the shortest one among them may be calculated as the proximity.
  • step S103 the deceleration command calculation unit 105 determines whether the distance (approach) calculated in step S102 is smaller than a first threshold (dth1 or dth2 described later). If the distance calculated in step S102 is smaller than the proximity threshold (dth1 or dth2), the process proceeds to step S104. If the distance calculated in step S102 is equal to or greater than the approach threshold, the process proceeds to step S107.
  • a first threshold dth1 or dth2 described later.
  • step S104 the deceleration command calculation unit 105 calculates the deceleration rate r of the actuator 5-7 based on the distance calculated in step S102.
  • the deceleration rate r according to the present embodiment is a value equal to or more than zero and equal to or less than one.
  • the relationship between the distance and the deceleration rate can be defined by, for example, a relationship as shown in FIG. After calculating the deceleration rate, the process proceeds to step S105.
  • step S105 the deceleration command calculation unit 105 first determines a hydraulic cylinder to be decelerated among the three actuators 5-7 that operate the front working device 1A.
  • (1) the distance (approach) calculated in step S102 is smaller than the proximity threshold, and (2) the velocity vector of the point where the distance (approach) is calculated in step S102 is the intrusion inhibition area 60.
  • the arm cylinder 6 moves the arm rear end 9b away from the intrusion prohibition area 60.
  • the boom cylinder 5 is operated in a direction in which the rear end 9b of the arm approaches the intrusion-inhibited area 60
  • the boom cylinder 5 in which the rear end 9b of the arm is in proximity to the intrusion-inhibited area 60 is decelerated.
  • Select as actuator. A plurality of actuators to be decelerated may be selected as long as the conditions (1) to (3) are satisfied. Alternatively, the condition (3) may be omitted, and all of the actuators operated by the operator when the conditions (1) and (2) are satisfied may be decelerated.
  • the deceleration command calculation unit 105 performs deceleration based on the operator operation speed Vope calculated by the operator operation speed estimation unit 101 for the actuator to be decelerated and the deceleration rate r calculated in step S104. , And outputs the calculated speed Vctrl to the speed command selection unit 107 and the history storage unit 106.
  • the actuator speed Vctrl after deceleration can be calculated by the following equation, for example.
  • the speed command selection unit 107 compares the operator operation speed Vope with the actuator speed Vctrl after deceleration, selects the one with the smaller absolute value, and outputs it to the electromagnetic proportional valve control unit 76.
  • the actuator 5-7 is automatically controlled so as to have an actuator speed corresponding to the deceleration rate r.
  • Vctrl equation when the deceleration rate r is larger than zero, Vctrl is always selected by the speed command selection unit 107.
  • step S107 If NO is determined in any of steps S100, S101, and S103, the process proceeds to step S107, and the actuator is driven as operated by the operator.
  • a flow of changing the threshold value (approach threshold value) of the distance from the intrusion prohibition area 60 in step S103 in FIG. 9 based on the history information stored in the history storage unit 106 will be described with reference to FIG.
  • step S201 the threshold value changing unit 109 (the deceleration command calculating unit 105) determines whether or not the operation range limiting control has been performed. If the operation range restriction control has not been executed, the process proceeds to step S202, and if it has been executed, the process proceeds to step S209.
  • step S202 the threshold value changing unit 109 calculates the distance (approach) in step S102 in FIG. 9 (the point of the front work apparatus 1A which is the shortest distance from the intrusion prohibition area 60; Position data). For example, in the situation shown in FIG. 8, this point corresponds to the arm rear end 9b.
  • the process proceeds to step S203.
  • step S203 the threshold changing unit 109 determines whether a predetermined time tj has elapsed. If the predetermined time tj has not elapsed, steps S201 to S203 are repeated until the predetermined time tj has elapsed. When the predetermined time tj has elapsed, the process proceeds to step S204.
  • the predetermined time tj can be set to an arbitrary time (for example, several minutes).
  • the front working device 1A performs a predetermined operation (excavation operation, earth discharging operation, reaching operation) for a predetermined number of cycles (for example, 10 minutes). Cycle)
  • the time required for repetition may be set.
  • step S204 the threshold value changing unit 109 calculates a variation in the position data based on the position data of the nearest position of the front work machine 1A acquired in step S202 during the predetermined time tj, and the variation is determined by a predetermined threshold value ( (Variation threshold) is determined. If the variation is smaller than the variation threshold, the process proceeds to step S205. On the other hand, if the variation is equal to or greater than the variation threshold, the process proceeds to step S209.
  • a predetermined threshold value (Variation threshold) is determined. If the variation is smaller than the variation threshold, the process proceeds to step S205. On the other hand, if the variation is equal to or greater than the variation threshold, the process proceeds to step S209.
  • step S205 the threshold value changing unit 109 determines that there is no lever operation related to traveling (that is, the operation of the operation lever 23) during the predetermined time tj. If there is no lever operation related to traveling, the process proceeds to step S206. On the other hand, if there is a lever operation related to traveling, the process proceeds to step S209.
  • step S206 the threshold changing unit 109 determines whether or not the approach threshold at that time (when executing step S206) is dth1 (initial value). If it is determined that the proximity threshold is dth1, the process proceeds to step S207, and the proximity threshold is changed from dth1 to dth2 (where dth1> dth2). On the other hand, if it is determined that the proximity threshold is not dth1, that is, if it is dth2, the process proceeds to step S208, and dth2 is maintained as the proximity threshold (the proximity threshold is not changed).
  • step S209 the threshold value changing unit 109 determines whether or not the approach threshold value at that time (during execution of step S209) is dth1. If it is determined that the proximity threshold is dth1, the process proceeds to step S210, and the proximity threshold is maintained at dth1. On the other hand, if it is determined that the proximity threshold is not dth1, the process proceeds to step S211 and the proximity threshold is changed from dth2 to dth1.
  • Dth1 and dth2 of the proximity threshold are smaller values for dth2 as shown in FIG. Therefore, when the operation range restriction control is executed based on dth2, the range in which the hydraulic actuator 5-7 operates according to the operator's operation is expanded as compared with the case where the operation range restriction control is executed based on dth1.
  • the relationship between the distance and the deceleration rate r does not need to be limited to, for example, a straight line as shown in FIG. 11, but may be a curve represented by a polynomial as shown in FIG.
  • step S201 is started at the timing when the next control cycle starts, and the above processing is repeated thereafter.
  • the proximity threshold which is the threshold of the proximity at which the operation range restriction control is started, is changed or maintained to a value (dth2) close to the intrusion prohibition area 60 (steps S207 and S208). This prevents frequent intervention of the operation range restriction control on the operator's operation as compared with the case where the approach threshold value is fixed to dth1. Intrusion can be prevented.
  • step S201 in FIG. 10 the presence or absence of execution of the operation range restriction control is checked with respect to the onboard operator, and if the operation range restriction control is executed during the current riding, the approach threshold is set. It is to be maintained / changed to the initial value (dth1) (steps S210, 211), and only when the operator who has not performed the operation range restriction control during the current boarding satisfies other conditions (steps S204, 205). The threshold of the degree of proximity was changed to dth2. Thus, it is possible to reliably prevent the intrusion into the intrusion prohibition area 60. Step S201 in FIG. 10 can be omitted.
  • the necessity of changing the proximity threshold is evaluated based on the position data of the nearest position to the intrusion prohibition area 60 obtained at the predetermined time tj.
  • the threshold is not changed. This can prevent the approach threshold from being changed frequently.
  • the position of the nearest position with respect to the intrusion prohibition area 60 and the contents of the work performed by the excavator are likely to be different from those before the movement, and the operator has the same feeling as before the movement.
  • the presence / absence of the operation of the traveling operation lever 23 is determined in step S205 in FIG. 10, and the proximity threshold is maintained / changed to the initial value (dth1) when the traveling operation lever 23 is operated. It was decided to.
  • Step S205 in FIG. 10 can be omitted.
  • the proximity threshold is switched depending on whether the variation is larger or smaller than the variation threshold, but the proximity threshold may be changed according to the magnitude of the variation. That is, when the proximity is a distance, the smaller the variation, the smaller the proximity threshold (distance threshold) may be set.
  • ⁇ Second embodiment> a description will be given of the content of the condition in which the threshold changing unit 109 resets the distance threshold (approach threshold) to the initial value (dth1) based on the data in the history storage unit 106.
  • the threshold changing unit 109 executes the processing of FIG. 13 described in the present embodiment in addition to the processing of FIG. 10 described in the first embodiment.
  • the history storage unit 106 acquires, from the main controller 57, history information of an operator operation on an operating device other than the operation levers 22 and 23 as information on whether the operator can operate the excavator 1.
  • the acquired operator operation history information includes key switch position information (ON position / OFF position / START position) and gate lock lever position information (lock position / unlock position). ) And the open / closed state (open state / closed state) of the door of the driver's cab on the upper swing body 12.
  • the threshold changing unit 109 resets the proximity threshold to an initial value based on the history information of the operator operation acquired by the history storage unit 106. When the proximity threshold is set to dth2, this reset changes the proximity threshold to a value (dth1) that specifies that the proximity threshold is closer to the intrusion prohibited area.
  • step S300 the threshold value changing unit 109 performs a key switch position switching operation (for example, switching from an OFF position to an ON position) by an operator based on the information stored in the history storage unit 106, and gate lock. It is determined whether one of a lever position switching operation (switching from a locked position to an unlocked position) and a door opening / closing operation (operation from a closed state of a door to an open state) has been performed. If it is determined that the execution has been performed, the process proceeds to step S301.
  • a key switch position switching operation for example, switching from an OFF position to an ON position
  • a door opening / closing operation operation from a closed state of a door to an open state
  • step S301 it is determined whether the distance threshold at this time is dth1. If the threshold is dth1, the process proceeds to step S302, and the distance threshold is maintained at dth1. If it is not dth1, the process proceeds to step S303, and the distance threshold is changed to dth1. If it is determined in step S300 that there is no operation, the process proceeds to step S304, and the distance threshold at this point is maintained.
  • the operation of the hydraulic shovel by the operator is temporarily disabled, so that the operator can interrupt the operation of the hydraulic actuator or perform an operation other than the operation of the hydraulic actuator. It is considered that the user concentrates on the operation and becomes conscious of something other than the excavation work (for example, setting a target surface, checking the terrain, taking a break, etc.). It is considered that there is a possibility that the operator's consciousness of the intrusion prohibition area 60 may be reduced in the operation of the excavator after such a situation has occurred.
  • the distance threshold value is reset to the initial value dth1 when it is determined that the operator can operate the hydraulic shovel again based on the information stored in the history storage unit 106.
  • step S300 at least one of a state in which the operation of the hydraulic shovel by the operator is enabled and a state in which the operation of the hydraulic shovel is disabled by the operator may be determined based on the information on the operation availability of the operator. For example, whether at least one of a switching operation of the key switch from the ON position to the OFF position, a switching operation of the gate lock lever from the unlocked position to the locked position, and a door operation from the open state to the closed state has been performed. It may be determined whether or not the operation of the hydraulic excavator by the operator has become impossible. Further, in the above description, when it is determined that the operation of the hydraulic excavator by the operator is once impossible, the proximity threshold is reset to the initial value (dth1). May be changed to a value other than the initial value.
  • ⁇ Third embodiment> a method of changing the distance threshold by the threshold changing unit 109, which is different from the flow illustrated in FIG. 10, will be described with reference to FIG.
  • the flow shown in FIG. 14 can be executed in the same cycle as the flow in FIG. 9 or at an interval of a predetermined time tj in FIG.
  • step S400 the threshold value changing unit 109 determines whether the distance between the nearest position of the front work device 1A and the intrusion prohibition area 60 is smaller than dth1. If the distance is smaller than dth1, the process proceeds to step S401. If the distance is equal to or larger than dth1, the process proceeds to step S406.
  • step S401 the threshold changing unit 109 determines that the approach of the front work apparatus 1A to the intrusion prohibition area 60 (that is, the distance between the nearest position and the intrusion prohibition area 60 is smaller than dth1) is performed after the key switch is turned on (that is, the key is turned on). It is determined whether it is the first time (after ON). If the access to the intrusion prohibition area 60 is the first time, the process proceeds to step S402, and if it is the second or subsequent time, the process proceeds to step S403.
  • step S402 the threshold value changing unit 109 maintains the distance threshold value at dth1.
  • step S403 the threshold value changing unit 109 determines whether the distance threshold value at this time is dth2. If the threshold is dth2, the process proceeds to step S404, and the distance threshold is maintained at dth2. If it is not dth2, the process proceeds to step S405, and the distance threshold is changed to dth2.
  • step S406 the threshold value changing unit 109 maintains the current distance threshold value.
  • the distance threshold is changed to a closer value (dth2) when approaching the intrusion prohibition area 60 for the second time, but the distance threshold is changed when the approach to the intrusion prohibition area 60 is any number of times after the second time.
  • the threshold may be changed to dth2.
  • the number of times of approach to the intrusion prohibition area 60 is reset to zero when the key switch is switched from the OFF position to the ON position.
  • the zero reset may be performed at any other timing.
  • the timing of resetting the number of times to zero may be determined by the controller 40 or may be determined by the operator.
  • step S205 in FIG. 10 is added, and when the traveling lever 23 is operated during the predetermined time tj, the number of times the front working device 1A approaches the intrusion prohibition area 60 is reset to zero, and the distance is reset. A process of resetting the threshold value to the initial value dth1 may be executed.
  • the information when the distance threshold value is changed, the information may be output to the display control unit 77 to notify the operator via the display device 55. Further, not only the display but also the notification by voice may be performed.
  • the operation range restriction control may be executed using the predicted contact time instead of the distance of the front work apparatus 1A to the intrusion prohibition area 60 as the degree of approach.
  • FIG. 16 shows a situation in which the upper swing body 12 has not swung with respect to the intrusion prohibition area 60 (reference situation)
  • FIG. 17 shows a situation in which the upper swing body 12 has swiveled by ⁇ sw from the reference situation in FIG.
  • the width dimension of the bucket 10 is W bk
  • the position Y bk and the speed V Ybk of the left end 10L of the bucket 10 with respect to the turning center 120 are represented by the following equations.
  • those marked with dots on the theta sw formula below denote the theta sw angular velocity (time differential value).
  • the position Y bk and the speed V Ybk can be calculated also in the lateral direction of the shovel. Further, the distance to the intrusion prohibition area 60 in the lateral direction and the predicted contact time can be calculated in the same manner as in the case of the above-described upward direction (see FIGS. 5 and 8).
  • the calculation of the position and speed of the bucket tip 10b and the arm rear end 9b is merely an example, and the portion of the hydraulic excavator 1 to be controlled is not limited to the bucket tip 10b and the arm rear end 9b. Absent.
  • a configuration may be adopted in which the rear end (that is, the work machine body) of the upper revolving unit 12 is prevented from entering the intrusion prohibition region 60 set in the lateral direction of the excavator 1 by turning.
  • the operation range limiting control may be executed using the estimated contact time instead of the distance of the upper revolving unit with respect to the intrusion prohibition area 60 as the degree of approach.
  • the distance to the intrusion prohibition area 60 in the horizontal direction and the predicted contact time can be calculated in the same manner as in the case of the above-described upward direction (see FIGS. 5 and 8).
  • the present invention is not limited to the above embodiments, and includes various modifications without departing from the gist of the present invention.
  • the present invention is not limited to one having all the configurations described in the above 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.
  • control controller 40 controls the components related to the control device (control controller 40) and the functions and execution processes of the components are partially or wholly designed by hardware (for example, a logic that executes the respective functions is designed by an integrated circuit). Etc.).
  • configuration according to the control device described above may be a program (software) that is read and executed by an arithmetic processing device (for example, a CPU) to realize each function according to the configuration of the control device.
  • Information related to the program can be stored in, for example, a semiconductor memory (flash memory, SSD, etc.), a magnetic storage device (hard disk drive, etc.), a recording medium (magnetic disk, optical disk, etc.), and the like.
  • control lines and the information lines are understood to be necessary for the description of the embodiment, but all the control lines and the information lines related to the product are not necessarily required. Does not necessarily mean that In fact, it can be considered that almost all components are interconnected.

Landscapes

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

Abstract

作業装置を駆動する複数のアクチュエータと,作業装置の姿勢情報を検出する姿勢検出装置と,侵入禁止領域と作業装置との近さを示す指標値である接近度を侵入禁止領域の位置情報と姿勢情報に基づいて算出する接近度演算部,及び,接近度閾値が規定する近さよりも接近度が規定する近さの方が近いとき,侵入禁止領域への作業装置の侵入が防止されるように複数のアクチュエータの少なくとも1つを減速する動作範囲制限制御を実行する制御指令部を有する制御コントローラとを作業機械に備える。制御コントローラは,接近度演算部で演算された接近度の履歴情報を記憶し,その接近度の履歴情報に基づいて接近度閾値を変更する。

Description

作業機械
 本発明は,作業機械に関する。
 油圧アクチュエータで駆動される作業装置(例えば多関節型のフロント作業装置)を備える作業機械(例えば油圧ショベル)を用いて掘削や積み込み等の作業を行う場合,作業を行う空間が屋外であれば上方に電線等が存在していたり,屋内であれば天井が存在していたりする場合がある。作業機械のオペレータは,これらの障害物と作業機械の接触を避けるよう,作業機械を操作する必要がある。
 このように周囲に障害物が存在する環境下におけるオペレータの操作を支援する技術として,特許文献1には,作業機械の周囲に設定される監視領域内の物体を検知する物体検知装置の検知結果と,作業機械に搭載される撮像装置が撮像した画像内のマーカー画像とに基づいて,監視領域内の物体が警告制限対象物であるか否かを判定し,監視領域内の物体が警告制限対象物である場合に警告の出力を禁止し,監視領域に含まれる作業機械により近い所定の領域内に警告制限対象物が入った場合に警告を出力する周囲監視装置が開示されている。
 また,特許文献2には,作業機(フロント作業装置)の動作範囲空間に危険域(以下では,「侵入禁止領域」とも称する)を設け,その危険域の手前で作業機の速度を減速させ,危険域の直前で作業機を停止させる作業機動作範囲制限装置が開示されている。
特開2013-159930号公報 特開平05-321290号公報
 特許文献1ではマーカーが警告制限対象物に貼付されることがある。そして,マーカーが貼付された物体は,マーカーが貼付されていない物体と比較して,より作業機械に接近した場合に警告されるよう構成されている。しかし,マーカーが貼付された物体を必ずオペレータが認識しているとは限らないため,マーカーが貼付された物体に作業機械が近づきすぎる可能性がある。
 一方,特許文献2では,危険域(侵入禁止領域)に接近した場合の作業機の減速方法として,作業機と危険域との距離に応じた減速パターンに基づく作業機速度と,オペレータによる作業機レバーの操作量に比例する作業機速度とを比較し,いずれか小さい方の作業機速度の指令値で作業機を駆動することを採用している。つまり,減速パターンに基づく作業機速度が作業機レバーの操作量に比例する作業機速度よりも小さい場合には,オペレータが危険域を認識しているか否かにかかわらず,作業機は常に減速パターンに基づく作業機速度で動作する。そのため,油圧ショベルが通常作業を行う領域と危険域が近接している場合,危険域への接近に基づく制御介入が頻繁に生じて作業効率が低下する虞がある。
 そこで本発明の目的は,頻繁な制御介入を防いで作業効率の低下を抑制しつつ,かつ確実に侵入禁止領域への侵入を防ぐことのできる作業機械を提供することにある。
 本願は上記課題を解決する手段を複数含んでいるが,その一例を挙げるならば,機械本体に設置された作業装置と,前記機械本体及び前記作業装置を駆動する複数のアクチュエータと,前記機械本体と前記作業装置の姿勢情報を検出する姿勢検出装置と,予め設定された侵入禁止領域と前記作業装置及び前記機械本体との近さを示す指標値である接近度を前記侵入禁止領域の位置情報と前記姿勢情報とに基づいて算出し,前記接近度の閾値として設定された接近度閾値が規定する近さよりも前記接近度が規定する近さの方が近いとき,前記侵入禁止領域への前記作業装置及び前記機械本体の侵入が防止されるように前記複数のアクチュエータの少なくとも1つを減速する動作範囲制限制御を実行する制御装置とを備える作業機械において,前記制御装置によって算出された前記接近度の履歴情報が記憶される記憶装置をさらに備え,前記制御装置は,前記記憶装置に記憶された前記接近度の履歴情報に基づいて前記接近度閾値を変更することとする。
 本発明によれば,頻繁な制御介入による作業効率の低下を抑制しつつ,かつ確実に侵入禁止領域への油圧ショベルの侵入を防ぐことができる。
油圧ショベルの構成図。 油圧ショベルの制御コントローラを油圧駆動装置とともに示す図。 制御用油圧ユニットの詳細図。 油圧ショベルの制御コントローラのハードウェア構成図。 油圧ショベルにおける座標系を示す図。 制御コントローラの機能ブロック図。 制御コントローラの詳細な機能ブロック図。 侵入禁止領域とショベル作業の例を示す図。 動作範囲制限制御のフローチャートを示す図。 第1実施形態に係る距離閾値の変更のフローチャートを示す図。 侵入禁止領域との距離と,減速率の関係を示す図。 侵入禁止領域との距離と,減速率の関係を示す図。 第2実施形態に係る距離閾値の変更のフローチャートを示す図。 第3実施形態に係る距離閾値の変更のフローチャートを示す図。 油圧ショベルにおける座標系を示す図。 侵入禁止領域に対して上部旋回体が旋回していない状況を示す図。 図16の状況から上部旋回体がθswだけ旋回した状況を示す図。 パイロット圧とアクチュエータ速度の相関テーブルを示す図。
 以下,本発明の実施形態について図面を用いて説明する。なお,以下では,作業機械として,作業装置の先端の作業具(アタッチメント)としてバケットを備える油圧ショベルを例示するが,バケット以外のアタッチメントを備える作業機械に本発明を適用してもよい。また,複数のリンク部材(アタッチメント,ブーム,アーム等)を連結して構成される多関節型の作業装置を有するものであれば,油圧ショベル以外の作業機械への適用も可能である。
 また,以下の説明では,同一の構成要素が複数存在する場合,符号の末尾にアルファベットの大文字を付すことがあるが,当該アルファベットの大文字を省略して当該複数の構成要素をまとめて表記することがある。例えば,同一の3つのポンプ190a,190b,190cが存在するとき,これらをまとめてポンプ190と表記することがある。
 <第1実施形態>
 図1は本発明の第1の実施形態に係る油圧ショベルの構成図であり,図2は本発明の実施形態に係る油圧ショベルの制御コントローラを油圧駆動装置と共に示す図であり,図3は図2中のフロント制御用油圧ユニット160の詳細図である。
 図1において,油圧ショベル1は,多関節型のフロント作業装置1Aと,車体(機械本体)1Bで構成されている。車体(機械本体)1Bは,左右の走行油圧モータ3a,3bにより走行する下部走行体11と,下部走行体11の上に取り付けられ,旋回油圧モータ4により旋回する上部旋回体12とからなる。
 フロント作業装置1Aは,垂直方向にそれぞれ回動する複数のフロント部材(ブーム8,アーム9及びバケット10)を連結して構成されている。ブーム8の基端は上部旋回体12の前部においてブームピンを介して回動可能に支持されている。ブーム8の先端にはアームピンを介してアーム9が回動可能に連結されており,アーム9の先端にはバケットピンを介してバケット10が回動可能に連結されている。ブーム8はブームシリンダ5によって駆動され,アーム9はアームシリンダ6によって駆動され,バケット10はバケットシリンダ7によって駆動される。
 ブーム8,アーム9,バケット10の回動角度α,β,γ(図5参照)を測定可能なように,ブームピンにブーム角度センサ30,アームピンにアーム角度センサ31,バケットリンク14にバケット角度センサ32が取付けられ,上部旋回体12には基準面(例えば水平面)に対する上部旋回体12(車体1B)の傾斜角θ(図5参照)を検出する車体傾斜角センサ33が取付けられている。なお,角度センサ30,31,32はそれぞれ基準面(例えば水平面)に対する角度センサ(例えば,慣性計測装置(IMU:Inertial Measurement Unit))に代替可能であるし,あるいはそれぞれのシリンダストロークを検出するシリンダストロークセンサとし,得られたシリンダストロークから角度に換算するものにも代替可能である。また,上部旋回体12と下部走行体11の相対角度を検出可能なように,上部旋回体12と下部走行体11の回転中心近傍に,図示しない旋回角度センサ19が取り付けられている。
 上部旋回体12に設けられた運転室内には,走行右レバー23a(図1)を有し走行右油圧モータ3a(下部走行体11)を操作するための操作装置47a(図2)と,走行左レバー23b(図1)を有し走行左油圧モータ3b(下部走行体11)を操作するための操作装置47b(図2)と,操作右レバー22a(図1)を共有しブームシリンダ5(ブーム8)及びバケットシリンダ7(バケット10)を操作するための操作装置45a,46a(図2)と,操作左レバー22b(図1)を共有しアームシリンダ6(アーム9)及び旋回油圧モータ4(上部旋回体12)を操作するための操作装置45b,46b(図2)が設置されている。以下では,操作右レバー22a,操作左レバー22b,走行右レバー23aおよび走行左レバー23bを操作レバー22,23と総称することがある。
 上部旋回体12に搭載された原動機であるエンジン18は,油圧ポンプ2とパイロットポンプ48を駆動する。油圧ポンプ2はレギュレータ2aによって容量が制御される可変容量型ポンプであり,パイロットポンプ48は固定容量型ポンプである。本実施形態においては,図3に示すように,パイロットライン144,145,146,147,148,149の途中にシャトルブロック162が設けられている。操作装置45,46,47から出力された油圧信号が,このシャトルブロック162を介してレギュレータ2aにも入力される。シャトルブロック162の詳細構成は省略するが,油圧信号がシャトルブロック162を介してレギュレータ2aに入力されており,油圧ポンプ2の吐出流量が当該油圧信号に応じて制御される。
 パイロットポンプ48の吐出配管であるポンプライン150はロック弁39を通った後,複数に分岐して操作装置45,46,47,フロント制御用油圧ユニット160内の各弁に接続している。ロック弁39は本例では電磁切換弁であり,その電磁駆動部は運転室(図1)に配置されたゲートロックレバー(不図示)の位置検出器と電気的に接続している。ゲートロックレバーのポジションは位置検出器で検出され,その位置検出器からロック弁39に対してゲートロックレバーのポジションに応じた信号が入力される。ゲートロックレバーのポジションがロック位置にあればロック弁39が閉じてポンプライン150が遮断され,ロック解除位置にあればロック弁39が開いてポンプライン150が開通する。つまり,ポンプライン150が遮断された状態では操作装置45,46,47による操作が無効化され,旋回,掘削等の動作が禁止される。
 また,ゲートロックレバーの位置検出器はゲートロックレバーの位置情報(ポジション)を示す信号を制御コントローラ40(後述)に出力する。この信号がロック解除位置を示す場合は,オペレータによる油圧ショベル1の操作が可能な状態であって,オペレータは例えば作業装置1Aによる掘削操作や,走行,旋回操作を実施しようとしていることを示す。反対に,ロック位置を示す場合は,オペレータによる油圧ショベル1の操作が不可能な状態であって,オペレータは油圧ショベル1による作業以外(例えば,目標面の設定,地形の確認,休憩等)を実施しようとしていることを示す。
 操作装置45,46,47は,油圧パイロット方式であり,パイロットポンプ48から吐出される圧油をもとに,それぞれオペレータにより操作される操作レバー22,23の操作量(例えば,レバーストローク)と操作方向に応じたパイロット圧(操作圧と称することがある)を発生する。このように発生したパイロット圧は,コントロールバルブユニット20内の対応する流量制御弁15a~15f(図2参照)の油圧駆動部150a~155bにパイロットライン144a~149b(図2参照)を介して供給され,これら流量制御弁15a~15fを駆動する制御信号として利用される。
 油圧ポンプ2から吐出された圧油は,流量制御弁15a,15b,15c,15d,15e,15f(図2参照)を介して走行右油圧モータ3a,走行左油圧モータ3b,旋回油圧モータ4,ブームシリンダ5,アームシリンダ6,バケットシリンダ7に供給される。供給された圧油によってブームシリンダ5,アームシリンダ6,バケットシリンダ7が伸縮することで,ブーム8,アーム9,バケット10がそれぞれ回動し,バケット10の位置及び姿勢が変化する。また,供給された圧油によって旋回油圧モータ4が回転することで,下部走行体11に対して上部旋回体12が旋回する。そして,供給された圧油によって走行右油圧モータ3a,走行左油圧モータ3bが回転することで,下部走行体11が走行する。以下では,走行油圧モータ3,旋回油圧モータ4,ブームシリンダ5,アームシリンダ6,バケットシリンダ7を総称して,油圧アクチュエータ3-7と総称することがある。
 図4は本実施形態に係る油圧ショベルが備える動作範囲制限システムの構成図である。図4のシステムは,操作レバー22,23がオペレータに操作されたときに,予め設定された侵入禁止領域60(図5参照)に対する油圧ショベルのフロント作業装置1Aおよび車体1Bの侵入が防止されるように,油圧アクチュエータ3-7を減速又は停止する動作範囲制限制御(減速制御)を実行するものである。動作範囲制限システムによる油圧アクチュエータ3-7の制御の詳細を説明する。
 例えば,操作レバー22の操作によって油圧アクチュエータ4-7の動作が指示された場合,侵入禁止領域60(図5参照)と侵入禁止領域60に対する油圧ショベル1の最近傍点(図5ではアーム9の後端部)との位置関係に基づいて,侵入禁止領域60に近づこうとする油圧アクチュエータ3-7の動作を制限するような制御信号を該当する流量制御弁15a~15fに出力する。
 動作範囲制限システムによって,油圧ショベルの各部が侵入禁止領域60に侵入することを防げるため,オペレータは本来の掘削作業に専念することが可能となる。なお,図5の例では侵入禁止領域60が油圧ショベルの上方に設定されているが,侵入禁止領域60はこの位置に限定されるものではない。例えば油圧ショベルの下方や側面にも設定可能であるし,扇形のような直線以外の形状も含まれる。
 図4のシステムは,作業機械姿勢検出装置51と,侵入禁止領域設定装置52と,オペレータ操作検出装置53と,動作範囲制限制御の有効/無効を選択する制御選択装置54と,侵入禁止領域60と油圧ショベルの位置関係を表示可能な表示装置(モニタ)55と,油圧ショベルのメインコントローラ57と,動作範囲制限制御をつかさどる制御コントローラ40とを備えている。
 作業機械姿勢検出装置51は,車体1Bと作業装置1Aの姿勢情報を検出するセンサであり,ブーム角度センサ30,アーム角度センサ31,バケット角度センサ32,車体傾斜角センサ33,旋回角度センサ34から構成される。
 侵入禁止領域設定装置52は,侵入禁止領域60に関する情報(例えば,侵入禁止領域60の境界の位置情報)を入力可能なインターフェースである。侵入禁止領域設定装置52を介した侵入禁止領域60の設定は,オペレータが手動で行っても良い。また,侵入禁止領域設定装置52を外部端末と接続し,その外部端末から侵入禁止領域60を設定しても良い。なお,侵入禁止領域60は,ショベル(例えば上部旋回体12)に設定されたローカル座標系,グローバル座標(地理座標),又は現場に設定された現場座標等,所望の座標系に設定できる。
 オペレータ操作検出装置53は,オペレータによる操作レバー22,23の操作によってパイロットライン144~149に生じる操作圧を取得する圧力センサ70a~75a,及び圧力センサ70b~75bから構成される。つまり,油圧アクチュエータ3-7に関する操作を検出している。
 制御選択装置54は,例えばジョイスティック形状の操作レバー22aにおける前面の上端部に設けられたスイッチであり,操作レバー22aを握るオペレータの親指により押下される。制御選択装置54は,モーメンタリスイッチであり,押下される度に動作範囲制限制御の有効(ON)と無効(OFF)が切り替えられる。制御選択装置54の切替位置(ON位置/OFF位置)は制御コントローラ40に入力される。なお,制御選択装置54の設置箇所は操作レバー22a(22b)に限らず,その他の場所に設けても良い。例えば,表示装置55に設けても良い。また,ハードウェアで構成される必要はなく,例えば表示装置を55タッチパネル化し,その画面上に表示されるグラフィカルユーザインターフェース(GUI)として構成しても良い。
 油圧ショベルのメインコントローラ57は,オペレータによる油圧ショベル1の操作が可能な状況か否かを示す情報(操作可否情報)として,エンジン18のON状態/OFF状態を示す情報(ON/OFF情報)や,ゲートロックレバーの位置情報(ロック位置/ロック解除位置),上部旋回体12上の運転室のドアの開閉状態の情報(開閉情報)をそれぞれのセンサから取得可能なコントローラである。メインコントローラ57は取得したこれらの情報(オペレータによる作業機械の操作可否情報)を制御コントローラ40に出力する。エンジン18がON状態にある場合,ゲートロックレバーがロック位置にある場合,及び運転室ドアが閉状態にある場合には,オペレータによる油圧ショベル1の操作が可能な状態であるとみなす。一方,エンジン18がOFF状態にある場合,ゲートロックレバーがロック解除位置にある場合,及び運転室ドアが開状態にある場合には,オペレータによる油圧ショベル1の操作が不可能な状態であるとみなす。なお,エンジン18のON状態/OFF状態はキースイッチの位置(OFF位置,ON位置,START位置)から判断しても良い。
 図2に示すように,制御用油圧ユニット160はブームシリンダ5,アームシリンダ6,バケットシリンダ7,旋回モータ4,走行モータ3のすべての操作装置のパイロットラインに設けられる。図3に制御用油圧ユニット160の詳細を示す。例としてブームシリンダ5を用いて説明する。パイロットライン144a,144bに対して,制御コントローラ40に電気的に接続された電磁比例弁84a,84bが設置されている。電磁比例弁84a,84bは,制御コントローラ40からの制御信号を基にパイロットライン144a,144b内のパイロット圧を低減して出力することが可能である。また,ここではブームシリンダに関するパイロットライン144を用いて説明したが,他の油圧アクチュエータ3,4,6,7に関するパイロット圧に関しても,制御コントローラ40からの指令により低減が可能なように,電磁比例弁84-89が設けられている。
 電磁比例弁84-89は,非通電時には開度が最大で,制御コントローラ40からの制御信号である電流を増大させるほど開度は小さくなる。つまり,オペレータが操作レバー22,23を操作したことによって生じたパイロット圧に対して,減じたパイロット圧を発生させることができ,すべての油圧アクチュエータの動作の速度を,オペレータの操作に対して強制的に低減できる。
 図4において制御コントローラ40は,入力インターフェース91と,プロセッサである中央処理装置(CPU)92と,記憶装置であるリードオンリーメモリ(ROM)93及びランダムアクセスメモリ(RAM)94と,出力インターフェース95とを有している。入力インターフェース91は,作業機械姿勢検出装置51である角度センサ30,31,32,34及び傾斜角センサ33からの信号と,侵入禁止領域60を設定するための装置である侵入禁止領域設定装置52からの信号と,操作装置45~47からの操作量を検出する圧力センサ(圧力センサ70~75を含む)であるオペレータ操作検出装置53からの信号と,制御選択装置54の切替位置(動作範囲制限制御を有効とするON位置と,同制御を無効とするOFF位置)を示す信号を入力し,CPU92が演算可能なように変換する。ROM93は,後述するフローチャートに係る処理を含め動作範囲制限制御を実行するための制御プログラムと,当該フローチャートの実行に必要な各種情報等が記憶された記録媒体であり,CPU92は,ROM93に記憶された制御プログラムに従って入力インターフェース91及びメモリ93,94から取り入れた信号に対して所定の演算処理を行う。出力インターフェース95は,CPU92での演算結果に応じた出力用の信号を作成し,その信号を電磁比例弁84~89または表示装置55に出力することで,油圧アクチュエータ3-7を駆動・制御したり,フロント作業装置1A,車体1B,バケット10及び侵入禁止領域60等の画像を表示装置55の画面上に表示させたりする。
 なお,図4の制御コントローラ40は,記憶装置としてROM93及びRAM94という半導体メモリを備えているが,記憶装置であれば代替可能であり,例えばハードディスクドライブ等の磁気記憶装置を備えても良い。
 図6は,制御コントローラ40の機能ブロック図である。制御コントローラ40は,動作範囲制限制御部78と,電磁比例弁制御部76と,表示制御部77を備えている。
 表示制御部77は,動作範囲制限制御部78から出力される作業機械姿勢及び侵入禁止領域60の位置情報を基に表示装置(モニタ)55を制御する部分である。表示制御部77には,フロント作業機1Aや車体1Bの画像及びアイコンを含む表示関連データが多数格納されている表示ROMが備えられており,表示制御部77が,入力情報に含まれるフラグに基づいて所定のプログラムを読み出すとともに,表示装置55における表示制御をする。
 図7は図6中の動作範囲制限制御部78の機能ブロック図である。動作範囲制限制御部78は,オペレータ操作速度推定部101と,姿勢演算部102と,侵入禁止領域演算部103と,接近度演算部104と,履歴記憶部106と,減速指令演算部105と,速度指令選択部107を備えている。このうち減速指令演算部105と,履歴記憶部106と,速度指令選択部107を制御指令部108と総称することがある。制御指令部108は,侵入禁止領域60へのフロント作業装置1A及び車体1Bの侵入が防止されるように複数の油圧アクチュエータ3-7の少なくとも1つを減速する動作範囲制限制御(減速制御)を実行する。
 オペレータ操作速度推定部101は,圧力センサ71~75から構成されるオペレータ操作検出装置53から入力されるパイロット圧を基に,制御コントローラ40内に予め保持してあるパイロット圧とアクチュエータ速度の相関テーブル(図18参照)を用いて,オペレータ操作による油圧アクチュエータ3-7の速度を推定する。なお,圧力センサ70,71,72による操作量の算出は一例に過ぎず,例えば各操作レバー22,23の操作レバーの回転変位を検出する位置センサ(例えば,ロータリーエンコーダ)で当該操作レバーの操作量を検出し,その検出したレバー操作量から,レバー操作量とパイロット圧の相関テーブルを用いてパイロット圧を算出し,油圧アクチュエータ3-7の速度を推定しても良い。また,オペレータの操作量から動作速度を算出する構成に代えて,角度センサ30~32の検出値から油圧シリンダ5,6,7の伸縮量を算出し,伸縮量の時間変化を基に動作速度を算出しても良い。また,旋回角度センサ34の時間変化を基に,旋回角度の時間変化を算出しても良い。
 姿勢演算部102は作業機械姿勢検出装置51からの情報に基づき,ローカル座標系における油圧ショベル1の姿勢と位置を演算する。油圧ショベル1の姿勢は,図5のショベル座標系(ローカル座標系)上に定義できる。図5のショベル座標系は,旋回中心軸を原点としている。下部走行体11が直進する際の進行方向と,フロント作業装置1Aの動作平面が平行となり,かつフロント作業装置1Aの伸ばし方向の動作方向と,下部走行体11を前進させたときの動作方向が一致する向きをX軸,上部旋回体12における旋回中心をZ軸,前述したX軸及びZ軸と右手座標系を構成するようにY軸を定めた。また,旋回角度については,フロント作業装置1AがX軸と平行になる状態を0度とした。X軸に対するブーム8の回転角をブーム角α,ブーム8に対するアーム9の回転角をアーム角β,アーム9に対するバケット10爪先の回転角をバケット角γ,下部旋回体に対する上部旋回体の旋回角を旋回角δとした。ブーム角αはブーム角度センサ30により,アーム角βはアーム角度センサ31により,バケット角γはバケット角度センサ32により,旋回角δは旋回角度センサ34により検出される。これらの角度情報と,油圧ショベルの各部の寸法情報を用いる事で,ショベル座標系における油圧ショベルの各部の姿勢と位置を演算できる。また,重力方向に対して直角な水平面(基準面)に対する車体1Bの傾斜角θは,車体傾斜角センサ33で検出可能である。
 侵入禁止領域演算部103は,侵入禁止領域設定装置52からの情報に基づき侵入禁止領域60の位置情報を,図5に示すショベル座標系に変換する演算を実行する。本実施形態では,図5に示すように,2次元空間で表現される侵入禁止領域60を示しているが,3次元空間で表現される侵入禁止領域60であっても良い。また,侵入禁止領域60は複数存在しても良い。
 接近度演算部104は,オペレータによる操作レバー22,23の操作時に,侵入禁止領域60に対する油圧ショベル1の動作範囲制限制御の対象部位との接近度を演算する。接近度とは,フロント作業装置1A及び車体1B上における動作範囲制限制御の対象部位と予め設定された侵入禁止領域60との近さを示す指標値である。接近度としては,例えば,動作範囲制限制御の対象部位と侵入禁止領域60との距離を利用しても良いし,この距離にショベルの動作速度を加味した情報である動作範囲制限制御の対象部位と侵入禁止領域60との接触予測時間を利用しても良い。フロント作業装置1A及び車体1B上における動作範囲制限制御の対象部位としては,侵入禁止領域60に侵入し得るショベル上の点が設定可能であり,例えば,バケット10の先端やアーム後端部9b(図15参照)が設定可能である。また,フロント作業装置1A及び車体1B上の複数の点における接近度を演算し,その中で最も侵入禁止領域60に近いと評価される点(例えば接近度として距離を選択した場合にはその距離が最も短い点)を動作範囲制限制御の対象部位として選択することも可能である。
 動作範囲制限制御の対象部位(以下では制御対象部位とも称する)の位置は次のように演算する。ここでは上部旋回体12の旋回中心120を基準とした場合の制御対象部位の位置及び速度の演算について説明する。図15に示すように,上部旋回体12の旋回中心120とブームピン8aのX軸方向の長さをLsb,ブームピン8aからアームピン9aまでの長さをLbm,アーピン9aからバケットピン10aまでの長さをLam,バケットピン10aからバケット先端10bまでの長さをLbk,ブーム8,アーム9,バケット10の回動角度をα,β,γとする。なお,旋回中心120と,ブームピン8に,Z軸方向やY軸方向のオフセットは無いものとする。このとき,バケット先端10bの水平方向位置Xbkと,垂直方向位置Zbkは,それぞれ以下の式で表される。
Figure JPOXMLDOC01-appb-M000001
 次に,ブーム8,アーム9,バケット10の回動角速度をωα,ωβ,ωγとすると,バケット先端10bの水平方向速度VXbkと,垂直方向速度VZbkは,それぞれ以下の式で表される。
Figure JPOXMLDOC01-appb-M000002
 図15に示すように,バケット先端以外のアーム後端部9b(図15参照)のような油圧ショベル1の他の部位についても,位置と速度をそれぞれ算出することが可能である。アーム後端部9bの位置Xamr,Zamr及び速度VXamr,VZamrは,以下の式にて算出できる。ただし,図15に示すようにLbsはアームピン9aからアーム後端部9bまでの距離,τは図15に示す幾何学情報である。このようにして,油圧ショベル1aの幾何学情報を用いることで,フロント作業装置1Aの他の部位も同様に,位置と速度を算出することが可能である。
Figure JPOXMLDOC01-appb-M000003
 また,侵入禁止領域60と制御対象部位の位置を用いることで,侵入禁止領域60と制御対象部位との距離を算出することが可能になる。ここでは制御対象部位がバケット先端10bである場合を例に挙げて説明する。上部旋回対の旋回中心120を基準としたとき,油圧ショベル1の上側に設定された侵入禁止領域60との距離をAzとすると,バケット先端10bの侵入禁止領域60に対する距離Dzbkは以下の式で表される。
Figure JPOXMLDOC01-appb-M000004
 算出したDzbkやVZbkを用いて,侵入禁止領域60とバケット先端10bの接触予測時間Tzbkは次のように算出できる。
Figure JPOXMLDOC01-appb-M000005
 同様にして,例えばアーム後端部9bの場合の距離Dzamrと接触予測時間Tzamrは以下のように算出できる。
Figure JPOXMLDOC01-appb-M000006
 このように接近度演算部140が複数の距離(接近度)Tzbk,Tzamrを算出した場合には,その中で距離が最小となる部分を制御対象部位として選択することができる。ただし,距離が最小であってもその部位がオペレータ操作に基づいて動作しない場合には,その距離に係る部位を制御対象部位から除外しても良い。
 減速指令演算部105は,接近度演算部104で演算された接近度と,後述する履歴記憶部106に記憶された接近度の履歴情報に基づき,接近度に応じた減速指令を演算する。より具体的には,減速指令演算部105は,接近度の閾値として設定された接近度閾値が規定する近さよりも,接近度演算部104で演算された制御対象部位に係る接近度が規定する近さの方が近いとき,侵入禁止領域60への当該制御対象部位の侵入が防止されるように当該制御対象部位を駆動する油圧アクチュエータの少なくとも1つを減速する減速指令を演算する。例えば接近度として動作範囲制限制御の対象部位(例えば,アーム後端部9b)と侵入禁止領域60との距離が接近度演算部104から入力される場合には,その距離が接近度閾値(接近度が距離の場合には「距離閾値」とも称する)よりも小さいときに減速指令が演算される。そして,その距離が接近度閾値よりも小さいとき,減速指令演算部105は,予め距離と減速率の関係が予め定義されたテーブル(後述の図11,12参照)とその距離に基づいて,当該制御対象部位を動作させる油圧アクチュエータ(例えばブームシリンダ5)の減速率を演算する。最後に減速指令演算部105は,オペレータ操作速度推定部101で演算された当該制御対象部位を動作させる油圧アクチュエータの速度と演算した減速率とを利用して侵入禁止領域60への侵入を防止するために必要となる当該油圧アクチュエータ速度を演算する。
 また,減速指令演算部105内の閾値変更部109は履歴記憶部106から入力される接近度の履歴情報を用いて接近度閾値を変更する。本実施形態では接近度閾値は,制御対象部位を動作させる油圧アクチュエータの減速率を演算する際にも用いられており,動作範囲制限制御による油圧アクチュエータの減速を開始する接近度となっている。すなわちアクチュエータの減速が開始する接近度が接近度の履歴情報に応じて変化するように構成されている。
 速度指令選択部107は,同一の油圧アクチュエータ3-7について,オペレータ操作速度推定部101で推定されたオペレータ操作による油圧アクチュエータの速度(オペレータ操作速度)と減速指令演算部105で演算された油圧アクチュエータ速度とを比較し,絶対値の小さい方をその油圧アクチュエータの目標速度として選択する。例えば減速指令演算部105で演算された油圧アクチュエータ速度が選択された場合,その対象となるアクチュエータの速度を減速するよう,選択したアクチュエータ速度を電磁比例弁制御部76に出力する。
 履歴記憶部106は,接近度演算部104で演算された接近度を時系列で記憶することで接近度の履歴情報として記憶している。履歴記憶部106は,制御コントローラ40内の記憶装置(ROM93,RAM94)に設けられた記憶領域であり,ここには接近度の履歴情報をはじめとした各種情報が記憶される。なお,この記憶領域は制御コントローラ40の外部に位置し作業機械に搭載された他の記憶装置に設けても良い。また,履歴記憶部106で保持されている履歴情報は,減速指令演算部105へ出力される。この他の履歴情報として,例えば,減速指令演算部105で演算されたアクチュエータ速度,オペレータ操作速度推定部101で演算されたオペレータ操作速度,メインコントローラ57からのエンジン18のON状態/OFF状態(オペレータ操作によるキースイッチの位置状態(OFF位置,ON位置,START位置))やゲートロックレバーの位置情報(ロック位置/ロック解除位置),運転室のドアの開閉状態(開状態/閉状態)に関する情報等の時系列を各情報の取得時刻とともに記憶しても良い。
 電磁比例弁制御部76は,速度指令選択部107から出力される各アクチュエータ3-7の目標速度に基づいて各電磁比例弁84-89への指令を演算して出力する。これによりパイロットライン144-149内のパイロット圧が目標速度に応じて適宜調整されるので,速度指令選択部107で選択された速度で各アクチュエータ3-7が動作する。
 ここで動作範囲制限制御による,アクチュエータ動作の制限の例を図8に示す。図8には,繰り返し行われる掘削作業の1サイクルにおいて,掘削作業が終了しフロント作業装置1Aが巻き込まれている状態S1と,次の掘削作業のためのリーチング作業を行っている状態S2を示している。状態S1からS2に遷移する際,バケット10と掘削面36の接触を防ぐためにブーム8の上げ動作をオペレータは実施するが,ブーム8の上げ動作が過剰である場合,アーム9の後端部37が侵入禁止領域60に侵入する可能性がある。減速指令演算部105は,図8に示すような状態S1からS2に遷移する状況でブーム8の上げ操作が過剰なときに,アーム9の後端部37の侵入禁止領域60への侵入を防止するためにブーム上げ動作(すなわちブームシリンダの伸び動作)を減速させる指令を演算する。言い換えると,侵入禁止領域60に対するフロント作業装置1Aの距離が接近度閾値より小さい場合,すなわち侵入禁止領域60にフロント作業装置1Aが近付いた場合に,ブーム上げ動作を減速させる指令を演算する。これにより侵入禁止領域60にフロント作業装置1Aが侵入しないよう,オペレータによる操作に対して介入動作(動作範囲制限制御)を行う。侵入禁止領域60に対する距離が接近度閾値より大きい場合は介入動作を行わず,ショベルはオペレータの操作に従って動作する。
 このとき履歴記憶部106は,動作範囲制限制御の実行の有無にかかわらず,接近度演算部104で演算された接近度(例えば距離),減速指令演算部105で演算されたアクチュエータ速度(減速指令),オペレータ操作速度推定部101で演算されたアクチュエータ速度(オペレータ操作速度)を記憶する。
 例えば,履歴記憶部106が記憶する履歴情報が侵入禁止領域60とショベル1の距離であるとき,減速指令演算部105(制御指令部108)はその距離が接近度閾値よりも小さいときに動作範囲制限制御を実行する。このとき,閾値変更部109は,その距離の履歴情報に基づいて距離のばらつき(例えば,分散や標準偏差)を演算し,減速指令演算部105が減速指令を算出し始める接近度閾値をそのばらつきの値に応じて変更する。例えば,距離のばらつきが所定の閾値(ばらつき閾値)以上のときは,減速指令を算出し始める距離の接近度閾値を初期値(dth1)のままとし,ばらつきがばらつき閾値より小さいときには接近度閾値を初期値より小さい値(dth2)に変更する。これにより制御介入が生じにくくなるようにすることができる。なお,距離のばらつきがばらつき閾値以上か否かで接近度閾値を2つ値の間で変化させる場合を説明したが,距離のばらつきが小さいほど小さい値になるように接近度閾値を設定することも可能である。
 速度指令選択部107は,制御選択装置54にて動作範囲制限制御が有効(ON)に設定されている場合,かつ,オペレータ操作速度を減速した速度を減速指令演算部105が出力する場合には,その速度で油圧アクチュエータ3-7が駆動されるように電磁比例弁制御部76に指令を出す。一方,減速指令演算部105がアクチュエータ速度を出力しない場合や,制御選択装置54にて動作範囲制限制御が無効(OFF)に設定されている場合は,電磁比例弁制御部76に信号を送らず,オペレータの操作通りに油圧アクチュエータ3-7が駆動されるようにする。
 図9,図10を用いて,動作範囲制限制御部78の制御フローを説明する。ここでは簡単のため,動作範囲制限制御の対象はフロント作業装置1Aとする。
 まず図9のステップS100にて,接近度演算部104は,侵入禁止領域演算部103から侵入禁止領域60の位置情報を入力し,侵入禁止領域60の設定があるか否かを判定する。侵入禁止領域60が設定されている場合にはステップS101へ進む。一方,侵入禁止領域60が設定されていない場合にはステップS107に進む。
 ステップS101では,接近度演算部104は,制御選択装置54にて動作範囲制限制御が有効(ON)に設定されているか否かを判定する。動作範囲制限制御が有効(ON)である場合にはステップS102に進む。そうでない場合(すなわち無効(OFF)である場合)にはステップS107に進む。
 ステップS102では,接近度演算部104は,姿勢演算部102と侵入禁止領域演算部103の情報を基にフロント作業装置1Aの各部の位置と侵入禁止領域60の位置とを比較して,侵入禁止領域60の境界からフロント作業装置1Aまでの最短距離を演算し,これを接近度とする。なお,フロント作業装置1Aにおいて侵入禁止領域60の境界までの距離を演算する箇所を予め複数決定しておき,その中から距離の最も短いものを接近度として演算しても良い。ステップS102での演算が終了したらステップS103へ進む。
 ステップS103では,減速指令演算部105は,ステップS102で算出された距離(接近度)が,第1閾値(後述するdth1あるいはdth2)より小さいか否かを判定する。ステップS102で算出した距離が接近度閾値(dth1あるいはdth2)より小さい場合,ステップS104へ進む。また,ステップS102で算出された距離が接近度閾値以上の場合はステップS107に進む。
 ステップS104では,減速指令演算部105は,ステップS102で算出した距離に基づいて,アクチュエータ5-7の減速率rを算出する。本実施形態の減速率rはゼロ以上かつ1以下の値であり,0で減速なし,1で減速が最大となり停止するように定義されている。距離と減速率の関係は,例えば図11に示すような関係で定義できる。減速率を算出したらステップS105へ進む。
 ステップS105では,減速指令演算部105は,まず,フロント作業装置1Aを動作する3つのアクチュエータ5-7の中で減速対象とする油圧シリンダを決定する。本実施形態では,(1)ステップS102で演算した距離(接近度)が接近度閾値より小さく,かつ,(2)ステップS102で距離(接近度)を演算した点の速度ベクトルが侵入禁止領域60に近づく向きである場合に,(3)フロント作業装置1Aを動作する3つのアクチュエータ5-7のうち,フロント作業装置1Aに発生させる速度ベクトルが侵入禁止領域60に近づく向きを有しているアクチュエータを減速対象とする。例えばアーム9の後端部9bが侵入禁止領域60に近い状況でオペレータによってアームシリンダ6とブームシリンダ5が操作されている場合において,アームシリンダ6がアーム後端部9bを侵入禁止領域60から遠ざける方向に動作させ,ブームシリンダ5がアーム後端部9bを侵入禁止領域60に近づける方向に動作させているときには,アーム後端部9bを侵入禁止領域60に近づけているブームシリンダ5を減速対象のアクチュエータとして選択する。なお,減速対象のアクチュエータは上記(1)-(3)の条件を満たせば複数選択しても良い。また,上記(3)の条件は省略して,上記(1)と(2)の条件が満たされた場合にオペレータが操作しているアクチュエータの全てを減速対象としても良い。
 減速対象のアクチュエータが決定したら,減速指令演算部105は,減速対象のアクチュエータに関してオペレータ操作速度推定部101で演算されたオペレータ操作速度Vopeと,ステップS104で演算した減速率rとに基づいて減速後のアクチュエータ速度Vctrlを演算し,演算した速度Vctrlを速度指令選択部107と履歴記憶部106に出力する。減速後のアクチュエータ速度Vctrlは例えば次の式で演算できる。
Figure JPOXMLDOC01-appb-M000007
 続いて速度指令選択部107は,オペレータ操作速度Vopeと減速後のアクチュエータ速度Vctrlの大小を比較して絶対値の小さい方を選択して電磁比例弁制御部76に出力する。これにより減速率rに応じたアクチュエータ速度になるようアクチュエータ5-7が自動制御される。なお上記のVctrlの式から明白であるが,減速率rがゼロより大きい場合には必ずVctrlが速度指令選択部107で選択される。
 ステップS100,ステップS101,ステップS103のいずれかでNOと判定された場合には,ステップS107へ進み,オペレータによる操作通りにアクチュエータを駆動させる。
 図9のステップS103における侵入禁止領域60との距離の閾値(接近度閾値)を,履歴記憶部106に記憶された履歴情報に基づいて変更するフローについて図10を用いて説明する。
 まずステップS201において,閾値変更部109(減速指令演算部105)は,動作範囲制限制御の実行がないか否かを判定する。動作範囲制限制御が実行されていない場合にはステップS202へ進み,実行されている場合にはステップS209に進む。
 ステップS202では,閾値変更部109は,図9のステップS102で距離(接近度)を演算した点(侵入禁止領域60から最短距離に在るフロント作業装置1Aの箇所であり,以下では「最近傍位置」と称することがある)の位置データを取得する。例えば図8に示す状況である場合,この点はアーム後端部9bに相当する。位置データが取得できたらステップS203へ進む。
 ステップS203では,閾値変更部109は,あらかじめ定められた所定時間tjが経過したか否かを判定する。所定時間tjが経過する前である場合,所定時間tjが経過するまでステップS201からステップS203を繰り返す。所定時間tjが経過したら,ステップS204へ進む。
 なお,所定時間tjとしては,任意の時間(例えば数分間)を設定可能であるが,例えばフロント作業装置1Aが所定の動作(掘削動作,放土動作,リーチング動作)を所定サイクル数(例えば10サイクル)繰り返すのに要した時間を設定しても良い。
 ステップS204では,閾値変更部109は,所定時間tj中にステップS202で取得したフロント作業機1Aの最近傍位置の位置データを基にその位置データのばらつきを演算し,そのばらつきが所定の閾値(ばらつき閾値)より小さいか否かを判定する。ばらつきがばらつき閾値より小さい場合にはステップS205へ進む。一方,ばらつきがばらつき閾値以上の場合にはステップS209に進む。
 ステップS205では,閾値変更部109は,所定時間tj中に走行に関するレバー操作(すなわち操作レバー23の操作)がないことを判定する。走行に関するレバー操作がない場合にはステップS206へ進む。一方,走行に関するレバー操作がある場合にはステップS209に進む。
 ステップS206では,閾値変更部109は,その時(ステップS206の実行時)の接近度閾値がdth1(初期値)であるか否かを判定する。接近度閾値がdth1であると判定された場合には,ステップS207へ進み,接近度閾値をdth1からdth2(ただし,dth1>dth2)に変更する。一方,接近度閾値がdth1ではないと判定された場合,つまりdth2である場合には,ステップS208へ進み,接近度閾値としてdth2を維持する(接近度閾値の変更は行わない)。
 ステップS209では,閾値変更部109は,その時(ステップS209の実行時)の接近度閾値がdth1であるか否かを判定する。接近度閾値がdth1であると判定された場合にはステップS210へ進み,接近度閾値をdth1に維持する。一方,接近度閾値がdth1ではないと判定された場合にはステップS211へ進み,接近度閾値をdth2からdth1に変更する。
 接近度閾値のdth1とdth2は,図11に示すようにdth2の方が小さい値となる。そのため,dth2に基づいて動作範囲制限制御が実行される場合,dth1に基づいて動作範囲制限制御が実行される場合と比して,オペレータ操作通りに油圧アクチュエータ5-7が動作する範囲が拡大する。なお,距離と減速率rの関係は,例えば図11に示すような直線に限定する必要はなく,図12に示すように多項式で表現される曲線であっても良い。
 ステップS207,208,210,211が終了したら,次の制御周期が開始するタイミングでステップS201を開始し,以降は上述の処理を繰り返すものとする。
 <作用・効果>
 本実施形態では,侵入禁止領域60に対するフロント作業機1Aの最近傍位置の位置データのばらつきが少ない場合,油圧ショベルに搭乗中のオペレータは侵入禁止領域60を認識しており,かつ,油圧ショベルの操作にも習熟しているとみなし,最近傍位置と侵入禁止領域60が近くても侵入禁止領域60へのショベルの侵入の可能性は低いと推定することとした。そこで,本実施形態の油圧ショベルでは,所定時間tj(図10のステップS203)における侵入禁止領域60に対するフロント作業機1Aの最近傍位置の位置データ(接近度)のばらつきがばらつき閾値より小さいときには,動作範囲制限制御が開始される接近度の閾値である接近度閾値(距離閾値)を侵入禁止領域60に近い値(dth2)に変更又は維持する(ステップS207,S208)。これにより接近度閾値をdth1に固定する場合と比較してオペレータ操作への動作範囲制限制御の頻繁な介入が防止されるので,作業効率の低下が抑制され,かつ確実に侵入禁止領域60への侵入を防止できる。
 また,操作スキルの高いオペレータや慎重に操作するタイプのオペレータでは動作範囲制限制御は実行されない可能性が高いが,操作スキルの低いオペレータでは動作範囲制限制御が繰り返し実行される可能性が高い。そこで本実施形態では図10のステップS201において搭乗中のオペレータに対して動作範囲制限制御の実行の有無を確認し,今回の搭乗中に動作範囲制限制御が実行された場合には接近度閾値を初期値(dth1)に維持/変更する(ステップS210,211)こととし,今回の搭乗中に動作範囲制限制御が実行されていないオペレータにだけ,他の条件(ステップS204,205)を満たす場合に接近度閾値をdth2に変更することとした。これにより確実に侵入禁止領域60への侵入を防止できる。なお,図10のステップS201は省略可能である。
 また,本実施形態は所定時間tjに得られた侵入禁止領域60に対する最近傍位置の位置データに基づいて接近度閾値の変更の要否を評価している関係上,少なくとも所定時間tjは接近度閾値が変更されることがない。これにより接近度閾値が頻繁に変更されることを防止できる。
 また,油圧ショベルの作業場所が変更されると,侵入禁止領域60に対する最近傍位置の位置や油圧ショベルが実行する作業内容が移動前と異なる可能性が高く,オペレータが移動前と同様の感覚で作業をすると侵入禁止領域60への侵入を許す可能性がある。そこで本実施形態では,図10のステップS205で走行操作レバー23の操作の有無を判定することで,走行操作レバー23が操作された場合には接近度閾値を初期値(dth1)に維持/変更することとした。これにより作業場所を移動した際にも確実に侵入禁止領域60への侵入を防止できる。なお,図10のステップS205は省略可能である。
 なお,本実施形態ではばらつきがばらつき閾値より大きいか小さいかで接近度閾値を切り換えたが,ばらつきの大きさに応じて接近度閾値を変更しても良い。すなわち接近度が距離の場合にはばらつきが小さいほど接近度閾値(距離閾値)が小さくなるように設定しても良い。
 <第2実施形態>
 本実施形態では,履歴記憶部106のデータに基づいて閾値変更部109が距離閾値(接近度閾値)を初期値(dth1)にリセットする条件に関する内容を述べる。閾値変更部109は第1実施形態で説明した図10の処理に加えて本実施形態で説明する図13の処理を実行する。
 履歴記憶部106はオペレータによる油圧ショベル1の操作可否情報として,操作レバー22.23以外の操作装置に関するオペレータ操作の履歴情報をメインコントローラ57から取得する。ここで取得されるオペレータ操作の履歴情報(操作可否情報)には,オペレータによるキースイッチの位置情報(ON位置/OFF位置/START位置)と,ゲートロックレバーの位置情報(ロック位置/ロック解除位置)と,上部旋回体12上の運転室のドアの開閉状態(開状態/閉状態)が含まれている。閾値変更部109は履歴記憶部106で取得されたオペレータ操作の履歴情報に基づいて接近度閾値を初期値にリセットする。接近度閾値がdth2に設定されている場合,このリセットにより接近度閾値は侵入禁止領域により近いことを規定する値(dth1)に変更される。
 図13に示すように閾値変更部109は,ステップS300において,履歴記憶部106に記憶された情報に基づいてオペレータによるキースイッチの位置切り換え操作(例えばOFF位置からON位置への切り換え),ゲートロックレバーの位置切り換え操作(ロック位置からロック解除位置への切り換え),またはドアの開閉操作(ドアの閉状態から開状態への操作)のいずれかが実行されたか否かを判定する。実行されたと判定された場合,ステップS301に進む。
 ステップS301では,この時点での距離閾値がdth1であるか否かを判定する。閾値がdth1である場合,ステップS302へ進み,距離閾値をdth1のまま維持する。dth1ではない場合,ステップS303へ進み,距離閾値をdth1に変更する。また,ステップS300でいずれの操作もないと判定された場合には,ステップS304へ進み,この時点での距離閾値を維持する。
 前述したステップS300に含まれる判定条件に該当する操作をオペレータがとった場合は,オペレータによる油圧ショベルの操作を一旦不可能にすることでオペレータが油圧アクチュエータの操作の中断や油圧アクチュエータの操作以外の操作に専念し,掘削作業以外のこと(例えば,目標面の設定,地形の確認,休憩等)に意識が向いた時と考えられる。このような状況になった後の油圧ショベルの操作では,オペレータの侵入禁止領域60に対する意識が低下している可能性があると考えられる。そこで本実施形態では,履歴記憶部106に記憶された情報に基づいて再びオペレータによる油圧ショベルの操作が可能な状態になったとみなした場合に距離閾値を初期値のdth1にリセットすることとした。このように大きめの閾値であるdht1に設定することで,その後の操作において侵入禁止領域60にショベルが接近した場合,早めの制御介入を発動させることよってオペレータに侵入禁止領域60が存在することを認識させることができる。
 なお,ステップS300では,オペレータの操作可否情報に基づいてオペレータによる油圧ショベルの操作が可能になった状態と不可能になった状態の少なくとも一方を判定すれば良い。例えば,キースイッチのON位置からOFF位置への切り換え操作,ゲートロックレバーのロック解除位置からロック位置への切り換え操作,開状態から閉状態へのドア操作の少なくとも1つが実行されたか否か,すなわちオペレータによる油圧ショベルの操作が不可能になったか否かを判定しても良い。また,上記ではオペレータによる油圧ショベルの操作が一旦不可能になったと判断される場合に接近度閾値を初期値(dth1)にリセットしたが,接近度閾値は侵入禁止領域により近いことを規定する値に変更すれば初期値以外の値に変更しても良い。
 <第3実施形態>
 本実施形態では,図10に示すフローとは異なる,閾値変更部109による距離閾値の変更方法について図14を用いて述べる。図14に示すフローは,図9のフローと同一の周期や,図10の所定時間tjの間隔で実施できる。
 まずステップS400において,閾値変更部109はフロント作業装置1Aの最近傍位置と侵入禁止領域60の距離がdth1より小さいかを判定する。ここで距離がdth1より小さい場合にはステップS401へ進み,dth1以上の場合にはステップS406に進む。
 ステップS401では,閾値変更部109は,侵入禁止領域60へのフロント作業装置1Aの接近(すなわち,最近傍位置と侵入禁止領域60の距離がdth1より小さいこと)がキースイッチON後(すなわち,キーON後)の1回目であるかを判定する。侵入禁止領域60への接近が1回目である場合にはステップS402へ進み,2回目以降である場合にはステップS403に進む。
 ステップS402では,閾値変更部109は,距離閾値をdth1に維持する。
 ステップS403では,閾値変更部109は,この時点での距離閾値がdth2であるか否かを判定する。閾値がdth2である場合,ステップS404へ進み,距離閾値をdth2のまま維持する。dth2ではない場合,ステップS405へ進み,距離閾値をdth2に変更する。
 ステップS406では,閾値変更部109はその時点での距離閾値を維持する。
 上記のように構成した本実施形態においては,侵入禁止領域60に対する1回目の接近ではオペレータが侵入禁止領域60を認識していない可能性があるため,早めの制御介入を実行してフロント作業装置1Aを滑らかに停止させることができる。これによりオペレータに侵入禁止領域60を認識させることができる。また,2回目以降の接近では,オペレータが侵入禁止領域を認識していることを前提に遅めに制御介入することで,違和感の低減と作業効率の向上が実現できる。
 なお,上記では侵入禁止領域60への接近が2回目のときに距離閾値をより近い値(dth2)に変更したが,侵入禁止領域60への接近が2回目以降の任意の回数のときに距離閾値をdth2に変更するように構成しても良い。
 また,上記ではキースイッチがOFF位置からON位置に切り換えられたときに侵入禁止領域60への接近回数をゼロにリセットしたが,その他の任意のタイミングでゼロリセット可能なように構成しても良い。回数をゼロリセットするタイミングは制御コントローラ40で決定しても良いし,オペレータが決定しても良い。
 また,図10のステップS205を追加し,所定時間tjの間に走行レバー23の操作があった場合には,フロント作業装置1Aの侵入禁止領域60への接近回数をゼロにリセットするとともに,距離閾値を初期値dth1にリセットする処理を実行しても良い。
 <その他>
 これまでに説明したいずれの実施形態においても,距離閾値が変更になった場合には,表示制御部77にその情報を出力し,表示装置55を介してオペレータに通達する構成としても良い。また,表示だけではなく,音声による通達を行っても良い。
 また,上記では油圧ショベル1の上方向に設定された侵入禁止領域60へのフロント作業装置1Aの侵入を防ぐ構成について例示したが,油圧ショベル1の横方向に設定された侵入禁止領域60にフロント作業装置1Aの先端が旋回により侵入することを防ぐ構成を採用しても良い。その場合,上部旋回体の慣性の影響を考慮するため,接近度として,侵入禁止領域60に対するフロント作業装置1Aの距離ではなく接触予測時間を用いて動作範囲制限制御を実行しても良い。
 ここで油圧ショベル1の横方向に侵入禁止領域60が設定された場合のフロント作業装置1Aの先端位置の算出について図16及び図17を用いて以下で説明する。図16は侵入禁止領域60に対して上部旋回体12が旋回していない状況(基準状況)を示し,図17は図16の基準状況から上部旋回体12がθswだけ旋回した状況である。
 このとき,バケット10の幅方向の寸法をWbkとすると,旋回中心120に対するバケット10の左端10Lの位置Ybk及び速度VYbkは下記式のように表される。ただし,下記式においてθswの上にドットを付したものはθswの角速度(時間微分値)を示すものとする。
Figure JPOXMLDOC01-appb-M000008
 このように,ショベルの横方向に関しても,位置Ybk及び速度VYbkを算出することが出来る。さらに横方向の侵入禁止領域60に対する距離と接触予測時間についても,前述した上方向の場合(図5,図8参照)と同様に算出することが出来る。
 なお,バケット先端10bやアーム後端部9bの位置や速度の算出はあくまで例として示したものであり,制御対象となる油圧ショベル1の部位はバケット先端10bやアーム後端部9bに限るものではない。例えば,油圧ショベル1の横方向に設定された侵入禁止領域60に上部旋回体12の後端部(すなわち作業機械本体)が旋回により侵入することを防ぐ構成を採用しても良い。その場合,上部旋回体の慣性の影響を考慮するため,接近度として,侵入禁止領域60に対する上部旋回体の距離ではなく接触予測時間を用いて動作範囲制限制御を実行しても良い。
 ここで油圧ショベル1の横方向に侵入禁止領域60が設定された場合の上部旋回体12の左側後端部12BLの位置の算出について図16及び図17を用いて以下で説明する。上部旋回体12の幅方向の寸法をWusと,図16のときの旋回中心120から上部旋回体12の左側後端部12BLまでの角度をθus0とすると,旋回中心120に対する上部旋回体12の左側後端部12BLの位置Yus及び速度VYusは下記式のように表される。ただし,下記式においてθswの上にドットを付したものはθswの角速度(時間微分値)を示すものとする。
Figure JPOXMLDOC01-appb-M000009
 このように,上部旋回体12の左側後端部12BLに関しても位置Yus及び速度VYusを算出できる。さらに横方向の侵入禁止領域60に対する距離と接触予測時間についても,前述した上方向の場合(図5,図8参照)と同様に算出できる。
 なお,本発明は,上記の各実施の形態に限定されるものではなく,その要旨を逸脱しない範囲内の様々な変形例が含まれる。例えば,本発明は,上記の実施の形態で説明した全ての構成を備えるものに限定されず,その構成の一部を削除したものも含まれる。また,ある実施の形態に係る構成の一部を,他の実施の形態に係る構成に追加又は置換することが可能である。
 また,上記の制御装置(制御コントローラ40)に係る各構成や当該各構成の機能及び実行処理等は,それらの一部又は全部をハードウェア(例えば各機能を実行するロジックを集積回路で設計する等)で実現しても良い。また,上記の制御装置に係る構成は,演算処理装置(例えばCPU)によって読み出し・実行されることで当該制御装置の構成に係る各機能が実現されるプログラム(ソフトウェア)としてもよい。当該プログラムに係る情報は,例えば,半導体メモリ(フラッシュメモリ,SSD等),磁気記憶装置(ハードディスクドライブ等)及び記録媒体(磁気ディスク,光ディスク等)等に記憶することができる。
 また,上記の各実施の形態の説明では,制御線や情報線は,当該実施の形態の説明に必要であると解されるものを示したが,必ずしも製品に係る全ての制御線や情報線を示しているとは限らない。実際には殆ど全ての構成が相互に接続されていると考えて良い。
 1A…フロント作業装置,1B…車体,3…走行モータ(アクチュエータ),4…旋回モータ(アクチュエータ),5…ブームシリンダ(アクチュエータ),6…アームシリンダ(アクチュエータ),7…バケットシリンダ(アクチュエータ),8…ブーム,9…アーム,10…バケット,30…ブーム角度センサ(姿勢検出装置),31…アーム角度センサ(姿勢検出装置),32…バケット角度センサ(姿勢検出装置),33…車体傾斜角センサ(姿勢検出装置),40…制御コントローラ,60…侵入禁止領域,93…ROM(記憶装置),94…RAM(記憶装置),104…接近度演算部,108…制御指令部,106…履歴記憶部,109…閾値変更部

Claims (4)

  1.  機械本体に設置された作業装置と,
     前記機械本体及び前記作業装置を駆動する複数のアクチュエータと,
     前記機械本体と前記作業装置の姿勢情報を検出する姿勢検出装置と,
     予め設定された侵入禁止領域と前記作業装置及び前記機械本体との近さを示す指標値である接近度を前記侵入禁止領域の位置情報と前記姿勢情報とに基づいて算出し,前記接近度の閾値として設定された接近度閾値が規定する近さよりも前記接近度が規定する近さの方が近いとき,前記侵入禁止領域への前記作業装置及び前記機械本体の侵入が防止されるように前記複数のアクチュエータの少なくとも1つを減速する動作範囲制限制御を実行する制御装置とを備える作業機械において,
     前記制御装置によって算出された前記接近度の履歴情報が記憶される記憶装置をさらに備え,
     前記制御装置は,前記記憶装置に記憶された前記接近度の履歴情報に基づいて前記接近度閾値を変更することを特徴とする作業機械。
  2.  請求項1の作業機械において,
     前記接近度は,前記作業装置及び前記機械本体と前記侵入禁止領域との距離であり,
     前記制御装置は,前記距離が前記接近度閾値よりも小さいとき前記動作範囲制限制御を実行し,前記距離のばらつきが小さいほど前記接近度閾値を小さい値に設定することを特徴とする作業機械。
  3.  請求項1の作業機械において,
     前記記憶装置には,オペレータによる前記作業機械の操作が可能か否かを示す操作可否情報が記憶されており,
     前記制御装置は,前記操作可否情報に基づいてオペレータによる前記作業機械の操作が一旦不可能になったことが確認したとき,前記接近度閾値を前記侵入禁止領域により近いことを規定する値に変更することを特徴とする作業機械。
  4.  請求項1の作業機械において,
     前記記憶装置には,前記接近度が前記接近度閾値よりも前記侵入禁止領域に近づいた回数が記憶されており,
     前記制御装置は,前記回数が所定の回数に達したとき,前記接近度閾値を前記侵入禁止領域により近いことを規定する値に変更することを特徴とする作業機械。
PCT/JP2019/022688 2018-09-14 2019-06-07 作業機械 WO2020054154A1 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
EP19861087.5A EP3812514B1 (en) 2018-09-14 2019-06-07 Work machine
US17/054,797 US11879233B2 (en) 2018-09-14 2019-06-07 Work machine
CN201980051191.5A CN112513378B (zh) 2018-09-14 2019-06-07 作业机械
KR1020217000365A KR102459283B1 (ko) 2018-09-14 2019-06-07 작업 기계

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2018-171991 2018-09-14
JP2018171991A JP7093277B2 (ja) 2018-09-14 2018-09-14 作業機械

Publications (1)

Publication Number Publication Date
WO2020054154A1 true WO2020054154A1 (ja) 2020-03-19

Family

ID=69777774

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2019/022688 WO2020054154A1 (ja) 2018-09-14 2019-06-07 作業機械

Country Status (6)

Country Link
US (1) US11879233B2 (ja)
EP (1) EP3812514B1 (ja)
JP (1) JP7093277B2 (ja)
KR (1) KR102459283B1 (ja)
CN (1) CN112513378B (ja)
WO (1) WO2020054154A1 (ja)

Families Citing this family (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP3862491B1 (en) * 2018-10-03 2024-04-10 Sumitomo Heavy Industries, Ltd. Excavator
US11851844B2 (en) * 2020-01-21 2023-12-26 Caterpillar Inc. Implement travel prediction for a work machine
US11572671B2 (en) * 2020-10-01 2023-02-07 Caterpillar Sarl Virtual boundary system for work machine
EP4230806A1 (en) * 2020-11-19 2023-08-23 Hitachi Construction Machinery Co., Ltd. Work machine
WO2022208974A1 (ja) * 2021-03-29 2022-10-06 日立建機株式会社 作業機械
CN113250255B (zh) * 2021-06-08 2022-08-19 上海三一重机股份有限公司 一种基于电子围墙的工程机械控制方法、装置及工程机械

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05321290A (ja) 1992-05-19 1993-12-07 Komatsu Ltd 作業機動作範囲制限装置
JPH0971965A (ja) * 1995-09-07 1997-03-18 Hitachi Constr Mach Co Ltd 建設作業機の作業範囲制限装置
JP2010126954A (ja) * 2008-11-26 2010-06-10 Hitachi Constr Mach Co Ltd 油圧ショベルの干渉防止装置
JP2013159930A (ja) 2012-02-02 2013-08-19 Sumitomo Heavy Ind Ltd 周囲監視装置
CN106502137A (zh) * 2016-12-28 2017-03-15 徐工集团工程机械有限公司 伸缩设备的控制***、方法和伸缩设备

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08291532A (ja) * 1995-04-21 1996-11-05 Sumitomo Constr Mach Co Ltd 建設機械の作業機干渉防止装置
US5553407A (en) * 1995-06-19 1996-09-10 Vermeer Manufacturing Company Excavator data acquisition and control system and method of use
JP3679848B2 (ja) * 1995-12-27 2005-08-03 日立建機株式会社 建設機械の作業範囲制限制御装置
JP3694411B2 (ja) 1998-12-01 2005-09-14 日立建機株式会社 建設機械の作業機干渉防止装置
JP2001064992A (ja) * 1999-08-31 2001-03-13 Sumitomo Constr Mach Co Ltd 油圧掘削機等の建設機械における干渉防止装置
US6437726B1 (en) * 2000-11-30 2002-08-20 Caterpillar Inc. Method and apparatus for determining the location of underground objects during a digging operation
US7516563B2 (en) * 2006-11-30 2009-04-14 Caterpillar Inc. Excavation control system providing machine placement recommendation
JP2008255597A (ja) 2007-04-02 2008-10-23 Hitachi Constr Mach Co Ltd 作業機械
JP6029992B2 (ja) 2013-01-29 2016-11-24 住友建機株式会社 建設機械の干渉防止装置
JP6587898B2 (ja) 2015-10-22 2019-10-09 株式会社神戸製鋼所 建設機械の干渉防止装置
JP6706094B2 (ja) 2016-02-29 2020-06-03 株式会社小松製作所 作業機械および作業機械の干渉回避方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05321290A (ja) 1992-05-19 1993-12-07 Komatsu Ltd 作業機動作範囲制限装置
JPH0971965A (ja) * 1995-09-07 1997-03-18 Hitachi Constr Mach Co Ltd 建設作業機の作業範囲制限装置
JP2010126954A (ja) * 2008-11-26 2010-06-10 Hitachi Constr Mach Co Ltd 油圧ショベルの干渉防止装置
JP2013159930A (ja) 2012-02-02 2013-08-19 Sumitomo Heavy Ind Ltd 周囲監視装置
CN106502137A (zh) * 2016-12-28 2017-03-15 徐工集团工程机械有限公司 伸缩设备的控制***、方法和伸缩设备

Non-Patent Citations (1)

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

Also Published As

Publication number Publication date
JP2020041388A (ja) 2020-03-19
JP7093277B2 (ja) 2022-06-29
CN112513378A (zh) 2021-03-16
EP3812514A1 (en) 2021-04-28
KR102459283B1 (ko) 2022-10-27
EP3812514A4 (en) 2022-03-02
US20210230837A1 (en) 2021-07-29
CN112513378B (zh) 2022-09-30
US11879233B2 (en) 2024-01-23
KR20210018451A (ko) 2021-02-17
EP3812514B1 (en) 2023-05-10

Similar Documents

Publication Publication Date Title
WO2020054154A1 (ja) 作業機械
KR102399329B1 (ko) 작업 기계
JP7117843B2 (ja) 作業機械
JP6889579B2 (ja) 作業機械
JP6860329B2 (ja) 作業機械
KR20180104042A (ko) 작업 기계
JP6957081B2 (ja) 作業機械
JP6752193B2 (ja) 作業機械
KR20180103967A (ko) 작업 기계
JP6964109B2 (ja) 作業機械
KR102602948B1 (ko) 작업 기계
WO2021186517A1 (ja) 作業機械
KR20210031744A (ko) 유압 셔블
JP7278190B2 (ja) 侵入監視制御システムおよび作業機械
JP7149917B2 (ja) 作業機械
JP6860471B2 (ja) 作業機械
CN118401721A (en) Work machine and control method for work machine
KR20240095459A (ko) 작업 기계 및 작업 기계의 제어 방법
JP2023133701A (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: 19861087

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2019861087

Country of ref document: EP

Effective date: 20201130

ENP Entry into the national phase

Ref document number: 20217000365

Country of ref document: KR

Kind code of ref document: A

ENP Entry into the national phase

Ref document number: 2019861087

Country of ref document: EP

Effective date: 20201130

NENP Non-entry into the national phase

Ref country code: DE