US20260243051A1
2026-08-20
19/469,463
2024-03-28
Smart Summary: A control device is designed for a work machine that can rotate around a central point. It includes a work tool attached to the rotating part of the machine. When a user sends a command for automatic operation, the device checks if the command matches the capabilities of the work tool. If it does, the control device will carry out the automatic operation as instructed. This system helps make the operation of the machine easier and more efficient. 🚀 TL;DR
Provided is 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 by an operation unit configured to output an instruction signal concerning an automatic operation including the work implement is inputted into the control device, and an automatic operation assigned to the inputted instruction signal is equal to an automatic operation that can be performed on a basis of information regarding the work tool, the control device performs the automatic operation of the inputted instruction signal.
Get notified when new applications in this technology area are published.
E02F3/437 » CPC main
Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms , e.g. dippers, buckets; Component parts; Drives for dippers, buckets, dipper-arms or bucket-arms; Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like providing automatic sequences of movements, e.g. linear excavation, keeping dipper angle constant
E02F9/123 » CPC further
Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups - ; Superstructures; Supports for superstructures; Supports for movable superstructures mounted on travelling or walking gears or on other superstructures; Slewing or traversing gears; Turntables, i.e. structure rotatable about 360° Drives or control devices specially adapted therefor
E02F3/43 IPC
Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms , e.g. dippers, buckets; Component parts; Drives for dippers, buckets, dipper-arms or bucket-arms Control of dipper or bucket position; Control of sequence of drive operations
E02F9/12 IPC
Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups - ; Superstructures; Supports for superstructures; Supports for movable superstructures mounted on travelling or walking gears or on other superstructures Slewing or traversing gears
The present disclosure relates to a control device, a control method, and a work machine.
The present application claims priority based on JP 2023-056913, filed in Japan on Mar. 31, 2023, the content of which is incorporated herein by reference.
Patent Document 1 describes a control device for a loading machine including a revolving body and a work implement. The control device is able to automate movement of the work implement between a loading position and an excavation position.
As described in Patent Document 1 as a modification example, the control device described in Patent Document 1 is configured such that a loading operation and an excavation operation using a manual operation can be combined with automation of the movement of the work implement between the loading position and the excavation position. For example, in a case where the loading operation and the excavation operation using a manual operation are combined with the automation of the movement of the work implement between the loading position and the excavation position, the present disclosure is configured such that a function of the automatic operation that is the automation of the work implement and the revolving body is allocated to a switch. At the time of operation, an operator needs to recognize what kind of function is allocated to a switch.
The present disclosure has been made in view of the circumstances 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 reduce a load when an operator operates a switch, thereby improving usability.
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 by an operation unit configured to output an instruction signal concerning an automatic operation including the work implement is inputted into the control device, and an automatic operation assigned to the inputted instruction signal is equal to an automatic operation that can be performed on a basis of information regarding the work tool, the control device performs the automatic operation of the inputted instruction signal.
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 by an operation unit configured to output an instruction signal concerning an automatic operation including the work implement is inputted, and an automatic operation assigned to the inputted instruction signal is equal to an automatic operation that can be performed on a basis of information regarding the work tool, performing the automatic operation of the inputted instruction signal.
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 for the work implement, in which, in a case where an instruction signal outputted by an operation unit configured to output an instruction signal concerning an automatic operation including the work implement is inputted into the control device, and an automatic operation assigned to the inputted instruction signal is equal to an automatic operation that can be performed on a basis of information regarding the work tool, the control device performs the automatic operation of the inputted instruction signal.
The control device, the control method, and the work machine according to the present disclosure make it possible to improve usability.
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.
FIG. 4 is a schematic view used to explain an operation example of a control device according to the embodiment of the present disclosure.
FIG. 5 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
FIG. 6 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
FIG. 7 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
FIG. 8 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
FIG. 9 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
FIG. 10 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
FIG. 11 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
FIG. 12 is a flowchart showing an operation example of the control device according to the embodiment of the present disclosure.
FIG. 13 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
FIG. 14 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
FIG. 15 is a flowchart showing an operation example of the control device according to the embodiment of the present disclosure.
FIG. 16 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
FIG. 17 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
FIG. 18 is a flowchart showing an operation example of the control device according to the embodiment of the present disclosure.
FIG. 19 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
FIG. 20 is a flowchart showing an operation example of the control device according to the embodiment of the present disclosure.
FIG. 21 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
FIG. 22 is a flowchart showing an operation example of the control device according to the embodiment of the present disclosure.
FIG. 23 is a schematic view used to explain an operation example of the control device according to the embodiment of the present disclosure.
FIG. 24 is a flowchart showing an operation example of the control device according to the embodiment of the present disclosure.
FIG. 25 is a flowchart showing an operation example of the control device according to the embodiment of the present disclosure.
FIG. 26 is a flowchart showing an operation example of the control device according to the embodiment of the present disclosure.
FIG. 27 is a flowchart showing an operation example of the control device according to the embodiment of the present disclosure.
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 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.
FIG. 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, provided that it is, for example, a work machine including a revolving body serving as an actuator and a work implement, and may be other work machines such as a face excavator, a rope excavator, or the like. In addition, it may be a work machine including an actuator driven through electrical power, in addition to through hydraulic pressure. The work machine 100 includes a traveling body 110, a revolving body 120, a work implement 130, and a cab 140.
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.
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. 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.
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 device 61.
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.
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.
The work implement 130 includes a boom 131, an arm 132, a bucket 133, a boom cylinder 131C, an arm cylinder 132C, and a 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” in the present disclosure. Furthermore, a tilt rotator, a quick coupler, a grapple, a magnet, and a breaker, or the like may be attached as a work tool that is an attachment, in addition to a bucket. These also each serve as an example of the “work tool” in the present disclosure.
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.
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.
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.
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 component configured to generate or change a predetermined signal upon being operated by an operator. In the present embodiment, the switch serves as one configuration example of an “operation unit” in the present disclosure. As 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, it 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.
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.
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, for example. Note that the operation switch 1433 is provided at the upper portion of or a side portion of an operation lever. It may be possible to employ a configuration in which a horn is blown when the operation switch 1433 turns ON, for example.
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, it is assumed that 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 are also referred to as a teaching switch 1431 and an automation starting switch 1432 (or simply each referred to as a “switch”)). The switches 1431 and 1432 are provided at the upper portion of or a side portion of an operation lever. Note that the teaching switch and the automation starting switch each serve as one example of a switch for automatic control. When the switch is turned ON, the automation starting switch is configured to output, to the control device 61, an instruction signal with which an automatic operation including the work implement 130 starts, for example. In addition, the switch is not limited to a signal concerning start of automation, and is only necessary to be a signal concerning automatic operation. For example, the switch may be a switch that outputs a signal of stopping automation, 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 may be performed for automatic control such as automatic soil removal in which a soil removal operation is automatically performed by 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, as for assignment of the autonomous driving, it may be possible to employ a configuration in which a plurality of switches are assigned so as to be provided at one operation lever, or a configuration in which, by providing a plurality of operation levers, one or a plurality of switches are provided for each of the operation levers.
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.
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.
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.
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 into which a command operation by an operator is inputted are separately provided.
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.
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.
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 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.
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.
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 or both sides of the work machine 100 so as to be directed toward the side direction of the work machine 100.
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.
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 of, from a state where the bucket 133 is positioned at the outer side of the loading target due to excavation of the excavation target, revolving up to a direction directed at the loading target while the boom 131 is being automatically lifted, and moving to a soil removal point. In addition, the “returning revolution” represents an operation of, from a state where the bucket 133 is positioned above the loading target due to loading, revolving up to a predetermined direction while the boom 131 is being automatically lowered, and moving to an excavation starting point. The “loading revolution” and the “returning revolution” are operations that automatically change the work implement and the revolving body, and each serve as one example of the “automatic operation including the work implement” in the present disclosure. Note that, as one example of the automatic operation, it may be possible to include an automatic operation of either the work implement or the revolving body. 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 starts. 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.
FIG. 4 schematically illustrates a series of flows of manual excavation, loading revolution, manual soil removal, and returning revolution. As illustrated, for example, at the top left, the work machine 100 illustrated in FIG. 4 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, and automatic revolution is performed up to the loading revolution target point TLP through a combined operation of the work implement 130 and the revolving body 120. Here, the operator causes the manual soil removal to be performed to perform soil removal of earth and sand in the bucket 133 (diagram at the bottom right). 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, and the automatic revolution is performed up to the returning revolution target point TRP through a combined operation of the work implement 130 and the revolving body 120.
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, the number thereof may be two or more, and a plurality of switches may be provided. 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 set the operation switch 1433 as a switch for a horn, and provide a third operation switch at either the left or right operation lever to use it as an automation starting switch for returning revolution.
Next, the interference avoiding point 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 of 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, when the automation starting switch 1432 is operated, the work machine 100 moves, through the loading revolution, the bucket 133 (133a) positioned at the automatic revolution starting point (SP) to the loading target point (TLP) through the interference avoiding point (EVP). The attitude of the bucket 133 (133b) at the time of arrival at the loading 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 (in the present embodiment, also referred to as an unloading attitude) (bucket 133 (133c)), and performs a soil removal operation. Here, the interference avoiding point (EVP) is a point (positional information) indicating a boundary of areas set such that no hitting against the loading platform 202 or the like of the dump truck 200 happens during the loading operation (loading revolution). In the present embodiment, only the revolving operation is performed at the soil removal point side (loading revolution target point TLP) of this boundary. The interference avoiding point (EVP) can be set on the basis of teaching in which the operator actually manipulates 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.
FIG. 6 illustrates an example of change in a revolution angle and a height position of the bucket pin during 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 with the dump truck is shown by hatching. In the example illustrated in FIG. 6, control of the revolving body 120 and control of the work implement 130 are performed in parallel from the automatic revolution starting point (SP) up to the interference avoiding point (EVP), whereby the height of the bucket pin reaches the height of an interference starting point before the revolution angle reaches the interference avoiding point angle. In addition, after arrival at the interference avoiding point, the revolution angle reaches the target angle due to alone control for the revolving body 120. The operation of the loading revolution includes a revolution region in which the revolving body 120 and the boom 131 are operated at the same time. The operation of the boom 131 in the loading revolution may include lifting the boom, and may include lowering the boom. For example, in a case where the height of the automatic revolution starting point is higher than the interference avoiding point, the boom lowering operation may be possible.
In addition, FIGS. 7 and 8 each illustrate an example of change in the revolution angle and the height of the bucket pin during 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 is maintained at the starting height until the bucket pin reaches the interference avoiding point, 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 arrival at the interference avoiding point, control of the revolving body 120 and control of the work implement 130 are performed in parallel, whereby both the height of the bucket pin and the revolution angle change so as to change to the target height and the target angle. Furthermore, in the example illustrated in FIG. 8, the height of the bucket pin first changes through the alone control for the work implement 130 until the height of the bucket pin reaches the height of the interference avoiding point. After arrival at the height of the interference avoiding point, the height of the bucket pin is maintained at the starting height until arrival at the interference avoiding point, 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 arrival at the interference avoiding point, control of the revolving body 120 and control of the work implement 130 are performed in parallel, whereby both the height of the bucket pin and the revolution angle change so as to 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. The operation of the returning revolution includes a revolution region in which the revolving body 120 and the boom 131 are operated at the same time. The operation of the boom 131 in the returning revolution may include lowering the boom, and may include the boom lifting operation. For example, in a case where the target height is higher than the interference avoiding point, the boom lifting operation may be possible.
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 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.
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 vertical 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 extends from the automatic revolution starting point (SP) until passing 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) through the combined operation of the work implement 130 and the revolving body 120.
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, avoiding the interference with the interfering object is achieved with the reference being the interference avoiding vertical plane (VS), as with the example illustrated in FIG. 10. In this example, the path of the bucket pin extends so as to ascend from the automatic revolution starting point (SP) until reaching 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.
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).
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 configured to perform an automatic operation on the basis of an operation instruction signal generated by the control device without relying on an operation by an operator is an actuator corresponding to an automatic operation assigned to an instruction signal outputted in response to an operation to an operation switch. In the present embodiment, in a case where an instruction signal outputted by the automation starting switch 1432 or the like configured to output an instruction signal concerning an automatic operation including the work implement is inputted into the automatic revolution control unit 62, and an automatic operation assigned to the inputted instruction signal is equal to an automatic operation that can be performed on a basis of information (one example of “information regarding a work tool” in the present disclosure) indicating the position, the attitude, surrounding situations, and the like concerning the bucket 133, the automatic revolution control unit 62 performs the automatic operation of the inputted instruction signal. In this case, the automatic revolution control unit 62 may perform the automatic operation of the instruction signal in a case where the automatic operation assigned to the instruction signal is equal to the automatic operation that can be performed on the basis of the information concerning the bucket 133, or may not perform the automatic operation of the instruction signal in a case where the automatic operation assigned to the instruction signal is equal to the automatic operation that cannot be performed on the basis of the information concerning the bucket 133. Note that the automatic revolution control unit 62 does not perform the automatic operation of the instruction signal in a case where the automatic operation assigned to the instruction signal is not equal to the automatic operation that can be performed on the basis of the information concerning the bucket 133.
The information input-output unit 621 inputs predetermined information outputted by the operation device 143, the attitude angle sensor 151, the GNSS sensor 152, the IMU 153, and the like, and outputs predetermined display information to the display input device 143D. The information input-output unit 621 inputs an instruction signal from the automation starting switch 1432 (operation unit) configured to output an instruction signal 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, for example.
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.
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.
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.
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.
The reference point setting unit 622 causes the display input device 143D to display an instruction to move to the reference point, and as the information 631, stores, 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, on the basis of the input operation by the operator to the display input device 143D and the information inputted by the information input-output unit 621. 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, set these points during the operation at any given timing, for example. In this case, 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, for example.
The revolution direction setting unit 623 sets the revolution direction of the work implement 130. The revolution direction setting unit 623 sets a revolution direction in loading revolution control (first revolution control) and returning revolution control (second revolution control) in accordance with a revolution direction of the revolving body 120 in which interference with an interfering object possibly occurs during the loading revolution control (first revolution control) and the returning revolution control (second revolution control).
The revolution direction setting unit 623 sets the revolution direction in a direction over the interference avoiding point (EVP) and for the bucket 133 toward the loading revolution target point TLP (first target point) corresponding to the soil removal position (unloading target position) or for the bucket 133 toward 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 in a case where the automation starting switch 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 of revolving 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 revolution to the left is performed 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 revolution to the left is performed 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 setting is made to the revolution to the left. FIG. 14 illustrates an example in which setting is made to the revolution to the right. In this case, the loading revolution or the returning revolution is performed in a direction in which the interference avoiding point that was taught exists. Thus, it is possible to prevent a situation where, in a case where revolution is performed at or around 180 degrees, it is unsure in which direction the revolution is performed.
In addition, for example, in a case where the target of unloading (loading, soil removal, or the like) is a dump truck 200, and the 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 no interference with the cab 201 of the dump truck 200 occurs, 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 in a case where 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 the soil removal target point PO 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, for example. 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 PO (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 (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 (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 of passing 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 determined in advance, it may be possible to automatically revolve in a direction at the minimum revolution angle.
Note that the revolution direction setting unit 623 may manually perform setting 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 or the ground with which no interfering object exists, the revolution direction setting unit 623 may set the revolution direction to a direction in which the revolution angle is minimum. In addition, it may be possible that the operator can select the setting method on an as-necessary basis through a touching operation to an input operation, for example.
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 it as a starting instruction for the 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 the 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 revolving using one operation switch.
In addition, in a case where the automation starting switch 1432 is one operation switch, when the bucket 133 is positioned above the loading platform 202 or the vessel 206 of the dump truck 200 (when the bucket is positioned within a predetermined range from the first target point) as illustrated, for example, in FIG. 19 and the automation starting switch 1432 is operated, the starting instruction receiving unit 624 receives it as a starting instruction for the returning revolution control (second revolution control), or when the bucket 133 is not positioned above the loading platform 202 or the vessel 206 of the dump truck 200 (hereinafter, simply referred to as a vessel 206) (when the bucket is not positioned within a predetermined range from the first target point), the starting instruction receiving unit 624 receives it 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.
In addition, in a case where the automation starting switch 1432 is one operation switch, when the bucket 133 is at the dumping attitude (when the bucket 133 is at a predetermined unloading attitude) as illustrated in FIG. 21 and the automation starting switch 1432 is operated, the starting instruction receiving unit 624 receives it as a starting instruction for the returning revolution control (second revolution control), or when the bucket 133 is at the holding attitude (when the bucket 133 is at a predetermined loading attitude) as illustrated in FIG. 23, the starting instruction receiving unit 624 receives it 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 faces a direction further away from the work machine 100 than the attitude in which the blade edge 133T of the bucket 133 faces 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 faces a direction further toward the work machine 100 than the attitude in which the blade edge 133T of the bucket 133 is pointed at the vertical direction as illustrated, for example, by the dashed line DL in FIG. 23. It is preferable that the blade edge 133T should face upward equal to or more upward than a direction perpendicular to the vertical direction, as illustrated by the dashed line DL in FIG. 21. Note that the attitude of the bucket 133 may be corrected on the basis of the pitch angle of the work machine 100.
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 at 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 at 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.
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.
In addition, it may be possible to employ a configuration in which, in a case where the automation starting switch 1432 is one operation switch, when the switch is operated and the bucket 133 is not at the dumping attitude (when the bucket is not at a predetermined unloading attitude), the starting instruction receiving unit 624 does not receive the operation to the switch, even if the bucket 133 is positioned above the loading platform 202 or the vessel 206 of the dump truck 200 as illustrated, for example, in FIG. 19 (even if the bucket is positioned within a predetermined range from the first target point), or when the switch is operated and the bucket 133 is not at the holding attitude (when the bucket is not at a predetermined loading attitude), the starting instruction receiving unit 624 does not receive the operation to switch, even if the bucket 133 is not positioned above the loading platform 202 or the vessel 206 of the dump truck 200 (even if the bucket is not positioned within a predetermined range from the first target point). The operation example in this case is shown in FIG. 24.
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 at 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 or sound on the display input device 143D, for example, for a predetermined period of time to indicate 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.
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 or sound on the display input device 143D, for example, for a predetermined period of time to indicate 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.
In addition, in a case where the automation starting switch 1432 includes two operation switches (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 of the automation starting switches is provided at the left operation lever and the other one of the automation starting switches is provided at the right operation lever or the like, when 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. In addition, in a case where a plurality of automation starting switches are provided at one operation lever, it is more difficult to operate the switch of autonomous driving. However, even in this case, it is possible to prevent erroneous operations.
It may be possible to employ a configuration in which, for example, in a case where the returning revolution automation starting switch 1433 (second operation unit) is operated, the starting instruction receiving unit 624 receives it 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), or in a case where the loading revolution automation starting switch 1432 (first operation unit) is operated, the starting instruction receiving unit 624 receives it 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.
The process shown in FIG. 25 is started in a case where 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 information on the position of 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 or sound on the display input device 143D, for example, for a predetermined period of time to indicate 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.
It may be possible to employ a configuration in which, for example, in a case where the loading revolution automation starting switch 1432 (first operation unit) is operated, the starting instruction receiving unit 624 receives the operation to the switch 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), or in a case where the returning revolution automation starting switch 1433 (second operation unit) is operated, the starting instruction receiving unit 624 receives the operation to the switch 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.
The process shown in FIG. 26 is started in a case where 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 or sound on the display input device 143D, for example, for a predetermined period of time to indicate 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.
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.
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.
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.
Furthermore, when 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. In addition, when 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.
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.
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 of passing through the interference avoiding vertical plane VS.
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.
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.
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 up to the interference avoiding point EVP (step S902). After passing through the interference avoiding point, 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.
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 up to 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 up to the interference avoiding vertical plane (VS) (step S905). After the interference avoiding point 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 (returning revolution target attitude) (step S906), and ends the process shown in FIG. 27.
With the present embodiment, the control device is able to determine whether the operation to the switch is an appropriate operation, on the basis of information concerning the position and the attitude of the work implement such as a bucket and an autonomous driving operation assigned to the operated switch, making it possible to prevent erroneous switch operation. Thus, the present embodiment makes it possible to improve usability in the automatic revolution control.
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.
The control device 61 described in the embodiment can be understood in the following manner.
(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 by an operation unit configured to output an instruction signal concerning an automatic operation including the work implement is inputted into the control device, and an automatic operation assigned to the inputted instruction signal is equal to an automatic operation that can be performed on a basis of information regarding the work tool, the control device performs the automatic operation of the inputted instruction signal.
(2) A control device according to a second aspect of the present disclosure provides the control device according to (1), in which the operation unit includes a plurality of operation units.
(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.
(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 a plurality of the operation units are provided at one operation lever.
(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 operation unit includes a plurality of operation units that are provided separately at a plurality of operation levers.
(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 the automatic operation includes a combined operation of the work implement and the revolving body.
(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 the automatic operation is loading revolution or returning revolution.
(8) A control device according to an eighth aspect of the present disclosure provides the control device according to any one of (1) to (7), in which the information concerning the work tool is information indicating a position or an attitude of the work tool.
The control device, the control method, and the work machine according to the present disclosure make it possible to improve usability.
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, wherein
in a case where an instruction signal outputted by an operation unit configured to output an instruction signal concerning an automatic operation including the work implement is inputted into the control device, and an automatic operation assigned to the inputted instruction signal is equal to an automatic operation that can be performed on a basis of information regarding the work tool, the control device performs the automatic operation of the inputted instruction signal.
2. The control device according to claim 1, wherein the operation unit includes a plurality of operation units.
3. The control device according to claim 1, wherein the operation unit is provided at an operation lever.
4. The control device according to claim 1, wherein a plurality of the operation units are provided at one operation lever.
5. The control device according to claim 1, wherein the operation unit includes a plurality of operation units that are provided separately at a plurality of operation levers.
6. The control device according to claim 1, wherein
the automatic operation includes a combined operation of the work implement and the revolving body.
7. The control device according to claim 1, wherein the automatic operation is loading revolution or returning revolution.
8. The control device according to claim 1, wherein the information regarding the work tool is information indicating a position or an attitude of the work tool.
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 including:
in a case where an instruction signal outputted by an operation unit configured to output an instruction signal concerning an automatic operation including the work implement is inputted, and an automatic operation assigned to the inputted instruction signal is equal to an automatic operation that can be performed on a basis of information regarding the work tool, performing the automatic operation of the inputted instruction signal.
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; and
a control device for the work implement, wherein
in a case where an instruction signal outputted by an operation unit configured to output an instruction signal concerning an automatic operation including the work implement is inputted into the control device, and an automatic operation assigned to the inputted instruction signal is equal to an automatic operation that can be performed on a basis of information regarding the work tool, the control device performs the automatic operation of the inputted instruction signal.