Control device, control method, and work machine
Patent Information
- Authority / Receiving Office
- US · United States
- Patent Type
- Applications(United States)
- Current Assignee / Owner
- KOMATSU LTD
- Filing Date
- 2024-03-04
- Publication Date
- 2026-08-06
Smart Images

Figure US20260226701A1-D00000_ABST
Abstract
Description
TECHNICAL FIELD
[0001] The present disclosure relates to a control device, a control method, and a work machine.
[0002] The present application claims priority based on JP 2023-056911, filed in Japan on Mar. 31, 2023, the content of which is incorporated herein by reference.BACKGROUND ART
[0003] Patent Document 1 describes a control device for a loading machine including a revolving body and a work implement, and the control device is able to automate movement of the work implement between a loading position and an excavation position.CITATION LISTPatent Literature
[0004] Patent Document 1: JP 2020-41352 ASUMMARY OF INVENTIONTechnical Problem
[0005] In the control device that is able to automate the movement of the work implement between the loading position and the excavation position, the operation of autonomous driving is performed on the basis of a signal from a switch operated by an operator. In a case where the number of operations of autonomous driving increases, switches corresponding to the automatic operations need to be provided, which creates a difficulty in securing the installation space. In addition, in a case where the number of switches increases, this requires an operator to reliably operate these switches, which deteriorates usability and leads to a deterioration in productivity.
[0006] The present disclosure has been made in view of the circumstance described above, and an object of the present disclosure is to provide a control device, a control method, and a work machine that make it possible to improve usability.Solution to Problem
[0007] One aspect of the present disclosure provides a control device of a work machine including a revolving body configured to revolve around a revolution center, and a work implement including a work tool and attached to the revolving body, in which, in a case where an instruction signal outputted from an operation unit and concerning an automatic operation including the work implement is inputted, the control device determines an automatic operation that is able to be performed from among a plurality of automatic operations, on a basis of information concerning the work tool, and performs the automatic operation determined to be able to be performed.
[0008] One aspect of the present disclosure provides a control method for a work machine including a revolving body configured to revolve around a revolution center, and a work implement including a work tool and attached to the revolving body, the control method including: in a case where an instruction signal outputted from an operation unit and concerning an automatic operation including the work implement is inputted, determining an automatic operation that is able to be performed from among a plurality of automatic operations, on a basis of information concerning the work tool; and performing the automatic operation determined to be able to be performed.
[0009] One aspect of the present disclosure provides a work machine including a revolving body configured to revolve around a revolution center, a work implement including a work tool and attached to the revolving body, and a control device configured to control the revolving body and the work implement, in which, in a case where an instruction signal outputted from an operation unit and concerning an automatic operation including the work implement is inputted, the control device determines an automatic operation that is able to be performed from among a plurality of automatic operations, on a basis of information concerning the work tool, and performs the automatic operation determined to be able to be performed.Advantageous Effects of Invention
[0010] The control device, the control method, and the work machine according to the present disclosure make it possible to improve usability.BRIEF DESCRIPTION OF DRAWINGS
[0011] FIG. 1 is a schematic view illustrating the configuration of a work machine according to an embodiment of the present disclosure.
[0012] FIG. 2 is a diagram illustrating the configuration of the inside of a cab according to the embodiment of the present disclosure.
[0013] FIG. 3 is a block diagram showing an example of the configuration of a control system according to the embodiment of the present disclosure.
[0014] FIG. 4 is a schematic view used to explain an operation example of a control device according to the embodiment of the present disclosure.
[0015] FIG. 5 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
[0016] FIG. 6 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
[0017] FIG. 7 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
[0018] FIG. 8 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
[0019] FIG. 9 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
[0020] FIG. 10 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
[0021] FIG. 11 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
[0022] FIG. 12 is a flowchart showing an operation example of the control device according to the embodiment of the present disclosure.
[0023] FIG. 13 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
[0024] FIG. 14 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
[0025] FIG. 15 is a flowchart showing an operation example of the control device according to the embodiment of the present disclosure.
[0026] FIG. 16 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
[0027] FIG. 17 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
[0028] FIG. 18 is a flowchart showing an operation example of the control device according to the embodiment of the present disclosure.
[0029] FIG. 19 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
[0030] FIG. 20 is a flowchart showing an operation example of the control device according to the embodiment of the present disclosure.
[0031] FIG. 21 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
[0032] FIG. 22 is a flowchart showing an operation example of the control device according to the embodiment of the present disclosure.
[0033] FIG. 23 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
[0034] FIG. 24 is a flowchart showing an operation example of the control device according to the embodiment of the present disclosure.
[0035] FIG. 25 is a flowchart showing an operation example of the control device according to the embodiment of the present disclosure.
[0036] FIG. 26 is a flowchart showing an operation example of the control device according to the embodiment of the present disclosure.
[0037] FIG. 27 is a flowchart showing an operation example of the control device according to the embodiment of the present disclosure.DESCRIPTION OF EMBODIMENTS
[0038] Hereinafter, with reference to the drawings, embodiments of the present disclosure are described. Note that the same or corresponding configurations in the respective drawings are denoted with the same reference symbols, and the description thereof is omitted as appropriate. FIG. 1 is a schematic view illustrating the configuration of a work machine according to an embodiment of the present disclosure. FIG. 2 is a diagram illustrating the configuration of the inside of a cab according to the embodiment of the present disclosure. FIG. 3 is a block diagram showing an example of the configuration of a control system according to the embodiment of the present disclosure. FIGS. 4 to 11 are schematic views each used to explain an operation example of a control device according to the embodiment of the present disclosure. FIGS. 12, 15, 18, 20, 22, and FIGS. 24 to 27 are flowcharts each showing an operation example of the control device according to the embodiment of the present disclosure. FIGS. 13, 14, 16, 17, 19, 21, and 23 are schematic views each used to explain an operation example of the control device according to the embodiment of the present disclosure.Configuration of Work Machine 100FIG. 1 illustrates the configuration of a work machine 100 according to the embodiment of the present disclosure. The work machine 100 operates at a working site, and works for a work target such as earth or sand. The work machine 100 according to the embodiment of the present disclosure is, for example, a hydraulic excavator. However, there is no limitation as to the work machine according to the present disclosure as long as it is a work machine including a revolving body and a work implement being actuators, for example, and may be other work machines such as a face excavator or a rope excavator or the like, for example. In addition, the work machine according to the present disclosure is not limited to a machine that hydraulically operates, and may be a work machine including an actuator that electrically operates. The work machine 100 includes a traveling body 110, a revolving body 120, a work implement 130, and a cab 140.
[0040] The traveling body 110 supports the work machine 100 so that the work machine 100 can travel. The traveling body 110 includes two crawlers 111 provided at the left and right, and two travel motors 112 used to drive the individual crawlers 111. The revolving body 120 is supported by the traveling body 110 so as to be rotatable about a revolution center.
[0041] The work implement 130 is driven by hydraulic pressure. The work implement 130 is supported at a front portion of the revolving body 120 so as to be drivable in an up-down direction. The cab 140 is a space where an operator rides and operates the work machine 100.
[0042] The cab 140 is provided in a left front portion of the revolving body 120. Note that, in the present embodiment, the up-down direction (Z direction), the left-right direction (Y direction), and the front-rear direction (X direction) are set with the revolving body 120 being the reference, as illustrated in FIG. 1. In the present embodiment, this coordinate system is referred to as an excavator coordinate system. In addition, a portion of the revolving body 120 where the work implement 130 is attached is referred to as a front portion. Further, in the revolving body 120, with reference to the front portion, a portion on a side opposite thereto is referred to as a rear portion, a portion on the left side is referred to as a left portion, and a portion on the right side is referred to as a right portion.Configuration of Revolving Body 120
[0043] The revolving body 120 includes an engine 121, a hydraulic pump 122, an electromagnetic proportional control (EPC) valve 123-1, a main valve 123-2, a revolution motor 124, and a fuel injection device 125. The engine 121 is a prime mover that drives the hydraulic pump 122. The engine 121 is an example of a power source. A self-starting motor 1211 is provided at the engine 121. The engine 121 is started by the rotation of the self-starting motor 1211. The EPC valve 123-1 controls hydraulic oil flowing through the main valve 123-2 on the basis of an operation instruction signal outputted by a control device61.
[0044] The hydraulic pump 122 is a variable displacement pump driven by the engine 121. The hydraulic pump 122 supplies each actuator with hydraulic oil through the main valve 123-2. Each actuator includes a boom cylinder 131C, an arm cylinder 132C, a bucket cylinder 133C, a travel motor 112, and a revolution motor 124. The main valve 123-2 is configured to control the flow rate of hydraulic oil supplied from the hydraulic pump 122.
[0045] The revolution motor 124 drives with hydraulic oil supplied from the hydraulic pump 122 through the main valve 123-2 to cause the revolving body 120 to revolve around a revolution axis 120C (revolution center). The fuel injection device 125 injects the fuel into the engine 121.Configuration of Work Implement 130
[0046] The work implement 130 includes a boom 131, an arm 132, a bucket 133, the boom cylinder 131C, the arm cylinder 132C, and the bucket cylinder 133C. Note that the boom cylinder 131C, the arm cylinder 132C, and the bucket cylinder 133C are included in a cylinder 130C illustrated in FIG. 3. Note that, in the present embodiment, the bucket 133 serves as one configuration example of a “work tool” according to the present disclosure. In addition to the bucket, a tilt rotator, a quick coupler, a grapple, a magnet, a breaker, or the like may be attached as the work tool that is an attachment. These also serve as an example of the “work tool” according to the present disclosure.
[0047] A base end portion of the boom 131 is attached to the revolving body 120 through a boom pin. The arm 132 couples the boom 131 and the bucket 133. A base end portion of the arm 132 is attached to the distal end portion of the boom 131 through an arm pin. The bucket 133 includes a blade for excavating earth and sand or the like, and an accommodation portion for holding the excavated earth and sand. A base end portion of the bucket 133 is attached to the distal end portion of the arm 132 through a bucket pin 133P.
[0048] The boom cylinder 131C is a hydraulic cylinder for actuating the boom 131. A base end portion of the boom cylinder 131C is attached to the revolving body 120. A distal end portion of the boom cylinder 131C is attached to the boom 131. The arm cylinder 132C is a hydraulic cylinder for driving the arm 132. A base end portion of the arm cylinder 132C is attached to the boom 131. A distal end portion of the arm cylinder 132C is attached to the arm 132. The bucket cylinder 133C is a hydraulic cylinder for driving the bucket 133. A base end portion of the bucket cylinder 133C is attached to the arm 132. The distal end portion of the bucket cylinder 133C is attached to a link member coupled to the bucket 133.Configuration of Cab 140
[0049] FIG. 2 illustrates the configuration of the inside of the cab 140 according to the embodiment of the present disclosure. An operator seat 142, an operation device 143, and the like are provided in the cab 140.
[0050] The operation device 143 is a device used to drive the traveling body 110, the revolving body 120, and the work implement 130 through a manual operation by an operator, set various types of setting values, change these values, or provide the operator with information. The operation device 143 includes a lever, a switch, and a pedal, for example. The operation device 143 includes a left operation lever 143LO, a right operation lever 143RO, a left foot pedal 143LF, a right foot pedal 143RF, a left travel lever 143LT, a right travel lever 143RT, and a display input device 143D. Note that, in the present embodiment, the switch is a constituent component that generates or changes a predetermined signal through an operation by an operator. In the present embodiment, the switch serves as one configuration example of an “operation unit” in the present disclosure. For the switch, it may be possible to use various types of switches such as a push button switch, a rocker switch, or a toggle switch, for example. In addition, it is only necessary that the switch is provided within a range in which the operator can operate. The switch is provided at or around an operator seat provided in the cab 140, in a remote operation room, or the like. For example, the switch may be provided in a console at the side of the operator seat 142, a transmitter that outputs an operation instruction to the work machine 100 from the outside of the work machine 100, or the like.
[0051] The left operation lever 143LO is provided at the left side of the operator seat 142. The right operation lever 143RO is provided at the right side of the operator seat 142.
[0052] The left operation lever 143LO is an operation mechanism for performing an operation of revolving the revolving body 120 and an operation of excavation / dumping by the arm 132. Specifically, when an operator of the work machine 100 tilts the left operation lever 143LO in a forward direction, the arm 132 performs the dumping operation. In addition, when the operator of the work machine 100 tilts the left operation lever 143LO in a rearward direction, the arm 132 performs the excavation operation. Furthermore, when the operator of the work machine 100 tilts the left operation lever 143LO in a rightward direction, the revolving body 120 revolves to the right. In addition, when the operator of the work machine 100 tilts the left operation lever 143LO in a leftward direction, the revolving body 120 revolves to the left. Note that, in another embodiment, it may be possible to employ a configuration in which, when the left operation lever 143LO is tilted in the front-rear direction, the revolving body 120 revolves to the right or to the left, and when the left operation lever 143LO is tilted in the left-right direction, the arm 132 performs the excavation operation or the dumping operation. An operation switch 1433 is provided at the left operation lever 143LO. Note that the operation switch 1433 is provided at the upper portion of or a side portion of the left operation lever 143LO. It may be possible to employ a configuration in which a horn is blown when the operation switch 1433 turns ON, for example.
[0053] The right operation lever 143RO is an operation mechanism for performing the excavation / dumping operation of the bucket 133 and a lifting / lowering operation of the boom 131. Specifically, when the operator of the work machine 100 tilts the right operation lever 143RO in the forward direction, the lowering operation of the boom 131 is performed. In addition, when the operator of the work machine 100 tilts the right operation lever 143RO in the rearward direction, the lifting operation of the boom 131 is performed. Furthermore, when the operator of the work machine 100 tilts the right operation lever 143RO in the rightward direction, the dumping operation of the bucket 133 is performed. In addition, when the operator of the work machine 100 tilts the right operation lever 143RO in the leftward direction, the excavating operation of the bucket 133 is performed. Note that, in another embodiment, it may be possible to employ a configuration in which, when the right operation lever 143RO is tilted in the front-rear direction, the bucket 133 performs the dumping operation or the excavating operation, and when the right operation lever 143RO is tilted in the left-right direction, the boom 131 performs the lifting operation or the lowering operation. Operation switches 1431 and 1432 are provided at the right operation lever 143RO, for example. In the present embodiment, a function as a teaching switch is set to the operation switch 1431, and a function as an automation starting switch is set to the operation switch 1432 (hereinafter, each of these switches is also referred to as a teaching switch 1431 and an automation starting switch 1432 (or simply each referred to as a “switch”)). The operation switches 1431 and 1432 are provided at the upper portion of or a side portion of the right operation lever 143RO. Note that the teaching switch and the automation starting switch each serve as one example of a switch for automatic control. For example, when the automation starting switch 1432 is turned ON, the automation starting switch 1432 outputs, to the control device 61, an instruction signal that starts an automatic operation including the work implement 130. In addition, the switch is not limited to a signal concerning start of an automatic operation, and is only necessary to be a signal concerning an automatic operation. For example, the switch may be a switch that outputs a signal that stops the automatic operation, for example. Furthermore, for example, the allocation of functions of the switch is not limited to automatic control for loading revolution and returning revolution, and the switch may be allocated to automatic control such as automatic soil removal in which a soil removal operation is automatically performed using the bucket 133, or automatic excavation in which an excavating operation is automatically performed. For example, it may be possible to employ a configuration in which autonomous driving of automatic excavation, loading revolution, returning revolution, and automatic soil removal are allocated to two or more switches. In addition, it may be possible to employ a configuration in which a plurality of switches are provided at one operation lever and autonomous driving is allocated to each of the plurality of switches, or a configuration in which one or a plurality of switches are provided separately at each of a plurality of operation levers.
[0054] The left foot pedal 143LF is disposed on the left side of a floor surface in front of the operator seat 142. The right foot pedal 143RF is disposed on the right side of the floor surface in front of the operator seat 142. The left travel lever 143LT is pivotally supported by the left foot pedal 143LF and is configured so that the tilting of the left travel lever 143LT and a depression of the left foot pedal 143LF are interlocked with each other. The right travel lever 143RT is pivotally supported by the right foot pedal 143RF and is configured so that the tilting of the right travel lever 143RT and a depression of the right foot pedal 143RF are interlocked with each other.
[0055] The left foot pedal 143LF and the left travel lever 143LT correspond to rotational driving of a left-side crawler of the traveling body 110. Specifically, when the operator of the work machine 100 tilts the left foot pedal 143LF or the left travel lever 143LT in the forward direction, the left-side crawler rotates in the forward traveling direction. Furthermore, when the operator of the work machine 100 tilts the left foot pedal 143LF or the left travel lever 143LT in the rearward direction, the left-side crawler rotates in the rearward traveling direction.
[0056] The right foot pedal 143RF and the right travel lever 143RT correspond to rotational driving of a right-side crawler of the traveling body 110. Specifically, when the operator of the work machine 100 tilts the right foot pedal 143RF or the right travel lever 143RT in the forward direction, the right-side crawler rotates in a forward traveling direction. In addition, when the operator of the work machine 100 tilts the right foot pedal 143RF or the right travel lever 143RT in the rearward direction, the right-side crawler rotates in the rearward traveling direction.
[0057] The display input device 143D is a device in which a display device and a sensor configured to sense a touch operation to the display screen are combined together. For example, by using the display input device 143D, an operator is able to set various types of setting values or the like, or change the setting values. Note that the display input device 143D may be configured such that the display device including a displaying unit and an input unit including a switch or the like for inputting an instruction operation from the operator are separately provided.Sensor or the Like
[0058] As illustrated in FIG. 3, a control system 60 of the work machine 100 includes the control device 61, the operation device 143, and various types of sensors. Note that, in FIG. 3, the circuits of hydraulic pressure systems are illustrated as thick lines. In the example illustrated in FIG. 3, the control system 60 includes an attitude angle sensor 151, a global navigation satellite system (GNSS) sensor 152, and an inertial measurement unit (IMU) 153.
[0059] The attitude angle sensor 151 includes a boom attitude angle sensor, an arm attitude angle sensor, and a bucket attitude angle sensor. The boom attitude angle sensor measures an attitude angle of the boom cylinder 131C. The arm attitude angle sensor measures an attitude angle of the arm cylinder 132C. The bucket attitude angle sensor measures an attitude angle of the bucket cylinder 133C.
[0060] The GNSS sensor 152 calculates a position of the revolving body 120 and a direction toward which the revolving body 120 is directed. The GNSS sensor 152 includes two receiving units 161 and 162 (see FIG. 1) configured to receive a position determination signal from an artificial satellite that constitutes the GNSS. The two receiving units 161 and 162 are each disposed at different positions of the revolving body 120. The GNSS sensor 152 detects the position of the representative points (original point of the excavator coordinate system) of the revolving body 120 in the construction-site coordinate system, on the basis of the position determination signals that the receiving units 161 and 162 receive. The GNSS sensor 152 uses each of the position determination signals that the two receiving units 161 and 162 receive to calculate the azimuth angle at which the revolving body 120 is directed, as a relationship of the position where one of the receiving units is disposed, relative to the position where the other one of the receiving units is disposed. The azimuth angle (also referred to as “vehicle body azimuth angle”) at which the revolving body 120 is directed is equal to a horizontal component of an extending direction of a straight line extending from the boom 131 of the work implement 130 toward the bucket 133, the extending direction being the front direction (X direction) of the revolving body 120.
[0061] The IMU 153 measures the acceleration and the angular velocity of the revolving body 120, and detects the attitude (for example, the roll angle and the pitch angle) of the revolving body 120 on the basis of the result of detection. The IMU 153 is disposed at the lower surface of the revolving body 120, for example.
[0062] Note that examples of other sensors of the work machine 100 include a stereo camera, a light detection and ranging (LiDAR) device, a laser scanner, or the like. These sensors are provided such that the direction of detection is directed toward the forward direction of the cab 140 of the work machine 100, for example. These sensors identify three-dimensional positions of a target object in a coordinate system with the position of each of the sensors being the reference. Note that these sensors may be provided at either the left side or the right side of or at both sides of the work machine 100 so as to be directed toward the side direction of the work machine 100.
[0063] In addition, the work machine 100 includes, for example, a near-field communication device used to perform vehicle-to-vehicle communication with other surrounding vehicles or the like, a movable-body communication device used to connect and communicate with a server at a remote area and the like, and the like.Basic Operation of Control Device
[0064] First, the basic operation of the control device 61 according to the embodiment of the present disclosure will be described with reference to FIGS. 4 to 11. Note that, in the present embodiment, the “loading revolution” represents a revolving operation in which, from a state where the bucket 133 is positioned at the outer side of the loading target due to excavation of the excavation target, the bucket 133 is caused to revolve up to a direction directed at the loading target while the boom 131 is being automatically lifted, and move to a soil removal point. In addition, the “returning revolution” represents an operation in which, from a state where the bucket 133 is positioned above the loading target due to loading, the bucket 133 is caused to revolve up to a predetermined direction while the boom 131 is being automatically lowered, and move to an excavation starting point. The “loading revolution” and the “returning revolution” are operations that automatically change the work implement 130 and the revolving body 120, and each serve as one example of the “automatic operation including the work implement” according to the present disclosure. Note that, as one example of the automatic operation, it may be possible to including an automatic operation of either the work implement 130 or the revolving body 120. The soil removal point represents a target point at which loading or the like is targeted, and is set, for example, to a loading platform of a dump truck serving as a transporting vehicle, or an inserting port of a soil recycler, a hopper, or the like. However, it is not limited to these, and in a case where the excavated earth and sand or the like are moved on the other grounds, it may be possible to set this movement destination as the soil removal point. In the present disclosure, the soil removal point serves as one example of a first target point (hereinafter, also referred to as a loading revolution target point TLP) corresponding to an unloading target position of the bucket 133 or the like. Furthermore, the excavation starting point is a point at which an automatic returning operation is targeted after completion of the soil removal, and is set, for example, to a point at which excavation is started. In the present disclosure, the excavation starting point serves as one example of a second target point (hereinafter, also referred to as a returning revolution target point TRP) corresponding to a loading target position of the bucket 133 or the like. Note that, in the present embodiment, the soil removal point (loading revolution target point TLP), the excavation starting point (returning revolution target point TRP), and an interference avoiding point, which will be described later, are each referred to as a reference point when these points are collectively mentioned. In addition, in the present embodiment, a portion of the work machine 100 that corresponds to the reference point is a bucket pin 133P. The control device 61 controls the position of the bucket pin 133P with the position of each of the reference points being the target value. Furthermore, the loading revolution target point TLP and the returning revolution target point TRP are each collectively referred to as a target point when these points are collectively mentioned.
[0065] FIG. 4 schematically illustrates a series of flows of manual excavation, loading revolution, manual soil removal, and returning revolution. First, as illustrated at the top left of FIG. 4, the work machine 100 performs manual excavation by an operator to load a load such as earth and sand in the bucket 133. After this, when the operator operates the automation starting switch 1432, the loading revolution is started as illustrated at the top right of FIG. 4, and the bucket 133 (bucket pin 133P) automatically revolves up to the loading revolution target point TLP through the combined operation of the work implement 130 and the revolving body 120. At the loading revolution target point TLP, the operator causes the manual soil removal to be performed to perform soil removal of earth and sand in the bucket 133 (bottom right of FIG. 4). After completion of the soil removal, when the operator operates the automation starting switch 1432, the returning revolution is started as illustrated at the bottom left of FIG. 4, and the bucket 133 (bucket pin 133P) automatically revolves up to the returning revolution target point TRP through the combined operation of the work implement 130 and the revolving body 120.
[0066] Note that, in the example illustrated in FIGS. 2 and 3, one automation starting switch 1432 is provided so as to be common to the loading revolution and the returning revolution. However, it may be possible to use two or more switches. For example, two independent automation starting switches may be provided such that the automation starting switch 1432 (hereinafter, also referred to as a loading revolution automation starting switch 1432) illustrated in FIG. 2 is set as an automation starting switch for loading revolution, and an automation starting switch 1433 (hereinafter, also referred to as a returning revolution automation starting switch 1433) illustrated in FIG. 2 is set as an automation starting switch for returning revolution. It may be possible that an operator can set the way of providing switches on an as-appropriate basis. Note that it may be possible to employ a configuration in which the operation switch 1433 is used as a horn, and the third operation switch is provided as an automation starting switch for the returning revolution, and is provided at either the left or right operation lever 143LO or 143RO.
[0067] Next, an interference avoiding point EVP will be described with reference to FIG. 5. FIG. 5 schematically illustrates a positional relationship between the work machine 100 and a dump truck 200 serving as a loading target for loading of earth and sand or the like. The dump truck 200 includes a cab 201, a loading platform 202, and a side plate 203. In the example illustrated in FIG. 5, the work machine 100 moves the bucket 133 (133a) positioned at the automatic revolution starting point (SP) at the time of operation to the automation starting switch 1432 due to the loading revolution through the interference avoiding point (EVP) to the loading revolution target point (TLP). The attitude of the bucket 133 (133b) at the time of arrival at the loading revolution target point (TLP) is a holding attitude (also referred to as a loading attitude in the present embodiment). Here, the operator sets the attitude of the bucket 133 to a dumping attitude (also referred to as an unloading attitude in the present embodiment) (bucket 133 (133c)), and performs the soil removal. Here, the interference avoiding point (EVP) is a point (positional information) indicating a boundary of areas set such that the bucket 133 does not hit against the loading platform 202 or the like of the dump truck 200 during the loading operation (loading revolution). In the present embodiment, only the revolving operation of the revolving body 120 is performed at the soil removal point side (loading revolution target point TLP side) of this boundary. The interference avoiding point (EVP) can be set on the basis of teaching in which the operator actually operates the work implement 130 to set the position and the attitude, for example. At this time, the interference avoiding point (EVP) is set with a certain margin in the vertical direction and the horizontal direction for the interference avoiding point (teaching position) that the operator registers, as illustrated in FIG. 5, for example. Note that the automatic revolution starting point (SP) is a position of the bucket pin 133P when the loading revolution or the returning revolution starts, and is a position when the operator operates the automation starting switch 1432. In addition, hereinafter, the automatic revolution starting point (SP) is also referred to as a starting point. Note that the automatic revolution starting point (SP) may be a certain specific position of the work implement 130 when the loading revolution or the returning revolution starts, and may be a position of the left-right end of the bucket 133 or a position of the blade edge, for example.
[0068] FIG. 6 illustrates an example of change in the revolution angle and the height of the bucket pin 133P in the loading revolution. The horizontal axis indicates the revolution angle, and the vertical axis indicates the height of the bucket pin. In FIG. 6, the revolution angle of the automatic revolution starting point (SP) is indicated as the starting angle, the revolution angle of the interference avoiding point (EVP) is indicated as the interference avoiding point angle, and the revolution angle of the loading revolution target point (TLP) is indicated as the target angle. In addition, the height of the automatic revolution starting point (SP) is indicated as the starting height, the height of the interference avoiding point (EVP) is indicated as the height of the interference avoiding point, and the height of the loading revolution target point (TLP) is indicated at the target height. Furthermore, the interference region between the bucket 133 and the dump truck 200 is shown by hatching. In the example illustrated in FIG. 6, control for the revolving body 120 and control for the work implement 130 are performed in parallel from the automatic revolution starting point (SP) until the bucket pin 133P reaches the interference avoiding point (EVP), whereby the height of the bucket pin 133P reaches the height of an interference starting point before the revolution angle reaches the interference avoiding point angle. In addition, after the bucket pin 133P reaches the interference avoiding point (EVP), the revolution angle reaches the target angle due to alone control for the revolving body 120. In the operation of the loading revolution, a revolution region in which the revolving body 120 and the boom 131 operate at the same time is included. The operation of the boom 131 in the loading revolution may include lifting the boom or lowering the boom. For example, in a case where the height of the automatic revolution starting point (SP) is higher than the height of the interference avoiding point (EVP), the operation of the boom 131 in the loading revolution may be a boom lowering operation.
[0069] FIGS. 7 and 8 each illustrate changes in the revolution angle and the height of the bucket pin 133P in the returning revolution. FIG. 7 illustrates an example in a case where the height of the automatic revolution starting point (SP) is equal to the height of the interference avoiding point (EVP). FIG. 8 illustrates an example in a case where the height of the automatic revolution starting point (SP) is lower than the height of the interference avoiding point (EVP). In the example illustrated in FIG. 7, the height of the bucket pin 133P is maintained at the starting height until the bucket pin 133P reaches the interference avoiding point (EVP), and the revolution angle changes from the starting angle to the interference avoiding point angle due to the alone control for the revolving body 120. Then, after the bucket pin 133P reaches the interference avoiding point (EVP), control for the revolving body 120 and control for the work implement 130 are performed in parallel, whereby both the height of the bucket pin 133P and the revolution angle change to the target height and the target angle. In addition, in the example illustrated in FIG. 8, until the height of the bucket pin 133P reaches the height of the interference avoiding point, the height of the bucket pin 133P changes due to the alone control for the work implement 130. After the height of the bucket pin 133P reaches the height of the interference avoiding point, the height of the bucket pin 133P is maintained at the starting height until the bucket pin 133P reaches the interference avoiding point (EVP), and the revolution angle changes from the starting angle to the interference avoiding point angle due to the alone control for the revolving body 120. Then, after the bucket pin 133P reaches the interference avoiding point (EVP), control for the revolving body 120 and control for the work implement 130 are performed in parallel, whereby both the height of the bucket pin 133P and the revolution angle change to the target height and the target angle. Note that, in the present embodiment, the returning revolution is controlled such that the attitude of the work implement 130 (the attitude of the bucket 133) reaches the target attitude before arrival at the target angle and the target height. A revolution region in which the revolving body 120 and the boom 131 are operated at the same time is included in the operation of the returning revolution. The operation of the boom 131 in the returning revolution may include lowering of the boom or may include a boom lifting operation. For example, in a case where the target height is higher than the height of the interference avoiding point (EVP), the operation of the boom 131 in the returning revolution may be the boom lifting operation.
[0070] FIG. 9 indicates an example in which an operation example in the loading revolution is illustrated using a perspective view. Note that, in addition to the side plate 203, the dump truck 200 includes a side guard plate (spreading preventing device) 204, and also includes a hinge 205. The side guard plate 204 or the hinge 205 serves as an example of an interfering object. In the example illustrated in FIG. 9, the path of the bucket pin 133P extends from the automatic revolution starting point (SP) to the interference avoiding point (EVP) due to an operation (hereinafter, referred to as a combined operation) of both the work implement 130 and the revolving body 120, and continues from the interference avoiding point (EVP) to the loading revolution target point (TLP) due to the alone operation of the revolving body 120.
[0071] FIG. 10 indicates an example in which an operation example in the returning revolution is illustrated using a perspective view. In the example illustrated in FIG. 10, the height of the automatic revolution starting point (SP) is higher than the height of the interference avoiding point (EVP). In addition, the automatic revolution starting point (SP) and the interference avoiding point (EVP) differ in their positions. In this case, in the present embodiment, avoiding the interference with an interfering object is achieved with the reference being a perpendicular plane (interference avoiding vertical plane (VS)) including the revolution axis 120C of the revolving body 120 and the interference avoiding point (EVP). Note that, in the present embodiment, the interference avoiding vertical plane (VS) and an interference avoiding flat plane (HS) are collectively referred to as an interference avoiding plane. In this example, the path of the bucket pin 133P extends from the automatic revolution starting point (SP) until the bucket pin 133P passes through the interference avoiding vertical plane (VS) due to the alone operation of the revolving body 120, and after passing through the interference avoiding vertical plane (VS), continues up to the returning revolution target point (TRP) due to the combined operation of the work implement 130 and the revolving body 120.
[0072] FIG. 11 indicates an example in which an operation example in the returning revolution is illustrated using a perspective view. In the example illustrated in FIG. 11, the height of the automatic revolution starting point (SP) is lower than the height of the interference avoiding point (EVP). In addition, the automatic revolution starting point (SP) and the interference avoiding point (EVP) differ in their positions. In this case, in the present embodiment, the work implement 130 is controlled until the height of the bucket pin 133P is equal to or higher than the height of the interference avoiding flat plane (HS) with the reference being a horizontal flat plane (interference avoiding flat plane (HS)) including the interference avoiding point (EVP). After this, as with the example illustrated in FIG. 10, avoiding the interference with an interfering object is achieved with the reference being the interference avoiding vertical plane (VS). In this example, the path of the bucket pin 133P extends so as to ascend from the automatic revolution starting point (SP) until the bucket pin 133P reaches the interference avoiding flat plane (HS), then extends due to the alone operation of the revolving body 120 until passing through the interference avoiding vertical plane (VS), and after passing through the interference avoiding vertical plane (VS), continues up to the returning revolution target point (TRP) due to the combined operation of the work implement 130 and the revolving body 120.Configuration of Control Device
[0073] As illustrated in FIG. 3, the control device 61 can be configured by using, for example, a computer such as a micro-controller, and includes an automatic revolution control unit 62, a storage unit 63, and an operation instruction switching unit 64 as a functional configuration including a combination or the like of hardware such as a computer, peripheral devices of the computer, a peripheral circuit, and software such as a program or the like that this computer executes. In addition, the automatic revolution control unit 62 includes an information input-output unit 621, a reference point setting unit 622, a revolution direction setting unit 623, a starting instruction receiving unit 624, an operation instruction switching control unit 625, and an operation instruction signal generating unit 626. Furthermore, the storage unit 63 holds information 631 or the like indicating the targeted work implement attitude and vehicle body azimuth angle (the soil removal target point, the interference avoiding point, and the excavation starting point).
[0074] The automatic revolution control unit 62 generates an operation instruction signal (automatic), and outputs it to the EPC valve 123-1 through the operation instruction switching unit 64 to drive the revolving body 120 and the work implement 130. Note that an actuator that performs an automatic operation with an operation instruction signal generated by the control device 61 regardless of the operation made by an operator is an actuator corresponding to an automatic operation associated with an instruction signal outputted through an operation performed to an operation switch. In the present embodiment, an instruction signal outputted from the automation starting switch 1432 or the like serving as an operation unit and concerning an automatic operation including the work implement 130 is inputted into the automatic revolution control unit 62. In a case where an automatic operation designated to the inputted instruction signal is equal to an automatic operation that can be performed on the basis of information (one example of “information concerning a work tool” in the present disclosure) indicating the position, the attitude, surrounding situations, or the like concerning the bucket 133, the automatic revolution control unit 62 performs the automatic operation of the inputted instruction signal. In this case, in a case where an automatic operation designated to the instruction signal is equal to an automatic operation that can be performed on the basis of information concerning the bucket 133, the automatic revolution control unit 62 may perform the automatic operation for the instruction signal. Alternatively, in a case where an automatic operation designated to the instruction signal is equal to an automatic operation that cannot be performed on the basis of information concerning the bucket 133, the automatic revolution control unit 62 may not perform the automatic operation for the instruction signal. Note that, in a case where an automatic operation designated to the instruction signal is not equal to an automatic operation that can be performed on the basis of information concerning the bucket 133, the automatic revolution control unit 62 may perform the automatic operation for the instruction signal.
[0075] Predetermined information outputted by the operation device 143, the attitude angle sensor 151, the GNSS sensor 152, the IMU 153, and the like is inputted into the information input-output unit 621. The information input-output unit 621 outputs predetermined display information to the display input device 143D. An instruction signal outputted from the automation starting switch 1432 (operation unit) and concerning an automatic operation including the work implement 130 including the work tool such as the boom 131, the arm 132, or the bucket 133 is inputted into the information input-output unit 621.
[0076] The reference point setting unit 622 sets the loading revolution target point TLP (soil removal point), the returning revolution target point TRP (excavation starting point), and the interference avoiding point (EVP). In the present embodiment, an operator teaches these reference points, which makes it possible to set them, create a three-dimensional map or the like as described in Patent Document 1, and perform setting on the basis of the created three-dimensional map or the like. The operator can select the setting method on an as-necessary basis, for example. Here, description will be made of an example in which the operator performs teaching to perform setting.
[0077] The reference point setting unit 622 causes the display input device 143D to display an instruction to move the bucket 133 to the excavation starting point. The operator operates the operation device 143 to move the bucket 133 to the excavation starting point, and inputs completion of movement to the excavation starting point into the display input device 143D.
[0078] Next, the reference point setting unit 622 causes the display input device 143D to display an instruction to move the bucket 133 to the interference avoiding point. The operator operates the operation device 143 to move the bucket 133 to the interference avoiding point, and inputs completion of movement to the interference avoiding point into the display input device 143D.
[0079] Next, the reference point setting unit 622 causes the display input device 143D to display an instruction to move the bucket 133 to the soil removal point. The operator operates the operation device 143 to move the bucket 133 to the soil removal point, and inputs completion of movement to the soil removal point into the display input device 143D.
[0080] The reference point setting unit 622 causes the display input device 143D to display an instruction to move to the reference point. In addition, on the basis of the input operation made to the display input device 143D by an operator and information inputted into the information input-output unit 621, the reference point setting unit 622 stores, as information 631 in the storage unit 63, information on the position and the attitude of the work implement 130 and the revolution angle of the revolving body 120 acquired on the basis of the excavator coordinate system at each of the reference points. Note that the reference point setting unit 622 can change the setting of the reference points at any given timing. That is, for example, before the automatic revolution is performed, the reference point setting unit 622 can set once the loading revolution target point TLP (soil removal point), the returning revolution target point TRP (excavation starting point), and the interference avoiding point EVP, and then, change the loading revolution target point TLP, the returning revolution target point TRP, and the interference avoiding point EVP at any given timing (for example, during the operation), for example. In this case, for example, it is possible to perform fine adjustment of the loading revolution target point TLP (soil removal point) or the returning revolution target point TRP (excavation starting point) or the like on an as-necessary basis.
[0081] The revolution direction setting unit 623 sets a revolution direction of the work implement 130 (revolving body 120). The revolution direction setting unit 623 sets the revolution direction in the loading revolution control (first revolution control) and the returning revolution control (second revolution control) while considering the revolution direction of the revolving body 120 that possibly causes interference with an interfering object in the loading revolution control (first revolution control) and the returning revolution control (second revolution control).
[0082] The revolution direction setting unit 623 sets the revolution direction to a direction that causes the bucket 133 to move over the interference avoiding point (EVP) to the loading revolution target point TLP (first target point) corresponding to the soil removal position (unloading target position) or causes the bucket 133 to move to the returning revolution target point TRP (second target point) corresponding to the excavation starting position (loading target position). FIG. 12 illustrates an operation example of the revolution direction setting unit 623 of this case. The process shown in FIG. 12 is started when the automation starting switch 1432 is operated. When the process shown in FIG. 12 is started, the revolution direction setting unit 623 first acquires the target angle described with reference to FIGS. 6 and 7 and the like (step S101). Next, the revolution direction setting unit 623 acquires the interference avoiding point angle (step S102). Then, in a case where the work implement 130 (revolving body 120) is caused to revolve to the left, the revolution direction setting unit 623 determines whether the revolution goes over the interference avoiding point angle and reaches the target angle (step S103). In a case where the work implement 130 (revolving body 120) is caused to revolve to the left and the revolution goes over the interference avoiding point angle and reaches the target angle (step S103: YES), the revolution direction setting unit 623 sets the revolution to the left as the revolution direction (step S104), and ends the process shown in FIG. 12. In a case where the work implement 130 (revolving body 120) is caused to revolve to the left and the revolution does not go over the interference avoiding point angle or reach the target angle (step S103: NO), the revolution direction setting unit 623 sets the revolution to the right as the revolution direction (step S105), and ends the process shown in FIG. 12. FIG. 13 illustrates an example in which the revolution to the left is set as the revolution direction. FIG. 14 illustrates an example in which the revolution to the right is set as the revolution direction. In this case, the loading revolution or the returning revolution is performed in a direction in which the interference avoiding point that has been taught exists. This makes it possible to prevent a situation where, in a case where revolution, for example, at or around 180 degrees is performed, it is unsure in which direction the work implement 130 (revolving body 120) is caused to revolve.
[0083] In addition, for example, in a case where the target of unloading (loading, soil removal, or the like) is a dump truck 200, and an interfering object is the cab 201 of the dump truck 200, the revolution direction setting unit 623 sets the revolution direction to a direction in which the interference between the work implement 130 and the cab 201 of the dump truck 200 does not occur, on the basis of the positional relationship between the revolution center (revolution axis 120C) and the dump truck 200. FIG. 15 illustrates an operation example of the revolution direction setting unit 623 in this case. The process shown in FIG. 15 is started when the automation starting switch 1432 is operated. When the process shown in FIG. 15 is started, the revolution direction setting unit 623 acquires positional information on a soil removal target point P0 illustrated in FIG. 16 or 17 and the positional coordinates of four points P1 to P4 that are points on the outline of the truck on the basis of the excavator coordinate system (step S201). Note that it is possible to acquire the positional coordinates of four points P1 to P4 that are points on the outline of the truck, for example, through vehicle-to-vehicle communication, or acquire them using an external sensor such as a LiDAR device, a radar scanner, or a camera provided at the work machine 100. Next, the revolution direction setting unit 623 calculates a vector (vector a) connecting the original point (revolution axis 120C) of the excavator coordinate system and the soil removal target point P0 (step S202). Next, the revolution direction setting unit 623 calculates a vector (vector b) of an X axis of the truck coordinate system (step S203). The truck coordinate system is a coordinate system with the reference being the position and the direction of the dump truck 200. Next, the revolution direction setting unit 623 determines whether the angle formed by the vector a and the vector b is greater than 0 degrees (step S204). In a case where the angle formed by the vector a and the vector b is greater than 0 degrees, the revolution direction setting unit 623 sets the revolution to the right as the revolution direction (step S205), and ends the process shown in FIG. 15. In a case where the angle formed by the vector a and the vector b is not greater than 0 degrees, the revolution direction setting unit 623 sets the revolution to the left as the revolution direction (step S206), and ends the process shown in FIG. 15. In the example illustrated in FIG. 16, the angle is greater than 0, and hence, the revolution direction is set to the rightward direction. In the example illustrated in FIG. 17, the angle is not greater than 0, and hence, the revolution direction is set to the leftward direction. In this case, it is possible to get the work implement 130 closer to the loading platform 202 of the dump truck 200 from the rearward side, and hence, this is preferable, as compared with a case where the work implement 130 passes through above the cab 201. Note that, when the angle formed by the vector a and the vector b is at or around 0 degrees and falls within a predetermined range from 0 degrees that is set in advance, it may be possible to automatically revolve in a direction at the minimum revolution angle.
[0084] Note that the revolution direction setting unit 623 may manually set the revolution direction on the basis of an input operation by an operator to the display input device 143D, for example. In addition, for example, in a case of the soil removal operation performed to a hopper with which no interfering object exists or to the ground, the revolution direction setting unit 623 may set the revolution direction to a direction in which the revolution angle is the minimum. Furthermore, as for the setting method, the operator can make selection on an as-necessary basis through any given touching operation to an input operation, for example.
[0085] In a case where the automation starting switch 1432 is one operation switch and an operation is performed to the automation starting switch 1432 (predetermined operation unit), the starting instruction receiving unit 624 receives the operation to the automation starting switch 1432 as a starting instruction for loading revolution control (first revolution control in which the bucket is moved to the first target point corresponding to the unloading target position) or as a starting instruction for returning revolution control (second revolution control in which the bucket is moved to the second target point corresponding to the loading target position). This configuration makes it possible to give an instruction of starting the revolution control using one operation switch.
[0086] In addition, in a case where the automation starting switch 1432 is one operation switch, when an operation is performed to the automation starting switch 1432, the starting instruction receiving unit 624 may perform the following process. That is, in a case where the bucket 133 is positioned above the loading platform 202 or the vessel 206 of the dump truck 200 (in a case where the bucket is positioned within a predetermined range from the first target point) as illustrated in FIG. 19 when an operation is performed to the automation starting switch 1432, the starting instruction receiving unit 624 receives the operation to the automation starting switch 1432 as a starting instruction for the returning revolution control (second revolution control). In a case where the bucket 133 is not positioned above the loading platform 202 or the vessel 206 (hereinafter, simply referred to as the vessel 206) of the dump truck 200 (in a case where the bucket is not positioned within a predetermined range from the first target point) when an operation is performed to the automation starting switch 1432, the starting instruction receiving unit 624 receives the operation to the automation starting switch 1432 as a starting instruction for the loading revolution control (first revolution control). Note that, in FIG. 19, positions P5 and P6 are positions at end portions of the cab 201. FIG. 18 shows an operation example of the starting instruction receiving unit 624 of this case. The process shown in FIG. 18 is started when the automation starting switch 1432 is operated. When the process shown in FIG. 18 is started, the starting instruction receiving unit 624 acquires positional information on the vessel 206 (step S301). Next, the starting instruction receiving unit 624 acquires positional information on the bucket 133 (step S302). For example, the position of the bucket 133 is a position of the bucket pin 133P in the excavator coordinate system and includes a direction in which the revolving body 120 is directed. Next, the starting instruction receiving unit 624 determines whether the bucket 133 is positioned above the vessel 206 (step S303). In a case where the bucket 133 is positioned above the vessel 206 (step S303: YES), the starting instruction receiving unit 624 sets the returning revolution as the revolution mode (type of revolution control) (step S304), and ends the process shown in FIG. 18. In a case where the bucket 133 is not positioned above the vessel 206 (step S303: NO), the starting instruction receiving unit 624 sets the loading revolution as the revolution mode (step S305), and ends the process shown in FIG. 18.
[0087] In addition, in a case where the automation starting switch 1432 is one operation switch, when an operation is performed to the automation starting switch 1432, the starting instruction receiving unit 624 may perform the following process. That is, in a case where the bucket 133 is at a dumping attitude (in a case where the bucket 133 is at a predetermined unloading attitude) as illustrated in FIG. 21 when the automation starting switch 1432 is operated, the starting instruction receiving unit 624 receives the operation to the automation starting switch 1432 as a starting instruction for the returning revolution control (second revolution control). In a case where the bucket 133 is at a holding attitude (in a case where the bucket 133 is at a predetermined loading attitude) as illustrated in FIG. 23 when the automation starting switch 1432 is operated, the starting instruction receiving unit 624 receives the operation to the automation starting switch 1432 as a starting instruction for the loading revolution control (first revolution control). In this case, the work machine 100 alone can set the revolution mode. The operation example of this case is illustrated in FIGS. 20 and 22. The dumping attitude is an attitude in which soil removal is performed for a load in the bucket 133. The dumping attitude is an attitude (dashed line DL in FIG. 21) in which a blade edge 133T of the bucket 133 is directed in a direction further away from the work machine 100 than the attitude in which the blade edge 133T of the bucket 133 is directed in the vertical direction as illustrated, for example, in FIG. 21. In addition, the holding attitude is an attitude in which a load is loaded in the bucket 133. The holding attitude is an attitude in which the blade edge 133T of the bucket 133 is directed in a direction further toward the work machine 100 than the attitude in which the blade edge 133T of the bucket 133 is directed in the vertical direction as illustrated, for example, by the dashed line DL in FIG. 23. At this time, it is preferable that the blade edge 133T should be directed more upward than a direction perpendicular to the vertical direction as illustrated by the dashed line DL in FIG. 23. Note that the attitude of the bucket 133 may be corrected on the basis of the pitch angle of the work machine 100.
[0088] The process shown in FIG. 20 is started when the automation starting switch 1432 is operated. When the process shown in FIG. 20 is started, the starting instruction receiving unit 624 acquires attitude information on the bucket 133 (step S401). Next, the starting instruction receiving unit 624 determines whether the bucket 133 is at the dumping attitude (step S402). In a case where the bucket 133 is in the dumping attitude (step S402: YES), the starting instruction receiving unit 624 sets the returning revolution as the revolution mode (step S403), and ends the process shown in FIG. 20. In a case where the bucket 133 is not in the dumping attitude (step S402: NO), the starting instruction receiving unit 624 sets the loading revolution as the revolution mode (step S404), and ends the process shown in FIG. 20.
[0089] The process shown in FIG. 22 is started when the automation starting switch 1432 is operated. When the process shown in FIG. 22 is started, the starting instruction receiving unit 624 acquires attitude information on the bucket 133 (step S501). Next, the starting instruction receiving unit 624 determines whether the bucket 133 is at the holding attitude (step S502). In a case where the bucket 133 is at the holding attitude (step S502: YES), the starting instruction receiving unit 624 sets the loading revolution as the revolution mode (step S503), and ends the process shown in FIG. 22. In a case where the bucket 133 is not at the holding attitude (step S502: NO), the starting instruction receiving unit 624 sets the returning revolution as the revolution mode (step S504), and ends the process shown in FIG. 22.
[0090] In addition, in a case where the automation starting switch 1432 is one operation switch, when an operation is performed to the automation starting switch 1432, the starting instruction receiving unit 624 may perform the following process. That is, in a case where the bucket 133 is not at the dumping attitude (in a case where the bucket is not at a predetermined unloading attitude), when the automation starting switch 1432 is operated, the starting instruction receiving unit 624 does not receive the operation to the automation starting switch 1432, even if the bucket 133 is positioned above the loading platform 202 or the vessel 206 of the dump truck 200 (even when the bucket is positioned within a predetermined range from the first target point) as illustrated, for example, in FIG. 19. In a case where the bucket 133 is not at the holding attitude (in a case where the bucket is not at a predetermined loading attitude), when the automation starting switch 1432 is operated, the starting instruction receiving unit 624 does not receive the operation to the automation starting switch 1432, even if the bucket 133 is not positioned above the loading platform 202 or the vessel 206 of the dump truck 200 (even when the bucket is not positioned within a predetermined range from the first target point). The operation example of this case is shown in FIG. 24.
[0091] The process shown in FIG. 24 is started when the automation starting switch 1432 is operated. When the process shown in FIG. 24 is started, the starting instruction receiving unit 624 acquires positional information on the vessel 206 (step S601), and also acquires position and attitude information on the bucket 133 (step S602). For example, the position of the bucket 133 is a position of the bucket pin 133P in the excavator coordinate system and includes a direction in which the revolving body 120 is directed. Next, the starting instruction receiving unit 624 determines whether the bucket 133 is positioned above the vessel 206 (step S603). In a case where the bucket 133 is positioned above the vessel 206 (step S603: YES), the starting instruction receiving unit 624 determines whether the bucket 133 is at the dumping attitude (step S604). In a case where the bucket 133 is at the dumping attitude (step S604: YES), the starting instruction receiving unit 624 sets the returning revolution as the revolution mode (step S607), and ends the process shown in FIG. 24. In a case where the bucket 133 is not in the dumping attitude (step S604: NO), the starting instruction receiving unit 624 does not cause the automatic revolution to be operated (step S605), and outputs a display on the display input device 143D or a sound, for example, for a predetermined period of time to make notification that the position or the attitude of the bucket 133 is not appropriate (step S606), and the process shown in FIG. 24 ends. Note that a step of step S601 may be provided.
[0092] In a case where the bucket 133 is not positioned above the vessel 206 (step S603: NO), the starting instruction receiving unit 624 determines whether the bucket 133 is at the holding attitude (step S608). In a case where the bucket 133 is at the holding attitude (step S608: YES), the starting instruction receiving unit 624 sets the loading revolution as the revolution mode (step S609), and ends the process shown in FIG. 24. In a case where the bucket 133 is not at the holding attitude (step S608: NO), the starting instruction receiving unit 624 does not cause the automatic revolution to be operated (step S610), and outputs a display on the display input device 143D or sound, for example, for a predetermined period of time to make notification that the position or the attitude of the bucket 133 is not appropriate (step S611), and the process shown in FIG. 24 ends. This configuration makes it possible to prevent the automatic revolution control from being performed in a state where the position or the attitude of the bucket 133 is not appropriate. Note that, in the example described above using one operation switch as the automation starting switch, description has been made of a case where two controls (the loading revolution control and the returning revolution control) are performed as the automatic operation. However, two or more operation switches may be used as the automation starting switch for the automatic operation. For example, an excavating operation or an automatic soil removal operation may be included as the automatic operation. It may be possible to employ a configuration in which the type of the automatic operation is determined as the excavating operation or the automatic soil removal operation on the basis of the attitude of the work implement 130 including the attitude of the arm 132, the boom 131, and the like, other than the bucket 133, that constitute the work implement 130, and the corresponding automatic operation is started. In addition, the combination of automatic operations to be started using the switch is not limited to those described above. It may be possible to employ any combination of automatic operations such as a combination of the loading revolution control and the automatic soil removal.
[0093] In addition, in a case where two switches are provided as an automation starting switch (for example, in a case where the loading revolution automation starting switch 1432 and the returning revolution automation starting switch 1433 are provided), the starting instruction receiving unit 624 may receive an operation to the loading revolution automation starting switch 1432 or the returning revolution automation starting switch 1433 (a first operation unit or a second operation unit) as a starting instruction for the loading revolution control (first revolution control) or as a starting instruction for the returning revolution control (second revolution control), provided that at least either the position or the attitude of the bucket 133 satisfies a predetermined condition (at least either the position or the attitude of the bucket satisfies a predetermined condition). For example, in a case where one automation starting switch is provided at the left operation lever 143LO whereas the other automation starting switch is provided at the right operation lever 143RO, and an operator erroneously operates the loading revolution automation starting switch 1432 and the returning revolution automation starting switch 1433, it is possible to prevent the automatic revolution control from starting. Furthermore, in a case where a plurality of automation starting switches are provided at one operation lever, it is more difficult to operate the switch for autonomous driving. Even in this case, it is possible to prevent erroneous operation.
[0094] For example, in a case where the returning revolution automation starting switch 1433 (second operation unit) is operated, the starting instruction receiving unit 624 may receive the operation to the returning revolution automation starting switch 1433 as a starting instruction for the returning revolution control (second revolution control), provided that the bucket 133 is positioned above the vessel 206 (provided that the bucket is positioned within a predetermined range from the first target point). In a case where the loading revolution automation starting switch 1432 (first operation unit) is operated, the starting instruction receiving unit 624 may receive the operation to the loading revolution automation starting switch 1432 as a starting instruction for the loading revolution control (first revolution control), provided that the bucket 133 is not positioned above the vessel 206 (provided that the bucket is not positioned within a predetermined range from the first target point). The operation example of this case is shown in FIG. 25.
[0095] The process shown in FIG. 25 is started when the loading revolution automation starting switch 1432 is operated. When the process shown in FIG. 25 is started, the starting instruction receiving unit 624 acquires positional information on the vessel 206 (step S701), and also acquires positional information on the bucket 133 (step S702). For example, the position of the bucket 133 is a position of the bucket pin 133P in the excavator coordinate system and includes a direction in which the revolving body 120 is directed. Next, the starting instruction receiving unit 624 determines whether the bucket 133 is positioned above the vessel 206 (step S703). In a case where the bucket 133 is positioned above the vessel 206 (step S703: YES), the starting instruction receiving unit 624 does not cause the automatic revolution to be operated (step S704), and outputs a display on the display input device 143D or sound, for example, for a predetermined period of time to make notification that the position or the attitude of the bucket 133 is not appropriate (step S705), and the process shown in FIG. 25 ends. In a case where the bucket 133 is not positioned above the vessel 206 (step S703: YES), the starting instruction receiving unit 624 sets the loading revolution as the revolution mode (step S706), and ends the process shown in FIG. 25. Note that a step of step S701 may not be provided.
[0096] In addition, for example, in a case where the loading revolution automation starting switch 1432 (first operation unit) is operated, the starting instruction receiving unit 624 may receive the operation to the loading revolution automation starting switch 1432 as a starting instruction for the loading revolution control (first revolution control), provided that the bucket 133 is at the holding attitude (the bucket is at a predetermined loading attitude). In a case where the returning revolution automation starting switch 1433 (second operation unit) is operated, the starting instruction receiving unit 624 may receive the operation to the returning revolution automation starting switch 1433 as a starting instruction for the returning revolution control (second revolution control), provided that the bucket 133 is at the dumping attitude (the bucket is at a predetermined unloading attitude). The operation example of this case is shown in FIG. 26.
[0097] The process shown in FIG. 26 is started when the loading revolution automation starting switch 1432 is operated. When the process shown in FIG. 26 is started, the starting instruction receiving unit 624 acquires attitude information on the bucket 133 (step S801). Next, the starting instruction receiving unit 624 determines whether the bucket 133 is at the dumping attitude (step S802). In a case where the bucket 133 is at the dumping attitude (step S802: YES), the starting instruction receiving unit 624 does not cause the automatic revolution to be operated (step S803), and outputs a display on the display input device 143D or sound, for example, for a predetermined period of time to make notification that the attitude of the bucket 133 is not appropriate (step S804), and the process shown in FIG. 26 ends. In a case where the bucket 133 is not at the dumping attitude (step S802: NO), the starting instruction receiving unit 624 sets the loading revolution as the revolution mode (step S805), and ends the process shown in FIG. 26.
[0098] Note that, as for the way of operating a plurality of starting instruction receiving units 624 described above, an operator can make selection on an as-necessary basis, for example.
[0099] The operation instruction switching control unit 625 controls the operation instruction switching unit 64 to output, from the operation instruction switching unit 64, either an operation instruction signal (manual) generated in response to an operation by the operator to the operation device 143 or an operation instruction signal (automatic) generated by the operation instruction signal generating unit 626. For example, in a case where the operation instruction signal generating unit 626 generates and outputs the operation instruction signal (automatic), the operation instruction switching control unit 625 selects the operation instruction signal (automatic), and outputs it from the operation instruction switching unit 64.
[0100] The operation instruction signal generating unit 626 serves as one configuration example of the control unit according to the present disclosure. The operation instruction signal generating unit 626 (control unit) generates and outputs an operation instruction signal used to perform the loading revolution control or the returning revolution control, in response to a predetermined instruction (for example, an operation to the automation starting switch 1432). The operation instruction signal generating unit 626 controls movement of the bucket 133 in the loading revolution control and the returning revolution control, for example, on the basis of the interference avoiding point EVP.
[0101] In addition, in a case where the starting instruction receiving unit 624 receives an operation to the automation starting switch 1432 as a starting instruction for the loading revolution control, the operation instruction signal generating unit 626 performs the loading revolution control, and in a case where the starting instruction receiving unit 624 receives an operation to the automation starting switch 1432 as a starting instruction for the returning revolution control, the operation instruction signal generating unit 626 performs the returning revolution control.
[0102] Furthermore, the operation instruction signal generating unit 626 performs the loading revolution control on the basis of the loading revolution target point TLP and the interference avoiding point EVP, and also performs the returning revolution control on the basis of an interference avoiding vertical plane VS (interference avoiding plane) including the returning revolution target point TRP and the interference avoiding point EVP.
[0103] In addition, in a case where the interference avoiding plane is the interference avoiding vertical plane VS that includes the revolution axis 120C passing through the revolution center and also includes the interference avoiding point EVP, the operation instruction signal generating unit 626 sets the height (predetermined height of the bucket) of the bucket pin 133P of the bucket 133 so as to be equal to or higher than the height of the interference avoiding point EVP, between a time when the returning revolution control starts and a time when the bucket pin 133P passes through the interference avoiding vertical plane VS.
[0104] Furthermore, the operation instruction signal generating unit 626 performs control of the attitude of the work implement 130 and control of revolution of the revolving body 120 in a combined manner in either the first region or the second region having a boundary at the interference avoiding plane, and performs only control of revolution of the revolving body 120 in the other region.
[0105] In addition, when the starting instruction receiving unit 624 receives an operation to the loading revolution automation starting switch 1432 as a starting instruction for the loading revolution control, the operation instruction signal generating unit 626 performs the loading revolution control. In addition, when an operation to the returning revolution automation starting switch 1433 is received as a starting instruction for the returning revolution control, the operation instruction signal generating unit 626 performs the returning revolution control.
[0106] FIG. 27 shows an operation example of the operation instruction signal generating unit 626. After the automation starting switch 1432 is operated, the operation shown in FIG. 27 is started in a case where the revolution direction and the revolution mode are set. When the process shown in FIG. 27 is started, the operation instruction signal generating unit 626 determines whether the loading revolution is set as the revolution mode (step S901). In a case where the loading revolution is set as the revolution mode (step S901: YES), the operation instruction signal generating unit 626 performs the revolution control and work implement control in parallel in the set revolution direction until the bucket pin 133P reaches the interference avoiding point EVP (step S902). After the bucket pin 133P passes through the interference avoiding point EVP, the operation instruction signal generating unit 626 performs the revolution control alone up to the loading revolution target point TLP (step S903), and ends the process shown in FIG. 27.
[0107] In a case where the loading revolution is not set as the revolution mode (step S901: NO), the operation instruction signal generating unit 626 determines whether the starting height is equal to or higher than the height of the interference avoiding point (step S904). In a case where the starting height is not equal to or higher than the height of the interference avoiding point (step S904: NO), the operation instruction signal generating unit 626 performs the work implement control alone until the height of the bucket pin 133P reaches the height of the interference avoiding point (step S907). After step 907 or in a case where the starting height is equal to or higher than the height of the interference avoiding point (step S904: YES), the operation instruction signal generating unit 626 performs the revolution control alone in the set revolution direction until the bucket pin 133P reaches the interference avoiding vertical plane (VS) (step S905). After the interference avoiding point EVP is passed through, the operation instruction signal generating unit 626 performs the revolution control and the work implement control in parallel up to the returning revolution target point TRP (returning revolution target attitude) (step S906), and ends the process shown in FIG. 27.
[0108] As described above, in the present embodiment, the control device 61 is a control device of the work machine 100 including the revolving body 120 configured to revolve around the revolution center, and also including the work implement 130 including the bucket 133 serving as a work tool and attached to the revolving body 120. In addition, in a case where an instruction signal outputted from a switch serving as an operation unit and concerning an automatic operation including the work implement 130 is inputted, the control device 61 determines an automatic operation that can be performed from among a plurality of automatic operations, on the basis of information concerning the bucket 133 (work tool), and performs the automatic operation that is determined to be able to be performed. Note that the plurality of automatic operations include an automatic operation including a combined operation of the work implement 130 and the revolving body 120, for example. Furthermore, the combined operation is loading revolution or returning revolution, for example. In addition, the information concerning the bucket 133 is information indicating the position or the attitude of the bucket 133, for example. In addition, determining the automatic operation that is able to be performed means determining whether the bucket 133 is positioned above the vessel of the transporting vehicle, for example. Furthermore, determining the automatic operation that is able to be performed means determining whether the attitude of the bucket 133 is either the dumping attitude or the holding attitude, for example.Operation and Effects
[0109] For the switches that an operator operates, the number of switches that can be installed is restricted due to space. In contrast, the present embodiment makes it possible to reduce the number of operation switches that output a signal instructing to start the operation of autonomous driving so as to be less than the number of operations of autonomous driving. Thus, with the present embodiment, it is possible to effectively use the space. In addition, in the automatic revolution control, it is possible to prevent an operator from performing a wrong operation to an operation switch, which makes it possible to improve usability.
[0110] These are descriptions of the embodiment according to the present invention with reference to the drawings. However, the specific configurations are not limited to the embodiment described above, and include design modifications and the like that do not depart from the gist of the present invention. For example, it may be possible to employ a remote operation system in which a portion of the configurations of the operation device 143 and the control device 61 is disposed at a remote site, and an operator controls the work implement 130 and the revolving body 120 through wireless communication while viewing the screen of a monitor at the remote site. Further, a part or an entirety of the program executed by the computer in the above-mentioned embodiments can be distributed via a computer-readable recording medium or a communication line.Supplementary Notes
[0111] The control device 61 described in the embodiment can be understood in the following manner.
[0112] 1(1) A control device according to a first aspect of the present disclosure provides a control device of a work machine including a revolving body configured to revolve around a revolution center, and a work implement including a work tool and attached to the revolving body, in which, in a case where an instruction signal outputted from an operation unit and concerning an automatic operation including the work implement is inputted, the control device determines an automatic operation that is able to be performed from among a plurality of automatic operations, on a basis of information concerning the work tool, and performs the automatic operation determined to be able to be performed.
[0113] (2) A control device according to a second aspect of the present disclosure provides the control device according to (1) , in which the number of the operation units is one.
[0114] (3) A control device according to a third aspect of the present disclosure provides the control device according to (1) or (2) , in which the operation unit is provided at an operation lever that the work machine includes.
[0115] (4) A control device according to a fourth aspect of the present disclosure provides the control device according to any one of (1) to (3), in which the plurality of automatic operations include an automatic operation including a combined operation of the work implement and the revolving body.
[0116] (5) A control device according to a fifth aspect of the present disclosure provides the control device according to any one of (1) to (4), in which the combined operation includes loading revolution or returning revolution.
[0117] (6) A control device according to a sixth aspect of the present disclosure provides the control device according to any one of (1) to (5), in which information concerning the work tool includes information indicating a position or an attitude of the work tool.
[0118] (7) A control device according to a seventh aspect of the present disclosure provides the control device according to any one of (1) to (6), in which determining an automatic operation that is able to be performed includes determining whether the work tool is positioned above a vessel of a transporting vehicle.
[0119] (8) A control device according to the seventh aspect of the present disclosure provides the control device according to any one of (1) to (6), in which determining an automatic operation that is able to be performed includes determining whether an attitude of the work tool is either a dumping attitude or a holding attitude.INDUSTRIAL APPLICABILITY
[0120] The control device, the control method, and the work machine according to the present disclosure make it possible to improve usability.REFERENCE SIGNS LIST
[0121] 100 . . . work machine, 110 . . . traveling body, 120 . . . revolving body, 130 . . . work implement, 133 . . . bucket, 140 . . . cab, 143D . . . display input device, 60 . . . control system, 61 . . . control device, 622 . . . reference point setting unit, 623 . . . revolution direction setting unit, 624 . . . starting instruction receiving unit, 626 . . . operation instruction signal generating unit (control unit)
Claims
1. A control device of a work machine including a revolving body configured to revolve around a revolution center, and a work implement including a work tool and attached to the revolving body, whereinin a case where an instruction signal outputted from an operation unit and concerning an automatic operation including the work implement is inputted, the control device determines an automatic operation that is able to be performed from among a plurality of automatic operations, on a basis of information concerning the work tool, and performs the automatic operation determined to be able to be performed.
2. The control device according to claim 1, wherein the number of the operation units is one.
3. The control device according to claim 2, wherein the operation unit is provided at an operation lever that the work machine includes.
4. The control device according to claim 1, wherein the plurality of automatic operations include an automatic operation including a combined operation of the work implement and the revolving body.
5. The control device according to claim 4, wherein the combined operation includes loading revolution or returning revolution.
6. The control device according to claim 1, wherein information concerning the work tool includes information indicating a position or an attitude of the work tool.
7. The control device according to any one of claims 1 to 6, wherein determining an automatic operation that is able to be performed includes determining whether the work tool is positioned above a vessel of a transporting vehicle.
8. The control device according to any one of claims 1 to 6, wherein determining an automatic operation that is able to be performed includes determining whether an attitude of the work tool is either a dumping attitude or a holding attitude.
9. A control method for a work machine including a revolving body configured to revolve around a revolution center, and a work implement including a work tool and attached to the revolving body, the control method comprising:in a case where an instruction signal outputted from an operation unit and concerning an automatic operation including the work implement is inputted, determining an automatic operation that is able to be performed from among a plurality of automatic operations, on a basis of information concerning the work tool; andperforming the automatic operation determined to be able to be performed.
10. A work machine comprising:a revolving body configured to revolve around a revolution center;a work implement including a work tool and attached to the revolving body; anda control device configured to control the revolving body and the work implement, whereinin a case where an instruction signal outputted from an operation unit and concerning an automatic operation including the work implement is inputted, the control device determines an automatic operation that is able to be performed from among a plurality of automatic operations, on a basis of information concerning the work tool, and performs the automatic operation determined to be able to be performed.