JP7156305B2 - 制御装置、および制御方法、プログラム、並びに移動体 - Google Patents
制御装置、および制御方法、プログラム、並びに移動体 Download PDFInfo
- Publication number
- JP7156305B2 JP7156305B2 JP2019554175A JP2019554175A JP7156305B2 JP 7156305 B2 JP7156305 B2 JP 7156305B2 JP 2019554175 A JP2019554175 A JP 2019554175A JP 2019554175 A JP2019554175 A JP 2019554175A JP 7156305 B2 JP7156305 B2 JP 7156305B2
- Authority
- JP
- Japan
- Prior art keywords
- unit
- self
- obstacle
- information
- route
- 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
Links
- 238000000034 method Methods 0.000 title claims description 82
- PWPJGUXAGUPAHP-UHFFFAOYSA-N lufenuron Chemical compound C1=C(Cl)C(OC(F)(F)C(C(F)(F)F)F)=CC(Cl)=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F PWPJGUXAGUPAHP-UHFFFAOYSA-N 0.000 title 1
- 238000012545 processing Methods 0.000 claims description 121
- 230000033001 locomotion Effects 0.000 claims description 101
- 230000009471 action Effects 0.000 claims description 76
- 230000008569 process Effects 0.000 claims description 65
- 238000001514 detection method Methods 0.000 claims description 62
- 230000001133 acceleration Effects 0.000 claims description 18
- 238000003384 imaging method Methods 0.000 claims description 15
- 239000000284 extract Substances 0.000 claims description 5
- 238000004891 communication Methods 0.000 description 33
- 230000010391 action planning Effects 0.000 description 24
- 230000006870 function Effects 0.000 description 12
- 230000006399 behavior Effects 0.000 description 11
- 230000010354 integration Effects 0.000 description 10
- 238000013507 mapping Methods 0.000 description 6
- 230000004807 localization Effects 0.000 description 5
- 230000008859 change Effects 0.000 description 4
- 238000010586 diagram Methods 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 4
- 238000005259 measurement Methods 0.000 description 4
- 238000012986 modification Methods 0.000 description 4
- 230000004048 modification Effects 0.000 description 4
- 230000000007 visual effect Effects 0.000 description 4
- 230000005856 abnormality Effects 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 3
- 230000007246 mechanism Effects 0.000 description 3
- 230000003287 optical effect Effects 0.000 description 3
- 239000002245 particle Substances 0.000 description 3
- 239000004065 semiconductor Substances 0.000 description 3
- 206010062519 Poor quality sleep Diseases 0.000 description 2
- 238000004091 panning Methods 0.000 description 2
- 240000004050 Pentaglottis sempervirens Species 0.000 description 1
- 235000004522 Pentaglottis sempervirens Nutrition 0.000 description 1
- 244000141353 Prunus domestica Species 0.000 description 1
- 230000003190 augmentative effect Effects 0.000 description 1
- 238000005452 bending Methods 0.000 description 1
- 238000002485 combustion reaction Methods 0.000 description 1
- 239000000470 constituent Substances 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000008921 facial expression Effects 0.000 description 1
- 239000000446 fuel Substances 0.000 description 1
- 230000014509 gene expression Effects 0.000 description 1
- 238000005286 illumination Methods 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 230000000116 mitigating effect Effects 0.000 description 1
- 230000010287 polarization Effects 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- 238000010845 search algorithm Methods 0.000 description 1
- 230000035939 shock Effects 0.000 description 1
- 238000000547 structure data Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
- G05D1/0251—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means extracting 3D information from a plurality of images taken from different locations, e.g. stereo vision
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C3/00—Measuring distances in line of sight; Optical rangefinders
- G01C3/02—Details
- G01C3/06—Use of electric means to obtain final indication
- G01C3/08—Use of electric radiation detectors
- G01C3/085—Use of electric radiation detectors with electronic parallax measurement
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0217—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with energy consumption, time reduction or distance reduction criteria
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/20—Analysis of motion
- G06T7/246—Analysis of motion using feature-based methods, e.g. the tracking of corners or segments
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/20—Analysis of motion
- G06T7/277—Analysis of motion involving stochastic approaches, e.g. using Kalman filters
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/50—Depth or shape recovery
- G06T7/55—Depth or shape recovery from multiple images
- G06T7/593—Depth or shape recovery from multiple images from stereo images
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/10—Image acquisition modality
- G06T2207/10016—Video; Image sequence
- G06T2207/10021—Stereoscopic video; Stereoscopic image sequence
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/10—Image acquisition modality
- G06T2207/10028—Range image; Depth image; 3D point clouds
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T2207/00—Indexing scheme for image analysis or image enhancement
- G06T2207/30—Subject of image; Context of image processing
- G06T2207/30248—Vehicle exterior or interior
- G06T2207/30252—Vehicle exterior; Vicinity of vehicle
- G06T2207/30261—Obstacle
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Electromagnetism (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Theoretical Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Traffic Control Systems (AREA)
Description
1.本開示の概要
2.好適な実施の形態
3.変形例
4.ソフトウェアにより実行させる例
移動体11は、センサ群21のセンシング結果から、何らかの原因で自己位置が不定の状態となった場合、動作モードを通常モードから探索モードに切り替える。
<本開示の移動体を制御する移動体制御システムの構成例>
上述した機能を実現させるための移動体11を制御する移動体制御システムについて説明する。
次に、図4を参照して、図3の移動体制御システム100のうち、認識処理部31に対応する自律移動制御部110の認識処理部121の具体的な構成例について説明する。
次に、図9のフローチャートを参照して、自己位置推定処理について説明する。
次に、図10のフローチャートを参照して、時系列情報自己位置推定処理について説明する。
次に、図8のフローチャートを参照して、現在情報自己位置推定処理について説明する。
次に、図12のフローチャートを参照して、障害物認識処理について説明する。
次に、図13のフローチャートを参照して、表面センシング済み領域記録処理について説明する。尚、表面センシング済み領域記録処理は、後述する動作モードが探索モードになったときに実行される処理である。
次に、図14のフローチャートを参照して、図4の移動体制御システム100における自律移動制御処理について説明する。
次に、図15のフローチャートを参照して、探索モード処理について説明する。
以上においては、図16の左部で示されるように、移動体11の矢印で示される移動方向に対して、移動方向に対して前方が撮像方向とされているステレオカメラ203が設けられている場合、ステレオカメラ203の表面センシング可能範囲が、視野角θ1、および撮像可能距離d1で固定されている例について説明してきた。
ところで、上述した一連の処理は、ハードウェアにより実行させることもできるが、ソフトウェアにより実行させることもできる。一連の処理をソフトウェアにより実行させる場合には、そのソフトウェアを構成するプログラムが、専用のハードウェアに組み込まれているコンピュータ、または、各種のプログラムをインストールすることで、各種の機能を実行することが可能な、例えば汎用のコンピュータなどに、記録媒体からインストールされる。
周辺の障害物の位置からなる障害物位置情報を生成する障害物位置情報生成部と、
前記障害物の表面をセンシングする表面センシング部と、
前記自己位置、前記障害物位置情報、および前記表面センシング部の表面センシング可能範囲に基づいて、前記障害物の表面センシング済み領域を記録する表面センシング済み領域記録部と、
前記障害物の表面センシング済み領域に基づいて、ルートを計画するルート計画部と
を含む制御装置。
<2> 前記表面センシング済み領域記録部は、前記表面センシング部の表面センシング可能範囲内の前記障害物の表面を、前記障害物の表面センシング済み領域として記録する
<1>に記載の制御装置。
<3> 前記ルート計画部は、
前記障害物の表面センシング済み領域、および前記障害物位置情報に基づいて、前記障害物の表面センシングが済んでいない未済領域を設定し、前記未済領域を分割した分割領域を経由地として設定し、前記経由地に優先度を設定する優先度設定部を含み、
前記優先度設定部により設定された前記優先度に基づいて、前記経由地を経由する前記ルートを計画する
<2>に記載の制御装置。
<4> 前記優先度設定部は、前記経由地を全て通過するルートのうち、優先条件に基づいて設定されるコストである優先度コストが最小となるルートにおける経由地の通過順序に応じて、前記経由地の優先度を設定する
<3>に記載の制御装置。
<5> 前記優先条件は、総移動距離、または総消費電力であり、
前記優先度コストは、移動距離に応じて設定されるコスト、または、消費電力に応じて設定されるコストである
<4>に記載の制御装置。
<6> 前記優先度設定部は、前記経由地を全て通過するルートのうち、前記優先条件、および機体運動情報に基づいて設定されるコストである優先度コストが最小となるルートにおける経由地の通過順序に応じて、前記経由地の優先度を設定する
<4>に記載の制御装置。
<7> 前記機体運動情報は、
前記優先条件が総移動距離である場合、最高速度、最小回転半径、および経路上の超えられる段差の高さの情報であり、
前記優先条件が総消費電力である場合、単位距離当たりの電力消費量、およびバッテリの充電容量の情報である
<6>に記載の制御装置。
<8> 前記ルート計画部は、前記優先度設定部により前記経由地毎に設定される前記優先度、および移動条件に基づいて、前記経由地を全て経由する前記ルートを計画する
<3>に記載の制御装置。
<9> 前記ルート計画部は、前記経由地を全て経由する全てのルートについて、前記優先度設定部により前記経由地毎に設定される前記優先度、および移動条件に基づいて設定されるルートコストを算出し、前記ルートコストが最小となるルートを選択する
<3>に記載の制御装置。
<10> 前記移動条件は、優先度の高い順に前記経由地を通過するという条件、経由地の優先度を無視しても最短時間で移動するという条件、または、優先度の高い経由地ほど、早く到着するという条件を含む
<9>に記載の制御装置。
<11> 前記移動条件が、優先度の高い経由地ほど、早く到着するという条件である場合、前記ルート計画部は、前記優先度と、前記経由地までの到着時間との積を前記ルートコストとして設定し、前記全てのルートのうち、前記ルートコストが最小となるルートを選択する
<10>に記載の制御装置。
<12> 前記自己位置推定部は、
時系列に供給されるセンサ情報からなる時系列情報を用いて、前記自己位置を推定し、推定結果を時系列情報自己位置として出力する時系列情報自己位置推定部を含み、
前記表面センシング済み領域記録部は、前記時系列情報自己位置、前記障害物位置情報、および前記表面センシング部の表面センシング可能範囲に基づいて、前記障害物の表面センシング済み領域を記録する
<1>に記載の制御装置。
<13> 前記時系列情報は、LIDAR(Light Detection and Ranging、Laser Imaging Detection and Ranging)により検出される3次元点群情報、および車輪エンコーダにより検出される位置情報、姿勢、速度、加速度、および角速度であり、
前記障害物位置情報生成部は、前記3次元点群情報に基づいて、前記周辺の障害物の相対位置および方向からなる障害物位置情報を生成する
<12>に記載の制御装置。
<14> 前記自己位置推定部は、
現在のセンシング結果を出力するセンサ情報からなる現在情報に基づいて、前記自己位置を推定し、現在情報自己位置として出力する現在情報自己位置推定部をさらに含む
<12>に記載の制御装置。
<15> 前記現在情報は、ステレオカメラからなる前記表面センシング部により撮像される視差画像であり、
前記現在情報自己位置推定部は、前記現在情報である視差画像に基づいて、デプス画像を生成し、前記デプス画像より画像特徴量を抽出し、前記画像特徴量と対応付けられている位置に基づいて、前記自己位置を推定し、現在情報自己位置として出力し、
前記自己位置推定部は、前記時系列情報自己位置および前記現在情報自己位置を統合して、前記自己位置として出力する
<14>に記載の制御装置。
<16> 前記位置と前記画像特徴量とが対応付けて記憶される位置画像特徴量記憶部をさらに含み、
前記自己位置推定部は、前記時系列情報自己位置および前記現在情報自己位置を統合して、自己位置として出力するとき、前記現在情報自己位置に対応する画像特徴量と、前記自己位置とを対応付けて、前記位置画像特徴量記憶部に記憶させる
<15>に記載の制御装置。
<17> 前記自己位置が不定状態の場合、前記表面センシング済み領域記録部は、前記自己位置、前記障害物位置情報、および前記表面センシング部の表面センシング可能範囲に基づいて、前記障害物の表面センシング済み領域を記録する
<1>乃至<16>のいずれかに記載の制御装置。
<18> 自己位置を推定する自己位置推定処理と、
周辺の障害物の位置からなる障害物位置情報を生成する障害物位置情報生成処理と、
前記障害物の表面をセンシングする表面センシング処理と、
前記自己位置、前記障害物位置情報、および前記表面センシング処理の表面センシング可能範囲に基づいて、前記障害物の表面センシング済み領域を記録する表面センシング済み領域記録処理と、
前記障害物の表面センシング済み領域に基づいて、ルートを計画するルート計画処理と
を含む制御方法。
<19> 自己位置を推定する自己位置推定部と、
周辺の障害物の位置からなる障害物位置情報を生成する障害物位置情報生成部と、
前記障害物の表面をセンシングする表面センシング部と、
前記自己位置、前記障害物位置情報、および前記表面センシング部の表面センシング可能範囲に基づいて、前記障害物の表面センシング済み領域を記録する表面センシング済み領域記録部と、
前記障害物の表面センシング済み領域に基づいて、ルートを計画するルート計画部と
してコンピュータを機能させるプログラム。
<20> 自己位置を推定する自己位置推定部と、
周辺の障害物の位置からなる障害物位置情報を生成する障害物位置情報生成部と、
前記障害物の表面をセンシングする表面センシング部と、
前記自己位置、前記障害物位置情報、および前記表面センシング部の表面センシング可能範囲に基づいて、前記障害物の表面センシング済み領域を記録する表面センシング済み領域記録部と、
前記障害物の表面センシング済み領域に基づいて、ルートを計画する計画部と、
前記計画部により計画された前記ルートに基づいて、行動計画を生成する行動計画生成部と、
前記行動計画生成部により決定された行動計画に基づいて移動体の動作を制御する制御部と
を含む移動体。
Claims (18)
- 自己位置を推定する自己位置推定部と、
周辺の障害物の位置からなる障害物位置情報を生成する障害物位置情報生成部と、
前記障害物の表面をセンシングする表面センシング部と、
前記自己位置、前記障害物位置情報、および前記表面センシング部の表面センシング可能範囲に基づいて、前記表面センシング部の表面センシング可能範囲内の前記障害物の表面を、前記障害物の表面センシング済み領域として記録する表面センシング済み領域記録部と、
前記障害物の表面センシング済み領域に基づいて、ルートを計画するルート計画部とを含み、
前記ルート計画部は、
前記障害物の表面センシング済み領域、および前記障害物位置情報に基づいて、前記障害物の表面センシングが済んでいない未済領域を設定し、前記未済領域を分割した分割領域を経由地として設定し、前記経由地に優先度を設定する優先度設定部を含み、
前記優先度設定部により設定された前記優先度に基づいて、前記経由地を経由する前記ルートを計画する
制御装置。 - 前記優先度設定部は、前記経由地を全て通過するルートのうち、優先条件に基づいて設定されるコストである優先度コストが最小となるルートにおける経由地の通過順序に応じて、前記経由地の優先度を設定する
請求項1に記載の制御装置。 - 前記優先条件は、総移動距離、または総消費電力であり、
前記優先度コストは、移動距離に応じて設定されるコスト、または、消費電力に応じて設定されるコストである
請求項2に記載の制御装置。 - 前記優先度設定部は、前記経由地を全て通過するルートのうち、前記優先条件、および機体運動情報に基づいて設定されるコストである優先度コストが最小となるルートにおける経由地の通過順序に応じて、前記経由地の優先度を設定する
請求項2に記載の制御装置。 - 前記機体運動情報は、
前記優先条件が総移動距離である場合、最高速度、最小回転半径、および経路上の超えられる段差の高さの情報であり、
前記優先条件が総消費電力である場合、単位距離当たりの電力消費量、およびバッテリの充電容量の情報である
請求項4に記載の制御装置。 - 前記ルート計画部は、前記優先度設定部により前記経由地毎に設定される前記優先度、および移動条件に基づいて、前記経由地を全て経由する前記ルートを計画する
請求項1に記載の制御装置。 - 前記ルート計画部は、前記経由地を全て経由する全てのルートについて、前記優先度設定部により前記経由地毎に設定される前記優先度、および移動条件に基づいて設定されるルートコストを算出し、前記ルートコストが最小となるルートを選択する
請求項1に記載の制御装置。 - 前記移動条件は、優先度の高い順に前記経由地を通過するという条件、経由地の優先度を無視しても最短時間で移動するという条件、または、優先度の高い経由地ほど、早く到着するという条件を含む
請求項7に記載の制御装置。 - 前記移動条件が、優先度の高い経由地ほど、早く到着するという条件である場合、前記ルート計画部は、前記優先度と、前記経由地までの到着時間との積を前記ルートコストとして設定し、前記全てのルートのうち、前記ルートコストが最小となるルートを選択する
請求項8に記載の制御装置。 - 前記自己位置推定部は、
時系列に供給されるセンサ情報からなる時系列情報を用いて、前記自己位置を推定し、推定結果を時系列情報自己位置として出力する時系列情報自己位置推定部を含み、
前記表面センシング済み領域記録部は、前記時系列情報自己位置、前記障害物位置情報、および前記表面センシング部の表面センシング可能範囲に基づいて、前記障害物の表面センシング済み領域を記録する
請求項1に記載の制御装置。 - 前記時系列情報は、LIDAR(Light Detection and Ranging、Laser Imaging Detection and Ranging)により検出される3次元点群情報、および車輪エンコーダにより検出される位置情報、姿勢、速度、加速度、および角速度であり、
前記障害物位置情報生成部は、前記3次元点群情報に基づいて、前記周辺の障害物の相対位置および方向からなる障害物位置情報を生成する
請求項10に記載の制御装置。 - 前記自己位置推定部は、
現在のセンシング結果を出力するセンサ情報からなる現在情報に基づいて、前記自己位置を推定し、現在情報自己位置として出力する現在情報自己位置推定部をさらに含む
請求項10に記載の制御装置。 - 前記現在情報は、ステレオカメラからなる前記表面センシング部により撮像される視差画像であり、
前記現在情報自己位置推定部は、前記現在情報である視差画像に基づいて、デプス画像を生成し、前記デプス画像より画像特徴量を抽出し、前記画像特徴量と対応付けられている位置に基づいて、前記自己位置を推定し、現在情報自己位置として出力し、
前記自己位置推定部は、前記時系列情報自己位置および前記現在情報自己位置を統合して、前記自己位置として出力する
請求項12に記載の制御装置。 - 前記位置と前記画像特徴量とが対応付けて記憶される位置画像特徴量記憶部をさらに含み、
前記自己位置推定部は、前記時系列情報自己位置および前記現在情報自己位置を統合して、自己位置として出力するとき、前記現在情報自己位置に対応する画像特徴量と、前記自己位置とを対応付けて、前記位置画像特徴量記憶部に記憶させる
請求項13に記載の制御装置。 - 前記自己位置が不定状態の場合、前記表面センシング済み領域記録部は、前記自己位置、前記障害物位置情報、および前記表面センシング部の表面センシング可能範囲に基づいて、前記障害物の表面センシング済み領域を記録する
請求項1に記載の制御装置。 - 自己位置を推定する自己位置推定処理と、
周辺の障害物の位置からなる障害物位置情報を生成する障害物位置情報生成処理と、
前記障害物の表面をセンシングする表面センシング処理と、
前記自己位置、前記障害物位置情報、および前記表面センシング処理の表面センシング可能範囲に基づいて、前記表面センシング処理の表面センシング可能範囲内の前記障害物の表面を、前記障害物の表面センシング済み領域として記録する表面センシング済み領域記録処理と、
前記障害物の表面センシング済み領域に基づいて、ルートを計画するルート計画処理とを含み、
前記ルート計画処理は、
前記障害物の表面センシング済み領域、および前記障害物位置情報に基づいて、前記障害物の表面センシングが済んでいない未済領域を設定し、前記未済領域を分割した分割領域を経由地として設定し、前記経由地に優先度を設定する優先度設定処理を含み、
前記優先度設定処理により設定された前記優先度に基づいて、前記経由地を経由する前記ルートを計画する
制御方法。 - 自己位置を推定する自己位置推定部と、
周辺の障害物の位置からなる障害物位置情報を生成する障害物位置情報生成部と、
前記障害物の表面をセンシングする表面センシング部と、
前記自己位置、前記障害物位置情報、および前記表面センシング部の表面センシング可能範囲に基づいて、前記表面センシング部の表面センシング可能範囲内の前記障害物の表面を、前記障害物の表面センシング済み領域として記録する表面センシング済み領域記録部と、
前記障害物の表面センシング済み領域に基づいて、ルートを計画するルート計画部としてコンピュータを機能させ、
前記ルート計画部は、
前記障害物の表面センシング済み領域、および前記障害物位置情報に基づいて、前記障害物の表面センシングが済んでいない未済領域を設定し、前記未済領域を分割した分割領域を経由地として設定し、前記経由地に優先度を設定する優先度設定部を含み、
前記優先度設定部により設定された前記優先度に基づいて、前記経由地を経由する前記ルートを計画する
プログラム。 - 自己位置を推定する自己位置推定部と、
周辺の障害物の位置からなる障害物位置情報を生成する障害物位置情報生成部と、
前記障害物の表面をセンシングする表面センシング部と、
前記自己位置、前記障害物位置情報、および前記表面センシング部の表面センシング可能範囲に基づいて、前記表面センシング部の表面センシング可能範囲内の前記障害物の表面を、前記障害物の表面センシング済み領域として記録する表面センシング済み領域記録部と、
前記障害物の表面センシング済み領域に基づいて、ルートを計画するルート計画部と、
前記ルート計画部により計画された前記ルートに基づいて、行動計画を生成する行動計画生成部と、
前記行動計画生成部により決定された行動計画に基づいて移動体の動作を制御する制御部とを含み、
前記ルート計画部は、
前記障害物の表面センシング済み領域、および前記障害物位置情報に基づいて、前記障害物の表面センシングが済んでいない未済領域を設定し、前記未済領域を分割した分割領域を経由地として設定し、前記経由地に優先度を設定する優先度設定部を含み、
前記優先度設定部により設定された前記優先度に基づいて、前記経由地を経由する前記ルートを計画する
移動体。
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017222457 | 2017-11-20 | ||
JP2017222457 | 2017-11-20 | ||
PCT/JP2018/041095 WO2019098082A1 (ja) | 2017-11-20 | 2018-11-06 | 制御装置、および制御方法、プログラム、並びに移動体 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPWO2019098082A1 JPWO2019098082A1 (ja) | 2020-11-19 |
JP7156305B2 true JP7156305B2 (ja) | 2022-10-19 |
Family
ID=66538592
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019554175A Active JP7156305B2 (ja) | 2017-11-20 | 2018-11-06 | 制御装置、および制御方法、プログラム、並びに移動体 |
Country Status (4)
Country | Link |
---|---|
US (1) | US11537131B2 (ja) |
JP (1) | JP7156305B2 (ja) |
DE (1) | DE112018005910T5 (ja) |
WO (1) | WO2019098082A1 (ja) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11348269B1 (en) * | 2017-07-27 | 2022-05-31 | AI Incorporated | Method and apparatus for combining data to construct a floor plan |
JP7353747B2 (ja) * | 2018-01-12 | 2023-10-02 | キヤノン株式会社 | 情報処理装置、システム、方法、およびプログラム |
KR102106100B1 (ko) * | 2018-02-02 | 2020-05-06 | 엘지전자 주식회사 | 이동 로봇 |
US11287826B2 (en) * | 2018-10-12 | 2022-03-29 | Boston Dynamics, Inc. | Terrain aware step planning system |
US11835960B2 (en) * | 2019-01-28 | 2023-12-05 | Zebra Technologies Corporation | System and method for semantically identifying one or more of an object and a location in a robotic environment |
CN112013844B (zh) * | 2019-05-31 | 2022-02-11 | 北京小米智能科技有限公司 | 建立室内环境地图的方法及装置 |
CN112462805B (zh) * | 2020-11-19 | 2022-11-29 | 西安理工大学 | 基于改进蚁群算法的5g网联无人机航迹规划方法 |
WO2024015030A1 (en) * | 2022-07-11 | 2024-01-18 | Delivers Ai Robotik Otonom Surus Bilgi Teknolojileri A.S. | A delivery system and method for a delivery robot |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004133567A (ja) | 2002-10-09 | 2004-04-30 | Hitachi Ltd | 移動体およびその位置検出装置 |
JP2011170843A (ja) | 2010-01-20 | 2011-09-01 | Ihi Aerospace Co Ltd | 経路生成装置と方法および経路生成装置を備える移動装置 |
JP2014194729A (ja) | 2013-02-27 | 2014-10-09 | Sharp Corp | 周囲環境認識装置、それを用いた自律移動システムおよび周囲環境認識方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002073770A (ja) | 2000-09-05 | 2002-03-12 | Ishida Co Ltd | 商品情報印字システム |
JP2003092347A (ja) | 2002-07-10 | 2003-03-28 | Mitsubishi Electric Corp | 半導体デバイスのコンタクトホール形成方法 |
JP2010217995A (ja) | 2009-03-13 | 2010-09-30 | Mitsubishi Electric Corp | 探索装置及び探索方法及び探索プログラム |
US9026302B2 (en) | 2009-11-06 | 2015-05-05 | Irobot Corporation | Methods and systems for complete coverage of a surface by an autonomous robot |
US9221396B1 (en) * | 2012-09-27 | 2015-12-29 | Google Inc. | Cross-validating sensors of an autonomous vehicle |
-
2018
- 2018-11-06 DE DE112018005910.3T patent/DE112018005910T5/de active Pending
- 2018-11-06 JP JP2019554175A patent/JP7156305B2/ja active Active
- 2018-11-06 WO PCT/JP2018/041095 patent/WO2019098082A1/ja active Application Filing
- 2018-11-06 US US16/763,216 patent/US11537131B2/en active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004133567A (ja) | 2002-10-09 | 2004-04-30 | Hitachi Ltd | 移動体およびその位置検出装置 |
JP2011170843A (ja) | 2010-01-20 | 2011-09-01 | Ihi Aerospace Co Ltd | 経路生成装置と方法および経路生成装置を備える移動装置 |
JP2014194729A (ja) | 2013-02-27 | 2014-10-09 | Sharp Corp | 周囲環境認識装置、それを用いた自律移動システムおよび周囲環境認識方法 |
Also Published As
Publication number | Publication date |
---|---|
DE112018005910T5 (de) | 2020-07-30 |
US11537131B2 (en) | 2022-12-27 |
JPWO2019098082A1 (ja) | 2020-11-19 |
US20200333790A1 (en) | 2020-10-22 |
WO2019098082A1 (ja) | 2019-05-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP7156305B2 (ja) | 制御装置、および制御方法、プログラム、並びに移動体 | |
JP7180612B2 (ja) | 制御装置、および制御方法、プログラム、並びに移動体 | |
JP7151725B2 (ja) | 制御装置、および制御方法、プログラム、並びに移動体 | |
JP7180670B2 (ja) | 制御装置、制御方法、並びにプログラム | |
WO2019098002A1 (ja) | 情報処理装置、情報処理方法、プログラム、及び移動体 | |
WO2020226085A1 (ja) | 情報処理装置、情報処理方法、及びプログラム | |
WO2019082669A1 (ja) | 情報処理装置、情報処理方法、プログラム、及び、移動体 | |
US20200278208A1 (en) | Information processing apparatus, movable apparatus, information processing method, movable-apparatus control method, and programs | |
WO2020031812A1 (ja) | 情報処理装置、情報処理方法、情報処理プログラム、及び移動体 | |
JP2020079997A (ja) | 情報処理装置、情報処理方法、及びプログラム | |
JPWO2019073795A1 (ja) | 情報処理装置、自己位置推定方法、プログラム、及び、移動体 | |
CN112810603B (zh) | 定位方法和相关产品 | |
JP7147142B2 (ja) | 制御装置、および制御方法、プログラム、並びに移動体 | |
WO2021033591A1 (ja) | 情報処理装置、および情報処理方法、並びにプログラム | |
WO2020129810A1 (en) | Information processing apparatus, information processing method, and program | |
WO2019176278A1 (ja) | 情報処理装置、情報処理方法、プログラム、及び移動体 | |
WO2021140916A1 (ja) | 移動体、情報処理装置、情報処理方法、及びプログラム | |
JP2019049475A (ja) | 信号処理装置、および信号処理方法、プログラム、並びに移動体 | |
JPWO2019049710A1 (ja) | 信号処理装置、および信号処理方法、プログラム、並びに移動体 | |
US20230150543A1 (en) | Systems and methods for estimating cuboid headings based on heading estimations generated using different cuboid defining techniques | |
US20230237793A1 (en) | False track mitigation in object detection systems | |
KR20230149709A (ko) | 그리드에서의 양방향 경로 최적화 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20210917 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220607 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20220801 |
|
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: 20220906 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20220919 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 7156305 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |