JP5105595B2 - 自律走行移動体の走行経路決定用地図作成装置及び走行経路決定用地図作成方法 - Google Patents
自律走行移動体の走行経路決定用地図作成装置及び走行経路決定用地図作成方法 Download PDFInfo
- Publication number
- JP5105595B2 JP5105595B2 JP2007281632A JP2007281632A JP5105595B2 JP 5105595 B2 JP5105595 B2 JP 5105595B2 JP 2007281632 A JP2007281632 A JP 2007281632A JP 2007281632 A JP2007281632 A JP 2007281632A JP 5105595 B2 JP5105595 B2 JP 5105595B2
- Authority
- JP
- Japan
- Prior art keywords
- travel route
- coordinate system
- map
- data
- time
- 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 20
- 238000005259 measurement Methods 0.000 claims description 24
- 238000012545 processing Methods 0.000 claims description 19
- 239000000872 buffer Substances 0.000 claims description 16
- 238000007405 data analysis Methods 0.000 claims description 14
- 230000000737 periodic effect Effects 0.000 claims description 8
- 238000006243 chemical reaction Methods 0.000 claims description 5
- 238000010586 diagram Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 238000004891 communication Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000013507 mapping Methods 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
これらのロボットにおいて、自律走行を実現するためには、いずれも移動経路決定用の地図を作成する必要があるが、従来では、複数のセンサなどの外界計測手段で得た外界情報と、デッドレコニングなどの手段で得た自己位置情報とに基づいて走行経路を決める地図を作成するようにしていた(例えば、特許文献1〜4参照)。
近年、高速で自律走行を行う移動体として、レーザレンジファインダやミリ波レーダなどの外界計測手段を多数搭載した移動体の研究開発が進められている(例えば、非特許文献1参照)。
本発明は、上述した従来の課題に着目してなされたもので、多数の外界計測手段で得る外界情報の処理に要する遅延分を補償することができ、その結果、高速の自律走行に適した走行経路決定用地図を安定して作成することが可能である自律走行移動体の走行経路決定用地図作成装置及び走行経路決定用地図作成方法を提供することを目的としている。
具体的には、直接的に距離や形状情報を取得できるものの計測レートの低さのため近傍情報取得に適したレーザレンジファインダに、精度は劣るものの広角情報取得に適したステレオ視や、物体の属性を識別するテクスチャ等の画像処理を組み合わせることが望ましい。
この際、デッドレコニングデータ及びGPSデータからそれぞれ得られる自己位置データを併用し、カルマンフィルタなどの無限インパルス応答フィルタを用いて連続的で且つ絶対位置での自己位置データを推定するように成すことも可能である。
一方、自己位置計測部で取得するデータは、地上座標系自己位置データであり、このデータは、センサ座標系外界データと非同期にそして異なるレートで取得されることから、センサ座標系外界データと整合性をとる必要がある。
上記地図作成部の地図作成モジュールでは、走行経路決定モジュールによる経路決定処理中に移動体の位置及び進む方位の変化が発生する場合であったとしても、すなわち、経路決定制御周期内に移動体の位置及び進む方位の変化が発生する場合であったとしても、実際に制御が開始される時点に移動体が到達する位置を推定して、この到達位置を起点とした必要な方向を臨む局所地図をベース地図から切り取って走行経路決定モジュールに送るようにしているので、移動体からの正確な相対的地図を用いた走行経路の決定及び制御が可能になる。
そして、上記走行経路の決定処理中に移動体の位置及び進む方位の変化が発生する場合であったとしても、すなわち、走行経路の決定制御周期内に移動体の位置及び進む方位の変化が発生する場合であったとしても、実際に制御が開始される時点に移動体が到達する位置を推定して、この到達位置を起点とした必要な方向を臨む部分をベース地図から切り取って走行経路を決めるのに必要な局所地図とするようにしているので、移動体からの正確な相対的地図を用いた走行経路の決定及び制御が可能になる。
図1〜図6は、本発明に係る自律走行移動体の走行経路決定用地図作成装置の一実施形態を示しており、この実施形態では、自律走行移動体が自律走行車である場合を例に挙げて説明する。
そして、自律走行車Cにおける車体駆動部50の操舵手段51は、ドライバ52及び入出力回路4を介して車体制御部60と接続していると共に、車体駆動部50の車速制御手段53は、コンバータ54及び入出力回路4を介して車体制御部60と接続しており、この車体制御部60には、地図作成部40からの制御信号がLAN3を介して入力されるようになっている。
この実施形態において、地図作成部40の地図作成モジュール40Aは、図4に示すように、データ解析部30から得たタイムスタンプ付きのセンサ座標系外界データ(レーザレンジファインダデータ11a,画像処理データ12a,他のセンサデータ13a)及び地上座標系自己位置データ21aを時系列に沿って蓄積するリングバッファ31〜34を具備している。
さらに、この実施形態において、地図作成部40の地図作成モジュール40Aは、図7に示すように、走行経路決定モジュール40Bから走行可能領域へ向けた自律走行車Cの走行経路Rを決めるのに必要な局所地図の要求が位置T2で出された段階において、この走行経路決定モジュール40Bによる経路決定処理時間の長さを考慮して、この経路決定処理時間のうちに自律走行車Cが到達する位置T3を起点とした必要な方向を臨む局所地図Zpをベース地図Zbから切り取って走行経路決定モジュール40Bに送るようになっている。
まず、データ解析部30は、外界計測部10から得た距離データ等のセンサ座標系外界データ及び自己位置計測部20から得た車速やヨーレート等による地上座標系自己位置データに、センサデバイスの処理及び通信遅延分を考慮した正しいタイムスタンプを添付する。
一方、自己位置推定のための自己位置計測部20で得た車速やヨーレート等による地上座標系自己位置データを受け取る自己位置情報生成モジュール30Bは、これらの地上座標系自己位置データを受け取った時点で、同じくセンサデバイスの処理及び通信遅延分を考慮した正しいタイムスタンプを添付して、自己位置推定結果を生成する。具体的には、車速度とヨーレートとの積分によるデッドレコ情報を生成する。
次いで、地図生成モジュール40Aは、走行経路決定モジュール40Bから走行可能領域へ向けた自律走行車Cの走行経路Rを決めるのに必要な局所地図の要求が位置T2で出された段階において、この走行経路決定モジュール40Bによる経路決定処理時間の長さを考慮して、この経路決定処理時間のうちに自律走行車Cが到達する位置T3を起点とした必要な方向を臨む局所地図Zpをベース地図Zbから切り取って走行経路決定モジュール40Bに送る。
上記した一実施形態では、自律走行移動体が自律走行車である場合を示したが、これに限定されるものではない。
10 外界計測部
11 レーザレンジファインダ
20 自己位置計測部
30 データ解析部
31〜34 リングバッファ
40 地図作成部
40A 地図作成モジュール
40B 走行経路決定モジュール
C 自律走行車(自律走行移動体)
R 走行経路
T3 自律走行車が到達する位置
Zb ベース地図
Zp 局所地図
Claims (2)
- 自律して走行する移動体の走行経路を決めるのに用いる地図の作成装置であって、
レーザレンジファインダなどのセンサを具備して、前記移動体近傍から遠方にかけての障害の有無を計測する外界計測部と、
デッドレコニングなどの手段により前記移動体の自己位置を求める自己位置計測部と、
前記外界計測部で得たセンサ座標系外界データにタイムスタンプを付して走行可能領域及び障害による走行不能領域の判定処理を行うと共に、前記自己位置計測部で得た地上座標系自己位置データにタイムスタンプを付して自己位置推定結果を生成するデータ解析部と、
前記データ解析部から得たタイムスタンプ付きのセンサ座標系外界データ及び地上座標系自己位置データを時系列に沿って蓄積するリングバッファを具備して、最新のセンサ座標系外界データが計測される毎に前記リングバッファから最新もしくはその近傍の任意時刻における各種データを取り出して、その時点における移動体の位置を認識して地上座標系への座標変換を行って、前記最新のセンサ座標系外界データを逐次反映させた空間的な2次元周期境界条件を有するリングバッファ状のベース地図を作成する地図作成モジュールを具備していると共に、前記地図作成モジュールで作成されたベース地図に基づいて、前記移動体の走行経路を決める走行経路決定モジュールを具備した地図作成部を備え、
前記地図作成部の地図作成モジュールは、走行可能領域へ向けた移動体の走行経路を決めるのに必要な局所地図の要求が前記走行経路決定モジュールから出された段階において、前記走行経路決定モジュールによる経路決定処理時間の長さを考慮して、この経路決定処理時間のうちに前記移動体が到達する位置を起点とした必要な方向を臨む局所地図を前記ベース地図から切り取って前記走行経路決定モジュールに送る
ことを特徴とする自律走行移動体の走行経路決定用地図作成装置。 - 自律して走行する移動体の走行経路を決めるのに用いる地図の作成方法であって、
レーザレンジファインダなどのセンサにより、前記移動体近傍から遠方にかけての障害の有無を計測すると共に、デッドレコニングなどの手段により前記移動体の自己位置を求め、
前記センサで得たセンサ座標系外界データにタイムスタンプを付して走行可能領域及び障害による走行不能領域の判定処理を行うと共に、前記デッドレコニングなどの手段で得た地上座標系自己位置データにタイムスタンプを付して自己位置推定結果を生成し、
これに続いて、タイムスタンプ付きの前記センサ座標系外界データ及び地上座標系自己位置データを時系列に沿ってリングバッファに蓄積し、最新のセンサ座標系外界データを計測する毎に前記リングバッファから最新もしくはその近傍の任意時刻における各種データを取り出して、その時点における移動体の位置を認識して地上座標系への座標変換を行って、前記最新のセンサ座標系外界データを逐次反映させた空間的な2次元周期境界条件を有するリングバッファ状のベース地図を作成し、
このリングバッファ状のベース地図に基づいて走行可能領域へ向けた移動体の走行経路を決めるのに必要な局所地図を求める段階において、前記走行経路を決定するのに要する時間の長さを考慮して、この走行経路決定処理時間のうちに前記移動体が到達する位置を起点とした必要な方向を臨む部分を前記ベース地図から切り取って前記走行経路を決めるのに必要な局所地図とする
ことを特徴とする自律走行移動体の走行経路決定用地図作成方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007281632A JP5105595B2 (ja) | 2007-10-30 | 2007-10-30 | 自律走行移動体の走行経路決定用地図作成装置及び走行経路決定用地図作成方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2007281632A JP5105595B2 (ja) | 2007-10-30 | 2007-10-30 | 自律走行移動体の走行経路決定用地図作成装置及び走行経路決定用地図作成方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2009110249A JP2009110249A (ja) | 2009-05-21 |
JP5105595B2 true JP5105595B2 (ja) | 2012-12-26 |
Family
ID=40778684
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2007281632A Active JP5105595B2 (ja) | 2007-10-30 | 2007-10-30 | 自律走行移動体の走行経路決定用地図作成装置及び走行経路決定用地図作成方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5105595B2 (ja) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5776324B2 (ja) * | 2011-05-17 | 2015-09-09 | 富士通株式会社 | 地図処理方法及びプログラム、並びにロボットシステム |
JP6469492B2 (ja) * | 2015-03-24 | 2019-02-13 | セコム株式会社 | 自律移動ロボット |
US10444347B2 (en) | 2016-11-30 | 2019-10-15 | GM Global Technology Operations LLC | Accurate self localization using automotive radar synthetic aperture radar |
JP6895745B2 (ja) * | 2016-12-12 | 2021-06-30 | 株式会社Ihiエアロスペース | 無人移動体及び無人移動体の制御方法 |
JP7439822B2 (ja) * | 2019-03-06 | 2024-02-28 | ソニーグループ株式会社 | 地図作成装置、地図作成方法、及びプログラム |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3150018B2 (ja) * | 1993-08-27 | 2001-03-26 | 株式会社アイ・エイチ・アイ・エアロスペース | 無人移動探査機の経路決定方法 |
DE4408329C2 (de) * | 1994-03-11 | 1996-04-18 | Siemens Ag | Verfahren zum Aufbau einer zellular strukturierten Umgebungskarte von einer selbstbeweglichen mobilen Einheit, welche sich mit Hilfe von auf Wellenreflexion basierenden Sensoren orientiert |
JPH10260724A (ja) * | 1997-03-19 | 1998-09-29 | Yaskawa Electric Corp | 通路環境の地図生成方法 |
JP2004298975A (ja) * | 2003-03-28 | 2004-10-28 | Sony Corp | ロボット装置、障害物探索方法 |
JP4445210B2 (ja) * | 2003-04-28 | 2010-04-07 | 株式会社東芝 | 自律走行ロボット |
JP2007041656A (ja) * | 2005-07-29 | 2007-02-15 | Sony Corp | 移動体制御方法および移動体 |
-
2007
- 2007-10-30 JP JP2007281632A patent/JP5105595B2/ja active Active
Also Published As
Publication number | Publication date |
---|---|
JP2009110249A (ja) | 2009-05-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Khan et al. | A comparative survey of lidar-slam and lidar based sensor technologies | |
CN108475059B (zh) | 自主视觉导航 | |
CN110178048B (zh) | 交通工具环境地图生成和更新的方法和*** | |
EP4009131B1 (en) | Method of navigating a vehicle and system thereof | |
EP2133662B1 (en) | Methods and system of navigation using terrain features | |
CN101900558B (zh) | 集成声纳微导航的自主式水下机器人组合导航方法 | |
KR101439921B1 (ko) | 비젼 센서 정보와 모션 센서 정보를 융합한 모바일 로봇용 slam 시스템 | |
WO2018081186A1 (en) | Method and system for global shape matching a trajectory | |
CN106339001A (zh) | 地图生成方法、移动机器人以及地图生成*** | |
JP2022518911A (ja) | 乗り物のセンサとカメラアレイからの構造化された地図データの生成 | |
JP5105596B2 (ja) | 自律走行移動体の走行経路決定用地図作成装置及び走行経路決定用地図作成方法 | |
KR20150086065A (ko) | 무인운전차량의 자율 주행을 위한 경로 추종 시스템 및 방법 | |
JP7289470B2 (ja) | 三次元空間に対応するマップを生成する車両、及びその方法 | |
CN112292582A (zh) | 用于生成高清晰度地图的方法和*** | |
KR20140144921A (ko) | 가상현실을 이용한 무인 자동차의 자율 주행 시뮬레이션 시스템 | |
JP5105595B2 (ja) | 自律走行移動体の走行経路決定用地図作成装置及び走行経路決定用地図作成方法 | |
CN112506200B (zh) | 机器人定位方法、装置、机器人及存储介质 | |
RU2740229C1 (ru) | Способ локализации и построения навигационных карт мобильного сервисного робота | |
JP2016080460A (ja) | 移動体 | |
CN105556244A (zh) | 用于获取机动车在大地坐标系中的实际位置的方法以及机动车 | |
CN110988949A (zh) | 定位方法、定位装置、计算机可读存储介质与可移动设备 | |
CN117268408A (zh) | 一种激光slam定位方法及*** | |
CN109752016A (zh) | 一种用于无人低速车的平行行驶航线轨迹生成*** | |
Demetriou | A Survey of Sensors for Localization of Unmanned Ground Vehicles (UGVs). | |
CN207882756U (zh) | 一种基于多传感器的移动定位控制*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A711 | Notification of change in applicant |
Free format text: JAPANESE INTERMEDIATE CODE: A711 Effective date: 20090702 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A821 Effective date: 20090702 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20100729 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20120118 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20120118 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20120313 |
|
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: 20120919 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20121001 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5105595 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20151012 Year of fee payment: 3 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |