Obstacle sensor inspection device and method

Abstract

To provide an obstacle sensor inspection system and method capable of detecting whether an abnormality of an obstacle sensor has occurred during traveling of a moving body.SOLUTION: An obstacle sensor inspection system 20 includes a travel control unit 22 that controls a moving body 1 so that the moving body can travel along a travel route R, an inspection processing unit 24 that, when the moving body 1 is traveling, uses an inspectional stationary object 4C in a sensor inspection section S to perform inspection processing on an obstacle sensor 5, and a detection area setting unit 25 that, when inspection processing is performed on the obstacle sensor 5, sets a detection area A of the obstacle sensor 5 to a second area A2 wider than a first area A1 which is used during normal traveling. When the inspectional stationary object 4C is detected by the obstacle sensor 5, the inspection processing unit 24 determines that the obstacle sensor 5 is normal. When the inspectional stationary object 4C is not detected by the obstacle sensor 5, the inspection processing unit determines that the obstacle sensor 5 is abnormal.SELECTED DRAWING: Figure 5

Description

[Technical Field]

[0001] The present invention relates to an obstacle sensor inspection device and method. [Background technology]

[0002] For example, Patent Document 1 describes a technology in which, before an autonomous work vehicle begins autonomous driving, it checks for abnormalities in sensors such as obstacle sensors that detect whether there are any obstacles around the autonomous work vehicle, and if an abnormality is found in the sensors, the details of the abnormality are displayed on a display. [Prior art documents] [Patent documents]

[0003] [Patent Document 1] Japanese Patent Application Laid-Open No. 2015-222503 Summary of the Invention [Problem to be solved by the invention]

[0004] However, in the above-mentioned conventional technology, the obstacle sensors are inspected only before the autonomously traveling work vehicle begins autonomous traveling, and therefore it is not possible to respond to malfunctions while the autonomously traveling work vehicle is traveling.

[0005] An object of the present invention is to provide an obstacle sensor inspection device and method that can detect whether an abnormality has occurred in an obstacle sensor while a mobile object is traveling. [Means for solving the problem]

[0006] One aspect of the present invention is an obstacle sensor inspection device that inspects obstacle sensors that detect obstacles around a moving body, and includes a travel control unit that controls the moving body to travel along a travel path, an inspection processing unit that performs an inspection process of the obstacle sensor using a pre-specified stationary object for inspection in a pre-specified sensor inspection section while the moving body is traveling along the travel path, and a detection area setting unit that, when the inspection processing unit performs the inspection process of the obstacle sensor, sets the detection area of ​​the obstacle sensor to a second area that is larger than the first area used during normal traveling.When the stationary object for inspection is detected by the obstacle sensor, the inspection processing unit determines that the obstacle sensor is normal, and when the stationary object for inspection is not detected by the obstacle sensor, it determines that the obstacle sensor is abnormal.

[0007] In such an obstacle sensor inspection device, when a mobile body is traveling along a travel route and reaches a sensor inspection section, an inspection process for the obstacle sensor is performed using a stationary inspection object while the mobile body travels through the sensor inspection section. If the stationary inspection object is detected by the obstacle sensor, the obstacle sensor is determined to be normal, and if the stationary inspection object is not detected by the obstacle sensor, the obstacle sensor is determined to be abnormal. Here, a second area, which is wider than the first area used during normal travel, is used as the detection area for the obstacle sensor. Therefore, when the mobile body travels through the sensor inspection section, the stationary inspection object is more easily detected by the obstacle sensor. This makes it possible to detect whether an abnormality has occurred in the obstacle sensor while the mobile body is traveling.

[0008] The obstacle sensor inspection device may further include an inspection preparation processing unit that performs preparation processing in a sensor inspection preparation section located earlier in the direction of travel of the mobile body than the sensor inspection section, before the inspection processing of the obstacle sensor is performed by the inspection processing unit, to prevent the mobile body from coming into contact with an obstacle when traveling through the sensor inspection section.

[0009] In this configuration, when the mobile body reaches a sensor inspection preparation section located before the sensor inspection section in the direction of travel of the mobile body, a preparation process is executed while the mobile body is traveling through the sensor inspection preparation section to prevent the mobile body from coming into contact with an obstacle while traveling through the sensor inspection section. Then, an inspection process for the obstacle sensor is executed in the sensor inspection section. Therefore, even if there is a possibility that an obstacle may be present around the mobile body while traveling through the sensor inspection section, the mobile body is prevented from coming into contact with the obstacle.

[0010] As a preparation process, the inspection preparation processing unit sets the detection area of ​​the obstacle sensor to a third area which is larger than the first area, and determines whether or not an obstacle is detected by the obstacle sensor in that state. When the inspection preparation processing unit determines that no obstacle is detected by the obstacle sensor, if the obstacle sensor detects a stationary object for inspection, the inspection processing unit may determine that the obstacle sensor is normal, or if the obstacle sensor does not detect a stationary object for inspection, determine that the obstacle sensor is abnormal.

[0011] In this configuration, when the mobile object reaches the sensor inspection preparation section, the detection area of ​​the obstacle sensor is changed from the first area to the third area, and it is determined whether the obstacle sensor detects an obstacle. If it is determined that the obstacle sensor does not detect an obstacle, an inspection process for the obstacle sensor is executed in the sensor inspection section. Here, the detection area of ​​the obstacle sensor is the third area, which is larger than the first area used during normal driving. Therefore, when the mobile object travels through the sensor inspection preparation section, the obstacle sensor is more likely to detect an obstacle. Therefore, it is possible to accurately detect whether an obstacle exists around the mobile object when the mobile object travels through the sensor inspection section.

[0012] As a preparation process, the inspection preparation processing unit may perform control so as to decelerate the moving body to a speed at which the moving body will not come into contact with an obstacle when traveling through the sensor inspection section.

[0013] In this configuration, when the moving object reaches the sensor inspection preparation section, it decelerates to a speed that will prevent it from coming into contact with an obstacle as it travels through the sensor inspection section. By decelerating the moving object in this manner in the sensor inspection preparation section, it is possible to shorten the distance required to inspect the obstacle sensors.

[0014] The second area may be set to be wider than the first area in at least one of the traveling direction and width direction of the moving object.

[0015] In such a configuration, when the mobile body travels along the travel route, a stationary object present in the direction of travel or to the side of the mobile body is used as the stationary object for inspection.

