JPH11249734A - 自律誘導装置 - Google Patents
自律誘導装置Info
- Publication number
- JPH11249734A JPH11249734A JP10051099A JP5109998A JPH11249734A JP H11249734 A JPH11249734 A JP H11249734A JP 10051099 A JP10051099 A JP 10051099A JP 5109998 A JP5109998 A JP 5109998A JP H11249734 A JPH11249734 A JP H11249734A
- Authority
- JP
- Japan
- Prior art keywords
- route
- point
- target
- obstacle
- module
- 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.)
- Withdrawn
Links
- 238000011156 evaluation Methods 0.000 claims abstract description 9
- 238000010586 diagram Methods 0.000 description 8
- 238000001514 detection method Methods 0.000 description 6
- 238000000034 method Methods 0.000 description 6
- 230000010365 information processing Effects 0.000 description 4
- 239000000446 fuel Substances 0.000 description 2
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
(57)【要約】
【課題】 航走前に出発点、到達目標点及び航走海域の
地理が与えられると、自律型水中ロボット自身で出発点
から到達目標点までのコースを設定し、到達目標点まで
自律型水中ロボットを誘導することができる自律誘導装
置を提供する。 【解決手段】 出発点と到達目標点と前記出発点から前
記到達目標点までの周囲の地図とが予め設定された目標
設定モジュール1と、目標設定モジュール1の出発点か
ら到達目標点までの全体経路を予め設定された評価基準
にて設定するグローバルパス計画モジュール2と、グロ
ーバルパス計画モジュール2で設定された全体経路を複
数に分割し分割された範囲毎に局所経路を設定するロー
カルパス計画モジュール3とを具備して自律誘導装置を
構成する。
地理が与えられると、自律型水中ロボット自身で出発点
から到達目標点までのコースを設定し、到達目標点まで
自律型水中ロボットを誘導することができる自律誘導装
置を提供する。 【解決手段】 出発点と到達目標点と前記出発点から前
記到達目標点までの周囲の地図とが予め設定された目標
設定モジュール1と、目標設定モジュール1の出発点か
ら到達目標点までの全体経路を予め設定された評価基準
にて設定するグローバルパス計画モジュール2と、グロ
ーバルパス計画モジュール2で設定された全体経路を複
数に分割し分割された範囲毎に局所経路を設定するロー
カルパス計画モジュール3とを具備して自律誘導装置を
構成する。
Description
【0001】
【発明の属する技術分野】本発明は、出発点と到達目標
点とが与えられた場合に自律型水中ロボットを到達目標
点へ誘導するための自律誘導装置に関するものである。
点とが与えられた場合に自律型水中ロボットを到達目標
点へ誘導するための自律誘導装置に関するものである。
【0002】
【従来の技術】従来、海洋資源探索等に用いられる自律
型水中ロボットを到達目標点まで誘導する場合、図6に
示すように、航走前に予め出発点Sから到達目標点Gま
でのコースR1を設定しておき、そのコースR1を慣性
航法等によりトラッキングさせている。自律型水中ロボ
ットを航走させる海域周辺の地理はほぼわっかているこ
とが多く、予めコースR1を与えることは可能である。
型水中ロボットを到達目標点まで誘導する場合、図6に
示すように、航走前に予め出発点Sから到達目標点Gま
でのコースR1を設定しておき、そのコースR1を慣性
航法等によりトラッキングさせている。自律型水中ロボ
ットを航走させる海域周辺の地理はほぼわっかているこ
とが多く、予めコースR1を与えることは可能である。
【0003】
【発明が解決しようとする課題】しかしながら、この方
法では出発点Sと到達目標点Gを与える毎にオペレータ
によりコースR1を設定する必要がある。さらに、出発
点Sから到達目標点Gまで多数のパスがある場合には、
どのパスを選択すれば良いかを決めるのは容易ではな
い。また、予め与えられたコースR1をトラッキングす
るのみでは、コース途中に予期しない障害物があったと
きには衝突する危険性もある。
法では出発点Sと到達目標点Gを与える毎にオペレータ
によりコースR1を設定する必要がある。さらに、出発
点Sから到達目標点Gまで多数のパスがある場合には、
どのパスを選択すれば良いかを決めるのは容易ではな
い。また、予め与えられたコースR1をトラッキングす
るのみでは、コース途中に予期しない障害物があったと
きには衝突する危険性もある。
【0004】そこで、本発明では、航走前に出発点、到
達目標点及び航走海域の地理が与えられると、自律型水
中ロボット自身で出発点から到達目標点までのコースを
設定し、到達目標点まで自律型水中ロボットを誘導する
ことができる自律誘導装置の提供を課題としている。さ
らに、本発明では、途中に障害物があればそれを回避す
るコースを航走中に再設定し、到達目標点まで自律型水
中ロボットを誘導することができる自律誘導装置の提供
を課題としている。
達目標点及び航走海域の地理が与えられると、自律型水
中ロボット自身で出発点から到達目標点までのコースを
設定し、到達目標点まで自律型水中ロボットを誘導する
ことができる自律誘導装置の提供を課題としている。さ
らに、本発明では、途中に障害物があればそれを回避す
るコースを航走中に再設定し、到達目標点まで自律型水
中ロボットを誘導することができる自律誘導装置の提供
を課題としている。
【0005】
【課題を解決するための手段】上記課題を解決するた
め、本発明においては以下の手段を採用した。請求項1
に記載の自律誘導装置は、出発点と到達目標点と前記出
発点から前記到達目標点までの周囲の地図とが予め設定
された目標設定部と、該目標設定部の前記出発点から前
記到達目標点までの全体経路を予め設定された評価基準
にて設定する全体経路設定部と、該全体経路設定部で設
定された前記全体経路を複数に分割し分割された範囲毎
に局所経路を設定する分割経路設定部とを具備して構成
したことを特徴としている。
め、本発明においては以下の手段を採用した。請求項1
に記載の自律誘導装置は、出発点と到達目標点と前記出
発点から前記到達目標点までの周囲の地図とが予め設定
された目標設定部と、該目標設定部の前記出発点から前
記到達目標点までの全体経路を予め設定された評価基準
にて設定する全体経路設定部と、該全体経路設定部で設
定された前記全体経路を複数に分割し分割された範囲毎
に局所経路を設定する分割経路設定部とを具備して構成
したことを特徴としている。
【0006】この自律誘導装置によれば、出発点、到達
目標点及び航走海域の情報を与えるだけで、自律型水中
ロボットを自動的に出発点から到達目標点まで誘導して
航走させることができる。
目標点及び航走海域の情報を与えるだけで、自律型水中
ロボットを自動的に出発点から到達目標点まで誘導して
航走させることができる。
【0007】請求項2に記載の自律誘導装置は、請求項
1に記載の自律誘導装置に加えて、障害物を検知する障
害物検知手段と、前記障害物を回避するための障害物回
避経路を設定する障害物回避経路設定部と、前記分割経
路設定部で設定した前記局所経路と前記障害物回避経路
設定部で設定した前記障害物回避経路とから進行方向を
決定する進行方向決定部とを具備して構成したことを特
徴としている。
1に記載の自律誘導装置に加えて、障害物を検知する障
害物検知手段と、前記障害物を回避するための障害物回
避経路を設定する障害物回避経路設定部と、前記分割経
路設定部で設定した前記局所経路と前記障害物回避経路
設定部で設定した前記障害物回避経路とから進行方向を
決定する進行方向決定部とを具備して構成したことを特
徴としている。
【0008】この自律誘導装置によれば、出発点、到達
目標点及び航走海域の情報を与えるだけで、自律型水中
ロボットを自動的に出発点から到達目標点まで誘導して
航走させることができるだけでなく、障害物を回避しな
がら航走させることも可能になる。
目標点及び航走海域の情報を与えるだけで、自律型水中
ロボットを自動的に出発点から到達目標点まで誘導して
航走させることができるだけでなく、障害物を回避しな
がら航走させることも可能になる。
【0009】
【発明の実施の形態】以下、本発明による自律誘導装置
の実施の形態を図面に基づいて説明する。図1ないし図
3は第1の実施の形態を示す図である。図1の系統図に
おいて、目標設定部として設けた目標設定モジュール1
には、航走前に自律誘導装置を備えた自律型水中ロボッ
トの出発点S、到達目標点G及び出発点Sから到達目標
点Gまでの航走海域周辺の地理情報がオペレータによっ
て予め与えられている。これらの情報をもとに、全体経
路設定部として設けたグローバルパス計画モジュール2
では出発点Sから到達目標点Gまでの道順、すなわち全
体経路を決定する。この道順の決定は予め設定された評
価基準によってなされる。この評価基準としては、たと
えば燃料消費量や所要時間などの評価値を最適化する方
法が用いられる。このグローバルパス計画モジュール2
での道順の決定は、詳細なコースを決めるのではなく、
図2に示すように、Aの道順で行くかあるいはBの道順
で行くかを決めるというようにおおまかなコースを決め
るものである。このようなおおまかな道順を以下パスク
ラスと表現する。なお、ここまでの処理は航走前に行わ
れる。
の実施の形態を図面に基づいて説明する。図1ないし図
3は第1の実施の形態を示す図である。図1の系統図に
おいて、目標設定部として設けた目標設定モジュール1
には、航走前に自律誘導装置を備えた自律型水中ロボッ
トの出発点S、到達目標点G及び出発点Sから到達目標
点Gまでの航走海域周辺の地理情報がオペレータによっ
て予め与えられている。これらの情報をもとに、全体経
路設定部として設けたグローバルパス計画モジュール2
では出発点Sから到達目標点Gまでの道順、すなわち全
体経路を決定する。この道順の決定は予め設定された評
価基準によってなされる。この評価基準としては、たと
えば燃料消費量や所要時間などの評価値を最適化する方
法が用いられる。このグローバルパス計画モジュール2
での道順の決定は、詳細なコースを決めるのではなく、
図2に示すように、Aの道順で行くかあるいはBの道順
で行くかを決めるというようにおおまかなコースを決め
るものである。このようなおおまかな道順を以下パスク
ラスと表現する。なお、ここまでの処理は航走前に行わ
れる。
【0010】グローバルパス計画モジュール2で決めら
れたパスクラスは、分割経路設定部として設けたローカ
ルパス計画モジュール3へ与えられ、このパスクラスか
らローカルパス計画モジュール3では航走中に自律型水
中ロボットの進むべきコースを設定する。これは、図3
に示すように、局所的に出発点s1と目標点g1とを定
め、その間のコース、すなわち局所経路r1を水中ロボ
ットの運動性能に合わせて決めるものである。これを順
次繰り返しながら最終的な到達目標点であるGに誘導す
る。なお、ローカルパス計画モジュール3からは、設定
したローカルなコース(局所経路r1)をトラッキング
するための目標点g1が時々刻々ルートトラッキングモ
ジュール7へ出力される。
れたパスクラスは、分割経路設定部として設けたローカ
ルパス計画モジュール3へ与えられ、このパスクラスか
らローカルパス計画モジュール3では航走中に自律型水
中ロボットの進むべきコースを設定する。これは、図3
に示すように、局所的に出発点s1と目標点g1とを定
め、その間のコース、すなわち局所経路r1を水中ロボ
ットの運動性能に合わせて決めるものである。これを順
次繰り返しながら最終的な到達目標点であるGに誘導す
る。なお、ローカルパス計画モジュール3からは、設定
したローカルなコース(局所経路r1)をトラッキング
するための目標点g1が時々刻々ルートトラッキングモ
ジュール7へ出力される。
【0011】上述した目標設定モジュール1にこのよう
なグローバルパス計画モジュール2とローカルパス計画
モジュール3とを合わせたものがパス計画モジュール4
となる。
なグローバルパス計画モジュール2とローカルパス計画
モジュール3とを合わせたものがパス計画モジュール4
となる。
【0012】一方、自律型水中ロボットは、姿勢、深
度、高度、速度、位置などを検出するセンサ5を備えて
いる。センサ5の検出信号はセンサ情報処理モジュール
6に取り込まれ、内部で使用する物理値に変換されてル
ートトラッキングモジュール7などに送られる。ルート
トラッキングモジュール7では、これらのセンサ情報の
中から必要な姿勢及び自己位置座標の信号を取り込み、
自律型水中ロボットをローカルパス計画モジュール3か
ら出力されたローカルな目標点g1へ誘導するための方
位を決定して運動制御モジュール8へ出力する。運動制
御モジュール8では、ルートトラッキングモジュール7
から入力された誘導方位と、センサ情報処理モジュール
6から入力された姿勢、深度、高度及び速度などのセン
サ情報を取り込み、自律型水中ロボットが決定された方
位の方向へ進むようにアクチュエータ9へ制御信号を出
力する。
度、高度、速度、位置などを検出するセンサ5を備えて
いる。センサ5の検出信号はセンサ情報処理モジュール
6に取り込まれ、内部で使用する物理値に変換されてル
ートトラッキングモジュール7などに送られる。ルート
トラッキングモジュール7では、これらのセンサ情報の
中から必要な姿勢及び自己位置座標の信号を取り込み、
自律型水中ロボットをローカルパス計画モジュール3か
ら出力されたローカルな目標点g1へ誘導するための方
位を決定して運動制御モジュール8へ出力する。運動制
御モジュール8では、ルートトラッキングモジュール7
から入力された誘導方位と、センサ情報処理モジュール
6から入力された姿勢、深度、高度及び速度などのセン
サ情報を取り込み、自律型水中ロボットが決定された方
位の方向へ進むようにアクチュエータ9へ制御信号を出
力する。
【0013】これにより、自律型水中ロボット自身が出
発点Sから到達目標点Gまでのコースを設定し、そのコ
ースをトラッキングすることにより到達目標点Gへ達す
ることができる。すなわち、オペレータは、自律型水中
ロボットに出発点S、到達目標点G及び航走海域周辺の
地理を与えるだけで、あとは自律型水中ロボツト自身で
処理することができる。
発点Sから到達目標点Gまでのコースを設定し、そのコ
ースをトラッキングすることにより到達目標点Gへ達す
ることができる。すなわち、オペレータは、自律型水中
ロボットに出発点S、到達目標点G及び航走海域周辺の
地理を与えるだけで、あとは自律型水中ロボツト自身で
処理することができる。
【0014】続いて、本発明による自律誘導装置の第2
の実施の形態を図2ないし図5に基づいて説明する。図
5の系統図によれば、目標設定モジュール1には、航走
前に自律誘導装置を備えた自律型水中ロボットの出発点
S、到達目標点G及び出発点Sから到達目標点Gまでの
航走海域周辺の地理情報(図2参照)が第1の実施の形
態と同様にオペレータによって予め与えられている。こ
れらの情報をもとに、グローバルパス計画モジュール2
では出発点Sから到達目標点Gまでの道順(全体経路)
を決定する。この道順の決定は予め設定された評価基準
によってなされるが、たとえば燃料消費量や所要時間な
どの評価値を最適化する方法が評価基準として用いられ
る。このグローバルパス計画モジュール2での道順の決
定は、詳細なコースを決めるのではなく、図2に示すよ
うに、Aの道順で行くかあるいはBの道順で行くかを決
めるというようにおおまかなコースを決めるものであ
る。このようなおおまかな道順はパスクラスと表現され
る。なお、ここまでの処理は第1の実施の形態と同様で
あって、いずれも航走前に行われるものである。
の実施の形態を図2ないし図5に基づいて説明する。図
5の系統図によれば、目標設定モジュール1には、航走
前に自律誘導装置を備えた自律型水中ロボットの出発点
S、到達目標点G及び出発点Sから到達目標点Gまでの
航走海域周辺の地理情報(図2参照)が第1の実施の形
態と同様にオペレータによって予め与えられている。こ
れらの情報をもとに、グローバルパス計画モジュール2
では出発点Sから到達目標点Gまでの道順(全体経路)
を決定する。この道順の決定は予め設定された評価基準
によってなされるが、たとえば燃料消費量や所要時間な
どの評価値を最適化する方法が評価基準として用いられ
る。このグローバルパス計画モジュール2での道順の決
定は、詳細なコースを決めるのではなく、図2に示すよ
うに、Aの道順で行くかあるいはBの道順で行くかを決
めるというようにおおまかなコースを決めるものであ
る。このようなおおまかな道順はパスクラスと表現され
る。なお、ここまでの処理は第1の実施の形態と同様で
あって、いずれも航走前に行われるものである。
【0015】グローバルパス計画モジュール2で決めら
れたパスクラスはローカルパス計画モジュール3へ与え
られ、このパスクラスからローカルパス計画モジュール
3では航走中に自律型水中ロボットの進むべきコースを
設定する。これは、図3に示すように、局所的に出発点
s1と目標点g1とを定め、その間のコース(局所経路
r1)を水中ロボットの運動性能に合わせて決めるもの
である。これを順次繰り返しながら最終的な到達目標点
であるGに誘導する。なお、ローカルパス計画モジュー
ル3からは、設定したローカルなコースをトラッキング
するための目標点g1が時々刻々ルートトラッキングモ
ジュール7へ出力される。
れたパスクラスはローカルパス計画モジュール3へ与え
られ、このパスクラスからローカルパス計画モジュール
3では航走中に自律型水中ロボットの進むべきコースを
設定する。これは、図3に示すように、局所的に出発点
s1と目標点g1とを定め、その間のコース(局所経路
r1)を水中ロボットの運動性能に合わせて決めるもの
である。これを順次繰り返しながら最終的な到達目標点
であるGに誘導する。なお、ローカルパス計画モジュー
ル3からは、設定したローカルなコースをトラッキング
するための目標点g1が時々刻々ルートトラッキングモ
ジュール7へ出力される。
【0016】上述した目標設定モジュール1にこのよう
なグローバルパス計画モジュール2とローカルパス計画
モジュール3とを合わせたものをパス計画モジュール4
とするが、これまでの構成は上述した第1の実施の形態
と同様である。
なグローバルパス計画モジュール2とローカルパス計画
モジュール3とを合わせたものをパス計画モジュール4
とするが、これまでの構成は上述した第1の実施の形態
と同様である。
【0017】一方、自律型水中ロボットは、姿勢、深
度、高度、速度、位置及び障害物などを検出するセンサ
5を備えている。センサ5は障害物検出手段を包含し、
その検出信号はセンサ情報処理モジュール6に取り込ま
れ、内部で使用する物理値に変換されてルートトラッキ
ングモジュール7などに送られる。ルートトラッキング
モジュール7では、これらのセンサ情報の中から必要な
姿勢及び自己位置座標の信号を取り込み、自律型水中ロ
ボットをローカルパス計画モジュール3から出力された
ローカルな目標点g1へ誘導するための方位を決定して
誘導方位合成器11へ出力する。
度、高度、速度、位置及び障害物などを検出するセンサ
5を備えている。センサ5は障害物検出手段を包含し、
その検出信号はセンサ情報処理モジュール6に取り込ま
れ、内部で使用する物理値に変換されてルートトラッキ
ングモジュール7などに送られる。ルートトラッキング
モジュール7では、これらのセンサ情報の中から必要な
姿勢及び自己位置座標の信号を取り込み、自律型水中ロ
ボットをローカルパス計画モジュール3から出力された
ローカルな目標点g1へ誘導するための方位を決定して
誘導方位合成器11へ出力する。
【0018】障害物回避モジュール10も同様に、セン
サ情報の中から必要な障害物探知距離及び障害物探知方
位の信号を取り込んで、障害物を回避する方位を決定し
誘導方位合成器11へ出力する。ルートトラッキングモ
ジュール7と障害物回避モジュール10との出力は誘導
方位合成器11で合成され、自律型水中ロボットが障害
物を回避しつつ目標点g1へ向かうための方位が決定さ
れる。この方位は、図5に示すように、目標点g1に向
かうための方位φ1 と障害物Pを回避するための方位φ
2 とを適当な重み付けを行って合成することにより求め
る。運動制御モジュール8では、誘導方位合成器11か
ら入力された誘導方位に加えて、姿勢、深度、高度及び
速度などのセンサ情報を取り込み、自律型水中ロボット
が決定された方位の方向へ進むようにアクチュエータ9
へ制御信号を出力する。
サ情報の中から必要な障害物探知距離及び障害物探知方
位の信号を取り込んで、障害物を回避する方位を決定し
誘導方位合成器11へ出力する。ルートトラッキングモ
ジュール7と障害物回避モジュール10との出力は誘導
方位合成器11で合成され、自律型水中ロボットが障害
物を回避しつつ目標点g1へ向かうための方位が決定さ
れる。この方位は、図5に示すように、目標点g1に向
かうための方位φ1 と障害物Pを回避するための方位φ
2 とを適当な重み付けを行って合成することにより求め
る。運動制御モジュール8では、誘導方位合成器11か
ら入力された誘導方位に加えて、姿勢、深度、高度及び
速度などのセンサ情報を取り込み、自律型水中ロボット
が決定された方位の方向へ進むようにアクチュエータ9
へ制御信号を出力する。
【0019】これにより、自律型水中ロボツト自身が出
発点Sから到達目標点Gまでのコースを設定し、そのコ
ースをトラッキングすることにより到達目標点Gへ達す
ることができる。また、途中に障害物があれば、その障
害物を回避しつつ目標点へ向かうことができる。すなわ
ち、オペレータは、自律型水中ロボツトに出発点S、到
達目標点G及び航走海域周辺の地理を与えるだけで、あ
とは自律型水中ロボット自身で処理することができる。
発点Sから到達目標点Gまでのコースを設定し、そのコ
ースをトラッキングすることにより到達目標点Gへ達す
ることができる。また、途中に障害物があれば、その障
害物を回避しつつ目標点へ向かうことができる。すなわ
ち、オペレータは、自律型水中ロボツトに出発点S、到
達目標点G及び航走海域周辺の地理を与えるだけで、あ
とは自律型水中ロボット自身で処理することができる。
【0020】
【発明の効果】以上詳述したように、請求項1に記載の
自律誘導装置によれば、自律型水中ロボツト自身が出発
点から到達目標点までのコースを設定するために必要な
出発点、到達目標点及び航走海域周辺の地理情報を設定
する目標設定部と、出発点から到達目標点までのおおま
かな道順(パスクラス)を決定する全体経路設定部と、
パスクラスに基づいてローカルなコース(局所経路)設
定をする分割経路設定部とを備え、全体経路設定部でパ
スクラスを決定し、分割経路設定部で詳細なコースを航
走中に設定できるので、オペレータが出発点、到達目標
点及び航走海域周辺の地理情報を与えるだけで、自律型
水中ロボツト自身により自動的に出発点から到達目標点
まで航走することができるようになる。
自律誘導装置によれば、自律型水中ロボツト自身が出発
点から到達目標点までのコースを設定するために必要な
出発点、到達目標点及び航走海域周辺の地理情報を設定
する目標設定部と、出発点から到達目標点までのおおま
かな道順(パスクラス)を決定する全体経路設定部と、
パスクラスに基づいてローカルなコース(局所経路)設
定をする分割経路設定部とを備え、全体経路設定部でパ
スクラスを決定し、分割経路設定部で詳細なコースを航
走中に設定できるので、オペレータが出発点、到達目標
点及び航走海域周辺の地理情報を与えるだけで、自律型
水中ロボツト自身により自動的に出発点から到達目標点
まで航走することができるようになる。
【0021】また、請求項2に記載の自律誘導装置によ
れば、オペレータが出発点、到達目標点及び航走海域周
辺の地理情報を与えるだけで、自律型水中ロボツト自身
により自動的に出発点から到達目標点まで航走すること
ができるようになるだけでなく、障害物を検知する障害
物検知手段と、障害物を回避するための障害物回避経路
を設定する障害物回避経路設定部と、障害物を回避しつ
つ目標点へ向かうための方位を決定する進行方向決定部
とを備えているので、障害物検出手段からもたらされた
情報を受けて障害物回避経路設定部により障害物を回避
する方位を決定し、進行方向決定部において障害物を回
避する方位が目標点へ誘導する方位と合成されるので、
障害物を回避しつつ目標点へ向かうことができるように
なる。
れば、オペレータが出発点、到達目標点及び航走海域周
辺の地理情報を与えるだけで、自律型水中ロボツト自身
により自動的に出発点から到達目標点まで航走すること
ができるようになるだけでなく、障害物を検知する障害
物検知手段と、障害物を回避するための障害物回避経路
を設定する障害物回避経路設定部と、障害物を回避しつ
つ目標点へ向かうための方位を決定する進行方向決定部
とを備えているので、障害物検出手段からもたらされた
情報を受けて障害物回避経路設定部により障害物を回避
する方位を決定し、進行方向決定部において障害物を回
避する方位が目標点へ誘導する方位と合成されるので、
障害物を回避しつつ目標点へ向かうことができるように
なる。
【図1】本発明の第1の実施の形態に係る自律型水中ロ
ボットの自律誘導装置の全体構成を示す系統図である。
ボットの自律誘導装置の全体構成を示す系統図である。
【図2】図1のグローバルパス計画モジュールの機能を
説明するための図である。
説明するための図である。
【図3】図1のローカルパス計画モジュールの機能を説
明するための図である。
明するための図である。
【図4】本発明の第2の実施の形態に係る自律型水中ロ
ボットの自律誘導装置の全体構成を示す系統図である。
ボットの自律誘導装置の全体構成を示す系統図である。
【図5】障害物回避の方法を説明するための図である。
【図6】従来の自律型水中ロボットの誘導制御方法を説
明するための図である。
明するための図である。
l 目標設定モジュール(目標設定部) 2 グローバルパス計画モジュール(全体経路設定
部) 3 ローカルパス計画モジュール(分割経路設定
部) 4 パス計画モジュール 5 センサ 6 センサ情報処理モジュール 7 ルートトラッキングモジユール 8 運動制御モジュール 9 アクチュエータ 10 障害物回避モジュール(障害物回避経路設定
部) 11 誘導方位合成器(進行方向決定部) S 出発点 G 到達目標点 A,B 全体経路(パスクラス) s1 局所的な出発点 g1 局所的な目標点 r1 局所経路 P 障害物
部) 3 ローカルパス計画モジュール(分割経路設定
部) 4 パス計画モジュール 5 センサ 6 センサ情報処理モジュール 7 ルートトラッキングモジユール 8 運動制御モジュール 9 アクチュエータ 10 障害物回避モジュール(障害物回避経路設定
部) 11 誘導方位合成器(進行方向決定部) S 出発点 G 到達目標点 A,B 全体経路(パスクラス) s1 局所的な出発点 g1 局所的な目標点 r1 局所経路 P 障害物
Claims (2)
- 【請求項1】 出発点と到達目標点と前記出発点から前
記到達目標点までの周囲の地図とが予め設定された目標
設定部と、該目標設定部の前記出発点から前記到達目標
点までの全体経路を予め設定された評価基準にて設定す
る全体経路設定部と、該全体経路設定部で設定された前
記全体経路を複数に分割し分割された範囲毎に局所経路
を設定する分割経路設定部とを具備して構成したことを
特徴とする自律誘導装置。 - 【請求項2】 障害物を検知する障害物検知手段と、前
記障害物を回避するための障害物回避経路を設定する障
害物回避経路設定部と、前記分割経路設定部で設定した
前記局所経路と前記障害物回避経路設定部で設定した前
記障害物回避経路とから進行方向を決定する進行方向決
定部とを具備して構成したことを特徴とする請求項1に
記載の自律誘導装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP10051099A JPH11249734A (ja) | 1998-03-03 | 1998-03-03 | 自律誘導装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP10051099A JPH11249734A (ja) | 1998-03-03 | 1998-03-03 | 自律誘導装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH11249734A true JPH11249734A (ja) | 1999-09-17 |
Family
ID=12877374
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP10051099A Withdrawn JPH11249734A (ja) | 1998-03-03 | 1998-03-03 | 自律誘導装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH11249734A (ja) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007122304A (ja) * | 2005-10-27 | 2007-05-17 | Hitachi Ltd | 移動ロボット |
US7280434B2 (en) | 2004-03-26 | 2007-10-09 | Samsung Electronics Co., Ltd. | Method, medium, and apparatus for global localization |
JP2008052473A (ja) * | 2006-08-24 | 2008-03-06 | Nippon Telegr & Teleph Corp <Ntt> | 水中ロボットの動作制御方法、装置、プログラム及びその記録媒体 |
JP2009288976A (ja) * | 2008-05-28 | 2009-12-10 | Ihi Corp | 無人搬送装置とその搬送経路決定方法 |
JP2013033356A (ja) * | 2011-08-01 | 2013-02-14 | Toyota Central R&D Labs Inc | 自律移動装置 |
WO2013039222A1 (ja) | 2011-09-16 | 2013-03-21 | 国立大学法人東京海洋大学 | 水中通信システム |
CN108762281A (zh) * | 2018-06-08 | 2018-11-06 | 哈尔滨工程大学 | 一种基于记忆关联强化学习的嵌入式实时水下机器人智能决策方法 |
CN109471446A (zh) * | 2018-11-08 | 2019-03-15 | 淮阴师范学院 | 一种基于神经网络的全覆盖路径规划方法 |
CN113721615A (zh) * | 2021-08-27 | 2021-11-30 | 广州大学 | 一种基于机器视觉的海航路径规划方法及*** |
CN113791627A (zh) * | 2021-11-16 | 2021-12-14 | 中国科学院自动化研究所 | 一种机器人导航方法、设备、介质和产品 |
JP2022529776A (ja) * | 2019-04-24 | 2022-06-24 | イントリンジック イノベーション エルエルシー | ロボットの運動計画 |
-
1998
- 1998-03-03 JP JP10051099A patent/JPH11249734A/ja not_active Withdrawn
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7280434B2 (en) | 2004-03-26 | 2007-10-09 | Samsung Electronics Co., Ltd. | Method, medium, and apparatus for global localization |
JP2007122304A (ja) * | 2005-10-27 | 2007-05-17 | Hitachi Ltd | 移動ロボット |
US8036775B2 (en) | 2005-10-27 | 2011-10-11 | Hitachi, Ltd. | Obstacle avoidance system for a user guided mobile robot |
JP2008052473A (ja) * | 2006-08-24 | 2008-03-06 | Nippon Telegr & Teleph Corp <Ntt> | 水中ロボットの動作制御方法、装置、プログラム及びその記録媒体 |
JP2009288976A (ja) * | 2008-05-28 | 2009-12-10 | Ihi Corp | 無人搬送装置とその搬送経路決定方法 |
JP2013033356A (ja) * | 2011-08-01 | 2013-02-14 | Toyota Central R&D Labs Inc | 自律移動装置 |
WO2013039222A1 (ja) | 2011-09-16 | 2013-03-21 | 国立大学法人東京海洋大学 | 水中通信システム |
US9306677B2 (en) | 2011-09-16 | 2016-04-05 | National University Corporation Tokyo University Of Marine Science And Technology | Underwater communication system |
CN108762281A (zh) * | 2018-06-08 | 2018-11-06 | 哈尔滨工程大学 | 一种基于记忆关联强化学习的嵌入式实时水下机器人智能决策方法 |
CN109471446A (zh) * | 2018-11-08 | 2019-03-15 | 淮阴师范学院 | 一种基于神经网络的全覆盖路径规划方法 |
JP2022529776A (ja) * | 2019-04-24 | 2022-06-24 | イントリンジック イノベーション エルエルシー | ロボットの運動計画 |
US11833694B2 (en) | 2019-04-24 | 2023-12-05 | Intrinsic Innovation Llc | Robot motion planning |
CN113721615A (zh) * | 2021-08-27 | 2021-11-30 | 广州大学 | 一种基于机器视觉的海航路径规划方法及*** |
CN113721615B (zh) * | 2021-08-27 | 2023-08-15 | 广州大学 | 一种基于机器视觉的海航路径规划方法及*** |
CN113791627A (zh) * | 2021-11-16 | 2021-12-14 | 中国科学院自动化研究所 | 一种机器人导航方法、设备、介质和产品 |
CN113791627B (zh) * | 2021-11-16 | 2022-02-11 | 中国科学院自动化研究所 | 一种机器人导航方法、设备、介质和产品 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108445879B (zh) | 一种基于预测碰撞危险区域的无人艇避障方法 | |
JP7083081B2 (ja) | 自動着岸装置 | |
CN111746736B (zh) | 船舶导航***及其导航方法 | |
EP3408720B1 (en) | Autonomous operation of a vessel | |
KR101831264B1 (ko) | 조종가능 플랫폼용의 자율 항해 시스템 및 방법 | |
CN108664020A (zh) | 一种基于速度障碍法和动态窗口法的无人艇动态避障算法 | |
US10114373B2 (en) | Navigation system with trajectory calculation mechanism and method of operation thereof | |
CN110727282B (zh) | Auv的对接方法、装置及水下对接*** | |
US5416713A (en) | Obstacle avoidance apparatus | |
JPH11249734A (ja) | 自律誘導装置 | |
US20180057131A1 (en) | Trolling motor with wind sensor | |
JP6977266B2 (ja) | 水中捜索方法および水中捜索システム | |
CN110702112A (zh) | 导航装置及路线生成方法 | |
CN111665868A (zh) | 基于虚拟航道的无人船返航方法、装置、设备及存储介质 | |
JP2017151499A (ja) | 障害物回避方法および装置 | |
JP6946026B2 (ja) | 航走制御装置、航走体監視システム、水上航走体の航走制御方法、およびプログラム | |
JP2021157493A (ja) | 自律飛行体及び飛行制御方法 | |
JP2005071114A (ja) | 車両の誘導制御装置 | |
JPH07304495A (ja) | 避航支援装置 | |
JP2003279361A (ja) | カーナビゲーションシステム及び方法並びにナビゲーション用プログラム | |
JP4983577B2 (ja) | 編隊航行時の旋回方法とその編隊 | |
JPWO2020111044A1 (ja) | 制御目標生成装置及び操船制御装置 | |
JP2000009480A (ja) | 位置情報表示装置 | |
KR20220132910A (ko) | 자율운항선박의 충돌회피 시스템 | |
US10788839B2 (en) | Planning-control collaboration design for low cost autonomous driving technology |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A300 | Application deemed to be withdrawn because no request for examination was validly filed |
Free format text: JAPANESE INTERMEDIATE CODE: A300 Effective date: 20050510 |