Control system of unmanned vehicle, unmanned vehicle, and method of controlling unmanned vehicle

Abstract

A control system of an unmanned vehicle includes : a requested steering speed calculation unit that calculates a requested steering speed of the unmanned vehicle such that 5 the unmanned vehicle travels along a traveling course; an actual steering speed acquisition unit that acquires an actual steering speed of the unmanned vehicle detected by a steering sensor; and a traveling control unit that adjusts a traveling speed of the unmanned vehicle based on a result 10 of comparison between the requested steering speed and the actual steering speed. 20 24 20 57 20 13 A ug 2 02 4 1 3 A u g 2 0 2 4 A B S T R A C T 2 0 2 4 2 0 5 7 2 0

Description

TITLE OF THE INVENTION: CONTROL SYSTEM OF UNMANNED VEHICLE, UNMANNED VEHICLE, AND METHOD OF CONTROLLING UNMANNED VEHICLE 5 Related Application This application is a divisional application of AU2021318674 filed 24 May 2021, the entire contents of which are incorporated herein by reference. Field 10   [0001a] The present disclosure relates to a control system of an unmanned vehicle, the unmanned vehicle, and a method of controlling the unmanned vehicle. Background

[0002] Any discussion of the prior art throughout the 15 specification should in no way be considered as an admission that such prior art is widely known or forms part of common general knowledge in the field. [0002a] As disclosed in Patent Literature 1, an unmanned vehicle operates in a wide work site such as a mine. 20 Patent Literature

[0003] Patent Literature 1: JP 2020-021280 A Summary

[0004] An unmanned vehicle travels in a work site along a traveling course. When the unmanned vehicle travels at a 25 high speed, the unmanned vehicle may deviate from the traveling course. If the unmanned vehicle deviates from the traveling course, the operation of the unmanned vehicle is stopped, and productivity at the work site may be decreased. 30

[0005] It is an object of the present invention to overcome or ameliorate at least one of the disadvantages of the prior art, or to provide a useful alternative. One embodiment inhibits a decrease in productivity at a work 2024205720   13 Aug 2024 site where an unmanned vehicle operates.

[0006] According to an aspect of the present invention, a control system of an unmanned vehicle comprises: a requested steering speed calculation unit that calculates a 5 requested steering speed of the unmanned vehicle such that the unmanned vehicle travels along a traveling course; an actual steering speed acquisition unit that acquires an actual steering speed of the unmanned vehicle detected by a steering sensor; and a traveling control unit that adjusts 10 a traveling speed of the unmanned vehicle based on a result of comparison between the requested steering speed and the actual steering speed. [0006a] According to another aspect of the present invention, an unmanned vehicle comprises the control system 15 of an unmanned vehicle as herein disclosed. [0006b] According to a further aspect of the present invention, a method of controlling an unmanned vehicle comprises: calculating a requested steering speed of the unmanned vehicle such that the unmanned vehicle travels 20 along a traveling course; acquiring an actual steering speed of the unmanned vehicle detected by a steering sensor; and adjusting a traveling speed of the unmanned vehicle based on a result of comparison between the requested steering speed and the actual steering speed. 25

[0007] According to the present disclosure, a decrease in productivity at a work site where an unmanned vehicle operates is inhibited. [0007a] Unless the context clearly requires otherwise, throughout the description and the claims, the words 30 "comprise", "comprising", and the like are to be construed in an inclusive sense as opposed to an exclusive or exhaustive sense; that is to say, in the sense of "including, but not limited to". 2024205720   13 Aug 2024 Brief Description of Drawings

[0008] FIG. 1 is a schematic diagram illustrating a management system of an unmanned vehicle according to an embodiment. 5        FIG. 2 is a schematic diagram illustrating the unmanned vehicle according to the embodiment. FIG. 3 is a schematic diagram illustrating a work site according to the embodiment. FIG. 4 is a schematic diagram for illustrating course 10 data according to the embodiment. FIG. 5 is a functional block diagram illustrating a control system of the unmanned vehicle according to the embodiment. FIG. 6 is a schematic diagram for illustrating a 15 traveling condition of the unmanned vehicle according to the embodiment. FIG. 7 is a flowchart illustrating a method of controlling the unmanned vehicle according to the embodiment. 20        FIG. 8 is a schematic diagram for illustrating operation of the unmanned vehicle according to the embodiment. Description of Embodiments

[0009] An embodiment of the present disclosure will be 2024205720   13 Aug 2024 described below with reference to the drawings, but the present disclosure is not limited to the embodiment. Components in the embodiment described below can be appropriately combined. Furthermore, some components are 5 not used in some cases.

[0010] [Management System] FIG. 1 is a schematic diagram illustrating a management system 1 of an unmanned vehicle 2 according to the embodiment. The unmanned vehicle 2 refers to a work 10 vehicle that operates in an unmanned manner without depending on a driving operation of a driver. The unmanned vehicle 2 operates at a work site. Examples of the work site include a mine or a quarry. The unmanned vehicle 2 is an unmanned dump truck that travels in an unmanned manner 15 at a work site and transports a cargo. The mine refers to a place or business facilities for mining minerals. The quarry refers to a place or business facilities for mining stones. Examples of a cargo transported by the unmanned vehicle 2 include ore and sediment excavated in the mine or 20 the quarry.

[0011] The management system 1 includes a management device 3 and a communication system 4. The management device 3 includes a computer system. The management device 3 is installed in a control facility 5 of the work site. 25 An administrator is in the control facility 5. The management device 3 and the unmanned vehicle 2 wirelessly communicate with each other via the communication system 4. A wireless communication device 6 is connected to the management device 3. The communication system 4 includes 30 the wireless communication device 6. The management device 3 generates course data indicating a traveling condition of the unmanned vehicle 2. The unmanned vehicle 2 operates at the work site based on the course data transmitted from the 2024205720   13 Aug 2024 management device 3.