[0016] The travel route has a curved section, the sensor inspection section is designated at a position before the curved section in the direction of travel of the mobile body, and the stationary object for inspection may be positioned so as to fall within the second area when the mobile body travels through the sensor inspection section.

[0017] In this configuration, a stationary object located near a curve in the travel route is used as the inspection object, and the inspection process of the obstacle sensor can be effectively performed using an appropriate stationary object as the inspection object.

[0018] Another aspect of the present invention is an obstacle sensor inspection method for inspecting obstacle sensors that detect obstacles around a mobile body, the method including the steps of: specifying a sensor inspection section along a travel path along which the mobile body is traveling, where inspection of the obstacle sensors is carried out; a sensor inspection preparation section that is located earlier in the direction of travel of the mobile body than the sensor inspection section; and a stationary inspection object to be used for inspecting the obstacle sensors in the sensor inspection section; controlling the mobile body to travel along the travel path; performing an inspection process of the obstacle sensors using the stationary inspection object in the sensor inspection section while the mobile body is traveling along the travel path; and, when performing the inspection process of the obstacle sensors, setting the detection area of ​​the obstacle sensors to a second area that is larger than the first area used during normal travel; and, in the step of performing the inspection process of the obstacle sensors, determining that the obstacle sensors are normal when the stationary inspection object is detected by the obstacle sensors, and determining that the obstacle sensors are abnormal when the stationary inspection object is not detected by the obstacle sensors.

[0019] In this obstacle sensor inspection method, when a mobile body is traveling along a travel route and reaches a sensor inspection section, an inspection process for the obstacle sensor is performed using a stationary inspection object while the mobile body travels through the sensor inspection section. If the stationary inspection object is detected by the obstacle sensor, the obstacle sensor is determined to be normal, and if the stationary inspection object is not detected by the obstacle sensor, the obstacle sensor is determined to be abnormal. Here, a second area, which is wider than the first area used during normal travel, is used as the detection area for the obstacle sensor. Therefore, when the mobile body travels through the sensor inspection section, the stationary inspection object is more easily detected by the obstacle sensor. This makes it possible to detect whether an abnormality has occurred in the obstacle sensor while the mobile body is traveling. [Effects of the Invention]

[0020] According to the present invention, it is possible to detect whether an abnormality has occurred in an obstacle sensor while a mobile object is traveling. [Brief explanation of the drawings]

[0021] [Figure 1] 1 is a schematic diagram showing a moving body equipped with an obstacle sensor inspection device according to an embodiment of the present invention; [Figure 2] 10A and 10B are diagrams showing an example of a sensor inspection section, a sensor inspection preparation section, a stationary object for inspection, and a detection area of ​​an obstacle sensor specified on a travel route. [Figure 3] 3 is a flowchart illustrating some steps of an obstacle sensor inspection method according to one embodiment of the present invention. [Figure 4] 10 is a flowchart illustrating another part of the steps of the obstacle sensor inspection method according to the embodiment of the present invention. [Figure 5] 1 is a block diagram showing the configuration of a travel control device equipped with an obstacle sensor inspection device according to a first embodiment of the present invention. [Figure 6] 6 is a flowchart showing the procedure of a driving control process executed by a driving control unit shown in FIG. 5. [Figure 7] 6 is a flowchart showing the procedure of an inspection process executed by an inspection processing unit shown in FIG. 5. [Figure 8] 6 is a flowchart showing the procedure of a detection area setting process executed by a detection area setting unit shown in FIG. 5. [Figure 9] 6 is a flowchart showing the procedure of an inspection preparation process executed by an inspection preparation processing unit shown in FIG. 5. [Figure 10] 6 is a timing diagram showing the traveling speed of a moving object and the detection area of ​​an obstacle sensor when the obstacle sensor is inspected by the obstacle sensor inspection device shown in FIG. 5. FIG. [Figure 11] FIG. 6 is a block diagram showing the configuration of a travel control device equipped with an obstacle sensor inspection device according to a second embodiment of the present invention. [Figure 12] 12 is a flowchart showing the procedure of a detection area setting process executed by a detection area setting unit shown in FIG. [Figure 13] 12 is a flowchart showing the procedure of an inspection preparation process executed by an inspection preparation processing unit shown in FIG. 11. [Figure 14] 12 is a timing diagram showing the traveling speed of a moving body and the detection area of ​​an obstacle sensor when the obstacle sensor is inspected by the obstacle sensor inspection device shown in FIG. 11. FIG. [Figure 15] 3 is a diagram showing a modified example of the detection area of ​​the obstacle sensor in the sensor inspection section shown in FIG. 2. FIG. DETAILED DESCRIPTION OF THE INVENTION

[0022] DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS Hereinafter, embodiments of the present invention will be described in detail with reference to the accompanying drawings. In the drawings, the same or equivalent elements are designated by the same reference numerals, and redundant explanations will be omitted.

[0023] Fig. 1 is a schematic diagram showing a mobile body equipped with an obstacle sensor inspection device according to one embodiment of the present invention. In Fig. 1, the mobile body 1 is an industrial vehicle such as a towing vehicle. The mobile body 1 has a base 2 and four wheels 3 arranged on the front, rear, left and right sides of the base 2.

[0024] As shown in FIG. 2, the mobile unit 1 autonomously travels along a predetermined travel route R. Here, the travel route R is a circular course. The travel route R includes a straight section r1 and a curved section r2. A plurality of stationary objects 4, such as pillars, shelves, and walls, are arranged around the travel route R.

[0025] The mobile body 1 is equipped with an obstacle sensor 5 that detects an obstacle X that exists around the mobile body 1 while traveling along the travel route R. The obstacle X may be a worker, another industrial vehicle, or luggage. The obstacle sensor 5 may be, for example, a laser sensor such as a LIDAR (Light Detection and Ranging) or a laser range finder. The laser sensor detects objects that exist around the mobile body 1 by emitting a laser beam toward the surroundings of the mobile body 1 and receiving the reflected laser light. The laser sensor irradiates a laser beam in an area that includes the traveling direction (forward) of the mobile body 1.

[0026] The obstacle sensor 5 is an area setting type sensor in which a detection area A is set, and detects whether an obstacle X is present in the detection area A. Although not shown in the figure, the detection area A of the obstacle sensor 5 includes a stop area and a deceleration area. The deceleration area is a wider range than the stop area.

[0027] In this embodiment, inspection of the obstacle sensors 5 is carried out while the moving body 1 is traveling along the travel route R. As shown in Fig. 2, a sensor inspection section S (see Fig. 2(b)), a sensor inspection preparation section S0 (see Fig. 2(a)), and a stationary object for inspection 4C are designated along the travel route R.

