Autonomous Vehicles
The autonomous mobile body uses obstacle shape detection and passage width calculation to adjust stopping areas, addressing interference risks by dynamically adjusting based on speed and passage width for safe navigation.
Patent Information
- Application Number
- JP2021122594
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Priority Date
- 2020-12-11
- Filing Date
- 2021-07-27
- Publication Date
- 2024-11-26
- Estimated Expiration
- 2041-07-27
AI Technical Summary
Autonomous mobile bodies face interference risks with obstacles while following a target object, especially in narrow passages where the obstacle stopping area based on speed is insufficient, leading to potential collisions with undetected chains or similar objects.
The autonomous mobile body includes a system to detect the external shape of obstacles, calculate passage width, and adjust the obstacle stopping area based on both speed and passage width, using sensors like laser sensors and cameras to avoid collisions by setting appropriate stopping areas.
This approach allows the autonomous mobile body to effectively follow a target object while preventing interference with obstacles, ensuring safe navigation through narrow passages by dynamically adjusting the stopping area based on detected passage width and speed.
Smart Images

Figure 0007589658000001 
Figure 0007589658000002 
Figure 0007589658000003
Abstract
Description
[Technical field]
[0001] The present invention relates to an autonomous moving body. [Background technology]
[0002] A known autonomous mobile body is described in Patent Document 1. This autonomous mobile body includes a base that travels autonomously, a surrounding information detection unit that is provided on the base and detects surrounding information related to the situation around the base, and a control unit that controls the base based on the surrounding information. The autonomous mobile body monitors obstacles present around the base with the surrounding information detection unit and travels autonomously while avoiding collisions with the obstacles. [Prior art documents] [Patent documents]
[0003] [Patent Document 1] JP 2020-42419 A Summary of the Invention [Problem to be solved by the invention]
[0004] Here, the autonomous mobile body may travel while following a follow-up object such as a worker. At this time, the autonomous mobile body performs follow-up travel in a state where an obstacle stop area for detecting the presence of an obstacle that stops the machine is set. Such an obstacle stop area is set to a size according to the speed of the machine, and is set smaller as the speed is lower. This suppresses unnecessary detection of obstacles, and the autonomous mobile body can follow the follow-up object without delay even in a narrow passage. However, even in a passage where the passage width is smaller than the machine, the follow-up object may pass through the passage. At this time, it is preferable for the machine to stop before approaching the passage too much, but since the obstacle stop area based on the speed is small, the machine will stop after approaching the passage as close as possible. For example, if a chain that cannot be detected by a sensor is installed in a narrow passage and the follow-up object passes over the chain, there is a possibility that the machine will get too close to the passage and interfere with the chain. Therefore, there has been a demand for an autonomous mobile body that can suppress interference between the machine and the obstacle while following the follow-up object.
[0005] An object of the present invention is to provide an autonomous moving body that can suppress interference between the body and an obstacle while following a target object to be followed. [Means for solving the problem]
[0006] An autonomous mobile body according to one embodiment of the present invention is an autonomous mobile body that travels autonomously to follow a target object to be followed, and comprises a traveling base, a surrounding information detection unit provided on the base that detects surrounding information relating to the situation around the base, and a control unit that controls the base based on the surrounding information, the control unit having an obstacle shape detection unit that detects the outline of an obstacle present around the base based on the surrounding information, an aisle width detection unit that detects the aisle width of the aisle formed by the obstacles acquired by the obstacle shape detection unit, and an obstacle stopping area setting unit that sets an obstacle stopping area to detect the presence of an obstacle that will stop the base, and the obstacle stopping area setting unit changes the range of the obstacle stopping area based on the aisle width detected by the aisle width detection unit.
[0007] In an autonomous mobile body according to one aspect of the present invention, an obstacle stopping area setting unit sets an obstacle stopping area for detecting the presence of an obstacle that stops the machine. Therefore, the autonomous mobile body can autonomously travel so as to follow the object to be followed while avoiding interference with obstacles around the machine. Here, the obstacle stopping area setting unit can change the range of the obstacle stopping area based on the passage width detected by the passage width detection unit. In a case where a narrow passage exists between the machine and the object to be followed as a result of the object to be followed passing through a narrow passage, the obstacle stopping area setting unit can appropriately change the range of the obstacle stopping area so that the machine can be stopped at an appropriate position according to the passage width of the passage. In this case, since it is possible to prevent the machine from getting too close to the narrow passage, it is possible to prevent the machine from interfering with the chain or the like even if, for example, a chain or the like exists in the narrow passage. As described above, the autonomous mobile body can suppress interference between the machine and the obstacle while following the object to be followed.
[0008] The obstacle stopping area setting unit can set the obstacle stopping area to a first range based on the speed of the machine and a second range based on the aisle width, and when the aisle width detected by the aisle width detection unit is below a predetermined width threshold and the speed of the machine is below a predetermined speed threshold, the obstacle stopping area setting unit may set the obstacle stopping area to a range including at least the second range. The obstacle stopping area setting unit can set a more appropriate obstacle stopping area by changing the range of the obstacle stopping area using the width threshold and the speed threshold as described above.
[0009] The passage width detection unit may divide the obstacle detection range into a plurality of rectangular sections in the width direction, sequentially perform a process of determining whether an obstacle exists in each section from a reference position toward the outside in the width direction, and detect the passage width based on the number of sections between the section in which it is determined that an obstacle exists and the reference position. This method of detecting the position of an object by dividing the detection range into a plurality of rectangular sections is a proven method, and by using this method to detect the passage width, the reliability of the detection result of the passage width detection unit can be increased.
[0010] The surrounding information includes a plurality of pieces of detection information that detect the conditions at each location around the machine, and the aisle width detection unit selects, from the plurality of pieces of detection information, the detection information that indicates the presence of an obstacle within the detection information selection area as the detection information to be used for detecting the aisle width. In this case, the aisle width detection unit can detect the aisle width by using the detection information that indicates the presence of an obstacle from among the plurality of pieces of detection information, while not using the detection information that does not indicate the presence of an obstacle. In this way, the aisle width detection unit can perform calculations by limiting the detection information required to detect the aisle width, thereby reducing the processing load.
[0011] The passage width detection unit may set the size of the detection information selection area based on the size of the obstacle detection range. In this case, the passage width detection unit can set the detection information selection area to an appropriate size based on the necessity of the detection range in which the passage width is detected. Effect of the Invention
[0012] According to the present invention, it is possible to provide an autonomous moving body that can suppress interference between the body and an obstacle while following a target object to be followed. [Brief description of the drawings]
[0013] [Figure 1] FIG. 2 is a schematic diagram showing a traveling state of an autonomous moving body according to an embodiment of the present invention. [Diagram 2] FIG. 2 is a block diagram of an autonomous moving body. [Diagram 3]5 is a flowchart showing the control content of a control process performed by a control unit of the autonomous moving body. [Figure 4] FIG. 4(a) shows a speed-based obstacle stopping area and a passage-width-based obstacle stopping area, and FIGS. 4(b), (c), and (d) are conceptual diagrams showing the adopted obstacle stopping areas. [Diagram 5] FIG. 1 is a conceptual diagram showing a state in which an autonomous moving body is autonomously traveling near a narrow passage. [Figure 6] FIG. 13 is a conceptual diagram showing an example of a method for calculating an aisle width. [Figure 7] FIG. 13 is a conceptual diagram showing an example of a method for calculating the length of a passage-width-based obstacle stopping area. [Figure 8] FIG. 11 is a conceptual diagram showing a state in which an autonomous moving body according to a comparative example is autonomously traveling near a narrow passage. [Figure 9] 13 is a conceptual diagram showing an example of a detection information selection area of an autonomous moving body according to a modified example. FIG. [Figure 10] 13 is a flowchart showing the control content of a control process performed by a control unit of an autonomous moving body according to a modified example. [Figure 11] 13 is a conceptual diagram showing an example of a detection information selection area of an autonomous moving body according to a modified example. FIG. [Figure 12] 13 is a conceptual diagram showing an example of a detection information selection area of an autonomous moving body according to a modified example. FIG. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0014] Hereinafter, an embodiment of the present invention will be described in detail with reference to the drawings.
[0015] FIG. 1 is a schematic diagram showing the traveling of an autonomous mobile body 1 according to an embodiment of the present invention. FIG. 2 is a block diagram of the autonomous mobile body 1. The autonomous mobile body 1 is an autonomous traveling cart or the like used when storing or retrieving luggage in a manufacturing plant, luggage distribution center, parts center, warehouse, or the like having a plurality of shelves on which various luggage are stored. As shown in FIG. 1, the autonomous mobile body 1 autonomously travels so as to follow a follow-up object 2 such as a worker. As the follow-up object 2 moves, the autonomous mobile body 1 moves so as to follow the follow-up object 2.
[0016] The autonomous mobile body 1 includes a platform 3 and a surrounding information detection unit 4. The platform 3 is a main body of the autonomous mobile body 1 that travels so as to follow the object 2 to be tracked. In the example shown in Fig. 1, the platform 3 has a cylindrical shape and is provided with wheels 6 for travel on its underside. The platform 3 has multiple wheels 6 (for example, four as shown in Fig. 6) and can move freely in any direction.
[0017] The surrounding information detection unit 4 is provided on the machine base 3 and detects surrounding information related to the situation around the machine base 3. The surrounding information detection unit 4 is provided on the top surface of the machine base 3 so as to be able to detect the situation in each direction. The situation around the machine base 3 includes information indicating the position and shape of obstacles present around the machine base 3, information indicating the position of the object 2 to be followed, and the like. The surrounding information detection unit 4 is configured by various sensors such as a laser sensor (LRF: Laser Range Finder), a stereo camera, a ToF (Time of flight) camera, a radar sensor, an ultrasonic sensor, or a combination of these sensors. For example, a laser sensor as an example of the surrounding information detection unit 4 detects the state of the environment in the detection range around the machine base 3. Specifically, the laser sensor can detect objects (obstacles and the object 2 to be followed) around the machine base 3 and measure the positional relationship with the detected object. The laser sensor irradiates a laser around the machine base 3 and receives the reflected light of the laser, thereby detecting objects around the machine base 3 from the laser sensor and measuring the distance to the object. The laser used may be a 2D laser or a 3D laser.
[0018] The surrounding information detected by the surrounding information detection unit 4 includes a plurality of pieces of detection information that detect the situation at each location around the three machines. When a laser sensor is used as the surrounding information detection unit 4, as shown in FIG. 9, the surrounding information detection unit 4 scans the surroundings while emitting a laser as a scanning line SL. The surrounding information detection unit 4 acquires information obtained by the scanning line SL at each location as detection information. Specifically, at a location where the scanning line SL hits the surface of the obstacle OA, the surrounding information detection unit 4 acquires a data point DP on the surface of the obstacle OA as detection information, as information indicating the presence of the obstacle OA. Details of the data point DP will be described later together with the explanation of the obstacle shape detection unit 16. On the other hand, at a location where the obstacle OA does not exist around the machine 3, the surrounding information detection unit 4 acquires, as detection information, that the data point DP was not obtained by the scanning line SL, as information indicating that the obstacle OA does not exist around. When a camera is used as the surrounding information detection unit 4, the surrounding information detection unit 4 acquires an image at each location as the surrounding information.
[0019] As shown in FIG. 2, the autonomous moving object 1 includes the above-mentioned surrounding information detection unit 4, a drive unit 7, and a control unit 10.
[0020] Although not shown in the figure, the driving unit 7 includes a motor that rotates the wheels 6 of the autonomous moving body 1. The driving unit 7 drives the wheels 6 based on a control signal from the control unit 10 so that the autonomous moving body 1 performs a desired operation.
[0021] The control unit 10 includes an ECU (Electronic Control Unit) that performs overall management of the autonomous mobile body 1. The ECU is an electronic control unit that includes a CPU (Central Processing Unit), a ROM (Read Only Memory), a RAM (Random Access Memory), a CAN (Controller Area Network) communication circuit, and the like. For example, the ECU loads a program stored in the ROM into the RAM, and executes the program loaded into the RAM with the CPU, thereby achieving various functions. The control unit 10 includes an information acquisition unit 11, a following control unit 12, an obstacle monitoring unit 13, a traveling control unit 14, and a storage unit 15.
[0022] The information acquisition unit 11 acquires various information necessary for the autonomous traveling of the autonomous moving body 1. The information acquisition unit 11 acquires at least the surrounding information detected by the surrounding information detection unit 4. The information acquisition unit 11 can also acquire the speed of the autonomous moving body 1.
[0023] The following control unit 12 controls the autonomous mobile body 1 to follow the object 2 to be followed (see FIG. 1). The following control unit 12 identifies the position of the object 2 to be followed using peripheral information acquired by the information acquisition unit 11. The following control unit 12 controls the distance between the platform 3 and the object 2 to be followed to be constant at a predetermined value. Therefore, when the object 2 to be followed moves a predetermined distance in a predetermined direction from the previous detected position, the following control unit 12 controls the autonomous mobile body 1 to move in accordance with the movement of the object 2 to be followed. The following control unit 12 drives the drive unit 7 via the travel control unit 14 to move the platform 3 in a desired direction and by a desired amount.
[0024] The travel control unit 14 controls the travel of the autonomous mobile body 1 based on the control contents of the following control unit 12 and the monitoring results of the obstacle monitoring unit 13. The travel control unit 14 outputs a control signal to the driving unit 7 so that the autonomous mobile body 1 moves in a desired direction by a desired movement amount. Furthermore, the travel control unit 14 outputs an acceleration / deceleration control signal to the driving unit 7 when acceleration or deceleration is required, and outputs a stop control signal to the driving unit 7 when stopping is required. The memory unit 15 stores various data. For example, the memory unit 15 stores map data of a work site where the autonomous mobile body 1 will be performing work.
[0025] The obstacle monitoring unit 13 monitors obstacles present around the autonomous moving body 1. The obstacle monitoring unit 13 particularly monitors obstacles (obstacles OA1 and OA2 shown in FIG. 1 ) present between the machine base 3 and the object to be followed 2, and obstacles present near the moving path when the autonomous moving body 1 follows the object. The obstacle monitoring unit 13 includes an obstacle shape detection unit 16, a passage width detection unit 17, and an obstacle stop area setting unit 18.
[0026] The obstacle shape detection unit 16 detects the outer shape of the obstacles present around the machine base 3 based on the surrounding information acquired by the information acquisition unit 11. When a laser sensor is used as the surrounding information detection unit 4, as shown in FIG. 7, a data point DP is acquired by hitting the surface of the obstacles OA1 and OA2 with a laser. From this data point DP, the position and distance in the width direction relative to the surrounding information detection unit 4 can be grasped. Such data points DP are acquired at a predetermined pitch in the width direction on the surface of the obstacles OA1 and OA2. This allows the obstacle shape detection unit 16 to acquire a data point group consisting of a plurality of data points DP. The obstacle shape detection unit 16 can detect the shapes of the obstacles OA1 and OB2 present around the machine base 3 based on the data point group. Specifically, the data point DP1 at the end of the obstacle OA1 and the data point DP2 at the end of the obstacle OA2 are separated from each other in the width direction, and there is no data point DP between the data point DP1 and the obstacle OA2. Therefore, the obstacle shape detection unit 16 can detect the shape of the obstacle OA1 that spreads to the left with the position of the data point DP1 as its end on the left side of the autonomous moving body 1. The obstacle shape detection unit 16 can also detect the shape of the obstacle OA2 that spreads to the road side with the position of the data point DP2 as its end on the road side of the autonomous moving body 1. The obstacle shape detection unit 16 can also detect that a passage PL that is a candidate for a route through which the autonomous moving body 1 passes when moving to the rear side of the obstacles OA1 and OA2 is formed between the obstacles OA1 and OA2.
[0027] Returning to Fig. 1, the passage width detection unit 17 detects the passage width of the passage formed by the obstacles acquired by the obstacle shape detection unit 16. In the example of Fig. 7, the passage width W of the passage PL formed by the obstacles OA1 and OA2 is detected. There is no particular limitation on the specific method by which the passage width detection unit 17 detects the passage width, and any known method may be appropriately adopted, for example, a method as shown in Fig. 6 may be adopted.
[0028] In the model shown in FIG. 6, obstacles OC1 and OC2 exist in the traveling direction MD of the autonomous mobile body 1, and a passage PL is formed between them. An XY coordinate system is set with the center of the machine base 3 as the limit, the traveling direction MD as the X axis, and the width direction as the Y axis. As shown in FIG. 6(a), the passage width detection unit 17 sets a detection range DE for detecting the passage width of the passage PL. The detection range DE is set to have a width of the passage width threshold WL on the left and right with the X axis as the reference position. The passage width threshold WL is the limit value of the passage width at which the autonomous mobile body 1 can pass through the passage PL, and is set to the diameter value of the machine base 3. The passage width detection unit 17 divides the obstacle detection range DE into a plurality of rectangular sections SDE in the width direction.
[0029] Here, the passage width detection unit 17 uses the X-axis as a reference position and sequentially performs a process of determining whether an obstacle exists in each section SDE from the reference position toward the outside in the width direction. Specifically, when detecting an obstacle OC2 on the right side of the reference position, the passage width detection unit 17 performs a process of determining whether an obstacle exists in the section SDE that is on the right side of the reference position and closest to the reference position. If it is determined that an obstacle does not exist in the section SDE, the passage width detection unit 17 performs a process of determining whether an obstacle exists in the section SDE that is on the right side of the reference position and second closest to the reference position. In this way, the passage width detection unit 17 performs a determination process while shifting the section SDE one by one to the right. By performing such a process, as shown in FIG. 6(b), the passage width detection unit 17 detects an obstacle OC2 in the sixth section SDE to the right of the reference position. It is possible to determine whether the obstacle OC2 exists in the section SDE by using an inner product. As a result, the passage width detection unit 17 detects the passage width on the right side of the reference position based on the number (five) of sections SDE between the sixth section SDE in which it is determined that the obstacle OC2 exists and the reference position. If the width of one section is 0.05 m, the passage width detection unit 17 detects that the right passage width is "0.05 m x (6 - 1) = 0.25 m". The passage width detection unit 17 performs a similar calculation for the left passage width. The left obstacle OC1 is detected in the fifth section SDE. Therefore, the passage width detection unit 17 detects that the left passage width is "0.05 m x (5 - 1) = 0.2 m". The passage width detection unit 17 detects the passage width (= 0.45 m) of the passage between the obstacles OC1 and OC2 by adding the right passage width and the left passage width together.
[0030] The obstacle stopping area setting unit 18 sets an obstacle stopping area for detecting the presence of an obstacle that stops the machine 3 between the machine 3 and the object to be followed 2. In this embodiment, the obstacle stopping area setting unit 18 sets at least one of a speed-based obstacle stopping area (first range) based on the speed of the machine 3 and an aisle width obstacle stopping area (second range) based on the aisle width as the obstacle stopping area. The obstacle stopping area setting unit 18 first calculates the size of the speed-based obstacle stopping area, and then calculates the size of the aisle width-based obstacle stopping area. Then, the obstacle stopping area setting unit 18 finally determines an obstacle stopping area for detecting the presence of an obstacle that stops the machine 3 according to the situation.
[0031] Specifically, as shown in FIG. 4(a), the obstacle stopping area setting unit 18 sets the speed-based obstacle stopping area SE1 in a circular range surrounding the periphery of the machine 3. The obstacle stopping area setting unit 18 adjusts the diameter of the speed-based obstacle stopping area SE1 according to the speed of the machine 3. For example, the obstacle stopping area setting unit 18 increases the diameter of the speed-based obstacle stopping area SE1 as the speed increases so that the distance required for the machine 3 to stop after detecting an obstacle can be secured. The obstacle stopping area setting unit 18 can set the diameter of the speed-based obstacle stopping area SE1 using a known method. The speed-based obstacle stopping area SE1 may be set around the entire circumference of the machine 3, or may be omitted at a rear portion in the traveling direction MD as shown in FIG. 1 and FIG. 5.
[0032] As shown in FIG. 4(a), the obstacle stopping area setting unit 18 sets the passage width based obstacle stopping area SE2 in a rectangular range having a predetermined width and a predetermined length in front of the machine base 3 in the traveling direction MD. If the obstacle stopping area setting unit 18 sets the minimum distance to be left between the obstacle and the machine base 3 as a parameter, the obstacle stopping area setting unit 18 can geometrically determine the obstacle stopping area SE2 based on the relationship between the parameter and the passage width. Specifically, as shown in FIG. 7, a line perpendicular to the width direction of the passage PL and passing through the data point DP2 at the end of the obstacle OA2 is set as a reference line ST. At this time, the center CP of the machine base 3 is placed on the reference line ST, and the machine base 3 is virtually placed at a position where the minimum distance Xth to be left between the obstacle OA2 and the machine base 3 is left between the machine base 3 and the data point DP2. Note that the positional relationship shown in FIG. 7 is different from the positional relationship when the obstacle stopping area setting unit 18 actually performs the calculation, and is a virtually set arrangement for the calculation. At this time, the distance between the center CP and the data point DP1 at the end of the other obstacle OA1 is adopted as the length L of the aisle-width based obstacle stopping area SE2. In this case, a right-angled triangle is formed by the center CP, the data point DP1, and the data point DP2. The length of the hypotenuse of the right-angled triangle corresponds to the length L, the short side corresponds to the aisle width W, and the long side corresponds to "distance Xth + radius R of the machine base 3." Therefore, there is a relationship between the length L, the aisle width W, the distance Xth, and the radius R of the machine base 3, as follows: 2 = W 2 + (Xth+R) 2" holds. Therefore, the length L can be found by calculating the square root of the right side of the relational expression. The length L is a positive number greater than 0. The calculation method is merely one example of a method for finding the length of the aisle-width-based obstacle stopping area SE2, and other methods may be used without being particularly limited. The width on one side of the aisle-width-based obstacle stopping area SE2 (half the width from the center of the machine) may be set as follows. For example, the width on one side may be calculated by the machine width (machine radius) + safety margin (width to leave a distance from the obstacle in the lateral direction). For example, if the width of the aisle-width-based obstacle stopping area SE2 is set to only the machine width, the machine may enter an aisle that is just barely passable, and may then interfere with a lateral obstacle while traveling. In order to suppress this, the width can be set using the calculation method described above.
[0033] As shown in FIG. 4(a), the obstacle stopping area setting unit 18 sets the size of the speed-based obstacle stopping area SE1 and the passage-width-based obstacle stopping area SE2, and then uses one or both of the obstacle stopping areas SE1 and SE2 depending on the situation to determine the final obstacle stopping area SE3. In a normal state, the obstacle stopping area setting unit 18 adopts the speed-based obstacle stopping area SE1 as the final obstacle stopping area SE3 as shown in FIG. 4(b). On the other hand, in a specific situation, the obstacle stopping area setting unit 18 adopts the passage-width-based obstacle stopping area SE2 as the final obstacle stopping area SE3 as shown in FIG. 4(c) and (d). For example, the obstacle stopping area setting unit 18 may adopt only the passage-width-based obstacle stopping area SE2 as the final obstacle stopping area SE3 as shown in FIG. 4(c). Alternatively, the obstacle stopping area setting unit 18 may adopt the combined range of the passage-width-based obstacle stopping area SE2 and the speed-based obstacle stopping area SE1 as the final obstacle stopping area SE3, as shown in Fig. 4(d). As described above, the obstacle stopping area setting unit 18 can change the range of the obstacle stopping area SE3 based on the passage width detected by the passage width detection unit 17.
[0034] When the passage width detected by the passage width detection unit 17 is below a predetermined width threshold and the speed of the machine base 3 is below a predetermined speed threshold, the obstacle stopping area setting unit 18 sets the obstacle stopping area SE3 to a range including at least the passage width-based obstacle stopping area SE2 (second range). For example, the width threshold may be set to the diameter of the machine base 3, or may be set to a value obtained by adding a predetermined margin to the diameter of the machine base 3. The speed threshold may be set to a speed at a stage before the speed-based obstacle stopping area becomes too small and the machine base 3 comes too close to the passage PL. For example, as shown in FIG. 5(a), in a stage before the object to be followed 2 passes through a narrow passage PL (the passage width W is below the width threshold), the autonomous mobile body 1 travels at a normal speed, so that the obstacle stopping area setting unit 18 adopts the speed-based obstacle stopping area SE1 as the obstacle stopping area SE3. On the other hand, when the object to be followed 2 passes through the narrow passage PL, the speed is reduced. Therefore, as shown in Fig. 5(b), when the autonomous moving body 1 approaches the vicinity of the passage PL, the speed of the autonomous moving body 1 becomes slow. In this case, as shown in Fig. 5(c), the obstacle stopping area setting unit 18 adopts the passage width based obstacle stopping area SE2 as the obstacle stopping area SE3.
[0035] Next, the control contents of the control unit 10 of the autonomous moving body 1 will be described with reference to Fig. 3. Fig. 3 is a flowchart showing the control contents of the control process performed by the control unit 10 of the autonomous moving body 1. This control process is repeatedly executed at a predetermined timing when the autonomous moving body 1 is traveling following the object to be followed 2. Note that Fig. 5 may be referred to as appropriate to explain the control process.
[0036] As shown in FIG. 3, the obstacle shape detection unit 16 of the control unit 10 detects the shape of an obstacle existing around the machine base 3 based on the surrounding information acquired from the surrounding information detection unit 4 via the information acquisition unit 11 (step S110). Next, the passage width detection unit 17 detects the passage width of the passage formed by the obstacle acquired by the obstacle shape detection unit 16 (step S120). In step S120, the passage width detection unit 17 divides the obstacle detection range into a plurality of rectangular sections in the width direction, and sequentially performs a process of determining whether an obstacle exists in each section from the reference position toward the outside in the width direction. The passage width detection unit 17 detects the passage width based on the number of sections between the section in which it is determined that an obstacle exists and the reference position. In the state shown in FIG. 5(b), the passage width detection unit 17 detects the passage width W of the passage PL existing between the machine base 3 and the object to be followed 2. In the state shown in Fig. 5(a), the aisle width detection unit 17 detects the aisle width of the aisle formed by obstacles OD1 and OD2, which are a pair of walls present beside the machine base 3. If there are no obstacles within the detection range DE in Fig. 6, the aisle width is 2 x WL. Therefore, if there are no obstacles OD1 and OD2 within the detection range DE in Fig. 5(a), the aisle width is 2 x WL, and if there are obstacles OD1 and OD2 within the detection range DE, the aisle width formed by the obstacles OD1 and OD2 is set.
[0037] Next, the obstacle stopping area setting unit 18 calculates the size of a speed-based obstacle stopping area SE1 (normal obstacle stopping area) based on the speed of the machine (step S130). Next, the obstacle stopping area setting unit 18 calculates the size of an aisle width-based obstacle stopping area SE2 based on the aisle width detected in step S120 (step S140). The obstacle stopping area setting unit 18 determines an obstacle stopping area SE3 by taking into account both the speed-based obstacle stopping area SE1 calculated in step S130 and the aisle width-based obstacle stopping area SE2 calculated in step S140 (step S150). In step S150, if there is an extremely narrow passage between the machine 3 and the object to be followed 2, the obstacle stopping area setting unit 18 determines whether the machine 3 is moving into that passage. The obstacle stopping area setting unit 18 compares the passage width of the passage in which the machine 3 is moving with a predetermined threshold value. The obstacle stopping area setting unit 18 also compares the speed of the machine 3 with a predetermined speed threshold value. Based on these processes, the obstacle stopping area setting unit 18 determines whether or not the passage width is below a predetermined width threshold and the speed of the machine 3 is below a predetermined speed threshold (step S160).
[0038] If the determination in step S160 is "NO", the obstacle stopping area setting unit 18 adopts the speed-based obstacle stopping area SE1 as the obstacle stopping area SE3 (step S180). For example, in the state shown in Fig. 5(a), the obstacle stopping area setting unit 18 adopts the speed-based obstacle stopping area SE1 as the obstacle stopping area SE3. Note that, if the speed-based obstacle stopping area SE1 was originally adopted as the obstacle stopping area SE3, the obstacle stopping area setting unit 18 maintains the obstacle stopping area SE3 in the original state.
[0039] On the other hand, if the determination in step S160 is "YES", the obstacle stopping area setting unit 18 adopts the passage-width-based obstacle stopping area SE2 as the obstacle stopping area SE3 (step S170). For example, in the state shown in FIG. 5(b), the obstacle stopping area setting unit 18 adopts the passage-width-based obstacle stopping area SE2 as the obstacle stopping area SE3, resulting in the state shown in FIG. 5(c). If the speed-based obstacle stopping area SE1 was originally adopted as the obstacle stopping area SE3, the obstacle stopping area setting unit 18 changes the range of the obstacle stopping area SE3 from the speed-based obstacle stopping area SE1 to the passage-width-based obstacle stopping area SE2 based on the passage width detected in step S120.
[0040] After the obstacle stopping area SE3 is set in steps S170 and S180, the obstacle monitoring unit 13 performs an obstacle determination process using the set obstacle stopping area SE3 (step S190). For example, in the state shown in Fig. 5(c), the obstacle stopping area SE3 detects a passage PL that is narrower than the machine 3, so the obstacle monitoring unit 13 determines that there is an obstacle that requires the machine 3 to be stopped, and stops the movement of the autonomous moving body 1. Then, when the process of step S190 ends, the control process shown in Fig. 3 ends, and the autonomous moving body 1 waits while stopped on the spot.
[0041] 5(a), the obstacle stopping area SE3 in the normal state does not detect a passage PL narrower than the vehicle 3, so the obstacle monitoring unit 13 determines that there is no obstacle that requires the vehicle 3 to be stopped, and continues the movement of the autonomous moving body 1. When the process of step S190 ends, the control process shown in FIG. 3 ends, and the process is repeated again from step S110.
[0042] Next, the actions and effects of the autonomous moving body 1 according to this embodiment will be described.
[0043] The autonomous mobile body according to the comparative example monitors obstacles using only the speed-based obstacle stopping area, without calculating the passage width-based obstacle stopping area, as in the present embodiment. For example, as shown in FIG. 8(a), even if the passage PL has a passage width smaller than that of the machine base 3, the object 2 to be followed may pass through the passage PL. In this case, the machine base 3 travels so as to approach the passage PL in order to follow the object 2 to be followed. At this time, it is preferable for the machine base 3 to stop before approaching the passage PL too much, but since the obstacle stopping area SE1 based on the speed is small, the machine base 3 stops after approaching the passage PL as close as possible. Specifically, the machine base 3 approaches the passage PL to the extent that a part of the front end of the machine base 3 enters the passage PL. Here, a chain CH that cannot be detected by a laser sensor is installed in the narrow passage PL, and the object 2 to be followed may pass through the passage PL by straddling the chain CH. In this case, as shown in FIG. 8(b), the machine base 3 may approach the passage PL too much, and the front end of the machine base 3 may enter the passage PL, resulting in interference with the chain CH.
[0044] In contrast, in the autonomous mobile body 1 according to the embodiment, the obstacle stopping area setting unit 18 sets an obstacle stopping area SE3 for detecting the presence of an obstacle that stops the machine 3. Therefore, the autonomous mobile body 1 can autonomously travel so as to follow the object 2 to be followed while avoiding interference with obstacles around the machine 3. Here, the obstacle stopping area setting unit 18 can change the range of the obstacle stopping area SE3 based on the passage width detected by the passage width detection unit 17. In the case where a narrow passage PL exists between the machine 3 and the object 2 to be followed as a result of the object 2 to be followed passing through a narrow passage PL, the obstacle stopping area setting unit 18 can appropriately change the range of the obstacle stopping area SE3 so that the machine 3 can be stopped at an appropriate position according to the passage width of the passage PL. In this case, since the machine 3 can be prevented from approaching too close to the narrow passage PL (see, for example, FIG. 5(c)), for example, even if a chain CH or the like exists in the narrow passage PL, the machine 3 can be prevented from interfering with the chain CH or the like. As a result, the autonomous moving body 1 can suppress interference between the vehicle 3 and obstacles while following the object 2 to be followed.
[0045] The obstacle stopping area setting unit 18 can set a speed-based obstacle stopping area SE1 (first range) based on the speed of the machine 3 and an aisle-width-based obstacle stopping area SE2 (second range) based on the aisle width as the obstacle stopping area SE3, and when the aisle width detected by the aisle width detection unit 17 is below a predetermined width threshold and the speed of the machine 3 is below a predetermined speed threshold, the obstacle stopping area setting unit 18 may set the obstacle stopping area SE3 to a range including at least the aisle-width-based obstacle stopping area SE2. The obstacle stopping area setting unit 18 can set a more appropriate obstacle stopping area by changing the range of the obstacle stopping area SE3 using the width threshold and speed threshold as described above.
[0046] The passage width detection unit 17 may divide the obstacle detection range into a plurality of rectangular sections in the width direction, sequentially perform a process of determining whether an obstacle exists in each section from a reference position toward the outside in the width direction, and detect the passage width based on the number of sections between the section in which it is determined that an obstacle exists and the reference position. This method of detecting the position of an object by dividing the detection range into a plurality of rectangular sections is a proven method, and by using this method to detect the passage width, the reliability of the detection result of the passage width detection unit can be increased.
[0047] The present invention is not limited to the above-described embodiments.
[0048] For example, the appearance of the work site, obstacles, passageways, routes, etc. shown in Figures 1 and 5 are merely examples and may be changed as appropriate to suit the work site.
[0049] Also, the passage width detection unit 17 may perform a process to reduce the load of calculations required to detect the passage width. Specifically, the passage width detection unit 17 selects a plurality of pieces of detection information based on the scanning line SL by setting a detection information selection area DCE as shown in FIG. 9. The passage width detection unit 17 selects, within the detection information selection area DCE, information indicating the presence of an obstacle OA as detection information to be used for detecting the passage width. Specifically, the passage width detection unit 17 acquires detection information based on the scanning line SL in which a data point DP falls within the detection information selection area DCE as detection information to be used for detecting the passage width. On the other hand, the passage width detection unit 17 does not use detection information based on the scanning line SL in which a data point DP does not fall within the detection information selection area DCE and detection information based on the scanning line SL in which a data point DP is not obtained, for detecting the passage width.
[0050] In the example shown in FIG. 9, the detection information selection area DCE has a circular shape centered on the center CP of the machine base 3. The aisle width detection unit 17 sets the size of the detection information selection area DCE based on the size of the detection range DE of the obstacle OA. The radius R1 of the detection information selection area DCE is set to the length of the diagonal of the detection range DE. Specifically, the radius R1 is set to "(aisle width threshold WL of the detection range DE) 2+ (Height H1 of detection range DE) 2 " is the value calculated by taking the square root of "
[0051] Next, the control contents of the control unit 10 of the autonomous mobile body 1 according to the modified example will be described with reference to Fig. 10. As shown in Fig. 10, the obstacle shape detection unit 16 of the control unit 10 detects the shape of an obstacle existing around the machine 3 based on the surrounding information acquired from the surrounding information detection unit 4 via the information acquisition unit 11 (step S110). In the example shown in Fig. 9, the surrounding information detection unit 4 detects the shape of an obstacle OA based on the data point DP.
[0052] Next, the passage width detection unit 17 selects detection information indicating the presence of an obstacle OA within the detection information selection area DCE as detection information to be used for detecting the passage width (step S200). In the example shown in FIG. 9, the passage width detection unit 17 selects detection information based on the scanning line SL corresponding to the data point DP present within the detection information selection area DCE. Next, the passage width detection unit 17 detects the passage width of the passage formed by the obstacle acquired by the obstacle shape detection unit 16 (step S120). At this time, the passage width detection unit 17 detects the passage width using only the detection information selected in step S200, without using other detection information. Note that the subsequent control processing is similar to the contents shown in FIG. 3, and therefore description thereof will be omitted.
[0053] As described above, the surrounding information includes a plurality of pieces of detection information that detect the situation at each point around the machine 3, and the aisle width detection unit 17 selects, from the plurality of pieces of detection information, the detection information that indicates the presence of an obstacle within the detection information selection area DCE as the detection information to be used for detecting the aisle width. In this case, the aisle width detection unit 17 can detect the aisle width by using the detection information that indicates the presence of an obstacle from among the plurality of pieces of detection information, while not using the detection information that does not indicate the presence of an obstacle. In this way, the aisle width detection unit 17 can perform calculations by limiting the detection information required to detect the aisle width, thereby reducing the processing load.
[0054] The passage width detection unit 17 may set the size of the detection information selection area DCE based on the size of the detection range of the obstacle. In this case, the passage width detection unit 17 can set the detection information selection area DCE to an appropriate size based on the necessity of the detection range in which the passage width is detected.
[0055] The setting position and size of the detection information selection area DCE are not particularly limited. For example, as shown in FIG. 11, a detection information selection area DCE centered on the transmission position of the scanning line SL may be adopted. In this case, too, the passage width detection unit 17 may set the size of the detection information selection area DCE based on the size of the detection range of the obstacle. Specifically, the radius R2 of the detection information selection area DCE is set as "(passage width threshold WL of detection range DE) 2 + (Height H1 of detection range DE - radius of machine base) 2 " The value is calculated by taking the square root of "
[0056] Also, as shown in FIG. 12, the position and size of the detection information selection area DCE may be the same as those of the detection range DE. [Explanation of symbols]
[0057] 1...autonomous moving body, 2...object to be followed, 3...machine base, 4...surrounding information detection unit, 10...control unit, 16...obstacle shape detection unit, 17...passage width detection unit, 18...obstacle stopping area setting unit, SE1...speed-based obstacle stopping area, SE2...passage width-based obstacle stopping area, SE3...obstacle stopping area.
Claims
1. An autonomous moving body that autonomously travels to follow a follow-up object, A running machine, a surrounding information detection unit provided in the machine base and detecting surrounding information related to a surrounding situation of the machine base; a control unit that controls the machine based on the peripheral information, The control unit is an obstacle shape detection unit that detects an outer shape of an obstacle present around the machine base based on the surrounding information; a passage width detection unit that detects a passage width of a passage formed by the obstacle obtained by the obstacle shape detection unit; an obstacle stopping area setting unit that sets an obstacle stopping area for detecting the presence of an obstacle that causes the machine to stop; the obstacle stopping area setting unit changes a range of the obstacle stopping area based on the passage width detected by the passage width detection unit; the obstacle stopping area setting unit is capable of setting, as the obstacle stopping area, a first range based on a speed of the machine base and a second range based on the aisle width, The obstacle stopping area setting unit sets the obstacle stopping area to a range that includes at least the second range when the aisle width detected by the aisle width detection unit is below a predetermined width threshold and the speed of the vehicle is below a predetermined speed threshold.
2. An autonomous moving body that autonomously travels to follow a follow-up object, A running machine, a surrounding information detection unit provided in the machine base and detecting surrounding information related to a surrounding situation of the machine base; a control unit that controls the machine based on the peripheral information, The control unit is an obstacle shape detection unit that detects an outer shape of an obstacle present around the machine base based on the surrounding information; a passage width detection unit that detects a passage width of a passage formed by the obstacle obtained by the obstacle shape detection unit; an obstacle stopping area setting unit that sets an obstacle stopping area for detecting the presence of an obstacle that causes the machine to stop; the obstacle stopping area setting unit changes a range of the obstacle stopping area based on the passage width detected by the passage width detection unit; The passage width detection unit divides the obstacle detection range into a plurality of rectangular sections in the width direction, sequentially performs a process of determining whether the obstacle is present in each section from a reference position toward the outside in the width direction, and detects the passage width based on the number of sections between the section in which it is determined that the obstacle is present and the reference position.
3. The surrounding information includes a plurality of pieces of detection information that detect situations at various points around the machine, 3 . The autonomous mobile body according to claim 1 , wherein the passage width detection unit selects, from among the plurality of pieces of detection information, one indicating the presence of the obstacle within a detection information selection area, as detection information to be used for detecting the passage width. 4 .
4. The autonomous moving body according to claim 3 , wherein the passage width detection unit sets a size of the detection information selection area based on a size of a detection range of the obstacle.
Citation Information
Patent Citations
Automated guided vehicle
JP2000148246A
Autonomous travelling device
JP2017123065A
Moving object
JP2019109770A
Autonomous travel carriage
JP2020042419A
Autonomous mobile body
JP2020187707A
