Transport vehicle
The transport vehicle uses sensors and directional control to navigate narrow spaces by calculating virtual obstacle positions and adjusting its path to avoid collisions, ensuring stable operation.
Patent Information
- Application Number
- JP2020140833
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2020-08-24
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2040-08-24
AI Technical Summary
Transport vehicles face stability issues when navigating narrow spaces due to frequent decelerations and stops caused by obstacle detection in confined areas.
Equipped with sensors to measure obstacle distances, a calculation unit determines virtual obstacle positions, and a travel control section adjusts the vehicle's direction to maintain a safe distance from obstacles, using approximate straight lines to guide the vehicle away from narrow space obstacles.
Enables stable navigation in narrow spaces by preventing the vehicle from colliding with obstacles, allowing smooth operation even in constrained environments.
Smart Images

Figure 0007588482000001 
Figure 0007588482000002 
Figure 0007588482000003
Abstract
Description
[Technical Field]
[0001] The present invention relates to a transport vehicle. [Background technology]
[0002] Patent Document 1 listed below discloses a guide robot that guides a person to a destination by autonomously traveling along a route to the destination. This guide robot travels while switching between a guided mode and an operational mode. The guided mode is a mode in which the robot travels autonomously in a direction determined based on the travel route. On the other hand, the operational mode is a mode in which the robot moves in a direction determined based on an input operation on a grip, which is an input device. The guide robot normally travels in the guided mode, and switches to the operational mode only when it moves to a mode switching area such as an elevator hall or inside an elevator. The guide robot travels along the travel route even when traveling in the operational mode. [Prior art documents] [Patent documents]
[0003] [Patent Document 1] Patent No. 6601001 Summary of the Invention [Problem to be solved by the invention]
[0004] Incidentally, some transport vehicles used to transport cargo and the like in factories and the like do not only move along a preset travel route like the guide robot in Patent Document 1, but also travel freely within the factory. When the travel of such a transport vehicle is manually controlled, the transport vehicle can travel stably if there is sufficient space on both sides of the vehicle body. However, in narrow spaces where there is not enough space on both sides of the vehicle body, for example, the obstacle detection function causes the transport vehicle to frequently slow down or stop, making it difficult to travel stably.
[0005] SUMMARY OF THE INVENTION It is therefore an object of the present invention to provide a transport vehicle that can easily travel in narrow spaces. [Means for solving the problem]
[0006] A transport vehicle according to one embodiment of the present invention comprises a sensor unit that measures the distance to an obstacle that may be present around the vehicle body, a calculation unit that calculates an approximate line indicating the virtual position of the obstacle based on the distance to the obstacle measured by the sensor unit when the obstacle is present in a first area located in the direction of travel of the vehicle body and having a width at least wider than the vehicle width, and a driving control unit that controls the direction of travel of the vehicle body so that the angle between the direction of travel vector of the vehicle body and the approximate line decreases.
[0007] According to this aspect, when an obstacle is present in the first region located in the traveling direction of the transported vehicle, an approximate line indicating the virtual position of the obstacle is calculated based on the sensed distance to the obstacle, and the traveling direction of the transported vehicle can be controlled so that the angle between the approximate line and the traveling direction vector of the transported vehicle decreases. This makes it possible to prevent the transported vehicle from getting too close to the obstacle.
[0008] In the above aspect, the traveling control unit may control the traveling direction of the vehicle body so that a difference between a traveling direction vector of the vehicle body and a vector based on the approximation line decreases.
[0009] According to this aspect, the direction of travel of the transport vehicle can be controlled so that the difference between the travel direction vector of the transport vehicle and the vector of the approximate straight line is reduced, making it possible to prevent the transport vehicle from getting too close to an obstacle.
[0010] In the above aspect, the traveling control unit may control the traveling direction of the vehicle body so that the inner product of a unit vector in the traveling direction of the vehicle body and a unit vector of the approximation line approaches one.
[0011] According to this aspect, the inner product of the unit vector in the direction of travel of the transport vehicle and the unit vector of the approximate line can be controlled to approach 1, thereby making it possible to prevent the transport vehicle from getting too close to an obstacle.
[0012] In the above aspect, when an obstacle is detected in each of the areas obtained by dividing the first area into left and right halves with respect to the traveling direction, the calculation unit may calculate an approximate straight line corresponding to each obstacle and calculate a straight line located in the center of each of the calculated approximate straight lines, and the driving control unit may control the traveling direction of the vehicle body so that the angle between the traveling direction vector of the vehicle body and the straight line located in the center decreases.
[0013] According to this aspect, when obstacles are detected in each of the left and right areas obtained by dividing the first area into two areas with respect to the traveling direction, approximate lines corresponding to the left and right obstacles are calculated, and the traveling direction of the transport vehicle can be controlled so that the angle between the line located at the center of these approximate lines and the traveling direction vector of the transport vehicle decreases. This makes it possible to prevent the transport vehicle from getting too close to the obstacles on both the left and right sides.
[0014] In the above aspect, when an obstacle is detected in a second area located inside the first area, the traveling control unit may rotate the vehicle body so that the obstacle moves outside the second area.
[0015] According to this aspect, when an obstacle is detected in a second area located inside the first area, the transport vehicle can be rotated and the direction of the transport vehicle can be changed so that the obstacle moves outside the second area, thereby allowing the transport vehicle approaching the obstacle to move away from the obstacle.
[0016] In the above aspect, when an obstacle is detected in a second area located inside the first area, the driving control unit may cause the vehicle body to travel in a direction different from the direction of travel when the obstacle was detected, so that the obstacle moves outside the second area.
[0017] According to this aspect, when an obstacle is detected in a second area located inside the first area, the transport vehicle can be made to travel in a direction different from the direction of travel when the obstacle was detected, and the position of the transport vehicle can be changed so that the obstacle is moved outside the second area, thereby allowing the transport vehicle approaching the obstacle to move away from the obstacle. [Effects of the Invention]
[0018] According to the present invention, a transport vehicle that can easily travel in narrow spaces can be provided. [Brief explanation of the drawings]
[0019] [Figure 1] FIG. 2 is a schematic diagram of a transport vehicle according to the embodiment, viewed from directly above. [Figure 2] 2 is a block diagram illustrating a functional configuration of the transport vehicle shown in FIG. 1. [Figure 3] FIG. 1 is a schematic diagram showing a transport vehicle traveling along a passage as viewed from directly above. [Figure 4] FIG. 1 is a schematic diagram showing a transport vehicle traveling along a passage as viewed from directly above. [Figure 5A] FIG. 10 is a schematic diagram showing a guided vehicle that has detected an obstacle in a monitoring area, as viewed from directly above. [Figure 5B] FIG. 10 is a schematic diagram showing a guided vehicle that has detected an obstacle in a monitoring area, as viewed from directly above. [Figure 6] FIG. 10 is a schematic diagram showing a guided vehicle that has detected an obstacle in a monitoring area, as viewed from directly above. [Figure 7] FIG. 10 is a schematic diagram showing a guided vehicle that has detected an obstacle within a vehicle width monitoring area, as viewed from directly above. [Figure 8] 10 is a flowchart illustrating an example of an operation of a transportation vehicle according to the embodiment. DETAILED DESCRIPTION OF THE INVENTION
[0020] DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS A preferred embodiment of the present invention will be described with reference to the accompanying drawings. In the drawings, components with the same reference numerals have the same or similar configurations.
[0021] FIG. 1 is a schematic diagram of a transport vehicle according to an embodiment, viewed from directly above. The transport vehicle 1 is an autonomously traveling device, and may be, for example, a transport platform that transports luggage or the like placed on the vehicle body, or a transport robot that transports luggage or the like. In this embodiment, a case will be described in which the transport vehicle 1 is a transport platform, for example. The transport vehicle 1 can move in all directions 360 degrees automatically or manually.
[0022] The transport vehicle 1 is equipped with two sensors Sa and Sb. The sensors Sa and Sb are sensors that measure the distance to an object, and are, for example, laser scanners or TOF (Time Of Flight) sensors. In this embodiment, a case will be described in which the sensors Sa and Sb are laser scanners that can scan a range of 270 degrees with laser light.
[0023] 1, the scanning range Ra of sensor Sa and the scanning range Rb of sensor Sb partially overlap, and by combining the two scanning ranges Ra and Rb, it is possible to scan the entire periphery of the transported vehicle 1. This makes it possible to detect obstacles that may exist around the transported vehicle 1 (in all directions).
[0024] The number of sensors mounted on the transport vehicle 1 is not limited to two, but may be one, or three or more. It is sufficient that the mounted sensors can detect obstacles present in all directions in which the transport vehicle 1 can move.
[0025] The guided vehicle 1 is equipped with an obstacle detection function. The obstacle detection function decelerates the guided vehicle 1 when an obstacle detected by the sensors Sa and Sb is present within a predetermined deceleration area, and stops the guided vehicle 1 when an obstacle detected by the sensors Sa and Sb is present within a predetermined stopping area. The deceleration area and stopping area can be set appropriately taking safety into consideration, but the stopping area is set to a range narrower than the deceleration area.
[0026] The functional configuration of the transport vehicle 1 will be described with reference to Fig. 2. As shown in the figure, the transport vehicle 1 has, as its functional configuration, for example, a sensor unit 11, a calculation unit 12, and a travel control unit 13.
[0027] The sensor unit 11 is physically the sensors Sa and Sb, and measures the distance to obstacles present around the transport vehicle 1. Examples of obstacles include the walls of the passage, shelves and pipes placed in the passage, other transport vehicles and people present in the passage, etc.
[0028] When it is determined that an obstacle exists in a monitoring area (first area) located in the traveling direction of the transport vehicle 1, the calculation unit 12 calculates an approximate line indicating a virtual position of the obstacle based on the distance to the obstacle. The calculation unit 12 will be described in detail below.
[0029] The monitoring area will be explained with reference to Figure 3. This figure is a schematic diagram of a transport vehicle 1 traveling down a passageway, viewed from directly above. The transport vehicle 1 travels along the passageway formed by passageway walls Wa and Wb in the direction of arrow Y. The vertical length of the monitoring area A is D, and the horizontal length of the monitoring area A is L. The vector whose starting point is the midpoint of the front edge of the vehicle body, whose direction is the arrow Y, and whose magnitude is D is defined as the traveling direction vector V of the transport vehicle 1.
[0030] The vertical length D of the monitoring area A is preferably set to, for example, the vertical length of the stopping area. Note that the vertical length D of the monitoring area A may be set between the vertical length of the stopping area and the vertical length of the deceleration area.
[0031] The horizontal length L of the monitoring area A is set to be at least longer than the vehicle width Lw of the transport vehicle 1.
[0032] 3, the traveling direction of the transport vehicle 1 is the direction of the arrow Y, so the monitoring area A is located above the transport vehicle 1 on the paper, but the position of the monitoring area A is not limited to this. For example, if the traveling direction of the transport vehicle 1 is to the right on the paper, which is perpendicular to the direction of the arrow Y, the monitoring area A will be located to the right of the transport vehicle 1 on the paper.
[0033] The function of the calculation unit 12 to detect an obstacle within the monitoring area A will be described with reference to FIG. 4. This figure is a schematic diagram of the guided vehicle 1 traveling along a passageway, as viewed from directly above. The guided vehicle 1 travels along a passageway formed by passageway walls Wa and Wb in the direction of a traveling vector V. In this figure, a part of the passageway wall Wa is present within the monitoring area A.
[0034] In this case, the calculation unit 12 determines, based on each piece of distance data measured by the sensor Sa, that distance data d shorter than the vertical length D of the monitoring area A exists within the monitoring area A. In other words, the calculation unit 12 determines that an obstacle exists within the monitoring area A. In this case, in order to reduce determination errors, it is preferable to determine that an obstacle exists within the monitoring area A when the number of distance data d shorter than the length D is equal to or greater than a predetermined number.
[0035] 5A and 5B, the function of the calculation unit 12 to calculate an approximate line will be described. Figures 5A and 5B are schematic diagrams of a guided vehicle 1 that has detected an obstacle in a monitoring area A, viewed from directly above.
[0036] As shown in Fig. 5A, the calculation unit 12 calculates an approximate line M indicating the virtual position of the passage wall Wa based on each piece of distance data to the passage wall Wa measured by the sensor Sa. The approximate line M can be calculated using a known method such as the least squares method. The calculation unit 12 translates the calculated approximate line M so that it passes through point P (see Fig. 5B). Point P is the point on the passage wall Wa identified by each piece of distance data measured within the monitoring area A that is closest to the traveling direction vector V.
[0037] 4 and 5 are diagrams illustrating the case where the transport vehicle 1 approaches the passage wall Wa on the left side of the traveling direction. However, there are also cases where the transport vehicle 1 approaches the passage wall Wb on the right side of the traveling direction, or where the transport vehicle 1 approaches obstacles such as the passage walls Wa and Wb on both the left and right sides.
[0038] Therefore, in this embodiment, in order to distinguish whether an obstacle exists on the left or right side of the transport vehicle 1, the monitoring area A is divided into two left and right areas A1 and A1, as shown in Figures 4 and 5. Then, it is determined whether an obstacle exists in each of the areas A1 and A1, and for the areas A1 and A1 where it is determined that an obstacle exists, the approximate line M is calculated according to the procedure described above. In other words, when the transport vehicle 1 approaches the passage wall Wb on the right side in the traveling direction, the approximate line M can be calculated according to the same procedure as when the transport vehicle 1 approaches the passage wall Wa on the left side in the traveling direction.
[0039] On the other hand, when the transport vehicle 1 approaches the passage walls Wa and Wb on both the left and right sides, the approximate line M can be calculated as follows, for example. A specific description will be given with reference to FIG.
[0040] In the situation shown in the figure, the calculation unit 12 determines that an obstacle exists in each of the two left and right areas A1 and A2. The calculation unit 12 calculates approximate lines M1 and Mr corresponding to the passage walls Wa and Wb that are obstacles for each of the two left and right areas A1 and A2. The approximate lines M1 and Mr can be calculated in the same way as when the guided vehicle 1 approaches the passage wall Wa on the left side in the traveling direction.
[0041] The calculation unit 12 calculates a straight line located at the center of the calculated approximate straight lines Ml and Mr, and calculates an approximate straight line vector Vm based on the straight line.
[0042] Returning to the explanation of Fig. 2, the travel control unit 13 controls the travel of the transport vehicle 1 (vehicle body). For example, when the travel mode is the automatic mode, the travel control unit 13 causes the transport vehicle 1 to travel autonomously based on the control program and control data stored in memory, data detected by various sensors, etc. On the other hand, when the travel mode is the manual mode, the travel control unit 13 causes the transport vehicle 1 to travel based on the control program and control data stored in memory, data detected by various sensors, and also on operation signals transmitted from a remote control (manual operation device) operated by a user.
[0043] In this embodiment, the description will be given assuming that the driving mode is the manual mode, but the present invention can be applied to the case where the driving mode is the automatic mode.
[0044] The travel control unit 13 controls the traveling direction of the transport vehicle 1 so as to reduce the angle between the traveling direction vector V of the transport vehicle 1 and the approximate line M or the approximate line vector Vm. Specifically, the travel control unit 13 controls the traveling direction of the transport vehicle 1 as described in the following (a) or (b).
[0045] (a) The travel control unit 13 controls the traveling direction of the transport vehicle 1 so that the difference between the traveling direction vector V of the transport vehicle 1 and the vector of the approximate line M or the approximate line vector Vm decreases.
[0046] (b) The travel control unit 13 controls the direction of travel of the transport vehicle 1 so that the dot product of the unit vector of the travel direction vector V of the transport vehicle 1 and the unit vector of the vector of the approximated straight line or the unit vector of the approximated straight line vector Vm approaches 1.
[0047] When an obstacle is detected in a vehicle width monitoring area (second area) Aw located inside the monitoring area A, the travel control unit 13 controls the guided vehicle 1 as described in (c) or (d) below. As shown in Fig. 3, the vertical length of the vehicle width monitoring area Aw is D, the same as that of the monitoring area A, but the horizontal length of the vehicle width monitoring area Aw is the vehicle width length Lw, which is shorter than the horizontal length L of the monitoring area A.
[0048] (c) The travel control unit 13 rotates the guided vehicle 1 so that the obstacle moves outside the vehicle width monitoring area Aw.
[0049] (d) The travel control unit 13 causes the guided vehicle 1 to travel in a direction different from the traveling direction when the obstacle was detected, so that the obstacle will move outside the vehicle width monitoring area Aw.
[0050] The transport vehicle 1 is controlled by (c) or (d) above, and when the obstacle moves outside the vehicle width monitoring area Aw, the direction of travel of the transport vehicle 1 is controlled by (a) or (b) above.
[0051] Here, the function of the calculation unit 12 to detect an obstacle within the vehicle width monitoring area Aw will be described with reference to Fig. 7. This figure is a schematic diagram of the guided vehicle 1 that has detected an obstacle within the vehicle width monitoring area Aw, viewed from directly above. The guided vehicle 1 is traveling along a passage formed by passage walls Wa and Wb in the direction of a traveling vector V. In this figure, a part of the passage wall Wa exists as an obstacle within the monitoring area A and the vehicle width monitoring area Aw.
[0052] In this case, the calculation unit 12 determines, based on each distance data measured by the sensor Sa, that distance data d shorter than the vertical length D of the monitoring area A exists within the vehicle width monitoring area Aw. In other words, the calculation unit 12 determines that an obstacle exists within the vehicle width monitoring area Aw. In this case, in order to reduce determination errors, it is preferable to determine that an obstacle exists within the vehicle width monitoring area Aw when the number of distance data d shorter than the length D is equal to or greater than a predetermined number.
[0053] Next, an example of the operation of the transport vehicle 1 according to the embodiment will be described with reference to FIG.
[0054] First, the calculation unit 12 of the transport vehicle 1 determines whether or not an obstacle exists in the monitoring area A based on each distance data measured by the sensor unit 11 (step S101). If this determination is NO (step S101; NO), this determination is repeated until it becomes YES.
[0055] If it is determined in the above step S101 that an obstacle exists within the monitoring area A (step S101; YES), the calculation unit 12 of the transport vehicle 1 determines whether or not an obstacle exists within the vehicle width monitoring area Aw based on the distance data measured by the sensor unit 11 (step S102).
[0056] If this determination is YES (step S102; YES), the travel control unit 13 of the guided vehicle 1 rotates the guided vehicle 1 so that the obstacle moves outside the vehicle width monitoring area Aw (step S103).Then, this determination process is repeated until the determination in step S102 is NO.
[0057] If it is determined in the above step S102 that no obstacle is present within the vehicle width monitoring area Aw (step S102; NO), the calculation unit 12 of the transport vehicle 1 calculates an approximate straight line M indicating the virtual position of the obstacle based on each distance data to the obstacle measured by the sensor unit 11 (step S104).
[0058] Next, the travel control unit 13 of the transport vehicle 1 controls the traveling direction of the transport vehicle 1 so that the angle between the traveling direction vector V of the transport vehicle 1 and the approximate line M decreases (step S105), and then the process returns to the determination process of step S101.
[0059] As described above, according to the transport vehicle 1 in the embodiment, when an obstacle is present in the monitoring area A located in the traveling direction of the transport vehicle 1, an approximate line M indicating the virtual position of the obstacle is calculated based on the distance to the obstacle sensed by the sensor, and the traveling direction of the transport vehicle 1 can be controlled so as to reduce the angle formed by the approximate line M and the traveling direction vector V of the transport vehicle 1. This makes it possible to prevent the transport vehicle 1 from getting too close to the obstacle.
[0060] Furthermore, according to the guided vehicle 1 of the embodiment, when an obstacle is detected within the vehicle width monitoring area Aw, the guided vehicle 1 can be rotated and the direction of the guided vehicle 1 can be changed so that the obstacle is moved out of the vehicle width monitoring area Aw. This allows the guided vehicle 1 approaching the obstacle to move away from the obstacle.
[0061] Furthermore, according to the transport vehicle 1 in the embodiment, when an obstacle is detected in each of the two areas Al and Ar obtained by dividing the monitoring area A into left and right halves, approximate lines Ml and Mr corresponding to the obstacles on the left and right sides are calculated, and the traveling direction of the transport vehicle 1 can be controlled so as to reduce the angle formed between the line located at the center of the approximate lines Ml and Mr and the traveling direction vector V of the transport vehicle 1. This makes it possible to prevent the transport vehicle 1 from getting too close to the obstacles on both the left and right sides.
[0062] Therefore, the transport vehicle 1 in the embodiment can easily travel in narrow spaces.
[0063] The above-described embodiments are intended to facilitate understanding of the present invention and are not intended to limit the present invention. The elements of the embodiments, as well as their arrangement, shape, size, etc., are not limited to those exemplified and may be modified as appropriate. [Explanation of symbols]
[0064] 1...transport vehicle, 11...sensor unit, 12...calculation unit, 13...travel control unit, A...monitoring area, Aw...vehicle width monitoring area, M...approximate line, Sa, Sb...sensor, V...traveling direction vector, Vm...approximate line vector, Wa, Wb...passage wall
Claims
1. A sensor unit for measuring a distance to an obstacle that may be present around the vehicle body; a calculation unit that calculates an approximation line indicating a virtual position of the obstacle based on a plurality of distance data to the obstacle measured by the sensor unit when the obstacle is present within a first region that is located in a traveling direction of the vehicle body and has a width at least wider than a vehicle width; a travel control unit that controls a traveling direction of the vehicle body so that an angle between a traveling direction vector of the vehicle body, which has a starting point at a midpoint of a front edge of the vehicle body and a magnitude equal to a vertical length of the first area, and the approximation line decreases; Equipped with the calculation unit calculates a provisional approximation line, which is a temporary approximation line, based on a plurality of distance data to the obstacle measured by the sensor unit, and further calculates the approximation line by translating the provisional approximation line so as to pass through a point that is identified as part of the obstacle in the first area and is closest to a traveling direction vector of the vehicle body, based on a plurality of distance data to the obstacle measured by the sensor unit. Transport vehicle.
2. the traveling control unit controls a traveling direction of the vehicle body so that a difference between a traveling direction vector of the vehicle body and a vector based on the approximation line is reduced. The transport vehicle according to claim 1.
3. the traveling control unit controls the traveling direction of the vehicle body so that an inner product of a unit vector of the traveling direction of the vehicle body and a unit vector of the approximation line approaches 1. The transport vehicle according to claim 1.
4. the calculation unit, when the obstacle is detected in each of the areas obtained by dividing the first area into left and right areas with respect to the traveling direction, calculates the approximation straight lines corresponding to each of the obstacles, and calculates a straight line located at the center of the calculated approximation straight lines; The traveling control unit controls a traveling direction of the vehicle body so that an angle between a traveling direction vector of the vehicle body and the straight line located at the center decreases. The transport vehicle according to claim 1.
5. When the obstacle is detected in a second area located inside the first area, the traveling control unit rotates the vehicle body so that the obstacle moves outside the second area. A transport vehicle according to any one of claims 1 to 4.
6. When the obstacle is detected in a second area located inside the first area, the traveling control unit causes the vehicle body to travel in a direction different from the traveling direction when the obstacle is detected so that the obstacle moves outside the second area. A transport vehicle according to any one of claims 1 to 4.
Citation Information
Patent Citations
Automatic guidance and control equipment for moving body
JP1990076008A
Method for correcting angle of mobile robot in working area and mobile robot
JP2020506478A
Traveling device, guide robot, and method for controlling traveling device
JP6601001B2