[0028] The sensor inspection section S is a section where inspection of the obstacle sensors 5 is carried out while the moving object 1 is traveling. The sensor inspection section S is specified at a position before any curve section r2 (referred to as curve section rs) among the multiple curve sections r2 on the travel route R in the direction of travel of the moving object 1. The distance of the sensor inspection section S is a distance that the moving object 1 travels for at least the time required to inspect the obstacle sensors 5.

[0029] The sensor inspection preparation section S0 is located before the sensor inspection section S in the direction of travel of the mobile body 1. The sensor inspection preparation section S0 is a section in which preparations are made to prevent the mobile body 1 from coming into contact with the obstacle X when the mobile body 1 travels through the sensor inspection section S. The distance of the sensor inspection preparation section S0 is a distance traveled that is equal to or longer than the time required for preparations to prevent the mobile body 1 from coming into contact with the obstacle X when the mobile body 1 travels through the sensor inspection section S.

[0030] The stationary object for inspection 4C is placed around the curved section rs of the travel route R. Specifically, the stationary object for inspection 4C is placed in front of the moving body 1 when the moving body 1 travels on the straight section r1 just before the curved section rs. The stationary object for inspection 4C is a stationary object 4 used to inspect the obstacle sensor 5.

[0031] 3 is a flowchart showing some of the steps of an obstacle sensor inspection method according to one embodiment of the present invention. This flowchart shows preliminary steps that are carried out by a user before actually inspecting the obstacle sensor 5.

[0032] 3, first, the sensor inspection section S and the sensor inspection preparation section S0 are designated (step S101) on the travel route R. Also, the stationary object for inspection 4C is designated (step S102).

[0033] Furthermore, a detection area A of the obstacle sensor 5 is designated (step S103). The detection area A of the obstacle sensor 5 is designated as a first area A1 used during normal travel of the mobile object 1, a second area A2 used when the mobile object 1 travels through the sensor inspection section S, and a third area A3 used when the mobile object 1 travels through the sensor inspection preparation section S0. The detection area A of the obstacle sensor 5 will be described in detail later.

[0034] Then, the designation data of the sensor inspection section S, the sensor inspection preparation section S0, the stationary object for inspection 4C, and the detection area A of the obstacle sensor 5 are stored in the storage unit 11, which will be described later (step S104).

[0035] 4 is a flowchart showing another part of the steps of the obstacle sensor inspection method according to one embodiment of the present invention. This flowchart shows the steps of actually inspecting the obstacle sensor 5. This flowchart is executed when an instruction to start inspecting the obstacle sensor 5 is given by, for example, an operation switch (not shown).

[0036] 4, first, the moving object 1 is caused to travel normally at a specified speed V along a travel route R (step S111). Next, it is determined whether the traveling of the moving object 1 has ended (step S112). When the traveling of the moving object 1 has ended, this flowchart ends.

[0037] If the traveling of the moving object 1 has not finished, in the sensor inspection preparation section S0, preparations are made to prevent the moving object 1 from coming into contact with the obstacle X when the moving object 1 travels through the sensor inspection section S (step S113). Subsequently, in the sensor inspection section S, the obstacle sensor 5 is inspected while the moving object 1 travels (step S114). Then, the above-mentioned step S111 is performed again.

[0038] 5 is a block diagram showing the configuration of a cruise control device equipped with an obstacle sensor inspection device according to the first embodiment of the present invention. The cruise control device 10 is a device that causes a moving body 1 to autonomously travel along a travel route R. The cruise control device 10 is mounted on the moving body 1.

[0039] The travel control device 10 includes the obstacle sensor 5, a memory unit 11, a self-position estimation sensor 12, a drive unit 13, an alarm 14, and a controller 15.

[0040] The memory unit 11 stores map data of the area in which the moving body 1 travels, travel route data on which the moving body 1 travels, and designation data for the above-mentioned sensor inspection section S, sensor inspection preparation section S0, stationary object for inspection 4C, and detection area A of the obstacle sensor 5, etc.

[0041] The self-position estimation sensor 12 is used to estimate the self-position of the mobile body 1. The self-position estimation sensor 12 detects stationary objects 4 that exist around the mobile body 1 while the mobile body 1 is traveling. Here, a laser sensor or the like is used as the self-position estimation sensor 12, similar to the obstacle sensor 5.

[0042] The drive unit 13 has, for example, a travel motor that rotates the wheels 3 of the moving body 1 and a steering motor that steers the wheels 3, although these are not shown.

[0043] When the obstacle sensor 5 detects an obstacle X present around the moving object 1, the alarm device 14 issues an alarm to the effect that an obstacle X is present. The alarm device 14 issues an alarm by sound or visual indication.

[0044] The controller 15 is composed of a CPU, RAM, ROM, an input / output interface, etc. The controller 15 has a self-position estimation unit 21, a traveling control unit 22, an obstacle detection unit 23, an inspection processing unit 24, a detection area setting unit 25, and an inspection preparation processing unit 26. These functions are executed when an instruction to start autonomous traveling of the moving body 1 is given by, for example, an operation switch (not shown).

[0045] The self-position estimation unit 21 estimates the self-position of the moving object 1 based on the detection data of the self-position estimation sensor 12 and the map data stored in the storage unit 11. Specifically, the self-position estimation unit 21 estimates the self-position of the moving object 1 by matching the detection data of the self-position estimation sensor 12 with the map data, for example, using a SLAM (simultaneous localization and mapping) technique. SLAM is a self-position estimation technology that estimates the self-position using sensor data and map data.

[0046] The traveling control unit 22 controls the driving unit 13 to make the moving object 1 travel along the traveling route R, based on the self-position of the moving object estimated by the self-position estimation unit 21. The procedure of the traveling control unit 22 will be described later.

[0047] The obstacle detection unit 23 determines whether an obstacle exists in the traveling direction (forward) of the moving body 1 based on the detection data of the obstacle sensor 5, and outputs an alarm notification signal to the alarm device 14 and the driving control unit 22 when an obstacle exists in the traveling direction of the moving body 1.

[0048] The inspection processing unit 24 performs inspection processing of the obstacle sensor 5 using the stationary object for inspection 4C in the sensor inspection section S when the mobile body 1 is traveling along the travel route R. When the stationary object for inspection 4C is detected by the obstacle sensor 5, the inspection processing unit 24 determines that the obstacle sensor 5 is normal, and when the stationary object for inspection 4C is not detected by the obstacle sensor 5, the inspection processing unit 24 determines that the obstacle sensor 5 is abnormal. The procedure of the inspection processing unit 24 will be described later.

