System and method for controlling work vehicle

The system addresses the challenge of varying turning performance by adjusting steering angles based on load state, enabling accurate navigation in work vehicles with changing loads.

JP2024169198APending Publication Date: 2024-12-05KOMATSU LTD
View PDF 1 Cites 0 Cited by

Patent Information

Application Number
JP2023086461
Authority / Receiving Office
JP · JP
Patent Type
Applications
Current Assignee / Owner
Filing Date
2023-05-25
Publication Date
2024-12-05

AI Technical Summary

Technical Problem

The turning performance of a work vehicle differs between an unloaded state and a loaded state due to changes in load applied to the work machine, making it challenging to control steering effectively in both conditions.

Method used

A system for controlling a work vehicle that includes sensors to detect whether a work implement is supporting a transported object, and a controller that adjusts steering angle commands based on the load state, outputting different steering angles for unloaded and loaded states.

Benefits of technology

The system enables the work vehicle to turn appropriately regardless of load changes, ensuring precise navigation along a target route.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 2024169198000001_ABST
    Figure 2024169198000001_ABST
Patent Text Reader

Abstract

To allow a work vehicle to make appropriate turns even when the load on a work machine changes.SOLUTION: A system for controlling a work vehicle is provided, comprising a sensor for detecting whether a work machine of the work vehicle is supporting goods or not, and a controller for controlling the work vehicle. The controller is configured to provide automatic control of steering of the work vehicle so as to make the work vehicle travel along a target route, output a first steering angle instruction value for adjusting the steering angle of the work vehicle when in an unloaded state where no goods are supported, and output a second steering instruction value for adjusting the steering angle when in a loaded state where goods are supported.SELECTED DRAWING: Figure 19
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present disclosure relates to systems and methods for controlling a work vehicle. [Background technology]

[0002] 2. Description of the Related Art In the technical field relating to work vehicles, a forklift as disclosed in Patent Document 1 is known. [Prior art documents] [Patent documents]

[0003] [Patent Document 1] JP 2019-036302 A Summary of the Invention [Problem to be solved by the invention]

[0004] A work vehicle is equipped with a working machine that supports an object to be transported. There is a possibility that a difference in the turning performance of the work vehicle occurs between an unloaded state in which no object is supported by the working machine and a loaded state in which the object is supported by the working machine. When the steering of the work vehicle is automatically controlled, it is required that the work vehicle be able to turn appropriately in both an unloaded state and a loaded state.

[0005] An object of the present disclosure is to properly turn a work vehicle even when the load applied to the work machine changes. [Means for solving the problem]

[0006] According to the present disclosure, there is provided a system for controlling a work vehicle. The system includes a sensor for detecting whether or not a work implement of the work vehicle is supporting a transported load, and a controller for controlling the work vehicle. The controller automatically controls steering of the work vehicle so that the work vehicle travels along a target route, and outputs a first steering angle command value for adjusting the steering angle of the work vehicle in an unloaded state in which no transported load is supported, and outputs a second steering angle command value for adjusting the steering angle in a loaded state in which a transported load is supported. Effect of the Invention

[0007] According to the present disclosure, the work vehicle turns appropriately even if the load on the work implement changes. [Brief description of the drawings]

[0008] [Figure 1] FIG. 1 is a perspective view showing a work vehicle according to an embodiment, seen from the front. [Diagram 2] FIG. 2 is a diagram illustrating an object sensor according to the embodiment. [Diagram 3] FIG. 3 is a view of the work vehicle according to the embodiment as viewed from above. [Figure 4] FIG. 4 is a diagram illustrating a first front sensor according to the embodiment. [Diagram 5] FIG. 5 is a diagram illustrating a state in which the second front sensor according to the embodiment detects an object. [Figure 6] FIG. 6 is a diagram illustrating a state in which the second front sensor according to the embodiment detects an object. [Figure 7] FIG. 7 is a block diagram showing the configuration of a control system for controlling a work vehicle according to this embodiment. [Figure 8] FIG. 8 is a block diagram illustrating a controller according to an embodiment. [Figure 9] FIG. 9 is a schematic diagram illustrating an example of a method for identifying an object according to an embodiment. [Figure 10] FIG. 10 is a schematic diagram showing the positions of the load spaces present around the target according to the embodiment. [Figure 11] FIG. 11 is a diagram showing a loading and unloading operation according to the embodiment. [Figure 12] FIG. 12 is a flowchart showing a control method for a work vehicle according to this embodiment. [Figure 13] FIG. 13 is a diagram showing an example of display data displayed on the display device when the automatic mode permission switch according to the embodiment is operated. [Figure 14]FIG. 14 is a diagram showing an example of display data displayed on the display device when the automatic mode start switch according to the embodiment is operated. [Figure 15] FIG. 15 is a diagram illustrating a relationship between distance and route data according to the embodiment. [Figure 16] FIG. 16 is a diagram that illustrates a work vehicle traveling so as to approach a target based on a generated route according to the embodiment. [Figure 17] FIG. 17 is a diagram for explaining a target route according to the embodiment. [Figure 18] FIG. 18 is a diagram that illustrates a work vehicle turning along a curved path according to the embodiment. [Figure 19] FIG. 19 is a flowchart showing the routine of step S8 according to the embodiment. [Figure 20] FIG. 20 is a diagram that illustrates a state in which the work vehicle according to the embodiment is approaching a target. [Figure 21] FIG. 21 is a diagram that illustrates a state in which a work vehicle according to an embodiment is approaching a target. [Figure 22] FIG. 22 is a diagram that illustrates a state in which the work vehicle according to the embodiment is approaching a target. [Diagram 23] FIG. 23 is a flowchart showing the routine of step S12 according to the embodiment. [Figure 24] FIG. 24 is a diagram for explaining the end condition of the automatic driving control according to the embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0009] Hereinafter, an embodiment according to the present disclosure will be described with reference to the drawings, but the present disclosure is not limited to the embodiment. The components of the embodiments described below can be appropriately combined. In addition, some components may not be used.

[0010] In the embodiment, the positional relationship of each part will be described using the terms left, right, front, rear, top, and bottom. These terms indicate relative positions or directions based on the origin of a vehicle body coordinate system defined for the work vehicle.

[0011] [Work vehicle] FIG. 1 is a front perspective view showing a work vehicle 1 according to an embodiment. In the embodiment, the work vehicle 1 is a forklift, which is a type of loading and unloading vehicle. In the embodiment, the work vehicle 1 is appropriately referred to as a forklift 1. In the embodiment, the work vehicle 1 is a counterbalanced forklift. Note that the work vehicle is not limited to a forklift. The work vehicle may be, for example, a wheel loader to which a fork attachment can be attached.

[0012] The forklift 1 performs a loading and unloading operation. The loading and unloading operation includes a loading and unloading operation of picking up an object placed in a predetermined storage position and a loading and unloading operation of placing the picked up object in a predetermined target position. The forklift 1 performs at least a part of the loading and unloading operation automatically. In the embodiment, the operation modes of the forklift 1 include a manual mode in which the loading and unloading operation is performed based on the operation of an operator, and an automatic mode in which at least a part of the loading and unloading operation is performed automatically. In the embodiment, the object is a loading platform or a container on which luggage is loaded. The object is, for example, a pallet, a skid, or a container. The object has a pair of fork insertion holes.

[0013] The forklift 1 includes a vehicle body 2, a cab 3 supported by the vehicle body 2, a work implement 4 disposed in front of the vehicle body 2, wheels 5 supporting the vehicle body 2, and an object sensor 7 for detecting objects.

[0014] The vehicle body 2 includes a counterweight 6 and a fender 8. The counterweight 6 is disposed at the rear of the vehicle body 2. The counterweight 6 is attached to the rear of the vehicle body 2 in order to balance the weight of the forklift 1 in the front-to-rear direction when the forklift 1 picks up an object to be transported. The fender 8 is disposed at the front of the vehicle body 2. The fenders 8 are disposed on both the left and right sides of the vehicle body 2.

[0015] The cab 3 forms a driver's cab. An operator of the forklift 1 can operate the forklift 1 by getting into the cab 3.

[0016] The work machine 4 performs at least a part of the loading and unloading work. The work machine 4 is disposed in front of the vehicle body 2. The work machine 4 is supported by the vehicle body 2. The work machine 4 has a mast 41, a bracket 42, and a fork 43.

[0017] The mast 41 is supported at the front of the vehicle body 2 so as to be tiltable. The mast 41 is long in the vertical direction. The bracket 42 supports the fork 43. The bracket 42 is supported by the mast 41. The bracket 42 is movable in the vertical direction along the mast 41. The fork 43 supports an object to be transported. The fork 43 is supported by the mast 41 via the bracket 42.

[0018] A pair of forks 43 are provided. The forks 43 include a first fork 43A and a second fork 43B disposed to the right of the first fork 43A. The bracket 42 supports the first fork 43A and the second fork 43B.

[0019] The wheels 5 support the vehicle body 2. At least a portion of the wheels 5 is disposed below the vehicle body 2. The wheels 5 have front wheels 5F and rear wheels 5R. The front wheels 5F are disposed forward of the rear wheels 5R. The front wheels 5F are disposed on the left and right sides of the vehicle body 2. The rear wheels 5R are disposed on the left and right sides of the vehicle body 2. Each of the front wheels 5F and the rear wheels 5R can rotate around a rotation axis. One or both of the front wheels 5F and the rear wheels 5R are steered wheels. In the embodiment, the rear wheels 5R are steered wheels. Note that the front wheels 5F may be steered wheels, or both the front wheels 5F and the rear wheels 5R may be steered wheels.

