WO2025069961A1 - 作業機械 - Google Patents
作業機械 Download PDFInfo
- Publication number
- WO2025069961A1 WO2025069961A1 PCT/JP2024/031630 JP2024031630W WO2025069961A1 WO 2025069961 A1 WO2025069961 A1 WO 2025069961A1 JP 2024031630 W JP2024031630 W JP 2024031630W WO 2025069961 A1 WO2025069961 A1 WO 2025069961A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- rotation
- bucket
- angle
- rotating body
- control device
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Classifications
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F3/00—Dredgers; Soil-shifting machines
- E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
- E02F3/28—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
- E02F3/36—Component parts
- E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
- E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
-
- E—FIXED CONSTRUCTIONS
- E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
- E02F—DREDGING; SOIL-SHIFTING
- E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
- E02F9/20—Drives; Control devices
Definitions
- the present invention relates to a work machine.
- working machines such as hydraulic excavators that have a rotating body rotatably attached to a running body and a multi-jointed working device attached to the rotating body.
- the working device attached to the hydraulic excavator has a boom rotatably attached to the rotating body, an arm rotatably attached to the boom, and a bucket rotatably attached to the arm.
- Hydraulic excavators perform the following operations to excavate and load materials: an excavation operation to excavate soil and sand, a transport operation to transport the excavated material to above the loading platform of the loading machine such as a dump truck, a discharge operation to discharge the excavated material onto the loading platform of the loading machine, and a return operation to move the working equipment to the excavation position.
- Patent Document 1 discloses a control device and control method for a work machine (loading machine) that automatically performs a return operation.
- the control device for a loading machine is a control device for a loading machine that includes a rotating body that rotates around a rotation center and a working machine having a bucket and attached to the rotating body, and includes a loading target identification unit that identifies the position and shape of the loading target, an avoidance position identification unit that identifies an interference avoidance position that is a position a predetermined distance outside the loading target based on the position and shape of the loading target, and a movement processing unit that outputs an operation signal to drive only the rotating body until the bucket reaches the interference avoidance position from the loading position on the loading target, and outputs an operation signal to drive the rotating body and the working machine after the bucket reaches the interference avoidance position, and to move the bucket to an excavation position on the excavation target.”
- Patent Document 1 states that "When automatic excavation and loading control is executed continuously, the empty rotation start position P01 coincides with the loading position P07," "When the position P of the tip of the arm 132 reaches the loading position P07, the rotation of the rotating body 120 stops,” and "When the bucket 133 reaches the loading position P07, the movement processing unit 1112 generates a dump operation signal for rotating the bucket 133 in the dumping direction.”
- the rotating body is stopped while the bucket is rotated to discharge soil onto the loaded machine. Therefore, in order to perform the return operation, it is necessary to output a rotation operation command to rotate the rotating body after the soil discharge is completed.
- the present invention aims to improve productivity by smoothly transitioning from a state in which the work equipment is operating independently (e.g., a state in which an excavation operation or a discharge operation is being performed) to an operation that requires a rotation operation (e.g., a transport operation or a return operation).
- a state in which the work equipment is operating independently e.g., a state in which an excavation operation or a discharge operation is being performed
- an operation that requires a rotation operation e.g., a transport operation or a return operation.
- the working machine includes a travelling body, a rotating body provided so as to be rotatable with respect to the travelling body, a working device attached to the rotating body and having a boom, an arm and a bucket, an attitude detection device for detecting the attitude of the rotating body and the attitude of the working device, a vessel position detection device for detecting the position of a vessel of a loading machine into which the excavated material excavated by the working device is loaded, and a control device for performing automatic rotation control for automatically rotating the rotating body at least to a rotation completion angle which is a target rotation angle based on the detection results of the attitude detection device and the vessel position detection device.
- the control device determines whether or not a rotation start condition for starting the automatic rotation control of the rotating body is satisfied based on the rotation operation state of the rotating body and the operation state of the working device, and when it is determined that the rotation start condition is satisfied, outputs a rotation operation start command for starting the rotation of the rotating body toward the rotation completion angle at the timing when the rotation start condition is satisfied, regardless of whether the working device is in an operating state or not.
- the present invention improves productivity by smoothly transitioning the working device from a state in which it is operating independently to an operation that requires a rotational movement.
- FIG. 1 is a side view of a hydraulic excavator 1 according to the first embodiment.
- FIG. 2 is a diagram showing the hydraulic excavator 1 and a loaded machine 200.
- FIG. 3 is a schematic diagram of a hydraulic drive system 50 of the hydraulic excavator 1.
- FIG. 4 is a functional block diagram of the control device 40 according to the first embodiment.
- FIG. 5 is a diagram showing the shovel reference coordinate system as viewed from the Y-axis direction.
- FIG. 6 is a diagram showing the shovel reference coordinate system as viewed from the Z-axis direction.
- FIG. 7 is an explanatory diagram of the excavation operation.
- FIG. 8 is an explanatory diagram of the transport operation and the soil releasing operation.
- FIG. 9 is an explanatory diagram of the return operation.
- FIG. 10 is a flowchart showing an example of processing by the control device 40 according to the first embodiment, and shows the flow of processing from the start of an excavation operation to the completion of a transport operation.
- FIG. 11 is a flowchart showing an example of the processing by the control device 40 according to the first embodiment, and shows the flow of processing from the start of the soil releasing operation to the completion of the return operation.
- Figure 12 is a diagram showing the time series changes in the ground angle ⁇ of the bucket 10, the presence or absence of a rotation operation command (ON/OFF), and the rotation angle ⁇ sw when an operation transitions from an excavation operation to a transport operation, or from a dumping operation to a return operation, in the first embodiment.
- FIG. 10 is a flowchart showing an example of processing by the control device 40 according to the first embodiment, and shows the flow of processing from the start of an excavation operation to the completion of a transport operation.
- FIG. 11 is a flowchart showing an example of the processing by the control device 40 according to the first embodiment,
- FIG. 13 is a schematic plan view showing a state in which the hydraulic excavator 1 according to the first modification of the first embodiment transitions from the earth releasing operation to the returning operation.
- FIG. 14 is a flowchart showing an example of the processing by the control device 40 according to the first modification of the first embodiment, and shows the flow of processing from the start of the soil releasing operation to the completion of the return operation.
- FIG. 15 is a diagram showing a data table of the third time t3r.
- Figure 16 is a diagram showing the time series changes in the ground angle ⁇ of the bucket 10, the presence or absence of a rotation operation command (ON/OFF), and the rotation angle ⁇ sw when the operation transitions from the soil discharge operation to the return operation in variant example 1 of the first embodiment.
- FIG. 17 is a functional block diagram of a control device 240 according to the second embodiment.
- FIG. 18 is a flowchart showing an example of processing by the control device 240 according to the second embodiment, and shows the flow of processing from the start of an excavation operation to the completion of a transport operation.
- FIG. 19 is a flowchart showing an example of the processing by the control device 240 according to the second embodiment, and shows the flow of processing from the start of the soil releasing operation to the completion of the return operation.
- FIG. 20 is a diagram showing the time series changes in the weight (excavation amount) W of the transported object in the bucket 10, whether a rotation operation command is output (ON/OFF), and the rotation angle ⁇ sw when the operation transitions from an excavation operation to a transport operation.
- FIG. 20 is a diagram showing the time series changes in the weight (excavation amount) W of the transported object in the bucket 10, whether a rotation operation command is output (ON/OFF), and the rotation angle ⁇ sw when the operation transitions from an
- FIG. 21 is a diagram showing the time series changes in the reduction rate Pd of the transported goods in the bucket 10, the output (ON/OFF) of a swing operation command, and the swing angle ⁇ sw when the operation transitions from the soil-discharging operation to the return operation.
- FIG. 22 is a diagram showing the relationship between the reduction rate Pd of the transported goods and the ground angle ⁇ of the bucket 10.
- FIG. 23 is a diagram showing the ground angle conversion tables Tc1 and Tc2 after correction.
- FIG. 24 is a functional block diagram of a control device 340 according to the third embodiment.
- FIG. 25 is a flowchart showing an example of processing by the control device 340 according to the third embodiment, and shows the flow of processing from the start of an excavation operation to the completion of a transport operation.
- FIG. 26 is a flowchart showing an example of processing by the control device 340 according to the third embodiment, and shows the flow of processing from the start of the soil releasing operation to the completion of the return operation.
- traveling hydraulic motor 4 when there are multiple identical components, a lowercase alphabet letter may be added to the end of the reference numeral. In addition, the multiple components may be collectively referred to without the lowercase alphabet letter. For example, when there are two identical traveling hydraulic motors 4a, 4b, these may be collectively referred to as traveling hydraulic motor 4.
- FIG. 1 is a side view of a hydraulic excavator 1 according to a first embodiment of the present invention.
- Fig. 2 is a diagram showing the hydraulic excavator 1 and a loaded machine 200.
- the hydraulic excavator 1 as a work machine performs an excavation operation for excavating a surface to be excavated, such as the ground, and a loading operation for loading the excavated material, such as soil and sand, onto a loaded machine 200, such as a transport vehicle including a dump truck.
- the hydraulic excavator 1 performs an excavation operation in which the bucket 10 is used to excavate soil and other excavation objects, a transport operation in which the rotating body 7 is rotated to transport the excavated material in the bucket 10 to above the loaded machine 200, a soil discharge operation (discharge operation) in which the bucket 10 is moved in the dump direction to discharge the excavated material onto the loading platform (tray, vessel) 201 of the loaded machine 200, and a return operation in which the bucket 10 is moved from above the loaded machine 200 to a position for performing the next excavation operation.
- This excavation and loading cycle is performed multiple times for one loaded machine 200.
- the hydraulic excavator 1 shown in FIG. 1 comprises a vehicle body (machine body) 3 and an articulated working device 2 attached to the vehicle body 3.
- the vehicle body 3 comprises a running body 5 and a rotating body 7 that is rotatable relative to the running body 5.
- the running body 5 travels using a right crawler drive traveling hydraulic motor 4a (see FIG. 3) that drives the right crawler, and a left crawler drive traveling hydraulic motor 4b (see FIG. 3) that drives the left crawler.
- the rotating body 7 is attached to the upper part of the running body 5 via a rotating device, and rotates using a rotating hydraulic motor 6 (see FIG. 3) of the rotating device.
- the right crawler drive traveling hydraulic motor 4a and the left crawler drive traveling hydraulic motor 4b are collectively referred to as traveling hydraulic motors 4.
- the work device 2 attached to the rotating body 7 has a number of drive target members (8, 9, 10) that are rotatably connected, and a number of hydraulic cylinders (11, 12, 13) that drive the drive target members.
- the boom 8, arm 9, and bucket 10, which are three drive target members driven by the multiple hydraulic cylinders (11, 12, 13), are connected in series.
- the boom 8 has its base end rotatably connected to the front of the rotating body 7 by a boom pin 8a (see Figure 5).
- the arm 9 has its base end rotatably connected to the tip of the boom 8 by an arm pin 9a.
- the bucket 10 is rotatably connected to the tip of the arm 9 by a bucket pin 10a.
- the boom pin 8a, arm pin 9a, and bucket pin 10a are arranged parallel to one another, and each driven member (8, 9, 10) can rotate relative to one another in the same plane.
- the boom 8 rotates vertically by the extension and retraction of the boom cylinder 11.
- the arm 9 rotates forward and backward (dump direction and cloud direction) by the extension and retraction of the arm cylinder 12.
- the bucket 10 rotates forward and backward (dump direction and cloud direction) by the extension and retraction of the bucket cylinder 13.
- One end of the boom cylinder 11 is connected to the boom 8 and the other end is connected to the frame of the rotating body 7.
- One end of the arm cylinder 12 is connected to the arm 9 and the other end is connected to the boom 8.
- One end of the bucket cylinder 13 is connected to the bucket 10 via a bucket link 16 and the other end is connected to the arm 9.
- FIG. 3 is a schematic diagram of the hydraulic drive system 50 of the hydraulic excavator 1.
- the hydraulic drive system 50 includes an engine 103, which is a prime mover mounted on the rotating body 7, and a main pump 102 and a pilot pump 104, which are hydraulic pumps driven by the engine 103.
- the main pump 102 and the pilot pump 104 are driven by the engine 103 and discharge hydraulic oil.
- the hydraulic drive system 50 includes a flow control valve 101 that controls the flow rate and flow direction of hydraulic oil discharged from the main pump 102, a plurality of electromagnetic proportional valves 51 that output an operating pressure as an operating signal to the flow control valve 101, a control device 40 that outputs a control signal to the electromagnetic proportional valve 51, operation devices 20, 21 that are operated by an operator and output a signal corresponding to the operation amount and operation direction to the control device 40, and a control selection switch 24 that outputs a control switching signal to the control device 40 to switch between automatic control and manual control depending on the operation of the operator.
- the operation devices 20, 21 and the control selection switch 24 are installed in a cab 71 (see FIG. 1) provided on the rotating body 7.
- the work operation device 20 includes a work operation right lever 22a for operating the boom 8 and bucket 10, and a work operation left lever 22b for operating the arm 9 and the rotating body 7.
- the operation device 20 functions as a boom operation device, a bucket operation device, an arm operation device, and a swing operation device 28.
- the boom operation device, the bucket operation device, and the arm operation device are also collectively referred to as work operation devices 29.
- the travel operation device 21 includes a travel operation right lever 23a for operating the right crawler, and a travel operation left lever 23b for operating the left crawler.
- the work operation right lever 22a and the work operation left lever 22b are collectively referred to as the operation lever 22, and the travel operation right lever 23a and the travel operation left lever 23b are collectively referred to as the operation lever 23.
- the control selection switch 24 is provided on one of the operation levers 22a, 22b, 23a, 23b.
- the control selection switch 24 may be configured as a touch sensor of a touch panel provided in the operator's cab 71.
- the control selection switch 24 is an operation switch for switching between a manual mode in which the operation of the hydraulic excavator 1 is controlled in response to the operation of the operation device 20, and an automatic mode in which the operation of the hydraulic excavator 1 is controlled in response to a target route set by the control device 40.
- the operator can use the control selection switch 24 to select either the manual mode or the automatic mode at any time.
- the operation system according to this embodiment is an electric lever type operation system in which an electrical signal indicating the amount and direction of operation is input from the operation device 20 to the control device 40, a control signal is output from the control device 40 to the electromagnetic proportional valve 51, and an operating pressure is output from the electromagnetic proportional valve 51 to the flow control valve 101.
- the hydraulic excavator 1 has an operation detection device 56 that detects the amount and direction of operation of the operation levers 22, 23 and outputs a signal indicating the detection result to the control device 40.
- the operation detection device 56 has an operation amount sensor 52a that detects the amount of arm operation (arm crowding operation amount and arm dumping operation amount) by the work operation left lever 22b, an operation amount sensor 52b that detects the amount of rotation operation (right rotation operation amount and left rotation operation amount) by the work operation left lever 22b, an operation amount sensor 52c that detects the amount of boom operation (boom raising operation amount and boom lowering operation amount) by the work operation right lever 22a, an operation amount sensor 52d that detects the amount of bucket operation (bucket crowding operation amount and bucket dump operation amount) by the work operation right lever 22a, an operation amount sensor 52e that detects the amount of right crawler forward operation and right crawler backward operation by the travel operation right lever 23a, and an operation amount sensor 52f that detects the amount of left crawler forward operation and left crawler backward
- the multiple operation amount sensors 52 are, for example, rotary encoders or potentiometers capable of detecting the amount and direction of operation of the operating levers 22, 23.
- the control device 40 controls the rotational movement of the work device 2, the running movement of the running body 5, and the rotational movement of the rotating body 7 according to the operation information (amount and direction of operation) of the operating levers 22, 23 by the operator.
- the operating pressure output by the solenoid proportional valve 51 is guided to the pressure receiving chamber of the spool valve, and the spool operates.
- the hydraulic oil discharged from the main pump 102 is supplied to the corresponding hydraulic actuator through the spool valve, and the hydraulic actuator is operated.
- the electromagnetic proportional valves 51a, 51b output operating pressure for controlling the pressurized oil supplied to the swing hydraulic motor 6 to the pressure receiving chamber of the spool valve of the flow control valve 101 for driving the swing hydraulic motor 6.
- the electromagnetic proportional valves 51c, 51d output operating pressure for controlling the pressurized oil supplied to the arm cylinder 12 to the pressure receiving chamber of the spool valve of the flow control valve 101 for driving the arm cylinder 12.
- the electromagnetic proportional valves 51e, 51f output operating pressure for controlling the pressurized oil supplied to the boom cylinder 11 to the pressure receiving chamber of the spool valve of the flow control valve 101 for driving the boom cylinder 11.
- the electromagnetic proportional valves 51g, 51h output operating pressure for controlling the pressurized oil supplied to the bucket cylinder 13 to the pressure receiving chamber of the spool valve of the flow control valve 101 for driving the bucket cylinder 13.
- the electromagnetic proportional valves 51i and 51j output operating pressure for controlling the pressure oil supplied to the travel hydraulic motor 4a to the pressure receiving chamber of the spool valve for driving the travel hydraulic motor 4a of the flow control valve 101.
- the electromagnetic proportional valves 51k and 51l output operating pressure for controlling the pressure oil supplied to the travel hydraulic motor 4b to the pressure receiving chamber of the spool valve for driving the travel hydraulic motor 4b of the flow control valve 101.
- the boom cylinder 11, arm cylinder 12, and bucket cylinder 13 each extend and retract with the supplied pressure oil, rotating the boom 8, arm 9, and bucket 10. This changes the position of the bucket 10 and the attitude of the work device 2.
- the swing hydraulic motor 6 rotates with the supplied pressure oil, rotating the swing body 7.
- the traveling hydraulic motor 4a and traveling hydraulic motor 4b rotate with the supplied pressure oil, moving the traveling body 5. Note that even if the operator does not operate the operating levers 22, 23, the hydraulic actuators (4a, 4b, 6, 11, 12, 13) can be driven by operating the electromagnetic proportional valves 51a-51l and the flow control valve 101 with a control signal from the control device 40.
- the hydraulic excavator 1 is equipped with a posture detection device 53 that detects the posture of the vehicle body 3 (swivel body 7) and the posture of the work device 2, including the ground angle of the bucket 10.
- the posture detection device 53 is composed of a plurality of posture sensors, namely, a boom angle sensor 14, an arm angle sensor 15, a bucket angle sensor 17, a tilt angle sensor 18, and a swing angle sensor 19.
- the boom angle sensor 14 is attached to the boom pin 8a, detects the rotation angle of the boom 8 relative to the swing body 7, and outputs a signal representing the detection result to the control device 40.
- the arm angle sensor 15 is attached to the arm pin 9a, detects the rotation angle of the arm 9 relative to the boom 8, and outputs a signal representing the detection result to the control device 40.
- the bucket angle sensor 17 is attached to the bucket link 16, detects the rotation angle of the bucket 10 relative to the arm 9, and outputs a signal representing the detection result to the control device 40.
- the control device 40 obtains the rotation angles of the boom 8, arm 9, and bucket 10 by the angle sensors 14, 15, and 17.
- the control device 40 may acquire each rotation angle by detecting each angle of the boom 8, arm 9, and bucket 10 relative to a reference plane such as a horizontal plane using an inertial measurement unit (IMU) and converting it into each rotation angle of the boom 8, arm 9, and bucket 10.
- the control device 40 may also acquire each rotation angle by detecting each stroke of the boom cylinder 11, arm cylinder 12, and bucket cylinder 13 using a stroke sensor and converting it into each rotation angle of the boom 8, arm 9, and bucket 10.
- the rotation angles of the boom 8, arm 9, and bucket 10 are parameters that represent the attitude of the work device 2. That is, the boom angle sensor 14, arm angle sensor 15, and bucket angle sensor 17 function as attitude sensors that detect the attitude of the work device 2. Also, the tilt angle of the rotating body 7 and the rotation angle of the rotating body 7 relative to the running body 5 are parameters that represent the attitude of the rotating body 7 (vehicle body 3). That is, the tilt angle sensor 18 and the rotation angle sensor 19 function as attitude sensors that detect the attitude of the rotating body 7 (vehicle body 3).
- the hydraulic excavator 1 is equipped with an object detection device 54 that detects objects present within a detection range set around the hydraulic excavator 1.
- the object detection device 54 also detects the shape, type (excavated material, loading platform 201, etc.) and position of the object.
- the object detection device 54 is, for example, a LiDAR (Light Detection And Ranging) or a stereo camera, and is attached to the top of the driver's cab 71, etc. (see Figure 1).
- the object detection device 54 detects the loading platform 201 of the loading machine 200 onto which the excavated material excavated by the work device 2 is loaded, and detects position information (relative position) of the loading platform 201 with respect to the object detection device 54.
- the object detection device 54 functions as a vessel position detection device that detects the position of the loading platform (vessel) 201.
- the object detection device 54 also detects the shape of the terrain 210 (see FIG. 2) to be excavated. Note that multiple object detection devices 54 may be attached to the hydraulic excavator 1.
- the hydraulic excavator 1 is equipped with a hydraulic oil temperature sensor 55 that detects the temperature of the hydraulic oil discharged from the main pump 102.
- the hydraulic oil temperature sensor 55 is installed, for example, in a hydraulic oil tank or piping.
- the control device 40 is a computer in which processing devices such as a CPU (Central Processing Unit), MPU (Micro Processing Unit), and DSP (Digital Signal Processor), internal storage devices such as RAM (Random Access Memory) and ROM (Read Only Memory), and an external I/F (Interface) are connected to each other via a bus.
- processing devices such as a CPU (Central Processing Unit), MPU (Micro Processing Unit), and DSP (Digital Signal Processor), internal storage devices such as RAM (Random Access Memory) and ROM (Read Only Memory), and an external I/F (Interface) are connected to each other via a bus.
- An operation detection device 56, a posture detection device 53, an object detection device 54, a control selection switch 24, a hydraulic oil temperature sensor 55, an input device 57, and external storage devices such as a hard disk drive and large-capacity flash memory are connected to the external I/F of the control device 40.
- the ROM stores programs capable of executing various calculations.
- the ROM is a storage medium capable of reading programs that realize the functions of this embodiment.
- the processing device is a calculation device that expands the programs stored in the ROM into the RAM and executes the calculations, and performs predetermined calculation processing on signals received from the external I/F and storage devices (internal storage device and external storage device) in accordance with the programs.
- the input section of the external I/F converts signals input from various devices (operation detection device 56, attitude detection device 53, object detection device 54, hydraulic oil temperature sensor 55, control selection switch 24, input device 57, etc.) into data that can be calculated by the processing device.
- the output section of the external I/F generates an output signal according to the calculation result in the processing device, and outputs the signal to various devices (electromagnetic proportional valve 51, etc.).
- the attitude detection device 53 includes attitude sensors (14, 15, 17) that detect the attitude of the above-mentioned working device 2, and attitude sensors (18, 19) that detect the attitude of the rotating body 7 (vehicle body 3).
- the control device 40 controls the operation of the rotating body 7 and the work device 2 based on the operation information detected by the operation detection device 56.
- the control device 40 controls the operation of the rotating body 7 and the work device 2 based on the attitude of the rotating body 7 and the work device 2 and the position information of the loading platform 201.
- the control device 40 automatically operates the working device 2 from the operation start posture to the operation completion posture based on the detection results of the posture detection device 53 and the object detection device 54. Furthermore, when the transport operation and the return operation are performed automatically, the control device 40 automatically rotates the rotating body 7 from the rotation start angle to the rotation completion angle (executes automatic rotation control) based on the detection results of the posture detection device 53 and the object detection device 54, and automatically operates the working device 2 from the operation start posture to the operation completion posture.
- FIG. 4 is a functional block diagram of the control device 40. As shown in FIG. 4, the control device 40 executes programs stored in the ROM to function as an attitude calculation unit 41, an object position calculation unit 42, an operation transition determination unit 49, a turning start determination unit 43, an excavation control unit 44, a transportation control unit 45, a soil release control unit 46, a return control unit 47, and an actuator command unit 48.
- programs stored in the ROM to function as an attitude calculation unit 41, an object position calculation unit 42, an operation transition determination unit 49, a turning start determination unit 43, an excavation control unit 44, a transportation control unit 45, a soil release control unit 46, a return control unit 47, and an actuator command unit 48.
- the ROM of the control device 40 stores in advance the shovel reference coordinate system used to identify the position and posture of the components of the hydraulic excavator 1, the dimensions of the components of the hydraulic excavator 1, and data on the mounting position of the object detection device 54.
- the shovel reference coordinate system of this embodiment is defined as a right-handed coordinate system with the origin O being the point where the central axis of rotation intersects with the ground G.
- the forward movement direction of the traveling body 5 is defined as the positive direction of the X-axis.
- the direction extending upward from the origin O parallel to the central axis of rotation is defined as the positive direction of the Z-axis.
- the direction perpendicular to each of the X-axis and Z-axis is defined as the positive direction of the Y-axis, and the left side of the traveling body 5.
- the shovel reference coordinate system of this embodiment is a coordinate system set based on the traveling body 5, and the XY plane is fixed to the ground (traveling surface) G on which the traveling body 5 contacts.
- the rotation angle ⁇ sw of the rotating body 7 is 0 degrees when the hydraulic excavator 1 is in the reference posture, i.e., when the work device 2 is parallel to the X-axis.
- the rotation angle ⁇ sw of the rotating body 7 is 0 degrees
- the operating plane of the work device 2 is parallel to the XZ plane
- the lifting direction of the boom 8 is the positive direction of the Z-axis
- the dumping direction of the arm 9 and bucket 10 is the positive direction of the X-axis.
- the attitude calculation unit 41 calculates the attitude of the components of the hydraulic excavator 1 in the excavator reference coordinate system from the detection signal of the attitude detection device 53. Specifically, the attitude calculation unit 41 calculates the rotation angle of the boom 8 with respect to the X-axis (hereinafter also referred to as the boom angle) ⁇ bm from the detection signal of the rotation angle of the boom 8 output from the boom angle sensor 14. The attitude calculation unit 41 calculates the rotation angle of the arm 9 with respect to the boom 8 (hereinafter also referred to as the arm angle) ⁇ am from the detection signal of the rotation angle of the arm 9 output from the arm angle sensor 15.
- the attitude calculation unit 41 calculates the rotation angle of the bucket 10 with respect to the arm 9 (hereinafter also referred to as the bucket angle) ⁇ bk from the detection signal of the rotation angle of the bucket 10 output from the bucket angle sensor 17.
- the attitude calculation unit 41 calculates the rotation angle ⁇ sw of the rotating body 7 relative to the X-axis (traveling body 5) from the detection signal of the rotation angle of the rotating body 7 output from the rotation angle sensor 19.
- the posture calculation unit 41 calculates the positions of the boom 8, arm 9, and bucket 10 in the shovel reference coordinate system, that is, the planar positions specified by the X and Y coordinates, and the heights from the ground G specified by the Z coordinate, based on the calculated rotation angles ⁇ bm, ⁇ am, and ⁇ bk of the working device 2 and the rotation angle ⁇ sw of the rotating body 7, as well as the boom length Lbm, arm length Lam, and bucket length Lbk.
- the boom length Lbm is the length from the boom pin 8a to the arm pin 9a.
- the arm length Lam is the length from the arm pin 9a to the bucket pin 10a.
- the bucket length Lbk is the length from the bucket pin 10a to the tip (tip) of the bucket 10.
- the boom pin 8a is located at a position offset by Lox in the X-axis direction from the rotation center axis (Z-axis) when the rotation angle is set to 0 degrees.
- the attitude calculation unit 41 calculates the inclination angle (pitch angle and roll angle) of the vehicle body 3 (traveling body 5) with respect to a reference plane from the detection signal of the inclination angle of the vehicle body 3 output from the inclination angle sensor 18.
- the reference plane is, for example, a horizontal plane perpendicular to the direction of gravity.
- the attitude calculation unit 41 calculates the ground angle ⁇ , which is the angle of the bucket 10 with respect to a horizontal plane (ground G) perpendicular to the direction of gravity, from the inclination angle of the vehicle body 3 and each rotation angle ⁇ bm, ⁇ am, ⁇ bk of the work device 2.
- the ground angle ⁇ of the bucket 10 is the angle that a straight line SL passing through the tip of the bucket 10 and the bucket pin 10a makes with respect to the horizontal plane (ground G).
- the ground angle ⁇ of the bucket 10 is 0 (zero) degrees when the opening of the bucket 10 faces upward and the straight line SL is parallel to the horizontal plane (ground G), and increases as the bucket dump operation progresses.
- the ground angle ⁇ of the bucket 10 is 180 degrees when the opening of the bucket 10 faces downward and the line SL is parallel to the horizontal plane (ground surface G).
- the object position calculation unit 42 shown in FIG. 4 calculates the position of the platform 201 of the loaded machine 200 in the shovel reference coordinate system (the planar position specified by the X and Y coordinates, and the height from the ground G specified by the Z coordinate) based on the position information of the platform 201 detected by the object detection device 54, the rotation angle ⁇ sw of the rotating body 7 calculated by the attitude calculation unit 41, and the mounting position of the object detection device 54 in the shovel reference coordinate system.
- the position information of the platform 201 is information on the relative position of the platform 201 of the loaded machine 200 with respect to the object detection device 54.
- the control device 40 uses the object detection device 54 to obtain the relative position of the platform 201 with respect to the hydraulic excavator 1 (X, Y, Z coordinates in the shovel reference coordinate system).
- the position information of the platform 201 acquired by the control device 40 is, for example, the position coordinates of the four corners of the top surface of the platform 201, which is rectangular in plan view, i.e., the position coordinates of the front and rear ends of the upper edge of the left side (left end) of the platform 201 and the front and rear ends of the upper edge of the right side (right end).
- the position information of the platform 201 acquired by the control device 40 includes information on the relative position and relative angle of the platform 201 with respect to the rotating body 7.
- control device 40 uses the object detection device 54 to acquire various pieces of information regarding the relative position of the platform 201 of the loading machine 200, on which the excavated material excavated by the working device 2 is loaded, relative to the working device 2, as relative position information.
- the object position calculation unit 42 calculates the position information of characteristic points (e.g., the toe, the bottom, etc.) of the shape of the terrain 210 to be excavated, in the same way as it calculates the position information of the loading platform 201.
- characteristic points e.g., the toe, the bottom, etc.
- the soil discharge control unit 46 calculates a target route for releasing the excavated material held in the bucket 10 onto the platform 201 of the loaded machine 200, and the target speed of each hydraulic actuator on the target route.
- the return control unit 47 calculates a target route for moving the bucket 10 from the platform 201 of the loaded machine 200 to the next excavation start position, and a target speed of each hydraulic actuator on the target route. Note that the target speed on the target route can also be said to be the target speed for each calculation cycle (control cycle).
- the excavation control unit 44, the transport control unit 45, the soil discharge control unit 46, and the return control unit 47 perform various calculations in different work situations, but have similar functions, and therefore are collectively referred to as the operation control unit 400 below.
- the operation control unit 400 generates a target path for the control point of the work device 2 (e.g., the tip of the bucket 10).
- the operation control unit 400 also calculates a target value ⁇ t of the ground angle of the bucket 10 on the target path.
- the operation control unit 400 makes the tip of the bucket 10 follow the target path, and calculates the target speed of each hydraulic actuator to make the actual ground angle ⁇ of the bucket 10 follow the target value ⁇ t.
- FIG. 7 is an explanatory diagram of the excavation operation.
- the excavation control unit 44 generates an excavation start position DP1, an excavation completion position DP2, and a target path DPT for the excavation operation, which is a path connecting the excavation start position DP1 and the excavation completion position DP2.
- the excavation control unit 44 also sets a target value ⁇ t for the ground angle of the bucket 10 on the target path DPT. In this way, the excavation control unit 44 sets target values for both the position and angle of the bucket 10 in order to move a control point such as the tip of the bucket 10 along the target path DPT.
- FIG. 8 is an explanatory diagram of the transport operation and the soil dumping operation.
- the transport control unit 45 generates a transport start position CP1, a transport completion position CP2, and a target path CPT for the transport operation, which is a path connecting the transport start position CP1 and the transport completion position CP2.
- the transport start position CP1 and the transport completion position CP2 can be determined by the turning angle ⁇ sw and the attitude of the work device 2.
- the turning angle ⁇ sw at the transport start position CP1 is the angle at which turning for the transport operation starts, and is hereinafter also referred to as the turning start angle of the transport operation.
- the turning angle ⁇ sw at the transport completion position CP2 is the angle at which turning for the transport operation is completed, and is hereinafter also referred to as the turning completion angle of the transport operation.
- the soil dumping control unit 46 generates a soil dumping start position LP1, a soil dumping completion position LP2, and a target path LPT for the soil dumping operation, which is a path connecting the soil dumping start position LP1 and the soil dumping completion position LP2.
- the return control unit 47 generates a return start position RP1, a return completion position RP2, and a target path RPT for the return movement, which is a path connecting the return start position RP1 and the return completion position RP2.
- the return start position RP1 and the return completion position RP2 can be determined by the rotation angle ⁇ sw and the posture of the working device 2.
- the rotation angle ⁇ sw at the return start position RP1 is the angle at which rotation for the return movement starts, and is hereinafter also referred to as the rotation start angle of the return movement.
- the rotation angle ⁇ sw at the return completion position RP2 is the angle at which rotation for the return movement is completed, and is hereinafter also referred to as the rotation completion angle of the return movement.
- the transport control unit 45, the soil discharge control unit 46, and the return control unit 47 like the excavation control unit 44, set target values for both the position and angle of the bucket 10 to move the tip of the bucket 10 along the target path CPT, LPT, RPT.
- Each operation control unit 400 (excavation control unit 44, transport control unit 45, soil discharge control unit 46, and return control unit 47) shown in FIG. 4 calculates the target speed of each hydraulic actuator based on the target values of the position and angle of the bucket 10.
- the motion transition determination unit 49 determines whether each motion transition condition from excavation to transport, from transport to dumping, from dumping to return, and from return to excavation is met. If a motion transition condition is met, the motion transition determination unit 49 generates a start command to start the next motion. The motion transition condition is met when the tip of the bucket 10 reaches the completion position of the target path, and is not met when the tip of the bucket 10 has not reached the completion position of the target path.
- the operation transition determination unit 49 determines that the operation transition condition from the excavation operation to the transport operation is met, and outputs a command to start the transport operation to the transport control unit 45.
- the operation transition determination unit 49 also sets the control mode to either the automatic mode or the manual mode based on an operation command from the control selection switch 24.
- the actuator command unit 48 calculates a target speed according to the amount of operation of the operating lever 22 detected by the operation detection device 56. Furthermore, the actuator command unit 48 calculates a control current value to the electromagnetic proportional valve 51 according to the calculated target speed, and outputs a control current according to the calculation result to the electromagnetic proportional valve 51. In other words, the actuator command unit 48 outputs a control signal to the electromagnetic proportional valve 51 so that the boom cylinder 11, arm cylinder 12, bucket cylinder 13, and swing hydraulic motor 6 operate at a target speed according to the amount of operation detected by the operation detection device 56.
- the actuator command unit 48 calculates the control current value to the electromagnetic proportional valve 51 according to the target speed calculated by the operation control unit 400, and outputs a control current according to the calculation result to the electromagnetic proportional valve 51.
- the actuator command unit 48 outputs a control signal (operation command) to the electromagnetic proportional valve 51 so that the boom cylinder 11, arm cylinder 12, bucket cylinder 13, and swing hydraulic motor 6 operate at the target speed calculated by the operation control unit 400.
- control signal output from the actuator command unit 48 to the electromagnetic proportional valves 51a, 51b in order to operate the swing hydraulic motor 6 is referred to as a “swing operation command”, and in particular, a swing operation command that starts the swing of the swing body 7 when the swing operation of the swing body 7 is stopped is referred to as a “swing operation start command”.
- the control device 40 when an excavation operation is being performed, the control device 40 outputs a rotation operation start command for the transport operation before the operation transition condition from the excavation operation to the transport operation is met, so that the rotating body 7 is rotated immediately after the excavation operation is completed.
- the control device 40 when an earth dumping operation is being performed, the control device 40 outputs a rotation operation start command for the return operation before the operation transition condition from the earth dumping operation to the return operation is met, so that the rotating body 7 is rotated immediately after the earth dumping operation is completed.
- the rotation start determination unit 43 determines whether or not to output a rotation operation start command for executing an operation that requires rotation (transport operation and return operation) without waiting for the completion of the previous work (digging operation and soil dumping operation). In other words, the rotation start determination unit 43 has a function of determining the timing to output a rotation operation start command.
- the excavation operation completion angle ⁇ 1c is the completion angle of the operation of the working device 2 excavating the excavation target.
- the posture of the working device 2 when the ground angle ⁇ of the bucket 10 reaches the excavation operation completion angle ⁇ 1c is referred to as the excavation operation completion posture.
- the earth discharge operation completion angle ⁇ 1r is the completion angle of the operation of the working device 2 releasing the excavated material in the bucket 10 above the loading platform 201.
- the posture of the working device 2 when the ground angle ⁇ of the bucket 10 reaches the earth discharge operation completion angle ⁇ 1r is referred to as the earth discharge operation completion posture.
- the digging operation completion posture and the soil discharge operation completion posture are collectively referred to as the operation completion posture.
- the digging operation completion angle ⁇ 1c and the soil discharge operation completion angle ⁇ 1r are collectively referred to as the operation completion angle ⁇ 1.
- the rotation start determination unit 43 determines whether or not a rotation start condition for starting automatic rotation control of the rotating body 7 is satisfied when the rotation operation of the rotating body 7 has stopped and the work device 2 is operating.
- the rotation start condition is satisfied when it is predicted that the rotation of the rotating body 7 will start after the ground angle ⁇ of the bucket 10 reaches the operation completion angle ⁇ 1 if a rotation operation start command is output at the current time.
- the rotation start condition is met when the working device 2, while moving toward the operation completion posture, reaches a specified posture before the operation completion posture.
- the specified posture is a posture in which, if a rotation operation start command is output when the working device 2 is in that posture, the rotation of the rotating body 7 will actually start immediately after the working device 2 reaches the operation completion posture.
- the determination as to whether the rotation start condition is met is made by calculating the first time t1 and the second time t2, and comparing the calculated first time t1 and second time t2.
- the rotation start determination unit 43 calculates the first time t1 from when the rotation operation start command is output to when the operation of the rotating body 7 actually starts.
- the first time t1 when an excavation operation is being performed is referred to as the first time t1c
- the first time t1 when an earth discharge operation is being performed is referred to as the first time t1r.
- the first time t1 may be obtained by performing a calculation using a mathematical model of the hydraulic excavator 1, or by experimentally measuring the time from when a command to start a swing operation is given to the hydraulic excavator 1 until it starts moving and saving the value.
- the mathematical model of the hydraulic excavator 1 is represented, for example, by an equation of motion of a four-link system that operates by a driving torque, with the swing body 7 and the three driven members (boom 8, arm 9, and bucket 10) that make up the work device 2 treated as rigid bodies.
- the driving torque used in the equation of motion can be converted from the pressure acting on each hydraulic actuator.
- a transfer function for a speed command to each hydraulic actuator may be used as the mathematical model of the hydraulic excavator 1.
- the first time t1 taking into account the attitude of the working device 2.
- the first time t1 also changes depending on the temperature of the hydraulic oil (i.e., the viscosity of the hydraulic oil). For this reason, it is preferable to determine the first time t1 taking into account the temperature of the hydraulic oil.
- the rotation start determination unit 43 calculates the first time t1 using characteristic data of the first time t1 according to the posture of the work device 2 (boom angle, arm angle, bucket angle) and the temperature of the hydraulic oil.
- the characteristic data of the first time t1 may be a data table of the first time t1 that changes according to the posture of the work device 2 and the temperature of the hydraulic oil, or may be function data. Note that the characteristic data of the first time t1c and the characteristic data of the first time t1r may be the same or different.
- the rotation start determination unit 43 refers to the characteristic data of the first time t1 and calculates the first time t1 based on the posture of the work device 2 calculated by the posture calculation unit 41 and the temperature of the hydraulic oil detected by the hydraulic oil temperature sensor 55.
- the second time t2c corresponds to the predicted time from the current time until the tip of the bucket 10 reaches the excavation completion position DP2.
- the second time t2r corresponds to the predicted time from the current time until the tip of the bucket 10 reaches the soil discharge completion position LP2.
- the turning start determination unit 43 calculates the second time t2c based on the current attitude of the work device 2 calculated by the attitude calculation unit 41, the target route DPT calculated by the excavation control unit 44, and the target speed of each hydraulic actuator up to the excavation operation completion attitude. Similarly, the turning start determination unit 43 calculates the second time t2r based on the current attitude of the work device 2 calculated by the attitude calculation unit 41, the target route LPT calculated by the soil discharge control unit 46, and the target speed of each hydraulic actuator up to the soil discharge operation completion attitude.
- the second time t2 is not limited to being calculated by the rotation start determination unit 43.
- the excavation control unit 44 or the soil discharge control unit 46 may calculate the second time t2 and output the calculated second time t2 to the rotation start determination unit 43.
- the turn start determination unit 43 determines that the turn start condition is met when the second time t2 becomes shorter than the first time t1, i.e., when the second time t2 transitions from a state in which it is longer than the first time t1 to a state in which it is shorter than the first time t1, and sets a turn flag indicating the determination result to ON.
- the rotation start determination unit 43 determines that the rotating body 7 will start rotating immediately after the control point of the bucket 10 reaches the excavation completion position DP2, and turns on the transport rotation flag.
- the rotation start determination unit 43 determines that the rotating body 7 will start rotating immediately after the control point of the bucket 10 reaches the earth dumping completion position LP2, and turns on the return rotation flag.
- the rotation start determination unit 43 determines that the rotation start condition is met when the second time t2 becomes shorter than the first time t1 due to an operation of the work device 2, such as an excavation operation or a soil dumping operation. In other words, the rotation start determination unit 43 determines whether or not the rotation start condition is met based on the operating state of the work device 2. Furthermore, the rotation start condition is premised on the fact that the rotation operation has stopped. For this reason, the rotation start determination unit 43 determines whether or not the rotation start condition is met based not only on the operating state of the work device 2 but also on the rotation operation state of the rotating body 7.
- the transport control unit 45 starts automatic rotation control of the rotating body 7 during the transport operation while continuing the excavation operation.
- a rotation operation start command that starts the movement of the rotating body 7 in the direction from the transport start position CP1 toward the transport completion position CP2 is output from the actuator command unit 48 to the electromagnetic proportional valve 51.
- the return control unit 47 starts automatic rotation control of the rotating body 7 during the return operation while continuing the earth dumping operation.
- a rotation operation start command that starts the movement of the rotating body 7 in the direction from the return start position RP1 toward the return completion position RP2 is output from the actuator command unit 48 to the electromagnetic proportional valve 51.
- Figure 10 is a flowchart showing an example of processing executed by the control device 40 according to the first embodiment, showing the flow of processing from the start of the excavation operation to the completion of the transport operation.
- Figure 11 is a flowchart showing an example of processing executed by the control device 40 according to the first embodiment, showing the flow of processing from the start of the soil discharge operation to the completion of the return operation.
- a case will be described in which only one excavation operation, one transport operation, one soil discharge operation, and one return operation are executed. However, this series of operations may be executed multiple times. In addition, it is not necessarily necessary to start with an excavation operation.
- step S101 when the control selection switch 24 is operated to set the control mode to automatic mode, the operation transition determination unit 49 sets the control mode to automatic mode.
- the actuator command unit 48 starts an excavation operation by the work device 2 based on the target speed of each hydraulic actuator calculated by the excavation control unit 44. In other words, excavation control by the excavation control unit 44 is started.
- the excavation control unit 44 automatically operates the work device 2 until the ground angle ⁇ of the bucket 10 becomes the excavation operation completion angle ⁇ 1c.
- the rotation start determination unit 43 calculates the time (first time) t1c from when the rotation operation start command for the transport operation is output until the rotating body 7 starts moving. In the next step S103, the rotation start determination unit 43 calculates the time (second time) t2c from the current time until the bucket 10 reaches the excavation completion position DP2.
- step S104 the rotation start determination unit 43 compares the first time t1c with the second time t2c. Through this comparison, the rotation start determination unit 43 determines whether or not the movement of the rotating body 7 in the specified direction will start after the work device 2 reaches the excavation operation completion posture if a rotation operation start command is currently output.
- the process of step S104 is a process for determining whether or not the rotation start condition is satisfied.
- the turning start determination unit 43 determines that the turning start condition is not met and returns the process to step S103. If the first time t1c is greater than the second time t2c, the turning start determination unit 43 determines that the turning start condition is met, sets the transport turning flag to on, and proceeds to step S105.
- step S105 the transport control unit 45 starts controlling the rotating body 7 in the transport operation. That is, in step S105, the transport control unit 45 outputs a rotation operation start command for the transport operation.
- step S106 the operation transition determination unit 49 determines whether the operation transition condition from the excavation operation to the transport operation is satisfied. When the ground angle ⁇ of the bucket 10 reaches the excavation operation completion angle ⁇ 1c and the tip of the bucket 10 reaches the excavation completion position DP2, the operation transition determination unit 49 determines that the operation transition condition from the excavation operation to the transport operation is satisfied, and proceeds to step S107.
- step S106 determines that the operation transition condition from the excavation operation to the transport operation is not satisfied.
- the process of step S106 is repeatedly executed at a predetermined calculation cycle until a positive determination is made.
- step S107 the transport control unit 45 starts controlling the work device 2 during the transport operation. As described above, the control of the rotating body 7 during the transport operation is started before the operation transition condition is met (step S105).
- step S108 when the operation transition condition from the transport operation to the soil dumping operation is met, the transport operation is completed.
- the transport control unit 45 sets the transport rotation flag to off.
- step S109 shown in FIG. 11, and the operation transition determination unit 49 transitions the operation to the soil dumping operation.
- This starts soil dumping control by the soil dumping control unit 46.
- the soil dumping control unit 46 automatically operates the work device 2 until the ground angle ⁇ of the bucket 10 becomes the soil dumping operation completion angle ⁇ 1r.
- the rotation start determination unit 43 calculates the time (first time) t1r until the rotating body 7 starts moving after the return operation rotation command is issued. In the next step S112, the rotation start determination unit 43 calculates the time (second time) t2r from the current time until the bucket 10 reaches the soil discharge completion position LP2.
- step S113 the rotation start determination unit 43 compares the first time t1r with the second time t2r. Through this comparison, the rotation start determination unit 43 determines whether or not the operation of the rotating body 7 in the specified direction will start after the work device 2 reaches the soil discharge operation completion posture when a rotation operation start command is output at the current time.
- the process of step S113 is a process for determining whether or not the rotation start condition is satisfied.
- the turn start determination unit 43 determines that the turn start condition is not met and returns the process to step S112. If the first time t1r is greater than the second time t2r, the turn start determination unit 43 determines that the turn start condition is met, sets the return turn flag to on, and proceeds to step S114.
- step S114 the return control unit 47 starts controlling the revolving body 7 in the return operation. That is, in step S114, the return control unit 47 outputs a rotation operation start command for the return operation.
- step S115 the operation transition determination unit 49 determines whether the operation transition condition from the soil dumping operation to the return operation is satisfied. When the ground angle ⁇ of the bucket 10 reaches the soil dumping operation completion angle ⁇ 1r and the tip of the bucket 10 reaches the soil dumping completion position LP2, the operation transition determination unit 49 determines that the operation transition condition from the soil dumping operation to the return operation is satisfied and proceeds to step S116.
- step S115 is repeatedly executed at a predetermined calculation cycle until a positive determination is made.
- step S116 the return control unit 47 starts controlling the working device 2 during the return operation. As described above, the control of the rotating body 7 during the return operation is started before the operation transition condition is satisfied (step S114).
- next step S108 when the tip of the bucket 10 reaches the return completion position RP2, the return operation is completed.
- the return control unit 47 sets the return swing flag to OFF.
- the process shown in the flowchart of FIG. 11 ends.
- Fig. 12 is a diagram showing the time series changes in the ground angle ⁇ of the bucket 10, the presence or absence of a swing command output (ON/OFF), and the swing angle ⁇ sw when the operation transitions from an excavation operation to a transport operation, or from a dumping operation to a return operation.
- the horizontal axis in Figs. 12(a) to (c) indicates time.
- the vertical axis in Fig. 12(a) indicates the ground angle ⁇ of the bucket 10
- the vertical axis in Fig. 12(b) indicates the presence or absence of a swing command output
- the swing angle ⁇ sw is shown as a graph that increases in the positive direction from the reference position to the operation completion angle, with the position at which the excavation operation or the dumping operation is started as the reference position.
- the time series changes in each parameter of the transition from an excavation operation to a transport operation and the transition from a dumping operation to a return operation are shown in a common graph. However, the time series changes of each parameter during the transition from excavation to transport, and during the transition from dumping to return, are actually different.
- the control device 40 determines whether the rotation start condition is met when the rotation of the rotating body 7 has stopped and the work device 2 is operating automatically so that the ground angle ⁇ of the bucket 10 approaches the excavation operation completion angle ⁇ 1c (steps S101 to S104 in Figure 10).
- the rotating body 7 actually starts to rotate (state S12) immediately after the ground angle ⁇ of the bucket 10 reaches the operation completion angle ⁇ 1 (excavation operation completion angle ⁇ 1c).
- the timing when the ground angle ⁇ of the bucket 10 reaches the excavation operation completion angle ⁇ 1c and the timing when the rotating body 7 starts to rotate are approximately the same. This allows for a smooth transition from the excavation operation to the transport operation.
- the excavation control unit 44 sets the position where there is no soil around the bucket 10 as the excavation completion position DP2 based on the information on the excavation target topography 61 acquired by the object detection device 54. Therefore, even if the turning operation is started immediately after reaching the excavation completion position DP2, there is no soil that will strike the bucket 10 sideways, so damage to the work device 2 can be prevented.
- the control device 40 judges whether the rotation start condition is met when the rotation operation of the rotating body 7 is stopped and the work device 2 is operating automatically so that the ground angle ⁇ of the bucket 10 approaches the soil-discharging operation completion angle ⁇ 1r (steps S109 to S113 in Figure 11).
- the rotating body 7 actually starts to rotate immediately after the ground angle ⁇ of the bucket 10 reaches the operation completion angle ⁇ 1 (soil dumping operation completion angle ⁇ 1r).
- the timing when the ground angle ⁇ of the bucket 10 reaches the earth-discharging operation completion angle ⁇ 1r and the timing when the rotating body 7 starts to rotate are approximately the same. This allows for a smooth transition from the earth-discharging operation to the return operation.
- a hydraulic excavator (working machine) 1 includes a running body 5, a rotating body 7 that is rotatably provided with respect to the running body 5, and a working device 2 that is attached to the rotating body 7 and has a boom 8, an arm 9, and a bucket 10.
- the hydraulic excavator 1 also includes an attitude detection device 53 that detects the attitude of the rotating body 7 and the attitude of the working device 2 including the ground angle ⁇ of the bucket 10, and an object detection device (vessel position detection device) 54 that detects the position of the loading platform (vessel) 201 of the loading machine 200 onto which the material excavated by the working device 2 is loaded.
- the hydraulic excavator 1 also includes a control device 40 that performs automatic rotation control to automatically rotate at least the rotating body 7 to a rotation completion angle that is a target rotation angle, based on the detection results of the attitude detection device 53 and the object detection device 54.
- the rotation start angle which is the rotation angle at which the automatic rotation control is started, is the rotation angle ⁇ sw at the transport start position CP1 in the transport operation, and is the rotation angle ⁇ sw at the return start position RP1 in the return operation.
- the rotation completion angle which is the rotation angle at which the automatic rotation control is completed, is the rotation angle ⁇ sw at the transport completion position CP2 in the transport operation, and is the rotation angle ⁇ sw at the return completion position RP2 in the return operation.
- the control device 40 determines whether or not a rotation start condition for starting the automatic rotation control of the rotating body 7 is satisfied based on the rotation operation state of the rotating body 7 and the operation state of the working device 2. When the control device 40 determines that the rotation start condition is satisfied, it outputs a rotation operation start command to start rotating the rotating body 7 toward the rotation completion angle at the timing when the rotation start condition is satisfied, regardless of whether the working device 2 is in an operating state.
- the control device 40 When the rotation start condition is satisfied during the excavation operation, the control device 40 outputs a rotation start command to start transport control of the rotating body 7. As a result, the rotating body 7 actually starts to rotate at the same time as the work device 2 reaches the excavation operation completion posture, or immediately thereafter. Therefore, according to this embodiment, the transition from the excavation operation to the transport operation can be made smooth. Also, when the rotation start condition is satisfied during the soil dumping operation, the control device 40 outputs a rotation start command to start return control of the rotating body 7. As a result, the rotating body 7 actually starts to rotate at the same time as the work device 2 reaches the soil dumping operation completion posture, or immediately thereafter. Therefore, according to this embodiment, the transition from the soil dumping operation to the return operation can be made smooth. In other words, according to this embodiment, in the excavation and loading operation, the transition from the state in which the work device 2 is operating alone to the operation requiring the rotation operation can be made smoothly. As a result, the productivity (work efficiency) at the work site can be improved.
- the control device 40 calculates the ground angle ⁇ of the bucket 10 based on the detection result of the posture detection device 53.
- the control device 40 automatically operates the work device 2 during each of the excavation operation and the soil discharge operation until the ground angle ⁇ of the bucket 10 becomes the operation completion angle ⁇ 1.
- the control device 40 determines whether the rotation start condition is met when the rotation operation of the rotating body 7 has stopped and the work device 2 is operating automatically so that the ground angle ⁇ of the bucket 10 approaches the operation completion angle ⁇ 1. This configuration makes it possible to smoothly transition from the automatic excavation operation to the automatic transport operation, and from the automatic soil discharge operation to the automatic return operation.
- the control device 40 calculates the first time t1 from when the rotation operation start command is output until the operation of the rotating body 7 starts.
- the control device 40 calculates the second time t2 from the current time until the ground angle ⁇ of the bucket 10 reaches the operation completion angle ⁇ 1.
- the control device 40 determines that the rotation start condition is met when the second time t2 is shorter than the first time t1. In other words, the control device 40 considers that the above prediction has been made.
- the control device 40 determines that the rotation start condition is not met when the second time t2 is equal to or greater than the first time t1. In this configuration, the control device 40 repeatedly calculates the second time t2 based on the current attitude of the work device 2. This makes it possible to more appropriately prevent the rotating body 7 from actually starting to rotate before the ground angle ⁇ of the bucket 10 reaches the operation completion angle ⁇ 1.
- FIG. 13 is a schematic plan view showing the hydraulic excavator 1 according to Modification 1 of the first embodiment transitioning from an earth-discharging operation to a return operation.
- the control device 40 according to the first embodiment outputs a rotation start command during the earth-discharging operation so that the rotation of the rotating body 7 starts after the work device 2 reaches the earth-discharging operation completion posture.
- the control device 40 according to Modification 1 outputs a rotation start command during the earth-discharging operation so that the rotation of the rotating body 7 starts before the work device 2 reaches the earth-discharging operation completion posture, and the bucket 10 starts to move out of the loading platform 201 after the work device 2 reaches the earth-discharging operation completion posture.
- the work device 2 continues the earth dumping operation even while the rotating body 7 is rotating so that the bucket 10 reaches the rear end of the loading platform 201 from the return start position RP1. Then, just before the bucket 10 starts to move out of the loading platform 201, the earth dumping operation by the work device 2 is completed. After that, the rotating body 7 and the work device 2 are controlled so that the control point of the bucket 10 moves along the target route RPT connecting the position RP3 and the return completion position RP2.
- FIG. 14 is a diagram similar to FIG. 11 and is a flowchart showing an example of processing executed by the control device 40 according to the first variation of the first embodiment, showing the flow of processing from the start of the soil discharge operation to the completion of the return operation.
- processing of step S113B is executed instead of processing of step S113 in the flowchart of FIG. 11.
- processing of step S111B is added between steps S110 and S112 in the flowchart of FIG. 11.
- step S111B the rotation start determination unit 43 calculates the third time t3r based on the mathematical model of the hydraulic excavator 1 stored in the storage device, the attitude of the hydraulic excavator 1 calculated by the attitude calculation unit 41, and the position information of the loading platform 201 calculated by the object position calculation unit 42.
- the third time t3r corresponds to the time from when the rotating body 7 actually starts to rotate until the bucket 10 starts to move out of the loading platform 201.
- the third time t3r corresponds to the time until the rotating body 7 reaches the rear end of the loading platform 201.
- the swing start determination unit 43 may calculate the third time t3r using a data table that specifies the relationship between the swing angle ⁇ sw1 from the return start position RP1 until the bucket 10 reaches the rear end of the platform 201 and the third time t3r.
- FIG. 15 is a diagram showing a data table for the third time t3r.
- the data table for the third time t3r is determined in advance through experiments or the like and stored in a storage device.
- the swing start determination unit 43 calculates the swing angle ⁇ sw1 from the current position of the bucket 10 to the position where it reaches the rear end of the platform 201 based on the attitude of the hydraulic excavator 1 and the relative position of the platform 201 with respect to the hydraulic excavator 1.
- the swing start determination unit 43 refers to the data table in FIG. 15 and calculates the third time t3r based on the calculated swing angle ⁇ sw1.
- step S111B of FIG. 14 the process proceeds to step S112, where the second time t2r is calculated.
- step S112 the second time t2r is calculated.
- step S113B is a process for determining whether or not the rotation start condition is met.
- the rotation start determination unit 43 compares the sum of the first time t1r and the third time t3r with the second time t2r. Through this comparison, the rotation start determination unit 43 determines whether, if a rotation operation start command is output at the current time, the rotation of the rotating body 7 will start before the ground angle ⁇ of the bucket 10 reaches the soil discharge operation completion angle ⁇ 1r, and whether the bucket 10 will start to go out of the loading platform 201 after the ground angle ⁇ of the bucket 10 reaches the soil discharge operation completion angle ⁇ 1r.
- the turn start determination unit 43 determines that the turn start condition is not met and returns the process to step S112. If the sum of the first time t1r and the third time t3r is greater than the second time t2r, the turn start determination unit 43 determines that the turn start condition is met, sets the return turn flag to on, and proceeds to step S114.
- step S114 if it is predicted that the bucket 10 will begin to pass the end of the platform 201 immediately after the ground angle ⁇ of the bucket 10 reaches the discharge operation completion angle ⁇ 1r (Yes in step S113B), return control of the rotating body 7 is started (step S114).
- Figure 16 is a diagram similar to Figure 12, and shows the time series changes in the ground angle ⁇ of the bucket 10, the presence or absence of a swing operation command output (ON/OFF), and the swing angle ⁇ sw when the operation transitions from the soil dumping operation to the return operation in modified example 1 of the first embodiment.
- the bucket 10 moves toward the rear end of the loading platform 201 while performing a dumping operation above the loading platform 201.
- the rotation angle ⁇ sw increases to the predetermined rotation angle ⁇ sw1
- the bucket 10 reaches the rear end of the loading platform 201 in state S21.
- the position RP3 of the tip of the bucket 10 is preferably set at a position higher than the upper edge of the loading platform 201.
- return control of the work device 2 begins.
- the return operation is completed when the rotating body 7 and the work device 2 perform the return operation and the tip of the bucket 10 reaches the return completion position RP2 in state S22.
- this variation 1 of the first embodiment provides the following effects.
- the specified posture for outputting the rotation start command when the earth discharge operation is being performed is different from that of the above embodiment.
- the specified posture in this modified example is a posture in which, if a rotation start command is output when the work device 2 is in that posture, the work device 2 will start to go out of the loading platform 201 immediately after the work device 2 reaches the earth discharge operation completion posture.
- the rotating body 7 can actually be moved above the loading platform 201 before the soil release operation is completed, which improves productivity more than the above embodiment.
- the control device 40 calculates the first time t1r from when the rotation operation start command is output until the operation of the rotating body 7 starts.
- the control device 40 calculates the second time t2r from the current time until the ground angle ⁇ of the bucket 10 reaches the soil discharge operation completion angle ⁇ 1r.
- the control device 40 calculates the third time t3r from when the operation of the rotating body 7 starts until the bucket 10 starts to go outside the loading platform 201.
- the control device 40 determines that the rotation start condition is met when the second time t2r is shorter than the sum of the first time t1r and the third time t3r. In this configuration, the control device 40 repeatedly calculates the second time t2r based on the current posture of the work device 2. Therefore, it is possible to appropriately prevent the rotating body 7 from going outside the loading platform 201 before the work device 2 reaches the soil discharge operation completion posture.
- the method of calculating the second time t2r is not limited to the above example.
- the control device 40 may calculate the second time t2r using a data table (hereinafter also referred to as the second time characteristic table) that specifies the relationship between the ground angle ⁇ of the bucket 10 and the time (second time t2r) until the discharge of the excavated material in the bucket 10 is completed when the earth dumping operation is continued from the ground angle ⁇ .
- the time until the discharge of the excavated material in the bucket 10 is completed is affected by the soil quality (viscosity, grain size) of the excavated material.
- the control device 40 may correct the second time characteristic table based on the soil quality of the excavated material.
- the soil quality of the excavated material is input to the control device 40 by the input device 57.
- the control device 40 refers to the corrected second time characteristic table and calculates the second time t2r based on the ground angle ⁇ of the bucket 10.
- control device 40 may calculate the time from the start to the completion of the earth-discharging operation (hereinafter, the required discharge time) based on the behavior of the transported material (excavated material) in the bucket 10 during the first earth-discharging operation of the excavation and loading cycle by the object detection device 54, and use this to control the transition from the second or subsequent earth-discharging operation to the return operation of the excavation and loading cycle.
- the behavior of the transported material in the bucket 10 is, for example, a change in the area of the transported material in the bucket 10 in an image captured by a stereo camera serving as the object detection device 54.
- the control device 40 determines that the earth-discharging operation is completed and calculates the required discharge time.
- the timing for completing the soil discharge operation may be instructed to the control device 40 by the operator operating the input device 57.
- the control device 40 stores the time from the start of the soil discharge operation to the time the operator operates the input device 57 as the required release time.
- the control device 40 calculates the second time t2r by subtracting the time elapsed from the start time of the soil discharge operation from the required discharge time during the second and subsequent excavation/loading cycles.
- the control device 40 calculates the required discharge time, which is the time from the start time to the completion time of the operation of discharging the excavated material in the bucket 10, during the first discharge operation.
- the control device 40 calculates the second time t2r by subtracting the elapsed time from the start time of the operation of discharging the excavated material in the bucket 10 from the required discharge time.
- the control device 240 acquires the weight of the transported material (excavated material such as soil and sand) in the bucket 10, and judges whether or not the swing start condition is satisfied based on the acquired weight.
- the control device 240 judges that the swing start condition is satisfied when the weight of the excavated material in the bucket 10 reaches a predetermined weight.
- the control device 240 judges that the swing start condition is not satisfied when the weight of the excavated material in the bucket 10 does not reach the predetermined weight.
- the configuration of the hydraulic excavator 1 according to the second embodiment and the function of the control device 240 will be described in detail below.
- the hydraulic excavator 1 according to the second embodiment is provided with a transported goods information acquisition device 258.
- the transported goods information acquisition device 258 calculates the weight of the transported goods stored in the bucket 10.
- the transported goods information acquisition device 258 includes, for example, a pressure sensor (not shown) that detects the pressure of the hydraulic cylinders (11 to 13) and a calculation device that calculates the weight of the transported goods based on the detection results of the pressure sensor and the detection results of the attitude detection device 53.
- the configuration of the transported goods information acquisition device 258 is not limited to this.
- the transported goods information acquisition device 258 may be a weight sensor that directly detects the weight of the transported goods in the bucket 10.
- the calculation device of the transported goods information acquisition device 258 is provided separately from the control device 240, but the function of the calculation device of the transported goods information acquisition device 258 may be provided in the control device 240.
- Figure 18 is a flowchart showing an example of the process by the control device 240 according to the second embodiment, showing the process flow from the start of the excavation operation to the completion of the transport operation.
- Figure 19 is a flowchart showing an example of the process by the control device 240 according to the second embodiment, showing the process flow from the start of the soil discharge operation to the completion of the return operation.
- step S201 is executed instead of the processes of steps S102 to S104 in the flowchart of FIG. 10.
- step S202 is executed instead of the processes of steps S110 to S113 in the flowchart of FIG. 11.
- excavation control is started in step S101.
- the hydraulic excavator 1 is in a state where the rotation of the rotating body 7 is stopped and the work device 2 is operating to excavate the excavation material.
- excavation control is performed so that the weight (excavation volume) W of the excavation material stored in the bucket 10 reaches the target excavation volume Wt.
- the target excavation volume Wt is a target value for the weight of the excavation material to be stored in the bucket 10, which is determined in advance and stored in the storage device.
- the next step S201 is a process for judging whether or not the turning start condition is satisfied.
- the turning start judgment unit 43 judges whether or not a predetermined percentage P1 or more of the excavated material with respect to the target excavation volume Wt has been stored in the bucket 10 based on the weight W of the transported material acquired by the transported material information acquisition device 258.
- the predetermined percentage P1 is determined in advance and stored in the storage device.
- the predetermined percentage P1 is, for example, a value of 90% or more.
- the predetermined percentage P1 may be changed by operating the input device 57. If it is judged that a predetermined percentage P1 or more of the excavated material with respect to the target excavation volume Wt has been stored in the bucket 10, the process proceeds to step S105.
- the process of step S201 is repeatedly executed at a predetermined calculation cycle until a positive judgment is made.
- the rotation start determination unit 43 acquires the weight W of the transported object from the transported object information acquisition device 258 at each predetermined calculation cycle. When an excavation operation is performed, the weight W of the transported object in the bucket 10 increases over time. When the weight W of the transported object becomes equal to or greater than a predetermined weight W1, the rotation start determination unit 43 determines that the rotation start condition is met and proceeds to step S105.
- the predetermined weight W1 is the weight of the transported object equivalent to a predetermined ratio P1 of the target excavation amount Wt, and is calculated by the rotation start determination unit 43.
- steps S105 to S108 in FIG. 18 is similar to that in the first embodiment (see FIG. 10), so a description thereof will be omitted.
- step S109 soil discharge control is started in step S109.
- the hydraulic excavator 1 enters a state in which the rotation of the rotating body 7 is stopped and the work device 2 is operating to release the excavated material.
- the next step S202 is a process for determining whether or not the turning start condition has been met.
- the turning start determination unit 43 determines whether or not the weight W of the transported object has decreased by a predetermined percentage P2 or more with respect to the weight W0 before the dumping operation, based on the weight W of the transported object acquired by the transported object information acquisition device 258.
- the process of step S202 can also be said to be a process for determining whether or not the percentage Pd of the weight W of the transported object that has decreased with respect to the weight W0 before the dumping operation (hereinafter also referred to as the reduction percentage of the transported object) has reached a predetermined percentage P2 or more.
- the predetermined percentage P2 is determined in advance and stored in the storage device.
- the predetermined percentage P2 is, for example, a value of about 80 to 90%. Note that the predetermined percentage P2 may be changed by operating the input device 57.
- the rotation start determination unit 43 stores the weight W of the transported object when the operation transition condition from the excavation operation to the transport operation is satisfied as the weight W0 before the soil dumping operation. If it is determined that the weight W of the transported object has decreased by a predetermined percentage P2 or more with respect to the weight W0 before the soil dumping operation, the process proceeds to step S114.
- the process of step S202 is repeatedly executed at a predetermined calculation cycle until a positive determination is made.
- the rotation start determination unit 43 acquires information on the weight W of the transported object from the transported object information acquisition device 258 at a predetermined calculation cycle.
- the weight W of the transported object in the bucket 10 decreases over time.
- the control device 240 determines that the rotation start condition is met and proceeds to step S114.
- steps S114 to S117 in FIG. 19 is similar to that in the first embodiment (see FIG. 11), so a description thereof will be omitted.
- Fig. 20 is a diagram showing the time series changes in the weight (excavation amount) W of the transported object in the bucket 10, the presence or absence (ON/OFF) of a swing operation command, and the swing angle ⁇ sw when the operation transitions from an excavation operation to a transport operation.
- the horizontal axis in Figs. 20(a) to (c) indicates time.
- the vertical axis in Fig. 20(a) indicates the weight (excavation amount) W of the transported object in the bucket 10.
- the vertical axis in Fig. 20 is a diagram showing the time series changes in the weight (excavation amount) W of the transported object in the bucket 10.
- the vertical axis in Fig. 20(a) indicates the weight (excavation amount) W of the transported object in the bucket 10.
- FIG. 20(b) indicates the presence or absence of a swing operation command
- the vertical axis in Fig. 20(c) indicates the swing angle ⁇ sw.
- the swing angle ⁇ sw is shown as a graph in which the position where the excavation operation is started is set as a reference position, and increases in the positive direction from the reference position to the excavation operation completion angle.
- FIG. 21 is a diagram showing the time series changes in the reduction rate Pd of the transported goods in the bucket 10, the presence or absence of a swing operation command being output (ON/OFF), and the swing angle ⁇ sw when transitioning from the dumping operation to the return operation.
- the horizontal axis in FIG. 21(a) to (c) indicates time.
- the vertical axis in FIG. 21(a) indicates the reduction rate Pd [%] of the transported goods.
- the vertical axis in FIG. 21(b) indicates the presence or absence of a swing operation command being output, and the vertical axis in FIG. 21(c) indicates the swing angle ⁇ sw.
- the swing angle ⁇ sw is shown as a graph in which the position where the dumping operation starts is set as the reference position, and increases in the positive direction from the reference position to the angle at which the dumping operation is completed.
- the control device 240 acquires the weight W of the transported material (excavated material) in the bucket 10 from the transported material information acquisition device 258.
- the control device 240 determines that the rotation start condition is met when the acquired weight W of the transported material in the bucket 10 reaches a predetermined weight.
- the control device 240 determines whether the rotation start condition is met when the rotation operation of the rotating body 7 has stopped and the work device 2 is operating to excavate the excavated material.
- the control device 240 determines that the rotation start condition is met when the weight W of the excavated material in the bucket 10 has increased to a predetermined weight W1, and outputs a rotation operation start command (steps S201 and S105 in FIG. 18).
- the control device 240 determines whether the rotation start condition is met when the rotation operation of the rotating body 7 has stopped and the work device 2 is operating to release the excavated material.
- the control device 240 determines that the swing start condition is met and outputs a swing operation start command (steps S202 and S114 in FIG. 19). According to the second embodiment, the same action and effect as the first embodiment is achieved.
- the transported object information acquisition device 258 calculates the weight W of the transported object (excavated object) in the bucket 10, thereby reducing the calculation load on the control device 240.
- the above-mentioned predetermined rate P2 may be changed by operating the input device 57.
- the storage device stores a ground angle conversion table T (see FIG. 22), which is a data table that defines the relationship between the reduction rate Pd of the transported goods and the ground angle ⁇ of the bucket 10.
- the turning start determination unit 43 acquires information on the new predetermined rate P2 from the input device 57, it refers to the ground angle conversion table T and calculates the ground angle (ground angle threshold) ⁇ 2 of the bucket 10 that corresponds to the new predetermined rate P2.
- the hydraulic excavator 1 includes an input device 57 that can input the predetermined ratio P2.
- the control device 240 according to this modification also includes a ground angle conversion table T, which is a data table that defines the relationship between the ratio of the weight of the excavated material released from the bucket 10 to the weight W0 of the excavated material before it is released from the bucket 10 (the reduction ratio of the transported material) Pd, and the ground angle ⁇ of the bucket 10.
- the control device 240 refers to the ground angle conversion table T and determines the ground angle of the bucket 10 corresponding to the predetermined ratio P2 input by the input device 57 as the ground angle threshold value ⁇ 2.
- the control device 240 determines that the swing start condition is met and outputs a swing operation start command. With this configuration, the operator can adjust the timing of the swing operation by operating the input device 57.
- the control device 240 may further correct and use the ground angle conversion table T.
- the control device 240 correcting the ground angle conversion table T it is possible to more appropriately set the ground angle ⁇ 2 of the bucket 10 corresponding to the predetermined ratio P2.
- the swing start determination unit 43 may correct the ground angle conversion table T, which is a reference data table, based on the actual data of the hydraulic excavator 1.
- FIG. 23 is a diagram showing the corrected ground angle conversion tables Tc1 and Tc2.
- the ground angle conversion table T may be corrected based on time series data of the weight W of the transported object calculated by the transported object information acquisition device 258, the ground angle ⁇ of the bucket 10 calculated by the attitude calculation unit 41, and the weight W0 of the transported object before the earth dumping operation. In this way, for example, the corrected ground angle conversion table Tc1 is obtained.
- the control device 240 refers to the corrected ground angle conversion table Tc1 and calculates the ground angle threshold value ⁇ c21 of the bucket 10 for the input predetermined ratio P2. When the ground angle ⁇ of the bucket 10 reaches the ground angle threshold value ⁇ c21 during the earth dumping operation, the control device 240 determines that the swing start condition is established and outputs a swing operation start command.
- the control device 240 acquires actual machine data (weight W of the excavated material and ground angle ⁇ of the bucket) when the working device 2 is performing the soil discharge operation, and determines the ground angle threshold value that defines the swing start condition based on the acquired actual machine data.
- the control device 240 it is possible to cause the control device 240 to output a swing operation start command at an appropriate timing, regardless of individual differences, etc., of the hydraulic excavator 1 performing the work.
- the swing start determination unit 43 may correct the ground angle conversion table T based on the soil property of the transported material.
- the hydraulic excavator 1 according to this modified example is equipped with an input device 57 that can input soil property such as the viscosity of the excavated material. The operator operates the input device 57 to input the predetermined ratio P2 and the viscosity of the excavated material to the control device 240.
- the control device 240 corrects the ground angle conversion table T so that the rate of change of the reduction rate Pd relative to the ground angle ⁇ becomes smaller. This results in a corrected ground angle conversion table Tc2.
- the control device 240 refers to the corrected ground angle conversion table Tc2 and calculates the ground angle threshold value ⁇ c22 of the bucket 10 for the input predetermined rate P2.
- the soil quality of the excavated material is not limited to viscosity, and may also be grain size.
- the control device 240 corrects the ground angle conversion table T based on the soil quality of the excavated object input by the input device 57.
- the control device 240 can output a rotation operation start command at an appropriate timing.
- the turning start determination unit 43 may correct the ground angle conversion table T based on the ground angular velocity of the bucket 10.
- the angular velocity of the bucket 10 is calculated by the attitude calculation unit 41.
- the control device 240 corrects the ground angle conversion table T so that the rate of change of the reduction rate Pd with respect to the ground angle ⁇ becomes smaller. As a result, a corrected ground angle conversion table Tc2 is obtained.
- the control device 240 may calculate the reduction rate Pd of the transported material in the bucket 10 in the soil releasing operation (discharging operation) based on the behavior of the transported material (excavated material) in the bucket 10 detected by the object detection device 54.
- the behavior of the transported material in the bucket 10 is, for example, a change in the area of the transported material in the bucket 10 in an image captured by a stereo camera as the object detection device 54.
- the control device 240 may also calculate the reduction rate Pd of the transported material based on the shape of the transported material (excavated material) discharged to the loading platform 201 detected by the object detection device 54.
- the control device 240 can estimate how much of the transported material has been discharged from the shape of the transported material detected by the object detection device 54.
- the reduction rate Pd of the transported material reaches a predetermined rate P2
- the control device 240 determines that a turning start condition is established and outputs a turning operation start command.
- control device 240 determines whether the turning start condition is met based on the behavior of the excavated material in the bucket 10 detected by the object detection device 54, or the shape of the excavated material released onto the loading platform 201 detected by the object detection device 54.
- the transported material information acquisition device 258 can be omitted.
- FIG. 24 is a functional block diagram of the control device 340 according to the third embodiment.
- the hydraulic excavator 1 according to this embodiment is configured to automatically perform a transport operation after an excavation operation performed manually by the operator.
- the control device 340 outputs a command to start the rotation operation of the transport operation at a timing instructed by the operator.
- the hydraulic excavator 1 according to this embodiment is also configured to automatically perform a return operation after an earth dumping operation performed manually by the operator.
- the control device 340 outputs a command to start the rotation operation of the return operation at a timing instructed by the operator.
- the control selection switch 324 has the function of the control selection switch 24 described in the first embodiment, as well as the function of allowing selection of semi-automatic mode.
- the control device 340 controls the operation of the work device 2 in accordance with the operation device 20 during excavation and soil dumping operations. Furthermore, the control device 340 controls the operation of the work device 2 and the rotating body 7 in accordance with the target route set by the control device 340, regardless of the operation of the operation device 20, during transport and return operations.
- the operation transition determination unit 349 sets the control mode to one of automatic mode, manual mode, and semi-automatic mode based on an operation command from the control selection switch 324. Furthermore, when the automatic mode is set, the operation transition determination unit 349 determines that the operation transition condition is met when the tip of the bucket 10 reaches the completion position of the target path, as in the first embodiment.
- the operation transition determination unit 349 determines that the operation transition condition from the excavation operation to the transport operation is satisfied when the semi-automatic mode is set and the work operation device 29 is returned to the neutral position after the excavation operation by the work operation device 29 is performed.
- the operation transition determination unit 349 also determines that the operation transition condition from the soil discharge operation to the return operation is satisfied when the semi-automatic mode is set and the work operation device 29 is returned to the neutral position after the soil discharge operation by the work operation device 29 is performed.
- the operation transition determination unit 349 determines that the work operation device 29 is returned to the neutral position after the excavation operation or soil discharge operation by the work operation device 29 is performed when any of the arm operation amount, boom operation amount, and bucket operation amount detected by the operation amount sensors 52a, 52c, and 52d of the operation detection device 56 becomes equal to or greater than the operation determination threshold, and then the arm operation amount, boom operation amount, and bucket operation amount become equal to or less than the neutral determination threshold.
- the turning start determination unit 343 determines whether the current operation state is an excavation operation, a transport operation, a soil dumping operation, or a return operation, based on the determination result of the operation transition determination unit 349. In addition, the turning start determination unit 343 determines that a turning operation has been performed when the amount of turning operation detected by the operation amount sensor 52b of the operation detection device 56 is equal to or greater than the operation determination threshold value.
- the rotation start determination unit 343 determines that the rotation start condition is met if a rotation operation is performed while an excavation operation is being performed.
- the rotation start determination unit 343 also determines that the rotation start condition is met if a rotation operation is performed while an earth discharge operation is being performed.
- the rotation operation device 28 also functions as a rotation start operation device that instructs the start of rotation of the rotating body 7 by automatic operation during an excavation operation or an earth discharge operation.
- Figure 25 is a flowchart showing an example of the process by the control device 340 according to the third embodiment, showing the process flow from the start of the excavation operation to the completion of the transport operation.
- Figure 26 is a flowchart showing an example of the process by the control device 340 according to the third embodiment, showing the process flow from the start of the soil discharge operation to the completion of the return operation.
- steps S301 and S302 are executed instead of steps S101 to S104 in the flowchart of FIG. 10. Also, in the flowchart of FIG. 25, step S303 is executed instead of step S106 in the flowchart of FIG. 10. In the flowchart of FIG. 26, steps S304 and S305 are executed instead of steps S109 to S113 in the flowchart of FIG. 11. Also, in the flowchart of FIG. 26, step S306 is executed instead of step S115 in the flowchart of FIG. 11.
- step S301 when the control selection switch 24 is operated to change the control mode to the semi-automatic mode, the operation transition determination unit 349 sets the control mode to the semi-automatic mode.
- the actuator command unit 48 starts an excavation operation by the work device 2 based on a target speed according to the amount of operation of the work operation device 29.
- the next step S302 is a process for determining whether or not a turning start condition has been met.
- the turning start determination unit 343 determines whether or not a turning operation has been performed. If a turning operation has been performed, the turning start determination unit 343 determines that the turning start condition has been met, and proceeds to step S105.
- the process of step S302 is repeatedly executed at a predetermined calculation cycle until a positive determination is made. In other words, the control device 340 repeatedly executes the process of step S302 until a turning operation is performed.
- step S105 the transport control unit 45 outputs a command to start a rotation operation for the transport operation of the rotating body 7.
- the operation transition determination unit 49 determines whether the operation transition condition from the excavation operation to the transport operation is satisfied. If the work operation device 29 is returned to the neutral position (in this embodiment, both the work operation right lever 22a and the work operation left lever 22b are in the neutral position), the operation transition determination unit 49 determines that the operation transition condition from the excavation operation to the transport operation is satisfied, and proceeds to step S107.
- step S303 determines that the operation transition condition from the excavation operation to the transport operation is not satisfied.
- the process of step S303 is repeatedly executed at a predetermined calculation cycle until a positive determination is made.
- steps S107 and S108 in FIG. 25 is similar to that in the first embodiment (see FIG. 10), so a description thereof will be omitted.
- step S304 the actuator command unit 48 starts the soil release operation by the work device 2 based on a target speed according to the amount of operation of the work operation device 29.
- step S305 is similar to step S302 in that it determines whether or not a turning start condition has been met.
- the turning start determination unit 343 determines whether or not a turning operation has been performed. If a turning operation has been performed, the turning start determination unit 343 determines that the turning start condition has been met, and advances the process to step S114.
- the process of step S305 is repeatedly executed at a predetermined calculation cycle until a positive determination is made. In other words, the control device 340 repeatedly executes the process of step S305 until a turning operation is performed.
- step S114 the transport control unit 45 outputs a rotation operation start command for the return operation of the rotating body 7.
- step S306 the operation transition determination unit 49 determines whether the operation transition condition from the soil release operation to the return operation is satisfied. If the work operation device 29 is returned to the neutral position (in this embodiment, both the work operation right lever 22a and the work operation left lever 22b are in the neutral position), the operation transition determination unit 49 determines that the operation transition condition from the soil release operation to the return operation is satisfied, and proceeds to step S116.
- step S306 is repeatedly executed at a predetermined calculation cycle until a positive determination is made.
- steps S116 and S117 in FIG. 26 is similar to that in the first embodiment (see FIG. 11), so a description thereof will be omitted.
- the operator operates the work operation device 29, which causes the work device 2 to perform an excavation operation (step S301).
- the operator operates the swing operation device 28, which causes the control device 340 to output a swing operation start command for a transport operation (steps S302, S105).
- control device 340 determines that the excavation operation is complete and operates the work device 2 along the target path CPT (steps S303, S107, S108).
- the operator After the automatic transport operation is completed, the operator operates the work operation device 29, causing the work device 2 to perform the soil dumping operation (step S304).
- the operator operates the turning operation device 28, causing the control device 340 to output a turning operation start command for the return operation (steps S305, S114, S117).
- control device 340 determines that the soil release operation is complete and operates the work device 2 along the target route RPT (steps S306, S116).
- the third embodiment includes a rotation operation device (rotation start operation device) 28 that is operated by the operator to instruct the start of rotation of the rotating body 7, and a work operation device 29 that is operated by the operator to operate the work device 2.
- the control device 340 operates the work device 2 in response to the operation of the work operation device 29.
- the control device 340 determines whether or not the rotation start condition is met when the rotation operation of the rotating body 7 has stopped and the work device 2 is operating in response to the operation of the work operation device 29.
- the control device 340 determines that the rotation start condition is met when the rotation operation device 28 instructs the start of rotation of the rotating body 7.
- a rotation operation start command for a transport operation or a return operation can be output from the control device 340 based on the operator's intention.
- the hydraulic excavator 1 according to the third embodiment has been described as an example in which the excavation operation and the soil dumping operation are performed based on the manual operation of the operator, and the transport operation and the return operation are performed automatically.
- the hydraulic excavator 1 may be configured to perform only the excavation operation based on the manual operation of the operator, and to perform the transport operation, soil dumping operation, and the return operation automatically.
- the hydraulic excavator 1 may be configured to perform only the soil dumping operation based on the manual operation of the operator, and to perform the excavation operation, transport operation, and the return operation automatically.
- the hydraulic excavator 1 may be configured to perform all of the excavation operation, transport operation, soil dumping operation, and return operation automatically. In this case, the hydraulic excavator 1 may be configured such that the operator instructs only the timing of outputting a swing operation start command for the transport operation and the return operation.
- control device may execute the process of step S302 in FIG. 25 instead of the process of steps S102 to S104 in FIG. 10. Also, the control device may execute the process of step S305 in FIG. 26 instead of the process of steps S110 to S113 in FIG. 11.
- the control device 340 in this modified example judges whether or not the rotation start condition is met when the rotation operation of the rotating body 7 has stopped and the work device 2 is operating.
- the control device 340 judges that the rotation start condition is met when the rotation operation device 28 issues an instruction to start the rotation of the rotating body 7.
- a rotation operation start command for a transport operation or a return operation can be output from the control device 340 based on the operator's intention while an excavation operation or an earth dumping operation is being performed by automatic operation of the control device 340, in addition to manual operation by the operator.
- the rotation start operation device that instructs the start of rotation of the rotating body 7 is the rotation operation device 28.
- the form of the rotation start operation device is not limited to this.
- the rotation start operation device may be an operation device different from the operation devices 20 and 21, and may be an operation switch provided on the operation levers 22a and 22b.
- ⁇ Modification 1> In the above embodiment, an example has been described in which the vessel into which the excavated material excavated by the working device 2 is loaded is the bed 201 of the transport vehicle, but the present invention is not limited to this. The present invention may also be applied to a case in which the excavated material is loaded into a vessel provided on a loading machine such as a belt conveyor.
- a backhoe shovel with the bucket 10 attached to the tip of the arm 9 facing backward has been described as an example of a work machine, but the present invention is not limited to this.
- the work machine may be a loading shovel with the bucket 10 attached to the tip of the arm 9 facing forward.
- control selection switch 28... slewing operation device (slewing start operation device), 29... work operation device, 40... control device, 41... attitude calculation unit, 42... object position calculation unit, 43... slewing start determination unit, 44... excavation control unit, 45... transportation control unit, 46... soil discharge control unit, 47... return control unit, 48... actuator command unit, 49... operation transition determination unit, 50... hydraulic drive system, 51... solenoid proportional valve, 52... operation amount sensor, 53... attitude detection device, 54... object detection device (vessel position detection device), 55... hydraulic oil temperature sensor, 56... operation detection device, 57... input device, 200... loaded machine, 201... loading platform (tray, vessel), 240... control device, 258... transported object information acquisition device, 324... control selection switch, 340...
- control device 343... turning start determination unit, 349... operation transition determination unit, 400... operation control unit, CP1... transportation start position, CP2... transportation completion position, CPT... target route, DP1... excavation start position, DP2... excavation completion position, DPT... target route, LP1... soil release start position, LP2... soil release completion position, LPT... target route, P1... predetermined ratio, P2...
Landscapes
- Engineering & Computer Science (AREA)
- Mining & Mineral Resources (AREA)
- Civil Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Structural Engineering (AREA)
- Mechanical Engineering (AREA)
- Operation Control Of Excavators (AREA)
Abstract
作業機械は、走行体と、旋回体と、作業装置と、旋回体及び作業装置の姿勢を検出する姿勢検出装置と、作業装置により掘削された掘削物が積み込まれる被積込機械のベッセルの位置を検出するベッセル位置検出装置と、姿勢検出装置及びベッセル位置検出装置の検出結果に基づいて、少なくとも旋回体を旋回完了角度まで自動で旋回させる自動旋回制御を行う制御装置と、を備える。制御装置は、旋回体の旋回動作状態及び作業装置の動作状態に基づいて、自動旋回制御を開始する旋回開始条件が成立したか否かを判断する。制御装置は、旋回開始条件が成立したと判断した場合には、作業装置が動作している状態にあるか否かに関わらず、旋回体を旋回完了角度に向かって旋回開始させる旋回動作開始指令を出力する。
Description
本発明は、作業機械に関する。
走行体に旋回可能に取り付けられた旋回体と、旋回体に取り付けられた多関節型の作業装置と、を備えた油圧ショベルなどの作業機械が知られている。油圧ショベルに取り付けられる作業装置は、旋回体に回動可能に取り付けられるブームと、ブームに回動可能に取り付けられるアームと、アームに回動可能に取り付けられるバケットと、を有する。
油圧ショベルは、土砂等の掘削物を掘削する掘削動作と、掘削物をダンプトラック等の被積込機械の荷台の上方まで運搬する運搬動作と、掘削物を被積込機械の荷台に放出する放出動作と、掘削位置まで作業装置を移動させる戻り動作とを行って掘削物の掘削積込作業を行う。
特許文献1には、戻り動作を自動で行う作業機械(積込機械)の制御装置及び制御方法が開示されている。この特許文献1には、「積込機械の制御装置は、旋回中心回りに旋回する旋回体と、バケットを有し前記旋回体に取り付けられた作業機とを備える積込機械の制御装置であって、積込対象の位置および形状を特定する積込対象特定部と、前記積込対象の位置および形状に基づいて前記積込対象より所定距離だけ外側の位置である干渉回避位置を特定する回避位置特定部と、前記バケットが前記積込対象上の積込位置から前記干渉回避位置に到達するまで前記旋回体のみを駆動させて前記バケットを前記干渉回避位置へ移動させる操作信号を出力し、前記バケットが前記干渉回避位置に到達した後に前記旋回体および前記作業機を駆動させて前記バケットを掘削対象上の掘削位置へ移動させる操作信号を出力する移動処理部とを備える。」と記載されている。
特許文献1には、「自動掘削積込制御を連続して実行する場合には、空荷旋回開始位置P01は、積込位置P07と一致する。」、「アーム132の先端部の位置Pが積込位置P07に至ったとき、旋回体120の旋回は停止している。」「移動処理部1112は、バケット133が積込位置P07に到達すると、バケット133をダンプ方向へ回転させるためのダンプ操作信号を生成する。」との記載がある。つまり、特許文献1に記載の技術では、バケットを回動させて被積込機械へ放土を行っている間、旋回体は停止している。このため、戻り動作を行うには、放土が完了した後、旋回体を旋回させるための旋回動作指令を出力する必要がある。
しかしながら、旋回動作指令が出力されてから旋回体が実際に動き出すまでには時間を要する。そのため、特許文献1に記載の技術では、放土動作の完了タイミングと実際の旋回の開始タイミングとの間に生じるずれに起因して、生産性(作業効率)が低下する恐れがある。
本発明は、作業装置が単独で動作している状態(例えば、掘削動作、あるいは放出動作が行われている状態)から、旋回動作を必要とする動作(例えば、運搬動作、あるいは戻り動作)への遷移を滑らかに行うことで生産性の向上を図ることを目的とする。
本発明の一態様による作業機械は、走行体と、前記走行体に対して旋回可能に設けられる旋回体と、前記旋回体に取り付けられ、ブーム、アーム及びバケットを有する作業装置と、前記旋回体の姿勢、及び前記作業装置の姿勢を検出する姿勢検出装置と、前記作業装置により掘削された掘削物が積み込まれる被積込機械のベッセルの位置を検出するベッセル位置検出装置と、前記姿勢検出装置及び前記ベッセル位置検出装置の検出結果に基づいて、少なくとも前記旋回体を目標となる旋回角度である旋回完了角度まで自動で旋回させる自動旋回制御を行う制御装置と、を備える。前記制御装置は、前記旋回体の旋回動作状態及び前記作業装置の動作状態に基づいて、前記旋回体の前記自動旋回制御を開始する旋回開始条件が成立したか否かを判断し、前記旋回開始条件が成立したと判断した場合には、前記作業装置が動作している状態にあるか否かに関わらず、前記旋回開始条件が成立したタイミングで、前記旋回体を前記旋回完了角度に向かって旋回開始させる旋回動作開始指令を出力する。
本発明によれば、作業装置が単独で動作している状態から、旋回動作を必要とする動作への遷移を滑らかに行うことで生産性の向上を図ることができる。
以下、図面を参照して、本発明の実施形態について説明する。なお、以下では、作業機械が油圧ショベルである例について説明する。以下の説明では、同一の構成要素が複数存在する場合、符号の末尾にアルファベットの小文字を付すことがある。また、当該アルファベットの小文字を省略して当該複数の構成要素をまとめて表記することがある。例えば、同一の2つの走行油圧モータ4a,4bが存在するとき、これらをまとめて走行油圧モータ4と表記することがある。
<第1実施形態>
図1は、本発明の第1実施形態に係る油圧ショベル1の側面図である。図2は、油圧ショベル1と被積込機械200を示す図である。図1及び図2に示すように、作業機械としての油圧ショベル1は、地面等の掘削対象面を掘削する掘削作業と、掘削した土砂等の掘削物を、ダンプトラックをはじめとする運搬車両等の被積込機械200に積み込む積込作業とを行う。
図1は、本発明の第1実施形態に係る油圧ショベル1の側面図である。図2は、油圧ショベル1と被積込機械200を示す図である。図1及び図2に示すように、作業機械としての油圧ショベル1は、地面等の掘削対象面を掘削する掘削作業と、掘削した土砂等の掘削物を、ダンプトラックをはじめとする運搬車両等の被積込機械200に積み込む積込作業とを行う。
油圧ショベル1は、掘削積込作業において、バケット10を用いて土砂等の掘削対象物を掘削する掘削動作と、旋回体7を旋回させてバケット10内の掘削物を被積込機械200の上方まで運搬する運搬動作と、バケット10をダンプ方向に動作させて掘削物を被積込機械200の荷台(トレイ、ベッセル)201に放出する放土動作(放出動作)と、バケット10を被積込機械200の上方から次の掘削動作を行う位置まで移動させる戻り動作とを行う。この掘削積込サイクルは、1台の被積込機械200に対して複数回行われる。
図1に示す油圧ショベル1は、車体(機械本体)3と、車体3に取り付けられる多関節型の作業装置2とを備える。車体3は、走行体5と、走行体5に対して旋回可能に設けられる旋回体7と、を備える。走行体5は、右側のクローラを駆動する右クローラ駆動用の走行油圧モータ4a(図3参照)、及び左側のクローラを駆動する左クローラ駆動用の走行油圧モータ4b(図3参照)により走行する。旋回体7は、走行体5の上部に旋回装置を介して取り付けられ、旋回装置の旋回油圧モータ6(図3参照)により旋回する。なお、本実施形態では、右クローラ駆動用の走行油圧モータ4a及び左クローラ駆動用の走行油圧モータ4bを総称して、走行油圧モータ4とも記す。
旋回体7に取り付けられる作業装置2は、回動可能に連結される複数の駆動対象部材(8,9,10)及び駆動対象部材を駆動する複数の油圧シリンダ(11,12,13)を有する。本実施形態では、複数の油圧シリンダ(11,12,13)によって駆動される3つの駆動対象部材としてのブーム8、アーム9及びバケット10が、直列的に連結される。
ブーム8は、その基端部が旋回体7の前部においてブームピン8a(図5参照)によって回動可能に連結される。アーム9は、その基端部がブーム8の先端部においてアームピン9aによって回動可能に連結される。バケット10は、アーム9の先端部においてバケットピン10aによって回動可能に連結される。ブームピン8a、アームピン9a、バケットピン10aは、互いに平行に配置され、各駆動対象部材(8,9,10)は同一面内で相対回転可能とされている。
ブーム8は、ブームシリンダ11の伸縮動作によって上下方向に回動する。アーム9は、アームシリンダ12の伸縮動作によって前後方向(ダンプ方向及びクラウド方向)に回動する。バケット10は、バケットシリンダ13の伸縮動作によって前後方向(ダンプ方向及びクラウド方向)に回動する。ブームシリンダ11は、その一端側がブーム8に接続され他端側が旋回体7のフレームに接続されている。アームシリンダ12は、その一端側がアーム9に接続され他端側がブーム8に接続されている。バケットシリンダ13は、その一端側がバケットリンク16を介してバケット10に接続され他端側がアーム9に接続されている。
図3は、油圧ショベル1の油圧駆動システム50の概略構成図である。図3に示すように、油圧駆動システム50は、旋回体7に搭載された原動機であるエンジン103と、エンジン103により駆動される油圧ポンプであるメインポンプ102及びパイロットポンプ104と、を備える。メインポンプ102及びパイロットポンプ104は、エンジン103により駆動され、作動油を吐出する。
油圧駆動システム50は、メインポンプ102から吐出される作動油の流量及び流れ方向を制御する流量制御弁101と、流量制御弁101に操作信号としての操作圧を出力する複数の電磁比例弁51と、電磁比例弁51に制御信号を出力する制御装置40と、オペレータにより操作され、操作量及び操作方向に応じた信号を制御装置40に出力する操作装置20,21と、オペレータの操作により自動制御と手動制御とを切り換える制御切換信号を制御装置40に出力する制御選択スイッチ24と、を備える。操作装置20,21及び制御選択スイッチ24は、旋回体7に設けられた運転室71(図1参照)内に設置されている。
作業用の操作装置20は、ブーム8及びバケット10を操作するための作業操作右レバー22aと、アーム9及び旋回体7を操作するための作業操作左レバー22bとを備える。つまり、操作装置20は、ブーム操作装置、バケット操作装置、アーム操作装置及び旋回操作装置28としての機能を有する。ブーム操作装置、バケット操作装置及びアーム操作装置は、総称して作業操作装置29とも記す。走行用の操作装置21は、右クローラを操作するための走行操作右レバー23aと、左クローラを操作するための走行操作左レバー23bと、を備える。なお、本実施形態では、作業操作右レバー22a及び作業操作左レバー22bを総称して操作レバー22と記し、走行操作右レバー23a及び走行操作左レバー23bを総称して操作レバー23と記す。
制御選択スイッチ24は、操作レバー22a,22b,23a,23bのいずれかに設けられる。なお、制御選択スイッチ24は、運転室71内に設けられるタッチパネルのタッチセンサにより構成してもよい。制御選択スイッチ24は、操作装置20の操作に応じて油圧ショベル1の動作を制御する手動モードと、制御装置40が設定した目標経路に応じて油圧ショベル1の動作を制御する自動モードとを切り換えるための操作スイッチである。オペレータは、制御選択スイッチ24を用いて、任意のタイミングで、手動モード及び自動モードのいずれかを選択できる。
本実施形態に係る操作システムは、操作装置20から制御装置40に操作量及び操作方向を表す電気信号が入力され、制御装置40から電磁比例弁51に制御信号が出力され、電磁比例弁51から流量制御弁101に操作圧が出力される電気レバー方式の操作システムである。
油圧ショベル1は、操作レバー22,23の操作量及び操作方向を検出し、検出結果を表す信号を制御装置40に出力する操作検出装置56を有する。操作検出装置56は、作業操作左レバー22bによるアーム操作量(アームクラウド操作量及びアームダンプ操作量)を検出する操作量センサ52aと、作業操作左レバー22bによる旋回操作量(右旋回操作量及び左旋回操作量)を検出する操作量センサ52bと、作業操作右レバー22aによるブーム操作量(ブーム上げ操作量及びブーム下げ操作量)を検出する操作量センサ52cと、作業操作右レバー22aによるバケット操作量(バケットクラウド操作量及びバケットダンプ操作量)を検出する操作量センサ52dと、走行操作右レバー23aによる右クローラ前進操作量及び右クローラ後退操作量を検出する操作量センサ52eと、走行操作左レバー23bによる左クローラ前進操作量及び左クローラ後退操作量を検出する操作量センサ52fと、を有する。なお、アーム操作量、ブーム操作量、及びバケット操作量は、総称して作業操作量とも記す。
複数の操作量センサ52(52a~52f)は、例えば、操作レバー22,23の操作量及び操作方向を検出可能なロータリエンコーダ、あるいはポテンショメータである。
本実施形態に係る制御装置40は、オペレータによる操作レバー22,23の操作情報(操作量及び操作方向)に応じて、作業装置2の回動動作、走行体5の走行動作、及び、旋回体7の旋回動作を制御する。
具体的には、制御装置40は、オペレータによる操作レバー22,23の操作量及び操作方向に応じた制御信号を電磁比例弁51(51a~51l)に出力する。電磁比例弁51は、パイロットポンプ104から圧油が供給されるパイロットライン100に設けられている。電磁比例弁51は、制御装置40からの制御信号が入力されると作動し、パイロットライン100の一次圧を減圧して生成した二次圧を操作圧として流量制御弁101に出力する。流量制御弁101は、複数の油圧アクチュエータ(旋回油圧モータ6、アームシリンダ12、ブームシリンダ11、バケットシリンダ13、走行油圧モータ4a及び走行油圧モータ4b)毎に設けられた複数のスプール弁を有している。電磁比例弁51により出力された操作圧は、スプール弁の受圧室に導かれ、スプールが動作する。これにより、メインポンプ102から吐出された作動油が、スプール弁を通じて対応する油圧アクチュエータに供給され、その油圧アクチュエータを動作させる。
電磁比例弁51a,51bは、旋回油圧モータ6に供給される圧油を制御するための操作圧を流量制御弁101の旋回油圧モータ6駆動用のスプール弁の受圧室に出力する。電磁比例弁51c,51dは、アームシリンダ12に供給される圧油を制御するための操作圧を流量制御弁101のアームシリンダ12駆動用のスプール弁の受圧室に出力する。電磁比例弁51e,51fは、ブームシリンダ11に供給される圧油を制御するための操作圧を流量制御弁101のブームシリンダ11駆動用のスプール弁の受圧室に出力する。電磁比例弁51g,51hは、バケットシリンダ13に供給される圧油を制御するための操作圧を流量制御弁101のバケットシリンダ13駆動用のスプール弁の受圧室に出力する。電磁比例弁51i,51jは、走行油圧モータ4aに供給される圧油を制御するための操作圧を流量制御弁101の走行油圧モータ4a駆動用のスプール弁の受圧室に出力する。電磁比例弁51k,51lは、走行油圧モータ4bに供給される圧油を制御するための操作圧を流量制御弁101の走行油圧モータ4b駆動用のスプール弁の受圧室に出力する。
ブームシリンダ11、アームシリンダ12及びバケットシリンダ13は、それぞれ、供給された圧油によって伸縮し、ブーム8、アーム9及びバケット10を回動させる。これにより、バケット10の位置及び作業装置2の姿勢が変化する。旋回油圧モータ6は、供給された圧油によって回転し、旋回体7を旋回させる。走行油圧モータ4a及び走行油圧モータ4bは、供給された圧油によって回転し、走行体5を走行させる。なお、オペレータによる操作レバー22,23の操作が無い場合であっても、制御装置40からの制御信号によって電磁比例弁51a~51lを作動させ、流量制御弁101を作動させることによって、油圧アクチュエータ(4a,4b,6,11,12,13)を駆動させることが可能である。
油圧ショベル1は、車体3(旋回体7)の姿勢、及びバケット10の対地角を含む作業装置2の姿勢を検出する姿勢検出装置53を備えている。姿勢検出装置53は、複数の姿勢センサとしての、ブーム角度センサ14、アーム角度センサ15、バケット角度センサ17、傾斜角度センサ18及び旋回角度センサ19を含んで構成される。ブーム角度センサ14は、ブームピン8aに取り付けられ、旋回体7に対するブーム8の回動角度を検出し、検出結果を表す信号を制御装置40に出力する。アーム角度センサ15は、アームピン9aに取り付けられ、ブーム8に対するアーム9の回動角度を検出し、検出結果を表す信号を制御装置40に出力する。バケット角度センサ17は、バケットリンク16に取り付けられ、アーム9に対するバケット10の回動角度を検出し、検出結果を表す信号を制御装置40に出力する。制御装置40は、各角度センサ14,15,17によって、ブーム8、アーム9及びバケット10の各回動角度を取得する。
なお、ブーム8、アーム9及びバケット10の各回動角度を取得する方法は、これに限定されない。制御装置40は、水平面等の基準面に対するブーム8、アーム9及びバケット10の各角度を慣性計測装置(IMU:Inertial Measurement Unit)により検出し、ブーム8、アーム9及びバケット10の各回動角度に換算することによって、各回動角度を取得してもよい。また、制御装置40は、ブームシリンダ11、アームシリンダ12及びバケットシリンダ13の各ストロークをストロークセンサにより検出し、ブーム8、アーム9及びバケット10の各回動角度に換算することによって、各回動角度を取得してもよい。
傾斜角度センサ18は、旋回体7に取り付けられ、水平面等の基準面に対する旋回体7(車体3)の傾斜角を検出し、検出結果を表す信号を制御装置40に出力する。旋回角度センサ19は、走行体5と旋回体7との間の旋回装置に取り付けられ、走行体5に対する旋回体7の旋回角度を検出し、検出結果を表す信号を制御装置40に出力する。
ここで、ブーム8、アーム9及びバケット10の各回動角度は、作業装置2の姿勢を表すパラメータである。つまり、ブーム角度センサ14、アーム角度センサ15、及び、バケット角度センサ17は、作業装置2の姿勢を検出する姿勢センサとして機能している。また、旋回体7の傾斜角度及び走行体5に対する旋回体7の旋回角度は、旋回体7(車体3)の姿勢を表すパラメータである。つまり、傾斜角度センサ18及び旋回角度センサ19は、旋回体7(車体3)の姿勢を検出する姿勢センサとして機能している。
油圧ショベル1は、油圧ショベル1の周囲に設定される検出範囲内に存在する物体を検出する物体検出装置54を備えている。また、物体検出装置54は、物体の形状、種別(掘削物、荷台201等)及び位置を検出する。物体検出装置54は、例えば、LiDAR(Light Detection And Ranging)やステレオカメラであり、運転室71の上部などに取り付けられる(図1参照)。
物体検出装置54は、例えば、作業装置2により掘削された掘削物が積み込まれる被積込機械200の荷台201を検知し、物体検出装置54に対する荷台201の位置情報(相対位置)を検出する。つまり、物体検出装置54は、荷台(ベッセル)201の位置を検出するベッセル位置検出装置としての機能を有する。また、物体検出装置54は、掘削対象となる地形210(図2参照)の形状も検出する。なお、物体検出装置54は、油圧ショベル1に複数取り付けられていてもよい。
油圧ショベル1は、メインポンプ102から吐出される作動油の温度を検出する作動油温度センサ55を備えている。作動油温度センサ55は、例えば、作動油タンクや配管に設置される。
制御装置40は、CPU(Central Processing Unit)、MPU(Micro Processing Unit)、DSP(Digital Signal Processor)などの処理装置、RAM(Random Access Memory)、ROM(Read Only Memory)などの内部記憶装置、及び外部I/F(Interface)などがバスにより互いに接続されたコンピュータである。制御装置40の外部I/Fには、操作検出装置56、姿勢検出装置53、物体検出装置54、制御選択スイッチ24、作動油温度センサ55、入力装置57及びハードディスクドライブや大容量フラッシュメモリなどの外部記憶装置が接続されている。
ROMには、各種演算が実行可能なプログラムが格納されている。すなわち、ROMは、本実施形態の機能を実現するプログラムを読み取り可能な記憶媒体である。処理装置は、ROMに記憶されたプログラムをRAMに展開して演算実行する演算装置であって、プログラムに従って外部I/F、及び記憶装置(内部記憶装置及び外部記憶装置)から取り入れた信号に対して所定の演算処理を行う。
外部I/Fの入力部は、各種装置(操作検出装置56、姿勢検出装置53、物体検出装置54、作動油温度センサ55、制御選択スイッチ24、入力装置57等)から入力された信号を処理装置で演算可能なデータに変換する。また、外部I/Fの出力部は、処理装置での演算結果に応じた出力用の信号を生成し、その信号を各種装置(電磁比例弁51等)に出力する。
姿勢検出装置53は、上述した作業装置2の姿勢を検出する姿勢センサ(14,15,17)と、旋回体7(車体3)の姿勢を検出する姿勢センサ(18,19)と、を含んで構成される。
制御装置40は、手動モードが設定されている場合には、操作検出装置56により検出された操作情報に基づいて、旋回体7及び作業装置2の動作を制御する。制御装置40は、自動モードが設定されている場合には、旋回体7及び作業装置2の姿勢、並びに荷台201の位置情報に基づいて、旋回体7及び作業装置2の動作を制御する。
制御装置40は、掘削動作及び放土動作を自動で行う場合、姿勢検出装置53及び物体検出装置54の検出結果に基づいて、動作開始姿勢から動作完了姿勢まで自動で作業装置2を動作させる。また、制御装置40は、運搬動作及び戻り動作を自動で行う場合、姿勢検出装置53及び物体検出装置54の検出結果に基づいて、旋回開始角度から旋回完了角度まで自動で旋回体7を旋回させる(自動旋回制御を実行する)とともに、動作開始姿勢から動作完了姿勢まで自動で作業装置2を動作させる。
図4は、制御装置40の機能ブロック図である。図4に示すように、制御装置40は、ROMに記憶されているプログラムを実行することにより、姿勢演算部41、物体位置演算部42、動作遷移判断部49、旋回開始判断部43、掘削制御部44、運搬制御部45、放土制御部46、戻り制御部47、及び、アクチュエータ指令部48として機能する。
制御装置40のROMには、油圧ショベル1の構成要素の位置及び姿勢の特定に用いられるショベル基準座標系、油圧ショベル1の構成要素の寸法、物体検出装置54の取付位置のデータ等が予め記憶されている。本実施形態のショベル基準座標系は、図5及び図6に示すように、旋回中心軸と地面Gとが交差する点を原点Oとする右手座標系として定義されている。ショベル基準座標系は、走行体5の前進方向をX軸の正方向として定義されている。本実施形態のショベル基準座標系は、原点Oから旋回中心軸と平行に上方に延びる方向をZ軸の正方向として定義されている。本実施形態のショベル基準座標系は、X軸及びZ軸のそれぞれに直交する方向であって、走行体5の左方をY軸の正方向として定義されている。このように本実施形態のショベル基準座標系は、走行体5を基準に設定される座標系であり、XY平面は走行体5が接する地面(走行面)Gに固定されている。
本実施形態のショベル基準座標系において旋回体7の旋回角度θswは、油圧ショベル1が基準姿勢のとき、すなわち作業装置2がX軸と平行となる状態のときに、0度となる。旋回体7の旋回角度θswが0度の状態において、作業装置2の動作平面はXZ平面に平行であり、ブーム8の上げ動作方向はZ軸の正方向であり、アーム9及びバケット10のダンプ方向はX軸の正方向である。
姿勢演算部41は、姿勢検出装置53の検出信号から、ショベル基準座標系における油圧ショベル1の構成要素の姿勢を演算する。具体的には、姿勢演算部41は、ブーム角度センサ14から出力されたブーム8の回動角度の検出信号から、X軸に対するブーム8の回動角度(以下、ブーム角度とも記す)θbmを演算する。姿勢演算部41は、アーム角度センサ15から出力されたアーム9の回動角度の検出信号から、ブーム8に対するアーム9の回動角度(以下、アーム角度とも記す)θamを演算する。姿勢演算部41は、バケット角度センサ17から出力されたバケット10の回動角度の検出信号から、アーム9に対するバケット10の回動角度(以下、バケット角度とも記す)θbkを演算する。姿勢演算部41は、旋回角度センサ19から出力された旋回体7の旋回角度の検出信号から、X軸(走行体5)に対する旋回体7の旋回角度θswを演算する。
姿勢演算部41は、演算された作業装置2の各回動角度θbm,θam,θbk及び旋回体7の旋回角度θswと、ブーム長さLbm、アーム長さLam及びバケット長さLbkとに基づいて、ブーム8、アーム9及びバケット10のそれぞれのショベル基準座標系における位置、すなわちX座標及びY座標により特定される平面位置並びにZ座標により特定される地面Gからの高さを演算する。なお、ブーム長さLbmは、ブームピン8aからアームピン9aまでの長さである。アーム長さLamは、アームピン9aからバケットピン10aまでの長さである。バケット長さLbkは、バケットピン10aからバケット10の先端部(爪先)までの長さである。なお、ブームピン8aは、旋回角度を0度としたとき、旋回中心軸(Z軸)からX軸方向にLoxだけオフセットした位置に設けられている。
また、図示しないが、姿勢演算部41は、傾斜角度センサ18から出力された車体3の傾斜角度の検出信号から、基準面に対する車体3(走行体5)の傾斜角(ピッチ角及びロール角)を演算する。基準面は、例えば、重力方向に直交する水平面である。姿勢演算部41は、車体3の傾斜角、及び作業装置2の各回動角度θbm,θam,θbkから、重力方向に直交する水平面(地面G)に対するバケット10の角度である対地角γを演算する。バケット10の対地角γは、バケット10の先端部とバケットピン10aとを通る直線SLが水平面(地面G)に対して成す角度である。バケット10の対地角γは、バケット10の開口が上方を向いているときであって、直線SLが水平面(地面G)と平行であるときには0(ゼロ)度であり、バケットダンプ動作が進むにつれて大きくなる。バケット10の対地角γは、バケット10の開口が下方を向いているときであって、直線SLが水平面(地面G)と平行であるときには180度である。
図4に示す物体位置演算部42は、物体検出装置54により検出された荷台201の位置情報と、姿勢演算部41により演算された旋回体7の旋回角度θswと、ショベル基準座標系での物体検出装置54の取付位置とに基づき、当該被積込機械200の荷台201のショベル基準座標系における位置(X座標及びY座標により特定される平面位置、及び、Z座標により特定される地面Gからの高さ)を演算する。荷台201の位置情報とは、物体検出装置54に対する被積込機械200の荷台201の相対的な位置の情報である。このように、本実施形態に係る制御装置40は、物体検出装置54を用いて、油圧ショベル1に対する荷台201の相対位置(ショベル基準座標系でのX,Y,Z座標)を取得する。
制御装置40が取得する荷台201の位置情報は、例えば、平面視矩形状の荷台201の上面の四隅の位置座標、すなわち、荷台201の左側辺(左端部)の上縁の前端及び後端、並びに右側辺(右端部)の上縁の前端及び後端の位置座標などである。つまり、制御装置40が取得する荷台201の位置情報には、荷台201の旋回体7に対する相対位置及び相対角度の情報が含まれているといえる。換言すれば、本実施形態においては、制御装置40は、物体検出装置54を用いて、作業装置2により掘削された掘削物が積み込まれる被積込機械200の荷台201における、作業装置2に対する相対位置に関する種々の情報を相対位置情報として取得する。
また、物体位置演算部42は、荷台201の位置情報を演算するのと同様に、掘削対象となる地形210の形状の特徴点(例えば、法肩、法尻等)の位置情報を演算する。
掘削制御部44、運搬制御部45、放土制御部46、及び戻り制御部47は、油圧ショベル1による掘削作業、運搬作業、放土作業、戻り作業を自動で行うための目標経路と、目標経路上での各油圧アクチュエータの目標速度を演算する。掘削制御部44は、バケット10を用いて土砂を掘削するための目標経路と、目標経路上での各油圧アクチュエータの目標速度を演算する。運搬制御部45は、被積込機械200の荷台201上に、掘削物(運搬物)を格納したバケット10を移動させるための目標経路と、目標経路上での各油圧アクチュエータの目標速度を演算する。放土制御部46は、被積込機械200の荷台201上にバケット10内に保持された掘削物を放出するための目標経路と、目標経路上での各油圧アクチュエータの目標速度を演算する。戻り制御部47は、バケット10を被積込機械200の荷台201上から次の掘削開始位置に移動させるための目標経路と、目標経路上での各油圧アクチュエータの目標速度を演算する。なお、目標経路上での目標速度とは、演算周期(制御周期)毎の目標速度ともいえる。
掘削制御部44、運搬制御部45、放土制御部46、及び戻り制御部47は、各種演算を実行する作業場面が異なるものの、同様の機能を有するため、以下では、これらを総称して動作制御部400とも記す。動作制御部400は、作業装置2の制御点(例えば、バケット10の先端部)の目標経路を生成する。また、動作制御部400は、目標経路上でのバケット10の対地角の目標値γtを演算する。動作制御部400は、目標経路にバケット10の先端部を追従させるとともに、バケット10の実際の対地角γを目標値γtに追従させるための各油圧アクチュエータの目標速度を演算する。
図7~図9を参照して、自動運転時の掘削動作、運搬動作、放土動作、及び戻り動作について説明する。図7は、掘削動作の説明図である。図7に示すように、掘削制御部44は、掘削開始位置DP1と、掘削完了位置DP2と、掘削開始位置DP1と掘削完了位置DP2を結ぶ経路である掘削動作の目標経路DPTとを生成する。また、掘削制御部44は、目標経路DPTにおいてバケット10の対地角の目標値γtを設定する。このように、掘削制御部44は、バケット10の先端部などの制御点を目標経路DPTに沿って移動させるための、バケット10の位置と角度の両方の目標値を設定する。
図8は、運搬動作及び放土動作の説明図である。図8に示すように、運搬制御部45は、運搬開始位置CP1と、運搬完了位置CP2と、運搬開始位置CP1と運搬完了位置CP2を結ぶ経路である運搬動作の目標経路CPTとを生成する。運搬開始位置CP1及び運搬完了位置CP2は、旋回角度θswと作業装置2の姿勢により規定できる。運搬開始位置CP1での旋回角度θswは、運搬動作のための旋回が開始する角度であり、以下、運搬動作の旋回開始角度とも記す。また、運搬完了位置CP2での旋回角度θswは、運搬動作のための旋回が完了する角度であり、以下、運搬動作の旋回完了角度とも記す。また、放土制御部46は、放土開始位置LP1と、放土完了位置LP2と、放土開始位置LP1と放土完了位置LP2を結ぶ経路である放土動作の目標経路LPTとを生成する。
図9に示すように、戻り制御部47は、戻り開始位置RP1と、戻り完了位置RP2と、戻り開始位置RP1と戻り完了位置RP2を結ぶ経路である戻り動作の目標経路RPTとを生成する。戻り開始位置RP1及び戻り完了位置RP2は、旋回角度θswと作業装置2の姿勢により規定できる。戻り開始位置RP1での旋回角度θswは、戻り動作のための旋回が開始する角度であり、以下、戻り動作の旋回開始角度とも記す。また、戻り完了位置RP2での旋回角度θswは、戻り動作のための旋回が完了する角度であり、以下、戻り動作の旋回完了角度とも記す。
運搬制御部45、放土制御部46、及び戻り制御部47は、掘削制御部44と同様、バケット10の先端部を目標経路CPT,LPT,RPTに沿って移動させるための、バケット10の位置と角度の両方の目標値を設定する。
図4に示す各動作制御部400(掘削制御部44、運搬制御部45、放土制御部46、及び戻り制御部47)は、バケット10の位置と角度の目標値に基づいて、各油圧アクチュエータの目標速度を演算する。
動作遷移判断部49は、掘削動作から運搬動作、運搬動作から放土動作、放土動作から戻り動作、及び戻り動作から掘削動作への各動作遷移条件が成立したか否かを判断する。動作遷移判断部49は、動作遷移条件が成立した場合には、次の動作を開始するための開始指令を生成する。動作遷移条件は、目標経路の完了位置にバケット10の先端部が到達した場合に成立し、目標経路の完了位置にバケット10の先端部が到達していない場合には成立しない。
例えば、掘削動作が行われている状態において、掘削動作の目標経路DPTの終端である掘削完了位置DP2にバケット10が到達した場合、動作遷移判断部49は、掘削動作から運搬動作への動作遷移条件が成立したと判断し、運搬動作の開始指令を運搬制御部45に出力する。
また、動作遷移判断部49は、制御選択スイッチ24からの操作指令に基づいて、制御モードを自動モード及び手動モードのいずれかに設定する。
手動モードが設定されている場合、アクチュエータ指令部48は、操作検出装置56により検出された操作レバー22の操作量に応じた目標速度を演算する。さらに、アクチュエータ指令部48は、演算した目標速度に応じて電磁比例弁51への制御電流値を演算し、演算結果に応じた制御電流を電磁比例弁51に出力する。つまり、アクチュエータ指令部48は、操作検出装置56により検出された操作量に応じた目標速度でブームシリンダ11、アームシリンダ12、バケットシリンダ13、及び旋回油圧モータ6が動作するように、電磁比例弁51に制御信号を出力する。
自動モードが設定されている場合、アクチュエータ指令部48は、動作制御部400により演算された目標速度に応じて電磁比例弁51への制御電流値を演算し、演算結果に応じた制御電流を電磁比例弁51に出力する。つまり、アクチュエータ指令部48は、動作制御部400により演算された目標速度でブームシリンダ11、アームシリンダ12、バケットシリンダ13、及び旋回油圧モータ6が動作するように、電磁比例弁51に制御信号(動作指令)を出力する。なお、旋回油圧モータ6を動作させるために、アクチュエータ指令部48から電磁比例弁51a,51bに出力される制御信号を「旋回動作指令」と記し、特に、旋回体7の旋回動作が停止している状態において旋回体7の旋回を開始させる旋回動作指令を「旋回動作開始指令」と記す。
ここで、一般的に、旋回動作開始指令が出力されてから旋回油圧モータ6に作動油が供給されて旋回体7が実際に動き出すまでに、0.1~1秒程度の時間を要する。そこで、本実施形態では、掘削動作を行っている状態において、掘削動作から運搬動作への動作遷移条件が成立する前に、制御装置40が運搬動作のための旋回動作開始指令を出力することで、掘削動作完了後、直ちに旋回体7を旋回させる。同様に、放土動作を行っている状態において、放土動作から戻り動作への動作遷移条件が成立する前に、制御装置40が戻り動作のための旋回動作開始指令を出力することで、放土動作完了後、直ちに旋回体7を旋回させる。
旋回開始判断部43は、旋回が必須となる動作(運搬動作及び戻り動作)を実行させるための旋回動作開始指令を、その前の作業(掘削動作及び放土動作)の完了を待たずに出力するか否かを判断する。つまり、旋回開始判断部43は、旋回動作開始指令を出力するタイミングを決定する機能を有する。
バケット10の対地角γが掘削動作完了角度γ1cに達するとともにバケット10の先端部が掘削完了位置DP2に達すると、作業装置2による掘削動作が完了する。掘削動作完了角度γ1cは、作業装置2が掘削対象物を掘削する動作の完了角度である。バケット10の対地角γが掘削動作完了角度γ1cに達したときの作業装置2の姿勢は、掘削動作完了姿勢と記す。バケット10の対地角γが放土動作完了角度γ1rに達するとともにバケット10の先端部が放土完了位置LP2に達すると、作業装置2による放土動作が完了する。放土動作完了角度γ1rは、作業装置2が荷台201の上方でバケット10内の掘削物を放出する動作の完了角度である。バケット10の対地角γが放土動作完了角度γ1rに達したときの作業装置2の姿勢は、放土動作完了姿勢と記す。以下、掘削動作完了姿勢及び放土動作完了姿勢は、総称して動作完了姿勢とも記す。また、掘削動作完了角度γ1c及び放土動作完了角度γ1rは、総称して動作完了角度γ1とも記す。
旋回開始判断部43は、旋回体7の旋回動作が停止し、かつ、作業装置2が動作している状態において、旋回体7の自動旋回制御を開始する旋回開始条件が成立したか否かを判断する。旋回開始条件は、旋回動作開始指令を現時点で出力した場合に、バケット10の対地角γが動作完了角度γ1に至った後に旋回体7の旋回が開始されることが予測されると成立する。
旋回開始条件は、作業装置2が動作完了姿勢に向かって動作している状態において、動作完了姿勢の前の所定姿勢となった場合に成立することになる。ここで、所定姿勢とは、その姿勢であるときに旋回動作開始指令を出力すれば、作業装置2が動作完了姿勢に至った直後に旋回体7の旋回が実際に開始される姿勢である。
旋回開始条件が成立したか否かの判断は、具体的には、以下で説明するように、第1時間t1及び第2時間t2を演算し、演算した第1時間t1と第2時間t2とを比較することにより行われる。旋回開始判断部43は、旋回動作開始指令が出力されてから旋回体7の動作が実際に開始されるまでの第1時間t1を演算する。以下、掘削動作が行われている状態での第1時間t1を第1時間t1cと記し、放土動作が行われている状態での第1時間t1を第1時間t1rと記す。
第1時間t1は、油圧ショベル1の数学モデルを用いて演算することで取得してもよいし、油圧ショベル1に旋回動作開始指令を与えてから動き出すまでの時間を実験的に測定しその値を保存することで取得してもよい。油圧ショベル1の数学モデルは、例えば、旋回体7と、作業装置2を構成する3つの駆動対象部材(ブーム8、アーム9、及びバケット10)を剛体として、駆動トルクにより動作する4リンク系の運動方程式により表される。なお、運動方程式で用いられる駆動トルクは、各油圧アクチュエータに作用する圧力から変換可能である。また、油圧ショベル1の数学モデルとして、各油圧アクチュエータへの速度指令に対する伝達関数を採用してもよい。
ここで、第1時間t1は、作業装置2の慣性モーメントが大きいほど長くなる。このため、作業装置2の姿勢を考慮して第1時間t1を求めることが好ましい。また、第1時間t1は、作動油の温度(すなわち作動油の粘度)によっても変化する。このため、作動油の温度を考慮して第1時間t1を求めることが好ましい。
例えば、旋回開始判断部43は、作業装置2の姿勢(ブームの角度、アームの角度、バケットの角度)、及び作動油の温度に応じた第1時間t1の特性データを用いて、第1時間t1を演算する。第1時間t1の特性データは、作業装置2の姿勢及び作動油の温度に応じて変化する第1時間t1のデータテーブルであってもよいし、関数データであってもよい。なお、第1時間t1cの特性データと、第1時間t1rの特性データとは同じであってもよいし、異なっていてもよい。旋回開始判断部43は、第1時間t1の特性データを参照し、姿勢演算部41によって演算された作業装置2の姿勢と、作動油温度センサ55によって検出された作動油の温度とに基づき、第1時間t1を演算する。
旋回開始判断部43は、現時点から作業装置2が動作完了姿勢に至るまでの第2時間t2を演算する。なお、第2時間t2は、現時点からバケット10の対地角γが動作完了角度γ1に至るまでの時間ともいえる。以下、掘削動作が行われている状態での第2時間t2を第2時間t2cと記し、放土動作が行われている状態での第2時間t2を第2時間t2rと記す。
第2時間t2cは、現時点からバケット10の先端部が掘削完了位置DP2に到達するまでの予測時間に相当する。第2時間t2rは、現時点からバケット10の先端部が放土完了位置LP2に到達するまでの予測時間に相当する。
旋回開始判断部43は、姿勢演算部41により演算された作業装置2の現在の姿勢と、掘削制御部44により演算された目標経路DPT及び掘削動作完了姿勢までの各油圧アクチュエータの目標速度とに基づいて、第2時間t2cを演算する。同様に、旋回開始判断部43は、姿勢演算部41により演算された作業装置2の現在の姿勢と、放土制御部46により演算された目標経路LPT及び放土動作完了姿勢までの各油圧アクチュエータの目標速度とに基づいて、第2時間t2rを演算する。
なお、第2時間t2は、旋回開始判断部43が演算する場合に限定されない。掘削制御部44または放土制御部46が第2時間t2を演算し、演算した第2時間t2を旋回開始判断部43に出力してもよい。
旋回開始判断部43は、第2時間t2が第1時間t1よりも短くなった場合、すなわち第2時間t2が第1時間t1よりも長い状態から短い状態に遷移した場合に、旋回開始条件が成立したと判断し、その判断結果を表す旋回フラグをオンに設定する。
旋回開始判断部43は、掘削動作が行われている状態にあっては、掘削完了位置DP2にバケット10の制御点が到達した直後に旋回体7が旋回動作を開始すると判断し、運搬旋回フラグをオンにする。また、旋回開始判断部43は、放土動作が行われている状態にあっては、放土完了位置LP2にバケット10の制御点が到達した直後に旋回体7が旋回動作を開始すると判断し、戻り旋回フラグをオンにする。
このように、旋回開始判断部43は、掘削動作や放土動作などの作業装置2の動作が行われることにより、第2時間t2が第1時間t1よりも短くなった場合に旋回開始条件が成立したと判断する。つまり、旋回開始判断部43は、作業装置2の動作状態に基づいて旋回開始条件が成立したか否かを判断している。また、旋回開始条件は、旋回動作が停止していることを前提としている。このため、旋回開始判断部43は、作業装置2の動作状態だけでなく、旋回体7の旋回動作状態に基づいて旋回開始条件が成立したか否かを判断している。
運搬制御部45は、掘削動作中であるときに運搬旋回フラグがオンに設定されると、掘削動作を継続しつつ運搬動作における旋回体7の自動旋回制御を開始する。これにより、運搬開始位置CP1から運搬完了位置CP2に向かう方向への旋回体7の動作を開始させる旋回動作開始指令がアクチュエータ指令部48から電磁比例弁51に出力される。戻り制御部47は、放土動作中であるときに戻り旋回フラグがオンに設定されると、放土動作を継続しつつ戻り動作における旋回体7の自動旋回制御を開始する。これにより、戻り開始位置RP1から戻り完了位置RP2に向かう方向への旋回体7の動作を開始させる旋回動作開始指令がアクチュエータ指令部48から電磁比例弁51に出力される。
図10及び図11を参照して、第1実施形態に係る制御装置40により実行される処理の流れの一例を説明する。図10は、第1実施形態に係る制御装置40による処理の一例について示すフローチャートであり、掘削動作の開始から運搬動作の完了までの処理の流れを示す。図11は、第1実施形態に係る制御装置40による処理の一例について示すフローチャートであり、放土動作の開始から戻り動作の完了までの処理の流れを示す。図10及び図11のフローチャートに示す処理では、掘削動作、運搬動作、放土動作、及び戻り動作が、それぞれ1動作のみ実行される場合を例に説明する。しかしながら、これら一連の動作は、複数回実施してもよい。また、必ずしも掘削動作から開始する必要もない。
図10に示すように、ステップS101において、制御選択スイッチ24により制御モードを自動モードにするための操作が行われると、動作遷移判断部49は、制御モードを自動モードに設定する。自動モードが設定されると、アクチュエータ指令部48は、掘削制御部44により演算される各油圧アクチュエータの目標速度に基づき、作業装置2による掘削動作を開始する。つまり、掘削制御部44による掘削制御が開始される。掘削制御において、掘削制御部44は、バケット10の対地角γが掘削動作完了角度γ1cとなるまで自動で作業装置2を動作させる。
次のステップS102において、旋回開始判断部43は、運搬動作の旋回動作開始指令の出力後に旋回体7が動き出すまでの時間(第1時間)t1cを演算する。次のステップS103において、旋回開始判断部43は、現時点から掘削完了位置DP2にバケット10が到達するまでの時間(第2時間)t2cを演算する。
次のステップS104において、旋回開始判断部43は、第1時間t1cと第2時間t2cを比較する。この比較により、旋回開始判断部43は、旋回動作開始指令を現時点で出力した場合に、旋回体7の所定方向への動作は、作業装置2が掘削動作完了姿勢に至った後に開始されるか否かを判断する。すなわち、ステップS104の処理は、旋回開始条件が成立したか否かを判断する処理である。
第1時間t1cが第2時間t2c以下である場合には、旋回開始判断部43は、旋回開始条件が成立していないと判断し、処理をステップS103に戻す。第1時間t1cが第2時間t2cより大きい場合には、旋回開始判断部43は、旋回開始条件が成立していると判断し、運搬旋回フラグをオンに設定して処理をステップS105に進める。
ステップS105において、運搬制御部45は、運搬動作における旋回体7の制御を開始する。つまり、ステップS105において、運搬制御部45は、運搬動作のための旋回動作開始指令を出力する。次のステップS106において、動作遷移判断部49は、掘削動作から運搬動作への動作遷移条件が成立したか否かを判断する。動作遷移判断部49は、バケット10の対地角γが掘削動作完了角度γ1cに達するとともにバケット10の先端部が掘削完了位置DP2に達すると、掘削動作から運搬動作への動作遷移条件が成立したと判断し、処理をステップS107に進める。バケット10の対地角γが掘削動作完了角度γ1cに達していない場合、あるいは、バケット10の先端部が掘削完了位置DP2に達していない場合、動作遷移判断部49は、掘削動作から運搬動作への動作遷移条件は成立していないと判断する。ステップS106の処理は、肯定判断されるまで所定の演算周期で繰り返し実行される。
ステップS107において、運搬制御部45は、運搬動作における作業装置2の制御を開始する。なお、上述したように、運搬動作における旋回体7の制御は、動作遷移条件の成立前に先立って開始されている(ステップS105)。
次のステップS108において、運搬動作から放土動作への動作遷移条件が成立すると、運搬動作が完了する。運搬動作が完了すると、運搬制御部45は、運搬旋回フラグをオフに設定する。運搬動作が完了すると、処理が図11に示すステップS109に進み、動作遷移判断部49は動作を放土動作に遷移させる。これにより、放土制御部46による放土制御が開始される。放土制御において、放土制御部46は、バケット10の対地角γが放土動作完了角度γ1rとなるまで自動で作業装置2を動作させる。
次のステップS110において、旋回開始判断部43は、戻り動作の旋回指令後に旋回体7が動き出すまでの時間(第1時間)t1rを演算する。次のステップS112において、旋回開始判断部43は、現時点から放土完了位置LP2にバケット10が到達するまでの時間(第2時間)t2rを演算する。
次のステップS113において、旋回開始判断部43は、第1時間t1rと第2時間t2rとを比較する。この比較により、旋回開始判断部43は、旋回動作開始指令を現時点で出力した場合に、旋回体7の所定方向への動作は、作業装置2が放土動作完了姿勢に至った後に開始されるか否かを判断する。すなわち、ステップS113の処理は、旋回開始条件が成立したか否かを判断する処理である。
第1時間t1rが第2時間t2r以下である場合には、旋回開始判断部43は、旋回開始条件が成立していないと判断し、処理をステップS112に戻す。第1時間t1rが第2時間t2rより大きい場合には、旋回開始判断部43は、旋回開始条件が成立していると判断し、戻り旋回フラグをオンに設定して処理をステップS114に進める。
ステップS114において、戻り制御部47は、戻り動作における旋回体7の制御を開始する。つまり、ステップS114において、戻り制御部47は、戻り動作のための旋回動作開始指令を出力する。次のステップS115において、動作遷移判断部49は、放土動作から戻り動作への動作遷移条件が成立したか否かを判断する。動作遷移判断部49は、バケット10の対地角γが放土動作完了角度γ1rに達するとともにバケット10の先端部が放土完了位置LP2に達すると、放土動作から戻り動作への動作遷移条件が成立したと判断し、処理をステップS116に進める。バケット10の対地角γが放土動作完了角度γ1rに達していない場合、あるいは、バケット10の先端部が放土完了位置LP2に達していない場合、動作遷移判断部49は、放土動作から戻り動作への動作遷移条件は成立していないと判断する。ステップS115の処理は、肯定判断されるまで所定の演算周期で繰り返し実行される。
ステップS116において、戻り制御部47は、戻り動作における作業装置2の制御を開始する。なお、上述したように、戻り動作における旋回体7の制御は、動作遷移条件の成立前に先立って開始されている(ステップS114)。
次のステップS108において、バケット10の先端部が戻り完了位置RP2に達すると、戻り動作が完了する。戻り動作が完了すると、戻り制御部47は、戻り旋回フラグをオフに設定する。戻り動作が完了すると、図11のフローチャートに示す処理が終了する。
以下、図7~図9及び図12を参照して、本実施形態に係る油圧ショベル1の主な動作について説明する。図12は、掘削動作から運搬動作へ、あるいは放土動作から戻り動作へ、動作が遷移する場合のバケット10の対地角γ、旋回動作指令の出力有無(ON/OFF)、及び旋回角度θswの時系列変化を示す図である。図12(a)~(c)の横軸は、時間を示す。図12(a)の縦軸はバケット10の対地角γを示し、図12(b)の縦軸は旋回動作指令の出力の有無を示し、図12(c)の縦軸は旋回角度θswを示している。なお、旋回角度θswは、掘削動作または放土動作を開始した位置を基準位置とし、その基準位置から動作完了角度まで正の方向に増加するグラフとして記載している。また、図12では、説明の便宜上、掘削動作から運搬動作への遷移、及び放土動作から戻り動作への遷移の各パラメータの時系列変化を共通のグラフで示している。しかしながら、掘削動作から運搬動作への遷移、及び放土動作から戻り動作への遷移の各パラメータの時系列変化は、実際には異なる。
まず、図7及び図12を用いて、掘削動作から運搬動作に遷移する際の動作について説明する。制御装置40は、旋回体7の旋回動作が停止し、かつ、バケット10の対地角γが掘削動作完了角度γ1cに近づくように、作業装置2が自動で動作している状態において、旋回開始条件が成立したか否かを判断する(図10のステップS101~S104)。
掘削動作を開始した状態S10から一定時間が経過した時刻T2において、旋回開始条件が成立すると(図10のステップS104でYes)、旋回体7の自動旋回制御が開始される(状態S11)。一方、時刻T2よりも前の時刻T1では、旋回開始条件が成立していないため(図10のステップS104でNo)、旋回体7の自動旋回制御は開始されていない。掘削動作が完了する時刻T3よりも前の段階(時刻T2)で旋回体7の自動旋回制御が開始される(旋回動作開始指令が出力される)。このように、制御装置40は、旋回開始条件が成立したタイミング(時刻T2)で、旋回体7を旋回完了角度に向かって旋回開始させる旋回動作開始指令を出力する。これにより、バケット10の対地角γが動作完了角度γ1(掘削動作完了角度γ1c)に到達した直後に、旋回体7が実際に旋回し始める(状態S12)。つまり、バケット10の対地角γが掘削動作完了角度γ1cに至るタイミングと、旋回体7が旋回を開始するタイミングとが略一致する。これにより、掘削動作から運搬動作への遷移が滑らかに行われる。
なお、掘削制御部44は、物体検出装置54が取得した掘削対象地形61の情報に基づき、バケット10の周囲に土砂が存在しない位置を掘削完了位置DP2に設定する。そのため、掘削完了位置DP2に到達した直後に旋回動作を開始しても、バケット10に横当たりする土砂は存在しないため、作業装置2の損傷を防ぐことができる。
時刻T3で、バケット10の対地角γが掘削動作完了角度γ1cに到達した状態になると、作業装置2の運搬制御が開始する。旋回体7及び作業装置2が運搬動作を行って、バケット10の先端部が運搬完了位置CP2(図8参照)に到達すると、運搬動作が完了する。
次に図9及び図12を用いて、放土動作から戻り動作に遷移する際の動作について説明する。制御装置40は、旋回体7の旋回動作が停止し、かつ、バケット10の対地角γが放土動作完了角度γ1rに近づくように、作業装置2が自動で動作している状態において、旋回開始条件が成立したか否かを判断する(図11のステップS109~S113)。
放土動作を開始した状態S20から一定時間が経過した時刻T2において、旋回開始条件が成立すると(図11のステップS113でYes)、旋回体7の自動旋回制御が開始される。一方、時刻T2よりも前の時刻T1では、旋回開始条件が成立していないため(図11のステップS113でNo)、旋回体7の自動旋回制御は開始されていない。放土動作が完了する時刻T3よりも前の段階(時刻T2)で旋回体7の自動旋回制御が開始される(旋回動作開始指令が出力される)。このように、制御装置40は、旋回開始条件が成立したタイミング(時刻T2)で、旋回体7を旋回完了角度に向かって旋回開始させる旋回動作開始指令を出力する。これにより、バケット10の対地角γが動作完了角度γ1(放土動作完了角度γ1r)に到達した直後に、旋回体7が実際に旋回し始める。つまり、バケット10の対地角γが放土動作完了角度γ1rに至るタイミングと、旋回体7が旋回を開始するタイミングとが略一致する。これにより、放土動作から戻り動作への遷移が滑らかに行われる。
時刻T3で、バケット10の対地角γが放土動作完了角度γ1rに到達した状態になると、作業装置2の戻り制御が開始する。旋回体7及び作業装置2が戻り動作を行って、バケット10の先端部が戻り完了位置RP2に到達した状態S22になると、戻り動作が完了する。
上述した第1実施形態によれば、次の作用効果を奏する。
(1)油圧ショベル(作業機械)1は、走行体5と、走行体5に対して旋回可能に設けられる旋回体7と、旋回体7に取り付けられ、ブーム8、アーム9及びバケット10を有する作業装置2と、を備える。また、油圧ショベル1は、旋回体7の姿勢、及びバケット10の対地角γを含む作業装置2の姿勢を検出する姿勢検出装置53と、作業装置2により掘削された掘削物が積み込まれる被積込機械200の荷台(ベッセル)201の位置を検出する物体検出装置(ベッセル位置検出装置)54と、を備える。さらに、油圧ショベル1は、姿勢検出装置53及び物体検出装置54の検出結果に基づいて、少なくとも旋回体7を目標となる旋回角度である旋回完了角度まで自動で旋回させる自動旋回制御を行う制御装置40を備える。なお、自動旋回制御を開始する旋回角度である旋回開始角度は、運搬動作にあっては運搬開始位置CP1における旋回角度θswであり、戻り動作にあっては戻り開始位置RP1における旋回角度θswである。また、自動旋回制御を完了する旋回角度である旋回完了角度は、運搬動作にあっては運搬完了位置CP2における旋回角度θswであり、戻り動作にあっては戻り完了位置RP2における旋回角度θswである。制御装置40は、旋回体7の旋回動作状態及び作業装置2の動作状態に基づいて、旋回体7の自動旋回制御を開始する旋回開始条件が成立したか否かを判断する。制御装置40は、旋回開始条件が成立したと判断した場合には、作業装置2が動作している状態にあるか否かに関わらず、旋回開始条件が成立したタイミングで、旋回体7を旋回完了角度に向かって旋回開始させる旋回動作開始指令を出力する。
制御装置40は、掘削動作中に旋回開始条件が成立した場合には、旋回動作開始指令を出力して旋回体7の運搬制御を開始する。その結果、作業装置2が掘削動作完了姿勢に至ると同時に、あるいはその直後に旋回体7が実際に旋回し始める。したがって、本実施形態によれば、掘削動作から運搬動作への遷移を滑らかにすることができる。また、制御装置40は、放土動作中に旋回開始条件が成立した場合には、旋回動作開始指令を出力して旋回体7の戻り制御を開始する。その結果、作業装置2が放土動作完了姿勢に至ると同時に、あるいはその直後に旋回体7が実際に旋回し始める。したがって、本実施形態によれば、放土動作から戻り動作への遷移を滑らかにすることができる。つまり、本実施形態によれば、掘削積込作業において、作業装置2が単独で動作している状態から、旋回動作を必要とする動作への遷移を滑らかに行うことができる。その結果、作業現場での生産性(作業効率)を向上することができる。
(2)制御装置40は、姿勢検出装置53の検出結果に基づきバケット10の対地角γを演算する。制御装置40は、掘削動作及び放土動作のそれぞれにおいて、バケット10の対地角γが動作完了角度γ1となるまで自動で作業装置2を動作させる。制御装置40は、旋回体7の旋回動作が停止し、かつ、バケット10の対地角γが動作完了角度γ1に近づくように、作業装置2が自動で動作している状態において、旋回開始条件が成立したか否かを判断する。この構成によれば、自動掘削動作から自動運搬動作への遷移、及び、自動放土動作から自動戻り動作への遷移を滑らかにすることができる。
(3)制御装置40は、旋回動作開始指令を現時点で出力した場合に、バケット10の対地角γが動作完了角度γ1に至った後に旋回体7の旋回が開始されることが予測されると、旋回開始条件が成立したと判断する。制御装置40は、上記の予測がなされるまでは旋回開始条件は成立していないと判断する。この構成によれば、バケット10の対地角γが動作完了角度γ1に至った後に、旋回体7が実際に旋回し始める。つまり、この構成によれば、バケット10の対地角γが動作完了角度γ1に至る前に、旋回体7が実際に旋回し始めることを適切に防止することができる。
(4)制御装置40は、旋回動作開始指令が出力されてから旋回体7の動作が開始されるまでの第1時間t1を演算する。制御装置40は、現時点からバケット10の対地角γが動作完了角度γ1に至るまでの第2時間t2を演算する。制御装置40は、第2時間t2が第1時間t1よりも短くなった場合に、旋回開始条件が成立したと判断する。つまり、制御装置40は、上記の予測がなされたとみなす。制御装置40は、第2時間t2が第1時間t1以上の場合には、旋回開始条件は成立していないと判断する。この構成では、制御装置40が、現時点の作業装置2の姿勢に基づき、第2時間t2を繰り返し演算する。このため、バケット10の対地角γが動作完了角度γ1に至る前に、旋回体7が実際に旋回し始めることを、より適切に防止することができる。
<第1実施形態の変形例1>
第1実施形態では、掘削動作から運搬動作へ遷移する際の制御の内容と、放土動作から戻り動作へ遷移する際の制御の内容とが同様である例について説明した。しかしながら、本発明はこれに限定されない。以下、図13~図16を参照して、放土動作から戻り動作へ遷移する際の制御内容の変形例を説明する。
第1実施形態では、掘削動作から運搬動作へ遷移する際の制御の内容と、放土動作から戻り動作へ遷移する際の制御の内容とが同様である例について説明した。しかしながら、本発明はこれに限定されない。以下、図13~図16を参照して、放土動作から戻り動作へ遷移する際の制御内容の変形例を説明する。
図13は、第1実施形態の変形例1に係る油圧ショベル1が放土動作から戻り動作に遷移する様子を示す平面模式図である。第1実施形態に係る制御装置40は、作業装置2が放土動作完了姿勢に至った後に旋回体7の旋回が開始されるように、旋回開始指令を放土動作中に出力した。これに対して、本変形例1に係る制御装置40は、作業装置2が放土動作完了姿勢に至る前に旋回体7の旋回が開始され、かつ、作業装置2が放土動作完了姿勢に至った後にバケット10が荷台201の外に出始めるように、放土動作中に旋回開始指令を出力する。
このため、本変形例1では、図13に示すように、バケット10が戻り開始位置RP1から荷台201の後端部に到達するように旋回体7が旋回している間にも作業装置2が放土動作を継続している。そして、バケット10が荷台201の外に出始める直前に、作業装置2による放土動作が完了する。その後、バケット10の制御点が位置RP3と戻り完了位置RP2とを結ぶ目標経路RPTに沿って移動するように、旋回体7及び作業装置2が制御される。
図14は、図11と同様の図であり、第1実施形態の変形例1に係る制御装置40により実行される処理の一例について示すフローチャートであり、放土動作の開始から戻り動作の完了までの処理の流れを示す。図14のフローチャートでは、図11のフローチャートのステップS113の処理に代えて、ステップS113Bの処理が実行される。また、図14のフローチャートでは、図11のフローチャートのステップS110とS112の間に、ステップS111Bの処理が追加されている。
図14に示すように、本変形例では、ステップS110において第1時間t1rの演算処理が終わると、処理がステップS111Bに進む。ステップS111Bにおいて、旋回開始判断部43は、記憶装置に記憶されている油圧ショベル1の数学モデルと、姿勢演算部41により演算される油圧ショベル1の姿勢と、物体位置演算部42により演算される荷台201の位置情報とに基づいて、第3時間t3rを演算する。第3時間t3rは、旋回体7が実際に旋回し始めてからバケット10が荷台201の外に出始めるまでの時間に相当する。換言すれば、第3時間t3rは、旋回体7が荷台201の後端部に到達するまでの時間に相当する。
旋回開始判断部43は、バケット10が戻り開始位置RP1から荷台201の後端部に至るまでの旋回角度θsw1と、第3時間t3rとの関係を規定するデータテーブルを用いて、第3時間t3rを演算してもよい。図15は、第3時間t3rのデータテーブルを示す図である。第3時間t3rのデータテーブルは、予め実験等により定められ、記憶装置に記憶されている。旋回開始判断部43は、油圧ショベル1の姿勢と、油圧ショベル1に対する荷台201の相対位置とに基づき、バケット10が現在の位置から荷台201の後端部に到達する位置までの旋回角度θsw1を演算する。旋回開始判断部43は、図15のデータテーブルを参照し、演算した旋回角度θsw1に基づき、第3時間t3rを演算する。
図14のステップS111Bにおいて第3時間t3rの演算処理が完了すると、処理がステップS112に進み、第2時間t2rが演算される。ステップS112において第2時間t2rの演算処理が完了すると、処理がステップS113Bに進む。
ステップS113Bの処理は、旋回開始条件が成立したか否かを判断する処理である。ステップS113Bにおいて、旋回開始判断部43は、第1時間t1rと第3時間t3rの和と、第2時間t2rとを比較する。この比較により、旋回開始判断部43は、旋回動作開始指令を現時点で出力した場合に、バケット10の対地角γが放土動作完了角度γ1rに至る前に旋回体7の旋回が開始され、かつ、バケット10の対地角γが放土動作完了角度γ1rに至った後にバケット10が荷台201の外に出始めるか否かを判断する。
第1時間t1rと第3時間t3rの和が第2時間t2r以下である場合には、旋回開始判断部43は、旋回開始条件が成立していないと判断し、処理をステップS112に戻す。第1時間t1rと第3時間t3rの和が第2時間t2rより大きい場合には、旋回開始判断部43は、旋回開始条件が成立していると判断し、戻り旋回フラグをオンに設定して処理をステップS114に進める。
つまり、本変形例では、バケット10の対地角γが放土動作完了角度γ1rとなった直後に、バケット10が荷台201の端部を通過し始めることが予測された場合(ステップS113BでYes)に、旋回体7の戻り制御を開始する(ステップS114)。
図13及び図16を用いて、本変形例において、放土動作から戻り動作に遷移する際の動作について説明する。図16は、図12と同様の図であり、第1実施形態の変形例1において、放土動作から戻り動作へ、動作が遷移する場合のバケット10の対地角γ、旋回動作指令の出力有無(ON/OFF)、及び旋回角度θswの時系列変化を示す図である。
本変形例では、放土動作を開始した状態S20から一定時間が経過した時刻Tr2において、旋回開始条件が成立し(図14のステップS113BでYes)、旋回体7の自動旋回制御が開始される。一方、時刻Tr2よりも前の時刻Tr1では、旋回開始条件が成立していないため(図14のステップS113BでNo)、旋回体7の自動旋回制御は開始されていない。本変形例では、バケット10の対地角γが放土動作完了角度γ1rに到達する時刻Tr4よりも前の時刻Tr3で旋回体7が実際に旋回し始める。したがって、旋回体7の旋回により、バケット10は荷台201の上方でダンプ動作をしつつ荷台201の後端部に向かって移動する。旋回角度θswが所定の旋回角度θsw1まで増加すると、バケット10が荷台201の後端部に到達した状態S21となる。このときのバケット10の先端部の位置RP3は、荷台201の上縁よりも高い位置に設定されることが好ましい。
本変形例では、バケット10の対地角γが放土動作完了角度γ1rに至るタイミングと、バケット10が荷台201の後端部に到達するタイミングが一致する。時刻Tr4で、バケット10の対地角γが放土動作完了角度γ1rに到達した状態S21になると、作業装置2の戻り制御が開始する。旋回体7及び作業装置2が戻り動作を行って、バケット10の先端部が戻り完了位置RP2に到達した状態S22になると、戻り動作が完了する。
このような第1実施形態の変形例1によれば、第1実施形態と同様の効果に加え、次の作用効果を奏する。
(5)制御装置40は、作業装置2が荷台201の上方でバケット10内の掘削物を放出する放土動作(放出動作)をしている状態において、旋回動作開始指令を現時点で出力した場合に、バケット10の対地角γが放土動作完了角度(動作完了角度)γ1rに至る前に旋回体7の旋回が開始され、かつ、バケット10の対地角γが放土動作完了角度γ1rに至った後にバケット10が荷台201の外に出始めることが予測されると、旋回開始条件が成立したと判断する。制御装置40は、上記の予測がなされるまでは旋回開始条件は成立していないと判断する。本変形例において、放土動作が行われているときに旋回動作開始指令を出力する所定姿勢は、上記実施形態とは異なる。本変形例に係る所定姿勢とは、その姿勢であるときに旋回動作開始指令を出力すれば、作業装置2が放土動作完了姿勢に至った直後に作業装置2が荷台201の外に出始める姿勢である。本変形例では、放土動作が完了する前に、旋回体7を荷台201の上方において実際に動かすことができるので、上記実施形態よりも生産性を向上することができる。
(6)制御装置40は、旋回動作開始指令が出力されてから旋回体7の動作が開始されるまでの第1時間t1rを演算する。制御装置40は、現時点からバケット10の対地角γが放土動作完了角度γ1rに至るまでの第2時間t2rを演算する。制御装置40は、旋回体7の動作が開始されてからバケット10が荷台201の外に出始めるまでの第3時間t3rを演算する。制御装置40は、第2時間t2rが第1時間t1rと第3時間t3rの和よりも短くなった場合に、旋回開始条件が成立したと判断する。この構成では、制御装置40が、現時点の作業装置2の姿勢に基づき、第2時間t2rを繰り返し演算する。このため、作業装置2が放土動作完了姿勢に至る前に、旋回体7が荷台201の外に出てしまうことを適切に防止することができる。
<第1実施形態の変形例2>
第2時間t2rの演算方法は上述した例に限定されない。
第2時間t2rの演算方法は上述した例に限定されない。
<第1実施形態の変形例2-1>
例えば、制御装置40は、バケット10の対地角γと、その対地角γから放土動作が継続された場合に、バケット10内の掘削物の放出が完了するまでの時間(第2時間t2r)との関係を規定するデータテーブル(以下、第2時間特性テーブルとも記す)を用いて、第2時間t2rを演算してもよい。バケット10内の掘削物の放出が完了するまでの時間は、掘削物の土質(粘性、粒径)の影響を受ける。このため、制御装置40は、掘削物の土質に基づき、第2時間特性テーブルを補正してもよい。掘削物の土質は、入力装置57により制御装置40に入力される。制御装置40は、補正後の第2時間特性テーブルを参照し、バケット10の対地角γに基づき、第2時間t2rを演算する。
例えば、制御装置40は、バケット10の対地角γと、その対地角γから放土動作が継続された場合に、バケット10内の掘削物の放出が完了するまでの時間(第2時間t2r)との関係を規定するデータテーブル(以下、第2時間特性テーブルとも記す)を用いて、第2時間t2rを演算してもよい。バケット10内の掘削物の放出が完了するまでの時間は、掘削物の土質(粘性、粒径)の影響を受ける。このため、制御装置40は、掘削物の土質に基づき、第2時間特性テーブルを補正してもよい。掘削物の土質は、入力装置57により制御装置40に入力される。制御装置40は、補正後の第2時間特性テーブルを参照し、バケット10の対地角γに基づき、第2時間t2rを演算する。
<第1実施形態の変形例2-2>
また、制御装置40は、物体検出装置54によって掘削積込サイクルの初回の放土動作におけるバケット10内の運搬物(掘削物)の挙動に基づいて、放土動作を開始してから完了するまでの時間(以下、放出所要時間)を演算し、掘削積込サイクルの2回目以降の放土動作から戻り動作への遷移の制御に利用してもよい。バケット10内の運搬物の挙動とは、例えば、物体検出装置54としてのステレオカメラにより撮影された画像内のバケット10内の運搬物の面積の変化等である。掘削積込サイクルの初回の放土動作において、制御装置40は、物体検出装置54により検出されたバケット10内の運搬物の面積が所定値以下になった場合に、放土動作が完了したと判断して放出所要時間を演算する。
また、制御装置40は、物体検出装置54によって掘削積込サイクルの初回の放土動作におけるバケット10内の運搬物(掘削物)の挙動に基づいて、放土動作を開始してから完了するまでの時間(以下、放出所要時間)を演算し、掘削積込サイクルの2回目以降の放土動作から戻り動作への遷移の制御に利用してもよい。バケット10内の運搬物の挙動とは、例えば、物体検出装置54としてのステレオカメラにより撮影された画像内のバケット10内の運搬物の面積の変化等である。掘削積込サイクルの初回の放土動作において、制御装置40は、物体検出装置54により検出されたバケット10内の運搬物の面積が所定値以下になった場合に、放土動作が完了したと判断して放出所要時間を演算する。
なお、放土動作が完了するタイミングは、オペレータが入力装置57を操作することにより、制御装置40に対して教示してもよい。例えば、掘削積込サイクルの初回の放土動作において、制御装置40は、放土動作の開始時刻から、オペレータが入力装置57を操作した時刻までの時間を、放出所要時間として記憶する。
制御装置40は、掘削積込サイクルの2回目以降において、放土動作開始時刻からの経過時間を放出所要時間から差し引くことにより第2時間t2rを演算する。
このように、本変形例に係る制御装置40は、初回の放土動作において、バケット10内の掘削物を放出する動作の開始時刻から完了時刻までの時間である放出所要時間を演算する。制御装置40は、2回目以降の放土動作において、バケット10内の掘削物を放出する動作の開始時刻からの経過時間を、放出所要時間から減算することにより、第2時間t2rを演算する。この構成によれば、作業を行う油圧ショベル1の個体差等に関わらず、旋回動作開始指令を適切なタイミングで制御装置40から出力させることができる。
<第2実施形態>
図17~図21を参照して、本発明の第2実施形態に係る油圧ショベル1について説明する。なお、第1実施形態で説明した構成と同一もしくは相当する構成には同一の参照記号を付し、相違点を主に説明する。第2実施形態に係る制御装置240、バケット10内の運搬物(土砂等の掘削物)の重量を取得し、取得した重量に基づき旋回開始条件が成立したか否かを判断する。制御装置240は、バケット10内の掘削物の重量が所定重量に達した場合には、旋回開始条件が成立したと判断する。制御装置240は、バケット10内の掘削物の重量が所定重量に達していない場合には、旋回開始条件は成立していないと判断する。以下、第2実施形態に係る油圧ショベル1の構成、及び制御装置240の機能について詳しく説明する。
図17~図21を参照して、本発明の第2実施形態に係る油圧ショベル1について説明する。なお、第1実施形態で説明した構成と同一もしくは相当する構成には同一の参照記号を付し、相違点を主に説明する。第2実施形態に係る制御装置240、バケット10内の運搬物(土砂等の掘削物)の重量を取得し、取得した重量に基づき旋回開始条件が成立したか否かを判断する。制御装置240は、バケット10内の掘削物の重量が所定重量に達した場合には、旋回開始条件が成立したと判断する。制御装置240は、バケット10内の掘削物の重量が所定重量に達していない場合には、旋回開始条件は成立していないと判断する。以下、第2実施形態に係る油圧ショベル1の構成、及び制御装置240の機能について詳しく説明する。
図17は、第2実施形態に係る制御装置240の機能ブロック図である。第2実施形態に係る油圧ショベル1は、運搬物情報取得装置258を備えている。運搬物情報取得装置258は、バケット10に格納された運搬物の重量を算出する。運搬物情報取得装置258は、例えば、油圧シリンダ(11~13)の圧力を検出する圧力センサ(不図示)と、圧力センサの検出結果及び姿勢検出装置53の検出結果に基づき運搬物の重量を演算する演算装置と、を備えている。なお、運搬物情報取得装置258の構成はこれに限定されない。運搬物情報取得装置258は、バケット10内の運搬物の重量を直接的に検出する重量センサであってもよい。また、本実施形態では、運搬物情報取得装置258の演算装置が、制御装置240とは別に設けられている例について説明するが、運搬物情報取得装置258の演算装置の機能は、制御装置240が備えていてもよい。
図18及び図19を参照して、第2実施形態に係る制御装置240により実行される処理の流れの一例を説明する。図18は、第2実施形態に係る制御装置240による処理の一例について示すフローチャートであり、掘削動作の開始から運搬動作の完了までの処理の流れを示す。図19は、第2実施形態に係る制御装置240による処理の一例について示すフローチャートであり、放土動作の開始から戻り動作の完了までの処理の流れを示す。
図18のフローチャートでは、図10のフローチャートのステップS102~S104の処理に代えて、ステップS201の処理が実行される。図19のフローチャートでは、図11のフローチャートのステップS110~S113の処理に代えて、ステップS202の処理が実行される。
図18に示すように、ステップS101において掘削制御が開始される。これにより、油圧ショベル1は、旋回体7の旋回動作が停止し、かつ、掘削物を掘削するために作業装置2が動作している状態となる。本第2実施形態での掘削制御は、バケット10に格納された掘削物の重量(掘削量)Wが目標掘削量Wtに至るように行われる。目標掘削量Wtは、バケット10に格納する掘削物の重量の目標値であり、予め定められ、記憶装置に記憶されている。
次のステップS201の処理は、旋回開始条件が成立したか否かを判断する処理である。ステップS201において、旋回開始判断部43は、運搬物情報取得装置258により取得された運搬物の重量Wに基づき、目標掘削量Wtに対して所定割合P1以上の掘削物がバケット10に格納されたか否かを判断する。所定割合P1は、予め定められ、記憶装置に記憶されている。所定割合P1は、例えば、90%以上の値である。なお、所定割合P1は、入力装置57を操作することにより変更できるようにしてもよい。目標掘削量Wtに対して所定割合P1以上の掘削物がバケット10に格納されたと判断された場合には、処理がステップS105に進む。ステップS201の処理は、肯定判断されるまで所定の演算周期で繰り返し実行される。
具体的には、旋回開始判断部43は、運搬物情報取得装置258から所定の演算周期毎に運搬物の重量Wを取得する。掘削動作が行われると、時間の経過に従ってバケット10内の運搬物の重量Wが増加する。旋回開始判断部43は、運搬物の重量Wが所定重量W1以上になると、旋回開始条件が成立したと判断し、処理をステップS105に進める。なお、所定重量W1は、目標掘削量Wtに対する所定割合P1に相当する運搬物の重量であり、旋回開始判断部43により演算される。
図18のステップS105~S108の処理は、第1実施形態(図10参照)と同様であるので、説明を省略する。
図19に示すように、ステップS109において放土制御が開始される。これにより、油圧ショベル1は、旋回体7の旋回動作が停止し、かつ、掘削物を放出するために作業装置2が動作している状態となる。
次のステップS202の処理は、旋回開始条件が成立したか否かを判断する処理である。ステップS202において、旋回開始判断部43は、運搬物情報取得装置258により取得された運搬物の重量Wに基づき、運搬物の重量Wが放土動作前の重量W0に対して所定割合P2以上減少したか否かを判断する。なお、ステップS202の処理は、放土動作前の重量W0に対して減少した運搬物の重量Wの割合(以下、運搬物の減少割合とも記す)Pdが、所定割合P2以上になったか否かを判断する処理ともいえる。
所定割合P2は、予め定められ、記憶装置に記憶されている。所定割合P2は、例えば、80~90%程度の値である。なお、所定割合P2は、入力装置57を操作することにより変更できるようにしてもよい。
旋回開始判断部43は、掘削動作から運搬動作への動作遷移条件が成立したときの運搬物の重量Wを、放土動作前の重量W0として記憶している。運搬物の重量Wが放土動作前の重量W0に対して所定割合P2以上減少した判断された場合には、処理がステップS114に進む。ステップS202の処理は、肯定判断されるまで所定の演算周期で繰り返し実行される。
具体的には、旋回開始判断部43は、運搬物情報取得装置258から所定の演算周期毎に運搬物の重量Wの情報を取得する。放土動作が行われると、時間の経過に従ってバケット10内の運搬物の重量Wが減少する。制御装置240は、運搬物の重量Wが所定重量W2以下になると、旋回開始条件が成立したと判断し、処理をステップS114に進める。なお、所定の重量W2は、放出された重量、すなわち放土動作前の重量W0に対して所定割合P2の重量分(W0×P2)を、放土動作前の重量W0から差し引いた値(W2=W0-W0×P2)であり、旋回開始判断部43により演算される。
図19のステップS114~S117の処理は、第1実施形態(図11参照)と同様であるので、説明を省略する。
以下、図20及び図21を参照して、本第2実施形態に係る油圧ショベル1の主な動作について説明する。まず、図20を用いて、掘削動作から運搬動作に遷移する際の動作について説明する。図20は、掘削動作から運搬動作へ動作が遷移する場合のバケット10内の運搬物の重量(掘削量)W、旋回動作指令の出力有無(ON/OFF)、及び旋回角度θswの時系列変化を示す図である。図20(a)~(c)の横軸は、時間を示す。図20(a)の縦軸はバケット10内の運搬物の重量(掘削量)Wを示す。図20(b)の縦軸は旋回動作指令の出力の有無を示し、図20(c)の縦軸は旋回角度θswを示している。なお、旋回角度θswは、掘削動作を開始した位置を基準位置とし、その基準位置から掘削動作完了角度まで正の方向に増加するグラフとして記載している。
図20に示すように、掘削動作を開始してから一定時間が経過した時刻Tc22において、旋回開始条件が成立し(図18のステップS201でYes)、旋回体7の自動旋回制御が開始される。一方、時刻Tc22よりも前の時刻Tc21では、旋回開始条件が成立していないため(図18のステップS201でNo)、旋回体7の自動旋回制御は開始されていない。バケット10内の運搬物の重量Wが目標掘削量Wtに達する時刻Tc23よりも前の段階(時刻Tc22)で旋回体7の自動旋回制御が開始される(旋回動作開始指令が出力される)。これにより、バケット10内の運搬物の重量Wが目標掘削量Wtに到達した直後に、旋回体7が実際に旋回し始める。つまり、バケット10内の運搬物の重量Wが目標掘削量Wtに至るタイミングと、旋回体7が旋回を開始するタイミングとが略一致する。これにより、掘削動作から運搬動作への遷移が滑らかに行われる。
次に図21を用いて、放土動作から戻り動作に遷移する際の動作について説明する。図21は、放土動作から戻り動作へ動作が遷移する場合のバケット10内の運搬物の減少割合Pd、旋回動作指令の出力有無(ON/OFF)、及び旋回角度θswの時系列変化を示す図である。図21(a)~(c)の横軸は、時間を示す。図21(a)の縦軸は、運搬物の減少割合Pd[%]を示す。図21(b)の縦軸は旋回動作指令の出力の有無を示し、図21(c)の縦軸は旋回角度θswを示している。なお、旋回角度θswは、放土動作を開始した位置を基準位置とし、その基準位置から放土動作完了角度まで正の方向に増加するグラフとして記載している。
図21に示すように、放土動作を開始してから一定時間が経過した時刻Tr22において、旋回開始条件が成立し(図19のステップS202でYes)、旋回体7の自動旋回制御が開始される。一方、時刻Tr22よりも前の時刻Tr21では、旋回開始条件が成立していないため(図19のステップS202でNo)、旋回体7の自動旋回制御は開始されていない。運搬物の減少割合Pdが100%になる時刻Tr23よりも前の段階(時刻Tr22)で旋回体7の自動旋回制御が開始される(旋回動作開始指令が出力される)。これにより、運搬物の減少割合Pdが100%に到達した直後に、旋回体7が実際に旋回し始める。つまり、運搬物の減少割合Pdが100%に至るタイミングと、旋回体7が旋回を開始するタイミングとが略一致する。これにより、放土動作から戻り動作への遷移が滑らかに行われる。
このように、本第2実施形態に係る制御装置240は、運搬物情報取得装置258からバケット10内の運搬物(掘削物)の重量Wを取得する。制御装置240は、取得したバケット10内の運搬物の重量Wが所定重量に達した場合に、旋回開始条件が成立したと判断する。制御装置240は、旋回体7の旋回動作が停止し、かつ、掘削物を掘削するために作業装置2が動作している状態において、旋回開始条件が成立したか否かを判断する。制御装置240は、バケット10内の掘削物の重量Wが所定重量W1まで増加した場合に、旋回開始条件が成立したと判断し、旋回動作開始指令を出力する(図18のステップS201,S105)。制御装置240は、旋回体7の旋回動作が停止し、かつ、掘削物を放出するために作業装置2が動作している状態において、旋回開始条件が成立したか否かを判断する。制御装置240は、バケット10内の掘削物の重量Wが放出動作前から所定割合P2の重量分だけ放出されることによって所定重量W2まで減少した場合に、旋回開始条件が成立したと判断し、旋回動作開始指令を出力する(図19のステップS202,S114)。このような第2実施形態によれば、第1実施形態と同様の作用効果を奏する。
また、本第2実施形態によれば、運搬物情報取得装置258がバケット10内の運搬物(掘削物)の重量Wを演算することにより、制御装置240の演算負荷を低減できる。
<第2実施形態の変形例1>
図22に示すように、運搬物の減少割合Pdと、バケット10の対地角γとの間には相関関係がある。バケット10の対地角γが放土完了角度に近づくにしたがって、運搬物の減少割合Pdは増加する。このため、旋回開始判断部43は、バケット10の対地角γが所定割合P2に対応する対地角(対地角閾値)γ2に達した場合に、旋回開始条件が成立したと判断し、旋回動作開始指令を出力してもよい。
図22に示すように、運搬物の減少割合Pdと、バケット10の対地角γとの間には相関関係がある。バケット10の対地角γが放土完了角度に近づくにしたがって、運搬物の減少割合Pdは増加する。このため、旋回開始判断部43は、バケット10の対地角γが所定割合P2に対応する対地角(対地角閾値)γ2に達した場合に、旋回開始条件が成立したと判断し、旋回動作開始指令を出力してもよい。
また、本変形例において、上記所定割合P2は、入力装置57を操作することにより変更できるようにしてもよい。この場合、記憶装置には、運搬物の減少割合Pdと、バケット10の対地角γとの関係を規定するデータテーブルである対地角変換テーブルT(図22参照)が記憶されている。旋回開始判断部43は、入力装置57から新たな所定割合P2の情報を取得すると、対地角変換テーブルTを参照し、新たな所定割合P2に対応するバケット10の対地角(対地角閾値)γ2を演算する。
以上のとおり、本変形例に係る油圧ショベル1は、所定割合P2を入力可能な入力装置57を備えている。また、本変形例に係る制御装置240は、バケット10から放出される前の掘削物の重量W0に対してバケット10から放出された掘削物の重量の割合(運搬物の減少割合)Pdと、バケット10の対地角γとの関係を規定するデータテーブルである対地角変換テーブルTを有している。制御装置240は、対地角変換テーブルTを参照し、入力装置57により入力された所定割合P2に対応するバケット10の対地角を対地角閾値γ2として決定する。制御装置240は、バケット10の対地角γが、対地角閾値γ2に達した場合に、旋回開始条件が成立したと判断し、旋回動作開始指令を出力する。この構成によれば、オペレータは、入力装置57を操作して、旋回動作のタイミングを調整することができる。
<第2実施形態の変形例2>
第2実施形態の変形例1に係る構成において、制御装置240は、さらに対地角変換テーブルTを補正して用いてもよい。制御装置240が対地角変換テーブルTを補正することにより、所定割合P2に対応するバケット10の対地角γ2をより適切に設定することができる。
第2実施形態の変形例1に係る構成において、制御装置240は、さらに対地角変換テーブルTを補正して用いてもよい。制御装置240が対地角変換テーブルTを補正することにより、所定割合P2に対応するバケット10の対地角γ2をより適切に設定することができる。
<第2実施形態の変形例2-1>
例えば、旋回開始判断部43は、油圧ショベル1の実機データに基づき、基準となるデータテーブルである対地角変換テーブルTを補正してもよい。図23は、補正後の対地角変換テーブルTc1,Tc2を示す図である。例えば、放土動作が行われている状態において、運搬物情報取得装置258により演算される運搬物の重量W、姿勢演算部41により演算されるバケット10の対地角γ、放土動作前の運搬物の重量W0の時系列データに基づき、対地角変換テーブルTを補正してもよい。これにより、例えば、補正後の対地角変換テーブルTc1が得られる。制御装置240は、補正後の対地角変換テーブルTc1を参照し、入力された所定割合P2に対するバケット10の対地角閾値γc21を演算する。制御装置240は、放土動作中に、バケット10の対地角γが対地角閾値γc21に達した場合に、旋回開始条件が成立したと判断し、旋回動作開始指令を出力する。
例えば、旋回開始判断部43は、油圧ショベル1の実機データに基づき、基準となるデータテーブルである対地角変換テーブルTを補正してもよい。図23は、補正後の対地角変換テーブルTc1,Tc2を示す図である。例えば、放土動作が行われている状態において、運搬物情報取得装置258により演算される運搬物の重量W、姿勢演算部41により演算されるバケット10の対地角γ、放土動作前の運搬物の重量W0の時系列データに基づき、対地角変換テーブルTを補正してもよい。これにより、例えば、補正後の対地角変換テーブルTc1が得られる。制御装置240は、補正後の対地角変換テーブルTc1を参照し、入力された所定割合P2に対するバケット10の対地角閾値γc21を演算する。制御装置240は、放土動作中に、バケット10の対地角γが対地角閾値γc21に達した場合に、旋回開始条件が成立したと判断し、旋回動作開始指令を出力する。
このように、本変形例に係る制御装置240は、作業装置2が放土動作しているときの実機データ(掘削物の重量W及びバケットの対地角γ)を取得し、取得した実機データに基づき、旋回開始条件を規定する対地角閾値を決定する。この構成によれば、作業を行う油圧ショベル1の個体差等に関わらず、旋回動作開始指令を適切なタイミングで制御装置240から出力させることができる。
<第2実施形態の変形例2-2>
また、掘削物の土質の粘度が大きいほど、バケット10から運搬物を放出しにくくなる。したがって、旋回開始判断部43は、運搬物の土質に基づき、対地角変換テーブルTを補正してもよい。本変形例に係る油圧ショベル1は、掘削物の粘度などの土質を入力可能な入力装置57を備えている。オペレータは、入力装置57を操作して、所定割合P2及び掘削物の粘度を制御装置240に入力する。
また、掘削物の土質の粘度が大きいほど、バケット10から運搬物を放出しにくくなる。したがって、旋回開始判断部43は、運搬物の土質に基づき、対地角変換テーブルTを補正してもよい。本変形例に係る油圧ショベル1は、掘削物の粘度などの土質を入力可能な入力装置57を備えている。オペレータは、入力装置57を操作して、所定割合P2及び掘削物の粘度を制御装置240に入力する。
制御装置240は、入力された粘度が記憶装置に記憶されている粘度の基準値に比べて大きい場合には、対地角γに対する減少割合Pdの変化率が小さくなるように対地角変換テーブルTを補正する。これにより、補正後の対地角変換テーブルTc2が得られる。制御装置240は、補正後の対地角変換テーブルTc2を参照し、入力された所定割合P2に対するバケット10の対地角閾値γc22を演算する。なお、掘削物の土質は、粘度に限らず、粒度であってもよい。
このように、本変形例に係る制御装置240は、入力装置57により入力された掘削物の土質に基づき、対地角変換テーブルTを補正する。この構成によれば、掘削する作業場所が変更になるなど、掘削対象物の土質が変わった場合であっても、旋回動作開始指令を適切なタイミングで制御装置240から出力させることができる。
<第2実施形態の変形例2-3>
また、バケット10の角速度が大きいと、ある対地角γであるときの運搬物の減少割合Pdが想定よりも小さくなる。したがって、旋回開始判断部43は、バケット10の対地角速度に基づき、対地角変換テーブルTを補正してもよい。バケット10の角速度は、姿勢演算部41により演算される。制御装置240は、バケット10の角速度が基準値よりも大きい場合には、対地角γに対する減少割合Pdの変化率が小さくなるように、対地角変換テーブルTを補正する。これにより、補正後の対地角変換テーブルTc2が得られる。
また、バケット10の角速度が大きいと、ある対地角γであるときの運搬物の減少割合Pdが想定よりも小さくなる。したがって、旋回開始判断部43は、バケット10の対地角速度に基づき、対地角変換テーブルTを補正してもよい。バケット10の角速度は、姿勢演算部41により演算される。制御装置240は、バケット10の角速度が基準値よりも大きい場合には、対地角γに対する減少割合Pdの変化率が小さくなるように、対地角変換テーブルTを補正する。これにより、補正後の対地角変換テーブルTc2が得られる。
<第2実施形態の変形例3>
制御装置240は、物体検出装置54により検出されるバケット10内の運搬物(掘削物)の挙動に基づいて、放土動作(放出動作)におけるバケット10内の運搬物の減少割合Pdを演算してもよい。バケット10内の運搬物の挙動とは、例えば、物体検出装置54としてのステレオカメラにより撮影された画像内のバケット10内の運搬物の面積の変化等である。また、制御装置240は、物体検出装置54により検出される荷台201に放出された運搬物(掘削物)の形状に基づいて、運搬物の減少割合Pdを演算してもよい。荷台201に運搬物が放出されると、荷台201には、放出された分だけ、運搬物の山が形成される。このため、制御装置240は、物体検出装置54により検出された運搬物の形状から運搬物がどの程度放出されたのかを推定できる。制御装置240は、運搬物の減少割合Pdが所定割合P2に達したとき、旋回開始条件が成立し、旋回動作開始指令を出力する。
制御装置240は、物体検出装置54により検出されるバケット10内の運搬物(掘削物)の挙動に基づいて、放土動作(放出動作)におけるバケット10内の運搬物の減少割合Pdを演算してもよい。バケット10内の運搬物の挙動とは、例えば、物体検出装置54としてのステレオカメラにより撮影された画像内のバケット10内の運搬物の面積の変化等である。また、制御装置240は、物体検出装置54により検出される荷台201に放出された運搬物(掘削物)の形状に基づいて、運搬物の減少割合Pdを演算してもよい。荷台201に運搬物が放出されると、荷台201には、放出された分だけ、運搬物の山が形成される。このため、制御装置240は、物体検出装置54により検出された運搬物の形状から運搬物がどの程度放出されたのかを推定できる。制御装置240は、運搬物の減少割合Pdが所定割合P2に達したとき、旋回開始条件が成立し、旋回動作開始指令を出力する。
このように、本変形例に係る制御装置240は、物体検出装置54により検出されるバケット10内の掘削物の挙動、あるいは、物体検出装置54により検出される荷台201に放出された掘削物の形状に基づいて、旋回開始条件が成立したか否かを判断する。この構成によれば、運搬物情報取得装置258を省略できる。
<第3実施形態>
図24~図26を参照して、本発明の第3実施形態に係る油圧ショベル1について説明する。なお、第1実施形態で説明した構成と同一もしくは相当する構成には同一の参照記号を付し、相違点を主に説明する。第1実施形態では、掘削動作、運搬動作、放土動作、及び戻り動作が、自動で行われる例について説明した。これに対して、第3実施形態では、掘削動作及び放土動作は手動で行われ、運搬動作及び戻り動作は自動で行われる例について説明する。
図24~図26を参照して、本発明の第3実施形態に係る油圧ショベル1について説明する。なお、第1実施形態で説明した構成と同一もしくは相当する構成には同一の参照記号を付し、相違点を主に説明する。第1実施形態では、掘削動作、運搬動作、放土動作、及び戻り動作が、自動で行われる例について説明した。これに対して、第3実施形態では、掘削動作及び放土動作は手動で行われ、運搬動作及び戻り動作は自動で行われる例について説明する。
図24は、第3実施形態に係る制御装置340の機能ブロック図である。本実施形態に係る油圧ショベル1は、オペレータによる手動操作での掘削動作の後、運搬動作を自動で行う構成である。制御装置340は、運搬動作の旋回動作開始指令をオペレータが指示したタイミングで出力する。また、本実施形態に係る油圧ショベル1は、オペレータによる手動操作での放土動作の後、戻り動作を自動で行う構成である。制御装置340は、戻り動作の旋回動作開始指令をオペレータが指示したタイミングで出力する。
制御選択スイッチ324は、第1実施形態で説明した制御選択スイッチ24の機能に加え、半自動モードを選択可能とする機能を有している。半自動モードが設定された場合、制御装置340は、掘削動作及び放土動作の際には操作装置20に応じて作業装置2の動作を制御する。また、制御装置340は、運搬動作及び戻り動作の際には操作装置20の操作に関わらず、制御装置340が設定した目標経路に応じて作業装置2と旋回体7の動作を制御する。
第3実施形態に係る動作遷移判断部349は、制御選択スイッチ324からの操作指令に基づいて、制御モードを自動モード、手動モード及び半自動モードのいずれかに設定する。また、自動モードが設定されている場合、動作遷移判断部349は、第1実施形態と同様、バケット10の先端部が目標経路の完了位置に到達した場合に動作遷移条件が成立したと判断する。
動作遷移判断部349は、半自動モードが設定され、かつ、作業操作装置29による掘削動作が行われた後、作業操作装置29が中立位置に戻された場合には、掘削動作から運搬動作への動作遷移条件が成立したと判断する。また、動作遷移判断部349は、半自動モードが設定され、かつ、作業操作装置29による放土動作が行われた後、作業操作装置29が中立位置に戻された場合には、放土動作から戻り動作への動作遷移条件が成立したと判断する。なお、動作遷移判断部349は、操作検出装置56の操作量センサ52a,52c,52dにより検出されたアーム操作量、ブーム操作量及びバケット操作量のいずれかが操作判断用閾値以上になった後、アーム操作量、ブーム操作量及びバケット操作量のいずれもが中立判断用閾値以下になった場合に、作業操作装置29による掘削動作あるいは放土動作が行われた後、作業操作装置29が中立位置に戻されたと判断する。
第3実施形態に係る旋回開始判断部343は、動作遷移判断部349の判断結果に基づき、現在の動作状態が掘削動作、運搬動作、放土動作、及び戻り動作のいずれの動作を行っているかを判断する。また、旋回開始判断部343は、操作検出装置56の操作量センサ52bにより検出された旋回操作量が操作判断用閾値以上である場合に、旋回操作が行われたと判断する。
旋回開始判断部343は、掘削動作を行っているときに旋回操作が行われた場合には、旋回開始条件が成立したと判断する。また、旋回開始判断部343は、放土動作を行っているときに旋回操作が行われた場合には、旋回開始条件が成立したと判断する。このように、本第3実施形態では、旋回操作装置28が、掘削動作中あるいは放土動作中に、自動運転による旋回体7の旋回の開始を指示する旋回開始操作装置としても機能する。
図25及び図26を参照して、第3実施形態に係る制御装置340により実行される処理の流れの一例を説明する。図25は、第3実施形態に係る制御装置340による処理の一例について示すフローチャートであり、掘削動作の開始から運搬動作の完了までの処理の流れを示す。図26は、第3実施形態に係る制御装置340による処理の一例について示すフローチャートであり、放土動作の開始から戻り動作の完了までの処理の流れを示す。
図25のフローチャートでは、図10のフローチャートのステップS101~S104の処理に代えて、ステップS301,S302の処理が実行される。また、図25のフローチャートでは、図10のフローチャートのステップS106の処理に代えて、ステップS303の処理が実行される。図26のフローチャートでは、図11のフローチャートのステップS109~S113の処理に代えて、ステップS304,S305の処理が実行される。また、図26のフローチャートでは、図11のフローチャートのステップS115の処理に代えて、ステップS306の処理が実行される。
図25に示すように、ステップS301において、制御選択スイッチ24により制御モードを半自動モードにするための操作が行われると、動作遷移判断部349は、制御モードを半自動モードに設定する。半自動モードが設定されると、アクチュエータ指令部48は、作業操作装置29の操作量に応じた目標速度に基づき、作業装置2による掘削動作を開始する。
次のステップS302の処理は、旋回開始条件が成立したか否かを判断する処理である。ステップS302において、旋回開始判断部343は、旋回操作が行われたか否かを判断する。旋回開始判断部343は、旋回操作が行われた場合には、旋回開始条件が成立したと判断し、処理をステップS105に進める。ステップS302の処理は、肯定判断されるまで所定の演算周期で繰り返し実行される。つまり、制御装置340は、旋回操作が行われるまで、ステップS302の処理を繰り返し実行する。
ステップS105において、運搬制御部45は、旋回体7の運搬動作のための旋回動作開始指令を出力する。次のステップS303において、動作遷移判断部49は、掘削動作から運搬動作への動作遷移条件が成立したか否かを判断する。作業操作装置29が中立位置に戻された場合(本実施形態では、作業操作右レバー22a及び作業操作左レバー22bの双方が中立位置にある場合)には、動作遷移判断部49は掘削動作から運搬動作への動作遷移条件が成立したと判断し、処理をステップS107に進める。作業操作装置29が中立位置に戻されていない場合(本実施形態では、作業操作右レバー22a及び作業操作左レバー22bの少なくとも一方が中立位置にない場合)には、動作遷移判断部49は掘削動作から運搬動作への動作遷移条件は成立していないと判断する。ステップS303の処理は、肯定判断されるまで所定の演算周期で繰り返し実行される。
図25のステップS107,S108の処理は、第1実施形態(図10参照)と同様であるので、説明を省略する。
運搬動作が完了すると(図25のステップS108)、図26に示すステップS304に進む。ステップS304において、アクチュエータ指令部48は、作業操作装置29の操作量に応じた目標速度に基づき、作業装置2による放土動作を開始する。
次のステップS305の処理は、ステップS302の処理と同様、旋回開始条件が成立したか否かを判断する処理である。ステップS305において、旋回開始判断部343は、旋回操作が行われたか否かを判断する。旋回開始判断部343は、旋回操作が行われた場合には、旋回開始条件が成立したと判断し、処理をステップS114に進める。ステップS305の処理は、肯定判断されるまで所定の演算周期で繰り返し実行される。つまり、制御装置340は、旋回操作が行われるまで、ステップS305の処理を繰り返し実行する。
ステップS114において、運搬制御部45は、旋回体7の戻り動作のための旋回動作開始指令を出力する。次のステップS306において、動作遷移判断部49は、放土動作から戻り動作への動作遷移条件が成立したか否かを判断する。作業操作装置29が中立位置に戻された場合(本実施形態では、作業操作右レバー22a及び作業操作左レバー22bの双方が中立位置にある場合)には、動作遷移判断部49は放土動作から戻り動作への動作遷移条件が成立したと判断し、処理をステップS116に進める。作業操作装置29が中立位置に戻されていない場合(本実施形態では、作業操作右レバー22a及び作業操作左レバー22bの少なくとも一方が中立位置にない場合)には、動作遷移判断部49は放土動作から戻り動作への動作遷移条件は成立していないと判断する。ステップS306の処理は、肯定判断されるまで所定の演算周期で繰り返し実行される。
図26のステップS116,S117の処理は、第1実施形態(図11参照)と同様であるので、説明を省略する。
本第3実施形態に係る油圧ショベル1の主な動作について説明する。オペレータが作業操作装置29を操作することにより、作業装置2による掘削動作が行われる(ステップS301)。掘削動作がある程度進んだ段階で、オペレータが旋回操作装置28を操作することにより、運搬動作のための旋回動作開始指令が制御装置340から出力される(ステップS302,S105)。
オペレータが作業操作装置29を中立位置に戻すと、制御装置340は、掘削動作が完了したと判断して、作業装置2を目標経路CPTに沿って動作させる(ステップS303,S107,S108)。
自動の運搬動作が完了した後、オペレータが作業操作装置29を操作することにより、作業装置2による放土動作が行われる(ステップS304)。放土動作がある程度進んだ段階で、オペレータが旋回操作装置28を操作することにより、戻り動作のための旋回動作開始指令が制御装置340から出力される(ステップS305,S114,S117)。
オペレータが作業操作装置29を中立位置に戻すと、制御装置340は、放土動作が完了したと判断して、作業装置2を目標経路RPTに沿って動作させる(ステップS306,S116)。
このように、本第3実施形態では、オペレータにより操作され、旋回体7の旋回の開始を指示する旋回操作装置(旋回開始操作装置)28と、オペレータにより操作され、作業装置2を動作させる作業操作装置29と、を備える。制御装置340は、作業操作装置29の操作に応じて作業装置2を動作させる。制御装置340は、旋回体7の旋回動作が停止し、かつ、作業操作装置29の操作に応じて作業装置2が動作している状態において、旋回開始条件が成立したか否かを判断する。制御装置340は、旋回操作装置28により旋回体7の旋回の開始が指示された場合に、旋回開始条件が成立したと判断する。
本第3実施形態によれば、オペレータが手動で作業装置2による掘削動作や放土動作を行っている最中に、オペレータの意図に基づき運搬動作や戻り動作のための旋回動作開始指令を制御装置340から出力させることができる。
<第3実施形態の変形例1>
第3実施形態に係る油圧ショベル1は、掘削動作及び放土動作をオペレータの手動操作に基づいて行い、運搬動作及び戻り動作を自動で行う構成である例について説明した。しかしながら、油圧ショベル1は、掘削動作のみオペレータの手動操作に基づいて行い、運搬動作、放土動作、及び戻り動作を自動で行う構成にしてもよい。また、油圧ショベル1は、放土動作のみオペレータの手動操作に基づいて行い、掘削動作、運搬動作、及び戻り動作を自動で行う構成にしてもよい。また、油圧ショベル1は、掘削動作、運搬動作、放土動作、及び戻り動作のいずれの動作も自動で行う構成にしてもよい。この場合、油圧ショベル1は、運搬動作や戻り動作のための旋回動作開始指令を出力するタイミングのみ、オペレータが指示する構成であってもよい。
第3実施形態に係る油圧ショベル1は、掘削動作及び放土動作をオペレータの手動操作に基づいて行い、運搬動作及び戻り動作を自動で行う構成である例について説明した。しかしながら、油圧ショベル1は、掘削動作のみオペレータの手動操作に基づいて行い、運搬動作、放土動作、及び戻り動作を自動で行う構成にしてもよい。また、油圧ショベル1は、放土動作のみオペレータの手動操作に基づいて行い、掘削動作、運搬動作、及び戻り動作を自動で行う構成にしてもよい。また、油圧ショベル1は、掘削動作、運搬動作、放土動作、及び戻り動作のいずれの動作も自動で行う構成にしてもよい。この場合、油圧ショベル1は、運搬動作や戻り動作のための旋回動作開始指令を出力するタイミングのみ、オペレータが指示する構成であってもよい。
例えば、制御装置は、図10のステップS102~S104の処理に代えて、図25のステップS302の処理を実行してもよい。また、制御装置は、図11のステップS110~S113の処理に代えて、図26のステップS305の処理を実行してもよい。
本変形例に係る制御装置340は、旋回体7の旋回動作が停止し、かつ、作業装置2が動作している状態において、旋回開始条件が成立したか否かを判断する。制御装置340は、旋回操作装置28により旋回体7の旋回の開始が指示された場合に、旋回開始条件が成立したと判断する。この構成によれば、オペレータの手動操作だけでなく、制御装置340による自動運転により掘削動作や放土動作が行われている最中に、オペレータの意図に基づき運搬動作や戻り動作のための旋回動作開始指令を制御装置340から出力させることができる。
<第3実施形態の変形例2>
第3実施形態では、旋回体7の旋回の開始を指示する旋回開始操作装置が、旋回操作装置28である例について説明した。しかしながら、旋回開始操作装置の形態は、これに限定されない。例えば、旋回開始操作装置は、操作装置20,21とは異なる操作装置であって、操作レバー22a,22bに設けた操作スイッチとしてもよい。
第3実施形態では、旋回体7の旋回の開始を指示する旋回開始操作装置が、旋回操作装置28である例について説明した。しかしながら、旋回開始操作装置の形態は、これに限定されない。例えば、旋回開始操作装置は、操作装置20,21とは異なる操作装置であって、操作レバー22a,22bに設けた操作スイッチとしてもよい。
次のような変形例も本発明の範囲内であり、変形例に示す構成と上述の実施形態で説明した構成を組み合わせたり、上述の異なる実施形態で説明した構成同士を組み合わせたり、以下の異なる変形例で説明する構成同士を組み合わせることも可能である。
<変形例1>
上記実施形態では、作業装置2により掘削された掘削物が積み込まれるベッセルが、運搬車両の荷台201である例について説明したが、本発明はこれに限定されない。本発明は、ベルトコンベア等の被積込機械に設けられるベッセルに掘削物を積み込む場合に適用してもよい。
上記実施形態では、作業装置2により掘削された掘削物が積み込まれるベッセルが、運搬車両の荷台201である例について説明したが、本発明はこれに限定されない。本発明は、ベルトコンベア等の被積込機械に設けられるベッセルに掘削物を積み込む場合に適用してもよい。
<変形例2>
上記実施形態では、アーム9の先端部にバケット10を後向きに取り付けたバックホウショベルを作業機械の一例として説明したが、本発明はこれに限定されない。作業機械は、アーム9の先端部にバケット10を前向きに取り付けたローディングショベルであってもよい。
上記実施形態では、アーム9の先端部にバケット10を後向きに取り付けたバックホウショベルを作業機械の一例として説明したが、本発明はこれに限定されない。作業機械は、アーム9の先端部にバケット10を前向きに取り付けたローディングショベルであってもよい。
以上、本発明の実施形態について説明したが、上記実施形態は本発明の適用例の一部を示したに過ぎず、本発明の技術的範囲を上記実施形態の具体的構成に限定する趣旨ではない。
1…油圧ショベル(作業機械)、2…作業装置、3…車体、5…走行体、6…旋回油圧モータ(油圧アクチュエータ)、7…旋回体、8…ブーム(駆動対象部材)、9…アーム(駆動対象部材)、10…バケット(駆動対象部材)、11…ブームシリンダ(油圧シリンダ、油圧アクチュエータ)、12…アームシリンダ(油圧シリンダ、油圧アクチュエータ)、13…バケットシリンダ(油圧シリンダ、油圧アクチュエータ)、14…ブーム角度センサ(姿勢センサ)、15…アーム角度センサ(姿勢センサ)、17…バケット角度センサ(姿勢センサ)、18…傾斜角度センサ(姿勢センサ)、19…旋回角度センサ(姿勢センサ)、20,21…操作装置、24…制御選択スイッチ、28…旋回操作装置(旋回開始操作装置)、29…作業操作装置、40…制御装置、41…姿勢演算部、42…物体位置演算部、43…旋回開始判断部、44…掘削制御部、45…運搬制御部、46…放土制御部、47…戻り制御部、48…アクチュエータ指令部、49…動作遷移判断部、50…油圧駆動システム、51…電磁比例弁、52…操作量センサ、53…姿勢検出装置、54…物体検出装置(ベッセル位置検出装置)、55…作動油温度センサ、56…操作検出装置、57…入力装置、200…被積込機械、201…荷台(トレイ、ベッセル)、240…制御装置、258…運搬物情報取得装置、324…制御選択スイッチ、340…制御装置、343…旋回開始判断部、349…動作遷移判断部、400…動作制御部、CP1…運搬開始位置、CP2…運搬完了位置、CPT…目標経路、DP1…掘削開始位置、DP2…掘削完了位置、DPT…目標経路、LP1…放土開始位置、LP2…放土完了位置、LPT…目標経路、P1…所定割合、P2…所定割合、Pd…運搬物の減少割合、RP1…戻り開始位置、RP2…戻り完了位置、RPT…目標経路、T…対地角変換テーブル(データテーブル)、t1,t1c,t1r…第1時間、t2,t2c,t2r…第2時間、t3r…第3時間、Tc1,Tc2…補正後の対地角変換テーブル、W…重量、W0…放土動作前の重量、W1,W2…所定重量、Wt…目標掘削量、γ…対地角、γ1c…掘削動作完了角度(動作完了角度)、γ1r…放土動作完了角度(動作完了角度)、γ2,γc21,γc22…対地角閾値、γt…対地角の目標値、θsw…旋回角度
Claims (16)
- 走行体と、
前記走行体に対して旋回可能に設けられる旋回体と、
前記旋回体に取り付けられ、ブーム、アーム及びバケットを有する作業装置と、
前記旋回体の姿勢、及び前記作業装置の姿勢を検出する姿勢検出装置と、
前記作業装置により掘削された掘削物が積み込まれる被積込機械のベッセルの位置を検出するベッセル位置検出装置と、
前記姿勢検出装置及び前記ベッセル位置検出装置の検出結果に基づいて、少なくとも前記旋回体を目標となる旋回角度である旋回完了角度まで自動で旋回させる自動旋回制御を行う制御装置と、を備えた作業機械において、
前記制御装置は、
前記旋回体の旋回動作状態及び前記作業装置の動作状態に基づいて、前記旋回体の前記自動旋回制御を開始する旋回開始条件が成立したか否かを判断し、
前記旋回開始条件が成立したと判断した場合には、前記作業装置が動作している状態にあるか否かに関わらず、前記旋回開始条件が成立したタイミングで、前記旋回体を前記旋回完了角度に向かって旋回開始させる旋回動作開始指令を出力する、
ことを特徴とする作業機械。 - 請求項1に記載の作業機械において、
前記制御装置は、
前記姿勢検出装置の検出結果に基づき前記バケットの対地角を演算し、
前記バケットの対地角が動作完了角度となるまで自動で前記作業装置を動作させ、
前記旋回体の旋回動作が停止し、かつ、前記バケットの対地角が前記動作完了角度に近づくように、前記作業装置が自動で動作している状態において、前記旋回開始条件が成立したか否かを判断する、
ことを特徴とする作業機械。 - 請求項2に記載の作業機械において、
前記制御装置は、前記旋回動作開始指令を現時点で出力した場合に、前記バケットの対地角が前記動作完了角度に至った後に前記旋回体の旋回が開始されることが予測されると、前記旋回開始条件が成立したと判断する、
ことを特徴とする作業機械。 - 請求項2に記載の作業機械において、
前記制御装置は、
前記旋回動作開始指令が出力されてから前記旋回体の動作が開始されるまでの第1時間を演算し、
現時点から前記バケットの対地角が前記動作完了角度に至るまでの第2時間を演算し、
前記第2時間が前記第1時間よりも短くなった場合に、前記旋回開始条件が成立したと判断する、
ことを特徴とする作業機械。 - 請求項2に記載の作業機械において、
前記動作完了角度は、前記作業装置が前記ベッセルの上方で前記バケット内の掘削物を放出する動作の完了角度であり、
前記制御装置は、前記旋回動作開始指令を現時点で出力した場合に、前記バケットの対地角が前記動作完了角度に至る前に前記旋回体の旋回が開始され、かつ、前記バケットの対地角が前記動作完了角度に至った後に前記バケットが前記ベッセルの外に出始めることが予測されると、前記旋回開始条件が成立したと判断する、
ことを特徴とする作業機械。 - 請求項5に記載の作業機械において、
前記制御装置は、
前記旋回動作開始指令が出力されてから前記旋回体の動作が開始されるまでの第1時間を演算し、
現時点から前記バケットの対地角が前記動作完了角度に至るまでの第2時間を演算し、
前記旋回体の動作が開始されてから前記バケットが前記ベッセルの外に出始めるまでの第3時間を演算し、
前記第2時間が前記第1時間と前記第3時間の和よりも短くなった場合に、前記旋回開始条件が成立したと判断する、
ことを特徴とする作業機械。 - 請求項1に記載の作業機械において、
前記制御装置は、前記バケット内の前記掘削物の重量が所定重量に達した場合に、前記旋回開始条件が成立したと判断する、
ことを特徴とする作業機械。 - 請求項1に記載の作業機械において、
前記制御装置は、
前記バケット内の前記掘削物の重量を取得し、
取得した前記バケット内の前記掘削物の重量が所定重量に達した場合に、前記旋回開始条件が成立したと判断する、
ことを特徴とする作業機械。 - 請求項7に記載の作業機械において、
前記制御装置は、
前記旋回体の旋回動作が停止し、かつ、前記掘削物を掘削するために前記作業装置が動作している状態において、前記旋回開始条件が成立したか否かを判断し、
前記バケット内の前記掘削物の重量が前記所定重量まで増加した場合に、前記旋回開始条件が成立したと判断する、
ことを特徴とする作業機械。 - 請求項7に記載の作業機械において、
前記制御装置は、
前記旋回体の旋回動作が停止し、かつ、前記掘削物を放出するために前記作業装置が動作している状態において、前記旋回開始条件が成立したか否かを判断し、
前記バケット内の前記掘削物の重量が放出動作前から所定割合の重量分だけ放出されることによって前記所定重量まで減少した場合に、前記旋回開始条件が成立したと判断する、
ことを特徴とする作業機械。 - 請求項10に記載の作業機械において、
前記所定割合を入力可能な入力装置を備え、
前記制御装置は、
前記バケットから放出される前の前記掘削物の重量に対して前記バケットから放出された前記掘削物の重量の割合と、前記バケットの対地角との関係を規定するデータテーブルを有し、
前記データテーブルを参照し、前記入力装置により入力された前記所定割合に対応する前記バケットの対地角を対地角閾値として決定し、
前記バケットの対地角が、前記対地角閾値に達した場合に、前記旋回開始条件が成立したと判断する、
ことを特徴とする作業機械。 - 請求項11に記載の作業機械において、
前記入力装置は、前記掘削物の土質を入力可能であり、
前記制御装置は、前記入力装置により入力された前記掘削物の土質に基づき、前記データテーブルを補正する、
ことを特徴とする作業機械。 - 請求項10に記載の作業機械において、
前記ベッセル位置検出装置は、物体を検出する物体検出装置であり、
前記制御装置は、前記物体検出装置により検出される前記バケット内の前記掘削物の挙動、あるいは、前記物体検出装置により検出される前記ベッセルに放出された前記掘削物の形状に基づいて、前記旋回開始条件が成立したか否かを判断する、
ことを特徴とする作業機械。 - 請求項1に記載の作業機械において、
オペレータにより操作され、前記旋回体の旋回の開始を指示する旋回開始操作装置を備え、
前記制御装置は、
前記旋回体の旋回動作が停止し、かつ、前記作業装置が動作している状態において、前記旋回開始条件が成立したか否かを判断し、
前記旋回開始操作装置により前記旋回体の旋回の開始が指示された場合に、前記旋回開始条件が成立したと判断する、
ことを特徴とする作業機械。 - 請求項14に記載の作業機械において、
オペレータにより操作され、前記作業装置を動作させる作業操作装置を備え、
前記制御装置は、
前記旋回体の旋回動作が停止し、かつ、前記作業操作装置の操作に応じて前記作業装置が動作している状態において、前記旋回開始条件が成立したか否かを判断し、
前記旋回開始操作装置により前記旋回体の旋回の開始が指示された場合に、前記旋回開始条件が成立したと判断する、
ことを特徴とする作業機械。 - 請求項6に記載の作業機械において、
前記制御装置は、
前記バケット内の掘削物を放出する動作の開始時刻から完了時刻までの時間である放出所要時間を演算し、
前記バケット内の掘削物を放出する動作の開始時刻からの経過時間を、前記放出所要時間から減算することにより、前記第2時間を演算する、
ことを特徴とする作業機械。
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2023-165863 | 2023-09-27 | ||
| JP2023165863A JP2025056408A (ja) | 2023-09-27 | 2023-09-27 | 作業機械 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| WO2025069961A1 true WO2025069961A1 (ja) | 2025-04-03 |
Family
ID=95203167
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| PCT/JP2024/031630 Pending WO2025069961A1 (ja) | 2023-09-27 | 2024-09-03 | 作業機械 |
Country Status (2)
| Country | Link |
|---|---|
| JP (1) | JP2025056408A (ja) |
| WO (1) | WO2025069961A1 (ja) |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2019132064A (ja) * | 2018-01-31 | 2019-08-08 | 株式会社小松製作所 | 積込機械の制御装置および制御方法 |
| JP2021055433A (ja) * | 2019-09-30 | 2021-04-08 | 住友重機械工業株式会社 | ショベル |
-
2023
- 2023-09-27 JP JP2023165863A patent/JP2025056408A/ja active Pending
-
2024
- 2024-09-03 WO PCT/JP2024/031630 patent/WO2025069961A1/ja active Pending
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2019132064A (ja) * | 2018-01-31 | 2019-08-08 | 株式会社小松製作所 | 積込機械の制御装置および制御方法 |
| JP2021055433A (ja) * | 2019-09-30 | 2021-04-08 | 住友重機械工業株式会社 | ショベル |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2025056408A (ja) | 2025-04-08 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN109757113B (zh) | 作业机械 | |
| KR102118386B1 (ko) | 작업 기계 | |
| CN114207220B (zh) | 动作示教系统 | |
| WO2019124520A1 (ja) | 作業機械 | |
| CN113454293B (zh) | 作业机械 | |
| KR20190034648A (ko) | 작업 기계 | |
| JPH10212740A (ja) | 油圧ショベルの自動掘削方法 | |
| WO2018199069A1 (ja) | 作業機械および作業機械の制御方法 | |
| US20170096797A1 (en) | Operator assist features for excavating machines based on perception system feedback | |
| WO2025069961A1 (ja) | 作業機械 | |
| US20240376687A1 (en) | Work machine | |
| WO2022230980A1 (ja) | 積込機械の制御装置及び制御方法 | |
| WO2022201905A1 (ja) | 作業機械 | |
| US7627966B2 (en) | Off-fall control for a trenching operation | |
| US20250207353A1 (en) | Work vehicle | |
| JP7786144B2 (ja) | 作業システム | |
| WO2025022923A1 (ja) | 積込機械の制御装置、積込機械の制御方法および遠隔操作システム | |
| EP4600427A1 (en) | Work machine | |
| WO2025204720A1 (ja) | 作業機械システムおよび作業機械の制御方法 | |
| JP2025150637A (ja) | 作業機械システムおよび作業機械の制御方法 | |
| WO2024190914A1 (ja) | 作業機械の制御装置、遠隔操作システムおよび制御方法 | |
| JP2024144798A (ja) | 制御装置、制御方法および作業機械 | |
| KR20240027120A (ko) | 제어 장치, 작업 기계, 제어 방법 및 제어 시스템 | |
| WO2023281988A1 (ja) | 作業機械システム | |
| JP2024106574A (ja) | 積込機械の制御装置、積込機械の制御方法および積込機械の制御システム |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| 121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 24871761 Country of ref document: EP Kind code of ref document: A1 |