[0049] When the inspection processing unit 24 performs inspection processing of the obstacle sensor 5 in the sensor inspection section S, the detection area setting unit 25 sets the detection area A of the obstacle sensor 5 to a second area A2 that is larger than the first area A1 used during normal driving.

[0050] As shown in FIG. 2(b), the second area A2 is wider than the first area A1 in the traveling direction of the moving object 1. In other words, the length dimension L2 of the second area A2 is greater than the length dimension L1 of the first area A1. The length dimension of the detection area A of the obstacle sensor 5 is the dimension along the traveling direction of the moving object 1. The above-mentioned stationary object for inspection 4C is positioned so as to fit within the second area A2 when the moving object 1 travels through the sensor inspection section S.

[0051] Before the inspection processing unit 24 executes the inspection processing of the obstacle sensor 5, the inspection preparation processing unit 26 executes preparation processing in the sensor inspection preparation section S0 to prevent the moving body 1 from coming into contact with the obstacle X when the moving body 1 travels through the sensor inspection section S. As the preparation processing, the inspection preparation processing unit 26 sets the detection area A of the obstacle sensor 5 to a third area A3 that is larger than the first area A1, and determines whether or not the obstacle X is detected by the obstacle sensor 5 in that state.

[0052] 2(a) and 2(b), the third area A3 is wider than the first area A1 in the traveling direction of the mobile object 1, and narrower than the second area A2 in the traveling direction of the mobile object 1. The third area A3 is wider than the first area A1 in the traveling direction of the mobile object 1, for example, by the distance x that the mobile object 1 travels in the time required to inspect the obstacle sensor 5. In other words, the length dimension L3 of the third area A3 is the sum (L1+x) of the length dimension L1 of the first area A1 and the distance x. The procedure of the inspection preparation processing unit 26 will be described later.

[0053] The obstacle sensor inspection device 20 of this embodiment is a device that inspects the obstacle sensors 5. In other words, the obstacle sensor inspection device 20 is a device that implements the above-mentioned obstacle sensor inspection method. The obstacle sensor inspection device 20 is composed of a memory unit 11, a self-position estimation sensor 12, a drive unit 13, an alarm 14, a self-position estimation unit 21 of a controller 15, a travel control unit 22, an inspection processing unit 24, a detection area setting unit 25, and an inspection preparation processing unit 26.

[0054] Fig. 6 is a flowchart showing the procedure of the travel control process executed by the travel control unit 22. In Fig. 6, the travel control unit 22 first determines whether an alarm notification signal has been input from the obstacle detection unit 23, thereby determining whether an obstacle X present in the traveling direction of the moving object 1 has been detected by the obstacle sensor 5 (step S131).

[0055] When the traveling control unit 22 determines that the obstacle sensor 5 has not detected an obstacle X present in the traveling direction of the moving body 1, the traveling control unit 22 controls the drive unit 13 to make the moving body 1 travel at a specified speed V (see Figure 10(a)) along the traveling route R based on the self-position of the moving body 1 estimated by the self-position estimation unit 21 (step S132), and executes the above step S131 again.

[0056] When the traveling control unit 22 determines that the obstacle sensor 5 has detected an obstacle X present in the traveling direction of the moving body 1, it determines whether an inspection start signal (described later) has been input from the inspection preparation processing unit 26, thereby determining whether the inspection processing of the obstacle sensor 5 by the inspection processing unit 24 is currently being performed (step S133).

[0057] When the traveling control unit 22 determines that the inspection processing unit 24 is not currently performing the inspection processing of the obstacle sensor 5, it controls the drive unit 13 to stop or decelerate the moving body 1 (step S134), and executes the above step S131 again. At this time, if the obstacle detection unit 23 detects that there is an obstacle X within the stopping area (described above) of the detection area A of the obstacle sensor 5, it controls the drive unit 13 to stop the moving body 1. When the obstacle detection unit 23 detects that there is no obstacle X within the stopping area of ​​the detection area A of the obstacle sensor 5 but that there is an obstacle X within the deceleration area (described above), it controls the drive unit 13 to decelerate the moving body 1.

[0058] When the traveling control unit 22 determines that the inspection processing unit 24 is currently executing the inspection process of the obstacle sensor 5, it controls the drive unit 13 to make the moving object 1 travel at a specified speed V along the travel route R (step S132). As a result, when the inspection process of the obstacle sensor 5 is being executed, even if the obstacle sensor 5 detects an obstacle X present in the traveling direction of the moving object 1, the operation to stop or decelerate the moving object 1 is disabled.

[0059] Fig. 7 is a flowchart showing the procedure of the inspection process executed by the inspection processing unit 24. In Fig. 7, the inspection processing unit 24 first determines whether or not an inspection start signal (described later) has been input from the inspection preparation processing unit 26 (step S141).

[0060] When the inspection processing unit 24 determines that an inspection start signal has been input, it acquires detection data from the obstacle sensor 5 (step S142). Then, the inspection processing unit 24 determines whether or not a stationary object to be inspected 4C has been detected based on the detection data from the obstacle sensor 5 (step S143). When the inspection processing unit 24 determines that a stationary object to be inspected 4C has been detected, it determines that the obstacle sensor 5 is normal (step S144).

[0061] When the inspection processing unit 24 determines that the stationary object for inspection 4C has not been detected, it determines that the obstacle sensor 5 is abnormal (step S145). Then, the inspection processing unit 24 outputs an abnormality notification signal to the alarm device 14 to cause the alarm device 14 to issue an abnormality warning (step S146). Furthermore, the inspection processing unit 24 controls the drive unit 13 to stop the moving object 1 (step S147).

[0062] After executing step S144 or step S147, the inspection processing unit 24 outputs an inspection completion signal to the detection area setting unit 25 to notify that the inspection operation of the obstacle sensor 5 by the inspection processing unit 24 has been completed (step S148), and terminates this processing.

[0063] Fig. 8 is a flowchart showing the procedure of the detection area setting process executed by the detection area setting unit 25. In Fig. 8, the detection area setting unit 25 first determines whether or not an inspection start signal (described later) has been input from the inspection preparation processing unit 26 (step S151).