[0020] In the embodiment, the left-right direction is a direction parallel to the rotation axes of the front wheels 5F and the rear wheels 5R when the forklift 1 travels in a straight line. The up-down direction is a direction perpendicular to the ground contact surfaces of the front wheels 5F and the rear wheels 5R. The front-rear direction is a direction perpendicular to both the left-right direction and the up-down direction.

[0021] The fender 8 is positioned so as to cover at least a portion of the front wheel 5F. At least a portion of the fender 8 is positioned higher than the front wheel 5F. At least a portion of the fender 8 is positioned rearward of the front wheel 5F. The fenders 8 are positioned on both the left and right sides of the vehicle body 2. The left fender 8 is positioned so as to cover at least a portion of the left front wheel 5F. The right fender 8 is positioned so as to cover at least a portion of the right front wheel 5F.

[0022] The object sensor 7 detects objects around the forklift 1. Objects detected by the object sensor 7 include targets that are targeted when performing loading and unloading operations. In the embodiment, the targets are, for example, transported goods, a loading space in which the transported goods can be placed, or the bed of a cargo vehicle. A plurality of object sensors 7 are provided on the forklift 1. In the embodiment, the object sensors 7 include a left side sensor 7A attached to the left side of the vehicle body 2, a right side sensor 7B (see FIG. 3) attached to the right side of the vehicle body 2, a first front sensor 7C attached to the front of the vehicle body 2, and a second front sensor 7D attached to at least a part of the work implement 4.

[0023] 2 is a diagram illustrating an object sensor 7 according to an embodiment. The object sensor 7 includes at least a three-dimensional sensor 72. In the embodiment, the object sensor 7 includes a camera 71 and a three-dimensional sensor 72. The camera 71 and the three-dimensional sensor 72 are arranged in the up-down direction. The camera 71 and the three-dimensional sensor 72 are fixed. The relative positions of the camera 71 and the three-dimensional sensor 72 do not change.

[0024] The camera 71 acquires image data of an object. The three-dimensional sensor 72 acquires three-dimensional data of the object. The three-dimensional data of the object includes a point cloud consisting of a plurality of detection points defined on the surface of the object. The point cloud indicates the relative distance and relative position between the three-dimensional sensor 72 and each of the plurality of detection points defined on the surface of the object. An example of the three-dimensional sensor 72 is a laser sensor (LiDAR: Light Detection and Ranging) that detects an object by emitting laser light. Note that the three-dimensional sensor 72 may be an infrared sensor that detects an object by emitting infrared light or a radar sensor (RADAR: Radio Detection and Ranging) that detects an object by emitting radio waves.

[0025] An imaging range 710 of the camera 71 overlaps at least a portion of a measurement range 720 of the three-dimensional sensor 72. In the following description, the imaging range 710 and the measurement range 720 are collectively referred to as a detection range 70 as appropriate.

[0026] Fig. 3 is a top view of the forklift 1 according to the embodiment. As shown in Fig. 1 and Fig. 3, the forklift 1 is equipped with a plurality of object sensors 7. The object sensors 7 include a left side sensor 7A attached to the left side of the vehicle body 2, a right side sensor 7B attached to the right side of the vehicle body 2, a first front sensor 7C attached to the front of the vehicle body 2, and a second front sensor 7D attached to at least a part of the work implement 4.

[0027] The detection range 70 of the object sensor 7 includes a detection range 70A of the left side sensor 7A, a detection range 70B of the right side sensor 7B, a detection range 70C of the first front sensor 7C, and a detection range 70D of the second front sensor 7D.

[0028] A detection range 70A of the left side direction sensor 7A is defined diagonally forward and to the left of the vehicle body 2. A detection range 70B of the right side direction sensor 7B is defined diagonally forward and to the right of the vehicle body 2. A detection range 70C of the first front sensor 7C is defined in front of the vehicle body 2. A detection range 70D of the second front sensor 7D is defined in front of the vehicle body 2.

[0029] In the front-rear direction, the left side sensor 7A and the right side sensor 7B are each disposed rearward of the work implement 4. The left side sensor 7A and the right side sensor 7B are each disposed rearward of the mast 41.

[0030] The left side sensor 7A and the right side sensor 7B are each disposed forward of the center of the vehicle body 2 in the front-rear direction.

[0031] In the vertical direction, the left side sensor 7A and the right side sensor 7B are disposed between the center of the front wheel 5F and the upper end of the counterweight 6, respectively.

[0032] In this embodiment, the left side direction sensor 7A is attached to an upper surface of the left side fender 8. The right side direction sensor 7B is attached to an upper surface of the right side fender 8.

[0033] In the front-rear direction, the first front sensor 7C is disposed rearward of the work implement 4. The first front sensor 7C is disposed rearward of the mast 41. The first front sensor 7C is attached to the front of the vehicle body 2 so as to be disposed rearward of the work implement 4.

[0034] In the embodiment, the first front sensor 7C is attached to the upper surface of the left fender 8. The first front sensor 7C may be attached to the upper surface of the right fender 8.

[0035] The first front sensor 7C can detect an object that is close to the ground. In the vertical direction, the position of the detection range 70C of the first front sensor 7C coincides with the position of at least a part of the front wheel 5F. In the vertical direction, the position of at least a part of the detection range 70C of the first front sensor 7C coincides with the position of the lower end of the movable range of the fork 43 in the vertical direction.

[0036] The second front sensor 7D is attached to at least a part of the work implement 4 so as to move in the up and down direction together with the fork 43. In the left-right direction, the second front sensor 7D is disposed between the first fork 43A and the second fork 43B. In the embodiment, the second front sensor 7D is attached to the bracket 42. The second front sensor 7D is attached to the bracket 42 so as to be disposed between the first fork 43A and the second fork 43B in the left-right direction.

[0037] [First forward sensor] 4 is a diagram showing a first front sensor 7C according to the embodiment. As shown in FIG. 4, when the fork 43 supports an object 50, the second front sensor 7D may be blocked by the object 50 and may not be able to detect an object in front of the forklift 1. In the embodiment, the forklift 1 includes the first front sensor 7C attached to the front of the vehicle body 2. Therefore, even if a situation occurs in which the second front sensor 7D cannot detect an object in front of the forklift 1, the first front sensor 7C can detect the object in front of the forklift 1.

[0038] As described above, in the vertical direction, at least a part of the detection range 70C of the first front sensor 7C coincides with the lower end of the movable range of the fork 43 in the vertical direction. As shown in Fig. 3, when the forklift 1 travels with the fork 43 supporting the object 50, the fork 43 is raised. Therefore, the first front sensor 7C can detect an object in front of the forklift 1 without being blocked by the object 50.

[0039] [Second forward sensor] 5 and 6 are diagrams each showing a state in which the second front sensor 7D according to the embodiment detects the object 50. As shown in FIG. 5 and FIG. 6, the second front sensor 7D can detect the object 50 when the work machine 4 and the object 50 are facing each other. The second front sensor 7D can move in the vertical direction together with the fork 43. Therefore, in each of the cases where the object 50 supported by the fork 43 is disposed downward as shown in FIG. 5 and where the object 50 supported by the fork 43 is disposed upward as shown in FIG. 6, the second front sensor 7D can detect the fork insertion hole and the fork 43 provided in the object 50 by moving in the vertical direction together with the fork 43. In other words, regardless of the position of the fork insertion hole in the vertical direction, the second front sensor 7D can detect the fork insertion hole and the fork 43 by moving in the vertical direction together with the fork 43.

[0040] [Control System] Fig. 7 is a block diagram showing the configuration of a control system 10 for controlling a work vehicle 1 according to an embodiment. As shown in Fig. 7, the control system 10 includes a power source 11, a hydraulic pump 12, a work machine drive device 45, a traveling device 14, a control valve unit 13, an operation device 15, an output device 16, and a controller 100.

[0041] The power source 11 drives the hydraulic pump 12. The power source 11 is, for example, an engine.

[0042] The hydraulic pump 12 is driven by the power source 11 and discharges hydraulic oil. The hydraulic oil discharged from the hydraulic pump 12 is supplied to each of the lift cylinder 451, the tilt cylinder 452, the side shift cylinder 453, the travel motor 141, and the steering cylinder 142 via the control valve unit 13.

[0043] The work machine driving device 45 operates the work machine 4. The work machine driving device 45 has a lift cylinder 451, a tilt cylinder 452, and a side shift cylinder 453.

[0044] In the embodiment, each of the lift cylinder 451, the tilt cylinder 452, and the side shift cylinder 453 is a hydraulic cylinder. The lift cylinder 451 moves the fork 43 in the up-down direction relative to the vehicle body 2. The tilt cylinder 452 tilts the fork 43 in the front-rear direction relative to the vehicle body 2. The side shift cylinder 453 moves the fork 43 in the left-right direction relative to the vehicle body 2.

[0045] The lift cylinder 451 is disposed between the mast 41 and the bracket 42. The lift cylinder 451 moves the bracket 42 in the vertical direction, thereby moving the fork 43 in the vertical direction. The bracket 42 and the fork 43 move together in the vertical direction. The bracket 42 and the fork 43 move in the vertical direction along the mast 41. The tilt cylinder 452 is disposed between the vehicle body 2 and the mast 41. The tilt cylinder 452 tilts the mast 41 in the longitudinal direction, thereby tilting the fork 43 in the longitudinal direction.

[0046] The traveling device 14 causes the forklift 1 to travel. The traveling device 14 advances, brakes, and steers the forklift 1. Advancement means that the forklift 1 moves forward or backward. Braking means that the forklift 1 decelerates or stops. Steering means that the traveling direction of the forklift 1 is changed. The traveling device 14 has a traveling motor 141, a brake device (not shown), and a steering cylinder 142.

[0047] The traveling motor 141 generates a driving force for moving the forklift 1 forward or backward by rotating the front wheels 5F. The traveling motor 141 is driven by hydraulic oil discharged from the hydraulic pump 12. The front wheels 5F are driving wheels that rotate by the rotational force generated by the traveling motor 141. The braking device brakes the forklift 1. The braking device decelerates or stops the forklift 1.

[0048] The steering cylinder 142 steers the forklift 1. The steering cylinder 142 steers the rear wheels 5R to change the traveling direction of the forklift 1. The rear wheels 5R are steered wheels that are steered by the steering cylinder 142.

[0049] The control valve unit 13 is disposed between the hydraulic actuators, such as the lift cylinder 451, the tilt cylinder 452, the side shift cylinder 453, the travel motor 141, and the steering cylinder 142, and the hydraulic pump 12. The control valve unit 13 has a travel control valve 131 that controls the flow rate and direction of hydraulic oil supplied to the travel motor 141, a steering control valve 132 that controls the flow rate and direction of hydraulic oil supplied to the steering cylinder 142, and a work equipment control valve 133 that controls the flow rate and direction of hydraulic oil supplied to each of the lift cylinder 451, the tilt cylinder 452, and the side shift cylinder 453. The control valve unit 13 is controlled by a controller 100, which will be described later.

[0050] The operation device 15 is a device for operating the forklift 1. The operation device 15 is disposed in the cab 3. The operation device 15 receives operations by the operator for operating the work implement drive device 45 and the traveling device 14, and outputs an operation signal corresponding to the operation. In the manual mode, the forklift 1 operates based on the operation of the operation device 15 by the operator. The operation device 15 has, for example, a steering wheel 151, a work implement lever 152, a forward / reverse switch lever 153, an accelerator pedal 154, a brake pedal 155, an automatic mode permission switch 156, and an automatic mode start switch 157.

[0051] In the manual mode, the rear wheels 5R are steered by the operator operating the steering wheel 151. In the manual mode, the position and attitude of the forks 43 are adjusted by the operator operating the work equipment lever 152. The forward / reverse switch lever 153 is operated by the operator to switch the forklift 1 between forward and reverse. The traveling speed of the forklift 1 is adjusted by the operator operating at least one of the accelerator pedal 154 and the brake pedal 155.

[0052] The automatic mode permission switch 156 generates a control command to start a process of identifying an object for automatically carrying out loading and unloading work by being operated by an operator. In the manual mode, when the automatic mode permission switch 156 is operated, the controller 100 starts a process of identifying an object based on the object detection data of the object sensor 7.

[0053] The automatic mode start switch 157 generates a control command to start automatic travel control or automatic work machine control when operated by an operator. When the automatic mode start switch 157 is operated after the automatic mode permission switch 156 is operated, the controller 100 transitions the operation mode of the forklift 1 from the manual mode to the automatic mode.

[0054] The output device 16 is disposed in the cab 3. The output device 16 provides output data to the operator. In the embodiment, the output device 16 includes a display device 161 and an audio output device 162. The display device 161 provides display data to the operator as output data. An example of the display device 161 is a flat panel display such as a liquid crystal display (LCD) or an organic electroluminescence display (OELD). The audio output device 162 provides audio data to the operator as output data. An example of the audio output device 162 is a buzzer or a speaker. The output device 16 may include a lamp.

[0055] The controller 100 controls the forklift 1. The controller 100 controls at least one of the traveling of the forklift 1 and the working machine 4. As described above, the operation modes of the forklift 1 include the manual mode and the automatic mode. In the manual mode, the forklift 1 performs a loading and unloading operation based on the driving operation of the operator. In the automatic mode, the forklift 1 automatically performs at least a part of the loading and unloading operation based on the object detection data of the object sensor 7.

[0056] In the automatic mode, at least one of the traveling device 14 and the work machine drive device 45 is automatically controlled by the controller 100. In the automatic mode, the controller 100 controls at least one of the traveling device 14 and the work machine drive device 45 based on object detection data from the object sensor 7. In the following description, the automatic control of the traveling device 14 in the automatic mode will be appropriately referred to as automatic traveling control, and the automatic control of the work machine drive device 45 in the automatic mode will be appropriately referred to as automatic work machine control.

[0057] In the embodiment, the automatic travel control includes automatically controlling the steering of the forklift 1. In the automatic mode, the steering cylinder 142 is automatically controlled by the controller 100.

[0058] In the embodiment, the automatic control of the work machine includes automatically controlling the position and attitude of the fork 43. In the automatic mode, at least one of the lift cylinder 451, the tilt cylinder 452, and the side shift cylinder 453 is automatically controlled by the controller 100.

[0059] The control system 10 includes a vehicle speed sensor 143 which detects the traveling speed of the forklift 1, a steering sensor 144 which detects the steering angle of the rear wheel 5R, a lift sensor 46 which detects the vertical position of the fork 43 relative to the vehicle body 2, a tilt sensor 47 which detects the fore-aft inclination of the fork 43 relative to the vehicle body 2, a side shift sensor 48 which detects the left-right position of the fork 43 relative to the vehicle body 2, and a work equipment load sensor 49 which detects the load applied to the work equipment 4.

[0060] The work machine load sensor 49 detects whether the work machine 4 of the forklift 1 supports a transported object. The work machine load sensor 49 detects the weight of the transported object supported by the work machine 4. The work machine load sensor 49 is, for example, a load measuring device such as a strain gauge or a load cell arranged on at least a part of the work machine 4. The detection data of the work machine load sensor 49 is output to the controller 100. The load applied to the work machine 4 may be detected using, for example, a hydraulic sensor that detects the pressure of the pressure oil that drives the lift cylinder 451. In this case, the load applied to the work machine 4 changes depending on whether the transported object is supported by the fork 43 or not. The work machine load sensor 49 detects the change in the load applied to the work machine 4.

[0061] [controller] FIG. 8 is a block diagram showing a controller 100 according to an embodiment. The controller 100 includes a computer system 1000. The computer system 1000 includes a processor 1001 such as a central processing unit (CPU), a main memory 1002 including a non-volatile memory such as a read only memory (ROM) and a volatile memory such as a random access memory (RAM), a storage 1003, and an interface 1004 including an input / output circuit. The functions of the controller 100 are stored in the storage 1003 as a computer program. The processor 1001 reads the computer program from the storage 1003, loads it in the main memory 1002, and executes the above-mentioned processing according to the program. The computer program may be distributed to the computer system 1000 via a network.

[0062] As shown in FIG. 7, the controller 100 has a detection data acquisition unit 101, an identification unit 102, a control command receiving unit 103, a determination unit 104, a distance calculation unit 105, a selection unit 106, a path generation unit 107, a position calculation unit 108, a switching unit 109, a travel control unit 110, a work machine control unit 111, an output control unit 112, and a memory unit 113.

[0063] The storage unit 113 stores object dictionary data for identifying an object, and route data indicating the driving conditions of the forklift 1 in the automatic mode. The storage unit 113 stores the route data for driving the forklift 1 so as to face the object directly. The route data is determined in advance. In the embodiment, the storage unit 113 stores a plurality of route data.

[0064] The detection data acquisition unit 101 acquires detection data from each of the object sensor 7 , the vehicle speed sensor 143 , the steering sensor 144 , the lift sensor 46 , the tilt sensor 47 , the side shift sensor 48 , and the work machine load sensor 49 .

[0065] The identification unit 102 identifies a target for carrying out loading and unloading work from the objects detected by the object sensor 7, based on the object detection data of the object sensor 7. A method for identifying the target will be described later.

[0066] The control command receiving unit 103 receives a control command generated by operating the automatic mode permission switch 156. The control command receiving unit 103 receives a control command to start a process of identifying an object from the automatic mode permission switch 156. The control command receiving unit 103 receives a control command generated by operating the automatic mode start switch 157. The control command receiving unit 103 receives a control command to start automatic travel control or automatic work machine control from the automatic mode start switch 157.

[0067] The determination unit 104 determines the target for automatic loading and unloading work based on a control command from the automatic mode start switch 157 .

[0068] Based on the object detection data from the object sensor 7, the distance calculation unit 105 calculates the distance between the forklift 1 and an object for automatically carrying out loading and unloading work.

[0069] The selection unit 106 selects one piece of route data from the plurality of pieces of route data stored in the storage unit 113 based on the distance calculated by the distance calculation unit 105 .

[0070] The route generating unit 107 generates a route based on the route data selected by the selecting unit 106 .

[0071] Based on the object detection data from the object sensor 7, the position calculation unit 108 calculates the azimuth angle of the target with the object sensor 7 as the reference, in order to automatically carry out loading and unloading work.

[0072] A switching unit 109 switches the object detection data of the object sensor 7 used to identify the object, based on the azimuth angle of the object calculated by the position calculation unit .

[0073] The switching unit 109 switches between the object detection data of the first front sensor 7C and the object detection data of the second front sensor 7D used for identifying the object based on the detection data of the work machine load sensor 49. The switching unit 109 can determine whether the forks 43 are supporting a transported object based on the detection data of the work machine load sensor 49. When no transported object is supported on the forks 43, the switching unit 109 determines the object detection data of the object sensor 7 used for identifying the object present in front of the forklift 1 to be the object detection data of the second front sensor 7D. When a load is supported on the forks 43, the switching unit 109 determines the object detection data of the object sensor 7 used for identifying the object present in front of the forklift 1 to be the object detection data of the first front sensor 7C.

[0074] The travel control unit 110 controls the travel of the forklift 1 based on the object detection data from the object sensor 7 and the route data.

[0075] The work implement control unit 111 controls the work implement 4 based on the object detection data from the object sensor 7.

[0076] The output control unit 112 causes the output device 16 to output output data when the state of at least one of the traveling device 14 and the work machine 4 changes.

[0077] [Target Identification] 9 is a schematic diagram showing an example of a method for identifying an object according to an embodiment of the present invention. The forklift 1 identifies an object and performs travel control so that the forklift 1 automatically faces the object.

[0078] In the embodiment, the identification unit 102 identifies the target from the objects existing around the forklift 1 based on the object detection data of the three-dimensional sensor 72. In the example shown in FIG. 9, the target 50 is a transported object. The transported object shown in FIG. 9 is, for example, a box-shaped pallet. (a1) shows a point cloud which is object detection data obtained by irradiating the transported object with laser light from the three-dimensional sensor 72. (a2) shows a shaded plane estimated from the point cloud of (a1). The plane is estimated based on the relative positions between the three-dimensional sensor 72 and each of the multiple detection points defined on the surface of the object, which are indicated by the point cloud. The estimated plane is a surface facing the forklift 1 when the forklift 1 picks up the transported object. (a3) ​​is a view obtained by converting the viewpoint of (a2) to a vertical view (planar view). In (a3), the plane estimated in (a2) is indicated by a dashed line. In (a3), the point cloud appears to the left of the plane estimated in (a2). The points surrounded by an ellipse indicate the points passing through the plane estimated in (a2). In other words, the points surrounded by an ellipse are the points passing through the fork insertion hole provided in the transported object. (a4) is a diagram showing the intersection between the estimated plane and a line connecting the points passing through the plane and the coordinate system reference of the three-dimensional sensor 72. (a5) is a diagram showing the points supplemented at the intersection position obtained in (a4). (a6) is a diagram showing the estimated plane converted into a binary image viewed from the front. The part surrounded by a square indicates the points supplemented in (a5). The identification unit 102 refers to the target dictionary data stored in the memory unit 113, and determines whether the supplemented points are characteristic parts indicating the fork insertion hole, thereby identifying the transported object.

[0079] For example, in a facility where transported goods are temporarily stored, the transported goods are placed adjacent to each other. This makes it difficult to identify each transported goods as an independent object from the point cloud, which is the object detection data of the three-dimensional sensor 72. However, by identifying the fork insertion holes provided in each transported goods, it is possible to identify one transported goods from a group of adjacent transported goods.

[0080] Next, a description will be given of the identification of a load-placing space by the identification unit 102. The identification unit 102 identifies an object, and identifies a load-placing space based on a space of a predetermined size that exists around the identified object.

[0081] Fig. 10 is a schematic diagram showing the positions of the loading spaces 55 around the target 53 according to the embodiment. The identification unit 102 identifies the reference target 53 from the object detection data from the three-dimensional sensor 72. In the example shown in Fig. 10, the reference target 53 is a transported item.

[0082] The identification unit 102 searches for a space of a predetermined size around the reference target 53 from the object detection data. The surroundings of the target refer to positions adjacent to the target. In the example shown in FIG. 10, the surroundings of the target 53 are in front of the target 53, behind the target 53, to the right of the target 53, and above the target 53. The space of a predetermined size is a space in which an object picked up by the forklift 1 can be placed. The space of a predetermined size is, for example, a space that is larger than the dimensions of the object.

[0083] The identification unit 102 identifies a space large enough to accommodate the transported goods found as a loading space 55.

[0084] In the embodiment, the identification unit 102 identifies the target using object detection data from the three-dimensional sensor 72, but is not limited to this. For example, in another embodiment, the identification unit 102 may extract features from a captured image captured by the camera 71, and identify the target from the captured image based on the extracted features and target dictionary data. The method of identifying the target may be, for example, a recognition process based on pattern matching or machine learning.

[0085] [Control method] Fig. 11 is a diagram showing a loading / unloading operation according to the embodiment, and Fig. 12 is a flowchart showing a method for controlling the forklift 1 according to the embodiment.

[0086] In the example shown in FIG. 11, the object 50 for automatically performing the loading and unloading work is a transported object. As shown in FIG. 11, at the loading and unloading site, a plurality of objects 50 are placed at a predetermined storage position. The plurality of objects 50 are arranged so as to be lined up at the loading and unloading site. The plurality of objects 50 are arranged so that the front faces 50F of the objects 50 face the travel path 59. The front face 50F of the object 50 is a surface that faces the forklift 1 when the forklift 1 picks up the object 50. A pair of fork insertion holes are provided on the front face 50F of the object 50. In the example shown in FIG. 11, the object 50 includes a first object 51 and a second object 52. The first object 51 and the second object 52 are arranged adjacent to each other. The front face 50F of the object 50 includes a front face 51F of the object 51 and a front face 52F of the object 52. The controller 100 performs automatic travel control and automatic work machine control so that one target 50 out of a plurality of targets 50 arranged adjacent to each other is picked up by the forks 43 of the work machine 4.

[0087] The forklift 1 advances along the travel path 59 that exists on the front 50F side of the multiple targets 50 in order to pick up one of the multiple targets 50 with the forks 43. The forklift 1 moves straight along the travel path 59 so as to pass the front 50F sides of the multiple targets 50 in sequence.

[0088] A detection range 70A of the left side sensor 7A is defined diagonally forward and to the left of the vehicle body 2. Therefore, when the forklift 1 moves forward on the travel path 59 in the first direction, the left side sensor 7A can detect an object 50 existing on the left side of the forklift 1. Object detection data of the left side sensor 7A is transmitted to the controller 100. The detection data acquisition unit 101 acquires the object detection data of the left side sensor 7A.

[0089] The forklift 1 moves forward along the travel path 59 in the manual mode until the automatic mode start switch 157 is operated. The operator operates the steering wheel 151 and the accelerator pedal 154 so that the forklift 1 moves forward along the travel path 59. When transitioning the operation mode of the forklift 1 from the manual mode to the automatic mode, the operator operates the automatic mode start switch 157 after operating the automatic mode enable switch 156.

[0090] When the automatic mode permission switch 156 is operated by an operator, the control command receiving unit 103 receives a control command from the automatic mode permission switch 156. When the control command receiving unit 103 receives the control command from the automatic mode permission switch 156, a process of searching for the object 50 is started. The identification unit 102 starts searching for the object 50 based on the object detection data of the left side sensor 7A (step S1).

[0091] The identification unit 102 identifies the objects 50 one by one based on the object detection data of the left side sensor 7A. The identification unit 102 determines whether or not one object 50 has been identified among the multiple objects 50 (step S2).

[0092] FIG. 13 is a diagram showing an example of display data displayed on the display device 161 when the automatic mode permission switch 156 according to the embodiment is operated. The display device 161 displays image data captured by the camera 71. In the example shown in FIG. 13, the display device 161 displays image data including a plurality of objects 50. As shown in FIG. 13, after the automatic mode permission switch 156 is operated and before the automatic mode start switch 157 is operated, when a first object 51 is identified among the plurality of objects 50, the output control unit 112 causes the display device 161 to display a symbol 36 indicating the identified object 51 together with image data in which the object 51 is captured. The symbol 36 is displayed so as to be superimposed on the position of the object 51 in the image data. In the embodiment, the symbol 36 is a frame image displayed so as to surround the object 51. The operator can recognize that the object 51 has been identified among the plurality of objects 50 by the symbol 36. Since the object 52 has not been identified among the plurality of objects 50, the symbol 36 indicating the object 52 is not displayed.

[0093] In step S2, if it is determined that the target 50 has not been identified (step S2: No), the controller 100 returns to the process of step S1.

[0094] In step S2, if it is determined that one target 51 has been identified among the multiple targets 50 (step S2: Yes), the determination unit 104 determines whether the control command receiving unit 103 has received a control command from the automatic mode start switch 157 (step S3).

[0095] As described above, by operating the automatic mode start switch 157 after operating the automatic mode permission switch 156, the operation mode of the forklift 1 transitions from the manual mode to the automatic mode. When the operator performs a cargo picking operation for the object 51 in the automatic mode, the operator operates the automatic mode start switch 157 while the object 51 is being identified by the identification unit 102. When the operator operates the automatic mode start switch 157, the control command receiving unit 103 receives a control command from the automatic mode start switch 157.

[0096] In step S3, if it is determined that a control command has not been received from the automatic mode start switch 157 (step S3: No), the controller 100 returns to the process of step S1.

[0097] In step S3, when the identification unit 102 has identified the object 51 and it is determined that a control command from the automatic mode start switch 157 has been received by the control command receiving unit 103 (step S3: Yes), the determination unit 104 determines that the object 50 for automatically performing the loading operation is the object 51 (step S4).

[0098] When a control command is received from the automatic mode start switch 157 and the target 51 for automatically carrying out the load picking operation is determined, the operation mode of the forklift 1 transitions from the manual mode to the automatic mode. When the operation mode of the forklift 1 transitions from the manual mode to the automatic mode, automatic travel control for carrying out the load picking operation of the target 51 is started.

[0099] FIG. 14 is a diagram showing an example of display data displayed on the display device 161 when the automatic mode start switch 157 according to the embodiment is operated. When the operator performs the loading operation of the object 51 in the automatic mode, the operator operates the automatic mode start switch 157 in a state in which the symbol 36 indicating the object 51 is displayed. When the automatic mode start switch 157 is operated by the operator, the control command receiving unit 103 receives a control command from the automatic mode start switch 157. When the object 51 is identified by the identification unit 102 and the control command receiving unit 103 receives a control command from the automatic mode start switch 157, the output control unit 112 causes the display device 161 to display the symbol 37 indicating the object 51 of the loading operation in the automatic mode together with the image data in which the object 51 is captured. The symbol 37 is displayed so as to be superimposed on the position of the object 51 in the image data. In the embodiment, the symbol 37 is a frame image displayed so as to surround the object 51. The operator can recognize from the symbol 37 that the object 51 has been determined as the target of the loading operation in the automatic mode among the multiple objects 50.

[0100] The output control unit 112 causes the display device 161 to display each of the symbols 36 and 37 such that the display form of the symbol 36 is different from the display form of the symbol 37. The different display form may be, for example, at least one of the color, the line type, and the thickness. As an example, the symbol 36 is, for example, a blue frame image, and the symbol 37 is, for example, a red frame image.

[0101] The output control unit 112 causes the output device 16 to output output data when the control command receiving unit 103 receives a control command from the automatic mode start switch 157. In an embodiment, the output control unit 112 causes the audio output device 162 to output voice data when the control command receiving unit 103 receives a control command from the automatic mode start switch 157. This allows the operator to recognize that the operation mode of the forklift 1 has transitioned from the manual mode to the automatic mode. The voice data is, for example, a buzzer sound.

[0102] The output control unit 112 may output output data from the output device 16 at the time when the automatic driving control is started. This allows the operator to recognize that the automatic control of the driving device 14 has been started.

[0103] When the operator performs the loading operation of the object 52 in the automatic mode, after operating the automatic mode enable switch 156, the operator moves the forklift 1 forward along the travel path 59 in the manual mode until the object 52 is identified by the identification unit 102. After the object 52 is identified and the symbol 36 is displayed so as to be superimposed on the object 52 in the image data, the operator operates the automatic mode start switch 157. When the automatic mode start switch 157 is operated in a state in which the object 52 is identified by the identification unit 102, the object 52 is determined as the object 50 for automatically performing the loading operation, and the symbol 37 is displayed so as to be superimposed on the object 52 in the image data. By determining the object 52 for the loading operation in the automatic mode, the loading operation of the object 52 based on the automatic mode is started.

[0104] After the object 51 for the cargo-picking operation has been determined, the distance calculation unit 105 calculates the distance D between the forklift 1 and the object 51 based on the object detection data of the left side sensor 7A (step S5).

[0105] The distance calculation unit 105 calculates a distance D from the origin of the vehicle body coordinate system of the forklift 1 to the plane of the target 51 estimated by the identification unit 102. More specifically, the distance calculation unit 105 calculates a distance D from the origin of the vehicle body coordinate system of the forklift 1 to the plane of the front surface 51F of the target 51 in a direction perpendicular to the plane of the front surface 51F of the target 51 estimated by the identification unit 102. The origin of the vehicle body coordinate system of the forklift 1 is, for example, the intersection of the rotation axis of the front wheel 5F and an axis passing through the center of the vehicle body 2 in the width direction. In the example shown in FIG. 11, a direction parallel to the plane of the front surface 51F of the target 51 estimated by the identification unit 102 is defined as a first direction, and a direction perpendicular to the plane of the front surface 51F of the target 51 estimated by the identification unit 102 is defined as a second direction. That is, the second direction indicates a direction in which the forklift 1 faces the front surface of the target 51 in order for the forklift 1 to pick up the target 51.

[0106] The selection unit 106 selects one piece of route data from the plurality of pieces of route data stored in the storage unit 113 based on the distance D calculated by the distance calculation unit 105 in step S5 (step S6).

[0107] FIG. 15 is a diagram showing a schematic relationship between distance D and route data according to the embodiment. The storage unit 113 stores a plurality of route data. Each of the route data includes a target route 60 for the forklift 1 in automatic travel control. The route data specifies the travel conditions for causing the forklift 1 to travel in the second direction. The route data specifies the travel conditions for causing the forklift 1 to travel in a direction perpendicular to the front of the target 51. In the example shown in FIG. 15, the target route 60 stored in the storage unit 113 includes a first target route 61 and a second target route 62.

[0108] The target path 60 is a collection of target positions of the forklift 1 in the automatic mode. The target path 60 including the target positions of the forklift 1 is defined in, for example, a vehicle body coordinate system.

[0109] The target path 60 includes a start point 60S where the target path 60 starts, an end point 60E where the target path 60 ends, a first travel path 60A extending from the start point 60S, a second travel path 60B extending to the end point 60E so as to make the forklift 1 travel in the second direction, and a curved path 60C connecting the first travel path 60A and the second travel path 60B. The first travel path 60A is a path along a clothoid curve whose curvature increases in proportion to the curve length from the start point 60S. The second travel path 60B is a path along a clothoid curve whose curvature increases in proportion to the curve length from the end point 60E. The curved path 60C is an arc-shaped path connecting the end of the first travel path 60A and the front end of the second travel path 60B. The curvature of the first travel path 60A increases from the start point 60S toward the end of the first travel path 60A. The curvature of the second travel path 60B increases from the end point 60E toward the start end of the second travel path 60B. The end end of the first travel path 60A and the start end of the curved path 60C are connected. The end end of the curved path 60C and the start end of the second travel path 60B are connected. The curvature of the curved path 60C, the curvature at the end of the first travel path 60A, and the curvature at the start end of the second travel path 60B are equal. The curvature of the target path 60 changes continuously from the start point 60S through the end end of the first travel path 61A, the curved path 60C, and the start end of the second travel path 61B to the end point 60E. The target path 60 forms a smoothly curved path.

[0110] The distance between the forklift 1 and the target 51 in the second direction is different for each of the multiple target routes 60. The curvature of the curved route 60C is different for each of the multiple target routes 60. In the example shown in FIG. 15, the distance D1 between the forklift 1 and the target 51 on the first target route 61 in the second direction is shorter than the distance D2 between the forklift 1 and the target 51 on the second target route 62 in the second direction. The curvature 1 / r 61 is the curvature 1 / r of the curved path 60C of the second target path 62. 62 Greater than.

[0111] The selection unit 106 selects one piece of route data from the plurality of route data stored in the storage unit 113 based on the distance D calculated by the distance calculation unit 105 in step S5. When the distance D calculated by the distance calculation unit 105 is equal to or close to the distance D1 between the start point 60S of the first target route 61 and the target 51, the selection unit 106 selects the first route data defining the first target route 61 from the plurality of route data stored in the storage unit 113. When the distance D calculated by the distance calculation unit 105 is equal to or close to the distance D2 between the start point 60S of the second target route 62 and the target 51, the selection unit 106 selects the second route data defining the second target route 62 from the plurality of route data stored in the storage unit 113.

[0112] In the example shown in FIG. 15, there are two types of route data, but there may be three types of route data, or any multiple types of four or more.

[0113] The route generating unit 107 generates the route 65 based on the route data selected by the selecting unit 106 in step S6 (step S7).

[0114] The path generating unit 107 determines the position of the reference point 51R of the target 51 in the vehicle body coordinate system of the forklift 1. The path generating unit 107 arranges the target path 60 so that the end point 60E of the target path 60 selected by the selection unit 106 and the reference point 51R of the target 51 coincide in the first direction, and the start point 60S of the target path 60 selected by the selection unit 106 coincide in the second direction with the origin 1G of the vehicle body coordinate system of the forklift 1. The path generating unit 107 generates a straight path 63 connecting the end point 60E of the target path 60 and the reference point 51R of the target 51. In the embodiment, the reference point 51R of the target 51 is the center of a line segment connecting each of a pair of fork insertion holes 54 on the front surface 51F of the target 51. The reference point 51R of the target 51 is determined by the recognition unit 102 based on the object detection data of the object sensor 7 when the recognition unit 102 recognizes the fork insertion hole 54.

[0115] The traveling control unit 110 controls the traveling device 14 based on the 65 routes generated by the route generating unit 107 in step S7 (step S8).

[0116] Fig. 16 is a diagram illustrating the forklift 1 traveling to approach the target 51 based on the generated route 65 according to the embodiment. As shown in Fig. 16, the traveling control unit 110 controls the traveling device 14 to approach the target 51 while facing it head-on, based on the route 65 generated in step S7. The traveling control unit 110 controls the traveling device 14 so that the forklift 1 traveling in the first direction turns and approaches the target 51 while traveling in the second direction.

[0117] In the automatic mode, the steering of the forklift 1 is automatically controlled. The travel control unit 110 automatically controls the steering of the forklift 1 so that the forklift 1 travels according to the target route 60. The travel control unit 110 automatically controls the steering of the forklift 1 so that the forklift 1 travels toward the target 51. The travel control unit 110 controls the steering cylinder 142 based on the detection data of the steering sensor 144 so that the forklift 1 travels according to the target route 60 defined by the route data and the straight route 63 generated by the route generation unit 107. In the automatic mode, the forklift 1 is advanced and braked by the operator's operation of the accelerator pedal 154 and the brake pedal 155. That is, in the automatic travel control, the forklift 1 is automatically steered based on the target route 60, and the forklift 1 is advanced and braked manually based on the operator's driving operation. In the automatic mode, the forklift 1 may also be advanced and braked automatically.

[0118] FIG. 17 is a diagram for explaining a target route 60 according to an embodiment. In the embodiment, the target route 60 is defined by a virtual line connecting a plurality of travel points 66. A plurality of travel points 66 are set on the travel path 59. The travel points 66 define a target position of the forklift 1. A target steering angle of the forklift 1 and a speed limit (target travel speed) of the forklift 1 are set for each of the plurality of travel points 66. The plurality of travel points 66 are set at intervals. In the automatic travel control, the forklift 1 travels on the travel path 59 according to the target route 60. In the automatic travel control, the forklift 1 travels such that the center of the forklift 1 coincides with the target route 60 in the vehicle width direction of the forklift 1.

[0119] The target position of the forklift 1 refers to the target position of the forklift 1 when passing through the traveling point 66. The target position of the forklift 1 is defined in the vehicle body coordinate system of the forklift 1. The target steering angle of the forklift 1 refers to the steering angle of the forklift 1 when passing through the traveling point 66. In the embodiment, the target steering angle is the target steering angle of the rear wheel 5R. The speed limit of the forklift 1 refers to the speed limit of the forklift 1 when passing through the traveling point 66. The speed limit of the forklift 1 may be regarded as the target traveling speed of the forklift 1 when passing through the traveling point 66.

[0120] In the automatic driving control, the driving control unit 110 controls the driving device 14 so that the forklift 1 drives along the target route 60, based on a target route 60 including a plurality of driving points 66, each of which has a target position, a target steering angle, and a speed limit set, and on the detection data of the object sensor 7, the steering sensor 144, and the vehicle speed sensor 143.

[0121] The object sensor 7 can detect the relative position between the forklift 1 and the target 51 in the vehicle body coordinate system. The target position of the forklift 1 is defined in the vehicle body coordinate system of the forklift 1. The position calculation unit 108 can calculate the relative position between the forklift 1 and the target route 60 (travel point 66) based on the detection data of the object sensor 7. The travel control unit 110 controls the traveling device 14 so as to reduce the deviation between the detected position of the forklift 1 detected by the object sensor 7 when passing through the travel point 66 and the target position of the forklift 1 set at the travel point 66.

[0122] In the automatic driving control, the driving control unit 110 controls the driving device 14 so as to reduce the deviation between the detected steering angle of the forklift 1 detected by the steering sensor 144 when passing through the driving point 66 and the target steering angle of the forklift 1 set at the driving point 66.

[0123] In the automatic driving control, the driving control unit 110 controls the driving device 14 so as to reduce the deviation between the detected driving speed of the forklift 1 detected by the vehicle speed sensor 143 when passing the driving point 66 and the target driving speed of the forklift 1 set at the driving point 66.

[0124] 18 is a diagram illustrating the forklift 1 turning along the curved route 60C according to the embodiment. As described above, in the automatic driving control, the driving control unit 110 controls the traveling device 14 so that the forklift 1 travels along the target route 60. When the forklift 1 turns along the curved route 60C, the driving control unit 110 controls the steering cylinder 142 so that the deviation between the detected steering angle of the forklift 1 and the target steering angle becomes small.

[0125] When no transported object is supported on the forks 43, i.e., when the forks 43 are unloaded, the traveling control unit 110 determines a first steering angle command value and outputs the first steering angle command value to the traveling device 14 so that the forklift 1 can travel along the curved route 60C. The first steering angle command value is a steering angle command value that specifies the steering angle of the rear wheels 5R to a first steering angle. By controlling the steering angle of the rear wheels 5R to the first steering angle, the forklift 1 can travel along the curved route 60C.

[0126] On the other hand, when an object is supported on the forks 43, that is, when the forks 43 are loaded, a moment of rotation in the forward direction is applied, so that the load on the rear wheels 5R (steered wheels) is reduced, making it difficult to turn. Therefore, when the vehicle is loaded, there is a possibility that the vehicle will deviate from the curved path 60C even if the above-mentioned first steering angle command value is output.

[0127] In the embodiment, the traveling control unit 110 compensates the steering angle command value output to the traveling device 14 based on whether or not a transported object is supported on the fork 43. The traveling control unit 110 outputs a first steering angle command value for adjusting the steering angle of the forklift 1 to a first steering angle in an unladen state in which no transported object is supported on the working machine 4. The traveling control unit 110 outputs a second steering angle command value for adjusting the steering angle of the forklift 1 to a second steering angle in a loaded state in which a transported object is supported on the working machine 4. The first steering angle command value specifies the steering angle of the rear wheels 5R to a first steering angle. The second steering angle command value specifies the steering angle of the rear wheels 5R to a second steering angle larger than the first steering angle. The traveling control unit 110 outputs the second steering angle command value based on the weight of the transported object supported on the fork 43. The first steering angle is a target steering angle set for the forklift 1 in an unladen state. The second steering angle is a target steering angle set for the forklift 1 in a loaded state. The traveling control unit 110 may compensate the steering angle command value output to the traveling device 14 based on the weight of the transported object supported by the forks 43.

[0128] 19 is a flowchart showing the routine of step S8 according to the embodiment. The travel control unit 110 acquires detection data of the work machine load sensor 49 (step S81). The work machine load sensor 49 can detect whether the forks 43 are loaded or not. The work machine load sensor 49 can detect the weight of the transported object supported by the forks 43.

[0129] The traveling control unit 110 determines whether or not the forks 43 are in a loaded state based on the detection data acquired in step S81 (step S82).

[0130] In step S82, when it is determined that the forks 43 are in an unloaded state (step S82: No), the traveling control unit 110 outputs a first steering angle command value to the traveling device 14 (step S83).

[0131] The first steering angle command value is a steering angle command value that specifies the steering angle of the rear wheels 5R to a first steering angle. The steering angle of the forklift 1 is controlled to the first steering angle based on the first steering angle command value. When the forklift 1 is in an unloaded state, the steering angle of the rear wheels 5R is controlled to the first steering angle, thereby enabling the forklift 1 to travel along the target route 60 (curved route 60C).

[0132] In step S82, when it is determined that the forks 43 are in a loaded state (step S82: Yes), the traveling control unit 110 outputs a second steering angle command value to the traveling device 14 (step S84).

[0133] The second steering angle command value is a steering angle command value that specifies the steering angle of the rear wheels 5R to a second steering angle that is larger than the first steering angle. The steering angle of the forklift 1 is controlled to the second steering angle based on the second steering angle command value. When the forklift 1 is in a loaded state, the steering angle of the rear wheels 5R is controlled to the second steering angle, thereby enabling the forklift 1 to travel along the target route 60 (curved route 60C).

[0134] As described above, it may be switched according to the loading state, or it may be continuously compensated by measuring the load weight as in the following formula (1): If the first steering angle command value is Ca1, the second steering angle command value is Ca2, the weight of the transported object is W, and the coefficient is a, the second steering angle command value is expressed by the following formula (1).

[0135] Ca2 = Ca1 × (1 + W × a) … (1)

[0136] As described above, a speed limit (target traveling speed) is set at the traveling point 66. The speed limit is determined in advance so that the forklift 1 traveling along the target route 60 does not deviate from the target route 60. For example, even if the operator depresses the accelerator pedal 154 heavily, the traveling control unit 110 controls the traveling device 14 based on the detection data of the vehicle speed sensor 143 so that the traveling speed of the forklift 1 does not exceed the speed limit.

[0137] The speed limit of the curved path 60C is lower than the speed limit of the first travel path 60A. The speed limit of the second travel path 60B is lower than the speed limit of the curved path 60C. That is, the closer the forklift 1 is to the object 51, the lower the speed limit becomes.

[0138] In the embodiment, the greater the curvature of the curved path 60C, the lower the speed limit. In the example shown in Fig. 15, the speed limit of the forklift 1 when traveling along the curved path 60C of the first target path 61 is lower than the speed limit of the forklift 1 when traveling along the curved path 60C of the second target path 62. In other words, the speed limit is set so that the traveling speed of the forklift 1 does not increase as the curve of the curved path 60C becomes sharper.

[0139] 12, when the forklift 1 travels along the target route 60, the position calculation unit 108 calculates the azimuth angle of the object 51 with respect to the left side sensor 7A and the azimuth angle of the object 51 with respect to the second front sensor 7D, based on the object detection data of the left side sensor 7A and the object detection data of the second front sensor 7D (step S9).

[0140] Each of Figures 20, 21, and 22 is a schematic diagram showing a state in which a forklift 1 according to an embodiment approaches a target 51. Figure 20 shows a state in which the forklift 1 is traveling in a first direction. Figure 21 shows a state in which the forklift 1 is turning from the first direction to a second direction. Figure 22 shows a state in which the forklift 1 is traveling in the second direction.

[0141] 20, 21, and 22, the position calculation unit 108 calculates, as the azimuth angle of the object 51 based on the left side sensor 7A, a first angle θa formed by a first direction line LA1 indicating the orientation direction of the left side sensor 7A and a second direction line LA2 connecting the left side sensor 7A and the reference point 51R of the object 51. The position calculation unit 108 calculates, as the azimuth angle of the object 51 based on the second front sensor 7D, a second angle θc formed by a third direction line LC1 indicating the orientation direction of the second front sensor 7D and a fourth direction line LC2 connecting the second front sensor 7D and the reference point 51R of the object 51.

[0142] The position calculation unit 108 compares the calculated first angle θa and second angle θc to determine whether the second angle θc is equal to or smaller than the first angle θa (step S10).

[0143] In step S10, if it is determined that the second angle θc is greater than the first angle θa (step S10: No), the controller 100 returns to the process of step S9. The identification unit 102 can continue to identify the target 51 based on the object detection data of the left side sensor 7A.

[0144] In step S10, if it is determined that the second angle θc is less than or equal to the first angle θa (step S10: Yes), the switching unit 109 switches the object detection data of the object sensor 7 used to identify the object 51 from the object detection data of the left side sensor 7A to the object detection data of the second front sensor 7D (step S11).

[0145] In the embodiment, the relative angle α between the forklift 1 and the object 51 when the forklift 1 is traveling in the first direction on the travel path 59 is substantially 90 degrees. As the forklift 1 travels from the first direction to the second direction, the relative angle α between the forklift 1 and the object 51 gradually decreases from 90 degrees. When the forklift 1 faces the front of the object 51, the relative angle α between the forklift 1 and the object 51 is substantially 0 degrees.

[0146] 20, when the forklift 1 is traveling in the first direction, the left side sensor 7A can detect the object 51. That is, when the relative angle α between the forklift 1 and the object 51 is large, the object 51 is within the detection range 70A of the left side sensor 7A, so the left side sensor 7A can detect the object 51.

[0147] 21, when the forklift 1 turns from the first direction to the second direction, both the left side sensor 7A and the second front sensor 7D can detect the object 51. That is, when the relative angle α between the forklift 1 and the object 51 gradually decreases from 90 degrees, the object 51 is within the detection range 70A of the left side sensor 7A and the detection range 70D of the second front sensor 7D, so that both the left side sensor 7A and the second front sensor 7D can detect the object 51.

[0148] 22, when the forklift 1 is traveling in the second direction, the left side sensor 7A may not be able to detect the object 51. That is, when the relative angle α between the forklift 1 and the object 51 approaches 0 degrees, the object 51 is outside the detection range 70A of the left side sensor 7A, so the left side sensor 7A cannot detect the object 51. On the other hand, when the relative angle α between the forklift 1 and the object 51 approaches 0 degrees, the object 51 is within the detection range 70D of the second front sensor 7D, so the second front sensor 7D can detect the object 51.

[0149] In this way, the object sensor 7 that can detect the object 51 changes depending on the relative angle α between the forklift 1 and the object 51, so based on the determination of the position calculation unit 108, the switching unit 109 switches the object detection data of the object sensor 7 used to identify the object 51 from the object detection data of the left side sensor 7A to the object detection data of the second front sensor 7D.

[0150] When the second angle θc is greater than the first angle θa, the identification unit 102 identifies the object 51 based on the object detection data of the left side sensor 7A. When the second angle θc is equal to or smaller than the first angle θa, the identification unit 102 identifies the object 51 based on the object detection data of the second front sensor 7D. This allows the identification unit 102 to continue identifying the object 51 based on either the detection data of the left side sensor 7A or the object detection data of the second front sensor 7D even when the forklift 1 turns.

[0151] The driving control unit 110 determines whether or not the end condition of the automatic driving control is satisfied (step S12). If the end condition is satisfied, the automatic driving control is ended. After the automatic driving control is ended, the forklift 1 transitions to a manual mode in which the forklift 1 operates based on the operation of the operation device 15.

[0152] Fig. 23 is a flowchart showing the routine of step S12 according to the embodiment. Fig. 24 is a diagram for explaining the end condition of the automatic driving control according to the embodiment.

[0153] In the embodiment, the termination condition includes that the steering angle θs of the rear wheels 5R of the forklift 1 is equal to or less than a predetermined threshold value (equal to or less than a third threshold value). The threshold value is, for example, 1 degree.

[0154] In the automatic driving control, the forklift 1 drives toward the target 51 according to a target route 60 including a curved route 60C. When the forklift 1 drives along the curved route 60C, the direction of the rear wheels 5R is bent. If the mode is changed from the automatic driving control to the manual mode in a state in which the direction of the rear wheels 5R is significantly bent, the forklift 1 may proceed in a direction unintended by the operator. For example, the forklift 1 that faces the target 51 in the automatic driving control may proceed in a direction away from the target 51 when the mode is changed to the manual mode. In other words, the direct facing relationship between the forklift 1 and the target 51 may be lost. As a result, the operability may decrease in the manual mode.

[0155] As described above, in the embodiment, the termination condition includes that the steering angle θs of the rear wheels 5R is equal to or less than the threshold value. By transitioning from the automatic driving control to the manual mode when the steering angle θs of the rear wheels 5R is equal to or less than the threshold value, the deterioration of the operability in the manual mode is suppressed.

[0156] The termination condition also includes that the relative position between the forklift 1 and the target 51 satisfies a predetermined condition.

[0157] In the embodiment, the termination condition includes that the facing angle α between the forklift 1 and the front face 51F of the object 51 is equal to or smaller than a first threshold value that is determined in advance. The facing angle α refers to the angle between the left-right axis extending in the vehicle width direction of the forklift 1 in the vehicle body coordinate system and the front face 51F of the object 51. The first threshold value is, for example, 0.5 degrees.

[0158] The termination condition also includes a condition that the lateral positional deviation Ds between the forklift 1 and the target 51 is equal to or less than a second threshold value that is determined in advance. The lateral positional deviation Ds refers to the deviation between the origin 1G and the reference point 51R in the vehicle width direction of the forklift 1 in the vehicle body coordinate system. The second threshold value is, for example, 10 cm.

[0159] The termination condition also includes that the distance Fs between the front face 51F of the target 51 and the tip of the fork 43 is equal to or less than a fourth threshold value that is determined in advance. The fourth threshold value is, for example, 1 m.

[0160] 23, in the routine of step S12, the identification unit 102 determines whether or not the forklift 1 is placed in front of the object 51 based on the object detection data of the second front sensor 7D. That is, the identification unit 102 determines whether or not the forklift 1 faces the front face 51F of the object 51 based on the object detection data of the second front sensor 7D. The identification unit 102 also determines whether or not the facing angle α between the forklift 1 and the front face 51F of the object 51 is equal to or smaller than a first threshold value based on the object detection data of the second front sensor 7D (step S121).

[0161] In step S121, if it is determined that the facing angle α is less than or equal to the first threshold value (step S121: Yes), the identification unit 102 determines whether the lateral positional deviation Ds between the forklift 1 and the object 51 is less than or equal to a second threshold value based on the object detection data of the second front sensor 7D (step S122).

[0162] In step S122, when it is determined that the deviation amount Ds is equal to or smaller than the second threshold value (step S122: Yes), the identification unit 102 determines whether or not the steering angle θs of the rear wheel 5R is equal to or smaller than a third threshold value based on the detection data of the steering sensor 144 (step S123). The third threshold value is the above-mentioned 1 degree.

[0163] In step S123, if it is determined that the steering angle θs is less than or equal to the third threshold (step S123: Yes), the identification unit 102 determines whether the distance Fs between the front face 51F of the object 51 and the tip of the fork 43 is less than or equal to a fourth threshold based on the object detection data of the second forward sensor 7D (step S124).

[0164] In step S124, if it is determined that the distance Fs is equal to or less than the fourth threshold value (step S124: Yes), the traveling control unit 110 determines that the end condition of the automatic traveling control is satisfied (step S125). After step S125, the controller 100 proceeds to step S13 shown in FIG.

[0165] In step S124, if it is determined that the distance Fs is not equal to or less than the fourth threshold value (step S124: No), the traveling control unit 110 determines that the end condition of the automatic traveling control is not satisfied (step S126). After step S126, the controller 100 returns to the process of step S8 shown in FIG.

[0166] If it is determined in step S121 that the facing angle α is not equal to or less than the first threshold (step S121: No), if it is determined in step S122 that the deviation amount Ds is not equal to or less than the second threshold (step S122: Yes), and if it is determined in step S123 that the steering angle θs is not equal to or less than the third threshold (step S123: No), the identification unit 102 determines whether or not the distance Fs between the front face 51F of the object 51 and the tip of the fork 43 is equal to or less than a fifth threshold determined in advance based on the object detection data of the second forward sensor 7D (step S127). The fifth threshold is, for example, 30 cm. That is, the identification unit 102 determines whether or not the forklift 1 is too close to the object 51.

[0167] In step S127, if it is determined that the distance Fs is equal to or less than the fifth threshold (step S127: Yes), the traveling control unit 110 determines that the end condition of the automatic traveling control is satisfied (step S125). After step S125, the controller 100 proceeds to step S13 shown in FIG.

[0168] In step S127, if it is determined that the distance Fs is not equal to or less than the fifth threshold value (step S127: No), the traveling control unit 110 determines that the end condition of the automatic traveling control is not satisfied (step S126). After step S126, the controller 100 returns to the process of step S8 shown in FIG.

[0169] When it is determined in the routine of step S12 that the end condition of the automatic driving control is satisfied (step S125), the driving control unit 110 adjusts the steering angle θs of the rear wheels 5R so that the steering angle θs becomes equal to or less than a predetermined threshold value (equal to or less than a third threshold value) as shown in Fig. 12. The threshold value is, for example, 1 degree. In the embodiment, the driving control unit 110 adjusts the steering angle θs of the rear wheels 5R to 0 degrees (step S13).

[0170] In step S13, the steering angle θs of the rear wheel 5R is adjusted to 0 degrees, and then the automatic driving control ends (step S14).

[0171] As described above, in the automatic driving control, the forklift 1 drives toward the target 51 along the target route 60 including the curved route 60C. When the forklift 1 drives along the curved route 60C, the direction of the rear wheels 5R is turned. If the automatic driving control is terminated with the rear wheels 5R turned significantly, the forklift 1 may proceed in a direction unintended by the operator. As a result, the operability may decrease in the manual mode.

[0172] In the embodiment, when the end condition of the automatic driving control is satisfied, the steering angle of the rear wheel 5R is set to 0 degrees, and then the automatic driving control is switched to the manual mode, thereby suppressing the deterioration of the operability in the manual mode.

[0173] The output control unit 112 causes the output device 16 to output output data when the forklift 1 is located in front of the target 51. In the embodiment, the output control unit 112 causes the audio output device 162 to output a buzzer sound as audio data when it is determined that the forklift 1 is located in front of the target 51 based on the object detection data of the second forward sensor 7D. This allows the operator to recognize that the forklift 1 is directly facing the front of the target 51.

[0174] After the automatic traveling control is ended, in order to start the automatic control of the work equipment, the operator operates the automatic mode start switch 157. The control command receiving unit 103 receives the control command from the automatic mode start switch 157 (step S15).

[0175] When the control command receiving unit 103 receives a control command from the automatic mode start switch 157, automatic control of the work machine is started.

[0176] The output control unit 112 causes the output device 16 to output output data at the time when the control command receiving unit 103 receives a control command from the automatic mode start switch 157. In the embodiment, the output control unit 112 causes the audio output device 162 to output a buzzer sound as audio data at the time when the control command receiving unit 103 receives a control command from the automatic mode start switch 157. This allows the operator to recognize that the work machine automatic control has started.

[0177] The work machine control unit 111 controls the work machine 4 based on the object detection data of the second front sensor 7D so that the position of the tip of the fork 43 coincides with the position of the pair of fork insertion holes 54. That is, based on the object detection data of the second front sensor 7D, the work machine control unit 111 controls the position and attitude of the fork 43 so that the distance between the fork 43 and the pair of fork insertion holes 54 of the target 51 is equal to or less than a predetermined value. The work machine control unit 111 controls at least one of the lift cylinder 451, the tilt cylinder 452, and the side shift cylinder 453 so that the position of the tip of the fork 43 coincides with the position of the pair of fork insertion holes 54 (step S16).

[0178] The output control unit 112 causes the output device 16 to output output data when it is determined based on the object detection data of the second front sensor 7D that the position of the tip of the fork 43 coincides with the position of the pair of fork insertion holes 54. In the embodiment, when the distance between the fork 43 and the pair of fork insertion holes 54, which are the predetermined parts of the target 51, becomes equal to or less than a predetermined value, the output control unit 112 causes the audio output device 162 to output a buzzer sound as audio data. This allows the operator to recognize that the position of the tip of the fork 43 coincides with the position of the pair of fork insertion holes 54.

[0179] [effect] As described above, in the embodiment, the controller 100 outputs a first steering angle command value for adjusting the steering angle θs of the forklift 1 in the unloaded state, and outputs a second steering angle command value for adjusting the steering angle θs in the loaded state. Even if there is a difference in the turning performance of the work vehicle between the unloaded state and the loaded state, the forklift 1 can travel along the target route 60 by adjusting the steering angle θs based on the load on the work implement 4. In the automatic travel control, the controller 100 can properly turn the forklift 1 along the target route 60 even if the load on the work implement 4 changes.

[0180] [Other embodiments] In the above embodiment, an object for automatically carrying out loading and unloading work is placed on the left side of the forklift 1 traveling in the first direction on the travel path 59, and the left side sensor 7A detects the object. When an object for automatically carrying out loading and unloading work is placed on the right side of the forklift 1 traveling in the first direction on the travel path 59, the object is detected by the right side sensor 7B. The identification unit 102 identifies the object based on the object detection data of the right side sensor 7B.

[0181] In the above embodiment, the power source 11 of the forklift 1 is an engine, but is not limited to this. For example, the power source 11 of the forklift 1 may be a battery that supplies electric power. In this case, the travel motor 141 may be an electric motor. Also, the hydraulic pump 12 may be driven by the electric motor.

[0182] In the above embodiment, the automatic mode permission switch 156 and the automatic mode start switch 157 are separate switches, but this is not limited to the above. For example, the automatic mode permission switch 156 and the automatic mode start switch 157 may be the same switch. Operation of one switch may generate a control command to start a process of identifying a target for automatically performing loading and unloading work, and further operation of the switch may generate a control command to start automatic travel control or automatic work machine control.

[0183] In the above embodiment, the operator in the cab 3 is capable of operating the forklift 1, but this is not limiting. For example, an operating device for operating the forklift 1 may be disposed in a location remote from the forklift 1, and the forklift 1 may be remotely operated.

[0184] In the above embodiment, the forklift 1 moves forward in the manual mode until the automatic mode start switch 157 is operated, but this is not limited to the above. For example, the forklift 1 may be equipped with a positioning system for detecting the vehicle position, such as a Global Navigation Satellite System (GNSS), and may automatically travel to a target object while referring to map data including the target's position information and the vehicle position. Furthermore, when it is determined that the target object has been identified by the identification unit 102, the determination unit 104 may determine an object for automatically performing loading and unloading work.

[0185] In the above embodiment, during automatic travel control, the advancement and braking of the forklift 1 are manually performed based on the driving operation of the operator, but this is not limiting. The travel control unit 110 may control the advancement and braking of the forklift 1. The travel control unit 110 may control the advancement and braking of the forklift 1 based on the speed limit of the forklift 1 included in the route data. [Explanation of symbols]

[0186] 1...Forklift (work vehicle), 1G...Origin, 2...Vehicle body, 3...Cab, 4...Work equipment, 5...Wheels, 5F...Front wheels, 5R...Rear wheels, 6...Counterweight, 7...Object sensor, 7A...Left side sensor, 7B...Right side sensor, 7C...First front sensor, 7D...Second front sensor, 8...Fender, 10...Control system, 11...Power source, 12...Hydraulic pump, 13...Control valve unit, 14...Travel gear, 15...Operation device, 16...Output device, 36...Symbol, 37...Symbol, 41...Mast, 42...Bracket, 43...Fork, 43A...First fork, 43B...Second fork , 45...working machine drive device, 46...lift sensor, 47...tilt sensor, 48...side shift sensor, 49...working machine load sensor, 50...target, 50F...front, 51...target, 51F...front, 51R...reference point, 52...target, 52F...front, 53...target, 54...fork insertion hole, 55...load space, 59...traveling path, 60...target path, 60A...first traveling path, 60B...second traveling path, 60C...curved path, 60E...end point, 60S...starting point, 61...first target path, 62...second target path, 63...straight path, 65...path, 66...traveling point, 70...detection range, 0A...detection range, 70B...detection range, 70C...detection range, 70D...detection range, 71...camera, 72...3D sensor, 100...controller, 101...detection data acquisition unit, 102...identification unit, 103...control command receiving unit, 104...determination unit, 105...distance calculation unit, 106...selection unit, 107...path generation unit, 108...position calculation unit, 109...switching unit, 110...travel control unit, 111...work machine control unit, 112...output control unit, 113...storage unit, 710...imaging range, 720...measurement range, 131...travel control valve, 132...steering control valve, 133...work machine control valve, 141...travel A driving motor, 142... steering cylinder, 143... vehicle speed sensor, 144... steering sensor, 151... steering wheel, 152... work equipment lever, 153... forward / reverse switch lever, 154... accelerator pedal, 155... brake pedal, 156... automatic mode permission switch, 157... automatic mode start switch, 161... display device, 162... audio output device, 451... lift cylinder, 452... tilt cylinder, 453... side shift cylinder, 1000... computer system, 1001... processor, 1002... main memory, 1003... storage,1004: interface, LA1: first direction line, LA2: second direction line, LC1: third direction line, LC2: fourth direction line, α: relative angle, θa: first angle, θc: second angle.

Claims

1. A system for controlling a work vehicle, comprising: a sensor for detecting whether or not a work implement of the work vehicle is supporting a transported object; A controller for controlling the work vehicle, The controller: automatically controlling steering of the work vehicle so that the work vehicle travels along a target route; outputting a first steering angle command value for adjusting a steering angle of the work vehicle in an unloaded state in which the transported object is not supported; outputting a second steering angle command value for adjusting the steering angle in a loaded state in which the transported object is supported; system.

2. The work vehicle has a vehicle body, front wheels, and rear wheels, The working machine is disposed in front of the vehicle body, One or both of the front wheels and the rear wheels are steered wheels, The first steering angle command value specifies a steering angle of the steered wheels to a first steering angle, The second steering angle command value specifies a steering angle of the steered wheels to a second steering angle that is larger than the first steering angle. The system of claim 1 .

3. The steering wheels are the rear wheels. The system of claim 2.

4. The sensor detects a weight of the transported object, The controller: outputting the second steering angle command value based on the weight; The system of claim 1 .

5. The target route is a virtual line connecting a plurality of travel points, a target steering angle of the work vehicle in an unloaded state is set for each of the plurality of traveling points by the first steering angle command value; a target steering angle of the work vehicle in the loaded state is set at each of the plurality of travel points by the second steering angle command value; The system of claim 1 .

6. 1. A method for controlling a work vehicle, comprising: Detecting whether or not a work implement of the work vehicle is supporting a transported object; automatically controlling steering of the work vehicle so that the work vehicle travels along a target route; outputting a first steering angle command value for adjusting a steering angle of the work vehicle in an unloaded state in which the transported object is not supported; a command value is output to a second steering angle for adjusting the steering angle in a loaded state in which the transported object is supported; method.

Citation Information

Patent Citations

  • Unmanned carrier controller and control method

    JP2019036302A