Control device, control method, and control program
The control device addresses wheel idling on slopes by planning oblique routes based on slope and vehicle specifications, ensuring stable vehicle movement by maintaining wheel contact with the road.
Patent Information
- Application Number
- JP2023079613
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-05-12
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2043-05-12
AI Technical Summary
Existing vehicle control systems face challenges in maintaining stable movement when encountering gradient changes in the road, leading to potential wheel idling and inability to traverse slopes effectively.
A control device that acquires slope change information and mobile body specifications to plan a route that allows the vehicle to obliquely enter slopes, preventing wheel lift-off and ensuring continuous travel by controlling the vehicle's path and wheel engagement.
The solution enables vehicles to maintain contact with the road surface during slope transitions, preventing wheel idling and ensuring stable propulsion, even on uneven terrain.
Smart Images

Figure 2024163749000001_ABST
Abstract
Description
[Technical field]
[0001] The present disclosure relates to a control device, a control method, and a control program. [Background technology]
[0002] Patent Document 1 discloses a drive device mounted on a vehicle, which drives at least one of a plurality of axles, a first axle, by the power of an internal combustion engine and drives at least one of the remaining axles, a second axle, by electric power. The drive device has an electric motor that generates electric power, a power supply means that supplies power to the electric motor, and a control means that controls the driving of the electric motor. When the vehicle is traveling on a slope, the drive device increases or decreases the electric power when the vehicle is traveling on a slope relative to the electric power when the vehicle is traveling on a flat road, depending on whether the slope in the vehicle's traveling direction is an uphill road or a downhill road. This allows the drive power of the vehicle when the vehicle is traveling on a slope to be controlled according to the slope, so that the vehicle can be driven stably on a slope as on a flat road, for example, by increasing the drive power of the vehicle when going uphill and suppressing slipping when going downhill. [Prior art documents] [Patent documents]
[0003] [Patent Document 1] JP 2007-276641 A Summary of the Invention [Problem to be solved by the invention]
[0004] In the technology described in Patent Document 1, depending on the gradient of the road, there is a possibility that one of the wheels may come off the ground. If the wheel that comes off the ground is a drive wheel, the drive wheel may spin freely, causing the vehicle to become unable to move forward.
[0005] An object of the present disclosure is to provide a control device, a control method, and a control program that can prevent the drive wheels from spinning even when the moving body is traveling on a road with a changing slope, and enable the moving body to continue traveling on the road. [Means for solving the problem]
[0006] A first aspect of the present disclosure is a control device (10) including: an acquisition unit (72) that acquires gradient change information regarding gradient changes of a travel path (16) located ahead of a traveling direction of a moving body (12) having a plurality of wheels (14) and specification information regarding specifications of the moving body; a planning unit (74) that plans a route (R) for the moving body to travel on the travel path based on the gradient change information and the specification information; and a control unit (78) that controls the moving body to travel along the route.
[0007] A second aspect of the present disclosure is a control method for causing a computer (10) to execute processing including an acquisition step of acquiring gradient change information regarding gradient changes of a driving path located ahead in a driving direction of a mobile body having a plurality of wheels and specification information regarding specifications of the mobile body, a planning step of planning a route for the mobile body to travel on the driving path based on the gradient change information and the specification information, and a control step of controlling the mobile body to travel along the route.
[0008] A third aspect of the present disclosure is a control program (70) for causing a computer to execute processing including an acquisition step of acquiring gradient change information regarding gradient changes of a roadway located ahead in a traveling direction of a mobile body having a plurality of wheels and specification information regarding specifications of the mobile body, a planning step of planning a route for the mobile body to travel on the roadway based on the gradient change information and the specification information, and a control step of controlling the mobile body to travel along the route. Effect of the Invention
[0009] According to the present disclosure, a control device, a control method, and a control program are provided that can prevent the drive wheels from spinning even when a moving body is traveling on a road with a changing slope, and enable the moving body to continue traveling on the road. [Brief description of the drawings]
[0010] [Figure 1] 1 is a perspective view of a moving body equipped with a control device according to a first embodiment of the present disclosure. [Diagram 2] 4A to 4C are diagrams comparing the manner in which the moving body according to the first embodiment of the present disclosure enters an uphill road and a flat road vertically and the manner in which the moving body enters the uphill road and a flat road obliquely. [Diagram 3] 10 is a diagram comparing the distance d when the moving body according to the first embodiment of the present disclosure enters an uphill road vertically and when it enters obliquely. FIG. [Figure 4] 2 is a block diagram showing a hardware configuration of a moving body according to the first embodiment of the present disclosure. FIG. [Diagram 5] 2 is a block diagram showing a functional configuration of a control device according to the first embodiment of the present disclosure. FIG. [Figure 6] FIG. 2 is a block diagram illustrating the operation of the control device according to the first embodiment of the present disclosure. [Figure 7] 3A to 3C are diagrams illustrating a specific method for deriving a route along which a moving body travels according to the first embodiment of the present disclosure. [Figure 8] 4 is a flowchart showing a route planning process according to the first embodiment of the present disclosure. [Figure 9] 4 is a flowchart showing a driving control process according to the first embodiment of the present disclosure. [Figure 10] FIG. 11 is a diagram for comparing routes planned based on the magnitude of the gradient of a road in the second embodiment of the present disclosure. [Figure 11] FIG. 11 is a diagram comparing routes planned based on the height of a moving object in the second embodiment of the present disclosure. [Figure 12] FIG. 11 is a diagram comparing routes planned based on the width and width of the wheels of a moving body in the second embodiment of the present disclosure. [Figure 13]FIG. 11 is a diagram comparing paths planned based on the wide and narrow ranges of motion of a suspension provided on a moving body in the second embodiment of the present disclosure. [Figure 14] FIG. 13 is a diagram showing a route planned when a lateral movement distance h of a moving object is shorter than a distance h1 in the third embodiment of the present disclosure. [Figure 15] 13 is a diagram showing a manner in which a route is changed when a lateral movement distance h of a moving object is longer than a distance h1 in the third embodiment of the present disclosure. FIG. [Figure 16] FIG. 13 is a diagram illustrating a comparison of paths planned based on the position of the center of gravity of a moving object in the fourth embodiment of the present disclosure. [Figure 17] FIG. 13 is a block diagram showing a moving object according to a fifth embodiment of the present disclosure. [Figure 18] FIG. 13 is a block diagram showing a moving object according to a sixth embodiment of the present disclosure. [Figure 19] 13A to 13C are diagrams illustrating the operation of a discrimination unit and an output unit according to the sixth embodiment of the present disclosure. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0011] [First embodiment] First, a first embodiment of the present disclosure will be described.
[0012] As shown in Fig. 1, a control device 10 according to the first embodiment is mounted on a moving body 12. The control device 10 is a device that controls the traveling of the moving body 12. The moving body 12 may be a manned aircraft or an unmanned aircraft. In addition, the moving body 12 may be an autonomous traveling robot.
[0013] The moving body 12 has a plurality of wheels 14. The plurality of wheels 14 includes front wheels, middle wheels, and rear wheels. As an example, the total number of the plurality of wheels 14 is six. That is, the moving body 12 is a six-wheeled vehicle, and is a vehicle in which three wheels 14 are arranged on each of the left and right sides of the moving body 12. In the example shown in FIG. 1, the number of middle wheels on each side is one, but the number of middle wheels on each side may be any number. In addition, the total number of the plurality of wheels 14 is six, but the total number of the plurality of wheels 14 may be any number. The plurality of wheels 14 includes driving wheels and steering wheels. The driving wheels and steering wheels may be different wheels 14 or the same wheels 14.
[0014] As shown in FIG. 2, when the mobile body 12 travels on the travel path 16, the travel path 16 may have gradient change sections 18, 20. The gradient change sections 18, 20 are portions where the gradient of the travel path 16 changes at the boundaries of the gradient change sections 18, 20. The gradient change sections 18, 20 extend in a direction intersecting the extension direction of the travel path 16. In the example shown in FIG. 2, the gradient change sections 18, 20 extend in a direction perpendicular to the extension direction of the travel path 16. In the example shown in FIG. 2, the travel path 16 includes a flat road 22, an uphill road 24, and a flat road 26. The flat road 22 and the uphill road 24 are connected via the gradient change section 18, and the uphill road 24 and the flat road 26 are connected via the gradient change section 20.
[0015] In relation to the flat road 22 and the uphill road 24, the flat road 22 is an example of a "first running path" in the present disclosure, and the uphill road 24 is an example of a "second running path" in the present disclosure. In relation to the uphill road 24 and the flat road 26, the uphill road 24 is an example of a "first running path" in the present disclosure, and the flat road 26 is an example of a "second running path" in the present disclosure.
[0016] Fig. 2(A) shows a case where the mobile unit 12 enters an uphill road 24 and a flat road 26 vertically, and Fig. 2(B) shows a case where the mobile unit 12 enters an uphill road 24 and a flat road 26 obliquely. In Figs. 2(A) and (B), the upper figures are side views, and the lower figures are plan views.
[0017] The mobile body 12 vertically entering the uphill path 24 means that the mobile body 12 enters the uphill path 24 in a state in which the extension direction of the gradient change section 18 located at the entrance of the uphill path 24 is perpendicular to the traveling direction of the mobile body 12 in a plan view, and the mobile body 12 obliquely entering the uphill path 24 means that the mobile body 12 enters the uphill path 24 in a state in which the extension direction of the gradient change section 18 is oblique to the traveling direction of the mobile body 12 in a plan view. In addition, the mobile body 12 vertically entering the uphill path 24 is synonymous with passing vertically through the gradient change section 18 located at the entrance of the uphill path 24, and the mobile body 12 obliquely entering the uphill path 24 is synonymous with passing through the gradient change section 18 obliquely.
[0018] While the case where the moving object 12 enters the uphill road 24 has been described above with reference to FIGS. 2(A) and 2(B), the case where the moving object 12 enters the flat road 26 is similar to the above description.
[0019] Fig. 3(A) shows the length a of the body 48 of the moving body 12 along the extension direction of the travel path 16 and the distance d between the body 48 and the gradient change section 18 when the moving body 12 enters the uphill road 24 vertically, and Fig. 3(B) shows the length b of the body 48 along the extension direction of the travel path 16 and the distance d between the body 48 and the gradient change section 18 when the moving body 12 enters the uphill road 24 obliquely. In Figs. 3(A) and (B), the upper figures are side views and the lower figures are plan views. In Figs. 3(A) and (B), the illustration of the multiple wheels 14 is omitted.
[0020] As shown in Fig. 2(A) and Fig. 3(A), when the moving body 12 enters the uphill road 24 vertically, the middle wheel may leave the ground. That is, when the moving body 12 enters the uphill road 24 vertically, the distance d is expressed by formula (1), and when the condition of formula (2) is satisfied, the middle wheel leaves the ground. However, the bending angle θ is the angle between the flat road 22 and the uphill road 24 when the travel path 16 is viewed from the side, and the distance d1 is the distance between the lower end of the middle wheel and the body 48 of the moving body 12 when the suspension 46 (described later) supporting the middle wheel is fully extended. Note that the distances d and d1 are distances under the condition that the center of the middle wheel is located on a line L that passes through the gradient change section 18 and is perpendicular to the body 48, and are distances along the line L.
number
number
[0021] In this way, if the intermediate wheel that has come off the ground is a drive wheel, the drive wheel may spin freely and the mobile unit 12 may not be able to climb the uphill road 24. Here, when it is detected that the travel path 16 has a gradient changing section 18 with the uphill road 24, it is conceivable to carry out control to increase the drive force of the drive wheel. However, even in this case, the drive wheel will still spin freely, and the mobile unit 12 may not be able to climb the uphill road 24.
[0022] 2(B), when the travel path 16 has a gradient changing section 18 with an uphill road 24, the control device 10 plans a route R in which the moving object 12 enters the uphill road 24 at an angle and moves along the extension direction of the travel path 16 after entering the uphill road 24. Then, the control device 10 controls the moving object 12 to travel along the route R.
[0023] As shown in Fig. 3(B), when the moving object 12 enters the uphill path 24 obliquely, the length b becomes shorter than the length a when the moving object 12 enters the uphill path 24 perpendicularly, and therefore the distance d becomes shorter, so that the middle wheel can be prevented from coming off the ground. In other words, when the moving object 12 enters the uphill path 24 obliquely, the distance d is expressed by equation (3), the length b is expressed by equation (4), and when the condition of equation (5) is satisfied, the middle wheel can be prevented from coming off the ground. However, the entry angle α is determined by the angle between the extension direction of the travel path 16 and the traveling direction of the moving object 12 when the moving object 12 enters the uphill path 24 obliquely (specifically, when the center of the moving object 12 is located on the gradient change section 18 in a plan view).
number
number
number
[0024] Here, a specific example will be described. For example, when the gradient of the uphill road 24 is 1 / 12, the bending angle θ is 175.2°, and the length of the front and rear wheels 14 is assumed to be equal to the length a. If the length a is 280 mm, the distance d is 6 mm according to formula (1). Therefore, according to formula (2), if the distance d1 is less than 6 mm, the middle wheel will leave the ground. On the other hand, if the distance d1 is 4 mm, and the distance d is set to 4 mm, and the length b and the intrusion angle α are calculated according to formulas (3) and (4), the intrusion angle α will be 44° when the length b is 201 mm. Therefore, if the intrusion angle α is 44° or more, it is possible to prevent the middle wheel from leaving the ground.
[0025] 3(A) and 3(B), the case where the moving object 12 enters the uphill road 24 has been described, but the above technical idea is also applicable to the case where the moving object 12 enters the flat road 26. In addition, although not specifically shown, the above technical idea may also be applied to the case where the moving object 12 enters a downhill road.
[0026] Hereinafter, as shown in FIG. 2(B) and FIG. 3(B), a specific configuration of the control device 10 will be described using as an example a case in which the moving object 12 enters an uphill road 24.
[0027] 4, the moving body 12 includes, in addition to the control device 10, a sensing unit 30 and a traveling device 32. As an example, the sensing unit 30 includes an autonomous sensor 34, a LiDAR (Light Detection And Ranging) sensor 36, a stereo camera 38, and a camera 40.
[0028] The autonomous sensor 34 is, for example, an IMU (Inertial Measurement Unit), which detects three-dimensional inertial motion of the mobile unit 12 and outputs data corresponding to the detected inertial motion. The LiDAR sensor 36 detects the distance and direction of an object located ahead of the mobile unit 12 in the traveling direction, and outputs data corresponding to the detected distance and direction. The stereo camera 38 is composed of two cameras, detects the distance to an object located ahead of the mobile unit 12 in the traveling direction, and outputs data corresponding to the detected distance. The camera 40 is composed of a two-dimensional camera using an imaging element such as a CCD (Charge Coupled Device) sensor or a CMOS (Complementary Metal Oxide Semiconductor) sensor, and captures an object located ahead of the mobile unit 12 in the traveling direction, and outputs the image obtained by imaging as data.
[0029] The traveling device 32 is configured to include a plurality of wheels 14. The traveling device 32 includes a driving device 42, a steering device 44, and a plurality of suspensions 46. The driving device 42 is a device that drives driving wheels of the plurality of wheels 14. The driving source of the driving device 42 may be a motor or an engine. The driving source may also be a hybrid unit equipped with a motor and an engine. The steering device 44 is a device that steers steering wheels of the plurality of wheels 14. An actuator that applies a steering force to the steering wheels may be a motor or a hydraulic actuator. Each suspension 46 includes, for example, a spring and a damper, and supports each wheel 14 relative to a vehicle body 48.
[0030] The control device 10 is configured by a computer including a CPU (Central Processing Unit) 50, a ROM (Read Only Memory) 52, a RAM (Random Access Memory) 54, a storage 56, an input / output I / F (Interface) 58, and a communication I / F 60. The CPU 50, the ROM 52, the RAM 54, the storage 56, the input / output I / F 58, and the communication I / F 60 are connected to each other via a bus 62 so as to be able to communicate with each other.
[0031] The CPU 50 executes various programs and controls the traveling device 32. Specifically, the CPU 50 reads out various programs stored in the ROM 52 or the storage 56, and executes the programs using the RAM 54 as a working area. The CPU 50 then performs various arithmetic processing in accordance with the programs and controls the traveling device 32.
[0032] The ROM 52 stores various programs and various data. The RAM 54 temporarily stores programs or data as a working area. The storage 56 is composed of a recording medium such as a hard disk drive (HDD), a solid state drive (SSD), or a flash memory. The storage 56 stores various programs including an operating system and various information used to control the traveling device 32.
[0033] The communication I / F 60 transmits and receives data to and from an external device other than the mobile object 12 by wireless communication based on a wireless communication standard such as Wi-Fi (registered trademark) or Bluetooth (registered trademark). Note that the communication I / F 60 may transmit and receive data to and from an external device by wired communication.
[0034] 5, a control program 70 is stored in the ROM 52. The CPU 50 reads out the control program 70 stored in the ROM 52, and executes the control program 70 using the RAM 54 as a working area. The CPU 50 then executes a route planning process and a travel control process in accordance with the control program 70.
[0035] The route planning process is executed by the CPU 50 operating as an acquisition unit 72 and a planner 74 in accordance with the control program 70. The travel control process is executed by the CPU 50 operating as an estimation unit 76 and a control unit 78 in accordance with the control program 70.
[0036] As shown in FIG. 6, the sensing unit 30 outputs sensor information including data obtained by the autonomous sensor 34, the LiDAR sensor 36, the stereo camera 38, and the camera 40 to the CPU 50.
[0037] Map information and specification information are stored in the storage 56. The map information is digital map information on the road 16, and includes, for example, information on road information such as the width, shape, and presence or absence of gradient change sections 18 of the road 16, and the gradient of the road 16, in which position information indicating a position is associated with the road information. The specification information is information on the specifications of the mobile unit 12, and includes, for example, information on the height of the mobile unit 12, the length of the body 48, the spacing between the wheels 14, and the range of movement of the suspension 46.
[0038] The acquisition unit 72 acquires gradient change information regarding gradient changes of the road 16 based on the sensor information input from the sensing unit 30 to the CPU 50 and the map information stored in the storage 56. For example, the acquisition unit 72 estimates the self-position of the mobile object 12 based on data obtained by the autonomous sensor 34, and acquires gradient change information from the map information based on the self-position. The gradient change information includes, for example, information on the presence or absence of the gradient change unit 18, the gradient of the road 16, and the position of the gradient change unit 18. The acquisition unit 72 also acquires specification information stored in the storage 56.
[0039] The acquisition unit 72 may acquire the gradient change information based on the data acquired by the autonomous sensor 34, the LiDAR sensor 36, the stereo camera 38, and the camera 40 without using map information. Alternatively, for example, a receiver capable of receiving a signal from a positioning system such as a Global Positioning System (GPS) may be used in the sensing unit 30. The acquisition unit 72 may estimate the self-position of the moving object 12 based on the signal received by the receiver, and acquire the gradient change information from the map information based on the self-position. Alternatively, the acquisition unit 72 may estimate the self-position of the moving object 12 in a composite manner based on the data acquired by the autonomous sensor 34, the LiDAR sensor 36, the stereo camera 38, and the camera 40.
[0040] The planning unit 74 plans a route R along which the moving object 12 travels on the travel path 16, based on the gradient change information and the specification information acquired by the acquisition unit 72. The route R is a route along which the moving object 12 enters the uphill path 24 obliquely, and moves along the extending direction of the travel path 16 after entering the uphill path 24 (see FIG. 2(B)). The route R is also a route along which the multiple wheels 14 maintain contact with the road surface while the moving object 12 enters the uphill path 24 obliquely (see FIG. 3(B)). In other words, the route R is a route that satisfies the condition of the above formula (5). A specific method of deriving the route R will be described later.
[0041] The estimation unit 76 estimates the self-position of the moving object 12 based on the sensor information. For example, the estimation unit 76 estimates the self-position of the moving object 12 based on the autonomous sensor 34. When a receiver of a positioning system is used in the sensing unit 30, the estimation unit 76 may estimate the self-position of the moving object 12 based on a signal received by the receiver. The estimation unit 76 may also estimate the self-position of the moving object 12 in a composite manner based on data obtained by the autonomous sensor 34, the LiDAR sensor 36, the stereo camera 38, and the camera 40.
[0042] When the self-location of the mobile unit 12 is estimated using the autonomous sensor 34, a relative position in a predetermined relative coordinate system is estimated as the self-location. On the other hand, when the self-location of the mobile unit 12 is estimated based on a signal received by a receiver of the positioning system, an absolute position in an absolute coordinate system determined by the positioning system is estimated as the self-location.
[0043] The control unit 78 controls the drive unit 42 and steering unit 44 of the traveling device 32 to cause the moving body 12 to travel along the route R based on the self-position of the moving body 12 estimated by the estimation unit 76 and the route R planned by the planning unit 74.
[0044] Next, a specific method of deriving the route R will be described with reference to Fig. 7. As shown in Fig. 7, the moving object 12 starts lateral movement at a position before the gradient change section 18 (hereinafter referred to as the "lateral movement start position") in order to enter the uphill road 24 obliquely. Here, the speed of the moving object 12 is v, the distance between the gradient change section 18 and the lateral movement start position is s, the entry angle when the moving object 12 enters the uphill road 24 obliquely is α, and the lateral movement distance of the moving object 12 from the lateral movement start position to after it enters the uphill road 24 is h. However, the speed v of the moving object 12 is constant.
[0045] The time t required from the lateral movement start position to reach the gradient change section 18 is calculated by equation (6), the yaw rate yr from the lateral movement start position to reach the gradient change section 18 is calculated by equation (7), and the lateral movement distance h is calculated by equation (8), where v1 is the lateral movement speed of the moving object 12 and is calculated by equation (9).
number
number
number
number
[0046] The planning unit 74 (see FIG. 6) sets the above-mentioned time t, yaw rate yr, lateral movement distance h, and lateral movement speed v1 as constants, and plans a route R, which is a cubic curve, based on these constants.
[0047] Next, a control method using the control device 10 according to the first embodiment of the present disclosure will be described.
[0048] First, the route planning process will be described with reference to Fig. 8. The route planning process is executed, for example, every time it is detected that a gradient change section 18 with an uphill road 24 is located ahead in the traveling direction of the moving object 12. In the route planning process, first, in step ST10, the acquisition unit 72 acquires gradient change information and specification information. Step ST10 is an example of an "acquisition step" according to the present disclosure.
[0049] Next, in step ST12, the planning unit 74 plans a route R along which the moving object 12 travels on the travel path 16, based on the gradient change information and the specification information acquired in step ST10. As a result, when a gradient change section 18 with an uphill road 24 is located ahead of the moving object 12 in the traveling direction, a route R along which the moving object 12 enters the uphill road 24 at an angle is planned. Step ST10 is an example of a "planning step" according to the present disclosure. After the processing of step ST12, the route planning process ends.
[0050] Next, the driving control process will be described with reference to Fig. 9. The driving control process is executed when the route R is planned by the route planning process. In the driving control process, first, in step ST20, the estimation unit 76 estimates the self-position of the moving object 12 based on sensor information.
[0051] Next, in step ST22, the control unit 78 controls the drive unit 42 and the steering unit 44 of the traveling device 32 to make the moving body 12 travel along the route R, based on the self-position of the moving body 12 estimated in step ST20 and the route R planned by the route planning process. As a result, when a gradient change section 18 with an uphill road 24 is located ahead in the traveling direction of the moving body 12, the moving body 12 travels along the route R, causing the moving body 12 to enter the uphill road 24 obliquely. Step ST22 is an example of a "control step" according to the present disclosure.
[0052] Next, in step ST24, the CPU 50 determines whether or not the moving object 12 has finished traveling along the route R. If the moving object 12 has not finished traveling along the route R in step ST24, the determination is negative, and the traveling control process proceeds to step ST20. On the other hand, if the moving object 12 has finished traveling along the route R in step ST24, the determination is positive, and the traveling control process ends.
[0053] Next, effects of the first embodiment of the present disclosure will be described.
[0054] As described above in detail, in the control device 10 according to the first embodiment, the acquisition unit 72 acquires gradient change information related to gradient changes of the travel path 16 located ahead in the travel direction of the moving body 12 and specification information related to the specifications of the moving body 12. In addition, the planning unit 74 plans a route R along which the moving body 12 travels on the travel path 16 based on the gradient change information and the specification information. Therefore, before the moving body 12 enters the uphill road 24, it is possible to plan a route R that can prevent the driving wheels of the multiple wheels 14 from leaving the ground. Then, the control unit 78 performs control to make the moving body 12 travel along the route R planned by the planning unit 74. This makes it possible to prevent the driving wheels from leaving the ground. As a result, it is possible to prevent the driving wheels from spinning, so that the moving body 12 can climb the uphill road 24.
[0055] 3, the length of the vehicle body along the extension direction of the travel path 16 is shorter when the vehicle body 12 enters the uphill path 24 obliquely (length b in this case) than when the vehicle body 12 enters the uphill path 24 perpendicularly (length a in this case), and thus the distance d between the vehicle body 48 and the gradient change section 18 is shorter, making it possible to prevent the intermediate wheels from leaving the ground.
[0056] In addition, the route R is a route in which the wheels 14 maintain contact with the road surface while the moving body 12 enters the uphill road 24 at an angle. Therefore, by maintaining the wheels 14 in contact with the road surface, it is possible to obtain high stability and high propulsive force, compared to a case in which, for example, any one of the wheels 14 leaves the ground.
[0057] [Second embodiment] Next, a second embodiment of the present disclosure will be described.
[0058] In the second embodiment, the configuration of the control device 10 (see FIG. 6) is different from that of the above-described first embodiment as follows. That is, when calculating the lateral movement distance h and the entry angle α in planning the route R, the planner 74 takes into account the height of the moving body 12. That is, the planner 74 calculates the lateral movement distance h and the entry angle α by taking into account the gradient included in the gradient change information, the spacing between the wheels 14 and the range of movement of the suspension 46 included in the specification information, as well as the height of the moving body 12 included in the specification information.
[0059] When calculating the lateral movement distance h and the entry angle α, the gradient and the spacing between the wheels 14 are multiplied by a positive coefficient, and the height of the moving body 12 and the range of movement of the suspension 46 are multiplied by a negative coefficient. The coefficients are determined in advance according to the specifications of the moving body 12, etc. Then, based on the calculated lateral movement distance h and entry angle α, the planning unit 74 plans, as a route R, a route that avoids at least one of tipping and rolling over of the moving body 12 while the moving body 12 is entering the uphill road 24 obliquely.
[0060] For example, as shown in Fig. 10(A), when the bending angle θ is small (i.e., when the gradient is large), a route R with a long lateral movement distance h and a large intrusion angle α is planned. On the other hand, as shown in Fig. 10(B), when the bending angle θ is large (i.e., when the gradient is small), a route R with a short lateral movement distance h and a small intrusion angle α is planned.
[0061] 11(A), when the height of the moving body 12 is high (i.e., when the center of gravity of the moving body 12 is high), a route R with a short lateral movement distance h and a small intrusion angle α is planned. On the other hand, when the height of the moving body 12 is low (i.e., when the center of gravity of the moving body 12 is low) as shown in FIG. 11(B), a route R with a long lateral movement distance h and a large intrusion angle α is planned.
[0062] Also, for example, as shown in Fig. 12(A), when the interval between the wheels 14 is wide, a route R with a long lateral movement distance h and a large intrusion angle α is planned. On the other hand, as shown in Fig. 12(B), when the interval between the wheels 14 is narrow, a route R with a short lateral movement distance h and a small intrusion angle α is planned.
[0063] Also, for example, as shown in Fig. 13(A), when the range of movement of the suspension 46 is wide, a route R with a short lateral movement distance h and a small intrusion angle α is planned. On the other hand, as shown in Fig. 13(B), when the range of movement of the suspension 46 is narrow, a route R with a long lateral movement distance h and a large intrusion angle α is planned.
[0064] As described above in detail, in the second embodiment, the specification information includes information related to the height of the moving body 12, and the planning unit 74 plans, as the route R, a route that avoids at least one of tipping and rolling over of the moving body 12 while the moving body 12 enters the uphill road 24 at an angle. Therefore, when the moving body 12 travels along the route R planned by the planning unit 74, at least one of tipping and rolling over of the moving body 12 can be avoided while the moving body 12 enters the uphill road 24 at an angle.
[0065] [Third embodiment] Next, a third embodiment of the present disclosure will be described.
[0066] In the third embodiment, the configuration of the control device 10 (see FIG. 6) is different from that of the above-described first embodiment as follows. That is, when planning the route R, the planner 74 considers the long / short relationship between the lateral movement distance h and the distance h1. The distance h1 is the distance between the moving object 12 and the end of the travel path 16, and is calculated based on the width of the travel path 16 included in the map information, the width of the moving object 12 included in the specification information, and the self-position of the moving object 12 estimated by the acquisition unit 72. In addition, the planner 74 includes information on the speed of the moving object 12 in the route R to be planned.
[0067] For example, as shown in FIG. 14, when the lateral movement distance h calculated under the predetermined conditions is shorter than the distance h1 (that is, when h < h1), the planning unit 74 plans a path that obliquely enters the uphill road 24 at the first intrusion speed V1 included in the predetermined conditions and at the first intrusion angle α1 calculated under the predetermined conditions as the path R.
[0068] On the other hand, for example, as shown in the upper diagram of FIG. 15, there may be a case where the lateral movement distance h calculated under the predetermined conditions is longer than the distance h1 (that is, when h > h1). In this case, if the moving body 12 travels along the planned path R, the moving body 12 will deviate from the traveling path 16.
[0069] Therefore, when the lateral movement distance h calculated under the predetermined conditions is longer than the distance h1, the planning unit 74 plans a path that obliquely enters the uphill road 24 at a second intrusion angle α2 smaller than the first intrusion angle α1 as the path R, as shown in the lower diagram of FIG. 15. In this case, the planning unit 74 plans the path R so that the lateral movement distance h becomes shorter than the distance h1 (that is, h < h1).
[0070] In addition, the planning unit 74 plans a path as the path R in which the moving body 12 obliquely enters the uphill road 24 at a second speed V2 higher than the first intrusion speed V1 so that a situation where the moving body 12 cannot complete climbing the uphill does not occur when the moving body 12 obliquely enters the uphill road 24 at the second intrusion angle α2.
[0071] As described in detail above, in the third embodiment, when the lateral movement distance h when the moving body 12 obliquely enters the uphill road 24 at the first intrusion speed V1 and the first intrusion angle α1 is longer than the distance h1, the planning unit 74 plans a path R in which the moving body 12 enters the uphill road 24 at a second speed V2 higher than the first intrusion speed V1 and at a second intrusion angle α2 smaller than the first intrusion angle α1. Thereby, it is possible to avoid the moving body 12 from deviating from the traveling path 16 and to complete climbing the uphill road 24.
[0072] [Fourth Embodiment] Next, a fourth embodiment of the present disclosure will be described.
[0073] In the fourth embodiment, the configuration of the control device 10 (see FIG. 6) is different from that of the above-described first embodiment as follows. That is, the planner 74 takes into consideration the position of the center of gravity of the moving object 12 when planning the route R. The position of the center of gravity is acquired by the acquirer 72. The position of the center of gravity may be derived based on data acquired by the autonomous sensor 34, or may be derived based on data acquired by a detector that detects the position of the center of gravity. When the acquirer 72 acquires the position of the center of gravity, the acquirer 72 includes the position of the center of gravity in the specification information.
[0074] 16(A) and (B), there are cases where the luggage 90 carried on the moving body 12 is displaced in the width direction of the moving body 12 with respect to the center of the moving body 12. For example, in the example shown in Fig. 16(A), the luggage 90 carried on the moving body 12 is displaced to the right with respect to the center of the moving body 12, and in the example shown in Fig. 16(B), the luggage 90 carried on the moving body 12 is displaced to the left with respect to the center of the moving body 12.
[0075] When the luggage 90 carried by the moving body 12 is shifted to the right with respect to the center of the moving body 12, the center of gravity of the moving body 12 is also shifted to the side where the luggage 90 is carried. Therefore, for example, when the luggage 90 carried by the moving body 12 is shifted to the right with respect to the center of the moving body 12, if the moving body 12 enters the uphill road 24 diagonally while moving laterally to the right, the moving body 12 may be subjected to centrifugal force and roll over to the right. Similarly, when the luggage 90 carried by the moving body 12 is shifted to the left with respect to the center of the moving body 12, if the moving body 12 enters the uphill road 24 diagonally while moving laterally to the left, the moving body 12 may be subjected to centrifugal force and roll over to the left.
[0076] Therefore, when the center of gravity is shifted in the width direction of the moving body 12 with respect to the center of the moving body 12, the planning unit 74 plans a route R that enters the uphill road 24 obliquely from the side where the center of gravity is shifted. For example, as shown in Fig. 16(A), when the center of gravity is shifted to the right with respect to the center of the moving body 12, the planning unit 74 plans a route R that enters the uphill road 24 obliquely from the right side. On the other hand, as shown in Fig. 16(B), when the center of gravity is shifted to the left with respect to the center of the moving body 12, the planning unit 74 plans a route R that enters the uphill road 24 obliquely from the left side.
[0077] As described above in detail, in the fourth embodiment, when the center of gravity of the moving body 12 is shifted in the width direction of the moving body 12 with respect to the center of the moving body 12, the planning unit 74 plans a route R that enters the uphill road 24 obliquely from the side where the center of gravity is shifted. This makes it possible to prevent the moving body 12 from being subjected to centrifugal force and overturning when the moving body 12 enters the uphill road 24 obliquely.
[0078] In the fourth embodiment, when the moving body 12 enters the flat road 26 from the uphill road 24 (see FIG. 2(B)), even if the center of gravity is shifted in the width direction of the moving body 12 with respect to the center of the moving body 12, the planning unit 74 may plan a route R that enters the flat road 26 obliquely from the side where the center of gravity is shifted. Even in this case, when the moving body 12 enters the flat road 26 obliquely, it is possible to prevent the moving body 12 from being subjected to centrifugal force and overturning.
[0079] On the other hand, when the moving body 12 enters a downhill road from the flat road 26, if the center of gravity of the moving body 12 is shifted in the width direction of the moving body 12 with respect to the center of the moving body 12, the planning unit 74 may plan a route R for entering the downhill road obliquely from the side opposite to the side where the center of gravity is shifted. Even in this case, it is possible to prevent the moving body 12 from overturning due to centrifugal force when the moving body 12 enters the downhill road obliquely.
[0080] [Fifth embodiment] Next, a fifth embodiment of the present disclosure will be described.
[0081] In the fifth embodiment, the configurations of the mobile object 12 and the control device 10 are different from those of the first embodiment described above as follows. That is, the mobile object 12 includes an alarm device 100. The alarm device 100 is a device that issues an alarm to those around the mobile object 12, and includes, for example, a light emitter, a speaker, a monitor, and a vibrator. In addition, the communication I / F 60 of the mobile object 12 is communicably connected to a management device 112 of a management center 110. The management center 110 is an organization that manages the travel of the mobile object 12. The management device 112 is configured, for example, by a server or the like.
[0082] The CPU 50 also operates as a notification unit 80. The notification unit 80 performs control to notify when the planner 74 is unable to plan the route R. Examples of the notification control include operating the notification device 100 to issue a notification to those around the mobile object 12 and transmitting notification information to the management device 112 via the communication I / F 60. The notification information is information that notifies that the planner 74 is unable to plan the route R. Examples of cases in which the planner 74 is unable to plan the route R include when at least one of the gradient change information and the specification information is not acquired by the acquisition unit 72 due to a communication failure or malfunction, etc.
[0083] In addition, the control unit 78 may perform control to stop the traveling device 32 when the planner 74 is unable to plan the route R.
[0084] As described above in detail, in the fifth embodiment, when the planner 74 is unable to plan the route R, control is performed to notify the notification unit 80. Therefore, it is possible to notify the surroundings of the mobile object 12 or the management center 110 that the mobile object 12 is unable to plan the route R, and therefore that the mobile object 12 is unable to move along the route R.
[0085] [Sixth embodiment] Next, a sixth embodiment of the present disclosure will be described.
[0086] In the sixth embodiment, the configurations of the moving object 12 and the control device 10 are different from those of the first embodiment described above as follows. That is, as shown in Fig. 18, the moving object 12 includes an alarm device 100. The alarm device 100 is as described in the fifth embodiment.
[0087] The CPU 50 also operates as a discrimination unit 82 and an output unit 84. The acquisition unit 72 acquires an image obtained by capturing an image of the road 16 located in front of the moving body 12 by the camera 40. The acquisition unit 72 then acquires road surface condition information related to the condition of the road surface of the road 16 based on the image. The road surface condition information includes, for example, information on whether or not there is a foreign object on the road surface, information on whether or not there is an abnormality on the road surface, and information such as the friction coefficient of the road surface. The friction coefficient of the road surface is estimated based on the luminance of the road surface included in the image. The acquisition unit 72 also acquires gradient change information. As described in the first embodiment, the gradient change information includes information such as the gradient of the road 16.
[0088] The discrimination unit 82 discriminates the cause of the spinning of the drive wheels among the plurality of wheels 14, based on the road surface condition information and gradient change information acquired by the acquisition unit 72. The output unit 84 generates countermeasure information for the spinning of the drive wheels, based on the cause determined by the discrimination unit 82, and outputs the countermeasure information. The countermeasure information output from the output unit 84 is transmitted to the management device 112 of the management center 110 via the communication I / F 60. The countermeasure information output from the output unit 84 may be output to the alarm device 100.
[0089] For example, as shown in FIG. 19, when the discrimination unit 82 determines that there is no foreign object or abnormality based on the road surface condition information, it discriminates the cause based on the first table 120, and when it determines that there is a foreign object or abnormality, it discriminates the cause based on the second table 122.
[0090] The first table 120 and the second table 122 specify the relationship between the friction coefficient and gradient of the road surface and the cause. Cause No. 1 indicates that the cause is the gradient, cause No. 2 indicates that the cause is the friction coefficient, cause No. 3 indicates that the cause is dirt on the tires of the drive wheels, and cause No. 4 indicates that the cause is a foreign object or an abnormality.
[0091] If no foreign matter or abnormality is found, the discrimination unit 82 discriminates the cause based on the first table 120 in the following manner: That is, if the friction coefficient is large and the gradient is large, the discrimination unit 82 selects cause No. 1, and if the friction coefficient is large and the gradient is small, the discrimination unit 82 selects cause No. 3. Also, if the friction coefficient is small and the gradient is large, the discrimination unit 82 selects causes No. 1 and No. 2, and if the friction coefficient is small and the gradient is small, the discrimination unit 82 selects cause No. 2.
[0092] On the other hand, when a foreign object or abnormality is found, the discrimination unit 82 discriminates the cause based on the second table 122 in the following manner. That is, when the friction coefficient is large and the gradient is large, the discrimination unit 82 selects causes No. 1 and No. 4, and when the friction coefficient is large and the gradient is small, the discrimination unit 82 selects causes No. 1, No. 2, and No. 4. When the friction coefficient is small and the gradient is large, the discrimination unit 82 selects causes No. 2 and No. 4. When the friction coefficient is small and the gradient is small, the discrimination unit 82 selects causes No. 2 and No. 4.
[0093] The output unit 84 generates countermeasure information based on the third table 124. Countermeasure information A indicates reviewing the route R, countermeasure information B indicates changing to tires with higher friction, countermeasure information C indicates cleaning the tires, and countermeasure information D indicates removing foreign matter or resolving the abnormality. A tire changing robot that operates on command from the management device 112 may be used to change the tires. A cleaning robot that operates on command from the management device 112 may be used to clean the tires and remove foreign matter.
[0094] Then, the output unit 84 generates countermeasure information based on the third table 124 in the following manner. That is, when the discrimination unit 82 selects cause No. 1, the output unit 84 generates countermeasure information A, and when the discrimination unit 82 selects cause No. 2, the output unit 84 generates countermeasure information B. Also, when the discrimination unit 82 selects cause No. 3, the output unit 84 generates countermeasure information C, and when the discrimination unit 82 selects cause No. 4, the output unit 84 generates countermeasure information D.
[0095] As described above in detail, in the fifth embodiment, the discrimination unit 82 discriminates the cause of the spinning of the drive wheels among the plurality of wheels 14 based on road surface condition information and gradient change information relating to the condition of the road surface of the travel road 16. Then, the output unit 84 outputs countermeasure information for the spinning of the drive wheels based on the cause. Therefore, it is possible to take countermeasures according to the cause of the spinning of the drive wheels based on the countermeasure information.
[0096] Furthermore, when causes No. 1, No. 2, and No. 4 (that is, causes other than dirt on the tires) are selected, it is possible to avoid the waste of dispatching the cleaning robot to clean the tires.
[0097] If the output unit 84 determines that the cause of the spinning of the drive wheels is dirt on the drive wheels, the output unit 84 may include information in the countermeasure information that prompts the user to change or clean the tires. In this way, when the countermeasure information is received by the management device 112, the management center 110 can proceed to a process for changing or cleaning the tires (for example, a process for operating a changing robot or a cleaning robot).
[0098] Furthermore, when it is determined that the cause of the spinning of the drive wheels is a foreign object on the road surface, the output unit 84 may include information for urging the removal of the foreign object in the countermeasure information. In this way, when the countermeasure information is received by the management device 112, the management center 110 can proceed to a process for removing the foreign object (for example, a process for operating a cleaning robot).
[0099] The above describes the first to ninth embodiments of the present disclosure. However, the present disclosure is not limited to the above, and it goes without saying that the present disclosure can be implemented in various modified forms within the scope of the present disclosure.
[0100] For example, in each of the above embodiments, the control device 10 is mounted on the moving object 12, but it may be mounted on an external device other than the moving object 12. The external device may be communicably connected to the moving object 12, and the moving object 12 may travel in response to a command from the external device. The external device may be a dedicated command device or a server.
[0101] In addition, in each of the above embodiments, the control device 10 has a function of performing route planning processing to plan the route R and a function of performing driving control processing to control the traveling device 32, but may be divided into a first control device having a function of performing route planning processing and a second control device having a function of performing driving control processing.
[0102] In addition, both the first control device and the second control device may be mounted on the moving body 12, but either one of them may be mounted on an external device. In addition, both the first control device and the second control device may be mounted on an external device, or each may be mounted on a different external device.
[0103] The apparatus and methods described herein may be implemented by a special-purpose computer having a processor programmed to execute one or more functions embodied in a computer program. Alternatively, the apparatus and methods described herein may be implemented by a special-purpose computer having a processor configured with dedicated hardware logic circuits. Alternatively, the apparatus and methods described herein may be implemented by one or more special-purpose computers configured by a combination of a processor that executes a computer program and one or more hardware logic circuits. The computer program may also be stored on a computer-readable non-transitory tangible recording medium as instructions that are executed by the computer.
[0104] The features of the present disclosure are as follows: (Appendix 1) an acquisition unit (72) that acquires gradient change information relating to gradient changes of a roadway (16) located ahead of a moving body (12) having a plurality of wheels (14) in a traveling direction of the moving body, and specification information relating to specifications of the moving body; a planning unit (74) that plans a route (R) along which the moving object travels on the travel path based on the gradient change information and the specification information; A control unit (78) that controls the moving body to travel along the route; A control device (10) comprising: (Appendix 2) The travel path includes a first travel path (22) and a second travel path (24) connected to the first travel path via a gradient change section (18), The path is a path in which the moving body enters the second traveling path obliquely. 2. The control device according to claim 1. (Appendix 3) The travel path includes a first travel path and a second travel path that is connected to the first travel path via a gradient change section, the path is a path along which the wheels maintain a state of contact with a road surface while the moving body enters the second traveling path obliquely, 3. The control device according to claim 1 or 2. (Appendix 4) The travel path includes a first travel path and a second travel path that is connected to the first travel path via a gradient change section, The specification information includes information regarding a height of the moving object, The route is a route that avoids at least one of tipping and rolling over of the moving body while the moving body enters the second traveling path obliquely. 4. The control device according to claim 1, (Appendix 5) The travel path includes a first travel path and a second travel path that is connected to the first travel path via a gradient change section, When the second traveling path is an uphill path (24) and a lateral movement distance when the moving body enters the second traveling path obliquely at a first entry speed and a first entry angle is longer than a distance between the moving body and an end of the traveling path, the planning unit plans, as the route, a route in which the moving body enters the uphill path obliquely at a second entry speed higher than the first entry speed and a second entry angle smaller than the first entry angle. 5. The control device according to claim 1 , (Appendix 6) The travel path includes a first travel path and a second travel path that is connected to the first travel path via a gradient change section, the specification information includes information regarding a position of a center of gravity of the moving body, When the second traveling path is an uphill road and the center of gravity is shifted in a width direction of the moving body with respect to a center of the moving body, the planning unit plans, as the route, a route that enters the uphill road obliquely from the side where the center of gravity is shifted. 6. The control device according to claim 1 , (Appendix 7) The system further includes a notification unit (80) that performs control to notify a user when the planning unit is unable to plan the route. 7. The control device according to any one of claims 1 to 6. (Appendix 8) a determination unit (82) that determines a cause of a spin of a driving wheel among the plurality of wheels based on road surface condition information related to a condition of the road surface of the travel road and the gradient change information; an output unit (84) that outputs countermeasure information for the spinning of the drive wheels based on the cause; Further comprising: 8. The control device according to any one of claims 1 to 7. (Appendix 9) when it is determined that the cause is dirt on the tires of the drive wheels, the output unit includes information that prompts the user to replace or clean the tires in the countermeasure information. 9. The control device according to claim 8. (Appendix 10) when it is determined that the cause is a foreign object on the road surface, the output unit includes information for prompting removal of the foreign object in the countermeasure information. 9. The control device according to claim 8. (Appendix 11) A computer (10) an acquisition step of acquiring gradient change information relating to gradient change of a roadway located ahead in a traveling direction of a mobile body having a plurality of wheels and specification information relating to specifications of the mobile body; a planning step of planning a route for the moving object to travel on the travel path based on the gradient change information and the specification information; a control step of controlling the moving object to travel along the route; A control method for executing a process including the steps of: (Appendix 12) On the computer, an acquisition step of acquiring gradient change information relating to gradient change of a roadway located ahead in a traveling direction of a mobile body having a plurality of wheels and specification information relating to specifications of the mobile body; a planning step of planning a route for the moving object to travel on the travel path based on the gradient change information and the specification information; a control step of controlling the moving object to travel along the route; A control program (70) for executing the process including the steps of: [Explanation of symbols]
[0105] 10...control device, 12...mobile body, 14...wheel, 16...running path, 18, 20...gradient change section, 22, 26...flat road, 24...uphill road, 30...sensing section, 32...running device, 34...autonomous sensor, 36...LiDAR sensor, 38...stereo camera, 40...camera, 42...driving device, 44...steering device, 46...suspension, 48...vehicle body, 50...CPU, 52...ROM, 54... RAM, 56...storage, 58...input / output I / F, 60...communication I / F, 62...bus, 70...control program, 72...acquisition unit, 74...planning unit, 76...estimation unit, 78...control unit, 80...notification unit, 82...discrimination unit, 84...output unit, 90...baggage, 100...notification device, 110...management center, 112...management device, 120...first table, 122...second table, 124...third table
Claims
1. an acquisition unit (72) that acquires gradient change information related to gradient changes of a roadway (16) located ahead of a moving body (12) having a plurality of wheels (14) in a traveling direction of the moving body, and specification information related to specifications of the moving body; a planning unit (74) that plans a route (R) along which the moving body travels on the travel path based on the gradient change information and the specification information; A control unit (78) that controls the moving body to travel along the route; A control device (10) comprising:
2. The travel path includes a first travel path (22) and a second travel path (24) connected to the first travel path via a gradient change section (18), The path is a path in which the moving body enters the second travel path obliquely. The control device according to claim 1 .
3. The travel path includes a first travel path and a second travel path connected to the first travel path via a gradient change portion, the path is a path along which the wheels maintain a state of contact with a road surface while the moving body enters the second travel path obliquely; The control device according to claim 1 .
4. The travel path includes a first travel path and a second travel path connected to the first travel path via a gradient change portion, The specification information includes information regarding a height of the moving object, the route is a route that avoids at least one of tipping over and rolling over of the moving body while the moving body is entering the second travel path obliquely, The control device according to claim 1 .
5. The travel path includes a first travel path and a second travel path connected to the first travel path via a gradient change portion, When the second travel path is an uphill road (24) and a lateral movement distance when the moving body enters the second travel path obliquely at a first entry speed and a first entry angle is longer than a distance between the moving body and an end of the travel path, the planning unit plans, as the route, a route in which the moving body enters the uphill road obliquely at a second entry speed higher than the first entry speed and a second entry angle smaller than the first entry angle. The control device according to claim 1 .
6. The travel path includes a first travel path and a second travel path connected to the first travel path via a gradient change portion, the specification information includes information regarding a position of a center of gravity of the moving body, When the second traveling path is an uphill road and the center of gravity is shifted in a width direction of the moving body with respect to a center of the moving body, the planning unit plans, as the route, a route that enters the uphill road obliquely from the side where the center of gravity is shifted. The control device according to claim 1 .
7. The system further includes a notification unit (80) that performs control to notify a user when the planning unit is unable to plan the route. The control device according to claim 1 .
8. a determination unit (82) that determines a cause of a spin of a driving wheel among the plurality of wheels based on road surface condition information related to a condition of the road surface of the travel path and the gradient change information; an output unit (84) that outputs countermeasure information for the spinning of the drive wheels based on the cause; Further comprising: The control device according to claim 1 .
9. when it is determined that the cause is dirt on the tires of the drive wheels, the output unit includes information that prompts the user to replace or clean the tires in the countermeasure information. The control device according to claim 8.
10. when it is determined that the cause is a foreign object on the road surface, the output unit includes information for prompting removal of the foreign object in the countermeasure information. The control device according to claim 8.
11. A computer (10) an acquisition step of acquiring gradient change information relating to gradient change of a roadway located ahead in a traveling direction of a mobile body having a plurality of wheels and specification information relating to specifications of the mobile body; a planning step of planning a route for the moving object to travel on the travel path based on the gradient change information and the specification information; a control step of controlling the moving object to travel along the route; A control method for executing a process including the steps of:
12. On the computer, an acquisition step of acquiring gradient change information relating to gradient change of a roadway located ahead in a traveling direction of a mobile body having a plurality of wheels and specification information relating to specifications of the mobile body; a planning step of planning a route for the moving object to travel on the travel path based on the gradient change information and the specification information; a control step of controlling the moving object to travel along the route; A control program (70) for executing a process including the steps of:
Citation Information
Patent Citations
Complex terrain trajectory tracking control method for six-wheel independently-driven and independently-steering robot
CN115268450A
On-vehicle navigation system
JP2008175581A
Agricultural working machine
JP2018085960A
Crane
JP2018095365A
Off-road vehicle and ground surface control system
JP2018185672A
