EP4644620A1 - Work machine-including system, work machine controller, and work machine path generation method - Google Patents
Work machine-including system, work machine controller, and work machine path generation methodInfo
- Publication number
- EP4644620A1 EP4644620A1 EP24760169.3A EP24760169A EP4644620A1 EP 4644620 A1 EP4644620 A1 EP 4644620A1 EP 24760169 A EP24760169 A EP 24760169A EP 4644620 A1 EP4644620 A1 EP 4644620A1
- Authority
- EP
- European Patent Office
- Prior art keywords
- excavation
- target
- loading
- work machine
- wheel loader
- 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
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
- E02F3/431—Control of dipper or bucket position; Control of sequence of drive operations for bucket-arms, front-end loaders, dumpers or the like
- E02F3/434—Control of dipper or bucket position; Control of sequence of drive operations for bucket-arms, front-end loaders, dumpers or the like providing automatic sequences of movements, e.g. automatic dumping or loading, automatic return-to-dig
-
- 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/08—Superstructures; Supports for superstructures
- E02F9/0841—Articulated frame, i.e. having at least one pivot point between two travelling gear units
-
- 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/26—Indicating devices
- E02F9/261—Surveying the work-site to be treated
- E02F9/262—Surveying the work-site to be treated with follow-up actions to control the work tool, e.g. controller
Definitions
- the present disclosure relates to a system including a work machine, a controller for a work machine, and a path generation method for a work machine.
- a conventional wheel loader is disclosed in, for example, JP 2022-157259 A (Patent Literature 1).
- Patent Literature 1 JP 2022-157259 A
- a wheel loader repeatedly performs excavation work and loading work.
- a path of traveling by automatic control is required to be appropriately set.
- the present disclosure proposes a system including a work machine, a controller for a work machine, and a path generation method for a work machine by which a path of traveling in a case where excavation and loading work is automatically controlled can be appropriately set.
- a system including a work machine includes a work machine main body including a travel body, a work implement attached to the work machine main body, and a controller that generates a travel path of the travel body.
- An object around the work machine main body includes an excavation target that is a heap of material excavated by the work implement.
- the travel path of the travel body includes an excavation position at which the work machine excavates the excavation target and a loading position in a case where the material is loaded onto a loading target onto which the material is loaded.
- the controller recognizes the excavation target on the basis of a detection result of the sensor, selects the excavation position, and calculates a minimum distance by which the loading position is to be separated from the excavation position by a dimension of the work machine.
- a controller for a work machine generates a travel path of a travel body of a work machine including the travel body and a work implement.
- the travel path of the travel body includes an excavation position at which the work machine excavates an excavation target that is a heap of material excavated by the work implement and a loading position in a case where material is loaded onto a loading target onto which the material is loaded.
- the controller recognizes the excavation target on the basis of a detection result of a sensor that detects an object around a work machine main body.
- the controller selects the excavation position.
- the controller calculates a minimum distance by which the loading position is to be separated from the excavation position by a dimension of the work machine.
- a path generation method for a work machine is a method for generating a travel path of a travel body of a work machine including the travel body and a work implement.
- the travel path of the travel body includes an excavation position at which the work machine excavates an excavation target that is a heap of material excavated by the work implement and a loading position in a case where material is loaded onto a loading target onto which the material is loaded.
- the path generation method includes the following steps. The first step is to recognize the excavation target on the basis of a detection result of a sensor that detects an object around a work machine main body.
- the second step is to select the excavation position.
- the third step is to calculate a minimum distance by which the loading position is to be separated from the excavation position by a dimension of the work machine.
- a path of traveling in a case where excavation and loading work is automatically controlled can be appropriately set.
- a wheel loader 1 will be described as an example of a work machine.
- Fig. 1 is a side view of the wheel loader 1 as an example of a work machine.
- Fig. 2 is a plan view of the wheel loader 1 illustrated in Fig. 1 .
- the wheel loader 1 mainly includes a vehicle body frame 2, a work implement 3, a travel device 4, and a cab 5.
- the vehicle body frame 2, the cab 5, and the like form the vehicle body of the wheel loader 1.
- the work implement 3 and the travel device 4 are attached to the vehicle body of the wheel loader 1.
- the main body of the wheel loader 1 (work machine main body) includes the vehicle body and the travel device 4.
- the travel device 4 causes the vehicle body of the wheel loader 1 to travel, and includes travel wheels 4a and 4b.
- the wheel loader 1 is a wheeled vehicle including the travel wheels 4a and 4b as traveling rotation bodies on both sides of the vehicle body in a left-right direction.
- the wheel loader 1 is self-propelled by rotationally driving the travel wheels 4a and 4b, and can perform desired work using the work implement 3.
- the travel device 4 corresponds to an example of a "travel body".
- a direction in which the wheel loader 1 travels straight is referred to as a front-rear direction of the wheel loader 1.
- a side on which the work implement 3 is disposed with respect to the vehicle body frame 2 is defined as a front direction
- a side opposite to the front direction is defined as a rear direction.
- the left-right direction of the wheel loader 1 is a direction orthogonal to the front-rear direction in a plan view of the wheel loader 1 on a flat ground.
- the right side and the left side in the left-right direction when viewed in the front direction are the right direction and the left direction, respectively.
- the vertical direction of the wheel loader 1 is a direction orthogonal to a plane defined by the front-rear direction and the left-right direction. In the vertical direction, the side with the ground is the lower side, and the side with the sky is the upper side.
- the vehicle body frame 2 includes a front frame 2a and a rear frame 2b.
- the front frame 2a is disposed in front of the rear frame 2b.
- the front frame 2a and the rear frame 2b are attached to each other by a center pin 10 so as to be movable in the left-right direction.
- a pair of left and right steering cylinders 11 is attached across the front frame 2a and the rear frame 2b.
- the steering cylinders 11 are hydraulic cylinders. By the steering cylinders 11 being expanded and contracted by hydraulic oil from a steering pump (not illustrated), the travel direction of the wheel loader 1 is changed to the left and right.
- the front frame 2a and the rear frame 2b form the vehicle body frame 2 including an articulated structure.
- the wheel loader 1 is an articulated work machine in which the front frame 2a and the rear frame 2b are coupled to each other so as to be bendable.
- the work implement 3 and a pair of the travel wheels (front wheels) 4a are attached to the front frame 2a.
- the work implement 3 is attached to the front of the vehicle body of the wheel loader 1.
- the work implement 3 is supported by the vehicle body of the wheel loader 1.
- the work implement 3 is rotatably supported by the vehicle body frame 2, more specifically, the front frame 2a.
- the work implement 3 is disposed in front of the vehicle body frame 2.
- the work implement 3 includes a boom 14.
- a base end portion of the boom 14 is rotatably attached to the front frame 2a by a boom pin 9.
- the boom 14 includes a left boom member 14L and a right boom member 14R.
- the left boom member 14L and the right boom member 14R are joined to each other so as to be unable to relatively move by a joining member that extends in the left-right direction to form the boom 14 including an integrated structure.
- the boom pin 9 includes a pair of a left boom pin 9L and a right boom pin 9R.
- the boom 14 is rotatable with respect to the front frame 2a about the left boom pin 9L and the right boom pin 9R.
- the left boom pin 9L and the right boom pin 9R rotatably support the work implement 3 with respect to the vehicle body frame 2.
- the work implement 3 includes a bucket 6.
- the bucket 6 is disposed at the distal end of the work implement 3.
- the bucket 6 is a work tool for excavation and loading.
- a blade edge 6a is a distal end portion of the bucket 6.
- a back surface 6b is a part of the outer surface of the bucket 6.
- the back surface 6b includes a flat surface.
- the back surface 6b extends rearward from the blade edge 6a.
- the bucket 6 is rotatably attached to the boom 14 by a bucket pin 17 located at a distal end of the boom 14.
- the bucket 6 includes a left boom attachment portion to which the left boom member 14L is attached and a right boom attachment portion to which the right boom member 14R is attached.
- the work implement 3 further includes a bell crank 18 and a link 15.
- a substantially central portion of the bell crank 18 is rotatably supported by the boom 14 by a support pin 18a located substantially at the center of the boom 14 in the longitudinal direction.
- the link 15 is coupled to a coupling pin 18c included at the lower end (distal end portion) of the bell crank 18.
- the link 15 couples the bell crank 18 and the bucket 6.
- the bell crank 18 and the link 15 are disposed between the left boom member 14L and the right boom member 14R in the left-right direction.
- the front frame 2a and the boom 14 are coupled by a pair of boom cylinders 16.
- the boom cylinders 16 are hydraulic cylinders.
- the boom cylinders 16 drive the boom 14 to rotate up and down about the boom pin 9.
- the base ends of the boom cylinders 16 are attached to the front frame 2a.
- the distal ends of the boom cylinders 16 are attached to the boom 14.
- the boom cylinders 16 are hydraulic actuators that move the boom 14 up and down with respect to the front frame 2a. As the boom 14 ascends and descends, the bucket 6 attached to the distal end of the boom 14 also ascends and descends.
- a bucket cylinder 19 couples the bell crank 18 and the front frame 2a.
- the base end of the bucket cylinder 19 is attached to the front frame 2a.
- the distal end of the bucket cylinder 19 is attached to a coupling pin 18b included at the upper end portion (base end portion) of the bell crank 18.
- the bucket cylinder 19 is a hydraulic actuator that rotates the bucket 6 up and down with respect to the boom 14.
- the bucket cylinder 19 is a work tool cylinder that drives the bucket 6.
- the bucket cylinder 19 rotationally drives the bucket 6 around the bucket pin 17.
- the bucket 6 is formed to be operable with respect to the boom 14.
- the bucket 6 is formed to be operable with respect to the front frame 2a.
- the boom cylinders 16 and the bucket cylinder 19 form a work implement actuator that drives the work implement 3.
- the cab 5 on which the operator boards and a pair of the travel wheels (rear wheels) 4b are attached to the rear frame 2b.
- the box-shaped cab 5 is disposed behind the boom 14.
- the cab 5 is mounted on the rear frame 2b.
- the cab 5 is placed on the vehicle body frame 2.
- a seat on which the operator of the wheel loader 1 sits, an operation device 8 to be described below, and the like are disposed.
- a perception device 111 is included on the cab 5.
- the perception device 111 is disposed, for example, on a ceiling of the cab 5.
- the perception device 111 is mounted on, for example, an upper surface of the cab 5.
- the perception device 111 is disposed, for example, on a front portion of the cab 5.
- the perception device 111 is attached to the cab 5 facing forward, for example, and can acquire information of the front of the cab 5. Details of the perception device 111 will be described below.
- a length L1 illustrated in Fig. 1 is a length from the blade edge 6a of the bucket 6 to the rear end of the vehicle body (total length of the wheel loader 1) in the front-rear direction.
- a length L2 is a length from the front end of the front wheel 4a to the rear end of the vehicle body in the front-rear direction (vehicle body length of the wheel loader 1).
- a length L3 is a length (wheelbase length) from the center of the front wheel 4a to the center of the rear wheel 4b in the front-rear direction.
- a length L4 is a length from the center of the front wheel 4a to the bending center of the front frame 2a and the rear frame 2b in the front-rear direction.
- a length L5 is a length from the bending center of the front frame 2a and the rear frame 2b to the center of the rear wheel 4b in the front-rear direction.
- a length L9 illustrated in Fig. 2 is a length (bucket width) from the left end to the right end of the bucket 6 in the left-right direction.
- a width direction center 6c of the bucket 6 is a center point of the bucket 6 in the left-right direction.
- Lengths L1 to L5 and L9 illustrated in Figs. 1 and 2 are included in a specification value of the wheel loader 1.
- the specification value of the wheel loader 1 further includes a minimum turning radius of the vehicle body.
- the wheel loader 1 includes an articulated structure in which the front frame 2a and the rear frame 2b are bendable from each other, so that the minimum turning radius of the vehicle body is smaller as compared to a rigid structure.
- the specification value of the wheel loader 1 is a value unique to each individual of the wheel loader 1, and is stored in a vehicle body controller 50 to be described below.
- the wheel loader 1 executes excavation and loading work of scooping material into the bucket 6 and loading the material in the bucket 6 onto a loading target such as a dump truck.
- the material is earth, sand, rock, ore, or the like excavated at a work site or carried into the work site by a carrying machine such as a dump truck.
- Fig. 3 is a view for describing excavation and loading work by the wheel loader 1 according to the embodiment.
- Fig. 3(A) illustrates the wheel loader 1 that performs unloaded advancing.
- the wheel loader 1 travels forward toward an excavation target 200 that is a heap of material.
- the boom cylinders 16 and the bucket cylinder 19 are operated so that the work implement 3 is in an excavation posture in which the distal end of the boom 14 is at a low position and the bucket 6 is oriented horizontally.
- Figs. 3(B) and 3(C) illustrate the wheel loader 1 performing excavation work.
- the wheel loader 1 thrusts the blade edge 6a of the bucket 6 into the excavation target 200, and stops forward travel.
- the blade edge 6a of the bucket 6 bites into the excavation target 200 by an excavation (thrusting) operation illustrated in Fig. 3(B) .
- an excavation (scooping) operation of scooping the excavation target 200 into the bucket 6 illustrated in Fig. 3(C) is executed.
- the excavation (scooping) operation may be completed only by tilting back the bucket 6 once.
- the operation of tilting back, neutralizing, and tilting back the bucket 6 again may be repeated.
- Fig. 3(D) illustrates the wheel loader 1 that performs loaded backing.
- the wheel loader 1 travels backward with the excavation target 200 loaded in the bucket 6.
- the wheel loader 1 may raise the bucket 6 while traveling backward.
- Fig. 3(E) illustrates the wheel loader 1 that performs loaded advancing.
- the wheel loader 1 travels forward toward a loading target 300 while raising the bucket 6 or maintaining a state in which the bucket 6 is raised.
- the wheel loader 1 approaches the loading target 300 until the bucket 6 reaches a predetermined position located substantially directly above the loading platform of the loading target 300.
- Fig. 3(F) illustrates the wheel loader 1 that performs a soil discharging operation to the loading target 300.
- the wheel loader 1 When the wheel loader 1 approaches the loading target 300 and reaches a predetermined position, the wheel loader 1 dumps the bucket 6 and loads the material in the bucket 6 onto the loading target 300. Thereafter, the wheel loader 1 lowers the boom 14 to return the work implement 3 to the excavation posture while traveling backward to the position at which the forward travel is started in Fig. 3(E) .
- the above is a typical operation included in one cycle of the excavation and loading work.
- the wheel loader 1 repeatedly performs the plurality of operations described above in sequence, excavates the excavation target 200, and loads the excavated material onto the loading target 300 such as a dump truck.
- the wheel loader 1 When excavating the excavation target 200 illustrated in Figs. 3(B) and 3(C) , the wheel loader 1 takes a straight posture in which the front frame 2a and the rear frame 2b are not bent from each other. When loading the material in the bucket 6 illustrated in Fig. 3(F) onto the loading target 300, the wheel loader 1 takes a straight posture in which the front frame 2a and the rear frame 2b are not bent from each other.
- Fig. 4 is a block diagram illustrating a schematic configuration of a control system that controls the wheel loader 1.
- An engine 21 is a driving source that generates a driving force for driving the work implement 3 and the travel device 4, and is, for example, a diesel engine.
- a driving source instead of the engine 21, a motor driven by a power storage body may be used, or both the engine and the motor may be used.
- the output of the engine 21 is controlled by adjusting the amount of fuel injected into the cylinder of the engine 21.
- the driving force generated by the engine 21 is transmitted to a transmission 23.
- the transmission 23 shifts the driving force to an appropriate torque and rotational speed.
- An axle 25 is connected to an output shaft of the transmission 23.
- the driving force shifted by the transmission 23 is transmitted to the axle 25.
- the driving force is transmitted from the axle 25 to the travel wheels 4a and 4b ( Figs. 1 and 2 ).
- the wheel loader 1 travels.
- both the travel wheel 4a and the travel wheel 4b form driving wheels that receive a driving force and cause the wheel loader 1 to travel.
- the work implement pump 13 is a hydraulic pump that is driven by the engine 21 and operates the work implement 3 by discharged hydraulic oil.
- the work implement 3 is driven by hydraulic oil from the work implement pump 13.
- the hydraulic oil discharged from the work implement pump 13 is supplied to the boom cylinders 16 and the bucket cylinder 19 via a main valve 32.
- the boom cylinders 16 expand and contract by receiving the supply of the hydraulic oil, the boom 14 moves up and down.
- the bucket cylinder 19 receives the supply of the hydraulic oil and expands and contracts, the bucket 6 rotates up and down.
- the wheel loader 1 includes the vehicle body controller 50.
- the vehicle body controller 50 includes an engine controller 60, a transmission controller 70, and a work implement controller 80.
- the vehicle body controller 50 is generally implemented by reading various programs by a central processing unit (CPU).
- the vehicle body controller 50 includes a memory (not illustrated).
- the memory functions as a work memory and stores various programs for implementing the function of the wheel loader 1.
- the operation device 8 is included in the cab 5.
- the operation device 8 is operated by the operator.
- the operation device 8 includes a plurality of types of operation members operated by the operator to operate the wheel loader 1.
- the operation device 8 includes an accelerator pedal 41 and a work implement operation lever 42.
- the operation device 8 may include a steering wheel, a shift lever, and the like (not illustrated).
- the accelerator pedal 41 is operated to set a target rotation speed of the engine 21.
- the engine controller 60 controls the output of the engine 21 on the basis of the operation amount of the accelerator pedal 41.
- the operation amount (depression amount) of the accelerator pedal 41 is increased, the output of the engine 21 is increased.
- the operation amount of the accelerator pedal 41 is reduced, the output of the engine 21 is reduced.
- the transmission controller 70 controls the transmission 23 on the basis of the operation amount of the accelerator pedal 41.
- the work implement operation lever 42 is operated to operate the work implement 3.
- the work implement controller 80 controls electromagnetic proportional control valves 35 and 36 on the basis of the operation amount of the work implement operation lever 42.
- the electromagnetic proportional control valve 35 contracts the bucket cylinder 19 to switch the main valve 32 such that the bucket 6 moves in the dumping direction (direction in which the blade edge of the bucket 6 is lowered). Furthermore, the electromagnetic proportional control valve 35 extends the bucket cylinder 19 to switch the main valve 32 such that the bucket 6 moves in the tilting direction (direction in which the blade edge of the bucket 6 is raised).
- the electromagnetic proportional control valve 36 contracts the boom cylinders 16 to switch the main valve 32 such that the boom 14 is lowered. Furthermore, the electromagnetic proportional control valve 36 extends the boom cylinders 16 to switch the main valve 32 such that the boom 14 is raised.
- a machine monitor 51 receives input of an instruction signal from the vehicle body controller 50 and displays various types of information.
- the various types of information displayed on the machine monitor 51 may be, for example, information regarding work executed by the wheel loader 1, vehicle 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 the wheel loader 1, and the like.
- the machine monitor 51 may be a touch panel, and in this case, a signal generated by the operator touching a part of the machine monitor 51 is output from the machine monitor 51 to the vehicle body controller 50.
- FIG. 5 is a block diagram illustrating a configuration of an automatic control system of the wheel loader 1.
- An automation controller 100 is formed to be able to transmit and receive signals to and from the vehicle body controller 50 described with reference to Fig. 4 .
- the automation controller 100 is also formed to be able to transmit and receive signals to and from an external information acquisition unit 110.
- the external information acquisition unit 110 includes the perception device 111 and a position information acquisition device 112.
- the perception device 111 and the position information acquisition device 112 are mounted on the wheel loader 1.
- the perception device 111 acquires information of the surroundings of the wheel loader 1.
- the perception device 111 is attached to a front portion of the upper surface of the cab 5, for example.
- the perception device 111 corresponds to an example of an "object sensor" that detects an object around the main body of the wheel loader 1 (work machine main body).
- the perception device 111 detects a direction of an object outside the wheel loader 1 and a distance to the object in a non-contact manner.
- the perception device 111 is, for example, a light detection and ranging (LiDAR) that emits laser light and acquires information of an object.
- the perception device 111 may be a visual sensor including a camera.
- the perception device 111 may be a radio detection and ranging (Radar) that acquires information of an object by emitting radio waves.
- the perception device 111 may be an infrared sensor.
- the position information acquisition device 112 acquires information of the current position of the wheel loader 1.
- the position information acquisition device 112 acquires position information of the wheel loader 1 in a global coordinate system with reference to the earth using, for example, a satellite positioning system.
- the position information acquisition device 112 uses, for example, global navigation satellite systems (GNSS), and includes a GNSS receiver.
- GNSS global navigation satellite systems
- the satellite positioning system calculates the position of the antenna of the GNSS receiver from a positioning signal received by the GNSS receiver from a satellite to calculate the position of the wheel loader 1.
- External information of the wheel loader 1 by the perception device 111 and the position information of the wheel loader 1 by the position information acquisition device 112 are input to the automation controller 100.
- the vehicle body controller 50 is formed to be able to transmit and receive signals to and from a vehicle information acquisition unit 120, and receives input of information of the wheel loader 1 acquired by the vehicle information acquisition unit 120.
- the vehicle information acquisition unit 120 includes various sensors mounted on the wheel loader 1.
- the 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.
- the articulation angle sensor 121 detects an articulation angle that is an angle formed by the front frame 2a and the rear frame 2b, and generates a signal of the detected articulation angle.
- the articulation angle sensor 121 outputs the signal of the articulation angle to the vehicle body controller 50.
- the vehicle speed sensor 122 detects the moving speed of the wheel loader 1 by the travel device 4, for example, by detecting the rotation speed of the output shaft of the transmission 23, and generates a signal of the detected vehicle speed.
- the vehicle speed sensor 122 outputs the signal of the vehicle speed to the vehicle body controller 50.
- the vehicle speed sensor 122 corresponds to an example of a travel sensor that detects a traveling status of the travel device 4 (travel body).
- the boom angle sensor 123 includes, for example, a rotary encoder included in the boom pin 9 that is an attachment portion of the boom 14 to the vehicle body frame 2.
- the boom angle sensor 123 detects an angle of the boom 14 with respect to the horizontal direction (boom angle), and generates a signal indicating the detected angle of the boom 14.
- the boom angle sensor 123 outputs the signal of the angle of the boom 14 to the vehicle body controller 50.
- the bucket angle sensor 124 includes, for example, a rotary encoder included in the support pin 18a that is a rotation shaft of the bell crank 18.
- the bucket angle sensor 124 detects an angle of the bell crank 18 with respect to the boom 14 (bell crank angle), and generates a signal of the detected angle of the bell crank 18.
- the vehicle information acquisition unit 120 or the vehicle body controller 50 calculates an angle of the bucket 6 (bucket angle) with respect to the boom 14 from the detected angle of the bell crank 18.
- the boom angle sensor 123 and the bucket angle sensor 124 correspond to an example of a work implement posture sensor that detects the posture of the work implement 3.
- the boom angle sensor 123 may be a stroke sensor disposed on the boom cylinder 16.
- the bucket angle sensor 124 may be a potentiometer or a proximity switch attached to the bucket pin 17, or may be a stroke sensor disposed on the bucket cylinder 19.
- the boom cylinder pressure sensor 125 detects pressure on the bottom side (boom bottom pressure) of the boom cylinder 16, and generates a signal of the detected boom bottom pressure.
- the boom bottom pressure increases in a case where a load is loaded on the bucket 6, and decreases in a case where the load is empty.
- the boom cylinder pressure sensor 125 outputs the signal of the boom bottom pressure to the vehicle body controller 50.
- the vehicle body controller 50 outputs information input from the vehicle information acquisition unit 120 to the automation controller 100.
- the automation controller 100 receives detection values of the vehicle speed sensor 122, the boom angle sensor 123, and the bucket angle sensor 124 via the vehicle body controller 50.
- An actuator 140 is formed to be able to transmit and receive signals to and from the vehicle body controller 50.
- the actuator 140 is driven upon receiving an instruction signal from the vehicle body controller 50.
- the actuator 140 includes a brake electromagnetic proportional control valve (EPC) 141 for operating the brake of the travel device 4, a steering EPC 142 for adjusting the traveling direction of the wheel loader 1, a work implement EPC 143 for operating the work implement 3, and a hydraulic mechanical transmission (HMT) 144.
- EPC brake electromagnetic proportional control valve
- HMT hydraulic mechanical transmission
- the electromagnetic proportional control valves 35 and 36 illustrated in Fig. 4 form the work implement EPC 143.
- the transmission 23 illustrated in Fig. 4 is implemented as the HMT 144 utilizing electronic control.
- the transmission 23 may be a hydro-static transmission (HST).
- a power transmission device that transmits power from the engine 21 to the travel wheels 4a and 4b may include an electric drive device of a diesel electric type or the like, or may include any combination of the HMT, the HST, and the electric drive device.
- the transmission controller 70 includes a brake control unit 71 and an accelerator control unit 72.
- the brake control unit 71 outputs an instruction signal for controlling the operation of the brake to the brake EPC 141.
- the accelerator control unit 72 outputs an instruction signal for controlling the vehicle speed to the HMT 144.
- the work implement controller 80 includes a steering control unit 81 and a work implement control unit 82.
- the steering control unit 81 outputs an instruction signal for controlling the traveling direction of the wheel loader 1 to the steering EPC 142.
- the work implement control unit 82 outputs an instruction signal for controlling the operation of the work implement 3 to the work implement EPC 143.
- the automation controller 100 includes a position estimation unit 101, a path planning unit 102, and a path follow-up control unit 103.
- the position estimation unit 101 estimates the self-position of the wheel loader 1 on the basis of the position information acquired by the position information acquisition device 112. Furthermore, the position estimation unit 101 recognizes a target position on the basis of the external information acquired by the perception device 111.
- the target position is, for example, an excavation position in the excavation target 200 at which the wheel loader 1 excavates the excavation target 200 using the bucket 6. Further, for example, the target position is a loading position in the loading target 300 that is a relative position of the work implement 3 (bucket 6) with respect to the loading target 300 when material is loaded onto the loading target 300.
- the perception device 111 may recognize and input a target position to the automation controller 100, and the position estimation unit 101 may recognize a target position on the basis of the detection result detected by the perception device 111.
- the path planning unit 102 generates an optimum path of the wheel loader 1 in a case where the wheel loader 1 is automatically controlled.
- the optimum path includes a path of traveling by the travel device 4 and a path of operation of the work implement 3.
- the path planning unit 102 generates a path of traveling of the wheel loader 1 that performs unloaded advancing toward the excavation target 200.
- the path planning unit 102 generates a path of the operation of the work implement 3 in excavation work.
- the path planning unit 102 generates a path of traveling of the wheel loader 1 that performs loaded backing to be separated from the excavation target 200 and a path of operation of the work implement 3 that is performing loaded backing.
- the path planning unit 102 generates a path of traveling of the wheel loader 1 that performs loaded advancing toward the loading target 300 and a path of operation of the work implement 3 that is performing loaded advancing.
- the path planning unit 102 generates a path of operation of the work implement 3 that discharges material scooped into the bucket 6 to the loading target 300.
- the path planning unit 102 generates a path of traveling of the wheel loader 1 that performs unloaded backing to be separated from the loading target 300 and a path of operation of the work implement 3 that is performing unloaded backing.
- the path planning unit 102 also generates an optimum path that connects the current self-position of the wheel loader 1 and a target position to which the wheel loader 1 is heading while executing the excavation and loading work.
- the path follow-up control unit 103 gives an instruction of operation of the travel device 4 and the work implement 3.
- the path follow-up control unit 103 controls the accelerator, the brake, and the steering such that the wheel loader 1 travels following the optimum path generated by the path planning unit 102.
- An instruction signal for causing the wheel loader 1 to travel along the optimum path is output from the path follow-up control unit 103 to the brake control unit 71, the accelerator control unit 72, and the steering control unit 81.
- the path follow-up control unit 103 controls the boom cylinders 16 and the bucket cylinder 19 such that the work implement 3 operates along the optimum path generated by the path planning unit 102.
- An instruction signal for moving the work implement 3 along the optimum path is output from the path follow-up control unit 103 to the work implement control unit 82.
- An interface 130 is formed to be able to transmit and receive signals to and from the vehicle body controller 50.
- the interface 130 includes an automation switching switch 131, an engine emergency stop switch 132, and a mode lamp 133.
- the automation switching switch 131 is operated by the operator.
- the operator operates the automation switching switch 131 to switch between manually operating the wheel loader 1 and automatically controlling the wheel loader 1.
- the engine emergency stop switch 132 is operated by the operator. In a case where an event that requires emergency stop of the engine 21 occurs, the operator operates the engine emergency stop switch 132. Operation signals of the automation switching switch 131 and the engine emergency stop switch 132 are input to the vehicle body controller 50.
- the mode lamp 133 displays whether the wheel loader 1 is currently in a mode of being manually operated by the operator or in a mode of being automatically controlled.
- An instruction signal for controlling lighting of the lamp is output from the vehicle body controller 50 to the mode lamp 133.
- the automation controller 100 is also formed to be able to transmit and receive signals to and from a communication device 150.
- the automatic control system of the wheel loader 1 is formed to be able to gives an instruction of information held by the automation controller 100 to the loading target 300 such as a dump truck via the communication device 150.
- the dump truck as an example of the loading target 300 includes a vessel 301.
- the vessel 301 is an example of a container in which material loaded on the work implement 3 (bucket 6) is loaded.
- Fig. 6 is a schematic view of the vessel 301 of the dump truck as viewed from the side.
- Fig. 6 and subsequent Fig. 9 a schematic shape of the vessel 301 viewed from the left side of the dump truck is illustrated.
- a thick line in the drawing indicates a schematic shape when a surface that forms the internal shape of the vessel 301 is viewed from the left side of the dump truck.
- the left-right direction in the drawings corresponds to the front-rear direction of the dump truck (front-rear direction of the vessel 301).
- the left direction in the drawing is the front direction of the dump truck (vessel 301), and the right direction in the drawing is the rear direction of the dump truck (vessel 301).
- the direction perpendicular to the drawing corresponds to the left-right direction of the dump truck (left-right direction of the vessel 301).
- the vertical direction in the drawing corresponds to the vertical direction of the dump truck (vertical direction of the vessel 301).
- the vessel 301 is included at a rear portion of the dump truck.
- a cab is included in front of the dump truck, and the vessel 301 is disposed behind the cab.
- the vessel 301 includes a structure in which heavy material including earth and sand, crushed stones, and the like can be loaded.
- the vessel 301 includes a bottom surface 302, a front wall surface 303, and a rear inclined surface 305.
- the bottom surface 302 has a flat shape.
- the bottom surface 302 has a planar shape that extends in the front-rear direction and the left-right direction of the dump truck (vessel 301).
- the front wall surface 303 has a flat shape.
- the front wall surface 303 extends forward and upward from the front end of the bottom surface 302.
- the front wall surface 303 extends upward, being inclined toward the front.
- the front wall surface 303 forms a front wall surface of the vessel 301.
- the wall surface in front of the vessel 301 is inclined upward toward the front.
- the front wall surface 303 includes a front upper edge 304.
- the front upper edge 304 extends in the left-right direction.
- the front upper edge 304 forms a front edge of the vessel 301.
- the rear inclined surface 305 has a flat shape.
- the rear inclined surface 305 extends rearward and upward from the rear end of the bottom surface 302.
- the rear inclined surface 305 extends upward, being inclined toward the rear.
- the rear inclined surface 305 is inclined upward toward the rear.
- the rear inclined surface 305 includes a rear upper edge 306.
- the rear upper edge 306 extends in the left-right direction.
- the rear upper edge 306 forms a rear edge of the vessel 301.
- the rear upper edge 306 is located lower than the front upper edge 304.
- Fig. 6 illustrates a shape of the vessel 301 without a tailgate.
- the tailgate is disposed to extend upward from the rear end of the rear inclined surface 305.
- the upper edge of the tailgate forms the rear upper edge 306.
- Fig. 7 is a schematic view illustrating a travel path of the wheel loader 1 that performs the excavation and loading work.
- Fig. 8 is a flowchart illustrating a flow of processing of generating a travel path of the wheel loader 1.
- the excavation target 200 illustrated in Fig. 7 is a heap of material excavated by the bucket 6 of the wheel loader 1.
- the excavation target 200 may be a heap of material accumulated in a material accumulation place such as a stockyard.
- the excavation target 200 may be a heap of material formed in a vacant lot.
- the excavation target 200 includes a top portion 201 having the highest heap height and a skirt 202 on a front side (side on which the wheel loader 1 excavates the excavation target 200. A lower side in Fig. 7 ).
- the skirt 202 is schematically illustrated linearly.
- the heap height of the excavation target 200 is not uniform, and the heap height gradually decreases from the top portion 201 toward the skirt 202.
- the excavation target 200 includes a low heap area 203 in which the accumulation amount of material is small and the heap height is low, and an accumulation area 204 in which the accumulation amount of material is larger than the low heap area 203 and the heap height is higher than the low heap area 203.
- step S21 the perception device 111 mounted on the wheel loader 1 detects the excavation target 200.
- the object around the wheel loader 1 detected by the perception device 111 includes the excavation target 200.
- the perception device 111 inputs the detection result of the excavation target 200 to the position estimation unit 101 of the automation controller 100.
- the position estimation unit 101 recognizes the position and shape of a heap of material that is the excavation target 200 on the basis of the detection result of the perception device 111.
- the path planning unit 102 of the automation controller 100 selects an excavation position B2 on the basis of the shape of the excavation target 200.
- a position to which the width direction center 6c ( Fig. 2 ) of the bucket 6 to be directed in the extending direction of the skirt 202 of the excavation target 200 (left-right direction in Fig. 7 ) when the wheel loader 1 excavates the excavation target 200 is defined as the excavation position B2.
- the path planning unit 102 can select, as the excavation position B2, a distance that can minimize a travel distance by which the wheel loader 1 that excavates the excavation target 200 advances toward the excavation target 200 so as to scoop material into the bucket 6 and load a certain amount of the material onto the work implement 3, typically, so as to fully load the material into the bucket 6.
- the excavation target 200 includes the low heap area 203 and the accumulation area 204 in the vicinity of the skirt 202.
- the wheel loader 1 can scoop more material into the bucket 6 with a short travel distance by traveling forward toward the accumulation area 204 and excavating the excavation target 200 rather than traveling forward toward the low heap area 203 and excavating the excavation target 200.
- the wheel loader 1 travels forward toward the accumulation area 204 and excavates the excavation target 200, so that the bucket 6 can be filled with the material at a position closer to the skirt 202. Therefore, the path planning unit 102 can select a substantially central position of the accumulation area 204 in the extending direction of the skirt 202 as the excavation position B2.
- the path planning unit 102 determines an angle ⁇ 2 formed by the skirt 202 of the excavation target 200 and the left side surface of the vessel 301 of the loading target 300.
- the angle ⁇ 2 can be determined to be any angle.
- the angle ⁇ 2 may be a 60° angle that is desirable for the excavation and loading work.
- the angle ⁇ 2 may be determined to be another angle different from 60° according to the situation of a work site or the surrounding environment.
- step S24 the path planning unit 102 determines a distance by which a loading position A2 that is a relative position of the work implement 3 (bucket 6) with respect to the loading target 300 when material is loaded onto the loading target 300 in the loading target 300 such as a dump truck is separated from the skirt 202 of the excavation target 200.
- a loading position A2 that is a relative position of the work implement 3 (bucket 6) with respect to the loading target 300 when material is loaded onto the loading target 300 in the loading target 300 such as a dump truck is separated from the skirt 202 of the excavation target 200.
- Fig. 9 is a schematic diagram illustrating an example of the loading position A2 with respect to the vessel 301.
- Fig. 9 schematically illustrates the vessel 301 viewed from the left side of the loading target 300.
- Fig. 9 also schematically illustrates the bucket 6 viewed from the rear of the wheel loader 1 (viewed in the front direction).
- the bucket 6 includes the blade edge 6a that extends in the width direction.
- a center point 6aC is a center point of the blade edge 6a in the width direction of the bucket 6.
- the bucket 6 illustrated in Fig. 9 is in a full dump posture.
- the bucket 6 in the posture illustrated in Fig. 9 moves in the dumping direction to the maximum.
- the cylinder stroke length of the bucket cylinder 19 is minimized.
- the wheel loader 1 travels forward from the side (left side) of the loading target 300 toward the vessel 301 and performs the loading work.
- the width direction of the bucket 6 during the loading work coincides with the front-rear direction (in Fig. 9 , left-right direction in the drawing) of the loading target 300 (vessel 301). Since the wheel loader 1 takes a straight posture during the loading work, the left-right direction of the wheel loader 1 coincides with the width direction of the bucket 6.
- Fig. 9 illustrates material M loaded from the bucket 6 onto the vessel 301 of the loading target 300.
- the path planning unit 102 recognizes the position of the upper end of the left side surface of the vessel 301 corresponding to the center point 6aC of the blade edge 6a of the bucket 6 in the front-rear direction of the loading target 300 in a case where the material M loaded onto the vessel 301 does not spill from the vessel 301 as the loading position A2.
- the loading position A2 is set as a position at which the right end of the bucket 6 is separated from the rear upper edge 306 of the vessel 301 by a predetermined distance when the bucket 6 in the full dump posture is viewed from the rear of the wheel loader 1 (viewed in the forward direction).
- the relative position of the right end of the bucket 6 with respect to the center point 6aC of the blade edge 6a is calculated from the dimension in the width direction of the bucket 6. In a case where the bucket 6 is at the loading position A2, the right end of the bucket 6 is separated forward from the rear upper edge 306 by a predetermined distance in the front-rear direction of the loading target 300.
- the path planning unit 102 determines the loading position A2 at a position at which the material M does not spill from the vessel 301 when the material M is loaded onto the vessel 301 at the angle of repose.
- the angle of repose 30° of sand can be used for determining the loading position A2 such that the angle formed by the material M with respect to the front-rear direction of the loading target 300 at the rear upper edge 306 ( Fig. 6 ) is 30° or less.
- the path planning unit 102 determines a distance by which the loading position A2 is separated from the excavation target 200 such that the loading target 300 does not interfere with the excavation target 200 and the wheel loader 1 that travels toward the loading position A2 and loads the material in the bucket 6 onto the loading target 300 at the loading position A2 does not interfere with the excavation target 200.
- the path planning unit 102 determines a distance between the loading position A2 and the skirt 202 in a direction orthogonal to the linearly extending skirt 202.
- the path planning unit 102 determines a distance between the loading position A2 and the skirt 202 in the traveling direction (vertical direction in Fig. 7 ) of the wheel loader 1 traveling straight toward the excavation target 200.
- step S25 the path planning unit 102 determines, from the specification value of the wheel loader 1, the loading position A2 at which V-shape traveling can be performed without stationary steering in which steering is performed while the wheel loader 1 is stopped.
- the V-shape traveling is a typical path of traveling in a case where the wheel loader 1 performs the excavation and loading work, and the travel path of the wheel loader 1 has a V-shape.
- the travel path is assumed to be efficient since the travel distance of the wheel loader 1 is minimized.
- the wheel loader 1 is switched from forward movement to backward movement, and performs loaded backing.
- the wheel loader 1 is switched from backward movement to forward movement, and performs loaded advancing toward the loading position A2 of the loading target 300.
- a position at which the operation of the wheel loader 1 is switched from the loaded backing to the loaded advancing is referred to as a turning-back position.
- the wheel loader 1 that performs the loaded backing may travel straight from the excavation target 200 to the turning-back position.
- At least a part of the path on which the wheel loader 1 that performs the loaded advancing travels toward the loading position A2 of the loading target 300 may have a curved shape, typically an arc shape.
- the specification value of the wheel loader 1 includes the lengths L1 to L5 and L9 of respective parts of the wheel loader 1 described with reference to Figs. 1 and 2 .
- the length L1 is the total length of the wheel loader 1, and is the dimension of the wheel loader 1 in the front-rear direction.
- the specification value of the wheel loader 1 also includes a minimum radius in which the wheel loader 1 can turn without stationary steering.
- the wheel loader 1 When loading the material in the bucket 6 onto the vessel 301 of the loading target 300, the wheel loader 1 takes a straight posture in which the front frame 2a and the rear frame 2b are not bent from each other. When loading the material in the bucket 6 onto the vessel 301 of the loading target 300, the wheel loader 1 adjusts the position and posture of the work implement 3 (bucket 6) to the vessel 301 of the loading target 300. Specifically, the wheel loader 1 takes a posture in which the width direction of the bucket 6 coincides with the front-rear direction of the loading target 300 and the width direction center 6c ( Fig. 2 ) of the bucket 6 is adjusted to the loading position A2.
- the path planning unit 102 can set a position at which the center point 6aC ( Fig. 9 ) of the blade edge 6a of the bucket 6 is separated by the length L1 from the excavation position B2 on the skirt 202 of the excavation target 200 as a turning-back position T.
- the dimension of the wheel loader 1 for determining the turning-back position T is not limited to the length L1.
- the work implement 3 can change its posture with respect to the vehicle body of the wheel loader 1, and the length L1 may vary with movement of the work implement 3.
- the length L1 may vary by replacing the bucket 6.
- the length L2 that is an example of the main body dimension of the wheel loader 1 is a dimension in the front-rear direction of the wheel loader 1, and is a constant dimension regardless of the work implement 3.
- the path planning unit 102 may determine the turning-back position T on the basis of the length L2.
- the path planning unit 102 sets a curved path P starting from the width direction center 6c of the bucket 6 in a case where the wheel loader 1 is at the turning-back position T.
- the path planning unit 102 sets the path P in which the width direction of the bucket 6 coincides with the front-rear direction of the loading target 300 that stops at the angle ⁇ 2 with respect to the skirt 202 of the excavation target 200 when the width direction center 6c of the bucket 6 reaches a position separated from the skirt 202 of the excavation target 200 by the distance determined in step S24,.
- the path planning unit 102 sets the path P such that the wheel loader 1 traveling along the path P can turn without stationary steering.
- the wheel loader 1 that travels along the path P turns in a turning radius larger than a minimum radius in which the wheel loader 1 can turn without stationary steering.
- the path P is a trajectory followed by the width direction center 6c of the bucket 6 in a case where the wheel loader 1 turns in a turning radius in which the wheel loader 1 can turn without stationary steering.
- the path planning unit 102 confirms that the wheel loader 1 traveling along the path P can travel without stationary steering.
- the path planning unit 102 determines the end point of the path P in a case where the turning-back position T as a start point as the loading position A2.
- the wheel loader 1 that performs loaded advancing from the turning-back position T to the loading position A2 along the path P can turn without stationary steering, and can appropriately adjust the position and posture of the work implement 3 (bucket 6) to the vessel 301 of the loading target 300 at the loading position A2.
- the distance between the turning-back position T and the loading position A2 in the left-right direction of the loading target 300 that stops at the angle ⁇ 2 with respect to the skirt 202 of the excavation target 200 may be the length L1 that is the total length of the wheel loader 1.
- step S26 the path planning unit 102 calculates a distance x2 in the extending direction of the skirt 202 of the excavation target 200 (left-right direction in Fig. 7 ) corresponding to the loading position A2 determined in step S25.
- the path planning unit 102 can set a distance from the turning-back position T to the loading position A2 in the extending direction of the skirt 202 of the excavation target 200 as the distance x2.
- the excavation position B2 and the loading position A2 are separated from each other by the distance x2 in the extending direction of the skirt 202.
- the distance x2 is set as the minimum distance by which the loading position A2 determined as the position at which material is loaded onto the loading target 300 is to be separated from the excavation position B2 at which the wheel loader 1 excavates the excavation target 200.
- the path planning unit 102 selects a loading position Ax at a position separated farther from the excavation position B2 than the loading position A2 in the extending direction of the skirt 202 of the excavation target 200.
- the path planning unit 102 selects the loading position Ax at a position separated from the excavation position B2 by a distance greatly larger than the distance x2.
- the loading position A2 is a position at which the distance between the excavation position B2 and the loading position A2 can be set to the minimum distance x2, and the loading target 300 may be disposed at a position separated farther from the excavation target 200 than the loading position A2.
- the distance between the excavation position B2 and the loading position Ax may be larger than the distance x2.
- the loading position Ax may be selected in consideration of other factors including a situation of the work site, the surrounding environment, and the like. For example, in a case where it is recognized that there is a depression or mud at the loading position A2, the loading position Ax may be selected such that the loading target 300 is separated from the excavation target 200 and the loading target 300 can travel while avoiding the depression or the mud.
- the path planning unit 102 In step S28, the path planning unit 102 generates the shortest path that connects the loading position Ax and the excavation position B2.
- the path planning unit 102 determines a position separated from the skirt 202 of the excavation target 200 by the length L1 using the excavation position B2 as a starting point as the turning-back position T.
- the path planning unit 102 can generate a path of a straight line that connects the excavation position B2 and the turning-back position T as a path of unloaded advancing of the wheel loader 1 toward the excavation target 200 and as a path of loaded backing of the wheel loader 1 away from the excavation target 200.
- the path planning unit 102 can generate a path obtained by combining a straight line and a curve having any curvature such that the wheel loader 1 that starts performing loaded advancing from the turning-back position T causes the center point 6aC of the blade edge 6a of the bucket 6 to reach the loading position Ax of the loading target 300, and the width direction of the bucket 6 when the center point 6aC reaches the loading position Ax coincides with the front-rear direction of the loading target 300. Since the curvature radius of the curve included in this path is larger than the minimum radius in which the wheel loader 1 can turn without stationary steering, the wheel loader 1 can travel forward from the turning-back position T to the loading position Ax without stationary steering.
- the path planning unit 102 can set the generated path as a path for loaded advancing of the wheel loader 1 toward the loading target 300 and a path for unloaded backing of the wheel loader 1 away from the loading target 300.
- the wheel loader 1 that performs loaded advancing from the turning-back position toward the loading position Ax can make the width direction of the bucket 6 coincide with the front-rear direction of the loading target 300 when the bucket 6 reaches the loading position Ax without stationary steering.
- the path planning unit 102 may generate a path such that the wheel loader 1 at the turning-back position takes a straight posture.
- the path planning unit 102 may generate a path such that a posture is taken in which the front frame 2a and the rear frame 2b are bent from each other at the turning-back position.
- step S29 the path planning unit 102 gives an instruction of the loading position Ax and the angle ⁇ 2 to the loading target 300 such as a dump truck.
- the automation controller 100 outputs information indicating the loading position Ax and the angle ⁇ 2 to the communication device 150 ( Fig. 5 ).
- the information indicating the loading position Ax and the angle ⁇ 2 is transmitted to the loading target 300 via the communication device 150, and an instruction of a position at which the loading target 300 is to stop and a traveling direction of the loading target 300 to the stop position is given to the loading target 300.
- the position estimation unit 101 of the automation controller 100 recognizes the excavation target 200 that is a heap of material excavated by the work implement 3 on the basis of a detection result of the perception device 111.
- the path planning unit 102 of the automation controller 100 selects the excavation position B2 at which the excavation target 200 is excavated on the basis of the shape of the excavation target 200.
- the path planning unit 102 calculates, by a dimension of the wheel loader 1, the minimum distance x2 by which the loading position in a case where the wheel loader 1 that executes the excavation and loading work turns without stationary steering and loads material onto the loading target 300 by adjusting the position and posture of the bucket 6 of the work implement 3 to the loading target 300 is to be separated from the excavation position B2.
- the path of traveling in a case where the excavation and loading work is automatically controlled can be appropriately set by the shortest path on which traveling can be performed without stationary steering by the turning ability of the wheel loader 1 being determined from the dimension of the wheel loader 1.
- the shortest path on which the wheel loader 1 can perform V-shape traveling can be set, and the excavation and loading work can be efficiently executed.
- the dimension of the wheel loader 1 may include the dimension in the front-rear direction of the wheel loader 1.
- the distance x2 can be calculated from the length L1 or the like that is the total length of the wheel loader 1 in the front-rear direction, and the path of traveling in a case where the excavation and loading work is automatically controlled can be appropriately set.
- the path planning unit 102 can select, as the excavation position B2, a position that can minimize a travel distance by which the wheel loader 1 that excavates the excavation target 200 advances toward the excavation target 200 so as to load a certain amount of the material onto the work implement 3.
- the path of traveling in a case where the wheel loader 1 performs the excavation work being set to the shortest path, the excavation work can be efficiently performed.
- the path planning unit 102 may determine the loading position Ax in a case where the material is loaded onto the loading target 300 at a position separated from the excavation position B2 by a distance greatly larger than the distance x2.
- the distance x2 is a minimum distance in which the wheel loader 1 can turn without stationary steering, and the wheel loader 1 can be caused to travel without stationary steering by the distance between the excavation position B2 and the loading position Ax being made larger than the distance x2.
- An appropriate loading position Ax can be determined in consideration of the situation of the work site, the surrounding environment, and the like.
- the automation controller 100 may transmit the loading position Ax in a case where material is loaded onto the loading target 300 to the loading target 300.
- the wheel loader 1 can be caused to perform V-shape traveling in the shortest path, and the excavation and loading work can be efficiently executed.
- the path planning unit 102 may determine the turning-back position T at which the wheel loader 1 is switched from loaded backing to loaded advancing by the dimension of the wheel loader 1.
- the path planning unit 102 can determine a position separated from the excavation target 200 by the length L1 using the excavation position B2 as a starting point as the turning-back position T, and can appropriately set a path of traveling in a case where the excavation and loading work is automatically controlled.
- the main body of the wheel loader 1 may include the front frame 2a and the rear frame 2b bendable with respect to the front frame 2a.
- the wheel loader 1 includes an articulated structure in which the front frame 2a and the rear frame 2b are bendable from each other, so that the turning radius in the case of turning traveling can be reduced.
- the path of traveling can be shortened in a case where the wheel loader 1 performs the excavation and loading work.
- the wheel loader 1 may take a straight posture in which the front frame 2a and the rear frame 2b are not bent from each other in a case where the excavation target 200 is excavated and in a case where the material loaded on the work implement 3 is loaded onto the loading target 300.
- the wheel loader 1 taking a straight posture in a case where the excavation target 200 is excavated, the traction force of the vehicle can be sufficiently transmitted to the bucket 6 at the distal end of the work implement 3.
- the wheel loader 1 taking a straight posture in a case where the material is loaded onto the loading target 300, the vehicle can be stabilized.
- the position estimation unit 101 of the automation controller 100 recognizes the position of the loading target 300 on the basis of a detection result of the perception device 111.
- the present disclosure is not limited thereto, and information of the self-position of the loading target 300 may be input from the loading target 300 to the automation controller 100 by inter-vehicle communication between the automation controller 100 and the loading target 300 via the communication device 150.
- the position estimation unit 101 can recognize the relative position of the loading target 300 with respect to the wheel loader 1 from information of the current position of the wheel loader 1 acquired by the position information acquisition device 112 and information of the self-position of the loading target 300.
- the position estimation unit 101 can recognize the relative position of the loading target 300 with respect to the excavation target 200 from the information of the excavation target 200 acquired by the perception device 111 and the relative position of the loading target 300 with respect to the wheel loader 1.
- the automation controller 100 that forms the automatic control system of the wheel loader 1 described in the above embodiment is not necessarily mounted on the wheel loader 1.
- a controller outside the wheel loader 1 may construct a system included in the automation controller 100.
- a controller mounted on the wheel loader 1 may perform processing of transmitting information acquired by the external information acquisition unit 110, the vehicle information acquisition unit 120, and the like to an external controller, and the external controller that has received a signal may generate a travel path of the wheel loader 1.
- the external controller may be disposed at a work site of the wheel loader 1, or may be disposed at a remote place away from the work site of the wheel loader 1.
- the external controller may be a portable device.
- the external controller may be a portable device that can be carried and used by a worker, such as a notebook computer, a tablet computer, or a smartphone.
- the dump truck is exemplified as the loading target 300, and the work of loading material loaded on the work implement 3 (bucket 6) onto the vessel 301 has been described.
- the loading target 300 for loading material in the bucket 6 is not limited to the vessel 301 of the dump truck, and may be, for example, a hopper.
- an example has been described in which the excavation target 200 and the loading target 300 are detected by the perception device 111 mounted on the wheel loader 1.
- An object sensor that detects an object around the main body of the wheel loader 1 is not necessarily mounted on the wheel loader 1.
- the object sensor may be disposed outside the work machine.
- the object sensor may be disposed at a predetermined point of the work site, may be mounted on another work machine, or may be mounted on an unmanned aerial vehicle such as a drone.
- the wheel loader 1 includes the cab 5 and is a manned vehicle in which the operator boards the cab 5.
- the wheel loader 1 may be an unmanned vehicle.
- the wheel loader 1 may not include the cab 5 for the operator to board and operate.
- the wheel loader 1 may not include a steering function by a boarded operator.
- the wheel loader 1 may be a work machine dedicated to remote control. The operation of the wheel loader 1 may be performed by a wireless signal from a remote control device.
- a system including a work machine including:
- a dimension of the work machine includes a dimension in a front-rear direction of the work machine.
- the work machine main body includes a front frame and a rear frame bendable with respect to the front frame.
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)
- Component Parts Of Construction Machinery (AREA)
Abstract
A path of traveling in a case where excavation and loading work is automatically controlled is appropriately set. An object around the work machine main body includes an excavation target (200) that is a heap of material excavated by a work implement. A controller that generates a travel path of a travel body recognizes the excavation target (200) on the basis of a detection result of a sensor, selects an excavation position (B2) at which a work machine excavates the excavation target (200), and calculates a minimum distance (x2) by which the loading position (A2) in a case where the material loaded on the work implement is loaded onto a loading target (300) onto which the material is loaded is to be separated from the excavation position (B2) by a dimension of the work machine.
Description
- The present disclosure relates to a system including a work machine, a controller for a work machine, and a path generation method for a work machine.
- A conventional wheel loader is disclosed in, for example,
(Patent Literature 1).JP 2022-157259 A - Patent Literature 1:
JP 2022-157259 A - A wheel loader repeatedly performs excavation work and loading work. In order to automate the excavation work and the loading work, a path of traveling by automatic control is required to be appropriately set.
- The present disclosure proposes a system including a work machine, a controller for a work machine, and a path generation method for a work machine by which a path of traveling in a case where excavation and loading work is automatically controlled can be appropriately set.
- A system including a work machine according to an aspect of the present disclosure includes a work machine main body including a travel body, a work implement attached to the work machine main body, and a controller that generates a travel path of the travel body. An object around the work machine main body includes an excavation target that is a heap of material excavated by the work implement. The travel path of the travel body includes an excavation position at which the work machine excavates the excavation target and a loading position in a case where the material is loaded onto a loading target onto which the material is loaded. The controller recognizes the excavation target on the basis of a detection result of the sensor, selects the excavation position, and calculates a minimum distance by which the loading position is to be separated from the excavation position by a dimension of the work machine.
- A controller for a work machine according to an aspect of the present disclosure generates a travel path of a travel body of a work machine including the travel body and a work implement. The travel path of the travel body includes an excavation position at which the work machine excavates an excavation target that is a heap of material excavated by the work implement and a loading position in a case where material is loaded onto a loading target onto which the material is loaded. The controller recognizes the excavation target on the basis of a detection result of a sensor that detects an object around a work machine main body. The controller selects the excavation position. The controller calculates a minimum distance by which the loading position is to be separated from the excavation position by a dimension of the work machine.
- A path generation method for a work machine according to an aspect of the present disclosure is a method for generating a travel path of a travel body of a work machine including the travel body and a work implement. The travel path of the travel body includes an excavation position at which the work machine excavates an excavation target that is a heap of material excavated by the work implement and a loading position in a case where material is loaded onto a loading target onto which the material is loaded. The path generation method includes the following steps. The first step is to recognize the excavation target on the basis of a detection result of a sensor that detects an object around a work machine main body. The second step is to select the excavation position. The third step is to calculate a minimum distance by which the loading position is to be separated from the excavation position by a dimension of the work machine.
- According to a system including a work machine, a controller for a work machine, and a path generation method for a work machine of the present disclosure, a path of traveling in a case where excavation and loading work is automatically controlled can be appropriately set.
-
-
Fig. 1 is a side view of a wheel loader as an example of a work machine. -
Fig. 2 is a plan view of the wheel loader illustrated inFig. 1 . -
Fig. 3 is a view for describing excavation and loading work by the wheel loader. -
Fig. 4 is a block diagram illustrating a schematic configuration of a control system of the wheel loader. -
Fig. 5 is a block diagram illustrating a configuration of an automatic control system of the wheel loader. -
Fig. 6 is a schematic view of a vessel of a dump truck as viewed from the side. -
Fig. 7 is a schematic view illustrating a travel path of the wheel loader that performs excavation and loading work. -
Fig. 8 is a flowchart illustrating a flow of processing of generating a travel path of the wheel loader. -
Fig. 9 is a schematic diagram illustrating an example of a loading position with respect to a vessel. - Hereinafter, an embodiment will be described with reference to the drawings. In the following description, the same parts and components are denoted by the same reference signs. This also applies to their names and functions. Therefore, detailed descriptions thereof will not be repeated. It is also originally planned that any configurations are extracted from the embodiment and are freely combined.
- In the embodiment, a wheel loader 1 will be described as an example of a work machine.
Fig. 1 is a side view of the wheel loader 1 as an example of a work machine.Fig. 2 is a plan view of the wheel loader 1 illustrated inFig. 1 . - As illustrated in
Figs. 1 and2 , the wheel loader 1 mainly includes a vehicle body frame 2, a work implement 3, a travel device 4, and a cab 5. The vehicle body frame 2, the cab 5, and the like form the vehicle body of the wheel loader 1. The work implement 3 and the travel device 4 are attached to the vehicle body of the wheel loader 1. The main body of the wheel loader 1 (work machine main body) includes the vehicle body and the travel device 4. - The travel device 4 causes the vehicle body of the wheel loader 1 to travel, and includes travel wheels 4a and 4b. The wheel loader 1 is a wheeled vehicle including the travel wheels 4a and 4b as traveling rotation bodies on both sides of the vehicle body in a left-right direction. The wheel loader 1 is self-propelled by rotationally driving the travel wheels 4a and 4b, and can perform desired work using the work implement 3. The travel device 4 corresponds to an example of a "travel body".
- In the present specification, a direction in which the wheel loader 1 travels straight is referred to as a front-rear direction of the wheel loader 1. In the front-rear direction of the wheel loader 1, a side on which the work implement 3 is disposed with respect to the vehicle body frame 2 is defined as a front direction, and a side opposite to the front direction is defined as a rear direction. The left-right direction of the wheel loader 1 is a direction orthogonal to the front-rear direction in a plan view of the wheel loader 1 on a flat ground. The right side and the left side in the left-right direction when viewed in the front direction are the right direction and the left direction, respectively. The vertical direction of the wheel loader 1 is a direction orthogonal to a plane defined by the front-rear direction and the left-right direction. In the vertical direction, the side with the ground is the lower side, and the side with the sky is the upper side.
- The vehicle body frame 2 includes a front frame 2a and a rear frame 2b. The front frame 2a is disposed in front of the rear frame 2b. The front frame 2a and the rear frame 2b are attached to each other by a center pin 10 so as to be movable in the left-right direction.
- A pair of left and right steering cylinders 11 is attached across the front frame 2a and the rear frame 2b. The steering cylinders 11 are hydraulic cylinders. By the steering cylinders 11 being expanded and contracted by hydraulic oil from a steering pump (not illustrated), the travel direction of the wheel loader 1 is changed to the left and right. The front frame 2a and the rear frame 2b form the vehicle body frame 2 including an articulated structure. The wheel loader 1 is an articulated work machine in which the front frame 2a and the rear frame 2b are coupled to each other so as to be bendable.
- The work implement 3 and a pair of the travel wheels (front wheels) 4a are attached to the front frame 2a. The work implement 3 is attached to the front of the vehicle body of the wheel loader 1. The work implement 3 is supported by the vehicle body of the wheel loader 1. Specifically, the work implement 3 is rotatably supported by the vehicle body frame 2, more specifically, the front frame 2a. The work implement 3 is disposed in front of the vehicle body frame 2.
- The work implement 3 includes a boom 14. A base end portion of the boom 14 is rotatably attached to the front frame 2a by a boom pin 9. The boom 14 includes a left boom member 14L and a right boom member 14R. The left boom member 14L and the right boom member 14R are joined to each other so as to be unable to relatively move by a joining member that extends in the left-right direction to form the boom 14 including an integrated structure. The boom pin 9 includes a pair of a left boom pin 9L and a right boom pin 9R. The boom 14 is rotatable with respect to the front frame 2a about the left boom pin 9L and the right boom pin 9R. The left boom pin 9L and the right boom pin 9R rotatably support the work implement 3 with respect to the vehicle body frame 2.
- The work implement 3 includes a bucket 6. The bucket 6 is disposed at the distal end of the work implement 3. The bucket 6 is a work tool for excavation and loading. A blade edge 6a is a distal end portion of the bucket 6. A back surface 6b is a part of the outer surface of the bucket 6. The back surface 6b includes a flat surface. The back surface 6b extends rearward from the blade edge 6a. The bucket 6 is rotatably attached to the boom 14 by a bucket pin 17 located at a distal end of the boom 14. The bucket 6 includes a left boom attachment portion to which the left boom member 14L is attached and a right boom attachment portion to which the right boom member 14R is attached.
- The work implement 3 further includes a bell crank 18 and a link 15. A substantially central portion of the bell crank 18 is rotatably supported by the boom 14 by a support pin 18a located substantially at the center of the boom 14 in the longitudinal direction. The link 15 is coupled to a coupling pin 18c included at the lower end (distal end portion) of the bell crank 18. The link 15 couples the bell crank 18 and the bucket 6. The bell crank 18 and the link 15 are disposed between the left boom member 14L and the right boom member 14R in the left-right direction.
- The front frame 2a and the boom 14 are coupled by a pair of boom cylinders 16. The boom cylinders 16 are hydraulic cylinders. The boom cylinders 16 drive the boom 14 to rotate up and down about the boom pin 9. The base ends of the boom cylinders 16 are attached to the front frame 2a. The distal ends of the boom cylinders 16 are attached to the boom 14. The boom cylinders 16 are hydraulic actuators that move the boom 14 up and down with respect to the front frame 2a. As the boom 14 ascends and descends, the bucket 6 attached to the distal end of the boom 14 also ascends and descends.
- A bucket cylinder 19 couples the bell crank 18 and the front frame 2a. The base end of the bucket cylinder 19 is attached to the front frame 2a. The distal end of the bucket cylinder 19 is attached to a coupling pin 18b included at the upper end portion (base end portion) of the bell crank 18. The bucket cylinder 19 is a hydraulic actuator that rotates the bucket 6 up and down with respect to the boom 14. The bucket cylinder 19 is a work tool cylinder that drives the bucket 6. The bucket cylinder 19 rotationally drives the bucket 6 around the bucket pin 17. The bucket 6 is formed to be operable with respect to the boom 14. The bucket 6 is formed to be operable with respect to the front frame 2a.
- The boom cylinders 16 and the bucket cylinder 19 form a work implement actuator that drives the work implement 3.
- The cab 5 on which the operator boards and a pair of the travel wheels (rear wheels) 4b are attached to the rear frame 2b. The box-shaped cab 5 is disposed behind the boom 14. The cab 5 is mounted on the rear frame 2b. The cab 5 is placed on the vehicle body frame 2. In the cab 5, a seat on which the operator of the wheel loader 1 sits, an operation device 8 to be described below, and the like are disposed.
- A perception device 111 is included on the cab 5. The perception device 111 is disposed, for example, on a ceiling of the cab 5. The perception device 111 is mounted on, for example, an upper surface of the cab 5. The perception device 111 is disposed, for example, on a front portion of the cab 5. The perception device 111 is attached to the cab 5 facing forward, for example, and can acquire information of the front of the cab 5. Details of the perception device 111 will be described below.
- A length L1 illustrated in
Fig. 1 is a length from the blade edge 6a of the bucket 6 to the rear end of the vehicle body (total length of the wheel loader 1) in the front-rear direction. A length L2 is a length from the front end of the front wheel 4a to the rear end of the vehicle body in the front-rear direction (vehicle body length of the wheel loader 1). A length L3 is a length (wheelbase length) from the center of the front wheel 4a to the center of the rear wheel 4b in the front-rear direction. A length L4 is a length from the center of the front wheel 4a to the bending center of the front frame 2a and the rear frame 2b in the front-rear direction. A length L5 is a length from the bending center of the front frame 2a and the rear frame 2b to the center of the rear wheel 4b in the front-rear direction. - A length L9 illustrated in
Fig. 2 is a length (bucket width) from the left end to the right end of the bucket 6 in the left-right direction. A width direction center 6c of the bucket 6 is a center point of the bucket 6 in the left-right direction. - Lengths L1 to L5 and L9 illustrated in
Figs. 1 and2 are included in a specification value of the wheel loader 1. The specification value of the wheel loader 1 further includes a minimum turning radius of the vehicle body. The wheel loader 1 includes an articulated structure in which the front frame 2a and the rear frame 2b are bendable from each other, so that the minimum turning radius of the vehicle body is smaller as compared to a rigid structure. The specification value of the wheel loader 1 is a value unique to each individual of the wheel loader 1, and is stored in a vehicle body controller 50 to be described below. - The wheel loader 1 according to the present embodiment executes excavation and loading work of scooping material into the bucket 6 and loading the material in the bucket 6 onto a loading target such as a dump truck. The material is earth, sand, rock, ore, or the like excavated at a work site or carried into the work site by a carrying machine such as a dump truck.
Fig. 3 is a view for describing excavation and loading work by the wheel loader 1 according to the embodiment. -
Fig. 3(A) illustrates the wheel loader 1 that performs unloaded advancing. The wheel loader 1 travels forward toward an excavation target 200 that is a heap of material. The boom cylinders 16 and the bucket cylinder 19 are operated so that the work implement 3 is in an excavation posture in which the distal end of the boom 14 is at a low position and the bucket 6 is oriented horizontally. -
Figs. 3(B) and 3(C) illustrate the wheel loader 1 performing excavation work. The wheel loader 1 thrusts the blade edge 6a of the bucket 6 into the excavation target 200, and stops forward travel. The blade edge 6a of the bucket 6 bites into the excavation target 200 by an excavation (thrusting) operation illustrated inFig. 3(B) . In this state, when the boom 14 and the bucket 6 rise and the bucket 6 tilts back, the bucket 6 moves along a bucket trajectory BL as indicated by an arrow inFig. 3(C) . With this operation, an excavation (scooping) operation of scooping the excavation target 200 into the bucket 6 illustrated inFig. 3(C) is executed. - Depending on the type of the excavation target 200, the excavation (scooping) operation may be completed only by tilting back the bucket 6 once. Alternatively, in the excavation (scooping) operation, the operation of tilting back, neutralizing, and tilting back the bucket 6 again may be repeated.
-
Fig. 3(D) illustrates the wheel loader 1 that performs loaded backing. The wheel loader 1 travels backward with the excavation target 200 loaded in the bucket 6. The wheel loader 1 may raise the bucket 6 while traveling backward. -
Fig. 3(E) illustrates the wheel loader 1 that performs loaded advancing. The wheel loader 1 travels forward toward a loading target 300 while raising the bucket 6 or maintaining a state in which the bucket 6 is raised. The wheel loader 1 approaches the loading target 300 until the bucket 6 reaches a predetermined position located substantially directly above the loading platform of the loading target 300. -
Fig. 3(F) illustrates the wheel loader 1 that performs a soil discharging operation to the loading target 300. When the wheel loader 1 approaches the loading target 300 and reaches a predetermined position, the wheel loader 1 dumps the bucket 6 and loads the material in the bucket 6 onto the loading target 300. Thereafter, the wheel loader 1 lowers the boom 14 to return the work implement 3 to the excavation posture while traveling backward to the position at which the forward travel is started inFig. 3(E) . - The above is a typical operation included in one cycle of the excavation and loading work. The wheel loader 1 repeatedly performs the plurality of operations described above in sequence, excavates the excavation target 200, and loads the excavated material onto the loading target 300 such as a dump truck.
- When excavating the excavation target 200 illustrated in
Figs. 3(B) and 3(C) , the wheel loader 1 takes a straight posture in which the front frame 2a and the rear frame 2b are not bent from each other. When loading the material in the bucket 6 illustrated inFig. 3(F) onto the loading target 300, the wheel loader 1 takes a straight posture in which the front frame 2a and the rear frame 2b are not bent from each other. -
Fig. 4 is a block diagram illustrating a schematic configuration of a control system that controls the wheel loader 1. - An engine 21 is a driving source that generates a driving force for driving the work implement 3 and the travel device 4, and is, for example, a diesel engine. As the driving source, instead of the engine 21, a motor driven by a power storage body may be used, or both the engine and the motor may be used. The output of the engine 21 is controlled by adjusting the amount of fuel injected into the cylinder of the engine 21.
- The driving force generated by the engine 21 is transmitted to a transmission 23. The transmission 23 shifts the driving force to an appropriate torque and rotational speed. An axle 25 is connected to an output shaft of the transmission 23. The driving force shifted by the transmission 23 is transmitted to the axle 25. The driving force is transmitted from the axle 25 to the travel wheels 4a and 4b (
Figs. 1 and2 ). Thus, the wheel loader 1 travels. In the wheel loader 1 of the embodiment, both the travel wheel 4a and the travel wheel 4b form driving wheels that receive a driving force and cause the wheel loader 1 to travel. - Apart of the driving force of the engine 21 is transmitted to a work implement pump 13. The work implement pump 13 is a hydraulic pump that is driven by the engine 21 and operates the work implement 3 by discharged hydraulic oil. The work implement 3 is driven by hydraulic oil from the work implement pump 13. The hydraulic oil discharged from the work implement pump 13 is supplied to the boom cylinders 16 and the bucket cylinder 19 via a main valve 32. When the boom cylinders 16 expand and contract by receiving the supply of the hydraulic oil, the boom 14 moves up and down. When the bucket cylinder 19 receives the supply of the hydraulic oil and expands and contracts, the bucket 6 rotates up and down.
- The wheel loader 1 includes the vehicle body controller 50. The vehicle body controller 50 includes an engine controller 60, a transmission controller 70, and a work implement controller 80.
- The vehicle body controller 50 is generally implemented by reading various programs by a central processing unit (CPU). The vehicle body controller 50 includes a memory (not illustrated). The memory functions as a work memory and stores various programs for implementing the function of the wheel loader 1.
- The operation device 8 is included in the cab 5. The operation device 8 is operated by the operator. The operation device 8 includes a plurality of types of operation members operated by the operator to operate the wheel loader 1. The operation device 8 includes an accelerator pedal 41 and a work implement operation lever 42. The operation device 8 may include a steering wheel, a shift lever, and the like (not illustrated).
- The accelerator pedal 41 is operated to set a target rotation speed of the engine 21. The engine controller 60 controls the output of the engine 21 on the basis of the operation amount of the accelerator pedal 41. When the operation amount (depression amount) of the accelerator pedal 41 is increased, the output of the engine 21 is increased. When the operation amount of the accelerator pedal 41 is reduced, the output of the engine 21 is reduced. The transmission controller 70 controls the transmission 23 on the basis of the operation amount of the accelerator pedal 41.
- The work implement operation lever 42 is operated to operate the work implement 3. The work implement controller 80 controls electromagnetic proportional control valves 35 and 36 on the basis of the operation amount of the work implement operation lever 42.
- The electromagnetic proportional control valve 35 contracts the bucket cylinder 19 to switch the main valve 32 such that the bucket 6 moves in the dumping direction (direction in which the blade edge of the bucket 6 is lowered). Furthermore, the electromagnetic proportional control valve 35 extends the bucket cylinder 19 to switch the main valve 32 such that the bucket 6 moves in the tilting direction (direction in which the blade edge of the bucket 6 is raised). The electromagnetic proportional control valve 36 contracts the boom cylinders 16 to switch the main valve 32 such that the boom 14 is lowered. Furthermore, the electromagnetic proportional control valve 36 extends the boom cylinders 16 to switch the main valve 32 such that the boom 14 is raised.
- A machine monitor 51 receives input of an instruction signal from the vehicle body controller 50 and displays various types of information. The various types of information displayed on the machine monitor 51 may be, for example, information regarding work executed by the wheel loader 1, vehicle 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 the wheel loader 1, and the like. The machine monitor 51 may be a touch panel, and in this case, a signal generated by the operator touching a part of the machine monitor 51 is output from the machine monitor 51 to the vehicle body controller 50.
- In automating work of the wheel loader 1, an operation of a skilled operator is desirably reproduced by automatic control.
Fig. 5 is a block diagram illustrating a configuration of an automatic control system of the wheel loader 1. - An automation controller 100 is formed to be able to transmit and receive signals to and from the vehicle body controller 50 described with reference to
Fig. 4 . The automation controller 100 is also formed to be able to transmit and receive signals to and from an external information acquisition unit 110. The external information acquisition unit 110 includes the perception device 111 and a position information acquisition device 112. The perception device 111 and the position information acquisition device 112 are mounted on the wheel loader 1. - The perception device 111 acquires information of the surroundings of the wheel loader 1. The perception device 111 is attached to a front portion of the upper surface of the cab 5, for example. The perception device 111 corresponds to an example of an "object sensor" that detects an object around the main body of the wheel loader 1 (work machine main body).
- The perception device 111 detects a direction of an object outside the wheel loader 1 and a distance to the object in a non-contact manner. The perception device 111 is, for example, a light detection and ranging (LiDAR) that emits laser light and acquires information of an object. The perception device 111 may be a visual sensor including a camera. The perception device 111 may be a radio detection and ranging (Radar) that acquires information of an object by emitting radio waves. The perception device 111 may be an infrared sensor.
- The position information acquisition device 112 acquires information of the current position of the wheel loader 1. The position information acquisition device 112 acquires position information of the wheel loader 1 in a global coordinate system with reference to the earth using, for example, a satellite positioning system. The position information acquisition device 112 uses, for example, global navigation satellite systems (GNSS), and includes a GNSS receiver. The satellite positioning system calculates the position of the antenna of the GNSS receiver from a positioning signal received by the GNSS receiver from a satellite to calculate the position of the wheel loader 1.
- External information of the wheel loader 1 by the perception device 111 and the position information of the wheel loader 1 by the position information acquisition device 112 are input to the automation controller 100.
- The vehicle body controller 50 is formed to be able to transmit and receive signals to and from a vehicle information acquisition unit 120, and receives input of information of the wheel loader 1 acquired by the vehicle information acquisition unit 120. The vehicle information acquisition unit 120 includes various sensors mounted on the wheel loader 1. The 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.
- The articulation angle sensor 121 detects an articulation angle that is an angle formed by the front frame 2a and the rear frame 2b, and generates a signal of the detected articulation angle. The articulation angle sensor 121 outputs the signal of the articulation angle to the vehicle body controller 50.
- The vehicle speed sensor 122 detects the moving speed of the wheel loader 1 by the travel device 4, for example, by detecting the rotation speed of the output shaft of the transmission 23, and generates a signal of the detected vehicle speed. The vehicle speed sensor 122 outputs the signal of the vehicle speed to the vehicle body controller 50. The vehicle speed sensor 122 corresponds to an example of a travel sensor that detects a traveling status of the travel device 4 (travel body).
- The boom angle sensor 123 includes, for example, a rotary encoder included in the boom pin 9 that is an attachment portion of the boom 14 to the vehicle body frame 2. The boom angle sensor 123 detects an angle of the boom 14 with respect to the horizontal direction (boom angle), and generates a signal indicating the detected angle of the boom 14. The boom angle sensor 123 outputs the signal of the angle of the boom 14 to the vehicle body controller 50.
- The bucket angle sensor 124 includes, for example, a rotary encoder included in the support pin 18a that is a rotation shaft of the bell crank 18. The bucket angle sensor 124 detects an angle of the bell crank 18 with respect to the boom 14 (bell crank angle), and generates a signal of the detected angle of the bell crank 18. The vehicle information acquisition unit 120 or the vehicle body controller 50 calculates an angle of the bucket 6 (bucket angle) with respect to the boom 14 from the detected angle of the bell crank 18.
- The boom angle sensor 123 and the bucket angle sensor 124 correspond to an example of a work implement posture sensor that detects the posture of the work implement 3. The boom angle sensor 123 may be a stroke sensor disposed on the boom cylinder 16. The bucket angle sensor 124 may be a potentiometer or a proximity switch attached to the bucket pin 17, or may be a stroke sensor disposed on the bucket cylinder 19.
- The boom cylinder pressure sensor 125 detects pressure on the bottom side (boom bottom pressure) of the boom cylinder 16, and generates a signal of the detected boom bottom pressure. The boom bottom pressure increases in a case where a load is loaded on the bucket 6, and decreases in a case where the load is empty. The boom cylinder pressure sensor 125 outputs the signal of the boom bottom pressure to the vehicle body controller 50.
- The vehicle body controller 50 outputs information input from the vehicle information acquisition unit 120 to the automation controller 100. The automation controller 100 receives detection values of the vehicle speed sensor 122, the boom angle sensor 123, and the bucket angle sensor 124 via the vehicle body controller 50.
- An actuator 140 is formed to be able to transmit and receive signals to and from the vehicle body controller 50. The actuator 140 is driven upon receiving an instruction signal from the vehicle body controller 50. The actuator 140 includes a brake electromagnetic proportional control valve (EPC) 141 for operating the brake of the travel device 4, a steering EPC 142 for adjusting the traveling direction of the wheel loader 1, a work implement EPC 143 for operating the work implement 3, and a hydraulic mechanical transmission (HMT) 144.
- The electromagnetic proportional control valves 35 and 36 illustrated in
Fig. 4 form the work implement EPC 143. The transmission 23 illustrated inFig. 4 is implemented as the HMT 144 utilizing electronic control. The transmission 23 may be a hydro-static transmission (HST). A power transmission device that transmits power from the engine 21 to the travel wheels 4a and 4b may include an electric drive device of a diesel electric type or the like, or may include any combination of the HMT, the HST, and the electric drive device. - The transmission controller 70 includes a brake control unit 71 and an accelerator control unit 72. The brake control unit 71 outputs an instruction signal for controlling the operation of the brake to the brake EPC 141. The accelerator control unit 72 outputs an instruction signal for controlling the vehicle speed to the HMT 144.
- The work implement controller 80 includes a steering control unit 81 and a work implement control unit 82. The steering control unit 81 outputs an instruction signal for controlling the traveling direction of the wheel loader 1 to the steering EPC 142. The work implement control unit 82 outputs an instruction signal for controlling the operation of the work implement 3 to the work implement EPC 143.
- The automation controller 100 includes a position estimation unit 101, a path planning unit 102, and a path follow-up control unit 103.
- The position estimation unit 101 estimates the self-position of the wheel loader 1 on the basis of the position information acquired by the position information acquisition device 112. Furthermore, the position estimation unit 101 recognizes a target position on the basis of the external information acquired by the perception device 111. The target position is, for example, an excavation position in the excavation target 200 at which the wheel loader 1 excavates the excavation target 200 using the bucket 6. Further, for example, the target position is a loading position in the loading target 300 that is a relative position of the work implement 3 (bucket 6) with respect to the loading target 300 when material is loaded onto the loading target 300. The perception device 111 may recognize and input a target position to the automation controller 100, and the position estimation unit 101 may recognize a target position on the basis of the detection result detected by the perception device 111.
- The path planning unit 102 generates an optimum path of the wheel loader 1 in a case where the wheel loader 1 is automatically controlled. The optimum path includes a path of traveling by the travel device 4 and a path of operation of the work implement 3.
- For example, the path planning unit 102 generates a path of traveling of the wheel loader 1 that performs unloaded advancing toward the excavation target 200. The path planning unit 102 generates a path of the operation of the work implement 3 in excavation work. The path planning unit 102 generates a path of traveling of the wheel loader 1 that performs loaded backing to be separated from the excavation target 200 and a path of operation of the work implement 3 that is performing loaded backing. The path planning unit 102 generates a path of traveling of the wheel loader 1 that performs loaded advancing toward the loading target 300 and a path of operation of the work implement 3 that is performing loaded advancing. The path planning unit 102 generates a path of operation of the work implement 3 that discharges material scooped into the bucket 6 to the loading target 300. The path planning unit 102 generates a path of traveling of the wheel loader 1 that performs unloaded backing to be separated from the loading target 300 and a path of operation of the work implement 3 that is performing unloaded backing.
- The path planning unit 102 also generates an optimum path that connects the current self-position of the wheel loader 1 and a target position to which the wheel loader 1 is heading while executing the excavation and loading work.
- The path follow-up control unit 103 gives an instruction of operation of the travel device 4 and the work implement 3. The path follow-up control unit 103 controls the accelerator, the brake, and the steering such that the wheel loader 1 travels following the optimum path generated by the path planning unit 102. An instruction signal for causing the wheel loader 1 to travel along the optimum path is output from the path follow-up control unit 103 to the brake control unit 71, the accelerator control unit 72, and the steering control unit 81. The path follow-up control unit 103 controls the boom cylinders 16 and the bucket cylinder 19 such that the work implement 3 operates along the optimum path generated by the path planning unit 102. An instruction signal for moving the work implement 3 along the optimum path is output from the path follow-up control unit 103 to the work implement control unit 82.
- An interface 130 is formed to be able to transmit and receive signals to and from the vehicle body controller 50. The interface 130 includes an automation switching switch 131, an engine emergency stop switch 132, and a mode lamp 133.
- The automation switching switch 131 is operated by the operator. The operator operates the automation switching switch 131 to switch between manually operating the wheel loader 1 and automatically controlling the wheel loader 1. The engine emergency stop switch 132 is operated by the operator. In a case where an event that requires emergency stop of the engine 21 occurs, the operator operates the engine emergency stop switch 132. Operation signals of the automation switching switch 131 and the engine emergency stop switch 132 are input to the vehicle body controller 50.
- The mode lamp 133 displays whether the wheel loader 1 is currently in a mode of being manually operated by the operator or in a mode of being automatically controlled. An instruction signal for controlling lighting of the lamp is output from the vehicle body controller 50 to the mode lamp 133.
- The automation controller 100 is also formed to be able to transmit and receive signals to and from a communication device 150. The automatic control system of the wheel loader 1 is formed to be able to gives an instruction of information held by the automation controller 100 to the loading target 300 such as a dump truck via the communication device 150.
- The dump truck as an example of the loading target 300 includes a vessel 301. The vessel 301 is an example of a container in which material loaded on the work implement 3 (bucket 6) is loaded.
Fig. 6 is a schematic view of the vessel 301 of the dump truck as viewed from the side. InFig. 6 and subsequentFig. 9 , a schematic shape of the vessel 301 viewed from the left side of the dump truck is illustrated. A thick line in the drawing indicates a schematic shape when a surface that forms the internal shape of the vessel 301 is viewed from the left side of the dump truck. - In
Figs. 6 and9 , the left-right direction in the drawings corresponds to the front-rear direction of the dump truck (front-rear direction of the vessel 301). InFigs. 6 and9 , the left direction in the drawing is the front direction of the dump truck (vessel 301), and the right direction in the drawing is the rear direction of the dump truck (vessel 301). InFigs. 6 and9 , the direction perpendicular to the drawing corresponds to the left-right direction of the dump truck (left-right direction of the vessel 301). InFigs. 6 and9 , the vertical direction in the drawing corresponds to the vertical direction of the dump truck (vertical direction of the vessel 301). - The vessel 301 is included at a rear portion of the dump truck. A cab is included in front of the dump truck, and the vessel 301 is disposed behind the cab. The vessel 301 includes a structure in which heavy material including earth and sand, crushed stones, and the like can be loaded.
- As illustrated in
Fig. 6 , the vessel 301 includes a bottom surface 302, a front wall surface 303, and a rear inclined surface 305. The bottom surface 302 has a flat shape. The bottom surface 302 has a planar shape that extends in the front-rear direction and the left-right direction of the dump truck (vessel 301). - The front wall surface 303 has a flat shape. The front wall surface 303 extends forward and upward from the front end of the bottom surface 302. The front wall surface 303 extends upward, being inclined toward the front. The front wall surface 303 forms a front wall surface of the vessel 301. The wall surface in front of the vessel 301 is inclined upward toward the front. The front wall surface 303 includes a front upper edge 304. The front upper edge 304 extends in the left-right direction. The front upper edge 304 forms a front edge of the vessel 301.
- The rear inclined surface 305 has a flat shape. The rear inclined surface 305 extends rearward and upward from the rear end of the bottom surface 302. The rear inclined surface 305 extends upward, being inclined toward the rear. The rear inclined surface 305 is inclined upward toward the rear. The rear inclined surface 305 includes a rear upper edge 306. The rear upper edge 306 extends in the left-right direction. The rear upper edge 306 forms a rear edge of the vessel 301. The rear upper edge 306 is located lower than the front upper edge 304.
-
Fig. 6 illustrates a shape of the vessel 301 without a tailgate. In a case where the vessel 301 includes a tailgate, the tailgate is disposed to extend upward from the rear end of the rear inclined surface 305. The upper edge of the tailgate forms the rear upper edge 306. - Processing of generating a path of traveling of the wheel loader 1 in a case where the excavation and loading work described with reference to
Fig. 3 is automatically controlled will be described below.Fig. 7 is a schematic view illustrating a travel path of the wheel loader 1 that performs the excavation and loading work.Fig. 8 is a flowchart illustrating a flow of processing of generating a travel path of the wheel loader 1. - The excavation target 200 illustrated in
Fig. 7 is a heap of material excavated by the bucket 6 of the wheel loader 1. The excavation target 200 may be a heap of material accumulated in a material accumulation place such as a stockyard. The excavation target 200 may be a heap of material formed in a vacant lot. The excavation target 200 includes a top portion 201 having the highest heap height and a skirt 202 on a front side (side on which the wheel loader 1 excavates the excavation target 200. A lower side inFig. 7 ). The skirt 202 is schematically illustrated linearly. The heap height of the excavation target 200 is not uniform, and the heap height gradually decreases from the top portion 201 toward the skirt 202. - In the vicinity of the skirt 202, the excavation target 200 includes a low heap area 203 in which the accumulation amount of material is small and the heap height is low, and an accumulation area 204 in which the accumulation amount of material is larger than the low heap area 203 and the heap height is higher than the low heap area 203.
- As illustrated in
Fig. 8 , first, in step S21, the perception device 111 mounted on the wheel loader 1 detects the excavation target 200. The object around the wheel loader 1 detected by the perception device 111 includes the excavation target 200. The perception device 111 inputs the detection result of the excavation target 200 to the position estimation unit 101 of the automation controller 100. The position estimation unit 101 recognizes the position and shape of a heap of material that is the excavation target 200 on the basis of the detection result of the perception device 111. - In step S22, the path planning unit 102 of the automation controller 100 selects an excavation position B2 on the basis of the shape of the excavation target 200. A position to which the width direction center 6c (
Fig. 2 ) of the bucket 6 to be directed in the extending direction of the skirt 202 of the excavation target 200 (left-right direction inFig. 7 ) when the wheel loader 1 excavates the excavation target 200 is defined as the excavation position B2. The path planning unit 102 can select, as the excavation position B2, a distance that can minimize a travel distance by which the wheel loader 1 that excavates the excavation target 200 advances toward the excavation target 200 so as to scoop material into the bucket 6 and load a certain amount of the material onto the work implement 3, typically, so as to fully load the material into the bucket 6. - In the example illustrated in
Fig. 7 , the excavation target 200 includes the low heap area 203 and the accumulation area 204 in the vicinity of the skirt 202. The wheel loader 1 can scoop more material into the bucket 6 with a short travel distance by traveling forward toward the accumulation area 204 and excavating the excavation target 200 rather than traveling forward toward the low heap area 203 and excavating the excavation target 200. The wheel loader 1 travels forward toward the accumulation area 204 and excavates the excavation target 200, so that the bucket 6 can be filled with the material at a position closer to the skirt 202. Therefore, the path planning unit 102 can select a substantially central position of the accumulation area 204 in the extending direction of the skirt 202 as the excavation position B2. - In step S23, the path planning unit 102 determines an angle θ2 formed by the skirt 202 of the excavation target 200 and the left side surface of the vessel 301 of the loading target 300. The angle θ2 can be determined to be any angle. As an example, the angle θ2 may be a 60° angle that is desirable for the excavation and loading work. The angle θ2 may be determined to be another angle different from 60° according to the situation of a work site or the surrounding environment.
- In step S24, the path planning unit 102 determines a distance by which a loading position A2 that is a relative position of the work implement 3 (bucket 6) with respect to the loading target 300 when material is loaded onto the loading target 300 in the loading target 300 such as a dump truck is separated from the skirt 202 of the excavation target 200.
-
Fig. 9 is a schematic diagram illustrating an example of the loading position A2 with respect to the vessel 301.Fig. 9 schematically illustrates the vessel 301 viewed from the left side of the loading target 300.Fig. 9 also schematically illustrates the bucket 6 viewed from the rear of the wheel loader 1 (viewed in the front direction). The bucket 6 includes the blade edge 6a that extends in the width direction. A center point 6aC is a center point of the blade edge 6a in the width direction of the bucket 6. The bucket 6 illustrated inFig. 9 is in a full dump posture. The bucket 6 in the posture illustrated inFig. 9 moves in the dumping direction to the maximum. When the bucket 6 is in the posture illustrated inFig. 9 , the cylinder stroke length of the bucket cylinder 19 is minimized. - As illustrated in
Fig. 7 , the wheel loader 1 travels forward from the side (left side) of the loading target 300 toward the vessel 301 and performs the loading work. The width direction of the bucket 6 during the loading work coincides with the front-rear direction (inFig. 9 , left-right direction in the drawing) of the loading target 300 (vessel 301). Since the wheel loader 1 takes a straight posture during the loading work, the left-right direction of the wheel loader 1 coincides with the width direction of the bucket 6. -
Fig. 9 illustrates material M loaded from the bucket 6 onto the vessel 301 of the loading target 300. The path planning unit 102 recognizes the position of the upper end of the left side surface of the vessel 301 corresponding to the center point 6aC of the blade edge 6a of the bucket 6 in the front-rear direction of the loading target 300 in a case where the material M loaded onto the vessel 301 does not spill from the vessel 301 as the loading position A2. - The loading position A2 is set as a position at which the right end of the bucket 6 is separated from the rear upper edge 306 of the vessel 301 by a predetermined distance when the bucket 6 in the full dump posture is viewed from the rear of the wheel loader 1 (viewed in the forward direction). The relative position of the right end of the bucket 6 with respect to the center point 6aC of the blade edge 6a is calculated from the dimension in the width direction of the bucket 6. In a case where the bucket 6 is at the loading position A2, the right end of the bucket 6 is separated forward from the rear upper edge 306 by a predetermined distance in the front-rear direction of the loading target 300.
- Specifically, the path planning unit 102 determines the loading position A2 at a position at which the material M does not spill from the vessel 301 when the material M is loaded onto the vessel 301 at the angle of repose. For example, the angle of repose 30° of sand can be used for determining the loading position A2 such that the angle formed by the material M with respect to the front-rear direction of the loading target 300 at the rear upper edge 306 (
Fig. 6 ) is 30° or less. - The path planning unit 102 determines a distance by which the loading position A2 is separated from the excavation target 200 such that the loading target 300 does not interfere with the excavation target 200 and the wheel loader 1 that travels toward the loading position A2 and loads the material in the bucket 6 onto the loading target 300 at the loading position A2 does not interfere with the excavation target 200. The path planning unit 102 determines a distance between the loading position A2 and the skirt 202 in a direction orthogonal to the linearly extending skirt 202. The path planning unit 102 determines a distance between the loading position A2 and the skirt 202 in the traveling direction (vertical direction in
Fig. 7 ) of the wheel loader 1 traveling straight toward the excavation target 200. - In step S25, the path planning unit 102 determines, from the specification value of the wheel loader 1, the loading position A2 at which V-shape traveling can be performed without stationary steering in which steering is performed while the wheel loader 1 is stopped. The V-shape traveling is a typical path of traveling in a case where the wheel loader 1 performs the excavation and loading work, and the travel path of the wheel loader 1 has a V-shape. In a case where the wheel loader 1 performs V-shape traveling to perform the excavation and loading work, the travel path is assumed to be efficient since the travel distance of the wheel loader 1 is minimized.
- Referring to
Figs. 3 and7 , after excavating the excavation target 200, the wheel loader 1 is switched from forward movement to backward movement, and performs loaded backing. The wheel loader 1 is switched from backward movement to forward movement, and performs loaded advancing toward the loading position A2 of the loading target 300. A position at which the operation of the wheel loader 1 is switched from the loaded backing to the loaded advancing is referred to as a turning-back position. The wheel loader 1 that performs the loaded backing may travel straight from the excavation target 200 to the turning-back position. At least a part of the path on which the wheel loader 1 that performs the loaded advancing travels toward the loading position A2 of the loading target 300 may have a curved shape, typically an arc shape. - The specification value of the wheel loader 1 includes the lengths L1 to L5 and L9 of respective parts of the wheel loader 1 described with reference to
Figs. 1 and2 . As described with reference toFig. 1 , the length L1 is the total length of the wheel loader 1, and is the dimension of the wheel loader 1 in the front-rear direction. The specification value of the wheel loader 1 also includes a minimum radius in which the wheel loader 1 can turn without stationary steering. - When loading the material in the bucket 6 onto the vessel 301 of the loading target 300, the wheel loader 1 takes a straight posture in which the front frame 2a and the rear frame 2b are not bent from each other. When loading the material in the bucket 6 onto the vessel 301 of the loading target 300, the wheel loader 1 adjusts the position and posture of the work implement 3 (bucket 6) to the vessel 301 of the loading target 300. Specifically, the wheel loader 1 takes a posture in which the width direction of the bucket 6 coincides with the front-rear direction of the loading target 300 and the width direction center 6c (
Fig. 2 ) of the bucket 6 is adjusted to the loading position A2. - As illustrated in
Fig. 7 , the path planning unit 102 can set a position at which the center point 6aC (Fig. 9 ) of the blade edge 6a of the bucket 6 is separated by the length L1 from the excavation position B2 on the skirt 202 of the excavation target 200 as a turning-back position T. - The dimension of the wheel loader 1 for determining the turning-back position T is not limited to the length L1. The work implement 3 can change its posture with respect to the vehicle body of the wheel loader 1, and the length L1 may vary with movement of the work implement 3. The length L1 may vary by replacing the bucket 6. On the other hand, the length L2 that is an example of the main body dimension of the wheel loader 1 is a dimension in the front-rear direction of the wheel loader 1, and is a constant dimension regardless of the work implement 3. The path planning unit 102 may determine the turning-back position T on the basis of the length L2.
- The path planning unit 102 sets a curved path P starting from the width direction center 6c of the bucket 6 in a case where the wheel loader 1 is at the turning-back position T. The path planning unit 102 sets the path P in which the width direction of the bucket 6 coincides with the front-rear direction of the loading target 300 that stops at the angle θ2 with respect to the skirt 202 of the excavation target 200 when the width direction center 6c of the bucket 6 reaches a position separated from the skirt 202 of the excavation target 200 by the distance determined in step S24,.
- The path planning unit 102 sets the path P such that the wheel loader 1 traveling along the path P can turn without stationary steering. The wheel loader 1 that travels along the path P turns in a turning radius larger than a minimum radius in which the wheel loader 1 can turn without stationary steering. The path P is a trajectory followed by the width direction center 6c of the bucket 6 in a case where the wheel loader 1 turns in a turning radius in which the wheel loader 1 can turn without stationary steering. The path planning unit 102 confirms that the wheel loader 1 traveling along the path P can travel without stationary steering.
- The path planning unit 102 determines the end point of the path P in a case where the turning-back position T as a start point as the loading position A2. The wheel loader 1 that performs loaded advancing from the turning-back position T to the loading position A2 along the path P can turn without stationary steering, and can appropriately adjust the position and posture of the work implement 3 (bucket 6) to the vessel 301 of the loading target 300 at the loading position A2.
- As illustrated in
Fig. 7 , the distance between the turning-back position T and the loading position A2 in the left-right direction of the loading target 300 that stops at the angle θ2 with respect to the skirt 202 of the excavation target 200 may be the length L1 that is the total length of the wheel loader 1. - In step S26, the path planning unit 102 calculates a distance x2 in the extending direction of the skirt 202 of the excavation target 200 (left-right direction in
Fig. 7 ) corresponding to the loading position A2 determined in step S25. The path planning unit 102 can set a distance from the turning-back position T to the loading position A2 in the extending direction of the skirt 202 of the excavation target 200 as the distance x2. - As illustrated in
Fig. 7 , the excavation position B2 and the loading position A2 are separated from each other by the distance x2 in the extending direction of the skirt 202. The distance x2 is set as the minimum distance by which the loading position A2 determined as the position at which material is loaded onto the loading target 300 is to be separated from the excavation position B2 at which the wheel loader 1 excavates the excavation target 200. - In step S27, the path planning unit 102 selects a loading position Ax at a position separated farther from the excavation position B2 than the loading position A2 in the extending direction of the skirt 202 of the excavation target 200. The path planning unit 102 selects the loading position Ax at a position separated from the excavation position B2 by a distance greatly larger than the distance x2. The loading position A2 is a position at which the distance between the excavation position B2 and the loading position A2 can be set to the minimum distance x2, and the loading target 300 may be disposed at a position separated farther from the excavation target 200 than the loading position A2. The distance between the excavation position B2 and the loading position Ax may be larger than the distance x2.
- The loading position Ax may be selected in consideration of other factors including a situation of the work site, the surrounding environment, and the like. For example, in a case where it is recognized that there is a depression or mud at the loading position A2, the loading position Ax may be selected such that the loading target 300 is separated from the excavation target 200 and the loading target 300 can travel while avoiding the depression or the mud.
- In step S28, the path planning unit 102 generates the shortest path that connects the loading position Ax and the excavation position B2. The path planning unit 102 determines a position separated from the skirt 202 of the excavation target 200 by the length L1 using the excavation position B2 as a starting point as the turning-back position T. The path planning unit 102 can generate a path of a straight line that connects the excavation position B2 and the turning-back position T as a path of unloaded advancing of the wheel loader 1 toward the excavation target 200 and as a path of loaded backing of the wheel loader 1 away from the excavation target 200.
- The path planning unit 102 can generate a path obtained by combining a straight line and a curve having any curvature such that the wheel loader 1 that starts performing loaded advancing from the turning-back position T causes the center point 6aC of the blade edge 6a of the bucket 6 to reach the loading position Ax of the loading target 300, and the width direction of the bucket 6 when the center point 6aC reaches the loading position Ax coincides with the front-rear direction of the loading target 300. Since the curvature radius of the curve included in this path is larger than the minimum radius in which the wheel loader 1 can turn without stationary steering, the wheel loader 1 can travel forward from the turning-back position T to the loading position Ax without stationary steering. The path planning unit 102 can set the generated path as a path for loaded advancing of the wheel loader 1 toward the loading target 300 and a path for unloaded backing of the wheel loader 1 away from the loading target 300.
- By a position separated from the turning-back position by a distance greatly larger than the distance x2 being set as the loading position Ax, the wheel loader 1 that performs loaded advancing from the turning-back position toward the loading position Ax can make the width direction of the bucket 6 coincide with the front-rear direction of the loading target 300 when the bucket 6 reaches the loading position Ax without stationary steering.
- The path planning unit 102 may generate a path such that the wheel loader 1 at the turning-back position takes a straight posture. The path planning unit 102 may generate a path such that a posture is taken in which the front frame 2a and the rear frame 2b are bent from each other at the turning-back position.
- In step S29, the path planning unit 102 gives an instruction of the loading position Ax and the angle θ2 to the loading target 300 such as a dump truck. The automation controller 100 outputs information indicating the loading position Ax and the angle θ2 to the communication device 150 (
Fig. 5 ). The information indicating the loading position Ax and the angle θ2 is transmitted to the loading target 300 via the communication device 150, and an instruction of a position at which the loading target 300 is to stop and a traveling direction of the loading target 300 to the stop position is given to the loading target 300. - In this way, a series of processing for generating a path of traveling of the wheel loader 1 is ended ("end" in
Fig. 8 ). - Although there is a description partially overlapping with the above description, the characteristic configurations and actions and effects of the present embodiment will be collectively described as follows.
- As illustrated in
Figs. 5 ,7 , and8 , the position estimation unit 101 of the automation controller 100 recognizes the excavation target 200 that is a heap of material excavated by the work implement 3 on the basis of a detection result of the perception device 111. The path planning unit 102 of the automation controller 100 selects the excavation position B2 at which the excavation target 200 is excavated on the basis of the shape of the excavation target 200. The path planning unit 102 calculates, by a dimension of the wheel loader 1, the minimum distance x2 by which the loading position in a case where the wheel loader 1 that executes the excavation and loading work turns without stationary steering and loads material onto the loading target 300 by adjusting the position and posture of the bucket 6 of the work implement 3 to the loading target 300 is to be separated from the excavation position B2. - The path of traveling in a case where the excavation and loading work is automatically controlled can be appropriately set by the shortest path on which traveling can be performed without stationary steering by the turning ability of the wheel loader 1 being determined from the dimension of the wheel loader 1. The shortest path on which the wheel loader 1 can perform V-shape traveling can be set, and the excavation and loading work can be efficiently executed.
- As illustrated in
Figs. 1 and7 , the dimension of the wheel loader 1 may include the dimension in the front-rear direction of the wheel loader 1. The distance x2 can be calculated from the length L1 or the like that is the total length of the wheel loader 1 in the front-rear direction, and the path of traveling in a case where the excavation and loading work is automatically controlled can be appropriately set. - As illustrated in
Fig. 7 , the path planning unit 102 can select, as the excavation position B2, a position that can minimize a travel distance by which the wheel loader 1 that excavates the excavation target 200 advances toward the excavation target 200 so as to load a certain amount of the material onto the work implement 3. By the path of traveling in a case where the wheel loader 1 performs the excavation work being set to the shortest path, the excavation work can be efficiently performed. - As illustrated in
Fig. 7 , the path planning unit 102 may determine the loading position Ax in a case where the material is loaded onto the loading target 300 at a position separated from the excavation position B2 by a distance greatly larger than the distance x2. The distance x2 is a minimum distance in which the wheel loader 1 can turn without stationary steering, and the wheel loader 1 can be caused to travel without stationary steering by the distance between the excavation position B2 and the loading position Ax being made larger than the distance x2. An appropriate loading position Ax can be determined in consideration of the situation of the work site, the surrounding environment, and the like. - As illustrated in
Figs. 5 and8 , the automation controller 100 may transmit the loading position Ax in a case where material is loaded onto the loading target 300 to the loading target 300. By the loading target 300 that has received a signal being caused to stop according to the loading position Ax, the wheel loader 1 can be caused to perform V-shape traveling in the shortest path, and the excavation and loading work can be efficiently executed. - As illustrated in
Fig. 7 , the path planning unit 102 may determine the turning-back position T at which the wheel loader 1 is switched from loaded backing to loaded advancing by the dimension of the wheel loader 1. The path planning unit 102 can determine a position separated from the excavation target 200 by the length L1 using the excavation position B2 as a starting point as the turning-back position T, and can appropriately set a path of traveling in a case where the excavation and loading work is automatically controlled. - As illustrated in
Figs. 1 and2 , the main body of the wheel loader 1 may include the front frame 2a and the rear frame 2b bendable with respect to the front frame 2a. The wheel loader 1 includes an articulated structure in which the front frame 2a and the rear frame 2b are bendable from each other, so that the turning radius in the case of turning traveling can be reduced. The path of traveling can be shortened in a case where the wheel loader 1 performs the excavation and loading work. - As illustrated in
Fig. 7 , the wheel loader 1 may take a straight posture in which the front frame 2a and the rear frame 2b are not bent from each other in a case where the excavation target 200 is excavated and in a case where the material loaded on the work implement 3 is loaded onto the loading target 300. By the wheel loader 1 taking a straight posture in a case where the excavation target 200 is excavated, the traction force of the vehicle can be sufficiently transmitted to the bucket 6 at the distal end of the work implement 3. By the wheel loader 1 taking a straight posture in a case where the material is loaded onto the loading target 300, the vehicle can be stabilized. - In the above embodiment, the position estimation unit 101 of the automation controller 100 recognizes the position of the loading target 300 on the basis of a detection result of the perception device 111. The present disclosure is not limited thereto, and information of the self-position of the loading target 300 may be input from the loading target 300 to the automation controller 100 by inter-vehicle communication between the automation controller 100 and the loading target 300 via the communication device 150. The position estimation unit 101 can recognize the relative position of the loading target 300 with respect to the wheel loader 1 from information of the current position of the wheel loader 1 acquired by the position information acquisition device 112 and information of the self-position of the loading target 300. The position estimation unit 101 can recognize the relative position of the loading target 300 with respect to the excavation target 200 from the information of the excavation target 200 acquired by the perception device 111 and the relative position of the loading target 300 with respect to the wheel loader 1.
- The automation controller 100 that forms the automatic control system of the wheel loader 1 described in the above embodiment is not necessarily mounted on the wheel loader 1. A controller outside the wheel loader 1 may construct a system included in the automation controller 100. A controller mounted on the wheel loader 1 may perform processing of transmitting information acquired by the external information acquisition unit 110, the vehicle information acquisition unit 120, and the like to an external controller, and the external controller that has received a signal may generate a travel path of the wheel loader 1.
- The external controller may be disposed at a work site of the wheel loader 1, or may be disposed at a remote place away from the work site of the wheel loader 1. The external controller may be a portable device. The external controller may be a portable device that can be carried and used by a worker, such as a notebook computer, a tablet computer, or a smartphone.
- In the embodiment, the dump truck is exemplified as the loading target 300, and the work of loading material loaded on the work implement 3 (bucket 6) onto the vessel 301 has been described. The loading target 300 for loading material in the bucket 6 is not limited to the vessel 301 of the dump truck, and may be, for example, a hopper.
- In the embodiment, an example has been described in which the excavation target 200 and the loading target 300 are detected by the perception device 111 mounted on the wheel loader 1. An object sensor that detects an object around the main body of the wheel loader 1 (work machine main body) is not necessarily mounted on the wheel loader 1. The object sensor may be disposed outside the work machine. For example, the object sensor may be disposed at a predetermined point of the work site, may be mounted on another work machine, or may be mounted on an unmanned aerial vehicle such as a drone.
- In the embodiment, an example has been described in which the wheel loader 1 includes the cab 5 and is a manned vehicle in which the operator boards the cab 5. The wheel loader 1 may be an unmanned vehicle. The wheel loader 1 may not include the cab 5 for the operator to board and operate. The wheel loader 1 may not include a steering function by a boarded operator. The wheel loader 1 may be a work machine dedicated to remote control. The operation of the wheel loader 1 may be performed by a wireless signal from a remote control device.
- The above description includes the following features.
- A system including a work machine, including:
- a work machine main body including a travel body;
- a work implement attached to the work machine main body;
- a sensor that detects an object around the work machine main body; and
- a controller that generates a travel path of the travel body, in which
- the object includes an excavation target that is a heap of material excavated by the work implement,
- the travel path includes an excavation position at which the work machine excavates the excavation target and a loading position in a case where the material is loaded onto a loading target onto which the material is loaded, and
- the controller recognizes the excavation target on a basis of a detection result of the sensor, selects the excavation position, and calculates a minimum distance by which the loading position is to be separated from the excavation position by a dimension of the work machine.
- The system according to Supplement 1, in which a dimension of the work machine includes a dimension in a front-rear direction of the work machine.
- The system according to Supplement 1 or 2, in which the controller selects, as the excavation position, a position that can minimize a travel distance by which the work machine that excavates the excavation target advances toward the excavation target so as to load a certain amount of the material onto the work implement.
- The system according to any one of Supplements 1 to 3, in which the controller determines the loading position in a case where the material is loaded onto the loading target at a position separated from the excavation position by a distance greatly larger than the minimum distance.
- The system according to Supplement 4, in which the controller transmits the loading position at which the material is loaded onto the loading target to the loading target.
- The system according to any one of Supplements 1 to 5, in which the controller determines a turning-back position at which the work machine is switched from loaded backing to loaded advancing by a dimension of the work machine.
- The system according to any one of Supplements 1 to 6, in which the work machine main body includes a front frame and a rear frame bendable with respect to the front frame.
- The system according to Supplement 7, in which the work machine takes a straight posture in which the front frame and the rear frame are not bent from each other in a case where the excavation target is excavated and in a case where the material loaded on the work implement is loaded onto the loading target.
- The system according to any one of Supplements 1 to 8, in which the controller recognizes a shape of the excavation target, and selects the excavation position on a basis of a shape of the excavation target.
- It should be understood that the embodiments disclosed herein are illustrative in all respects and not restrictive. The scope of the present invention is defined not by the above description but by the claims, and is intended to include meanings equivalent to the claims and all modifications within the scope.
-
- 1
- Wheel loader
- 2
- Vehicle body frame
- 2a
- Front frame
- 2b
- Rear frame
- 3
- Work implement
- 4
- Travel device
- 4a
- Front wheel
- 4b
- Rear wheel
- 6
- Bucket
- 6a
- Blade edge
- 6aC
- Center point
- 6c
- Width direction center
- 14
- Boom
- 50
- Vehicle body controller
- 60
- Engine controller
- 70
- Transmission controller
- 80
- Work implement controller
- 100
- Automation controller
- 101
- Position estimation unit
- 102
- Path planning unit
- 103
- Path follow-up control unit
- 110
- External information acquisition unit
- 111
- Perception device
- 120
- Vehicle information acquisition unit
- 150
- Communication device
- 200
- Excavation target
- 201
- Top portion
- 202
- Skirt
- 203
- Low heap area
- 204
- Accumulation area
- 300
- Loading target
- 301
- Vessel
- 306
- Rear upper edge
- Ax
- Loading position
- B2
- Excavation position
- P
- Path
- T
- Turning-back position
- x2
- Distance.
Claims (11)
- A system comprising a work machine, comprising:a work machine main body including a travel body;a work implement attached to the work machine main body;a sensor that detects an object around the work machine main body; anda controller that generates a travel path of the travel body, whereinthe object includes an excavation target that is a heap of material excavated by the work implement,the travel path includes an excavation position at which the work machine excavates the excavation target and a loading position in a case where the material is loaded onto a loading target onto which the material is loaded, andthe controller recognizes the excavation target on a basis of a detection result of the sensor, selects the excavation position, and calculates a minimum distance by which the loading position is to be separated from the excavation position by a dimension of the work machine.
- The system according to claim 1, wherein a dimension of the work machine includes a dimension in a front-rear direction of the work machine.
- The system according to claim 1 or 2, wherein the controller selects, as the excavation position, a position that can minimize a travel distance by which the work machine that excavates the excavation target advances toward the excavation target so as to load a certain amount of the material onto the work implement.
- The system according to claim 1 or claim 2, wherein the controller determines the loading position in a case where the material is loaded onto the loading target at a position separated from the excavation position by a distance greatly larger than the minimum distance.
- The system according to claim 4, wherein the controller transmits the loading position at which the material is loaded onto the loading target to the loading target.
- The system according to claim 1 or 2, wherein the controller determines a turning-back position at which the work machine is switched from loaded backing to loaded advancing by a dimension of the work machine.
- The system according to claim 1 or 2, wherein the work machine main body includes a front frame and a rear frame bendable with respect to the front frame.
- The system according to claim 7, wherein the work machine takes a straight posture in which the front frame and the rear frame are not bent from each other in a case where the excavation target is excavated and in a case where the material loaded on the work implement is loaded onto the loading target.
- The system according to claim 1 or 2, wherein the controller recognizes a shape of the excavation target, and selects the excavation position on a basis of a shape of the excavation target.
- A controller for a work machine of a work machine including a travel body and a work implement, the controller generating a travel path of the travel body,
whereinthe travel path includes an excavation position at which the work machine excavates an excavation target that is a heap of material excavated by the work implement and a loading position in a case where the material is loaded onto a loading target onto which the material is loaded, andthe controller recognizes the excavation target on a basis of a detection result of a sensor that detects an object around a work machine main body,selects the excavation position, andcalculates a minimum distance by which the loading position is to be separated from the excavation position by a dimension of the work machine. - A path generation method for a work machine of a work machine including a travel body and a work implement, the path generation method being for generating a travel path of the travel body, whereinthe travel path includes an excavation position at which the work machine excavates an excavation target that is a heap of material excavated by the work implement and a loading position in a case where the material is loaded onto a loading target onto which the material is loaded, andthe path generation method comprising:recognizing the excavation target on a basis of a detection result of a sensor that detects an object around a work machine main body;selecting the excavation position; andcalculating a minimum distance by which the loading position is to be separated from the excavation position by a dimension of the work machine.
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2023026535A JP2024119549A (en) | 2023-02-22 | 2023-02-22 | SYSTEM INCLUDING WORK MACHINE, CONTROLLER FOR WORK MACHINE, AND ROUTE GENERATION METHOD FOR WORK MACHINE |
| PCT/JP2024/004468 WO2024176867A1 (en) | 2023-02-22 | 2024-02-09 | Work machine-including system, work machine controller, and work machine path generation method |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| EP4644620A1 true EP4644620A1 (en) | 2025-11-05 |
Family
ID=92501044
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| EP24760169.3A Pending EP4644620A1 (en) | 2023-02-22 | 2024-02-09 | Work machine-including system, work machine controller, and work machine path generation method |
Country Status (3)
| Country | Link |
|---|---|
| EP (1) | EP4644620A1 (en) |
| JP (1) | JP2024119549A (en) |
| WO (1) | WO2024176867A1 (en) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2026070086A (en) * | 2024-10-15 | 2026-04-27 | 株式会社小松製作所 | Control system for a work machine, method for controlling a work machine, and work machine |
Citations (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2022157259A (en) | 2021-03-31 | 2022-10-14 | 株式会社小松製作所 | System, method and work vehicle |
Family Cites Families (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH0592816A (en) * | 1991-09-30 | 1993-04-16 | Komatsu Ltd | Unmanned vehicle unloading method and unloading apparatus |
| JPH1088625A (en) * | 1996-09-13 | 1998-04-07 | Komatsu Ltd | Automatic excavator, automatic excavation method and automatic loading method |
| JPH10212035A (en) * | 1997-01-28 | 1998-08-11 | Komatsu Ltd | Work control device for loading / unloading vehicles |
| JP3291707B2 (en) * | 1997-01-28 | 2002-06-10 | 中小企業総合事業団 | Apparatus and method for guiding and guiding a mobile object |
| US6167336A (en) * | 1998-05-18 | 2000-12-26 | Carnegie Mellon University | Method and apparatus for determining an excavation strategy for a front-end loader |
| WO2021102333A1 (en) * | 2019-11-20 | 2021-05-27 | Autonomous Solutions, Inc. | Autonomous loader controller |
-
2023
- 2023-02-22 JP JP2023026535A patent/JP2024119549A/en active Pending
-
2024
- 2024-02-09 EP EP24760169.3A patent/EP4644620A1/en active Pending
- 2024-02-09 WO PCT/JP2024/004468 patent/WO2024176867A1/en not_active Ceased
Patent Citations (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2022157259A (en) | 2021-03-31 | 2022-10-14 | 株式会社小松製作所 | System, method and work vehicle |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2024119549A (en) | 2024-09-03 |
| WO2024176867A1 (en) | 2024-08-29 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN111771031B (en) | System and method for controlling work machine | |
| EP4545712A1 (en) | System including work machine, work machine controller, and method of controlling work machine | |
| WO2024176867A1 (en) | Work machine-including system, work machine controller, and work machine path generation method | |
| EP4545711A1 (en) | System including work machine, for work machine controller, and method of controlling work machine | |
| EP4644621A1 (en) | Work machine-including system, work machine controller, and work machine path generation method | |
| WO2024043075A1 (en) | Work machine, system including work machine, and method for controlling work machine | |
| EP4603643A1 (en) | System including work machine, control method of work machine, and controller of work machine | |
| EP4603644A1 (en) | System including work machine, method for controlling work machine, and controller for work machine | |
| EP4610440A1 (en) | System including work machine, method for controlling work machine, and controller for work machine | |
| EP4545713A1 (en) | System including work machine and method of controlling work machine | |
| EP4653625A1 (en) | System, controller for work machine, and method for deciding material positioning | |
| EP4653624A1 (en) | Work machine-including system, work machine controller, and work machine path generation method | |
| JP2025134217A (en) | System including a work machine, work machine, and method for automatically controlling a work machine | |
| JP2026009536A (en) | Method, controller for a work machine, and system including a work machine | |
| WO2026083851A1 (en) | Control system for work machine, control method for work machine, and work machine | |
| JP2025153585A (en) | System including a work machine, work machine, and automatic travel control method for a work machine | |
| US20250333935A1 (en) | Work machine, system including work machine, and method of controlling work machine | |
| JP2025134216A (en) | System including a work machine, work machine, and automatic travel control method for a work machine | |
| WO2025022879A1 (en) | Work machine, system including work machine, and method for controlling work machine | |
| JP2024036922A (en) | Work machines, systems including work machines, and control methods for work machines |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE INTERNATIONAL PUBLICATION HAS BEEN MADE |
|
| PUAI | Public reference made under article 153(3) epc to a published international application that has entered the european phase |
Free format text: ORIGINAL CODE: 0009012 |
|
| STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: REQUEST FOR EXAMINATION WAS MADE |
|
| 17P | Request for examination filed |
Effective date: 20250729 |
|
| AK | Designated contracting states |
Kind code of ref document: A1 Designated state(s): AL AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC ME MK MT NL NO PL PT RO RS SE SI SK SM TR |