[0064] When the detection area setting unit 25 determines that the inspection start signal has been input, it changes the detection area A of the obstacle sensor 5 from the third area A3 to the second area A2 (step S152). Subsequently, the detection area setting unit 25 determines whether or not the inspection end signal has been input from the inspection processing unit 24 (step S153).

[0065] When the detection area setting unit 25 determines that the inspection end signal has been input, it changes the detection area of ​​the obstacle sensor 5 from the second area A2 to the first area A1 (step S154), and executes the above step S151 again.

[0066] Fig. 9 is a flowchart showing the procedure of the inspection preparation process executed by the inspection preparation processing unit 26. In Fig. 9, the inspection preparation processing unit 26 first determines whether the moving object 1 has reached the sensor inspection preparation section S0 based on the self-position of the moving object 1 estimated by the self-position estimation unit 21 (step S161).

[0067] When the inspection preparation processing unit 26 determines that the moving object 1 has reached the sensor inspection preparation section S0, it changes the detection area A of the obstacle sensor 5 from the first area A1 to the third area A3 (step S162).

[0068] Next, the inspection preparation processing unit 26 acquires the detection data of the obstacle sensor 5 (step S163). Then, the inspection preparation processing unit 26 determines whether or not an obstacle X present in the traveling direction of the moving object 1 has been detected based on the detection data of the obstacle sensor 5 (step S164).

[0069] When the inspection preparation processing unit 26 determines that no obstacle X has been detected in the traveling direction of the moving body 1, it outputs an inspection start signal to the traveling control unit 22, the inspection processing unit 24, and the detection area setting unit 25 to instruct the inspection processing unit 24 to start the inspection operation of the obstacle sensor 5 (step S165), and executes the above step S161 again.

[0070] When the inspection preparation processing unit 26 determines that an obstacle X has been detected in the traveling direction of the moving body 1, it changes the detection area A of the obstacle sensor 5 from the third area A3 to the first area A1 (step S166) and executes the above step S161 again.

[0071] In the above, when an instruction to start autonomous traveling of the moving body 1 is given, the moving body 1 travels normally at a specified speed V along the travel route R. During normal traveling of the moving body 1, the first area A1 is used as the detection area A of the obstacle sensor 5. If the obstacle sensor 5 detects an obstacle X ahead of the moving body 1 while the moving body 1 is traveling, the moving body 1 stops or decelerates.

[0072] When the moving body 1 reaches the sensor inspection preparation section S0 without the obstacle sensor 5 detecting the presence of an obstacle X ahead of the moving body 1, as shown in FIG. 10, the detection area A of the obstacle sensor 5 is set to a third area A3 which is larger than the first area A1, and the moving body 1 travels at the same speed V for the time required to inspect the obstacle sensor 5.

[0073] If the obstacle sensor 5 detects an obstacle X ahead of the mobile object 1 while the mobile object 1 is traveling for the time required to inspect the obstacle sensor 5, the detection area A of the obstacle sensor 5 returns from the third area A3 to the first area A1, and the mobile object 1 returns to a normal traveling state. Therefore, the presence of obstacle X ahead of the mobile object 1 causes the mobile object 1 to stop or slow down. Also, for example, if obstacle X is detected multiple times each time the mobile object 1 passes through the sensor inspection preparation section S0, the sensor inspection preparation section S0 is inappropriate, and a warning is issued by the alarm 14 to prompt the user to reconsider the sensor inspection preparation section S0.

[0074] If the moving object 1 has traveled for the time required to inspect the obstacle sensor 5 and the obstacle sensor 5 does not detect an obstacle X ahead of the moving object 1, the moving object 1 reaches the sensor inspection section S, and as shown in FIG. 10, the detection area A of the obstacle sensor 5 is set to the second area A2, which is larger than the third area A3, and the moving object 1 travels at the same speed V. Then, the obstacle sensor 5 is inspected while the moving object 1 continues traveling. At this time, the operation of stopping or decelerating the moving object 1 in accordance with the detection result of the obstacle sensor 5 is disabled, so inspection of the obstacle sensor 5 using the stationary object for inspection 4C is not hindered.

[0075] When the obstacle sensor 5 detects the stationary object for inspection 4C, it is determined that the obstacle sensor 5 is normal. Then, the detection area A of the obstacle sensor 5 is changed from the second area A2 to the first area A1, and the moving object 1 returns to the normal traveling state.

[0076] On the other hand, if the obstacle sensor 5 does not detect the stationary object for inspection 4C, it is determined that the obstacle sensor 5 is abnormal. Then, a warning is issued by the alarm 14, and the moving body 1 is forcibly stopped. In this case, the moving body 1 will not perform autonomous traveling until the obstacle sensor 5 is restored by repair or the like, or until the obstacle sensor 5 is replaced.

[0077] As described above, in this embodiment, when the mobile object 1 reaches the sensor inspection section S while traveling along the travel route R, an inspection process for the obstacle sensor 5 is performed using the stationary object for inspection 4C while the mobile object 1 travels through the sensor inspection section S. If the stationary object for inspection 4C is detected by the obstacle sensor 5, the obstacle sensor 5 is determined to be normal. If the stationary object for inspection 4C is not detected by the obstacle sensor 5, the obstacle sensor 5 is determined to be abnormal. Here, the detection area A of the obstacle sensor 5 uses the second area A2, which is larger than the first area A1 used during normal traveling. Therefore, when the mobile object 1 travels through the sensor inspection section S, the stationary object for inspection 4C can be more easily detected by the obstacle sensor 5. This makes it possible to detect whether an abnormality has occurred in the obstacle sensor 5 while the mobile object 1 is traveling. As a result, it becomes possible to respond to malfunctions while the mobile object 1 is traveling.

[0078] Furthermore, in this embodiment, when the moving body 1 reaches a sensor inspection preparation section S0 that is located before the sensor inspection section S in the traveling direction of the moving body 1, a preparation process is executed while the moving body 1 travels through the sensor inspection preparation section S0 to prevent the moving body 1 from coming into contact with an obstacle X when the moving body 1 travels through the sensor inspection section S. Thereafter, an inspection process of the obstacle sensor 5 is executed in the sensor inspection section S. Therefore, even if there is a possibility that an obstacle X is present around the moving body 1 when the moving body 1 travels through the sensor inspection section S, the moving body 1 is prevented from coming into contact with the obstacle X.

[0079] Furthermore, in this embodiment, when the mobile object 1 reaches the sensor inspection preparation section S0, the detection area A of the obstacle sensor 5 is changed from the first area A1 to the third area A3, and it is determined whether or not the obstacle sensor 5 detects an obstacle X. If it is determined that the obstacle sensor 5 does not detect an obstacle X, an inspection process for the obstacle sensor 5 is executed in the sensor inspection section S. Here, the detection area A of the obstacle sensor 5 uses the third area A3, which is larger than the first area A1 used during normal traveling. Therefore, when the mobile object 1 travels through the sensor inspection preparation section S0, the obstacle sensor 5 is more likely to detect the obstacle X. Therefore, it is possible to accurately detect whether or not an obstacle X is present around the mobile object 1 when the mobile object 1 travels through the sensor inspection section S.

[0080] In this embodiment, the second area A2 is set to be wider than the first area A1 in the traveling direction of the moving object 1. Therefore, when the moving object 1 travels along the travel route R, a stationary object 4 existing in the traveling direction of the moving object 1 is used as an inspection stationary object 4C.

[0081] Furthermore, in this embodiment, the sensor inspection section S is specified as a position before the curve section rs of the travel route R in the traveling direction of the mobile object 1, and the stationary object for inspection 4C is placed at a position that falls within the second area A2 as the detection area A of the obstacle sensor 5 when the mobile object 1 travels through the sensor inspection section S. Therefore, the stationary object 4 located near the curve section rs of the travel route R is used as the stationary object for inspection 4C. Therefore, by using an appropriate stationary object 4 as the stationary object for inspection 4C, the inspection process of the obstacle sensor 5 can be effectively performed.

[0082] Furthermore, in this embodiment, not only abnormalities in the sensor body of the obstacle sensor 5 itself, but also breaks or short circuits in the cable 6 (see Figure 1) connecting the obstacle sensor 5 to the controller 15, dirt adhering to the sensor surface of the obstacle sensor 5 due to the external environment, etc. can be detected as abnormalities in the obstacle sensor 5.

[0083] Furthermore, in this embodiment, the stationary inspection object 4C is used to inspect the obstacle sensors 5, so there is no need for an operator to intervene in the inspection of the obstacle sensors 5, thereby reducing the burden on the operator.

[0084] In this embodiment, the third area A3 is wider in the direction of travel of the moving body 1 than the first area A1 and narrower in the direction of travel of the moving body 1 than the second area A2, but is not limited to this particular form and the third area A3 may be equal to the second area A2.

[0085] FIG. 11 is a block diagram showing the configuration of a travel control device equipped with an obstacle sensor checking device according to a second embodiment of the present invention.

[0086] 11, a driving control device 10A includes a controller 15A instead of the controller 15 in the first embodiment. The controller 15A includes the self-position estimation unit 21, driving control unit 22, obstacle detection unit 23, and inspection processing unit 24, as well as a detection area setting unit 25A and an inspection preparation processing unit 26A.

[0087] When the inspection processing unit 24 executes the inspection process of the obstacle sensor 5, the detection area setting unit 25A sets the detection area A of the obstacle sensor 5 to a second area A2 that is larger than the first area A1 used during normal driving.

[0088] Before the inspection processing unit 24 executes the inspection processing of the obstacle sensor 5, the inspection preparation processing unit 26A executes preparation processing in the sensor inspection preparation section S0 to prevent the moving body 1 from coming into contact with the obstacle X when the moving body 1 travels through the sensor inspection section S. As the preparation processing, the inspection preparation processing unit 26A controls the drive unit 13 to decelerate the moving body 1 to a speed at which the moving body 1 will not come into contact with the obstacle X when traveling through the sensor inspection section S.

[0089] The obstacle sensor inspection device 20A of this embodiment is composed of a memory unit 11, a self-position estimation sensor 12, a drive unit 13, an alarm 14, a self-position estimation unit 21 of a controller 15, a driving control unit 22, an inspection processing unit 24, a detection area setting unit 25A, and an inspection preparation processing unit 26A.

[0090] Fig. 12 is a flowchart showing the procedure of the detection area setting process executed by the detection area setting unit 25A, and corresponds to Fig. 8. In Fig. 12, the detection area setting unit 25A first determines whether or not the inspection start signal (described above) has been input from the inspection preparation processing unit 26A (step S151).

[0091] When the detection area setting unit 25A determines that the inspection start signal has been input, it changes the detection area A of the obstacle sensor 5 from the first area A1 to the second area A2 (step S152A). Subsequently, the detection area setting unit 25A determines whether the inspection end signal (described above) has been input from the inspection processing unit 24 (step S153). When the detection area setting unit 25A determines that the inspection end signal has been input, it changes the detection area A of the obstacle sensor 5 from the second area A2 to the first area A1 (step S154).

[0092] In this embodiment, the inspection end signal from the inspection processing unit 24 is input not only to the detection area setting unit 25A but also to the inspection preparation processing unit 26A.

[0093] Fig. 13 is a flowchart showing the procedure of the inspection preparation process executed by the inspection preparation processing unit 26A, and corresponds to Fig. 9. In Fig. 13, the inspection preparation processing unit 26A first determines whether the moving object 1 has reached the sensor inspection preparation section S0 (step S161).

[0094] When the inspection preparation processing unit 26A determines that the moving body 1 has reached the sensor inspection preparation section S0, it controls the drive unit 13 to decelerate the moving body 1 to a speed Vs (see Figure 14) at which the moving body 1 will not come into contact with the obstacle X when traveling through the sensor inspection section S (step S167).

[0095] For example, the inspection preparation processing unit 26A controls the drive unit 13 to decelerate the moving body 1 to a speed that allows the inspection processing unit 24 to complete the inspection process of the obstacle sensor 5 in the first area A1 where the obstacle sensor 5 has detected that no obstacle X is currently present in the traveling direction of the moving body 1. Specifically, the inspection preparation processing unit 26A controls the drive unit 13 so that the traveling speed of the moving body 1 after deceleration becomes equal to or less than (L1 / t), where t is the time required to inspect the obstacle sensor 5. As described above, L1 is the length dimension of the first area A1 (see FIG. 1).

[0096] Subsequently, the inspection preparation processing unit 26A outputs an inspection start signal to the travel control unit 22, the inspection processing unit 24, and the detection area setting unit 25A (step S165A).

[0097] Next, the inspection preparation processing unit 26A determines whether or not an inspection end signal has been input from the inspection processing unit 24 (step S168). When it is determined that an inspection end signal has been input, the inspection preparation processing unit 26A controls the drive unit to return the traveling speed of the moving object 1 to the original speed V (step S169), and executes the above step S161 again.

[0098] When changing the traveling speed of the moving body 1, the inspection preparation processing unit 26A may perform feedback control of the traveling speed of the moving body 1 using, for example, a vehicle speed sensor.

[0099] In the above, when the moving body 1 reaches the sensor inspection preparation section S0 during normal driving, as shown in FIG. 14, the moving body 1 decelerates to a speed Vs at which it will not come into contact with the surrounding obstacle X even if it drives for the time required to inspect the obstacle sensor 5.

[0100] After the moving object 1 has traveled the time required to inspect the obstacle sensors 5, when the moving object 1 reaches the sensor inspection section S, the detection area A of the obstacle sensors 5 is set to a second area A2 that is larger than the first area A1 during normal traveling, and the moving object 1 travels at the same speed Vs, as shown in Fig. 14. In this state, the obstacle sensors 5 are inspected.

[0101] When the obstacle sensor 5 detects the stationary object for inspection 4C, it is determined that the obstacle sensor 5 is normal. Then, the detection area A of the obstacle sensor 5 is changed from the second area A2 to the first area A1, and the moving object 1 returns to the normal traveling state.

[0102] On the other hand, if the obstacle sensor 5 does not detect the stationary object for inspection 4C, it is determined that the obstacle sensor 5 is abnormal. Then, a warning is issued by the alarm 14, and the moving body 1 is forced to stop.

[0103] As described above, in this embodiment, when the moving object 1 reaches the sensor inspection preparation section S0, the moving object 1 decelerates to a speed Vs at which the moving object 1 will not come into contact with an obstacle while traveling through the sensor inspection section S. By decelerating the moving object 1 in this way in the sensor inspection preparation section S0, the distance required to inspect the obstacle sensor 5 can be shortened.

[0104] In this embodiment, the detection area A of the obstacle sensor 5 when the moving body 1 travels through the sensor inspection preparation section S0 is set to the first area A1, which is the same as during normal travel, but is not limited to this form and may, for example, be narrower than the first area A1.

[0105] Although several embodiments of the present invention have been described above, the present invention is not limited to the above embodiments. For example, in the above embodiments, the detection area A of the obstacle sensor 5 when the moving object 1 travels through the sensor inspection section S is set to the second area A2 that is wider in the traveling direction of the moving object 1 than the first area A1, but the present invention is not particularly limited to this form.

[0106] For example, as shown in FIG. 15, the detection area A of the obstacle sensor 5 when the moving object 1 travels through the sensor inspection section S may be set to a second area A2 that is wider in the width direction of the moving object 1 than the first area A1. The width direction of the moving object 1 is perpendicular to the moving direction of the moving object 1. The width dimension W2 of the second area A2 is larger than the width dimension W1 of the first area A1. The width dimension is the dimension along the width direction of the moving object 1. In this case, the second area A2 is determined according to the width dimension of the moving object 1 or the width dimension of the towing cart towed by the moving object 1. Furthermore, the stationary object 4C to be inspected is specified to be, for example, a stationary object 4 such as a shelf or wall that extends along the moving direction of the moving object 1.

[0107] Furthermore, the detection area A of the obstacle sensor 5 when the moving object 1 travels through the sensor inspection section S may be set to a second area A2 that is wider than the first area A1 in the traveling direction and width direction of the moving object 1. In this case, when the moving object 1 travels along the travel route R, a stationary object 4 that exists in the traveling direction or to the side of the moving object 1 is used as the stationary object for inspection 4C. Therefore, it is possible to increase the options for the stationary object 4 that can be used as the stationary object for inspection 4C.

[0108] Furthermore, in the above-described first embodiment, the detection area A of the obstacle sensor 5 when the moving body 1 travels through the sensor inspection preparation section S0 may be set to a second area A2 that is wider in the width direction of the moving body 1 than the first area A1, or may be set to a second area A2 that is wider in the direction of travel and width direction of the moving body 1 than the first area A1.

[0109] Furthermore, in the above embodiment, the sensor inspection section S is specified as a position before the curve section rs of the travel route R in the direction of travel of the moving body 1, but it is not limited to this particular form, and may be a position away from the curve section r2 in the straight section r1 as long as it is possible to inspect the obstacle sensor 5.

[0110] Furthermore, in the above embodiment, in the sensor inspection preparation section S0 located before the sensor inspection section S in the traveling direction of the mobile body 1, preparations are made to prevent the mobile body 1 from coming into contact with the obstacle X when the mobile body 1 travels through the sensor inspection section S, but this is not particularly limited to such an embodiment. For example, if there is no obstacle X in the sensor inspection section S, it is not necessary to make preparations to prevent the mobile body 1 from coming into contact with the obstacle X when the mobile body 1 travels through the sensor inspection section S.

[0111] Furthermore, in the above embodiment, the obstacle sensor 5 is a laser sensor, but is not limited to this form, and a camera or the like may also be used as the obstacle sensor 5.

[0112] In the above embodiment, the self-position of the moving body 1 is estimated using a SLAM method using detection data from a laser sensor as the self-position estimation sensor 12, but the present invention is not limited to such a configuration. Methods for estimating the self-position of the moving body 1 may also use, for example, a magnetic sensor that detects a magnetic tape installed on the travel route R, a SLAM method using image data from a camera, an odometry sensor that detects the amount and direction of movement of the moving body 1, or an inertial measurement unit (IMU) that measures the angular velocity and acceleration of the moving body 1.

[0113] In addition, in the above embodiment, the inspection process of the obstacle sensors 5 is performed every time the moving object 1 passes through the sensor inspection section S specified on the traveling route R of the circular course, but this is not particularly limited to this form, and the inspection process of the obstacle sensors 5 may be performed only once every few laps. In addition, the traveling route R is not particularly limited to a circular course.

[0114] Furthermore, the above embodiment is an apparatus and method for inspecting an obstacle sensor 5 that detects an obstacle X present around a moving body 1 that is an industrial vehicle, but the present invention can also be applied to moving bodies other than industrial vehicles. [Explanation of symbols]

[0115] 1...moving body, 4C...stationary object for inspection, 5...obstacle sensor, 20, 20A...obstacle sensor inspection device, 22...travel control unit, 24...inspection processing unit, 25, 25A...detection area setting unit, 26, 26A...inspection preparation processing unit, A...detection area, A1...first area, A2...second area, A3...third area, R...traveling route, rs...curve section, S...sensor inspection section, S0...sensor inspection preparation section, X...obstacle.

Claims

