Work machine, system including work machine, and method for controlling work machine
Patent Information
- Authority / Receiving Office
- EP · EP
- Patent Type
- Applications
- Current Assignee / Owner
- KOMATSU LTD
- Filing Date
- 2023-08-28
- Publication Date
- 2026-07-01
AI Technical Summary
When loading materials into a dump truck using a wheel loader, the loading process often needs to be repeated multiple times, leading to potential spills during transport if the loading state is inappropriate.
A work machine system that includes a main body, a work implement, a work implement actuator, and a controller. The controller acquires information about the loading status of the load in the load container, determines if the load needs to be moved, and operates the work machine to push the load towards the center of the load container.
This solution ensures appropriate loading into the load container, preventing spills during transport by ensuring the load is properly balanced and secured.
Smart Images

Figure IMGAF001_ABST
Abstract
Description
TECHNICAL FIELD
[0001] The present disclosure relates to a work machine, a system including the work machine, and a method for controlling the work machine.BACKGROUND ART
[0002] WO2016 / 152994 (PTL 1) discloses control to move a boom and a bucket to a target position that is determined depending on a distance for which a wheel loader has traveled.CITATION LISTPATENT LITERATURE
[0003] PTL 1: WO2016 / 152994SUMMARY OF INVENTIONTECHNICAL PROBLEM
[0004] When loading into a load container such as a vessel of a dump truck is performed by a work machine such as a wheel loader, the loading work is usually performed multiple times. When the amount of loads loaded onto the dump truck by the loading work performed multiple times reaches the load capacity of the dump truck, loads may spill out while the dump truck is traveling, if the loading state (load condition) of the loaded loads is inappropriate.
[0005] The present disclosure proposes a work machine, a system including the work machine, and a method for controlling the work machine that enable appropriate loading into a load container.SOLUTION TO PROBLEM
[0006] A work machine and a system including the work machine according to an aspect of the present disclosure each include: a main body, a work implement, a work implement actuator, and a controller. The work implement is attached to the main body and loads a load into a load container. The work implement actuator drives the work implement with respect to the main body. The controller commands the work implement actuator to drive, based on a detected value of a position of the work implement and a detected value of a position of the load container with respect to the work machine. The controller acquires information about a loading status of a load in the load container, determines whether it is necessary to move the load in the load container, based on the acquired information about the loading status of the load, and operates, when determining that it is necessary to move the load in the load container, the work machine to move the load toward a center of the load container.
[0007] A method for controlling a work machine according to an aspect of the present disclosure includes: acquiring information about a loading status of a load in a load container; determining whether it is necessary to move the load in the load container, based on the acquired information about the loading status of the load; and operating, when determining that it is necessary to move the load in the load container, the work machine to move the load toward a center of the load container.ADVANTAGEOUS EFFECTS OF INVENTION
[0008] The work machine, a system including the work machine, and a method for controlling the work machine according to the present disclosure enable appropriate loading into the load container.BRIEF DESCRIPTION OF DRAWINGS
[0009] Fig. 1 is a side view of a wheel loader as one example of a work machine. Fig. 2 is a block diagram showing a schematic configuration of a control system of the wheel loader. Fig. 3 is a plan view of the wheel loader performing an excavation-and-loading work. Fig. 4 is a block diagram showing a configuration of an automatic control system of the wheel loader. Fig. 5 is a flowchart showing a flow of an operation of loading, onto a loading target, a load loaded on a bucket under automatic control. Fig. 6 is a flowchart showing automatic control of load push. Fig. 7 is a diagram schematically showing an arrangement of a vessel and the wheel loader at the start of approaching a dump. Fig. 8 is a diagram schematically showing an attitude of the wheel loader at the time a cutting edge of a bucket is located at the lowermost position during a loading operation. Fig. 9 is a diagram schematically showing an attitude of the wheel loader at the start of load push. Fig. 10 is a diagram schematically showing an attitude of the wheel loader at the time load push is ended. Fig. 11 is a graph showing change of the cylinder length during a loading work. Fig. 12 is a diagram showing change of the load condition in a vessel caused by load push. DESCRIPTION OF EMBODIMENTS
[0010] Embodiments are described hereinafter based on the drawings. In the following description, the same parts or elements are denoted by the same reference characters. They have the same names and functions. Therefore, a detailed description thereof is not herein repeated. It is originally intended that any features are extracted from embodiments and combined as appropriate.<Overall Configuration of Wheel Loader 1>
[0011] In connection with an embodiment, a wheel loader 1 is described as one example of the work machine. Fig. 1 is a side view of wheel loader 1 as one example of the work machine.
[0012] As shown in Fig. 1, wheel loader 1 includes a vehicular body frame 2, a work implement 3, a travel device 4, and a cab 5. The vehicular body of wheel loader 1 is made up of vehicular body frame 2 and cab 5, for example. To the vehicular body of wheel loader 1, work implement 3 and travel device 4 are attached. The main body of wheel loader 1 includes a vehicular body and travel device 4.
[0013] Travel device 4 causes the vehicular body of wheel loader 1 to travel, and includes running wheels 4a and 4b. Wheel loader 1 is a wheeled vehicle including running wheels 4a and 4b serving as traveling rotary bodies on both sides of the vehicular body in the left-right direction. Wheel loader 1 is capable of being self-propelled by rotationally driving running wheels 4a and 4b, and performing desired work using work implement 3. Travel device 4 corresponds to one example of "travel unit. "
[0014] The direction in which wheel loader 1 travels straight is herein referred to as front-rear direction of wheel loader 1. In the front-rear direction of wheel loader 1, the side where work implement 3 is located, with respect to vehicular body frame 2, is defined as front direction, and the side opposite to the front direction is defined as rear direction. The left-right direction of wheel loader 1 is a direction orthogonal to the front-rear direction as seen in a plan view of wheel loader 1 on a flat ground. The right side and the left side in the left-right direction, with respect to the front direction, are right direction and left direction, respectively. The top-bottom direction of wheel loader 1 is a direction orthogonal to a plane defined by the front-rear direction and the left-right direction. In the top-bottom direction, the side where the ground is located is the lower side, and the side where the sky is located is the upper side.
[0015] Vehicular body frame 2 includes a front frame 2a and a rear frame 2b. Front frame 2a is disposed frontward with respect to rear frame 2b. Front frame 2a and rear frame 2b are attached to each other in such a manner that they can swing in the left-right direction.
[0016] A pair of steering cylinders 11 is attached to extend across front frame 2a and rear frame 2b. Steering cylinder 11 is a hydraulic cylinder. The travel direction of wheel loader 1 is changed to the left or right by expansion / contraction of steering cylinder 11 caused by hydraulic oil from a steering pump. Front frame 2a and rear frame 2b constitute vehicular body frame 2 having an articulated structure. Wheel loader 1 is an articulated work machine having front frame 2a and rear frame 2b connected to each other in such a manner that they can be bent.
[0017] Work implement 3 and a pair of running wheels (front wheels) 4a are attached to front frame 2a. Work implement 3 is attached to the front of the main body of wheel loader 1. Work implement 3 is supported by the vehicular body of wheel loader 1. Work implement 3 includes a boom 14 and a bucket 6. Bucket 6 is disposed at the distal end of work implement 3. Bucket 6 is a working tool for excavation and loading. A cutting edge 6a is the distal end of bucket 6. A back surface 6b is a part of the outer surface of bucket 6. Back surface 6b is formed as a flat surface. Back surface 6b extends rearward from cutting edge 6a.
[0018] The proximal end of boom 14 is rotatably attached to front frame 2a by a boom pin 9. Bucket 6 is rotatably attached to boom 14 by a bucket pin 17 located at the distal end of boom 14. Boom pin 9 and bucket pin 17 correspond to "a plurality of joints" of work implement 3.
[0019] Work implement 3 further includes a bell crank 18 and a link 15. Bell crank 18 is rotatably supported on boom 14 by a support pin 18a located substantially at the center of boom 14. Link 15 is coupled to a coupling pin 18c provided at the distal end of bell crank 18. Link 15 connects bell crank 18 and bucket 6 to each other.
[0020] Front frame 2a and boom 14 are connected by a pair of boom cylinders 16. Boom cylinder 16 is a hydraulic cylinder. Boom cylinder 16 rotationally drives boom 14 up and down about boom pin 9. The proximal end of boom cylinder 16 is attached to front frame 2a. The distal end of boom cylinder 16 is attached to boom 14. Boom cylinder 16 is a hydraulic actuator that moves boom 14 up and down with respect to front frame 2a. As boom 14 moves up and down, bucket 6 attached to the distal end of boom 14 also moves up and down.
[0021] A bucket cylinder 19 connects bell crank 18 and front frame 2a to each other. The proximal end of bucket cylinder 19 is attached to front frame 2a. The distal end of bucket cylinder 19 is attached to a coupling pin 18b provided at the proximal end of bell crank 18. Bucket cylinder 19 is a hydraulic actuator that pivots bucket 6 up and down with respect to boom 14. Bucket cylinder 19 is a working tool cylinder that drives bucket 6. Bucket cylinder 19 rotationally drives bucket 6 about bucket pin 17. Bucket 6 is configured to be operable with respect to boom 14. Bucket 6 is configured to be operable with respect to front frame 2a.
[0022] Boom cylinder 16 and bucket cylinder 19 correspond to one example of "work implement actuator" that drives work implement 3.
[0023] Cab 5 on which an operator rides and a pair of running wheels (rear wheels) 4b are attached to rear frame 2b. Cab 5 in a box shape is located rearward with respect to boom 14. Cab 5 is placed on vehicular body frame 2. A seat on which an operator of wheel loader 1 sits and an operation device 8 (Fig. 2) described later herein, for example, are disposed in cab 5.<System Configuration>
[0024] Fig. 2 is a block diagram showing a schematic configuration of a control system that controls wheel loader 1.
[0025] As shown in Fig. 2, an engine 21 is a driving source that generates a driving force for driving work implement 3 and travel device 4 (Fig. 1), and is, for example, a diesel engine. A motor driven by a power storage unit may be used as a driving source, instead of engine 21, or both the engine and the motor may be used as a driving source. The output of engine 21 is controlled by adjusting the amount of fuel injected into a cylinder of engine 21.
[0026] The driving force generated by engine 21 is transmitted to a transmission 23. Transmission 23 changes the driving force to an appropriate torque and an appropriate rotational speed. An axle 25 is connected to an output shaft of transmission 23. The driving force changed by transmission 23 is transmitted to axle 25. The driving force is transmitted from axle 25 to running wheels 4a and 4b (Fig. 1). Accordingly, wheel loader 1 travels. In wheel loader 1 of the present embodiment, both of running wheels 4a and running wheels 4b constitute driving wheels that drive wheel loader 1 by the received driving force.
[0027] A part of the driving force of engine 21 is transmitted to a work implement pump 13. Work implement pump 13 is a hydraulic pump that is driven by engine 21 to cause work implement 3 (Fig. 1) to operate by its discharged hydraulic oil. Work implement 3 is driven by the hydraulic oil from work implement pump 13. The hydraulic oil discharged from work implement pump 13 is supplied to boom cylinder 16 and bucket cylinder 19 through a main valve 32. As boom cylinder 16 expands and contracts by receiving the supplied hydraulic oil, boom 14 moves up and down. As bucket cylinder 19 expands and contracts by receiving the supplied hydraulic oil, bucket 6 pivots up and down.
[0028] Wheel loader 1 includes a vehicular body controller 50. Vehicular body controller 50 includes an engine controller 60, a transmission controller 70, and a work implement controller 80.
[0029] Vehicular body controller 50 is generally implemented by a CPU (Central Processing Unit) reading various programs. Vehicular body controller 50 includes a memory, which is not shown. The memory functions as a work memory and stores various programs for implementing functions of wheel loader 1.
[0030] Operation device 8 is provided on cab 5. Operation device 8 is operated by an operator. Operation device 8 includes a plurality of types of operation members that the operator operates in order to cause wheel loader 1 to operate. Operation device 8 includes an accelerator pedal 41 and a work implement operation lever 42. Operation device 8 may include a steering handle, a shift lever, and the like, which are not shown.
[0031] Accelerator pedal 41 is operated to set a target rotational speed of engine 21. Engine controller 60 controls the output of engine 21 based on the operation amount of accelerator pedal 41. When the operation amount of accelerator pedal 41 (the extent to which the pedal is depressed) is increased, the output of engine 21 is increased. When the operation amount of accelerator pedal 41 is decreased, the output of engine 21 is decreased. Transmission controller 70 controls transmission 23 based on the operation amount of accelerator pedal 41.
[0032] Work implement operation lever 42 is operated to cause work implement 3 to operate. Work implement controller 80 controls electromagnetic proportional control valves 35 and 36 based on the operation amount of work implement operation lever 42.
[0033] Electromagnetic proportional control valve 35 switches main valve 32 so as to contract bucket cylinder 19 and thereby move bucket 6 in a dumping direction (a direction in which the cutting edge of bucket 6 is lowered). Electromagnetic proportional control valve 35 also switches main valve 32 so as to extend bucket cylinder 19 and thereby move bucket 6 in a tilt direction (a direction in which the cutting edge of bucket 6 is lifted). Electromagnetic proportional control valve 36 switches main valve 32 so as to contract boom cylinder 16 and thereby lower boom 14. Electromagnetic proportional control valve 36 also switches main valve 32 so as to extend boom cylinder 16 and thereby lift boom 14.
[0034] A machine monitor 51 receives input of a command signal from vehicular body controller 50 to display various kinds of information. Various kinds of information displayed on machine monitor 51 may for example be information about a work performed by wheel loader 1, vehicular body information such as a remaining amount of fuel, a cooling water temperature, and a hydraulic oil temperature, a peripheral image obtained by imaging the periphery of wheel loader 1, and the like. Machine monitor 51 may be a touch panel and, in this case, a signal generated as a result of operator's touch of a part of machine monitor 51 is output from machine monitor 51 to vehicular body controller 50.<Excavation-and-Loading Work>
[0035] Wheel loader 1 of the present embodiment performs an excavation-and-loading work of scooping out an excavation target, i.e., an object to be excavated, such as soil, rocks, and sand, and loading the excavation target on a loading target such as dump truck. Fig. 3 is a plan view of wheel loader 1 performing an excavation-and-loading work. Fig. 3 shows wheel loader 1 performing a so-called V-shape work.
[0036] Fig. 3 (A) illustrates wheel loader 1 making a so-called empty-load advance. Wheel loader 1 travels forward along an excavation route R1 toward an excavation target 310 such as soil, rocks, and sand. Wheel loader 1 pushes bucket 6 into excavation target 310 and stops traveling forward. An excavation work of scooping out at least a part of excavation target 310 with bucket 6 is performed, by lifting bucket 6 with cutting edge 6a (Fig. 1) of bucket 6 being caught in excavation target 310.
[0037] Fig. 3 (B) illustrates wheel loader 1 making a so-called loaded retreat. Excavation target 310 is loaded as a load in bucket 6. Wheel loader 1 travels backward along excavation route R1 to the position where it started traveling forward in Fig. 3 (A).
[0038] Fig. 3 (C) illustrates wheel loader 1 making a so-called loaded advance. With the load (excavation target 310) loaded in bucket 6, wheel loader 1 travels forward toward a vessel 301 of a dump truck 300. Wheel loader 1 travels forward along a loading route R2 from the position where it started traveling forward in Fig. 3 (A) toward dump truck 300. As wheel loader 1 approaches dump truck 300 and reaches a predetermined position, wheel loader 1 loads the load 310 in bucket 6 into vessel 301. Vessel 301 corresponds to one example of "load container" into which load 310 in bucket 6 is loaded.
[0039] Fig. 3 (D) illustrates wheel loader 1 making a so-called empty-load retreat. In the state where all load 310 in bucket 6 has been discharged into vessel 301 of dump truck 300 so that the inside of bucket 6 is empty, wheel loader 1 travels backward along loading route R2 to the position where it started traveling forward in Fig. 3 (C).
[0040] Thus, wheel loader 1 can repeatedly perform a series of operations: excavation, retreat, approaching the dump, discharging load, and retreat.<Automatic Control System of Wheel Loader 1>
[0041] For automation of loading onto dump truck 300 by wheel loader 1, it is desired to reproduce, under automatic control, an operation of work implement 3 for a loading work by a skilled operator, in order to prevent load 310 placed in vessel 301 from spilling from vessel 301. Fig. 4 is a block diagram showing a configuration of an automatic control system of wheel loader 1.
[0042] An automation controller 100 is configured to be capable of transmitting and receiving signals to and from vehicular body controller 50 described with reference to Fig. 2. Automation controller 100 is also configured to be capable of transmitting and receiving signals to and from an external information acquisition unit 110. External information acquisition unit 110 includes a sensing device 111 and a position information acquisition device 112. Sensing device 111 and position information acquisition device 112 are mounted on wheel loader 1.
[0043] Sensing device 111 acquires information about the surroundings of wheel loader 1. As shown in Fig. 1, sensing device 111 is attached, for example, to an upper front surface of cab 5. Sensing device 111 corresponds to one example of "object sensor" that detects an object around the main body of wheel loader 1.
[0044] Sensing device 111 detects the direction of an object outside wheel loader 1 and the distance to the object in a non-contact manner. Sensing device 111 is, for example, LiDAR (Light Detection and Ranging) that emits laser light to obtain information about an object. Sensing device 111 may be a visual sensor including a camera. Sensing device 111 may be Radar (Radio Detection and Ranging) that acquires information about an object by emitting radio waves. Sensing device 111 may also be an infrared sensor.
[0045] Position information acquisition device 112 acquires information about the current position of wheel loader 1. Position information acquisition device 112 acquires information about the position of wheel loader 1 in a global coordinate system with respect to the earth, for example, by using a satellite positioning system. Position information acquisition device 112 uses, for example, GNSS (Global Navigation Satellite Systems), and has a GNSS receiver. The satellite positioning system calculates the position of wheel loader 1 by calculating the position of an antenna of the GNSS receiver based on positioning signals that the GNAA receiver has received from satellites.
[0046] External information about wheel loader 1 acquired by sensing device 111 and position information about wheel loader 1 acquired by position information acquisition device 112 are input to automation controller 100.
[0047] Vehicular body controller 50 is configured to be capable of transmitting and receiving signals to and from vehicle information acquisition unit 120, and receives input of information about wheel loader 1 acquired by vehicle information acquisition unit 120. Vehicle information acquisition unit 120 is constituted of various sensors mounted on wheel loader 1. Vehicle information acquisition unit 120 includes an articulation angle sensor 121, a vehicle speed sensor 122, a boom angle sensor 123, a bucket angle sensor 124, and a boom cylinder pressure sensor 125.
[0048] Articulation angle sensor 121 detects an articulation angle which is an angle formed between front frame 2a and rear frame 2b, and generates a signal indicative of the detected articulation angle. Articulation angle sensor 121 outputs the signal indicative of the articulation angle to vehicular body controller 50.
[0049] Vehicle speed sensor 122 detects the speed of moving wheel loader 1 by travel device 4 (Fig. 1) by detecting the rotational speed of the output shaft of transmission 23 (Fig. 2), for example, and generates a signal indicative of the detected vehicle speed. Vehicle speed sensor 122 outputs a signal indicative of the vehicle speed to vehicular body controller 50. Vehicle speed sensor 122 corresponds to one example of "travel sensor" that detects a traveling state of travel device 4 (travel unit).
[0050] Boom angle sensor 123 is constituted, for example, of a rotary encoder provided on boom pin 9 which is a part for boom 14 to be attached to vehicular body frame 2. Boom angle sensor 123 detects the angle of boom 14 with respect to the horizontal direction and generates a signal indicative of the detected angle of boom 14. Boom angle sensor 123 outputs a signal indicative of the angle of boom 14 to vehicular body controller 50.
[0051] Bucket angle sensor 124 is constituted, for example, of a rotary encoder provided on a support pin 18a which is a rotation shaft of bell crank 18. Bucket angle sensor 124 detects the angle of bucket 6 with respect to boom 14, and generates a signal indicative of the detected angle of bucket 6. Bucket angle sensor 124 outputs the signal indicative of the angle of bucket 6 to vehicular body controller 50.
[0052] Boom angle sensor 123 and bucket angle sensor 124 correspond to one example of "work implement attitude sensor" that detects the attitude of work implement 3. The work implement attitude sensor may be an angle sensor that detects the angle of bell crank 18 and an angle sensor that detects the angle of link 15, instead of or in addition to boom angle sensor 123 and bucket angle sensor 124. The work implement attitude sensor is not limited to the rotary encoder, and may be a stroke sensor, an IMU (Inertial Measurement Unit), a potentiometer, a visual sensor, or the like.
[0053] When the stroke sensor is used as the work implement attitude sensor, for example, the stroke sensor is attached to each of boom cylinder 16 and bucket cylinder 19. The stroke amount of each of cylinders 16 and 19 can be detected by the stroke sensor. Respective attitudes of boom 14 and bucket 6 can be detected from the stroke amounts.
[0054] When the IMU is used as the work implement attitude sensor, for example, the IMU is attached to each of boom 14 and bucket 6. Each IMU detects angles (or angular velocities) and accelerations of the three axes. The attitudes of boom 14 and bucket 6 can be detected from the angles (or angular velocities) and accelerations of the three axes detected by the IMU.
[0055] When the potentiometer is used as the work implement attitude sensor, for example, the potentiometer is attached to each of a vicinity of the boom 14 side end of boom cylinder 16 and a vicinity of the bell crank 18 side end of bucket cylinder 19. Respective potentiometers can detect the rotation angle of boom 14 with respect to the main body of wheel loader 1 and the rotation angle of bucket 6 with respect to boom 14. The attitude of work implement 3 can be detected from these rotation angles.
[0056] When the visual sensor is used as the work implement attitude sensor, respective states of boom 14 and bucket 6 are imaged by the visual sensor.
[0057] Respective attitudes of boom 14 and bucket 6 can be detected from information about the images captured by the visual sensor. The visual sensor is, for example, an imaging device such as camera.
[0058] Boom cylinder pressure sensor 125 detects the pressure on the bottom side of boom cylinder 16 (boom bottom pressure) and generates a signal indicative of the detected boom bottom pressure. The boom bottom pressure increases when bucket 6 is loaded with a load and decreases when the bucket is emptied. Boom cylinder pressure sensor 125 outputs the signal indicative of the boom bottom pressure to vehicular body controller 50.
[0059] Vehicular body controller 50 outputs the information input from vehicle information acquisition unit 120 to automation controller 100. Automation controller 100 receives detected values of vehicle speed sensor 122, boom angle sensor 123, and bucket angle sensor 124 that are input through vehicular body controller 50.
[0060] An actuator 140 is configured to be capable of transmitting and receiving signals to and from vehicular body controller 50. Actuator 140 is driven in response to a command signal from vehicular body controller 50. Actuator 140 includes a brake EPC (electromagnetic proportional control valve) 141 for actuating a brake of travel device 4, a steering EPC 142 for adjusting the travel direction of wheel loader 1, a work implement EPC 143 for causing work implement 3 to operate, and an HMT (Hydraulic Mechanical Transmission) 144.
[0061] Electromagnetic proportional control valves 35 and 36 shown in Fig. 2 constitute work implement EPC 143. Transmission 23 shown in Fig. 2 is implemented as HMT 144 utilizing electronic control. Transmission 23 may be an HST (Hydro-Static Transmission). A power transmission device that transmits power from engine 21 to running wheels 4a and 4b may include an electric drive device of a diesel-electric transmission system or the like, or may include any combination of an HMT, an HST, and an electric drive device.
[0062] Vehicular body controller 50 includes transmission controller 70 and work implement controller 80. Transmission controller 70 includes a brake control unit 71 and an accelerator control unit 72. Brake control unit 71 outputs a command signal for controlling actuation of the brake, to brake EPC 141. Accelerator control unit 72 outputs a command signal for controlling the vehicle speed, to HMT 144.
[0063] Work implement controller 80 includes a steering control unit 81 and a work implement control unit 82. Steering control unit 81 outputs a command signal for controlling the travel direction of wheel loader 1, to steering EPC 142. Work implement control unit 82 outputs a command signal for controlling operation of work implement 3, to work implement EPC 143.
[0064] Automation controller 100 includes a position estimation unit 101, a path planning unit 102, a route tracking control unit 103, and a load push determination unit 104.
[0065] Position estimation unit 101 estimates the current position of wheel loader 1 based on the position information acquired by position information acquisition device 112. Position estimation unit 101 also recognizes a target position based on external information acquired by sensing device 111. The target position is, for example, the position of excavation target 310 or the position of dump truck 300 shown in Fig. 3. Sensing device 111 may recognize the target position and input the target position to automation controller 100, or position estimation unit 101 may recognize the target position based on a detection result detected by sensing device 111.
[0066] Path planning unit 102 generates an optimal route connecting the current position and the target position of wheel loader 1. The optimum route includes a route of traveling by travel device 4 and a route of operation of work implement 3.
[0067] Route tracking control unit 103 controls the accelerator, the brake, and the steering so that wheel loader 1 tracks the optimum route generated by path planning unit 102. A command signal for causing wheel loader 1 to travel along the optimal route is output from route tracking control unit 103 to brake control unit 71, accelerator control unit 72, and steering control unit 81. Route tracking control unit 103 controls boom cylinder 16 and bucket cylinder 19 so that work implement 3 operates along the optimum route generated by path planning unit 102. A command signal for moving work implement 3 along the optimal route is output from route tracking control unit 103 to work implement control unit 82.
[0068] An interface 130 is configured to be capable of transmitting and receiving signals to and from vehicular body controller 50. Interface 130 includes an automation switch 131, an engine emergency stop switch 132, and a mode lamp 133.
[0069] Automation switch 131 is operated by an operator. The operator operates automation switch 131 to make a switch between manual operation of wheel loader 1 and automatic control of wheel loader 1. Engine emergency stop switch 132 is operated by an operator. When an event occurs that requires emergency stop of engine 21, the operator operates engine emergency stop switch 132. Signals for operations of automation switch 131 and engine emergency stop switch 132 are input to vehicular body controller 50.
[0070] Mode lamp 133 indicates whether wheel loader 1 is currently in a mode of being manually operated by an operator or in an automatically controlled mode. A command signal for controlling lighting of the lamp is output from vehicular body controller 50 to mode lamp 133.
[0071] The automatic control system of wheel loader 1 acquires information about a loading status (for example, load condition) of a load in vessel 301 for automating a load push in a loading work. The automatic control system of wheel loader 1 also detects information about the loading status of the load in vessel 301. The automatic control system of wheel loader 1 moves (pushes) the load in vessel 301 by causing wheel loader 1 to operate based on the detected information. Thus, the automatic control system of wheel loader 1 includes a "loading sensor" that detects information about the loading status of the load in vessel 301.
[0072] The "loading sensor" detects information about a loading status of load 310 in vessel 301. The loading sensor may include, for example, at least one of the "object sensor" and the "work implement attitude sensor" described above. That is, the loading sensor may be the "object sensor" alone, or the "work implement attitude sensor" alone, or may include both the "object sensor" and the "work implement attitude sensor."
[0073] When the loading sensor is the object sensor, a signal indicating the loading status of load 310 in vessel 301 detected by the object sensor serves as information about the loading status of load 310 in vessel 301. In this case, the loading status of load 310 in vessel 301 is detected by sensing device 111, which is one example of the object sensor. Specifically, the loading status of load 310 in vessel 301 is detected by any one or any combination of a LiDAR, a visual sensor, a Radar, an infrared sensor, and the like, which are each an example of sensing device 111.
[0074] When the loading sensor is the work implement attitude sensor, a signal indicating the attitude of work implement 3 detected by the work implement attitude sensor serves as information about the loading status of load 310 in vessel 301. In this case, a signal indicating the attitude of work implement 3 is detected by any one or any combination of a rotary encoder, a stroke sensor, an IMU, a potentiometer, a visual sensor, and the like, which are each an example of the work implement attitude sensor.
[0075] The automatic control system of wheel loader 1 includes load push determination unit 104 that determines whether or not it is necessary to push load 310 in vessel 301, based on the information about the loading status of load 310 in vessel 301. Load push determination unit 104 is included in automation controller 100.
[0076] Load push determination unit 104 determines whether or not it is necessary to push load 310 in vessel 301, based on the information detected by the loading sensor. When the information about the loading status is detected by the object sensor alone, load push determination unit 104 determines whether or not it is necessary to push load 310 in vessel 301, based on the information about the loading status of load 310 in vessel 301 acquired by sensing device 111, for example.
[0077] In this case, automation controller 100 has stored, for example, relationship data indicating a relationship between the loading status of load 310 in vessel 301 and whether it is necessary to push the load. Load push determination unit 104 determines whether or not it is necessary to move load 310 in vessel 301, by comparing the relationship data with the information about the loading status of load 310 in vessel 301 acquired by sensing device 111.
[0078] When the information about the loading status is detected by the work implement attitude sensor alone, load push determination unit 104 calculates the number of times load 310 has been loaded into vessel 301 by work implement 3, from a signal indicating the attitude of work implement 3 acquired by the work implement attitude sensor, for example. When the calculated number of times of loading is equal to or more than a predetermined number of times (for example, two), load push determination unit 104 determines that it is necessary to pushy load 310 in vessel 301. In this case, the signal indicating the number of times of loading corresponds to the information about the loading status of load 310 in vessel 301.
[0079] It should be noted that the information about the loading status may be detected by both the object sensor and the work implement attitude sensor. In this case, it is determined whether or not it is necessary to push load 310 in vessel 301, based on both the information about the loading status detected by the object sensor and the information about the loading status detected by the work implement attitude sensor.
[0080] When load push determination unit 104 determines that it is necessary to push load 310 in vessel 301, automation controller 100 causes wheel loader 1 to operate so as to push load 310 toward center CL of vessel 301.
[0081] Specifically, when load push determination unit 104 determines that it is necessary to push load 310 in vessel 301, path planning unit 102 generates a route for causing wheel loader 1 to operate so as to move load 310 toward center CL of vessel 301. Then, route tracking control unit 103 controls the accelerator, the brake, the steering, boom cylinder 16, and bucket cylinder 19, so that wheel loader 1 tracks the route generated by path planning unit 102 and work implement 3 operates.<Automatic Dump Loading Flow>
[0082] Fig. 5 is a flowchart showing a flow of an operation of loading, onto a loading target, a load loaded on bucket 6, by automatically controlling wheel loader 1.
[0083] As shown in Fig. 5, in step S100, the shape of vessel 301 of dump truck 300, which is a loading target on which a load is to be loaded, is recognized in advance before a loading work is started. For example, the shape of dump truck 300 is acquired by a LiDAR, which is sensing device 111. Laser light is applied from the LiDAR to dump truck 300 to acquire point group data indicating three-dimensional coordinate values of measurement points on dump truck 300. Dump truck 300 is sensed from the front, rear, right, and left sides, so that the shape of vessel 301 can be recognized from the point group information. The recognized shape of vessel 301 is input to automation controller 100.
[0084] In step S101, sensing device 111 recognizes a reference point P (Fig. 7) of dump truck 300. For example, the LiDAR, which is sensing device 111, senses dump truck 300. Automation controller 100 recognizes the position of vessel 301 by comparing the point group detected by sensing device 111 with a master point group indicating the shape of vessel 301. Automation controller 100 sets reference point P at an upper end of a side surface of vessel 301 of dump truck 300 recognized by the LiDAR, which is sensing device 111.
[0085] In step S102, automation controller 100 sets coordinates of target positions c, d, and e (Fig. 7) of cutting edge 6a of bucket 6 moved by automatic control, with respect to reference point P. Cutting edge 6a of bucket 6 corresponds to one example of "feature point" set on work implement 3. The feature point is not limited to cutting edge 6a of bucket 6, and any of other points on work implement 3 may be set as the feature point.
[0086] Reference point P and target positions c, d, and e are now described. Fig. 7 is a diagram schematically showing an arrangement of vessel 301 and wheel loader 1 at the start of approaching a dump. In Fig. 7 and subsequent Figs. 8 to 10, vessel 301 as seen in the front-rear direction of dump truck 300 is schematically shown, and a part of a front portion of wheel loader 1 approaching vessel 301 from the left side or the right side of dump truck 300 is schematically shown.
[0087] Target position c is set as a position through which cutting edge 6a of bucket 6 passes while wheel loader 1 is traveling forward toward dump truck 300. During the forward travel of wheel loader 1, an operation of work implement 3 for moving bucket 6 in the dumping direction is performed in order to load the load 310 in bucket 6 into vessel 301. The position at the time cutting edge 6a of bucket 6 performing dumping during a loading operation is located at the lowermost position is target position c.
[0088] Target position d is set as a position through which cutting edge 6a of bucket 6 passes after passing through target position c. Target position d is set closer to reference point P than target position c. Target position d is a position at which the operation of bucket 6 in the dumping direction is stopped. When cutting edge 6a of bucket 6 is located at target position d, bucket 6 is in a full dump state, for example. When cutting edge 6a of bucket 6 is at target position d, the length of bucket cylinder 19 is minimum. Target position d is located above vessel 301.
[0089] When load push determination unit 104 determines that it is necessary to push load 310 which has been loaded in vessel 301, target position d is a position at which load push is started. Target position d is a position at which the operation of work implement 3 is stopped while bucket 6 is maintained in the full dump state, for example.
[0090] Target position e is set as a position through which cutting edge 6a of bucket 6 passes after passing through target position d. Target position e is set farther from reference point P than target position d. From target position d to target position e, the state in which the operation of work implement 3 is stopped is maintained in the state in which bucket 6 is in the full dump state, for example, and the forward travel of wheel loader 1 is continued. Target position e is located above vessel 301.
[0091] As shown in Fig. 7, an xy coordinate system having reference point P as the origin is defined. The x-axis is the left-right direction of dump truck 300 through reference point P. The direction away from vessel 301 with respect to reference point P is +x direction. The y-axis is the top-bottom direction through reference point P. The upward direction from reference point P is +y direction.
[0092] A bucket angle θ shown in Fig. 7 is an angle formed by the ground and back surface 6b of bucket 6. Bucket angle θ may also be an angle formed by back surface 6b of bucket 6 and a horizontal plane with respect to the vehicular body.
[0093] Target positions c, d, and e are determined by giving respective positions of cutting edge 6a of bucket 6 in the horizontal direction and the vertical direction with respect to reference point P, that is, the x-coordinate and the y-coordinate. Target position c is set as a position at which the height position of cutting edge 6a is the lowest (the y-coordinate has the minimum value) while discharging load 310 from bucket 6. Target position c is set to a position where the y-coordinate is on the negative side. The y-coordinates of target positions d and e are set to positions on the positive side.
[0094] Target positions c, d, and e are set at respective positions having respective x-coordinates on the negative side. Target positions d and e are set at the same y-coordinate, for example. At target positions d and e, bucket 6 may not be in the full dump state, but may be in a dump state in which load 310 in bucket 6 can be loaded into vessel 301. Moreover, target positions d and e may not be at the same y-coordinate, and target position e may be a position (position in the -y direction) lower than target position d.
[0095] Bucket angle θ at the time cutting edge 6a of bucket 6 is located at each target position is also set. The attitude of work implement 3 at the time cutting edge 6a of bucket 6 is located at each target position is determined from the x-coordinate and the y-coordinate of each target position and bucket angle θ at each target position. Automation controller 100 stores the attitude (target attitude) of work implement 3 at the time cutting edge 6a of bucket 6 is located at each target position. The length of boom cylinder 16 and the length of bucket cylinder 19 at the time cutting edge 6a of bucket 6 is located at each target position are determined, based on the target attitude at the time cutting edge 6a of bucket 6 is located at the target position.
[0096] The x-coordinate and the y-coordinate of each target position and bucket angle θ at each target position can be determined by analyzing the trajectory of cutting edge 6a while a skilled operator performs a loading work, extracting a characteristic position, and extracting the attitude of work implement 3 at the characteristic position.
[0097] Fig. 8 is a diagram schematically showing an attitude of the wheel loader at the time the cutting edge of the bucket is located at the lowermost position during a loading operation. Fig. 9 is a diagram schematically showing an attitude of the wheel loader at the start of load push. Fig. 10 is a diagram schematically showing an attitude of the wheel loader at the time load push is ended. In Fig. 8, cutting edge 6a of bucket 6 is located at target position c. In Fig. 9, cutting edge 6a is located at target position d. In Fig. 10, cutting edge 6a is located at target position e.
[0098] Fig. 11 is a graph showing change of the cylinder length during a loading work. The horizontal axis of Fig. 11 represents elapse of time, and auxiliary lines are drawn at respective times at which cutting edge 6a passes through target positions c, d, and e. The vertical axis in Fig. 11 represents the length of boom cylinder 16 and bucket cylinder 19.
[0099] As shown in Fig. 11 and Figs. 7 and 8, wheel loader 1 is traveling forward before cutting edge 6a reaches target position c. The length of boom cylinder 16 is increasing and accordingly boom 14 is rising. The length of bucket cylinder 19 continues decreasing, so that bucket 6 continues moving in the dumping direction. At the time cutting edge 6a reaches target position c, cutting edge 6a is located at the lowermost position during the loading operation.
[0100] As shown in Fig. 11 and Figs. 8 and 9, while cutting edge 6a moves from target position c to target position d, wheel loader 1 continues traveling forward. The length of boom cylinder 16 is still increasing and accordingly boom 14 is still rising. The length of bucket cylinder 19 is still decreasing, so that bucket 6 continues moving in the dumping direction. At the time cutting edge 6a reaches target position d, bucket 6 assumes the attitude in the full dump state. At the time cutting edge 6a reaches target position d, bucket cylinder 19 has the minimum length.
[0101] As shown in Fig. 11 and Figs. 9 and 10, while cutting edge 6a moves from target position d to target position e, wheel loader 1 continues traveling forward. While cutting edge 6a moves from target position d to target position e, the operation of work implement 3 is stopped. Therefore, the length of boom cylinder 16 and the length of bucket cylinder 19 are identical respectively to the length of boom cylinder 16 and the length of bucket cylinder 19 at target position d. Thus, at the time cutting edge 6a reaches target position e, bucket 6 maintains the attitude in the full dump state and bucket cylinder 19 has the minimum length.
[0102] As shown in Fig. 11, at the time cutting edge 6a reaches target position e, wheel loader 1 is switched from forward travel to backward travel. While cutting edge 6a moves after reaching target position e, the operation of work implement 3 may be stopped for a predetermined time. In this case, during a predetermined time after reaching target position e, the length of boom cylinder 16 and the length of bucket cylinder 19 are identical respectively to the length of boom cylinder 16 and the length of bucket cylinder 19 at target position e.
[0103] Moreover, after a predetermined time has elapsed from the time target position e is reached, wheel loader 1 may continue the backward travel, the length of boom cylinder 16 may be decreased (boom 14 may be lowered), and the length of bucket cylinder 19 may be increased (bucket 6 may be moved in the tilt direction).
[0104] As described above, cutting edge 6a of bucket 6 can be moved to pass through target positions c and d in this order, to discharge load 310 from within bucket 6 into vessel 301. Moreover, cutting edge 6a of bucket 6 can be moved to pass through target positions d and e in this order, to push load 310 in vessel 301 by bucket 6. For example, load 310 in vessel 301 can be pushed toward center CL of vessel 301 by bucket 6. Thus, automatic control for moving bucket 6 can be applied to wheel loader 1 to perform the operation of wheel loader 1, including the load discharging operation and the load push operation that are equivalent to operations performed under operation of a skilled operator.
[0105] Referring again to Fig. 5, the description of the loading work under automatic control is continued. In step S103, automation controller 100 recognizes respective current positions of wheel loader 1 and work implement 3. By acquiring the current position of the vehicular body of wheel loader 1 by means of position information acquisition device 112 and acquiring the attitude of the work implement with respect to the vehicular body by means of boom angle sensor 123 and the bucket angle sensor 124, respective current positions of wheel loader 1 and work implement 3 in the global coordinate system can be recognized. The relative position of cutting edge 6a of bucket 6 with respect to vessel 301 of dump truck 300 can be calculated based on the current positions of wheel loader 1 and work implement 3 and the current position of dump truck 300 in the global coordinate system.
[0106] Alternatively, sensing device 111 may be used to acquire the direction and the distance of reference point P of vessel 301 of dump truck 300 with respect to the position where sensing device 111 is arranged, to calculate the current relative position of cutting edge 6a of bucket 6 with respect to reference point P.
[0107] The position of cutting edge 6a of bucket 6 with respect to each of target positions c to e is recognized from the current position of work implement 3. For example, it is recognized that cutting edge 6a has not yet reached target position c, or that cutting edge 6a has passed through target position c and is located between target position c and target position d, or that cutting edge 6a has passed through target position d and is located between target position d and target position e. Further, a target position toward which cutting edge 6a is moved next is recognized. For example, if cutting edge 6a has not yet reached target position c, it is recognized that the next target position is target position c; if cutting edge 6a is located between target position c and target position d, it is recognized that the next target position is target position d; and if cutting edge 6a is located between target position d and target position e, it is recognized that the next target position is target position e.
[0108] In step S104, automation controller 100 recognizes the length of boom cylinder 16 and the length of bucket cylinder 19 at the current position. Boom angle sensor 123 detects the angle of boom 14. Bucket angle sensor 124 detects the angle of bucket 6. The attitude of work implement 3 is determined from the angle of boom 14 and the angle of bucket 6. The length of boom cylinder 16 and the length of bucket cylinder 19 at the current position are recognized based on the attitude of work implement 3.
[0109] Instead of or in addition to boom angle sensor 123 and bucket angle sensor 124, an angle sensor for detecting the angle of the bell crank 18 and an angle sensor for detecting the angle of link 15 may be provided. Instead of or in addition to the angle sensors, a stroke sensor, an IMU, a potentiometer, a visual sensor, or the like may detect the attitude of work implement 3.
[0110] In step S105, automation controller 100 calculates the differences between the length of boom cylinder 16 and the length of bucket cylinder 19 at the current position recognized in step S104, and the length of boom cylinder 16 and the length of bucket cylinder 19 at the target position toward which cutting edge 6a is moved next (referred to as the target cylinder length hereinafter). Automation controller 100 calculates the distance to move cylinders 16, 19 required for cutting edge 6a to reach the next target position.
[0111] In step S106, automation controller 100 refers to the current vehicle speed and determines a target cylinder stroke speed at which the target cylinder length is obtained when cutting edge 6a reaches the next target position. When cutting edge 6a reaches the next target position, automation controller 100 controls boom cylinder 16 and bucket cylinder 19 so that work implement 3 takes the target attitude corresponding to the target position. The current vehicle speed is acquired by vehicle speed sensor 122. From the current position of cutting edge 6a and the current vehicle speed, the time required to reach the next target position is calculated. The target cylinder stroke speed is determined by dividing the difference in cylinder length calculated in step S105 by the time taken to reach the next target position.
[0112] The cylinder stroke amount while wheel loader 1 travels a unit distance may be determined. The fact that wheel loader 1 has traveled a unit distance may be obtained from the vehicle speed or may be detected by sensing device 111.
[0113] In step S107, automation controller 100 outputs, to vehicular body controller 50, a command current corresponding to the target cylinder stroke speed. Automation controller 100 outputs, to work implement control unit 82 of work implement controller 80, a command to expand and contract boom cylinder 16 and bucket cylinder 19 at the target cylinder stroke speed. The command to expand and contract boom cylinder 16 and bucket cylinder 19 at the target cylinder stroke speed is output from work implement control unit 82 to work implement EPC 143.
[0114] In step S108, work implement EPC 143 that has received the command signal adjusts the opening degree to cause appropriate hydraulic oil to be supplied to boom cylinder 16 and bucket cylinder 19. Thus, boom cylinder 16 and bucket cylinder 19 operate.
[0115] In step S109, automation controller 100 recognizes respective current lengths of boom cylinder 16 and bucket cylinder 19, similarly to step S104. Automation controller 100 determines whether the respective current lengths of boom cylinder 16 and bucket cylinder 19 have reached the target cylinder length.
[0116] When it is determined in step S109 that the target cylinder length has been reached (YES in step S109), the flow proceeds to step S110, and automation controller 100 determines whether or not there is a next target position.
[0117] When it is determined in step S109 that the target cylinder length has not been reached (NO in step S109) and it is determined in step S110 that there is a next target position (YES in step S110), the flow returns to step S103 and the process of expanding and contracting boom cylinder 16 and bucket cylinder 19 is repeated based on the current position of work implement 3. The cylinder speed is sequentially changed depending on the current position of cutting edge 6a of bucket 6. When the current position of cutting edge 6a deviates from the position based on the cylinder speed set in the previous process, the cylinder speed is adjusted.
[0118] When it is determined in step S110 that there is no next target position (NO in step S110), the loading work is ended. In the present embodiment, this condition corresponds to the fact that the next target position is not set after target position d is reached.<Automatic Control Flow of Load Push>
[0119] Next, an automatic control flow of load push is described with reference to Fig. 6 for example.
[0120] Fig. 6 is a flowchart showing automatic control of load push. By the automatic control of the automatic dumping illustrated in Fig. 5, cutting edge 6a of bucket 6 reaches target position d as shown in Fig. 9. Whether or not cutting edge 6a has reached target position d is determined by automation controller 100 based on whether or not respective lengths of boom cylinder 16 and bucket cylinder 19 have reached the target length for target position d in the automatic control flow of Fig. 5. At the time target position d is reached, bucket 6 has become the full dump state. Therefore, the operation for loading the load 310 in bucket 6 into vessel 301 is ended (step S201, Fig. 6).
[0121] Automation controller 100 has acquired information about the loading status of load 310 in vessel 301. When cutting edge 6a of bucket 6 reaches target position d, automation controller 100 determines whether to push load 310 in vessel 301 (step S202, Fig. 6). The acquisition of the information about the loading status and the determination as to whether or not it is necessary to push the load are performed by load push determination unit 104 of automation controller 100.
[0122] Load push determination unit 104 determines whether it is necessary to push load 310 in vessel 301, based on the information about the loading status of load 310 in vessel 301. Load push determination unit 104 determines whether it is necessary to push load 310 in vessel 301, based on the information about the loading status of load 310 in vessel 301 acquired by sensing device 111, for example.
[0123] In this case, automation controller 100 has stored relationship data indicating a relationship between the loading status of load 310 in vessel 301 and whether it is necessary to push the load. Load push determination unit 104 determines whether it is necessary to push load 310 in vessel 301, by comparing the relationship data with the information about the loading status of load 310 in vessel 301 acquired by sensing device 111.
[0124] Moreover, load push determination unit 104 calculates the number of times load 310 has been loaded into vessel 301 by work implement 3, from a signal indicating the attitude of work implement 3 acquired by a work implement attitude sensor, for example. When the calculated number of times of loading is equal to or more than a predetermined number of times (for example, two), load push determination unit 104 determines that it is necessary to push load 310 in vessel 301.
[0125] In step S202, when load push determination unit 104 determines that it is necessary to push load 310 in vessel 301, path planning unit 102 generates a route along which wheel loader 1 is to be operated, so that cutting edge 6a moves from target position d to target position e.
[0126] Route tracking control unit 103 controls the accelerator, the brake, and the steering so that wheel loader 1 tracks the route generated by path planning unit 102. A command signal for causing wheel loader 1 to travel along an optimal route is output from route tracking control unit 103 to brake control unit 71, accelerator control unit 72, and steering control unit 81. Thus, wheel loader 1 is controlled to travel forward from target position d to target position e, by route tracking control unit 103.
[0127] Moreover, route tracking control unit 103 controls boom cylinder 16 and bucket cylinder 19 so that work implement 3 operates along the optimum route generated by path planning unit 102. A command signal to move work implement 3 along the optimal route is output from route tracking control unit 103 to work implement control unit 82. Thus, work implement 3 is controlled by route tracking control unit 103 to stop its operation from target position d to target position e.
[0128] Thus, route tracking control unit 103 performs control to cause wheel loader 1 to travel forward and cause work implement 3 to stop its operation, until target position e is reached from target position d (step S203, Fig. 6). Accordingly, wheel loader 1 is operated to push load 310 in vessel 301 toward center CL of vessel 301. When cutting edge 6a reaches target position e, the load push control is ended.
[0129] When load push determination unit 104 determines in step S202 that it is not necessary to push load 310 in vessel 301, the load push control is ended.<Movement of Load in Vessel 301 by Load Push>
[0130] Next, movement of the load in vessel 301 by the load push is described with reference to Fig. 12 (A) to Fig. 12 (C).
[0131] As shown in Fig. 12 (A), a load 310A is loaded in vessel 301 by loading performed for the first time, and a load 310B is loaded in the vessel by loading performed for the second time. For example, at the time the second loading is completed, load 310 loaded in vessel 301 may be unbalanced.
[0132] If the loading status (load condition) of load 310 in vessel 301 is inappropriate as described above, there is a possibility that load 310 spills from vessel 301 while dump truck 300 is traveling. In order to prevent load 310 from spilling from vessel 301, bucket 6 moves load 310 in vessel 301 toward center CL of vessel 301 in the present embodiment. Thus, in the present embodiment, the control of load push by bucket 6 is performed after the second loading of load 310B is completed, for example.
[0133] As shown in Fig. 12 (B), the load push is performed by moving cutting edge 6a of bucket 6 from the end of vessel 301 toward center CL. In this way, load 310 in vessel 301 is pushed by bucket 6 to move to center CL of vessel 301.
[0134] As shown in Fig. 12 (C), at the time cutting edge 6a reaches target position e, the unbalance of load 310 in vessel 301 has been improved. This prevents load 310 from spilling from vessel 301 while dump truck 300 is traveling.
[0135] After cutting edge 6a reaches target position e, wheel loader 1 travels backward. Thus, bucket 6 moves backward away from dump truck 300 while forming an apex of 310.
[0136] It should be noted that center CL of vessel 301 refers to the center of vessel 301 in the width direction in a cross section of vessel 301 in the direction in which wheel loader 1 travels forward toward vessel 301 during the loading operation (in the cross section shown in Fig. 12 (A) to (C)).<Functions and Effects>
[0137] The following is a summary of characteristic configurations, functions and effects of the present embodiment, a part of which has already been described above.
[0138] In the present embodiment, automation controller 100 (load push determination unit 104) shown in Fig. 4 acquires information about the loading status of load 310 in vessel 301. Automation controller 100 (load push determination unit 104) also determines whether or not it is necessary to push load 310 in vessel 301, based on the information about the loading status of load 310 in vessel 301. When automation controller 100 (load push determination unit 104) determines that it is necessary to move load 310 in vessel 301, automation controller 100 (load push determination unit 104) operates wheel loader 1 to move load 310 toward center CL of vessel 301.
[0139] Thus, load 310 is pushed toward center CL of vessel 301, based on the loading status of load 310 in vessel 301. Therefore, unbalance of load 310 in vessel 301 is improved. This prevents load 310 from spilling from vessel 301 while dump truck 300 is traveling.
[0140] In the present embodiment, when automation controller 100 (load push determination unit 104) shown in Fig. 4 determines it is necessary to move load 310 in vessel 301, automation controller 100 (load push determination unit 104) operates wheel loader 1 to move load 310 toward center CL of vessel 301 by causing travel device 4 to travel forward. Accordingly, it is possible to cause bucket 6 to push load 310 in vessel 301 toward center CL of vessel 301.
[0141] In the present embodiment, when automation controller 100 (load push determination unit 104) shown in Fig. 4 determines it is necessary to move load 310 in vessel 301, automation controller 100 (load push determination unit 104) causes travel device 4 to travel forward while stopping driving the work implement actuator, to thereby operate wheel loader 1 to move load 310 toward center CL of vessel 301. Accordingly, operation control of the work implement actuator while the load is pushed is unnecessary, which makes it possible to simplify operation control.
[0142] In the present embodiment, when automation controller 100 (load push determination unit 104) shown in Fig. 4 determines it is necessary to move load 310 in vessel 301, automation controller 100 (load push determination unit 104) operates wheel loader 1 to move load 310 toward center CL of vessel 301 by causing travel device 4 to travel forward while keeping the height of bucket 6. This eliminates the need to control the height of bucket 6 while the load is pushed, which makes it possible to simplify operation control.
[0143] In the present embodiment, automation controller 100 (load push determination unit 104) shown in Fig. 4 calculates the number of times loading into vessel 301 by work implement 3 is performed, based on the attitude of work implement 3 detected by the work implement attitude sensor, and determines whether or not it is necessary to move load 310 in vessel 301, based on the calculated number of times of loading. This makes it possible to easily determine whether or not it is necessary to push the load, based on the number of times of loading.
[0144] In the present embodiment, automation controller 100 (load push determination unit 104) shown in Fig. 4 determines whether or not it is necessary to move load 310 in vessel 301, based on the loading status of load 310 detected by the object sensor. Accordingly, it can be determined whether or not it is necessary to push the load, in accordance with the actual loading status of load 310 in vessel 301. It is therefore possible to more accurately prevent load 310 from spilling from vessel 301 while dump truck 300 is traveling.<Appendixes>
[0145] The foregoing includes features described in the following.(Appendix 1)
[0146] A work machine including: a main body; a work implement that is attached to the main body and loads a load into a load container; a work implement actuator that drives the work implement with respect to the main body; and a controller that commands the work implement actuator to drive, based on a detected value of a position of the work implement and a detected value of a position of the load container with respect to the work machine, wherein the controller acquires information about a loading status of the load in the load container, determines whether it is necessary to move the load in the load container, based on the acquired information about the loading status of the load, and operates, when determining that it is necessary to move the load in the load container, the work machine to move the load toward a center of the load container. (Appendix 2)
[0147] The work machine according to Appendix 1, wherein the main body includes a travel unit, the work machine further includes a travel sensor that detects a traveling state of the travel unit, and the controller commands the work implement actuator to drive, based on a detected value of the travel sensor and the detected value of the position of the load container with respect to the work machine. (Appendix 3)
[0148] The work machine according to Appendix 2, wherein when the controller determines that it is necessary to move the load in the load container, the controller operates the work machine to move the load toward the center of the load container by causing the travel unit to travel forward.(Appendix 4)
[0149] The work machine according to Appendix 3, wherein when the controller determines that it is necessary to move the load in the load container, the controller operates the work machine to move the load toward the center of the load container by causing the travel unit to travel forward while stopping the work implement actuator from driving.(Appendix 5)
[0150] The work machine according to Appendix 3 or Appendix 4, wherein the work implement includes a bucket, and when the controller determines that it is necessary to move the load in the load container, the controller operates the work machine to move the load toward the center of the load container by causing the travel unit to travel forward while keeping a height of the bucket. (Appendix 6)
[0151] The work machine according to any one of Appendix 1 to Appendix 5, further including a work implement attitude sensor that detects an attitude of the work implement, for determining the loading status of the load, wherein the controller calculates the number of times the work implement has performed loading into the load container, based on the attitude of the work implement detected by the work implement attitude sensor, and determines whether it is necessary to move the load in the load container, based on the calculated number of times.(Appendix 7)
[0152] The work machine according to any one of Appendix 1 to Appendix 5, further including an object sensor that detects the loading status of the load loaded into the load container, for determining the loading status of the load, wherein the controller determines whether it is necessary to move the load in the load container, based on the loading status of the load detected by the object sensor.(Appendix 8)
[0153] A system including a work machine, the system including: a work machine main body; a work implement that is attached to the work machine main body and loads a load into a load container; a work implement actuator that drives the work implement with respect to the work machine main body; and a controller that commands the work implement actuator to drive, based on a detected value of a position of the work implement and a detected value of a position of the load container with respect to the work machine, wherein the controller acquires information about a loading status of the load in the load container, determines whether it is necessary to move the load in the load container, based on the acquired information about the loading status of the load, and operates, when determining that it is necessary to move the load in the load container, the work machine to move the load toward a center of the load container. (Appendix 9)
[0154] A method for controlling a work machine, the method including: acquiring information about a loading status of a load in a load container; determining whether it is necessary to move the load in the load container, based on the acquired information about the loading status of the load; and operating, when determining that it is necessary to move the load in the load container, the work machine to move the load toward a center of the load container.
[0155] It should be construed that the embodiments disclosed herein are given by way of illustration in all respects, not by way of limitation. It is intended that the scope of the present invention is defined by claims, not by the description above, and encompasses all modifications and variations equivalent in meaning and scope to the claims.REFERENCE SIGNS LIST
[0156] 1 wheel loader; 2 vehicular body frame; 2a front frame; 2b rear frame; 3 work implement; 4 travel device; 4a, 4b running wheel; 5 cab; 6 bucket; 6a cutting edge; 6b back surface; 8 operation device; 9 boom pin; 11 steering cylinder; 13 work implement pump; 14 boom; 15 link; 16 boom cylinder; 17 bucket pin; 18 bell crank; 18a support pin; 18b, 18c coupling pin; 19 bucket cylinder; 21 engine; 23 transmission; 25 axle; 32 main valve; 35, 36 electromagnetic proportional control valve; 41 accelerator pedal; 42 work implement operation lever; 50 vehicular body controller; 51 machine monitor; 60 engine controller; 70 transmission controller; 71 brake control unit; 72 accelerator control unit; 80 work implement controller; 81 steering control unit; 82 work implement control unit; 100 automation controller; 101 position estimation unit; 102 path planning unit; 103 route tracking control unit; 104 determination unit; 110 external information acquisition unit; 111 sensing device; 112 position information acquisition device; 120 vehicle information acquisition unit; 121 articulation angle sensor; 122 vehicle speed sensor; 123 boom angle sensor; 124 bucket angle sensor; 125 boom cylinder pressure sensor; 130 interface; 131 automation switch; 132 engine emergency stop switch; 133 mode lamp; 140 actuator; 141 brake EPC; 142 steering EPC; 143 work implement EPC; 144 HMT; 300 dump truck; 301 vessel; 310 load (excavation target).
Claims
1. A work machine comprising: a main body; a work implement that is attached to the main body and loads a load into a load container; a work implement actuator that drives the work implement with respect to the main body; and a controller that commands the work implement actuator to drive, based on a detected value of a position of the work implement and a detected value of a position of the load container with respect to the work machine, wherein the controller acquires information about a loading status of the load in the load container, determines whether it is necessary to move the load in the load container, based on the acquired information about the loading status of the load, and operates, when determining that it is necessary to move the load in the load container, the work machine to move the load toward a center of the load container.
2. The work machine according to claim 1, wherein the main body includes a travel unit, the work machine further comprises a travel sensor that detects a traveling state of the travel unit, and the controller commands the work implement actuator to drive, based on a detected value of the travel sensor and the detected value of the position of the load container with respect to the work machine.
3. The work machine according to claim 2, wherein when the controller determines that it is necessary to move the load in the load container, the controller operates the work machine to move the load toward the center of the load container by causing the travel unit to travel forward.
4. The work machine according to claim 3, wherein when the controller determines that it is necessary to move the load in the load container, the controller operates the work machine to move the load toward the center of the load container by causing the travel unit to travel forward while stopping the work implement actuator from driving.
5. The work machine according to claim 3, wherein the work implement includes a bucket, and when the controller determines that it is necessary to move the load in the load container, the controller operates the work machine to move the load toward the center of the load container by causing the travel unit to travel forward while keeping a height of the bucket.
6. The work machine according to claim 1, further comprising a work implement attitude sensor that detects an attitude of the work implement, for determining the loading status of the load, wherein the controller calculates the number of times the work implement has performed loading into the load container, based on the attitude of the work implement detected by the work implement attitude sensor, and determines whether it is necessary to move the load in the load container, based on the calculated number of times.
7. The work machine according to claim 1, further comprising an object sensor that detects the loading status of the load loaded into the load container, for determining the loading status of the load, wherein the controller determines whether it is necessary to move the load in the load container, based on the loading status of the load detected by the object sensor.
8. A system comprising a work machine, the system comprising: a work machine main body; a work implement that is attached to the work machine main body and loads a load into a load container; a work implement actuator that drives the work implement with respect to the work machine main body; and a controller that commands the work implement actuator to drive, based on a detected value of a position of the work implement and a detected value of a position of the load container with respect to the work machine, wherein the controller acquires information about a loading status of the load in the load container, determines whether it is necessary to move the load in the load container, based on the acquired information about the loading status of the load, and operates, when determining that it is necessary to move the load in the load container, the work machine to move the load toward a center of the load container.
9. A method for controlling a work machine, the method comprising: acquiring information about a loading status of a load in a load container; determining whether it is necessary to move the load in the load container, based on the acquired information about the loading status of the load; and operating, when determining that it is necessary to move the load in the load container, the work machine to move the load toward a center of the load container.