[0012] [Unmanned Vehicle] FIG. 2 is a schematic diagram illustrating the unmanned vehicle 2 according to the embodiment. As 5 illustrated in FIGS. 1 and 2, the unmanned vehicle 2 includes a vehicle body 21, a traveling device 22, a dump body 23, a wireless communication device 30, a position sensor 31, an orientation sensor 32, a speed sensor 33, a steering sensor 34, and a control device 40. 10

[0013] The vehicle body 21 includes a vehicle body frame. The vehicle body 21 is supported by the traveling device 22. The vehicle body 21 supports the dump body 23.

[0014] The traveling device 22 causes the unmanned vehicle 2 to travel. The traveling device 22 causes the 15 unmanned vehicle 2 to move forward or rearward. At least a part of the traveling device 22 is disposed below the vehicle body 21. The traveling device 22 includes wheels 24, tires 25, a drive device 26, a brake device 27, and a steering device 28. 20

[0015] The tires 25 are mounted on the wheels 24. The wheels 24 include front wheels 24F and rear wheels 24R. The tires 25 include front tires 25F and rear tires 25R. The front tires 25F are mounted on the front wheels 24F. The rear tires 25R are mounted on the rear wheels 24R. 25

[0016] The drive device 26 generates driving force for starting or accelerating the unmanned vehicle 2. Examples of the drive device 26 include an internal combustion engine and an electric motor. Examples of the internal combustion engine include a diesel engine. Driving force 30 generated by the drive device 26 is transmitted to the rear wheels 24R, which rotates the rear wheels 24R. Rotation of the rear wheels 24R causes the unmanned vehicle 2 to be self-propelled. 2024205720   13 Aug 2024

[0017] The brake device 27 generates braking force for stopping or decelerating the unmanned vehicle 2. Examples of the brake device 27 include a disc brake and a drum brake . 5

[0018] The steering device 28 generates steering force for adjusting a traveling direction of the unmanned vehicle 2. The traveling direction of the unmanned vehicle 2 moving forward refers to an orientation of a front portion of the vehicle body 21. The traveling direction of the 10 unmanned vehicle 2 moving rearward refers to an orientation of a rear portion of the vehicle body 21. As illustrated in FIG. 2, the steering device 28 includes a steering cylinder 51. The steering cylinder 51 is a hydraulic cylinder. The front wheels 24F are steered by steering 15 force generated by the steering cylinder 51. The traveling direction of the unmanned vehicle 2 is adjusted by the front wheels 24F being steered.

[0019] The dump body 23 is a member on which a cargo is loaded. At least a part of the dump body 23 is disposed 20 above the vehicle body 21. As illustrated in FIG. 2, the dump body 23 moves up and down by operations of a hoist cylinder 52. The hoist cylinder 52 is a hydraulic cylinder. The dump body 23 is adjusted to have a loading posture or a dump posture by force of moving up and down 25 generated by the hoist cylinder 52. The loading posture refers to a posture in which the dump body 23 is lowered. The dump posture refers to a posture in which the dump body 23 is raised.

[0020] As illustrated in FIG. 2, the unmanned vehicle 2 30 includes a hydraulic pump 53, a valve device 54, and a hydraulic oil tank 55.

[0021] The hydraulic pump 53 is operated by driving force generated by the drive device 26. The hydraulic pump 2024205720   13 Aug 2024 53 discharges hydraulic oil for driving each of the steering cylinder 51 and the hoist cylinder 52. The hydraulic pump 53 sucks and discharges hydraulic oil stored in the hydraulic oil tank 55. 5

[0022] The valve device 54 adjusts a flow state of the hydraulic oil supplied to each of the steering cylinder 51 and the hoist cylinder 52. The valve device 54 operates based on a control command from the control device 40. The valve device 54 includes a first flow rate adjusting valve 10 and a second flow rate adjusting valve. The first flow rate adjusting valve can adjust the flow rate and direction of hydraulic oil supplied to the steering cylinder 51. The second flow rate adjusting valve can adjust the flow rate and direction of hydraulic oil supplied to the hoist 15 cylinder 52.

[0023] The steering cylinder 51 includes a bottom chamber 51B and a head chamber 51H. When hydraulic oil discharged from the hydraulic pump 53 is supplied to the bottom chamber 51B via the valve device 54, the steering 20 cylinder 51 extends. When the hydraulic oil discharged from the hydraulic pump 53 is supplied to the head chamber 51H via the valve device 54, the steering cylinder 51 contracts. The hydraulic oil discharged from the steering cylinder 51 is returned to the hydraulic oil tank 55 via 25 the valve device 54. The front wheels 24F are coupled to the steering cylinder 51 via a link mechanism. The front wheels 24F are steered by the extension and contraction of the steering cylinder 51.

[0024] The hoist cylinder 52 includes a bottom chamber 30   52B and a head chamber 52H. When the hydraulic oil discharged from the hydraulic pump 53 is supplied to the bottom chamber 52B via the valve device 54, the hoist cylinder 52 extends. When the hydraulic oil discharged 2024205720   13 Aug 2024 from the hydraulic pump 53 is supplied to the head chamber 52H via the valve device 54, the hoist cylinder 52 contracts. The hydraulic oil discharged from the hoist cylinder 52 is returned to the hydraulic oil tank 55 via 5 the valve device 54. The dump body 23 is coupled to the hoist cylinder 52. The dump body 23 is moved up and down by the extension and contraction of the hoist cylinder 52.

[0025] The wireless communication device 30 wirelessly communicates with the wireless communication device 6. The 10 communication system 4 includes the wireless communication device 30.

[0026] The position sensor 31 detects a position of the unmanned vehicle 2. The position of the unmanned vehicle 2 is detected by using a global navigation satellite system 15 (GNSS). The global navigation satellite system includes a global positioning system (GPS). The global navigation satellite system detects the position in a global coordinate system specified by coordinate data of latitude, longitude, and altitude. The global coordinate system 20 refers to a coordinate system fixed to the earth. The position sensor 31 includes a GNSS receiver, and detects the position of the unmanned vehicle 2 in the global coordinate system.

[0027] The orientation sensor 32 detects an orientation 25 of the unmanned vehicle 2. The orientation of the unmanned vehicle 2 includes a traveling direction of the unmanned vehicle 2. Examples of the orientation sensor 32 include a gyro sensor.

[0028] The speed sensor 33 detects a traveling speed of 30 the unmanned vehicle 2.

[0029] The steering sensor 34 detects a steering angle of the steering device 28. Examples of the steering sensor 34 include a potentiometer. 2024205720   13 Aug 2024

[0030] The control device 40 includes a computer system. The control device 40 is disposed in the vehicle body 21. The control device 40 can communicate with the management device 3. The control device 40 outputs a control command 5 for controlling the traveling device 22. The control command output from the control device 40 includes a driving command for operating the drive device 26, a braking command for operating the brake device 27, and a steering command for operating the steering device 28. The 10 drive device 26 generates driving force for starting or accelerating the unmanned vehicle 2 based on the driving command output from the control device 40. The brake device 27 generates braking force for stopping or decelerating the unmanned vehicle 2 based on the braking 15 command output from the control device 40. The steering device 28 generates steering force for causing the unmanned vehicle 2 to move straight or turn based on the steering command output from the control device 40.

[0031] [Work Site] 20        FIG. 3 is a schematic diagram illustrating the work site according to the embodiment. In the embodiment, the work site is a mine. Examples of the mine include a metal mine for mining metal, a non-metal mine for mining limestone, and a coal mine for mining coal. Examples of a 25 cargo transported by the unmanned vehicle 2 include mined objects excavated in the mine.

[0032] A traveling area 10 is set in the work site. In the traveling area 10, the unmanned vehicle 2 is permitted to travel. The unmanned vehicle 2 can travel in the 30 traveling area 10. The traveling area 10 includes a loading place 11, a soil discharging place 12, a parking place 13, an oil filling place 14, a traveling path 15, and an intersection 16. 2024205720   13 Aug 2024

[0033] The loading place 11 refers to an area for performing loading operation of loading a cargo on the unmanned vehicle 2. When the loading operation is performed, the dump body 23 is adjusted to have a loading 5 posture. In the loading place 11, a loader 7 operates. Examples of the loader 7 include a hydraulic shovel. A driver boards the loader 7. The loader 7 is a manned vehicle that operates based on a driving operation of the driver . 10

[0034] The soil discharging place 12 refers to an area for performing discharging operation of discharging a cargo from the unmanned vehicle 2. When the discharging operation is performed, the dump body 23 is adjusted to have a dump posture. A crusher 8 is provided in the soil 15 discharging place 12.

[0035] The parking place 13 is an area for parking the unmanned vehicle 2.

[0036] The oil filling place 14 is an area for filling the unmanned vehicle 2 with oil. 20

[0037] The traveling path 15 refers to an area where the unmanned vehicle 2 travels toward at least one of the loading place 11, the soil discharging place 12, the parking place 13, and the oil filling place 14. The traveling path 15 is provided so as to connect at least the 25 loading place 11 and the soil discharging place 12. In the embodiment, the traveling path 15 is connected to each of the loading place 11, the soil discharging place 12, the parking place 13, and the oil filling place 14.

[0038] The intersection 16 refers to an area where a 30 plurality of traveling paths 15 intersects or an area where one traveling path 15 branches into a plurality of traveling paths 15.

[0039] [Course Data] 2024205720   13 Aug 2024 FIG. 4 is a schematic diagram for illustrating course data according to the embodiment. The management device 3 generates the course data. The course data indicates a traveling condition of the unmanned vehicle 2. The course 5 data is set in the traveling area 10. The unmanned vehicle 2 travels in the traveling area 10 based on the course data transmitted from the management device 3. The course data includes course points 18, a traveling course 17 of the unmanned vehicle 2, target positions Pr of the unmanned 10 vehicle 2, target orientations Dr of the unmanned vehicle 2, and target traveling speeds Vr of the unmanned vehicle 2 .

[0040] As illustrated in FIG. 4, a plurality of course points 18 is set in the traveling area 10. The course 15 points 18 specify the target positions Pr of the unmanned vehicle 2. The target orientations Dr of the unmanned vehicle 2 and the target traveling speeds Vr of the unmanned vehicle 2 are set at the plurality of course points 18. The plurality of course points 18 is set at 20 intervals. The interval between the course points 18 is set to, for example, 1 [m] or more and 5 [m] or less. The intervals between the course points 18 may be uniform or non-uniform.

[0041] The traveling course 17 refers to a virtual line 25 indicating a target traveling route of the unmanned vehicle 2. The traveling course 17 is specified by a track passing through the plurality of course points 18. The control device 40 controls the traveling device 22 so that the unmanned vehicle 2 travels along the traveling course 17. 30 In the embodiment, the control device 40 controls the traveling device 22 so that the unmanned vehicle 2 travels with the center of the unmanned vehicle 2 in a vehicle width direction coinciding with the traveling course 17. 2024205720   13 Aug 2024

[0042] The target positions Pr of the unmanned vehicle 2 refer to target positions of the unmanned vehicle 2 at the time when the unmanned vehicle 2 passes through the course points 18. The control device 40 controls the traveling 5 device 22 so that actual positions Ps of the unmanned vehicle 2 at the time when the unmanned vehicle 2 passes through the course points 18 correspond to the target positions Pr based on detection data of the position sensor 31. The control device 40 controls the traveling device 22 10 so that the unmanned vehicle 2 travels along the traveling course 17 based on the detection data of the position sensor 31. The target positions Pr of the unmanned vehicle 2 may be specified in a local coordinate system of the unmanned vehicle 2 or a global coordinate system. 15

[0043] The target orientations Dr of the unmanned vehicle 2 refer to target orientations of the unmanned vehicle 2 at the time when the unmanned vehicle 2 passes through the course points 18. The target orientations Dr include orientation angles of the unmanned vehicle 2 with 20 respect to a reference orientation (e.g., north). In the embodiment, the target orientations Dr are target orientations of the front portion of the vehicle body 21, and indicate a target traveling direction of the unmanned vehicle 2. The control device 40 controls the traveling 25 device 22 so that actual orientations Ds of the unmanned vehicle 2 at the time when the unmanned vehicle 2 passes through the course points 18 correspond to the target orientations Dr based on detection data of the orientation sensor 32. For example, when a target orientation Dr at a 30 first course point 18 is set to a first target orientation Drl, the control device 40 controls the steering device 28 so that an actual orientation Ds of the unmanned vehicle 2 at the time when the unmanned vehicle 2 passes through the 2024205720   13 Aug 2024 first course point 18 corresponds to a first target orientation Drl. When a target orientation Dr at a second course point 18 is set to a second target orientation Dr2, the control device 40 controls the steering device 28 so 5 that an actual orientation Ds of the unmanned vehicle 2 at the time when the unmanned vehicle 2 passes through the second course point 18 corresponds to a second target orientation Dr2.

[0044] The target traveling speeds Vr of the unmanned 10 vehicle 2 refer to target traveling speeds of the unmanned vehicle 2 at the time when the unmanned vehicle 2 passes through the course points 18. The control device 40 controls the traveling device 22 so that actual traveling speeds Vs of the unmanned vehicle 2 at the time when the 15 unmanned vehicle 2 passes through the course points 18 correspond to the target traveling speeds Vr based on detection data of the speed sensor 33. For example, when a target traveling speed Vr at the first course point 18 is set to a first target traveling speed Vrl, the control 20 device 40 controls the drive device 26 or the brake device 27 so that an actual traveling speed Vs of the unmanned vehicle 2 at the time when the unmanned vehicle 2 passes through the first course point 18 corresponds to the first target traveling speed Vrl. When a target traveling speed 25 Vr at the second course point 18 is set to a second target traveling speed Vr2, the control device 40 controls the drive device 26 or the brake device 27 so that an actual traveling speed Vs of the unmanned vehicle 2 at the time when the unmanned vehicle 2 passes through the second 30 course point 18 corresponds to the second target traveling speed Vr2.

[0045] [Control System] FIG. 5 is a functional block diagram illustrating a 2024205720   13 Aug 2024 control system 100 of the unmanned vehicle 2 according to the embodiment. The control system 100 includes the control device 40 and the traveling device 22. The management device 3 and the control device 40 of the 5 unmanned vehicle 2 wirelessly communicate with each other via the communication system 4.

[0046] The control device 40 includes a processor 41, a main memory 42, a storage 43, and an interface 44. Examples of the processor 41 include a central processing 10 unit (CPU) and a micro processing unit (MPU). Examples of the main memory 42 include a nonvolatile memory and a volatile memory. Examples of the nonvolatile memory include a read only memory (ROM). Examples of the volatile memory include a random access memory (RAM). Examples of 15 the storage 43 include a hard disk drive (HDD) and a solid state drive (SSD) . Examples of the interface 44 include an input / output circuit and a communication circuit.

[0047] The interface 44 is connected to each of the traveling device 22, the position sensor 31, the 20 orientation sensor 32, the speed sensor 33, and the steering sensor 34. The interface 44 communicates with each of the traveling device 22, the position sensor 31, the orientation sensor 32, the speed sensor 33, and the steering sensor 34. 25

[0048] The control device 40 includes a course data acquisition unit 101, a sensor data acquisition unit 102, a requested steering speed calculation unit 103, an actual steering speed acquisition unit 104, a determination unit 105, and a traveling control unit 106. The processor 41 30 functions as the course data acquisition unit 101, the sensor data acquisition unit 102, the requested steering speed calculation unit 103, the actual steering speed acquisition unit 104, the determination unit 105, and the 2024205720   13 Aug 2024 traveling control unit 106.

[0049] The course data acquisition unit 101 acquires course data transmitted from the management device 3 via the interface 44. 5

[0050] The sensor data acquisition unit 102 acquires sensor data via the interface 44. The sensor data includes at least one of detection data of the position sensor 31, detection data of the orientation sensor 32, detection data of the speed sensor 33, and detection data of the steering 10 sensor 34 .

[0051] The requested steering speed calculation unit 103 calculates a requested steering speed vreq of the steering device 28 of the unmanned vehicle 2 so that the unmanned vehicle 2 travels along the traveling course 17. 15

[0052] The requested steering speed calculation unit 103 calculates the requested steering speed vreq based on the course data acquired by the course data acquisition unit 101 and the sensor data acquired by the sensor data acquisition unit 102. In the embodiment, the requested 20 steering speed calculation unit 103 calculates the requested steering speed vreq based on a target steering angle 5com and an actual steering angle 5reai detected by the steering sensor 34.

[0053] FIG. 6 is a schematic diagram for illustrating a 25 traveling condition of the unmanned vehicle 2 according to the embodiment. FIG. 6 illustrates an example in which the traveling course 17 is set so that the unmanned vehicle 2 turns. In the example in FIG. 6, course points 18 (i) to 18(i+n) are set as the course points 18. The unmanned 30 vehicle 2 travels in the traveling area 10 so as to pass through the course point 18 (i) and then the course point 18(i+n). The target positions Pr, the target orientations Dr, and the target traveling speeds Vr are set at the 2024205720   13 Aug 2024 plurality of course points 18.

[0054] In a traveling direction of the unmanned vehicle 2, the course point 18 (i+n) is in front of the course point 18 (i). The requested steering speed calculation unit 103 5 calculates a difference APr(i) between a target position Pr(i) of the course point 18(i) and sensor data (detection data of position sensor 31) acquired by the sensor data acquisition unit 102. Furthermore, the requested steering speed calculation unit 103 calculates a difference ADr(i) 10 between a target orientation Dr(i) of the course point 18 (i) and sensor data (detection data of orientation sensor 32) acquired by the sensor data acquisition unit 102.

[0055] The requested steering speed calculation unit 103 calculates a target steering angle 5COm(i) of the unmanned 15 vehicle 2 that travels from the course point 18 (i) to the course point 18(i+n) based on the difference APr(i), the difference ADr(i), the target position Pr(i+n) at the course point 18 (i+n), the target orientation Dr(i+n) at the course point 18 (i+n), and the like. 20

[0056] The actual steering angle 5reai is detection data of the steering sensor 34. The requested steering speed calculation unit 103 acquires the actual steering angle Sreaiz which is the detection data of the steering sensor 34 from the sensor data acquisition unit 102. 25

[0057] The requested steering speed calculation unit 103 can acquire the actual steering angle 5reai(i) detected by the steering sensor 34 of the unmanned vehicle 2 at the course point 18 (i) .

[0058] The requested steering speed calculation unit 103 30 calculates the requested steering speed vreq for the unmanned vehicle 2 to travel along the traveling course 17 based on the target steering angle 5COm and the actual 2024205720   13 Aug 2024 steering angle 5reai- The requested steering speed vreq is calculated based on Expression (1) below.

[0059] Vreq — (a / T) x (Scorn Sreal) • • • (1)

[0060] In Expression (1), a time T is a time expected to 5 be taken for the unmanned vehicle 2 to arrive at a target arrival point. The time T is calculated based on the distance from the current point of the unmanned vehicle 2 to the target arrival time point and a traveling speed Vs of the unmanned vehicle 2. For example, when the unmanned 10 vehicle 2 at the course point 18 <i) travels toward the course point 18(i+n), which is the target arrival point, the time T is a time required for the unmanned vehicle 2 to move from the course point 18 (i) to the course point 18(i+n). The time T is calculated based on the distance from the 15 course point 18(i) to the course point 18(i+n) and the traveling speed Vs of the unmanned vehicle 2 at the time when the unmanned vehicle 2 passes through the course point 18 (i). The distance from the course point 18 (i) to the course point 18(i+n) is specified by the course data. The 20 speed sensor 33 detects the traveling speed Vs of the unmanned vehicle 2 at the time when the unmanned vehicle 2 passes through the course point 18 (i) . Here, a is a constant. The constant a is, for example, three.