1. An obstacle sensor inspection device that inspects an obstacle sensor that detects obstacles present around a moving object, a travel control unit that controls the moving body to travel along a travel route; an inspection processing unit that, when the moving body is traveling along the travel route, executes an inspection process of the obstacle sensor in a pre-designated sensor inspection section using a pre-designated stationary object for inspection; a detection area setting unit that sets the detection area of ​​the obstacle sensor to a second area that is wider than a first area used during normal driving when the inspection processing unit executes the inspection processing of the obstacle sensor; and an inspection preparation processing unit that, before the inspection processing unit executes the inspection processing of the obstacle sensor, sets the detection area of ​​the obstacle sensor to a third area wider than the first area in a sensor inspection preparation section located before the sensor inspection section in the traveling direction of the moving body, and determines whether the obstacle is detected by the obstacle sensor in this state, thereby executing preparation processing to prevent the moving body from coming into contact with the obstacle when traveling through the sensor inspection section; When the inspection preparation processing unit determines that the obstacle sensor has not detected the obstacle, if the obstacle sensor detects the stationary object for inspection, the inspection processing unit determines that the obstacle sensor is normal, and if the obstacle sensor does not detect the stationary object for inspection, the inspection processing unit determines that the obstacle sensor is abnormal; The driving control unit is an obstacle sensor inspection device that disables the operation of stopping or decelerating the moving body when the obstacle sensor detects an obstacle during the inspection process of the obstacle sensor by the inspection processing unit.

2. An obstacle sensor inspection device that inspects an obstacle sensor that detects obstacles present around a moving object, a travel control unit that controls the moving body to travel along a travel route; an inspection processing unit that, when the moving body is traveling along the travel route, executes an inspection process of the obstacle sensor in a pre-designated sensor inspection section using a pre-designated stationary object for inspection; a detection area setting unit that sets the detection area of ​​the obstacle sensor to a second area that is wider than a first area used during normal driving when the inspection processing unit executes the inspection processing of the obstacle sensor; and an inspection preparation processing unit that, before the inspection processing unit executes the inspection processing of the obstacle sensor, controls the moving body to decelerate in a sensor inspection preparation zone located before the sensor inspection zone in the traveling direction of the moving body to a speed at which the moving body will not come into contact with the obstacle when traveling in the sensor inspection zone, thereby executing preparation processing to prevent the moving body from coming into contact with the obstacle when traveling in the sensor inspection zone; the inspection processing unit determines that the obstacle sensor is normal when the stationary object for inspection is detected by the obstacle sensor, and determines that the obstacle sensor is abnormal when the stationary object for inspection is not detected by the obstacle sensor; The driving control unit is an obstacle sensor inspection device that disables the operation of stopping or decelerating the moving body when the obstacle sensor detects an obstacle during the inspection process of the obstacle sensor by the inspection processing unit.

3. 3. The obstacle sensor inspection device according to claim 1, wherein the second area is set to be wider than the first area in at least one of the traveling direction and width direction of the moving object.

4. the travel route has a curved section, the sensor inspection section is designated as a position before the curved section in a traveling direction of the moving body, 3. The obstacle sensor inspection device according to claim 1, wherein the stationary inspection object is disposed at a position that fits within the second area when the mobile object travels through the sensor inspection section.

5. An obstacle sensor inspection method for inspecting an obstacle sensor that detects an obstacle present around a moving object, comprising: a step of designating, in the middle of a travel route along which the moving body travels, a sensor inspection section in which inspection of the obstacle sensors is to be carried out, a sensor inspection preparation section located before the sensor inspection section in the traveling direction of the moving body, and a stationary inspection object to be used for inspection of the obstacle sensors in the sensor inspection section; controlling the moving object to travel along the travel path; a step of executing an inspection process of the obstacle sensor using the inspection stationary object in the sensor inspection section while the moving body is traveling along the travel route; a step of setting a detection area of ​​the obstacle sensor to a second area that is wider than a first area used during normal driving when performing an inspection process of the obstacle sensor; and a step of executing a preparatory process to prevent the moving body from coming into contact with the obstacle when traveling through the sensor inspection section by setting the detection area of ​​the obstacle sensor to a third area wider than the first area in a sensor inspection preparation section located before the sensor inspection section in the traveling direction of the moving body, and determining whether the obstacle is detected by the obstacle sensor in this state, before executing the inspection process of the obstacle sensor. In the step of executing the obstacle sensor inspection process, when it is determined in the step of executing the preparation process that the obstacle has not been detected by the obstacle sensor, if the obstacle sensor detects the stationary object for inspection, it is determined that the obstacle sensor is normal, and if the obstacle sensor does not detect the stationary object for inspection, it is determined that the obstacle sensor is abnormal; In the step of controlling the moving body to travel, when the obstacle sensor detects an obstacle during the execution of the obstacle sensor inspection process, the obstacle sensor inspection method disables the operation of stopping or decelerating the moving body.

6. An obstacle sensor inspection method for inspecting an obstacle sensor that detects an obstacle present around a moving object, comprising: a step of designating, in the middle of a travel route along which the moving body travels, a sensor inspection section in which inspection of the obstacle sensors is to be carried out, a sensor inspection preparation section located before the sensor inspection section in the traveling direction of the moving body, and a stationary inspection object to be used for inspection of the obstacle sensors in the sensor inspection section; controlling the moving object to travel along the travel path; a step of executing an inspection process of the obstacle sensor using the inspection stationary object in the sensor inspection section while the moving body is traveling along the travel route; a step of setting a detection area of ​​the obstacle sensor to a second area that is wider than a first area used during normal driving when performing an inspection process of the obstacle sensor; and a step of executing a preparatory process to prevent the moving body from coming into contact with the obstacle when traveling through a sensor inspection preparation section by controlling the moving body to decelerate in a sensor inspection preparation section located before the sensor inspection section in the traveling direction of the moving body to a speed at which the moving body will not come into contact with the obstacle when traveling through the sensor inspection section, before executing the inspection process of the obstacle sensor. In the step of executing the inspection process of the obstacle sensor, when the stationary object for inspection is detected by the obstacle sensor, it is determined that the obstacle sensor is normal, and when the stationary object for inspection is not detected by the obstacle sensor, it is determined that the obstacle sensor is abnormal; In the step of controlling the moving body to travel, when the obstacle sensor detects an obstacle during the execution of the obstacle sensor inspection process, the obstacle sensor inspection method disables the operation of stopping or decelerating the moving body.

Images