JP7342697B2 - route generation device - Google Patents

route generation device Download PDF

Info

Publication number
JP7342697B2
JP7342697B2 JP2019237004A JP2019237004A JP7342697B2 JP 7342697 B2 JP7342697 B2 JP 7342697B2 JP 2019237004 A JP2019237004 A JP 2019237004A JP 2019237004 A JP2019237004 A JP 2019237004A JP 7342697 B2 JP7342697 B2 JP 7342697B2
Authority
JP
Japan
Prior art keywords
grid
information
grids
grid map
area
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2019237004A
Other languages
Japanese (ja)
Other versions
JP2021105854A (en
Inventor
翔 中田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Toyota Industries Corp
Original Assignee
Toyota Industries Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Toyota Industries Corp filed Critical Toyota Industries Corp
Priority to JP2019237004A priority Critical patent/JP7342697B2/en
Publication of JP2021105854A publication Critical patent/JP2021105854A/en
Application granted granted Critical
Publication of JP7342697B2 publication Critical patent/JP7342697B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Description

本発明は、経路生成装置に関する。 The present invention relates to a route generation device.

従来、特許文献1に記載される経路生成装置が知られている。
経路生成装置は、グリッドマップを縮小した縮小マップを生成するマップ縮小部と、縮小マップに基づき移動体の概略経路を生成する概略経路生成部と、概略経路に基づき詳細経路を生成する移動体の詳細経路を生成する詳細経路生成部とを有する経路生成部を含んでいる。
Conventionally, a route generation device described in Patent Document 1 has been known.
The route generation device includes a map reduction unit that generates a reduced map by reducing the grid map, a general route generation unit that generates a rough route for a moving object based on the reduced map, and a detailed route for a moving object that generates a detailed route based on the rough route. The route generating section includes a detailed route generating section that generates a detailed route.

マップ縮小部は、グリッドマップの複数のグリッドをグルーピングして、該グルーピングされた複数のグリッドを平均することにより縮小マップを生成している。マップ縮小部は、複数のグリッドの平均値が臨界値以上である場合、障害物があることを示す情報である「1」を平均化されたグリッドに設定し、複数のグリッドの平均値が臨界値未満である場合、障害物がないことを示す情報である「0」を平均化されたグリッドに設定する。 The map reduction unit generates a reduced map by grouping a plurality of grids of the grid map and averaging the grouped plurality of grids. If the average value of multiple grids is equal to or greater than a critical value, the map reduction unit sets "1", which is information indicating that there is an obstacle, to the averaged grid, and if the average value of multiple grids is equal to or higher than the critical value, If it is less than the value, "0", which is information indicating that there is no obstacle, is set in the averaged grid.

特開2010-190897号公報Japanese Patent Application Publication No. 2010-190897

ところで、複数のグリッドの平均値が臨界値未満である場合に障害物がないことを示す情報が平均化されたグリッドに設定されていると、平均化されたグリッドに対応する現実の位置には、移動体が移動できないように配置された障害物が存在する虞がある。そのため、移動体が経路生成装置により生成された経路を移動しているときに移動体が立ち往生してしまうことがある。 By the way, if information indicating that there are no obstacles when the average value of multiple grids is less than a critical value is set in the averaged grid, the actual position corresponding to the averaged grid will be , there is a possibility that there are obstacles placed to prevent the moving object from moving. Therefore, while the moving object is moving along the route generated by the route generation device, the moving object may become stuck.

本発明は、このような従来の技術に存在する問題点に着目してなされたものであり、その目的は、移動体が円滑に移動できる経路を生成できる経路生成装置を提供することにある。 The present invention has been made by paying attention to the problems existing in the conventional technology, and an object of the present invention is to provide a route generation device that can generate a route on which a mobile object can move smoothly.

上記課題を解決する経路生成装置は、グリッドマップに基づき移動体の概略経路を生成し、前記概略経路に基づき前記移動体の詳細経路を生成する経路生成装置であって、前記経路生成装置は、前記グリッドマップに設定された前記移動体が移動できる最小の幅となるグリッド数である移動体グリッド数に応じて前記グリッドマップの解像度を下げた低解像度グリッドマップを生成する第1処理と、前記低解像度グリッドマップのグリッドのうち障害物が設定されているグリッドに障害物があることを示す情報である第1情報を設定する第2処理と、前記低解像度グリッドマップにおいて、前記第1情報が設定されていないグリッドと、当該第1情報が設定されていないグリッドを挟み込む前記第1情報が設定された少なくとも2つのグリッドにより形成される領域のうち最も小さい範囲を前記低解像度グリッドマップの第1領域と設定するとともに、前記第1領域に対応する位置を前記グリッドマップの解像度で表現したものを前記グリッドマップの第2領域と設定し、前記グリッドマップの前記第2領域において、前記第1情報が設定された一方のグリッドに対応する位置に存在する障害物が設定されている第1障害物グリッドと、前記第1情報が設定された他方のグリッドに対応する位置に存在する障害物が設定されているグリッドであって前記第1領域の前記第1情報が設定されていないグリッドに対応する位置に存在するグリッドを挟み込んで前記第1障害物グリッドに対向する第2障害物グリッドと、の間のグリッド数を求め、当該求められたグリッド数が前記移動体グリッド数を下回ることがあった場合、前記第1領域の前記第1情報が設定されていないグリッドに前記移動体が移動できないことを示す第2情報を設定し、前記低解像度グリッドマップにおいて前記第1情報及び前記第2情報が設定されていないグリッドにより形成されるとともに前記移動体が移動できる領域である移動領域と、前記第1情報が設定されたグリッド及び前記第2情報が設定されたグリッドにより形成されるとともに前記移動体が移動できない領域である非移動領域と、を区別する第3処理と、前記移動領域において、前記移動体が移動を開始する開始点と、前記移動体の移動の目標点との間で前記概略経路を生成する第4処理と、を実施する。 A route generation device that solves the above problems is a route generation device that generates a rough route for a mobile body based on a grid map, and generates a detailed route for the mobile body based on the rough route, the route generation device including: a first process of generating a low-resolution grid map in which the resolution of the grid map is lowered in accordance with the number of grids of the moving object, which is the number of grids that is the minimum width in which the moving object can move, which is set in the grid map; a second process of setting first information that is information indicating that an obstacle is present in a grid in which an obstacle is set among the grids of the low-resolution grid map; and in the low-resolution grid map, the first information is The smallest range of the area formed by a grid that has not been set and at least two grids that are set with the first information that sandwich the grid that is not set with the first information is set as the first grid of the low-resolution grid map. 1 area, and a position corresponding to the first area expressed at the resolution of the grid map is set as a second area of the grid map, and in the second area of the grid map, An obstacle exists at a position corresponding to the first grid where the first information is set and an obstacle exists at a position corresponding to the other grid where the first information is set. a second obstacle that faces the first obstacle grid with a grid located at a position corresponding to a grid where an obstacle is set and where the first information of the first area is not set; The number of grids between the grids is calculated, and if the calculated number of grids is less than the number of moving body grids, the movement is performed to a grid where the first information of the first area is not set. A movement area that is formed by a grid in which second information indicating that the body cannot move, and in which the first information and the second information are not set in the low-resolution grid map, and in which the moving body can move. a third process for distinguishing between an area and a non-moving area that is formed by a grid in which the first information is set and a grid in which the second information is set and is an area in which the moving body cannot move; A fourth process of generating the approximate route between a starting point where the moving body starts moving and a target point of movement of the moving body is performed in the movement area.

これによれば、低解像度グリッドマップのグリッドにおいて障害物が設定されているグリッドには、障害物があることを示す第1情報が設定され、低解像度グリッドマップにおいて移動体が移動できないグリッドには、第2情報を設定している。そのため、概略経路を生成するときに移動体が移動できない経路を表現することができる。そして、低解像度グリッドマップにおいて、第1情報及び第2情報が設定されていないグリッドにより移動体が移動できる移動領域が明確になる。すなわち、生成した概略経路上に移動体の移動を妨げる要因がなくなる。当該概略経路に基づき詳細経路を生成するため、移動体が円滑に移動できる経路を生成できる。 According to this, the first information indicating that there is an obstacle is set in the grid in the low-resolution grid map where an obstacle is set, and in the grid in which the moving object cannot move in the low-resolution grid map, the first information is set in the grid in which the obstacle is set. , the second information is set. Therefore, when generating a rough route, it is possible to express a route on which the mobile object cannot travel. Then, in the low-resolution grid map, the movement area in which the mobile object can move becomes clear by the grid in which the first information and the second information are not set. That is, there are no factors on the generated rough route that impede the movement of the mobile object. Since the detailed route is generated based on the general route, it is possible to generate a route on which the mobile object can move smoothly.

上記の経路生成装置において、前記移動体グリッド数が偶数である場合、前記低解像度グリッドマップのグリッドは、前記移動体グリッド数を「2」で除した数の前記グリッドマップにおけるグリッドを縦横に有しているとよい。 In the above route generation device, when the number of mobile object grids is an even number, the grid of the low resolution grid map has a number of grids in the grid map vertically and horizontally equal to the number of mobile object grids divided by "2". It's good if you do.

上記の経路生成装置において、前記移動体グリッド数が奇数である場合、前記低解像度グリッドマップのグリッドは、前記移動体グリッド数に「1」を加算した数を「2」で除した数の前記グリッドマップにおけるグリッドを縦横に有しているとよい。 In the above route generation device, when the number of mobile object grids is an odd number, the grids of the low-resolution grid map are divided by the number obtained by adding "1" to the number of mobile object grids by "2". It is preferable to have grids in the grid map vertically and horizontally.

これらによれば、第3処理において、低解像度グリッドマップの第1領域は、最も小さい範囲で2つの第1情報が設定されたグリッドと、1つの第1情報が設定されていないグリッドとにより形成される。そのため、グリッドマップにおいて第1領域の最も小さい範囲に対応する位置を第2領域とすれば、グリッドマップ上では複数の第2領域が形成される。経路生成装置は、複数の第2領域それぞれに対して第2領域に存在する障害物間のグリッド数が移動体グリッド数よりも下回るか否かを判断する。これは、経路生成装置がグリッドマップ全域において障害物間のグリッド数が移動体グリッド数を下回るか否かを一括で判断する場合と比較して、移動体が移動できるか否かを判断するために使用するグリッド数が少ないため、経路生成装置の処理容量が少なくなる。よって、経路生成装置の演算負荷をより低減させることができる。 According to these, in the third process, the first area of the low-resolution grid map is formed by two grids in which two pieces of first information are set in the smallest range and one grid in which no first information is set. be done. Therefore, if the position corresponding to the smallest range of the first area on the grid map is defined as the second area, a plurality of second areas will be formed on the grid map. The route generation device determines, for each of the plurality of second regions, whether the number of grids between obstacles existing in the second region is less than the number of mobile object grids. This is because the route generation device determines whether or not the mobile object can move, compared to the case where the route generation device determines all at once whether the number of grids between obstacles is less than the number of mobile object grids in the entire grid map. Since the number of grids used is small, the processing capacity of the route generation device is reduced. Therefore, the calculation load on the route generation device can be further reduced.

この発明によれば、移動体が円滑に移動できる経路を生成できる。 According to this invention, it is possible to generate a route along which a moving object can move smoothly.

自律走行車を示す概略図。Schematic diagram showing an autonomous vehicle. 経路生成装置の処理フロー図。FIG. 3 is a processing flow diagram of the route generation device. 経路生成装置で用いられるグリッドマップを示した概略図。The schematic diagram showing the grid map used by a route generation device. 経路生成装置の第1処理を示した概略図。The schematic diagram showing the 1st processing of a route generation device. 経路生成装置の第2処理を示した概略図。FIG. 6 is a schematic diagram showing second processing of the route generation device. 経路生成装置の第3処理を示した概略図。FIG. 7 is a schematic diagram showing a third process of the route generation device. 経路生成装置の第3処理を示した概略図。FIG. 7 is a schematic diagram showing a third process of the route generation device. 経路生成装置の第4処理を示した概略図。FIG. 7 is a schematic diagram showing a fourth process of the route generation device. 経路生成装置の詳細経路生成処理を示した概略図。FIG. 3 is a schematic diagram showing detailed route generation processing by the route generation device. 経路生成装置の詳細経路生成処理を示した概略図。FIG. 3 is a schematic diagram showing detailed route generation processing by the route generation device. 経路生成装置の詳細経路生成処理を示した概略図。FIG. 3 is a schematic diagram showing detailed route generation processing by the route generation device. 経路生成装置の詳細経路生成処理を示した概略図。FIG. 3 is a schematic diagram showing detailed route generation processing by the route generation device. 経路生成装置の詳細経路生成処理を示した概略図。FIG. 3 is a schematic diagram showing detailed route generation processing by the route generation device.

以下、経路生成装置を具体化した一実施形態を図1~図13にしたがって説明する。なお、本実施形態の経路生成装置は、荷を搬送する搬送台車等の自律走行車に適用されている。そのため、自律走行車についての説明の中で経路生成装置について説明する。 An embodiment of a route generation device will be described below with reference to FIGS. 1 to 13. Note that the route generation device of this embodiment is applied to an autonomous vehicle such as a transport vehicle that transports a load. Therefore, the route generation device will be explained in the explanation about the autonomous vehicle.

図1に示すように、自律走行車1は、経路生成装置10と、移動体として車体20とを備えている。経路生成装置10は、車体20に搭載された制御装置である。経路生成装置10は、CPU11と、RAM及びROM等からなるメモリ12とを有している。メモリ12には、車体20を制御するための種々のプログラムが記憶されている。経路生成装置10は、メモリ12に記憶されているプログラムをCPUに実行させることにより車体20を制御する。 As shown in FIG. 1, the autonomous vehicle 1 includes a route generation device 10 and a vehicle body 20 as a moving object. The route generation device 10 is a control device mounted on the vehicle body 20. The route generation device 10 includes a CPU 11 and a memory 12 including a RAM, a ROM, and the like. The memory 12 stores various programs for controlling the vehicle body 20. The route generation device 10 controls the vehicle body 20 by causing the CPU to execute a program stored in the memory 12.

経路生成装置10は、地図情報と車体20の位置とに基づき車体20を移動させる機能を有している。地図情報は、メモリ12に記憶されている。地図情報は、例えば約500メートル四方で囲まれる広範囲における障害物の情報、車体20が移動できる走行可能路の情報、及び車体20が移動できない走行不能路の情報が含まれた情報である。経路生成装置10は、車体20の位置をGPSにより検出してもよいが、距離センサ等の車体20に搭載されるセンサを用いて車体20の周囲の物体を検出して地図情報と比較して推定してもよい。経路生成装置10は、検出された車体20の位置を開始点Sとして、車体20の移動の目標点Gに向かうための経路を生成し、当該経路に沿って車体20を移動させる。 The route generation device 10 has a function of moving the vehicle body 20 based on map information and the position of the vehicle body 20. Map information is stored in memory 12. The map information includes, for example, information on obstacles in a wide area surrounded by approximately 500 meters on all sides, information on drivable roads on which the vehicle body 20 can travel, and information on impassable roads on which the vehicle body 20 cannot travel. The route generation device 10 may detect the position of the vehicle body 20 using GPS, but may detect objects around the vehicle body 20 using a sensor mounted on the vehicle body 20 such as a distance sensor, and compare the detected objects with map information. It may be estimated. The route generating device 10 generates a route for moving the vehicle body 20 toward a target point G using the detected position of the vehicle body 20 as a starting point S, and moves the vehicle body 20 along the route.

図2に示すように、経路生成装置10は、車体20が走行するための経路を生成するにあたり、第1処理S101、第2処理S102、第3処理S103、第4処理S104、及び第5処理S105を実施する。各処理S101,S102,S103,S104は、車体20の概略経路Roを生成するまでの処理である概略経路生成処理である。第5処理S105は、概略経路Roに基づき車体20の詳細経路Rdを生成する処理である。 As shown in FIG. 2, the route generation device 10 performs a first process S101, a second process S102, a third process S103, a fourth process S104, and a fifth process when generating a route for the vehicle body 20 to travel. Execute S105. Each process S101, S102, S103, and S104 is a rough route generation process that is a process up to generating the rough route Ro for the vehicle body 20. The fifth process S105 is a process of generating a detailed route Rd for the vehicle body 20 based on the rough route Ro.

図3に示すように、経路生成装置10は、概略経路生成処理と、詳細経路生成処理とを実施するにあたり、グリッドマップM1を使用する。グリッドマップM1とは、メモリ12に記憶された地図情報を等間隔の縦横線で格子状に区切られたグリッドに分割して表現したマップである。なお、グリッドマップM1の外枠部分は、自律走行車1が適用される工場等の壁部を示している。そのため、本実施形態では、グリッドマップM1の外枠部分には、障害物があるものとして取り扱う。 As shown in FIG. 3, the route generation device 10 uses a grid map M1 when performing the general route generation process and the detailed route generation process. The grid map M1 is a map expressed by dividing the map information stored in the memory 12 into a grid divided into grids with equally spaced vertical and horizontal lines. Note that the outer frame portion of the grid map M1 indicates a wall of a factory or the like to which the autonomous vehicle 1 is applied. Therefore, in this embodiment, it is assumed that there is an obstacle in the outer frame portion of the grid map M1.

各処理S101,S102,S103,S104について図3~図8にしたがって説明する。なお、図4,5,7,8には、後述する低解像度グリッドマップM2を示しているが、説明の便宜上、グリッドマップM1のグリッドも記載している。 Each process S101, S102, S103, and S104 will be explained according to FIGS. 3 to 8. Note that although FIGS. 4, 5, 7, and 8 show a low-resolution grid map M2, which will be described later, for convenience of explanation, the grid of the grid map M1 is also shown.

図4に示すように、第1処理S101は、グリッドマップM1から低解像度グリッドマップM2を生成する処理である。
図3に示すように、経路生成装置10は、低解像度グリッドマップM2を生成するにあたり、車体20をグリッドマップM1に設定したときに車体20の幅に対応するグリッド数を確認する。本実施形態では、例えば車体20の幅に対応するグリッド数を「6」とする。経路生成装置10は、障害物Ob間を車体20が安全に移動できるときの車体20と障害物Obとの隙間等を考慮して、グリッドマップM1に設定された車体20が移動できる最小の幅となるグリッド数である移動体グリッド数Nを確認する。本実施形態における移動体グリッド数Nは、「8」である。移動体グリッド数Nは、グリッドマップM1に車体20を設定したときの車体20の幅に対応するグリッド数よりも大きく設定される。なお、障害物Ob間を車体20が安全に移動できるときの車体20と障害物Obとの間の隙間の大きさは、車体20の種類や経路生成装置10を採用する顧客によって適宜変更される。そのため、グリッドマップM1に車体20を設定したときの車体20の幅に対応するグリッド数から移動体グリッド数Nへの増加量は、適宜変更される。
As shown in FIG. 4, the first process S101 is a process of generating a low resolution grid map M2 from the grid map M1.
As shown in FIG. 3, when generating the low-resolution grid map M2, the route generation device 10 checks the number of grids corresponding to the width of the vehicle body 20 when the vehicle body 20 is set in the grid map M1. In this embodiment, for example, the number of grids corresponding to the width of the vehicle body 20 is set to "6". The route generation device 10 calculates the minimum width in which the vehicle body 20 can move, which is set in the grid map M1, in consideration of the gap between the vehicle body 20 and the obstacle Ob when the vehicle body 20 can safely move between the obstacles Ob. Check the mobile object grid number N, which is the grid number. The number N of moving object grids in this embodiment is "8". The mobile object grid number N is set to be larger than the grid number corresponding to the width of the vehicle body 20 when the vehicle body 20 is set in the grid map M1. Note that the size of the gap between the vehicle body 20 and the obstacle Ob when the vehicle body 20 can safely move between the obstacles Ob is changed as appropriate depending on the type of the vehicle body 20 and the customer who employs the route generation device 10. . Therefore, the amount of increase from the number of grids corresponding to the width of the vehicle body 20 when the vehicle body 20 is set in the grid map M1 to the number N of grids of the mobile object is changed as appropriate.

図4に示すように、経路生成装置10は、グリッドマップM1における移動体グリッド数Nに応じてグリッドマップM1の解像度を下げた低解像度グリッドマップM2を生成する。低解像度グリッドマップM2は、移動体グリッド数Nが「8」であるため、移動体グリッド数Nを「2」で除した数のグリッドマップM1におけるグリッドを縦横に有するグリッドを有している。図4では、黒色中太の線で区切られたグリッドが、低解像度グリッドマップM2のグリッドである。 As shown in FIG. 4, the route generation device 10 generates a low-resolution grid map M2 by lowering the resolution of the grid map M1 according to the number N of moving object grids in the grid map M1. Since the number N of moving object grids is "8", the low-resolution grid map M2 has a grid having the number of grids in the grid map M1, which is the number N of moving object grids divided by "2", vertically and horizontally. In FIG. 4, the grids separated by thick black lines are the grids of the low-resolution grid map M2.

ここで、概略経路生成処理において低解像度グリッドマップM2を使用する理由を説明する。
地図情報のサイズが大きいほどグリッドマップM1に地図情報を設定するために使用するメモリ12の容量が多くなる。上記の地図情報は、500メートル四方という広範囲の情報であるため、グリッドマップM1のまま車体20の概略経路Roを生成してしまうと、使用するメモリ12の容量が多いため、経路生成装置10の演算負荷が増え、ひいては経路生成装置10の演算速度も遅くなる。すなわち、低解像度グリッドマップM2を使用する理由は、車体20の概略経路Roの生成に使用するメモリ12の容量を少なくするためである。
Here, the reason for using the low resolution grid map M2 in the rough route generation process will be explained.
The larger the size of the map information, the larger the capacity of the memory 12 used to set the map information in the grid map M1. The above map information covers a wide area of 500 meters square, so if the rough route Ro of the vehicle body 20 is generated using the grid map M1, the capacity of the memory 12 to be used is large, so the route generation device 10 The calculation load increases, and the calculation speed of the route generation device 10 also slows down. That is, the reason for using the low-resolution grid map M2 is to reduce the capacity of the memory 12 used to generate the rough route Ro of the vehicle body 20.

移動体グリッド数Nを除する「2」を使用する理由も概略経路Roの生成に使用するメモリ12の容量を少なくするためである。移動体グリッド数Nを除する数値は、グリッドマップM1の解像度を下げるために設定される数値である。グリッドマップM1から低解像度グリッドマップM2を生成するときに解像度をより下げるためには、除する数値を可能な限り小さくすることが好ましい。グリッド数は整数であることを考慮すれば、「2」という数値がグリッドマップM1の解像度を下げるための最大値である。よって、概略経路Roの生成に使用するメモリ12の容量を最も効率的に少なくするために「2」という数値が採用されている。 The reason for using "2" to divide the number N of mobile object grids is to reduce the capacity of the memory 12 used to generate the rough route Ro. The numerical value divided by the number N of mobile object grids is a numerical value set to lower the resolution of the grid map M1. In order to further reduce the resolution when generating the low-resolution grid map M2 from the grid map M1, it is preferable to make the dividing value as small as possible. Considering that the number of grids is an integer, the value "2" is the maximum value for lowering the resolution of the grid map M1. Therefore, the value "2" is adopted in order to most efficiently reduce the capacity of the memory 12 used to generate the rough route Ro.

なお、本実施形態では、移動体グリッド数Nが偶数であるため、低解像度グリッドマップM2のグリッドは、移動体グリッド数Nを「2」で除した数のグリッドマップM1のグリッドを縦横に有していたが、例えば車体20の幅によっては、移動体グリッド数Nが奇数となる場合もある。移動体グリッド数Nが奇数である場合、「2」で除すると整数とならない。そして、グリッド数は一般的に整数であるため、移動体グリッド数Nが奇数である場合、低解像度グリッドマップM2のグリッドは、移動体グリッド数Nに「1」を加算した数を「2」で除した数のグリッドマップM1におけるグリッドを縦横に有するように変更する。 In this embodiment, since the number N of moving object grids is an even number, the grid of the low-resolution grid map M2 has the grids of the grid map M1 in the vertical and horizontal directions equal to the number N of moving object grids divided by "2". However, depending on the width of the vehicle body 20, for example, the number N of moving body grids may be an odd number. If the number N of mobile object grids is an odd number, dividing by "2" will not result in an integer. Since the number of grids is generally an integer, if the number N of mobile object grids is an odd number, the grid of the low resolution grid map M2 is the number of mobile object grids N plus "1". The grid map M1 is changed to have the number of grids divided by the number of grids in the vertical and horizontal directions.

図5に示すように、第2処理S102は、低解像度グリッドマップM2のグリッドのうち障害物Obが設定されているグリッドに障害物Obがあることを示す情報である第1情報I1を設定する処理である。図5では、斜線が設けられている低解像度グリッドマップM2のグリッドに第1情報I1が設定されている。本実施形態では、第1情報I1には「1」という数値が採用されている。すなわち、低解像度グリッドマップM2の1つのグリッドに含まれるグリッドマップM1の複数のグリッドのうち少なくとも1つに障害物Obが設定されている場合、低解像度グリッドマップM2の当該1つのグリッドの全域に障害物Obがあるものとして取り扱う。なお、第1情報I1は、「1」という数値でなくてもよく、例えば「0」という数値でもよい。また、第1情報I1は、数値に限らず文字であってもよい。すなわち、第1情報I1とは、障害物Obがあることを示す情報として低解像度グリッドマップM2のグリッドに設定されるのであれば、設定内容は適宜変更してもよい。 As shown in FIG. 5, the second process S102 sets first information I1 that is information indicating that an obstacle Ob is present in a grid to which an obstacle Ob is set among the grids of the low-resolution grid map M2. It is processing. In FIG. 5, the first information I1 is set in the grid of the low resolution grid map M2 provided with diagonal lines. In this embodiment, the numerical value "1" is adopted as the first information I1. That is, when an obstacle Ob is set in at least one of the plurality of grids of the grid map M1 included in one grid of the low-resolution grid map M2, the obstacle Ob is set in the entire area of the one grid of the low-resolution grid map M2. It is treated as if there is an obstacle Ob. Note that the first information I1 does not have to be a numerical value of "1", and may be, for example, a numerical value of "0". Further, the first information I1 is not limited to numerical values, but may be characters. That is, as long as the first information I1 is set in the grid of the low-resolution grid map M2 as information indicating that there is an obstacle Ob, the setting contents may be changed as appropriate.

次に、第3処理S103について図5~図7にしたがって説明する。第3処理S103は、車体20が移動できる領域である移動領域Maと、車体20が移動できない領域である非移動領域Munとを区別する処理である。 Next, the third process S103 will be explained according to FIGS. 5 to 7. The third process S103 is a process for distinguishing between a moving area Ma, which is an area in which the vehicle body 20 can move, and a non-moving area Mun, which is an area in which the vehicle body 20 cannot move.

図5に示すように、低解像度グリッドマップM2は、第1情報I1が設定されていないグリッド、及び当該第1情報I1が設定されていないグリッドを挟み込む第1情報I1が設定されたグリッドにより形成される第1領域R1を複数有している。本実施形態では、第1領域R1は、低解像度グリッドマップM2において、第1情報I1が設定されていない1つのグリッドと、第1情報I1が設定された2つのグリッドとにより構成されている。すなわち、第1情報I1が設定されていないグリッド、及び当該第1情報I1が設定されていないグリッドを挟み込む第1情報I1が設定されたグリッドにより形成される領域のうち最も小さな範囲を第1領域R1としている。第3処理S103では、第1領域R1において車体20が移動できるだけのグリッド数があるか否かを判断する。具体的には、図6を用いて説明する。 As shown in FIG. 5, the low-resolution grid map M2 is formed by a grid in which the first information I1 is not set, and a grid in which the first information I1 is set, sandwiching the grid in which the first information I1 is not set. It has a plurality of first regions R1. In this embodiment, the first region R1 is configured of one grid in which the first information I1 is not set and two grids in which the first information I1 is set in the low resolution grid map M2. In other words, the smallest range of the area formed by the grid in which the first information I1 is not set and the grid in which the first information I1 is set sandwiching the grid in which the first information I1 is not set is defined as the first area. It is set as R1. In the third process S103, it is determined whether there is a sufficient number of grids for the vehicle body 20 to move in the first region R1. Specifically, this will be explained using FIG. 6.

図6には、複数の第1領域R1のうちの1つを例示している。第3処理S103では、低解像度グリッドマップM2の第1領域R1と、第1領域R1に対応する位置を示すグリッドマップM1の第2領域R2とを比較する。具体的には、低解像度グリッドマップM2の第1領域R1に対応する位置だけをグリッドマップM1の解像度で表現し、障害物Obの配置を詳細に確認する。第3処理S103では、グリッドマップM1の第2領域R2に存在する障害物Ob間のグリッド数が移動体グリッド数Nを下回るか否かを判断する。例えば、図6では、障害物Ob間のグリッド数は、「6」である。そのため、図6に示す第1領域R1では、車体20は移動できないように障害物Obが配置されていることが確認できる。 FIG. 6 illustrates one of the plurality of first regions R1. In the third process S103, the first region R1 of the low-resolution grid map M2 is compared with the second region R2 of the grid map M1 indicating a position corresponding to the first region R1. Specifically, only the position corresponding to the first region R1 of the low-resolution grid map M2 is expressed with the resolution of the grid map M1, and the placement of the obstacle Ob is confirmed in detail. In the third process S103, it is determined whether the number of grids between obstacles Ob existing in the second region R2 of the grid map M1 is less than the number N of moving object grids. For example, in FIG. 6, the number of grids between obstacles Ob is "6". Therefore, in the first region R1 shown in FIG. 6, it can be confirmed that the obstacles Ob are arranged so that the vehicle body 20 cannot move.

図7に示すように、第3処理S103では、グリッドマップM1の第2領域R2に存在する障害物Ob間のグリッド数が移動体グリッド数Nを下回る場合、第1領域R1の第1情報I1が設定されていないグリッドに車体20が移動できないことを示す第2情報I2を設定する。図5と比較して斜線が追加されている低解像度グリッドマップM2のグリッドに第2情報I2が設定されている。本実施形態では、第2情報I2には「0」という数値が採用されている。第3処理S103では、低解像度グリッドマップM2の複数の第1領域R1それぞれに対して上記処理を実施する。これにより、第3処理S103では、低解像度グリッドマップM2において第1情報I1及び第2情報I2が設定されていないグリッドにより形成される移動領域Maと、第1情報I1又は第2情報I2が設定されたグリッドにより形成される非移動領域Munとが区別される。なお、第2情報I2は、「0」という数値でなくてもよく、例えば「1」という数値でもよい。この場合、第1情報I1として「0」を採用するとよい。また、第2情報I2は、数値に限らず文字であってもよい。すなわち、第2情報I2とは、車体20が移動できないことを示す情報として低解像度グリッドマップM2のグリッドに設定されるのであれば、設定内容は適宜変更してもよい。 As shown in FIG. 7, in the third process S103, if the number of grids between obstacles Ob existing in the second region R2 of the grid map M1 is less than the number N of moving object grids, the first information I1 of the first region R1 Second information I2 indicating that the vehicle body 20 cannot move to a grid where is not set is set. The second information I2 is set in the grid of the low-resolution grid map M2, which has diagonal lines added compared to FIG. 5 . In this embodiment, a numerical value of "0" is adopted as the second information I2. In the third process S103, the above process is performed for each of the plurality of first regions R1 of the low resolution grid map M2. As a result, in the third process S103, the movement area Ma formed by the grid in which the first information I1 and the second information I2 are not set in the low resolution grid map M2, and the first information I1 or the second information I2 are set. A non-moving area Mun formed by the grid is distinguished from the non-moving area Mun. Note that the second information I2 does not have to be a numerical value of "0", and may be, for example, a numerical value of "1". In this case, it is preferable to use "0" as the first information I1. Further, the second information I2 is not limited to numerical values, and may be characters. That is, as long as the second information I2 is set in the grid of the low-resolution grid map M2 as information indicating that the vehicle body 20 cannot move, the setting contents may be changed as appropriate.

図8に示すように、第4処理S104では、低解像度グリッドマップM2の移動領域Maにおいて、車体20が移動を開始する開始点Sと、車体20の移動の目標点である目標点Gとの間で概略経路Roを生成する。経路生成装置10は、多様な経路生成方法を採用することができるが、本実施形態では例えばA-Star探索アルゴリズムやダイクストラアルゴリズムを利用して開始点Sから目標点Gまでの最短の概略経路Roを生成している。なお、生成される概略経路Roは、開始点Sから目標点Gまでの最短経路である必要はなく、自律走行車1が経由すべき経由点があれば、移動領域Maにおいて開始点Sから当該経由点を経由して目標点Gに至る概略経路Roを生成してもよい。また、開始点Sから目標点Gまでの概略経路Roを生成するときに使用するアルゴリズムは、適宜変更してもよい。 As shown in FIG. 8, in the fourth process S104, in the movement area Ma of the low resolution grid map M2, a starting point S where the vehicle body 20 starts moving and a target point G which is the target point of the movement of the vehicle body 20 are determined. A rough route Ro is generated between them. The route generation device 10 can employ various route generation methods, but in this embodiment, for example, the A-Star search algorithm or Dijkstra algorithm is used to generate the shortest rough route Ro from the starting point S to the target point G. is being generated. Note that the generated general route Ro does not need to be the shortest route from the starting point S to the target point G, and if there is a via point that the autonomous vehicle 1 should pass through, it can be routed from the starting point S to the relevant point in the movement area Ma. A rough route Ro reaching the target point G via way points may be generated. Further, the algorithm used when generating the rough route Ro from the starting point S to the target point G may be changed as appropriate.

次に、第5処理S105について図9~図13にしたがって説明する。
図9に示すように、第5処理S105では、低解像度グリッドマップM2において、概略経路生成処理において生成された概略経路Roの周辺部分を含む第1分割領域Sd1、第2分割領域Sd2、及び第3分割領域Sd3に分割する。上記の周辺部分とは、概略経路Roに周辺に存在する障害物Obの一部を含む部分を示している。第1分割領域Sd1は、概略経路Roにおける開始点Sを含んでいる。第3分割領域Sd3は、概略経路Roにおける目標点Gを含んでいる。第2分割領域Sd2は、第1分割領域Sd1と第3分割領域Sd3との間の領域である。第2分割領域Sd2は、第1分割領域Sd1及び第3分割領域Sd3と一部オーバーラップするように配置されている。
Next, the fifth process S105 will be explained according to FIGS. 9 to 13.
As shown in FIG. 9, in the fifth process S105, in the low-resolution grid map M2, the first divided area Sd1, the second divided area Sd2, and the second divided area Sd2 including the peripheral portion of the rough route Ro generated in the rough route generation process are Divide into three divided regions Sd3. The above-mentioned peripheral portion refers to a portion including a part of the obstacle Ob existing in the vicinity of the approximate route Ro. The first divided region Sd1 includes a starting point S on the rough route Ro. The third divided region Sd3 includes the target point G on the approximate route Ro. The second divided area Sd2 is an area between the first divided area Sd1 and the third divided area Sd3. The second divided region Sd2 is arranged so as to partially overlap the first divided region Sd1 and the third divided region Sd3.

図10に示すように、第5処理S105では、低解像度グリッドマップM2の第1分割領域Sd1に対応するグリッドマップM1の領域を確認し、車体20が移動するための第1詳細経路Rd1を生成する。 As shown in FIG. 10, in the fifth process S105, an area of the grid map M1 corresponding to the first divided area Sd1 of the low-resolution grid map M2 is confirmed, and a first detailed route Rd1 for moving the vehicle body 20 is generated. do.

図11に示すように、第5処理S105では、低解像度グリッドマップM2の第2分割領域Sd2に対応するグリッドマップM1の領域を確認し、車体20が移動するための第2詳細経路Rd2を生成する。このとき、第2分割領域Sd2には、第1分割領域Sd1における第1詳細経路Rd1の終点が含まれている。第5処理S105では、第1詳細経路Rd1の終点を第2詳細経路Rd2の始点として第2詳細経路Rd2を生成する。 As shown in FIG. 11, in the fifth process S105, an area of the grid map M1 corresponding to the second divided area Sd2 of the low-resolution grid map M2 is confirmed, and a second detailed route Rd2 for moving the vehicle body 20 is generated. do. At this time, the second divided region Sd2 includes the end point of the first detailed route Rd1 in the first divided region Sd1. In the fifth process S105, a second detailed route Rd2 is generated using the end point of the first detailed route Rd1 as the starting point of the second detailed route Rd2.

図12に示すように、第5処理S105では、低解像度グリッドマップM2の第3分割領域Sd3に対応するグリッドマップM1の領域を確認し、車体20が移動するための第3詳細経路Rd3を生成する。第3分割領域Sd3には、第2分割領域Sd2における第2詳細経路Rd2の終点が含まれている。第5処理S105では、第2詳細経路Rd2の終点を第3詳細経路Rd3の始点として第3詳細経路Rd3を生成する。すなわち、図9に示すように、第2分割領域Sd2が第1分割領域Sd1及び第3分割領域Sd3と一部オーバーラップしているのは、各経路Rd1,Rd2,Rd3を連続的に構成するためである。 As shown in FIG. 12, in the fifth process S105, an area of the grid map M1 corresponding to the third divided area Sd3 of the low-resolution grid map M2 is confirmed, and a third detailed route Rd3 for moving the vehicle body 20 is generated. do. The third divided region Sd3 includes the end point of the second detailed route Rd2 in the second divided region Sd2. In the fifth process S105, a third detailed route Rd3 is generated using the end point of the second detailed route Rd2 as the starting point of the third detailed route Rd3. That is, as shown in FIG. 9, the reason why the second divided region Sd2 partially overlaps with the first divided region Sd1 and the third divided region Sd3 is because the routes Rd1, Rd2, and Rd3 are continuously configured. It's for a reason.

図13に示すように、第5処理S105では、各分割領域Sd1,Sd2,Sd3で生成された各経路Rd1,Rd2,Rd3をグリッドマップM1上において連続させることにより詳細経路Rdを生成する。すなわち、経路生成装置10は、グリッドマップM1に基づき車体20の概略経路Roを生成し、概略経路Roに基づき車体20の詳細経路Rdを生成している。なお、本実施形態では、低解像度グリッドマップM2を各分割領域Sd1,Sd2,Sd3に分割していたが、これに限らない。例えば、2分割でもよいし、4分割以上であってもよい。低解像度グリッドマップM2を分割する数が少ないほど、表現するグリッドマップM1のグリッド数が増大するため、各経路Rd1,Rd2,Rd3の生成に使用するメモリ12の容量が多くなる。そのため、経路生成装置10の各経路Rd1,Rd2,Rd3の生成に使用するメモリ12の容量が多くなり、経路生成装置10の演算速度が遅くなってしまう。よって、低解像度グリッドマップM2を分割する数は、経路生成装置10のメモリ12の容量によって適宜変更する。 As shown in FIG. 13, in the fifth process S105, a detailed route Rd is generated by making the routes Rd1, Rd2, and Rd3 generated in each of the divided regions Sd1, Sd2, and Sd3 consecutive on the grid map M1. That is, the route generation device 10 generates a rough route Ro for the vehicle body 20 based on the grid map M1, and generates a detailed route Rd for the vehicle body 20 based on the rough route Ro. Note that in this embodiment, the low-resolution grid map M2 is divided into divided regions Sd1, Sd2, and Sd3, but the present invention is not limited to this. For example, it may be divided into two, or may be divided into four or more. The smaller the number of divisions into which the low-resolution grid map M2 is divided, the greater the number of grids in the grid map M1 to represent, and therefore the capacity of the memory 12 used to generate each route Rd1, Rd2, Rd3 increases. Therefore, the capacity of the memory 12 used to generate each route Rd1, Rd2, and Rd3 of the route generation device 10 increases, and the calculation speed of the route generation device 10 becomes slow. Therefore, the number of divisions into which the low-resolution grid map M2 is divided is changed as appropriate depending on the capacity of the memory 12 of the route generation device 10.

本実施形態の作用を説明する。
低解像度グリッドマップM2のグリッドにおいて障害物Obが設定されているグリッドには、第1情報I1が設定され、低解像度グリッドマップM2において車体20が移動できないグリッドには、第2情報I2を設定している。そのため、概略経路Roを生成するときに車体20が移動できない経路が表現される。そして、低解像度グリッドマップM2において、第1情報I1及び第2情報I2が設定されていないグリッドにより車体20が移動できる移動領域Maが明確になる。すなわち、生成した概略経路Ro上に車体20の移動を妨げる要因がなくなる。
The operation of this embodiment will be explained.
The first information I1 is set in the grid of the low-resolution grid map M2 where the obstacle Ob is set, and the second information I2 is set in the grid in which the vehicle body 20 cannot move in the low-resolution grid map M2. ing. Therefore, when generating the rough route Ro, a route on which the vehicle body 20 cannot move is expressed. Then, in the low-resolution grid map M2, the movement area Ma in which the vehicle body 20 can move becomes clear by the grid in which the first information I1 and the second information I2 are not set. That is, there are no factors that hinder the movement of the vehicle body 20 on the generated rough route Ro.

本実施形態の効果を説明する。
(1)生成した概略経路Ro上に車体20の移動を妨げる要因がなくなり、概略経路Roに基づき詳細経路Rdを生成するため、車体20が円滑に移動できる経路を生成できる。
The effects of this embodiment will be explained.
(1) Since there are no factors that impede the movement of the vehicle body 20 on the generated general route Ro and the detailed route Rd is generated based on the general route Ro, a route on which the vehicle body 20 can move smoothly can be generated.

(2)第3処理S103において、低解像度グリッドマップM2の第1領域R1は、2つの第1情報が設定されたグリッドと、1つの第1情報が設定されていないグリッドとにより形成される。そのため、グリッドマップM1において第1領域R1に対応する位置を第2領域R2とすれば、グリッドマップM1上では複数の第2領域R2が形成される。経路生成装置10は、複数の第2領域R2それぞれに対して第2領域R2に存在する障害物Ob間のグリッド数が移動体グリッド数Nよりも下回るか否かを判断する。これは、経路生成装置10がグリッドマップM1全域において障害物Ob間のグリッド数が移動体グリッド数Nを下回るか否かを一括で判断する場合と比較して、車体20が移動できるか否かを判断するために使用するグリッド数が少ないため、経路生成装置10の処理容量が少なくなる。よって、経路生成装置10の演算負荷をより低減させることができる。 (2) In the third process S103, the first region R1 of the low-resolution grid map M2 is formed by two grids in which first information is set and one grid in which no first information is set. Therefore, if a position corresponding to the first region R1 on the grid map M1 is defined as a second region R2, a plurality of second regions R2 are formed on the grid map M1. The route generation device 10 determines whether or not the number of grids between the obstacles Ob existing in the second region R2 is less than the number N of mobile object grids for each of the plurality of second regions R2. This determines whether the vehicle body 20 can move or not, compared to the case where the route generation device 10 determines all at once whether the number of grids between obstacles Ob is less than the number N of moving object grids in the entire grid map M1. Since the number of grids used to determine the number of grids is small, the processing capacity of the route generation device 10 is reduced. Therefore, the calculation load on the route generation device 10 can be further reduced.

なお、本実施形態は、以下のように変更して実施することができる。本実施形態及び以下の変更例は、技術的に矛盾しない範囲で互いに組み合わせて実施することができる。
○ 低解像度グリッドマップM2において、第1領域R1は、2つの第1情報I1が設定されたグリッドと、複数の第1情報I1が設定されていないグリッドとにより構成されていてもよい。
Note that this embodiment can be implemented with the following modifications. This embodiment and the following modified examples can be implemented in combination with each other within a technically consistent range.
In the low-resolution grid map M2, the first region R1 may include a grid in which two pieces of first information I1 are set and a grid in which a plurality of pieces of first information I1 are not set.

○ グリッドマップM1の外枠部分は、本実施形態では工場等の壁部を示しているため、障害物Obがあるとして取り扱っていたが、これに限らない。グリッドマップM1に基づき車体20が移動する経路を生成するにあたって、グリッドマップM1上に開始点S及び目標点Gがある。そのため、そもそも車体20がグリッドマップM1外に離脱する経路を生成しないことから、グリッドマップM1の外枠部分は車体20が移動できない領域として設定されることも考えられる。すなわち、低解像度グリッドマップM2の外枠部分には、車体20が移動できないことを示す第2情報I2が設定されてもよい。このように変更するとき、低解像度グリッドマップM2において、第1情報I1が設定されていない1つのグリッドと、当該第1情報I1が設定されていないグリッドを挟み込む第1情報I1が設定されたグリッド及び第2情報I2が設定されたグリッドとにより形成される第3領域が形成される。経路生成装置10は、第3領域に対応する位置のグリッドマップM1のグリッド数が移動体グリッド数Nを下回るか否かを判定し、移動体グリッド数Nを下回る場合、第3領域における第1情報I1が設定されていないグリッドに第2情報I2を設定する。よって、低解像度グリッドマップM2において移動領域Maと、非移動領域Munとを区別することができる。 In the present embodiment, the outer frame portion of the grid map M1 represents a wall of a factory or the like, so it is treated as an obstacle Ob, but the present invention is not limited to this. When generating a route along which the vehicle body 20 moves based on the grid map M1, there is a starting point S and a target point G on the grid map M1. Therefore, since a route for the vehicle body 20 to leave the grid map M1 is not generated in the first place, the outer frame portion of the grid map M1 may be set as an area in which the vehicle body 20 cannot move. That is, the second information I2 indicating that the vehicle body 20 cannot be moved may be set in the outer frame portion of the low resolution grid map M2. When changing in this way, in the low-resolution grid map M2, one grid in which the first information I1 is not set and a grid in which the first information I1 is set sandwiching the grid in which the first information I1 is not set. and a grid in which the second information I2 is set. The route generation device 10 determines whether the number of grids in the grid map M1 at the position corresponding to the third area is less than the number N of moving body grids, and if it is less than the number N of moving body grids, the route generation device 10 Second information I2 is set in a grid where information I1 is not set. Therefore, the moving area Ma and the non-moving area Mun can be distinguished in the low resolution grid map M2.

○ 自律走行車1は、搬送台車であったが、これに限らない。例えば、掃除ロボットのような移動ロボットであってもよい。
○ また、経路生成装置10は、自律走行車1に適用されていたが、例えば自動車やフォークリフト等の車両に適用してもよい。また、経路生成装置10が移動体としての車体20が移動する経路を生成したが、例えばコンピュータで生成された空間でのアバターを移動体として、コンピュータで生成された空間でのアバターが移動する経路を生成してもよい。
○ Although the autonomous vehicle 1 is a transport vehicle, it is not limited to this. For example, it may be a mobile robot such as a cleaning robot.
Although the route generation device 10 was applied to the autonomous vehicle 1, it may also be applied to a vehicle such as a car or a forklift. Furthermore, although the route generation device 10 has generated a route along which the vehicle body 20 as a moving body moves, for example, when an avatar in a computer-generated space is used as a moving body, a route along which the avatar moves in a computer-generated space. may be generated.

10…経路生成装置、20…車体、Ro…概略経路、Rd…詳細経路、M1…グリッドマップ、M2…低解像度グリッドマップ、S101…第1処理、S102…第2処理、S103…第3処理、S104…第4処理、I1…第1情報、I2…第2情報、R1…第1領域、R2…第2領域、Ma…移動領域、Mun…非移動領域、S…開始点、G…目標点、Ob…障害物、N…移動体グリッド数。 10... Route generation device, 20... Vehicle body, Ro... General route, Rd... Detailed route, M1... Grid map, M2... Low resolution grid map, S101... First process, S102... Second process, S103... Third process, S104...Fourth process, I1...First information, I2...Second information, R1...First area, R2...Second area, Ma...Movement area, Mun...Non-movement area, S...Start point, G...Target point , Ob...obstacle, N...number of moving object grids.

Claims (3)

グリッドマップに基づき移動体の概略経路を生成し、前記概略経路に基づき前記移動体の詳細経路を生成する経路生成装置であって、
前記経路生成装置は、
前記グリッドマップに設定された前記移動体が通過できる最小の幅となるグリッド数である移動体グリッド数に応じて前記グリッドマップの解像度を下げた低解像度グリッドマップを生成する第1処理と、
前記低解像度グリッドマップのグリッドのうち障害物が設定されているグリッドに障害物があることを示す情報である第1情報を設定する第2処理と、
前記第1情報が設定されていないグリッドと、当該第1情報が設定されていないグリッドを挟み込む前記第1情報が設定された少なくとも2つのグリッドにより形成される領域のうち最も小さい範囲を前記低解像度グリッドマップの第1領域と設定するとともに、前記第1領域に対応する位置を前記グリッドマップの解像度で表現したものを前記グリッドマップの第2領域と設定し、前記グリッドマップの前記第2領域において、前記第1情報が設定された一方のグリッドに対応する位置に存在する障害物が設定されている第1障害物グリッドと、前記第1情報が設定された他方のグリッドに対応する位置に存在する障害物が設定されているグリッドであって前記第1領域の前記第1情報が設定されていないグリッドに対応する位置に存在するグリッドを挟み込んで前記第1障害物グリッドに対向する第2障害物グリッドと、の間のグリッド数を求め、当該求められたグリッド数が前記移動体グリッド数を下回ることがあった場合、前記第1領域の前記第1情報が設定されていないグリッドに前記移動体が移動できないことを示す第2情報を設定し、前記低解像度グリッドマップにおいて前記第1情報及び前記第2情報が設定されていないグリッドにより形成されるとともに前記移動体が移動できる領域である移動領域と、前記第1情報が設定されたグリッド及び前記第2情報が設定されたグリッドにより形成されるとともに前記移動体が移動できない領域である非移動領域と、を区別する第3処理と、
前記移動領域において、前記移動体が移動を開始する開始点と、前記移動体の移動の目標点との間で前記概略経路を生成する第4処理と、を実施することを特徴とする経路生成装置。
A route generation device that generates a rough route for a moving body based on a grid map, and generates a detailed route for the mobile body based on the rough route,
The route generation device includes:
a first process of generating a low-resolution grid map in which the resolution of the grid map is lowered in accordance with the number of moving object grids, which is the number of grids with a minimum width through which the moving object can pass, which is set in the grid map;
a second process of setting first information that is information indicating that an obstacle is present in a grid in which an obstacle is set among the grids of the low-resolution grid map;
The smallest range of the area formed by the grid in which the first information is not set and at least two grids in which the first information is set sandwiching the grid in which the first information is not set is determined by the A resolution grid map is set as a first area, and a position corresponding to the first area expressed at the resolution of the grid map is set as a second area of the grid map, and the second area of the grid map is set as a second area of the grid map. In the area, a first obstacle grid in which an obstacle is set that exists at a position corresponding to one grid in which the first information is set corresponds to the other grid in which the first information is set. facing the first obstacle grid with a grid located at a position corresponding to a grid set with an obstacle located at a position where the first information of the first area is not set. the number of grids between the second obstacle grid and the second obstacle grid , and if the calculated number of grids is less than the number of moving object grids, the first information of the first area is set. second information indicating that the mobile object cannot move is set in a grid that does not have the first information and the second information set in the low-resolution grid map, and the mobile object moves while the first information and the second information are not set in the low-resolution grid map. a moving area that is an area in which the moving body can move; and a non-moving area that is an area that is formed by a grid in which the first information is set and a grid in which the second information is set and in which the moving object cannot move. 3 processing and
A fourth process of generating the approximate route between a starting point where the moving body starts moving and a target point of movement of the moving body in the moving area. Device.
前記移動体グリッド数が偶数である場合、前記低解像度グリッドマップのグリッドは、前記移動体グリッド数を「2」で除した数の前記グリッドマップにおけるグリッドを縦横に有していることを特徴とする請求項1に記載の経路生成装置。 When the number of moving object grids is an even number, the grid of the low-resolution grid map has a number of grids in the grid map vertically and horizontally equal to the number of moving object grids divided by "2". The route generation device according to claim 1. 前記移動体グリッド数が奇数である場合、前記低解像度グリッドマップのグリッドは、前記移動体グリッド数に「1」を加算した数を「2」で除した数の前記グリッドマップにおけるグリッドを縦横に有していることを特徴とする請求項1又は請求項2に記載の経路生成装置。 When the number of mobile object grids is an odd number, the grids of the low-resolution grid map are formed by dividing the number of grids in the grid map by adding "1" to the number of mobile object grids by "2" vertically and horizontally. 3. The route generation device according to claim 1, further comprising:
JP2019237004A 2019-12-26 2019-12-26 route generation device Active JP7342697B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2019237004A JP7342697B2 (en) 2019-12-26 2019-12-26 route generation device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2019237004A JP7342697B2 (en) 2019-12-26 2019-12-26 route generation device

Publications (2)

Publication Number Publication Date
JP2021105854A JP2021105854A (en) 2021-07-26
JP7342697B2 true JP7342697B2 (en) 2023-09-12

Family

ID=76919459

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019237004A Active JP7342697B2 (en) 2019-12-26 2019-12-26 route generation device

Country Status (1)

Country Link
JP (1) JP7342697B2 (en)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010190897A (en) 2009-02-18 2010-09-02 Samsung Electronics Co Ltd Route generation device and method utilized grid map
JP2017083919A (en) 2015-10-22 2017-05-18 株式会社東芝 Device, method, and program for obstacle map generation
WO2018220787A1 (en) 2017-06-01 2018-12-06 三菱電機株式会社 Map processing device, map processing method and map processing program

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010190897A (en) 2009-02-18 2010-09-02 Samsung Electronics Co Ltd Route generation device and method utilized grid map
JP2017083919A (en) 2015-10-22 2017-05-18 株式会社東芝 Device, method, and program for obstacle map generation
WO2018220787A1 (en) 2017-06-01 2018-12-06 三菱電機株式会社 Map processing device, map processing method and map processing program

Also Published As

Publication number Publication date
JP2021105854A (en) 2021-07-26

Similar Documents

Publication Publication Date Title
KR102523426B1 (en) Work vehicle automatic driving system, driving route management device, driving route generating device, driving route determining device
CN105716613A (en) Method for planning shortest path in robot obstacle avoidance
CN112904842B (en) Mobile robot path planning and optimizing method based on cost potential field
KR102530996B1 (en) Robot navigation using 2d and 3d path planning
US10301794B2 (en) Construction machine
JP6564739B2 (en) Work machine
JP5402057B2 (en) Mobile robot control system, route search method, route search program
JP6732539B2 (en) Work machine
JP2017228155A (en) Travel support system and work vehicle
KR102452919B1 (en) work vehicle automatic driving system
JP7025896B2 (en) Crane system and crane control method
CN107000608B (en) Moving body
CN111469127B (en) Cost map updating method and device, robot and storage medium
JP2011227807A (en) Route search system, route search method, and mobile body
US11414834B2 (en) Travel route guidance device
KR102601073B1 (en) working machine
KR20190095622A (en) Method and Apparatus for Planning Obstacle Avoiding Path
US11978345B2 (en) Moving object behavior prediction device
JP2015106254A (en) Autonomous moving vehicle, and control method and control program of the same
JP7342697B2 (en) route generation device
KR101341602B1 (en) Method of optmizing global path of a mobile robot
KR101946740B1 (en) Ship operation assistance system, and ship operation assistance method
CN115008465A (en) Robot control method, robot, and computer-readable storage medium
CN114894212A (en) Improved path planning method based on adaptive parameters
CN114510028A (en) Map construction method, control method, robot, and computer-readable storage medium

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20220315

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20230228

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230301

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230501

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20230801

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230814

R151 Written notification of patent or utility model registration

Ref document number: 7342697

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151