[0061] The requested steering speed calculation unit 103 25 calculates a requested steering speed vreq(i) so that the unmanned vehicle 2 at the course point 18 (i) does not deviate from the traveling course 17 at the course point 18(i+n) . That is, the requested steering speed calculation unit 103 calculates the requested steering speed vreq(i) 30 based on Expression (1) so that the unmanned vehicle 2 that travels from the course point 18 (i) to the course point 18(i+nj does not deviate from the traveling course 17. 2024205720   13 Aug 2024

[0062] The actual steering speed acquisition unit 104 acquires an actual steering speed vreai of the steering device 28 of the unmanned vehicle 2 detected by the steering sensor 34. The actual steering speed vreai is 5 detection data of the steering sensor 34. The actual steering speed acquisition unit 104 acquires the actual steering speed vreal from the steering sensor 34. Note that, when the steering sensor 34 detects a steering angle, the actual steering speed acquisition unit 104 may acquire 10 the actual steering speed vreal by differentiating the steering angle detected by the steering sensor 34.

[0063] The actual steering speed acquisition unit 104 can acquire an actual steering speed vreai(i) detected by the steering sensor 34 of the unmanned vehicle 2 at the course 15 point 18 (i) .

[0064] The determination unit 105 determines whether or not the unmanned vehicle 2 can travel along the traveling course 17 based on a result of comparison between the requested steering speed vreq and the actual steering speed 20 vreai. That is, the determination unit 105 determines whether or not the unmanned vehicle 2 can travel without deviating from the traveling course 17 based on the result of comparison between the requested steering speed vreq and the actual steering speed vreai. 25

[0065] For example, the determination unit 105 determines whether or not the unmanned vehicle 2 that travels from the course point 18 (i) to the course point 18(i+n) can travel without deviating from the traveling course 17 based on the result of comparison between the 30 requested steering speed vreq(i) and the actual steering speed vreai(i).

[0066] When the requested steering speed vreq is higher than the actual steering speed vreal and the difference 2024205720   13 Aug 2024 between the requested steering speed vreq and the actual steering speed vreai exceeds a predetermined threshold p, the determination unit 105 determines that the unmanned vehicle 2 cannot travel along the traveling course 17. 5 That is, when a condition of Expression (2) below is satisfied, the determination unit 105 determines that the unmanned vehicle 2 cannot travel along the traveling course 17 . [00 67]      vreq - vreai > P . . . (2) 10

[0068] The threshold P is zero. Note that the threshold P may be a positive number.

[0069] In Expression (2), the actual steering speed vreai is detection data of the steering sensor 34 at the time when the control device 40 drives the steering device 28 of 15 the unmanned vehicle 2 at the maximum output. In the embodiment, the actual steering speed vreai at the time when the control device 40 drives the steering device 28 at the maximum output is appropriately referred to as a maximum steering speed. 20

[0070] That is, when determining that the actual steering speed vreai cannot reach the requested steering speed vreq even if the steering device 28 of the unmanned vehicle 2 at the first course point 18 (i) is driven at the maximum steering speed, the determination unit 105 25 determines that the unmanned vehicle 2 deviates from the traveling course 17 at the second course point 18(i+n) in front of the unmanned vehicle 2, and determines that the unmanned vehicle 2 cannot travel along the traveling course 17 . 30

[0071] In contrast, when the difference between the requested steering speed vreq and the actual steering speed vreai is equal to or less than the threshold P, the 2024205720   13 Aug 2024 determination unit 105 determines that the unmanned vehicle 2 can travel along the traveling course 17. In the embodiment, when the requested steering speed vreq is equal to or less than the actual steering speed vreai, the 5 determination unit 105 determines that the unmanned vehicle 2 can travel along the traveling course 17.

[0072] The traveling control unit 106 controls the traveling device 22 based on the course data acquired by the course data acquisition unit 101. Furthermore, the 10 traveling control unit 106 adjusts the traveling speed Vs of the unmanned vehicle 2 based on the result of comparison between the requested steering speed vreq and the actual steering speed vreai.

[0073] When the determination unit 105 determines that 15 the unmanned vehicle 2 cannot travel along the traveling course 17 based on the result of comparison between the requested steering speed vreq and the actual steering speed Vreav the traveling control unit 106 reduces the traveling speed Vs of the unmanned vehicle 2. 20

[0074] When an actual traveling speed at the time when the unmanned vehicle 2 passes through the first course point 18 is Vs, the traveling control unit 106 reduces the traveling speed Vs so that the traveling speed Vs becomes equal to or less than a traveling speed Vt indicated by 25 Expression (3).

[0075] Vt < (vreai / vreq) x Vs... (3)

[0076] When the determination unit 105 determines that the unmanned vehicle 2 can travel along the traveling course 17 based on the result of comparison between the 30 requested steering speed vreq and the actual steering speed vreai, the traveling control unit 106 causes the unmanned vehicle 2 to travel based on the target traveling speed Vr specified by the course data. 2024205720   13 Aug 2024

[0077] The management device 3 includes a course data generation unit 3A and a communication unit 3B.

[0078] The course data generation unit 3A generates course data indicating a traveling condition of the 5 unmanned vehicle 2. An administrator of the control facility 5 operates an input device 9 connected to the management device 3 to input the traveling condition of the unmanned vehicle 2 to the management device 3. Examples of the input device 9 include a touch panel, a computer 10 keyboard, a mouse, and an operation button. The input device 9 is operated by the administrator to generate input data. The course data generation unit 3A generates course data based on the input data generated by the input device 9. The course data generation unit 3A transmits the course 15 data to the unmanned vehicle 2 via the communication unit 3B and the communication system 4.

[0079] [Control Method] FIG. 7 is a flowchart illustrating a method of controlling the unmanned vehicle 2 according to the 20 embodiment. Course data is transmitted from the management device 3 to the control device 40. The course data acquisition unit 101 acquires the course data transmitted from the management device 3 (Step SI).

[0080] The traveling control unit 106 outputs a control 25 command for controlling the traveling device 22 so that the unmanned vehicle 2 travels based on the course data. The unmanned vehicle 2 travels in the traveling area 10 based on the course data.

[0081] The sensor data acquisition unit 102 acquires 30 sensor data (Step S2).

[0082] The sensor data acquired in Step S2 includes detection data of the position sensor 31, detection data of the orientation sensor 32, detection data of the speed 2024205720   13 Aug 2024 sensor 33, and detection data of the steering sensor 34. Detection data of the steering sensor 34 is the actual steering angle 5reai-

[0083] The requested steering speed calculation unit 103 5 calculates the requested steering speed vreq based on the target steering angle 5COm and the actual steering angle 5reai (Step S3) .

[0084] The requested steering speed calculation unit 103 calculates the target steering angle 5COm based on the 10 course data acquired in Step SI and the sensor data acquired in Step S2. The requested steering speed calculation unit 103 calculates the target steering angle 5com based on the target positions Pr and the target orientations Dr at the course points 18 and the sensor 15 data. Furthermore, the requested steering speed calculation unit 103 acquires the actual steering angle 5reai acquired in Step S2. The requested steering speed calculation unit 103 calculates the requested steering speed vreq for the unmanned vehicle 2 to travel along the 20 traveling course 17 based on Expression (1).

[0085] The actual steering speed acquisition unit 104 acquires the actual steering speed vreai based on the actual steering angle 5reai acquired in Step S2 (Step S4) .

[0086] The determination unit 105 compares the requested 25 steering speed vreq calculated in Step S3 with the actual steering speed vreal acquired in Step S4 (Step S5) .

[0087] The determination unit 105 determines whether or not the unmanned vehicle 2 can travel along the traveling course 17 based on the comparison result in Step S5 (Step 30   S6) .

[0088] The determination unit 105 determines whether or not the unmanned vehicle 2 can travel along the traveling 2024205720   13 Aug 2024 course 17 based on Expression (2) . In the embodiment, when the requested steering speed vreq is equal to or less than the actual steering speed vreai, the determination unit 105 determines that the unmanned vehicle 2 can travel along the 5 traveling course 17. When the requested steering speed vreq exceeds the actual steering speed vreal, the determination unit 105 determines that the unmanned vehicle 2 cannot travel along the traveling course 17.

[0089] When it is determined in Step S6 that the 10 unmanned vehicle 2 can travel along the traveling course 17 (Step S6: Yes), the traveling control unit 106 causes the unmanned vehicle 2 to travel based on the target traveling speed Vr specified by the course data (Step S7).

[0090] When it is determined in Step S6 that the 15 unmanned vehicle 2 cannot travel along the traveling course 17 (Step S6: No), the traveling control unit 106 operates the brake device 27 to reduce the traveling speed Vs, and causes the unmanned vehicle 2 to travel (Step S8).

[0091] [Effects] 20        As described above, according to the embodiment, the requested steering speed vreq for causing the unmanned vehicle 2 to travel along the traveling course 17 is calculated. The requested steering speed vreq is calculated based on the difference APr, the difference ADr, the 25 target steering angle 5Com, the actual steering angle 5reai, and the time T. The difference APr is a difference between the target position Pr of the first course point 18 and the sensor data (detection data of position sensor 31). The difference ADr is a difference between the target 30 orientation Dr of the first course point 18 and the sensor data (detection data of orientation sensor 32). The target steering angle 5COm is derived from the target position Pr 2024205720   13 Aug 2024 and the target orientation Dr of the second course point 18 in front of the first course point 18. The actual steering angle 5reai is detected by the steering sensor 34 when the unmanned vehicle 2 passes through the first course point 5   18. The time T is required for the unmanned vehicle 2 to move from the first course point 18 to the second course point 18. The time T is calculated based on the distance from the first course point 18 to the second course point 18 and the traveling speed Vs of the unmanned vehicle 2 at 10 the time when the unmanned vehicle 2 passes through the first course point 18. The distance from the first course point 18 to the second course point 18 is specified by the course data. The speed sensor 33 detects the traveling speed Vs of the unmanned vehicle 2 at the time when the 15 unmanned vehicle 2 passes through the first course point 18. Furthermore, the steering sensor 34 detects the actual steering speed vreai at the time when the unmanned vehicle 2 passes through the first course point 18. The traveling speed Vs of the unmanned vehicle 2 is adjusted based on the 20 result of comparison between the requested steering speed vreq and the actual steering speed vreai. This inhibits a decrease in productivity at the work site.

[0092] FIG. 8 is a schematic diagram for illustrating operation of the unmanned vehicle 2 according to the 25 embodiment. As illustrated in FIG. 8, when the unmanned vehicle 2 travels on a curve specified by the traveling course 17, the actual traveling speed Vs may be higher than the target traveling speed Vr specified by the course data. For example, when the traveling area 10 where the unmanned 30 vehicle 2 travels is a downhill road or cargos are loaded in the dump body 23, the actual traveling speed Vs may be higher than the target traveling speed Vr. Furthermore, the actual traveling speed Vs may be higher than the target 2024205720   13 Aug 2024 traveling speed Vr also immediately after the stopped unmanned vehicle 2 starts. When the unmanned vehicle 2 enters the curve at the high traveling speed Vs, the unmanned vehicle 2 may fail to go around the curve to 5 deviate from the traveling course 17 as illustrated by an unmanned vehicle 2D in FIG. 8.

[0093] In the embodiment, when it is determined that the unmanned vehicle 2 cannot travel along the traveling course 17 based on the result of comparison between the requested 10 steering speed vreq and the actual steering speed vreal, that is, when it is determined that the unmanned vehicle 2 cannot go around the curve even if the steering device 28 of the unmanned vehicle 2 entering the curve at the traveling speed Vs is operated at the maximum steering 15 speed, the brake device 27 is operated to reduce the traveling speed Vs of the unmanned vehicle 2. Reduction of the traveling speed Vs of the unmanned vehicle 2 allows the unmanned vehicle 2 to travel so as to follow the traveling course 17. Since deviation of the unmanned vehicle 2 from 20 the traveling course 17 is inhibited, a decrease in productivity at the work site is inhibited.

[0094] In contrast, when it is determined that the unmanned vehicle 2 can travel along the traveling course 17 based on the result of comparison between the requested 25 steering speed vreq and the actual steering speed vreai, the traveling speed Vs of the unmanned vehicle 2 is not reduced. Since the traveling speed Vs of the unmanned vehicle 2 is not reduced, the unmanned vehicle 2 can arrive at a destination place in a short time. For example, the 30 traveling speed Vs of the unmanned vehicle 2 is not reduced when the unmanned vehicle 2 travels toward the soil discharging place 12, so that the unmanned vehicle 2 can arrive at the soil discharging place 12 in a short time. 2024205720   13 Aug 2024 Therefore, a decrease in productivity at the work site is inhibited.

[0095] [Other Embodiments] Note that, in the above-described embodiment, at least 5 a part of the functions of the control device 40 may be provided in the management device 3, or at least a part of the functions of the management device 3 may be provided in the control device 40. For example, in the above-described embodiment, the management device 3 may have the function 10 of the requested steering speed calculation unit 103, and the requested steering speed vreq calculated based on a change command in the management device 3 may be transmitted to the control device 40 of the unmanned vehicle 2 via the communication system 4. Furthermore, the 15 management device 3 may have the function of the determination unit 105, and a determination result of the determination unit 105 may be transmitted to the control device 40 of the unmanned vehicle 2 via the communication system 4. When the determination unit 105 of the 20 management device 3 determines that the unmanned vehicle 2 cannot travel along the traveling course 17, the traveling control unit 106 of the control device 40 reduces the traveling speed Vs of the unmanned vehicle 2. Reference Signs List 25

[0096] 1 MANAGEMENT SYSTEM 2 UNMANNED VEHICLE 3 MANAGEMENT DEVICE 3A COURSE DATA GENERATION UNIT 3B COMMUNICATION UNIT 30        4 COMMUNICATION SYSTEM 5 CONTROL FACILITY 6 WIRELESS COMMUNICATION DEVICE 7 LOADER 2024205720   13 Aug 2024 8 CRUSHER 9 INPUT DEVICE 10 TRAVELING AREA 11 LOADING PLACE 5        12 SOIL DISCHARGING PLACE 13 PARKING PLACE 14 OIL FILLING PLACE 15 TRAVELING PATH 16 INTERSECTION 10        17 TRAVELING COURSE 18 COURSE POINT 21 VEHICLE BODY 22 TRAVELING DEVICE 23 DUMP BODY 15        2 4 WHEEL 24F FRONT WHEEL 24R REAR WHEEL 25 TIRE 25F FRONT TIRE 2 0        2 5R REAR TIRE 26 DRIVE DEVICE 27 BRAKE DEVICE 28 STEERING DEVICE 30 WIRELESS COMMUNICATION 25        31 POSITION SENSOR 32 ORIENTATION SENSOR 33 SPEED SENSOR 34 STEERING SENSOR 40 CONTROL DEVICE 30        41 PROCESSOR 42 MAIN MEMORY 43 STORAGE DEVICE 4 4 INTERFACE 2024205720   13 Aug 2024 51 STEERING CYLINDER 5IB BOTTOM CHAMBER 51H HEAD CHAMBER 52 HOIST CYLINDER 5        52B BOTTOM CHAMBER 52H HEAD CHAMBER 53 HYDRAULIC PUMP 54 VALVE DEVICE 55 HYDRAULIC OIL TANK 10        100 CONTROL SYSTEM 101 COURSE DATA ACQUISITION UNIT 102 SENSOR DATA ACQUISITION UNIT 103 REQUESTED STEERING SPEED CALCULATION UNIT 104 ACTUAL STEERING SPEED ACQUISITION UNIT 15        105 DETERMINATION UNIT 106 TRAVELING CONTROL UNIT Pr TARGET POSITION Ps POSITION Vr TARGET TRAVELING SPEED 20       Vs TRAVELING SPEED Vt TRAVELING SPEED Dr TARGET ORIENTATION Ds ORIENTATION ADr DIFFERENCE 25        a CONSTANT P THRESHOLD vreq REQUESTED STEERING SPEED V real ACTUAL STEERING SPEED 8 com TARGET STEERING ANGLE 30 Sreal ACTUAL STEERING ANGLE

Claims

1. A control system of an unmanned vehicle, comprising: a requested steering speed calculation unit that calculates a requested steering speed of the unmanned5 vehicle such that the unmanned vehicle travels along a traveling course;an actual steering speed acquisition unit that acquires an actual steering speed of the unmanned vehicle detected by a steering sensor; and10        a traveling control unit that adjusts a travelingspeed of the unmanned vehicle based on a result of comparison between the requested steering speed and the actual steering speed.15  2. The control system of an unmanned vehicle according toclaim 1, further comprisinga determination unit that determines whether or not the unmanned vehicle is allowed to travel along the traveling course based on the result of comparison, 20       wherein when it is determined that the unmannedvehicle is not allowed to travel along the traveling course, the traveling control unit reduces a traveling speed of the unmanned vehicle.25  3. The control system of an unmanned vehicle according toclaim 2, wherein when the requested steering speed is higher than the actual steering speed and a difference between the requested steering speed and the actual steering speed30 exceeds a threshold, the determination unit determines that the unmanned vehicle is not allowed to travel along the traveling course.2024205720   13 Aug 20244. The control system of an unmanned vehicle according to claim 2 or 3, wherein the traveling course is specified by a track passing through a plurality of course points,5        a target orientation and a target traveling speed ofthe unmanned vehicle are set for each of the plurality of course points, andthe requested steering speed calculation unit calculates the requested steering speed such that the10 unmanned vehicle at a first course point does not deviate from the traveling course at a second course point in front of the unmanned vehicle.

5. The control system of an unmanned vehicle according to 15 claim 4, wherein when it is determined that the unmanned vehicle deviates from the traveling course at the second course point even if a steering device of the unmanned vehicle is driven at a maximum steering speed, the20 determination unit determines that the unmanned vehicle is not allowed to travel along the traveling course.

6. The control system of an unmanned vehicle according to any one of claims 2 to 5,25       wherein when the requested steering speed is equal toor less than the actual steering speed, the determination unit determines that the unmanned vehicle is allowed to travel along the traveling course.30   7. An unmanned vehicle comprisingthe control system of an unmanned vehicle according to any one of claims 1 to 6.2024205720   13 Aug 20248. A method of controlling an unmanned vehicle, comprising:calculating a requested steering speed of the unmanned vehicle such that the unmanned vehicle travels along a5 traveling course;acquiring an actual steering speed of the unmanned vehicle detected by a steering sensor; andadjusting a traveling speed of the unmanned vehicle based on a result of comparison between the requested10 steering speed and the actual steering speed.

Images