Obstacle Avoidance Device
The obstacle avoidance device enhances autonomous vehicle navigation by deriving virtual observation points based on sensor data and vehicle movement, addressing the limitation of sensor observation areas to prevent collisions.
Patent Information
- Application Number
- JP2021147010
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2021-09-09
- Publication Date
- 2024-12-03
- Estimated Expiration
- 2041-09-09
AI Technical Summary
Existing obstacle avoidance systems for autonomous vehicles are limited by the sensor's observation area, failing to account for obstacles outside this area due to vehicle movement, leading to potential collisions.
An obstacle avoidance device that derives a virtual observation point group by moving past observation points based on the vehicle's movement, incorporating both observed and unobserved obstacles to enhance avoidance capabilities.
Improves the vehicle's ability to avoid obstacles by considering both observed and unobserved areas, reducing the risk of collision and optimizing route planning.
Smart Images

Figure 0007593274000001 
Figure 0007593274000002 
Figure 0007593274000003
Abstract
Description
[Technical field]
[0001] The present invention relates to an obstacle avoidance device. [Background technology]
[0002] Patent Document 1 discloses an autonomous vehicle equipped with a sensor capable of observing obstacles in the vicinity. [Prior art documents] [Patent documents]
[0003] [Patent Document 1] JP 2014-089740 A Summary of the Invention [Problem to be solved by the invention]
[0004] However, when the observation area of a sensor is limited, an obstacle that was located within the observation area of the sensor may be located outside the observation area of the sensor due to the movement of the autonomous vehicle. Even in such a case, when making the autonomous vehicle avoid surrounding obstacles, it is desirable to make the autonomous vehicle avoid the obstacles while taking into account the obstacles located outside the observation area of the sensor. [Means for solving the problem]
[0005] An obstacle avoidance device that solves the above problem is an obstacle avoidance device for causing an autonomous vehicle to avoid an obstacle observed by a sensor equipped in the autonomous vehicle, and includes an obstacle point cloud derivation unit that derives an obstacle point cloud that indicates the position of the obstacle relative to the autonomous vehicle based on the observation results of the sensor, and an avoidance unit that causes the autonomous vehicle to avoid the obstacle indicated by the obstacle point cloud when the obstacle point cloud is present, the obstacle point cloud comprising an observation point cloud that indicates the position of the obstacle within an observation area of the sensor, and an obstacle point cloud that is an obstacle that has been observed by the sensor in the past and is associated with the movement of the autonomous vehicle. and a virtual observation point cloud indicating the position of the obstacle that has become outside the observation area of the sensor due to an observation result of the sensor being moved, and the obstacle point cloud derivation unit comprises an observation point cloud acquisition unit that acquires the observation point cloud based on the observation results of the sensor, a movement amount acquisition unit that acquires the amount of movement of the autonomous vehicle from the acquisition of the past observation point cloud to the acquisition of the observation point cloud by the observation point cloud acquisition unit, where the observation point cloud acquired earlier than the observation point cloud acquired by the observation point cloud acquisition unit is defined as a past observation point cloud, and a virtual observation point cloud derivation unit that derives the virtual observation point cloud by moving the past observation point cloud by the movement amount.
[0006] According to this, the virtual observation point cloud is obtained by moving the previously observed observation point cloud by the movement amount of the autonomous vehicle. The virtual observation point cloud indicates where an obstacle indicated by the previously observed observation point cloud is located at the time when the observation point cloud is acquired by the observation point cloud acquisition unit. The avoidance unit causes the autonomous vehicle to perform an avoidance operation taking into account not only the observation point cloud indicating the position of the obstacle within the observation area of the sensor, but also the virtual observation point cloud. As a result, by using the obstacle avoidance device, the autonomous vehicle can avoid the obstacle by taking into account the obstacle observed in the past even if the obstacle is located outside the observation area of the sensor. Therefore, the obstacle avoidance performance of the autonomous vehicle can be improved.
[0007] In the above obstacle avoidance device, the obstacle point cloud derivation unit may include an auxiliary point cloud generation unit that generates an auxiliary point cloud within a blocked region of the observation region that is blocked by the obstacle, based on the observation point cloud acquired by the observation point cloud acquisition unit, and a virtual auxiliary point cloud derivation unit that derives a virtual auxiliary point cloud located outside the observation region of the sensor by moving the previously generated auxiliary point cloud by the movement amount, and the obstacle point cloud may include the auxiliary point cloud and the virtual auxiliary point cloud.
[0008] When an obstacle blocks the sensor's observation, it becomes difficult for the autonomous vehicle to observe the area behind the obstacle with the sensor. Therefore, according to this configuration, an auxiliary point cloud is generated in such a blocked area. When the previously generated auxiliary point cloud moves outside the observation area of the sensor due to the movement of the autonomous vehicle, the auxiliary point cloud is moved by the movement amount of the autonomous vehicle to derive a virtual auxiliary point cloud. The virtual auxiliary point cloud derived in this manner indicates an area that was in the observation area of the sensor but could not be observed by the sensor due to an obstacle. Since the obstacle point cloud includes the virtual auxiliary point cloud, the autonomous vehicle can avoid the area represented by the virtual auxiliary point cloud when avoiding an obstacle. The autonomous vehicle can avoid the obstacle while avoiding the area that could not be observed by the sensor due to the obstacle. Therefore, the possibility that the autonomous vehicle will come into contact with an object in an area blocked by an obstacle can be reduced.
[0009] In the above obstacle avoidance device, when the obstacle is present within the observation area, the observation area may be composed of the occluded area and an observable area other than the occluded area, and the obstacle point cloud derivation unit may include an auxiliary point cloud removal unit that removes from the obstacle point cloud those of the auxiliary point cloud and the virtual auxiliary point cloud that are included in the observable area.
[0010] According to this, the observable area indicates an observation area observed by a sensor without being blocked by an obstacle. Therefore, by removing the auxiliary point cloud and the virtual auxiliary point cloud that are included in the observable area from the obstacle point cloud, if it is confirmed that there is no obstacle in an area where it was once determined that there was an obstacle, the autonomous vehicle can travel through the area and avoid the obstacle. Therefore, it is possible to shorten the route when avoiding an obstacle.
[0011] In the above obstacle avoidance device, the avoidance unit may cause the autonomous vehicle to avoid the obstacle indicated by the obstacle point cloud that is included in a search area that includes at least a portion of the autonomous vehicle.
[0012] This makes it possible to prevent the autonomous vehicle from causing inconvenience by trying to avoid an obstacle that is so far away that it does not need to be avoided. In the above-mentioned obstacle avoidance device, the virtual observation point cloud derivation unit may derive the virtual observation point cloud by moving a portion of the past observation point cloud by the movement amount, and the distance between the virtual observation points that make up the derived virtual observation point cloud may be less than the drivable width within which the autonomous vehicle can travel.
[0013] According to this, by reducing the number of virtual observation points included in the derived virtual observation point group, it is possible to reduce the processing load on the obstacle avoidance device. Effect of the Invention
[0014] According to the present invention, it is possible to cause an autonomous vehicle to avoid obstacles by taking into consideration obstacles that are located outside the observation area of a sensor. [Brief description of the drawings]
[0015] [Figure 1] FIG. [Diagram 2] FIG. 2 is a block diagram of an autonomous vehicle. [Diagram 3]13 is a flowchart showing an obstacle avoidance process. [Figure 4] 13 is a flowchart showing an obstacle point cloud derivation process. [Diagram 5] FIG. 13 is a diagram showing an example of avoidance driving. [Figure 6] FIG. 13 is a diagram showing an example of avoidance driving. [Figure 7] FIG. 13 is a diagram showing an example of avoidance driving. [Figure 8] FIG. 13 is a diagram showing an example of avoidance driving. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0016] <Configuration> Hereinafter, an embodiment of an autonomous vehicle to which an obstacle avoidance device is applied will be described. As shown in Fig. 1, the autonomous vehicle 10 includes a vehicle 20, a sensor 31 mounted on the vehicle 20, and a control device 32 mounted on the vehicle 20. The vehicle 20 includes a vehicle body 21 and a plurality of wheels 22. The autonomous vehicle 10 is a transport cart that transports loads. The autonomous vehicle 10 of this embodiment is configured to be movable in all directions and to be able to turn on the spot around the vehicle center position P.
[0017] The wheels 22 in this embodiment are omnidirectional wheels. An omnidirectional wheel is a wheel that rotates together with the axle and also allows movement in the axial direction of the axle. Four wheels 22 are provided. By controlling the number of rotations and the direction of rotation of the wheels 22, the vehicle 20 can move in all directions while maintaining the orientation of the body 21, move while changing the orientation of the body 21, and change the orientation of the body 21 without moving. Note that the above-mentioned "omnidirectional" refers to the direction of movement on the road surface or floor surface on which the vehicle 20 runs. Hereinafter, for convenience of explanation, the surface on which the vehicle 20 runs is referred to as a horizontal plane.
[0018] 2, the autonomous vehicle 10 includes a drive mechanism 41 that drives the wheels 22. The drive mechanism 41 includes a motor 42 for rotating the wheels 22, and a motor driver 43 that drives the motor 42. Although not shown in the figure, the number of motors 42 and motor drivers 43 provided is the same as the number of wheels 22. The motor driver 43 controls the rotation speed of the motor 42 in response to a command from the control device 32. The control device 32 can control the traveling direction of the vehicle 20 by controlling the rotation speed of the motor 42 via the motor driver 43.
[0019] Next, the sensor 31 and the control device 32 will be described in detail. 1, the sensor 31 is configured to be able to observe an obstacle Ob1 within an observation area A1. The sensor 31 in this embodiment is an RGB camera including an imaging element such as a CMOS (Complementary Metal Oxide Transistor).
[0020] The observation area A1 is an area extending from the sensor 31 in the observation direction D1. The observation direction D1 is a direction parallel to the horizontal plane. As the observation area A1 moves from the sensor 31 toward the observation direction D1, it expands in a direction parallel to the horizontal plane and perpendicular to the observation direction D1. The observation direction D1 indicates the center of the observation area A1 based on the sensor 31. The observation area A1 is included in a range of a predetermined observation angle from the observation direction D1 in the horizontal plane. The observation angle is, for example, in a range of ±60 degrees with respect to the observation direction D1. The observation angle in this embodiment is the angle of view of the sensor 31. The sensor 31 is mounted at a sensor position Ps that is a position away from the running object center position P. Hereinafter, for convenience of explanation, a virtual boundary line that extends from the sensor position Ps and whose angle with the observation direction D1 is the above-mentioned observation angle is referred to as the observation boundary line B1, B2. In this embodiment, the direction from the running object center position P toward the sensor position Ps in the horizontal plane coincides with the observation direction D1.
[0021] As shown in FIG. 5, when an obstacle Ob1 exists within an observation area A1, the observation area A1 is made up of a blocked area A11 and an observable area A12. The shielded area A11 is an area of the observation area A1 where the observation by the sensor 31 is blocked by the obstacle Ob1. In other words, the shielded area A11 is a blind spot of the obstacle Ob1 as seen from the sensor 31, such as the depth of the obstacle Ob1 based on the sensor 31. For example, when the obstacle Ob1 exists in the observation area A1, the sensor 31 observes a part of the obstacle Ob1 facing the sensor 31. However, the sensor 31 may not be able to observe an area of the obstacle Ob1 that is blocked by a part observed by the sensor 31. The area blocked by the part of the obstacle Ob1 corresponds to the shielded area A11. In this case, the sensor 31 cannot observe an obstacle that may be located in the shielded area A11. Note that an obstacle that may be located in the shielded area A11 is, for example, a part of the obstacle Ob1 or an obstacle different from the obstacle Ob1.
[0022] The observable area A12 is an area of the observation area A1 other than the blocked area A11. The observable area A12 is an area in which the field of view of the sensor 31 is not blocked by the obstacle Ob1. The observable area A12 is an area in which the obstacle Ob1 can be directly observed by the sensor 31.
[0023] As shown in FIG. 2, the control device 32 includes a CPU 33, a storage unit 34 including a RAM and a ROM, and an auxiliary storage device 35. The storage unit 34 stores various programs for controlling the vehicle 20. The control device 32 may include dedicated hardware for executing at least some of the various processes, such as an application specific integrated circuit (ASIC). The control device 32 may be configured as a circuit including one or more processors that operate according to a computer program, one or more dedicated hardware circuits such as an ASIC, or a combination thereof. The processor includes a CPU and memories such as a RAM and a ROM. The storage unit 34 stores program code or instructions configured to cause the CPU to execute the processes. The storage unit 34, i.e., the computer readable medium, includes anything that can be accessed by a general-purpose or dedicated computer. The auxiliary storage device 35 is a rewritable non-volatile memory. Examples of the auxiliary storage device 35 include an EEPROM (Electrically Erasable Programmable Read-Only Memory) and a flash memory. The auxiliary storage device 35 stores information indicating an environmental map. The environmental map is information regarding the physical structure of the surrounding environment of the autonomous vehicle 10, such as the shape and size of the environment in which the autonomous vehicle 10 is used.
[0024] As shown in Fig. 1, when the vehicle 20 is driven, the control device 32 generates a driving route R. The driving route R is a route from the current position, which is the starting point of the vehicle 20, to the final destination. When the vehicle 20 is moving straight, the observation direction D1 is parallel to the driving route R. In Fig. 1, the driving route R and the observation direction D1 overlap. The driving route R can be generated by, for example, converting a drivable route into a grid map and generating a route, or by a potential method using a potential field.
[0025] The control device 32 sets a position on the travel route R a predetermined distance away from the vehicle 20 as a target point Pg, and controls the drive mechanism 41 to travel toward the target point Pg. The control device 32 drives the vehicle 20 so that the observation direction D1 of the sensor 31 faces the traveling direction of the vehicle 20. For ease of explanation, the traveling of the vehicle 20 such that the observation direction D1 coincides with the traveling direction of the vehicle 20 will be referred to as normal traveling below. The traveling direction of the vehicle 20 in normal traveling coincides with the direction in which the travel route R extends.
[0026] The control device 32 performs obstacle avoidance processing. By performing the obstacle avoidance processing, the control device 32 causes the autonomous mobile body 10 to avoid the obstacle Ob1 observed by the sensor 31. At this time, the control device 32 keeps the distance between the vehicle 20 and the obstacle Ob1 at or above a predetermined value so that the vehicle 20 and the obstacle Ob1 do not come into contact with each other.
[0027] An example of the obstacle avoidance processing will be described below with reference to Figures 3 to 8. The obstacle avoidance processing is performed, for example, while the vehicle 20 is traveling. As shown in Fig. 3, the control device 32 performs an obstacle point cloud derivation process in step S1. As a result, as shown in Fig. 5, the control device 32 derives an obstacle point cloud PCob based on the observation results of the sensor 31. The obstacle point cloud derivation process is repeatedly performed at a predetermined update period. As a result, the obstacle point cloud PCob is updated at the update period. The control device 32 that executes the process of step S1 corresponds to an obstacle point cloud derivation unit of this embodiment.
[0028] The obstacle point cloud PCob indicates the position of the obstacle Ob1 relative to the autonomous mobile body 10. The obstacle point cloud PCob is composed of one or more obstacle points Pob. It is a point indicating the position of the obstacle Ob1. For example, the obstacle point cloud PCob is the relative coordinates of the obstacle Ob1 relative to the autonomous mobile body 10 in a horizontal plane. In this embodiment, the obstacle point cloud PCob is a point cloud expressed in mobile body coordinates. The mobile body coordinates are expressed in a two-dimensional coordinate system with the mobile body center position P as the origin. In the mobile body coordinates, the direction parallel to the observation direction D1 is the Y direction, and the direction perpendicular to the observation direction D1 is the X direction. The XY plane is parallel to the horizontal plane.
[0029] 5 to 8, the obstacle point cloud PCob of this embodiment includes an observation point cloud PC1, an auxiliary point cloud PC2, a virtual observation point cloud PCi1, and a virtual auxiliary point cloud PCi2. The obstacle points Pob of this embodiment include an observation point P1, an auxiliary point P2, a virtual observation point Pi1, and a virtual auxiliary point Pi2.
[0030] The observation point group PC1 indicates the position of an obstacle Ob1 within the observation area A1 of the sensor 31. The observation point group PC1 is made up of one or more observation points P1. The auxiliary point group PC2 indicates the position of an obstacle that may be located in the blocked area A11. An obstacle that may be located in the blocked area A11 is, for example, a part of the obstacle Ob1 or an obstacle different from the obstacle Ob1. The auxiliary point group PC2 is composed of one or more auxiliary points P2.
[0031] The virtual observation point group PCi1 indicates the position of an obstacle Ob1 previously observed by the sensor 31. The virtual observation point group PCi1 is made up of one or more virtual observation points Pi1. The virtual auxiliary point group PCi2 indicates the position of an obstacle Ob1 that may be located within the blocked area A11 derived based on the past observation results of the sensor 31. The virtual auxiliary point group PCi2 is made up of one or more virtual auxiliary points Pi2.
[0032] Here, the obstacle point cloud derivation process in step S1 will be described in detail. 4, in step S11, the control device 32 acquires an observation point group PC1 and an observation time t1 based on the observation results of the sensor 31. The control device 32 that executes the process of step S11 corresponds to the observation point group acquisition unit of this embodiment.
[0033] Observation time t1 is the time when the observation result of sensor 31 is obtained. Observation time t1 can also be said to be the time when observation point group PC1 is acquired by control device 32. Control device 32 stores observation point group PC1 and observation time t1 acquired in step S11 in auxiliary storage device 35. Note that acquisition and storage of observation time t1 are optional.
[0034] An example of a method for deriving the observation point group PC1 expressed in vehicle coordinates will be described. The control device 32 acquires image data captured by the sensor 31. The image data may include an object located within the observation area A1. Each pixel of the acquired image data is associated with coordinates on the image data and depth information. The image coordinates are, for example, two-dimensional coordinates with an arbitrary point on the image as the origin, and indicate the direction of the object represented in each pixel relative to the sensor 31. The depth information indicates the distance between the object represented in each pixel and the sensor 31. The depth information is obtained, for example, by performing depth estimation on the image data. The specific aspect of the depth estimation is arbitrary, and examples include SfM (Structure from Motion) and machine learning using a convolution neural network (CNN). The depth information may be obtained separately from a distance sensor or the like.
[0035] The control device 32 derives sensor coordinates corresponding to each pixel from the acquired image coordinates and depth information. The sensor coordinates are, for example, a three-dimensional coordinate system with the sensor position Ps as the origin. In the sensor coordinates, the direction parallel to the observation direction D1 is the Y direction, the direction perpendicular to the observation direction D1 is the X direction, and the direction perpendicular to both the X direction and the Y direction is the Z direction. Here, the X direction and the Y direction are each parallel to the horizontal plane. The sensor coordinates may be expressed as polar coordinates with the sensor position Ps as the origin. In this way, the control device 32 derives a point cloud on the sensor coordinates of the target indicated by each pixel.
[0036] The control device 32 converts the point cloud into the vehicle coordinates based on the X and Y coordinates of the point cloud on the derived sensor coordinates. The control device 32 derives the point cloud obtained by the conversion as the observation point cloud PC1. The conversion deletes the Z coordinate included in the point cloud on the sensor coordinates. In other words, the conversion is a projection from the three-dimensional sensor coordinates to the two-dimensional vehicle coordinates. The control device 32 may convert only the Z coordinates of the derived point cloud on the sensor coordinates that are within a predetermined allowable range into the vehicle coordinates. The allowable range may be appropriately set based on, for example, the height of the step on which the autonomous vehicle 10 can travel or the vehicle height of the autonomous vehicle 10. This prevents, for example, the floor on which the autonomous vehicle 10 travels or the step that the autonomous vehicle 10 can overcome from being derived as the observation point cloud PC1.
[0037] For convenience of explanation, each point group described below is represented in a vehicle coordinate system unless otherwise specified. After step S11 is executed, the process proceeds to step S12, where the control device 32 generates an auxiliary point group PC2 in the shielded area A11. The shielded area A11 includes the boundary between the shielded area A11 and the observable area A12. In this embodiment, at least a part of the auxiliary point group PC2 is generated at the boundary between the shielded area A11 and the observable area A12. The auxiliary point group PC2 is composed of a plurality of auxiliary points P2. The distance between the auxiliary points P2 is less than the travelable width of the autonomous vehicle 10. The travelable width of the autonomous vehicle 10 is the width in which the autonomous vehicle 10 can travel. The travelable width is longer than the maximum dimension of the autonomous vehicle 10 in the horizontal direction by a predetermined margin width. The margin width can be arbitrarily set by the user based on the allowable distance between the vehicle 20 and the obstacle Ob1. In addition, since the observation point cloud PC1 is used to derive the auxiliary point cloud PC2, the auxiliary point cloud PC2 is also a point cloud indicating the position of the obstacle Ob1 in the shielded area A11 at the observation time t1. The control device 32 that executes the process of step S12 corresponds to the auxiliary point cloud generation unit of this embodiment.
[0038] The method of generating the auxiliary point group PC2 in the shielded area A11 is arbitrary, but for example, the control device 32 may generate the auxiliary point P2 at a position farther from the observation point P1 with respect to the sensor position Ps on a straight line connecting the sensor position Ps and the observation point P1. In particular, in this embodiment, when generating the auxiliary point group PC2, the control device 32 selects the observation point P1 having the largest angle from the sensor position Ps toward the observation point P1 with respect to the observation direction D1 as a reference. The control device 32 generates the auxiliary point P2 at a position farther from the observation point P1 with respect to the sensor position Ps on a straight line connecting the sensor position Ps and the selected observation point P1. This allows the control device 32 to generate the auxiliary point group PC2 at the boundary between the shielded area A11 and the observable area A12. The distance between the auxiliary points P2 generated at the boundary between the shielded area A11 and the observable area A12 is an arbitrary value less than the travelable width of the autonomous mobile body 10. Note that the control device 32 may generate the auxiliary point group PC2 by deriving the shielded area A11 based on the observation point group PC1 and placing the auxiliary point P2 at an arbitrary position within the derived shielded area A11.
[0039] Next, the process proceeds to step S13, where the control device 32 acquires a past observation point cloud, a past auxiliary point cloud, and a past observation time t2. The past observation point cloud is the observation point cloud PC1 acquired earlier than the observation point cloud PC1 acquired in step S11. The past auxiliary point cloud is the auxiliary point cloud PC2 generated earlier than the auxiliary point cloud PC2 generated in step S12. The past observation time t2 is the time when the observation point cloud PC1 was acquired in the past step S11. In this embodiment, the past observation time t2 is also the time when the auxiliary point cloud PC2 was generated in the past step S12. In this embodiment, the observation point cloud PC1, the auxiliary point cloud PC2, and the observation time t1 stored in the auxiliary storage device 35 in the obstacle point cloud derivation process performed in the previous update cycle are acquired as the past observation point cloud, the past auxiliary point cloud, and the past observation time t2, respectively. Note that acquisition of the past observation time t2 is optional.
[0040] The control device 32 acquires the amount of movement δ of the autonomous mobile unit 10 from the acquisition of the past observation point group in step S13 to the acquisition of the observation point group PC1 in step S11. The amount of movement δ includes the traveling direction and traveled distance of the autonomous mobile unit 10. In this embodiment, the amount of movement δ is the change in the mobile unit center position P in the absolute coordinate system from the past observation time t2 to the observation time t1. The absolute coordinate system is a coordinate system in which the ground surface on which the wheels 22 are in contact appears stationary.
[0041] The method of acquiring the movement amount δ is arbitrary, but for example, the control device 32 uses odometry to estimate the travel distance and travel direction of the autonomous mobile body 10 from the rotation amount of the wheels 22 and the rotation amount of the motor 42. The control device 32 acquires the movement amount δ from the estimated travel distance and travel direction of the autonomous mobile body 10. Note that the control device 32 may derive the movement amount δ using Simultaneous Localization and Mapping (SLAM). The control device 32 that executes the process of step S14 corresponds to the movement amount acquisition unit of this embodiment.
[0042] Next, the process proceeds to step S15, where the control device 32 derives a virtual observation point group PCi1 and a virtual auxiliary point group PCi2 by moving the past observation point group and the past auxiliary point group by a movement amount δ. In particular, the control device 32 moves any past observation point group whose distance from other past observation point groups is equal to or greater than the omission distance and less than the driving width. The omission distance indicates the resolution of the obstacle Ob1 recognized by the control device 32. The omission distance can be set arbitrarily based on, for example, the observation accuracy of the obstacle Ob1. The control device 32 that executes the process of step S15 corresponds to the virtual observation point group derivation unit and the virtual auxiliary point group derivation unit of this embodiment.
[0043] In this embodiment, the control device 32 selects the past observation point group from the previous update cycle, i.e., the past observation point group acquired in step S13, whose distance from the other past observation point groups is equal to or greater than the omittable distance and less than the driving width. The control device 32 translates the selected past observation point group by the movement amount δ acquired in step S14, to derive the virtual observation point group PCi1.
[0044] As described above, the moving object center position P moves by the movement amount δ from the past observation time t2 to the observation time t1. Therefore, the obstacle Ob1 shown in the past observation point group obtained at the past observation time t2 moves in the direction in which the moving object center position P moved, i.e., in the opposite direction to the traveling direction of the autonomous moving object 10, by the same distance as the movement distance of the moving object center position P.
[0045] Therefore, the virtual observation point group PCi1 is located at a position moved by the movement amount δ from the past observation point group PC1. In detail, the virtual observation point group PCi1 is located at a position moved from the past observation point group PC1 in the opposite direction to the movement direction of the moving object center position P by the same distance as the movement distance of the moving object center position P. Similarly, the virtual auxiliary point group PCi2 is located at a position moved by the movement amount δ from the past auxiliary point group PC2. Therefore, the point group obtained by translating the past observation point group by the movement amount δ becomes the virtual observation point group PCi1 representing the position of the obstacle Ob1 at observation time t1.
[0046] Here, due to the movement of the autonomous mobile unit 10, an obstacle Ob1 that was located within the observation area A1 at the past observation time t2 may be located outside the observation area A1 at the observation time t1. In this case, the virtual observation point group PCi1 and the virtual auxiliary point group PCi2 are located outside the observation area A1. Therefore, the virtual observation point group PCi1 and the virtual auxiliary point group PCi2 indicate the position of the obstacle located outside the observation area A1.
[0047] Next, the process proceeds to step S16, where the control device 32 removes the virtual observation point group PCi1 in the observation area A1 and the virtual auxiliary point group PCi2 in the observation area A1. In other words, the control device 32 leaves the virtual observation point group PCi1 outside the observation area A1 and the virtual auxiliary point group PCi2 outside the observation area A1 as the obstacle point group PCob. Whether the virtual observation point group PCi1 and the virtual auxiliary point group PCi2 are within the observation area A1 can be determined by whether the angle between the direction in the horizontal plane relative to the sensor position Ps of the virtual observation point Pi1 and the virtual auxiliary point Pi2 and the observation direction D1 is within the observation angle range. If the angle is within the observation angle range, the control device 32 determines that the virtual observation point group PCi1 and the virtual auxiliary point group PCi2 are within the observation area A1. On the other hand, if the angle is outside the observation angle range, the control device 32 determines that the virtual observation point group PCi1 and the virtual auxiliary point group PCi2 are outside the observation area A1. The virtual observation point group PCi1 and the virtual auxiliary point group PCi2 that remain without being removed in step S16 are located outside the observation area A1. Therefore, the virtual observation point group PCi1 and the virtual auxiliary point group PCi2 indicate the position of the obstacle Ob1 that has come to be located outside the observation area A1 of the sensor 31 due to the movement of the autonomous mobile body 10. The control device 32 that executes the processing of step S16 corresponds to the auxiliary point group removal unit of this embodiment.
[0048] Next, the process proceeds to step S17, where the control device 32 removes the auxiliary point group PC2 and the virtual auxiliary point group PCi2 from within the observable area A12. Note that in this embodiment, the virtual auxiliary point group PCi2 from within the observable area A12 has been removed in step S16.
[0049] Next, proceeding to step S18, the control device 32 removes the set of observation points PC1, the set of virtual observation points PCi1, the set of auxiliary points PC2, and the set of virtual auxiliary points PCi2 that are located outside the search area A2. As shown in Figs. 5 to 8, the search area A2 includes at least a portion of the autonomous vehicle 10. The search area A2 includes the vehicle center position P and the sensor position Ps. In this embodiment, the search area A2 includes the entire autonomous vehicle 10. The search area A2 is rectangular. The size of the search area A2 may be set in advance by a user, or may be set appropriately based on the traveling state of the autonomous vehicle 10, for example, the braking distance of the autonomous vehicle 10 corresponding to the traveling speed.
[0050] 4, the process proceeds to step S19, where the control device 32 derives, as an obstacle point group PCob, those remaining without being removed in the processes from step S16 to step S18, among the observation point group PC1, auxiliary point group PC2, virtual observation point group PCi1, and virtual auxiliary point group PCi2 acquired or derived in the processes from step S11 to step S15. In other words, the control device 32 derives, as an obstacle point group PCob, those located within the search area A2, among the observation point group PC1 in the observation area A1, the auxiliary point group PC2 in the observation area A1, the virtual observation point group PCi1 outside the observation area A1, and the virtual auxiliary point group PCi2 outside the observation area A1.
[0051] The control device 32 updates the obstacle point cloud PCob of the previous update cycle by storing the observation point cloud PC1 and virtual observation point cloud PCi1 derived as the obstacle point cloud PCob as past observation point clouds, the auxiliary point cloud PC2 and virtual auxiliary point cloud PCi2 as past auxiliary point clouds, and the observation time t1 as past observation time t2 in the auxiliary storage device 35. After completing the process of step S19, the control device 32 ends the obstacle point cloud derivation process and proceeds to step S2.
[0052] As shown in FIG. 3, the process proceeds to step S2, where the control device 32 determines whether or not an obstacle Ob1 exists within the search area A2 based on the obstacle point cloud PCob derived in step S1. Any method of determination may be used, but for example, the process proceeds to step S3, where the control device 32 causes the autonomous vehicle 10 to continue normal traveling and ends the obstacle avoidance process. On the other hand, if the determination result in step S2 is positive, that is, if it is determined that an obstacle Ob1 exists within the search area A2, the process proceeds to step S4.
[0053] In step S4, the control device 32 causes the autonomous mobile body 10 to perform avoidance traveling, thereby causing the autonomous mobile body 10 to avoid the obstacle Ob1 indicated by the obstacle point group PCob. The avoidance traveling is traveling in a direction in which the obstacle Ob1 determined to exist in step S2 can be avoided. As an example of the avoidance traveling, the control device 32 determines the traveling direction based on the position of the obstacle point group PCob. The control device 32 searches whether there is an area in the search area A2 that does not include the obstacle point group PCob and in which the interval between the obstacle points Pob is equal to or greater than the travelable width. The control device 32 determines, as the traveling direction of the autonomous mobile body 10, the direction in which the angle between the direction from the mobile body center position P toward the area and the direction of the traveling route R is the smallest, among the areas equal to or greater than the travelable width. After that, the control device 32 causes the autonomous mobile body 10 to travel in the traveling direction. In other words, the control device 32 causes the autonomous mobile body 10 to avoid the obstacle Ob1 by making the autonomous mobile body 10 detour around the area where the distance between the obstacle points Pob is less than the travelable width (the area indicated by the obstacle points Pob in this embodiment). The control device 32 that executes the process of step S4 corresponds to the avoidance unit in this embodiment.
[0054] After a predetermined update period has elapsed since the process of step S4 was started, the control device 32 returns to step S1 and performs the obstacle point cloud derivation process again. As a result, the control device 32 derives the obstacle point cloud PCob every time an update period elapses.
[0055] If it is determined that the obstacle Ob1 does not exist within the search area A2 as a result of the avoidance driving, the determination result in step S2 is negative, and the control device 32 causes the autonomous mobile body 10 to perform normal driving.
[0056] <effect> Next, the operation of this embodiment will be described. 1, if there is no obstacle Ob1 within the observation area A1 and the search area A2, there is no obstacle point cloud PCob derived in the obstacle point cloud derivation process of step S1. Therefore, the determination result of step S2 is negative, and the process proceeds to step S3, where the control device 32 causes the autonomous vehicle 10 to perform normal driving.
[0057] 5, when an obstacle Ob1 is present within the observation area A1, the sensor 31 observes the obstacle Ob1. The control device 32 executes the processes from step S1 to step S3 based on the observation results of the sensor 31, thereby acquiring the observation point group PC1 and deriving the auxiliary point group PC2. Note that if the past observation point group and the past auxiliary point group are not stored, the virtual observation point group PCi1 and the virtual auxiliary point group PCi2 derived by the processes from step S13 to step S15 do not exist.
[0058] Then, by executing the process of step S16, the control device 32 removes those located outside the observation region A1 from the auxiliary point cloud PC2 generated in the shielded region A11, and derives the observation point cloud PC1 and auxiliary point cloud PC2 remaining in the processes from step S11 to step S18 as the obstacle point cloud PCob. Therefore, the observation point cloud PC1 and auxiliary point cloud PC2 included in the obstacle point cloud PCob exist only in the search region A2.
[0059] 5, when an obstacle is observed in the observation area A1, the obstacle point cloud PCob exists in the search area A2. Therefore, the determination in step S2 is positive. As a result, the control device 32 determines the traveling direction of the autonomous mobile body 10 and causes the autonomous mobile body 10 to perform avoidance traveling.
[0060] As shown in Fig. 6, the autonomous vehicle 10 moves by a movement amount δ during a predetermined update period after starting avoidance traveling, and changes from the situation shown in Fig. 5 to the situation shown in Fig. 6. At this time, the control device 32 returns to step S1 again and performs the obstacle point cloud derivation process. As a result, the obstacle point cloud PCob after the update period has elapsed since the previously acquired observation time t1, i.e., the past observation time t2, is derived.
[0061] In the situation shown in Fig. 6, the control device 32 performs the process of step S1 again to obtain the observation point group PC1 and the observation time t1 within the observation area A1, and to generate the auxiliary point group PC2. In the situation shown in Fig. 6, the autonomous mobile device 10 performs evasive driving, and a part of the obstacle Ob1 moves outside the observation area A1. Therefore, the sensor 31 cannot observe the obstacle Ob1 that has moved outside the observation area A1.
[0062] Here, the control device 32 stores the observation point group PC1 obtained in the previous obstacle point group derivation process as a past observation point group, the observation time t1 as a past observation time t2, and the auxiliary point group PC2 as a past auxiliary point group in the auxiliary storage device 35. The control device 32 acquires this information from the auxiliary storage device 35, and derives the virtual observation point group PCi1 and the virtual auxiliary point group PCi2 in step S15, and derives the obstacle point group PCob including the virtual observation point group PCi1 and the virtual auxiliary point group PCi2. In the situation shown in FIG. 6, since the obstacle point group PCob exists within the search area A2, the determination result in step S2 is positive, and the control device 32 causes the autonomous mobile device 10 to perform avoidance traveling again.
[0063] As shown in Fig. 7, the autonomous vehicle 10 moves by a movement amount δ from the state shown in Fig. 6 during a predetermined update period after starting avoidance traveling, and reaches the state shown in Fig. 7. After that, the control device 32 returns to step S1 again and performs the obstacle point cloud derivation process. As a result, the obstacle point cloud PCob after the update period has elapsed since the previously acquired observation time t1, i.e., the past observation time t2, is derived.
[0064] Here, the virtual observation point cloud PCi1 and the virtual auxiliary point cloud PCi2 are point clouds obtained by moving the previously derived obstacle point cloud PCob by a movement amount δ. Therefore, among the obstacle point cloud PCob, the virtual observation point cloud PCi1 and the virtual auxiliary point cloud PCi2 indicate the position of the obstacle Ob1 that has moved outside the observation area A1 due to the avoidance driving of the autonomous mobile unit 10. Therefore, the control device 32 grasps the position of the obstacle Ob1 that is not observed by the sensor 31, and then causes the autonomous mobile unit 10 to perform the avoidance driving.
[0065] In the situation shown in Fig. 7, the control device 32 performs the obstacle point cloud derivation process again. In the situation shown in Fig. 7, the entire obstacle Ob1 is located outside the observation area A1 due to the previous avoidance driving. Since the obstacle Ob1 is not observed by the sensor 31, there is no observation point cloud PC1 acquired in step S11. Accordingly, the blocked area A11 no longer exists, and therefore there is no auxiliary point cloud PC2 generated in step S3.
[0066] However, the control device 32 derives the virtual observation point cloud PCi1 and virtual auxiliary point cloud PCi2 in the situation shown in Fig. 7 by using the observation point cloud PC1 and virtual observation point cloud PCi1 obtained in the previous obstacle point cloud derivation process as the past observation point clouds, and the auxiliary point cloud PC2 and virtual auxiliary point cloud PCi2 as the past auxiliary point clouds. At this time, the virtual auxiliary point cloud PCi2 included in the observation area A1 is removed. Since the virtual observation point cloud PCi1 and the virtual auxiliary point cloud PCi2 are included in the search area A2, the determination result of step S2 is positive, and the control device 32 causes the autonomous vehicle 10 to perform avoidance driving so as to head toward the driving route R while avoiding the virtual auxiliary point cloud PCi2. Thereafter, the avoidance driving leads from the situation shown in Fig. 7 to the situation shown in Fig. 8.
[0067] In the situation shown in FIG. 8, the control device 32 performs the obstacle point cloud derivation process again. In the situation shown in FIG. 8, the autonomous mobile body 10 returns to the travel route R by the previous avoidance travel, and the entire obstacle Ob1 is located outside the observation area A1. At this time, the obstacle Ob1 is not observed by the sensor 31, so the observation point cloud PC1 acquired in step S11 does not exist. Accordingly, the shielded area A11 does not exist, so the auxiliary point cloud PC2 generated in step S3 does not exist. In addition, a part of the obstacle Ob1 is located outside the search area A2. Accordingly, a part of the derived virtual observation point cloud PCi1 and virtual auxiliary point cloud PCi2 is located outside the search area A2. Therefore, the virtual observation point cloud PCi1 and virtual auxiliary point cloud PCi2 located outside the search area A2 are removed by the process of step S18.
[0068] When the virtual observation point group PCi1 or the virtual auxiliary point group PCi2 is present within the search area A2, the control device 32 performs avoidance driving so as to avoid the obstacle point group PCob including the virtual auxiliary point group PCi2, while driving on the driving route R. After that, when the virtual observation point group PCi1 and the virtual auxiliary point group PCi2 are located outside the search area A2, all of the obstacle point group PCob is removed from the search area A2 by the processing of step S18. As a result, the determination result in step S2 becomes negative, and the control device 32 causes the autonomous vehicle 10 to perform normal driving.
[0069] <Effects> According to the above embodiment, the following effects are achieved. (1) Based on the obstacle point cloud PCob derived in the obstacle point cloud derivation process in step S1, the control device 32 causes the autonomous mobile device 10 to avoid the obstacle Ob1 indicated by the obstacle point cloud PCob.
[0070] The obstacle point cloud PCob includes an observation point cloud PC1 indicating the position of an obstacle Ob1 within the observation area A1, and a virtual observation point cloud PCi1 indicating the position of an obstacle Ob1 that was previously observed by the sensor 31 but is now located outside the observation area A1 due to the movement of the autonomous vehicle 10.
[0071] In the obstacle point cloud derivation process of step S1, the control device 32 executes the following processes: step S11 to acquire an observation point cloud PC1 based on the observation results of the sensor 31; step S14 to acquire the movement amount δ of the autonomous vehicle 10 from the acquisition of the past observation point cloud to the acquisition of the observation point cloud PC1 in step S11; and step S15 to derive a virtual observation point cloud PCi1 by moving the past observation point cloud by the movement amount δ.
[0072] According to this, the virtual observation point group PCi1 is obtained by moving the observation point group PC1 observed in the past by the movement amount δ of the autonomous mobile unit 10. The virtual observation point group PCi1 indicates where the obstacle Ob1 indicated by the observation point group PC1 observed in the past is located at the time when the observation point group PC1 is acquired by the control device 32. The control device 32 causes the autonomous mobile unit 10 to perform avoidance taking into account not only the observation point group PC1 indicating the position of the obstacle Ob1 within the observation area A1 of the sensor 31, but also the virtual observation point group PCi1. As a result, by using the control device 32, the autonomous mobile unit 10 can avoid the obstacle Ob1 by taking into account the obstacle Ob1 observed in the past even if the obstacle Ob1 is located outside the observation area A1 of the sensor 31. Therefore, the autonomous mobile unit 10 can improve the obstacle Ob1 avoidance performance.
[0073] (2) In the obstacle point cloud derivation process, the control device 32 executes a process of step S12 of generating an auxiliary point cloud PC2 within a blocked area A11 blocked by an obstacle Ob1 within the observation area A1 based on the observation point cloud PC1 acquired in step S11, and a process of step S15 of deriving a virtual auxiliary point cloud PCi2 located outside the observation area A1 by moving a previous auxiliary point cloud, which is the auxiliary point cloud PC2 generated in the past, by a movement amount δ. The obstacle point cloud PCob includes the auxiliary point cloud PC2 and the virtual auxiliary point cloud PCi2.
[0074] When the observation by the sensor 31 is blocked by the obstacle Ob1, it becomes difficult for the sensor 31 to observe the area of the autonomous mobile device 10 behind the obstacle Ob1. Therefore, according to the present configuration, the auxiliary point group PC2 is generated in such a shielded region A11. When the previously generated auxiliary point group PC2 moves outside the observation region A1 of the sensor 31 due to the movement of the autonomous mobile unit 10, the auxiliary point group PC2 is moved by the movement amount δ of the autonomous mobile unit 10 to derive the virtual auxiliary point group PCi2. The virtual auxiliary point group PCi2 derived in this manner indicates an area that was in the observation region A1 of the sensor 31 but could not be observed by the sensor 31 due to the obstacle Ob1. Since the obstacle point group PCob includes the virtual auxiliary point group PCi2, the autonomous mobile unit 10 can avoid the area represented by the virtual auxiliary point group PCi2 when avoiding the obstacle. The obstacle Ob1 can be avoided while avoiding the area that could not be observed by the sensor 31 due to the obstacle Ob1. Therefore, the possibility that the autonomous mobile unit 10 comes into contact with an object in the area shielded by the obstacle Ob1 can be suppressed.
[0075] (3) When an obstacle Ob1 exists within the observation area A1, the observation area A1 is composed of a blocked area A11 and an observable area A12 other than the blocked area A11. In the obstacle point cloud derivation process of step S1, the control device 32 executes the process of step S16 to remove, from the obstacle point cloud PCob, those of the auxiliary point cloud PC2 and the virtual auxiliary point cloud PCi2 that are included within the observable area A12.
[0076] According to this, the observable area A12 indicates the observation area A1 observed by the sensor 31 without being blocked by the obstacle Ob1. Therefore, by removing from the obstacle point cloud PCob those of the auxiliary point cloud PC2 and the virtual auxiliary point cloud PCi2 that are included in the observable area A12, if it is confirmed that the obstacle Ob1 is not present in the area where it was once determined that the obstacle Ob1 may exist, the autonomous mobile body 10 can travel through the area and avoid the obstacle Ob1. Therefore, the route when avoiding the obstacle Ob1 can be shortened.
[0077] (4) The control device 32 executes the process of step S3 to cause the autonomous mobile body 10 to avoid the obstacle Ob1 indicated by the obstacle point cloud PCob included in the search area A2 that includes at least a portion of the autonomous mobile body 10.
[0078] This makes it possible to prevent the autonomous mobile device 10 from accidentally trying to avoid an obstacle Ob1 that is so far away that there is no need to avoid it. <Modification> The embodiment can be modified as follows: The embodiment and the following modified examples can be combined with each other to the extent that there is no technical contradiction.
[0079] The search area A2 can be set arbitrarily, and the shape of the search area A2 can be any closed area, such as a polygon such as a rectangle or a trapezoid, a circle, a semicircle, or the like. The control device 32 may cause the autonomous vehicle 10 to perform avoidance driving even when an obstacle point cloud PCob exists outside the search area A2. Accordingly, the control device 32 may omit the process of step S18 for removing each point cloud PC1, PCi1, PC2, and PCi2 outside the search area A2. In this case, the search area A2 does not need to be set.
[0080] The control device 32 may acquire a portion of the past observation point group in step S13. The interval between the past observation points constituting the acquired past observation point group is, for example, less than the travelable width of the autonomous mobile body 10.
[0081] In step S15, control device 32 may derive virtual observation point group PCi1 by moving some of the past observation point group acquired in step S13 by a movement amount δ. In this case, the interval between virtual observation points Pi1 that make up virtual observation point group PCi1 may be less than the drivable width.
[0082] This makes it possible to reduce the processing load on the control device 32 by reducing the number of virtual observation points Pi1 included in the derived virtual observation point group PCi1. Similarly, the control device 32 may acquire a portion of the past auxiliary point cloud in step S13. The interval between the past auxiliary points constituting the acquired past auxiliary point cloud is less than the travelable width of the autonomous mobile body 10.
[0083] When deriving the virtual observation point cloud PCi1 in step S15, the control device 32 may use all of the past observation point clouds, not just a part of them. Similarly, when deriving the virtual auxiliary point cloud PCi2 in step S15, the control device 32 may use all of the past auxiliary point clouds, not just a part of them. The control device 32 determines the spacing between the virtual observation points Pi1 in the virtual observation point cloud PCi1 derived in step S15 as arbitrary.
[0084] The control device 32 may omit the process of step S15 of removing the auxiliary point group PC2 and the virtual auxiliary point group PCi2 within the observable area A12. The control device 32 may omit the process of step S13 for generating the auxiliary point group PC2 within the masked area A11.
[0085] The obstacle point cloud PCob may include the observation point cloud PC1 and the virtual observation point cloud PCi1. The specific form of the sensor 31 is arbitrary as long as it can measure the relative coordinates of the obstacle Ob1 with respect to the autonomous vehicle 10. For example, a plurality of ultrasonic sensors may be used as the sensor 31. The ultrasonic sensors can measure distance by emitting ultrasonic waves. The ultrasonic sensors are mounted on the vehicle body 21 at intervals. The control device 32 can obtain the distance and angle of the obstacle Ob1, i.e., the relative coordinates of the obstacle Ob1, based on the intensity of the reflected waves observed by each ultrasonic sensor. As another example, the sensor 31 may be one capable of observing the distance and angle to an object, such as a LIDAR (Laser Imaging Detection and Ranging), a laser range finder, a ToF (Time of Flight) camera, or the like.
[0086] The method of acquiring the observation point cloud PC1 in step S11 is arbitrary. For example, the control device 32 may acquire the observation point cloud by converting the point cloud obtained by the sensor 31 using a LIDAR into an appropriate coordinate system.
[0087] The vehicle center position P and the sensor position Ps may coincide with each other. The autonomous vehicle 10 may be implemented in any desired manner. For example, any wheels may be used as the wheels 22, not limited to omnidirectional wheels. The number of wheels 22 is not limited to four, and may be any number. [Explanation of symbols]
[0088] 10...autonomous vehicle, 31...sensor, 32...control device, A1...observation area, A11...obstructed area, A12...observable area, A2...search area, Ob1...obstacle, PC1...observation point cloud, PC2...auxiliary point cloud, PCi1...virtual observation point cloud, PCi2...virtual auxiliary point cloud, PCob...obstacle point cloud, δ...movement amount.
Claims
1. An obstacle avoidance device for causing an autonomous vehicle to avoid an obstacle observed by a sensor provided in the autonomous vehicle, an obstacle point cloud derivation unit that derives an obstacle point cloud that indicates the position of the obstacle relative to the autonomous vehicle based on the observation results of the sensor; an avoidance unit that causes the autonomous vehicle to avoid the obstacles indicated by the obstacle point cloud when the obstacle point cloud is present; The obstacle point cloud is A group of observation points indicating the positions of the obstacles within an observation area of the sensor; a virtual observation point cloud indicating the positions of the obstacles that were observed by the sensor in the past and that have come to be located outside the observation area of the sensor due to the movement of the autonomous vehicle; The obstacle point cloud derivation unit is an observation point cloud acquisition unit that acquires the observation point cloud based on the observation results of the sensor; a movement amount acquisition unit that acquires a movement amount of the autonomous vehicle from the acquisition of the past observation point group to the acquisition of the observation point group by the observation point group acquisition unit, where the observation point group acquired earlier than the observation point group acquired by the observation point group acquisition unit is a past observation point group; a virtual observation point cloud derivation unit that derives the virtual observation point cloud by moving the past observation point cloud by the movement amount; an auxiliary point cloud generation unit that generates an auxiliary point cloud within a blocked area that is blocked by the obstacle, of the observation area, based on the observation point cloud acquired by the observation point cloud acquisition unit; a virtual auxiliary point cloud derivation unit that derives a virtual auxiliary point cloud located outside an observation area of the sensor by moving the previously generated auxiliary point cloud by the movement amount, the obstacle point cloud includes the auxiliary point cloud and the virtual auxiliary point cloud; When the obstacle is present within the observation area, the observation area is configured with the blocked area and an observable area other than the blocked area, The obstacle point cloud derivation unit is an auxiliary point cloud removal unit that removes, from the obstacle point cloud, those of the auxiliary point cloud and the virtual auxiliary point cloud that are included in the observable area.
2. The obstacle avoidance device according to claim 1 , wherein the avoidance unit causes the autonomous vehicle to avoid the obstacle indicated by the obstacle point cloud that is included in a search area that includes at least a portion of the autonomous vehicle.
3. the virtual observation point cloud derivation unit derives the virtual observation point cloud by moving a portion of the past observation point cloud by the movement amount; 3. The obstacle avoidance device according to claim 1, wherein the distance between the virtual observation points constituting the derived virtual observation point group is less than a travelable width within which the autonomous vehicle can travel.
Citation Information
Patent Citations
Movable region extraction device and movable region extraction method
JP2011253377A
Robot system and map update method
JP2014089740A
Mounting determination method, mounting method, mounting determination device, and robot
JP2015123534A
Display processing device
JP2019087980A
Autonomous travel body
JP2020140477A
