ホーム > 特許ランキング > ヤマハ発動機株式会社
(19)【発行国】日本国特許庁(JP)
(12)【公報種別】特許公報(B2)
(11)【特許番号】
(24)【登録日】2024-10-07
(45)【発行日】2024-10-16
(54)【発明の名称】既定ルート走行車両
(51)【国際特許分類】
G05D 1/43 20240101AFI20241008BHJP
【ＦＩ】
G05D1/43
【請求項の数】
14
(21)【出願番号】P 2023037696
(22)【出願日】2023-03-10
(62)【分割の表示】P 2021507254の分割
【原出願日】2020-03-11
(65)【公開番号】P2023060344
(43)【公開日】2023-04-27
【審査請求日】2023-03-10
(31)【優先権主張番号】P 2019048436
(32)【優先日】2019-03-15
(33)【優先権主張国・地域又は機関】JP
(73)【特許権者】
【識別番号】000010076
【氏名又は名称】ヤマハ発動機株式会社
(74)【代理人】
【識別番号】110001841
【氏名又は名称】弁理士法人ＡＴＥＮ
(72)【発明者】
【氏名】山崎 章弘
【審査官】稲垣 浩司
(56)【参考文献】
【文献】特開２０１７－３７３９８（ＪＰ，Ａ）
【文献】特開平４－１８１３０５（ＪＰ，Ａ）
【文献】特開平５－２０５１９８（ＪＰ，Ａ）
(58)【調査した分野】(Int.Cl.，ＤＢ名)
Ｇ０５Ｄ １／００ － １／８７
(57)【特許請求の範囲】
【請求項1】
既定ルートを走行する既定ルート走行車両において、４０°以上９０°以下の水平画角で撮像する撮像装置と、
前記既定ルートの路面における自車の将来の走行位置が前記撮像装置の撮像範囲に含まれるように、自車の車両上下方向に沿った揺動軸線を中心に前記撮像装置を車体に対して揺動させる揺動装置と、
揺動する前記撮像装置により撮像された画像中の前記既定ルートの前記路面の位置を推定するための路面位置関連情報を取得する路面位置関連情報取得部と、
前記揺動装置による前記撮像装置の揺動を制御し、前記路面位置関連情報取得部が取得した前記路面位置関連情報および前記撮像装置の前記揺動軸線を中心とした現在の揺動角度に関連する情報に基づいて、揺動する前記撮像装置によって撮像された前記画像中の前記既定ルートの前記路面の位置を推定し、前記画像中の推定された前記既定ルートの前記路面の位置に基づいて、前記画像中の前記既定ルートの前記路面上の障害物を検出する制御装置とを有することを特徴とする既定ルート走行車両。
【請求項2】
前記制御装置は、自車の使用中に前記撮像装置により撮像された前記画像に基づかずに、自車の進行方向を制御することを特徴とする請求項１に記載の既定ルート走行車両。
【請求項3】
前記制御装置は、前記揺動軸線を中心とした３０°以上１８０°以下の揺動角度範囲内で前記撮像装置が揺動するように、前記揺動装置を制御することを特徴とする請求項１または２に記載の既定ルート走行車両。
【請求項4】
前記既定ルートの前記路面の形状の情報と、前記既定ルートの前記路面上の複数の位置の相対位置情報または絶対位置情報とを含む第１既定ルート地図情報を予め記憶する記憶部を有し、前記制御装置は、前記既定ルートの前記路面における自車の現在位置を推定し、
前記制御装置は、前記既定ルートの前記路面における自車の将来の走行位置が前記撮像装置の撮像範囲に含まれるように、前記記憶部に記憶された前記第１既定ルート地図情報、および、前記制御装置によって推定された自車の現在位置に基づいて、前記揺動装置の目標揺動角度を設定し、
前記揺動装置は、前記制御装置によって設定された前記目標揺動角度に基づいて、前記揺動軸線を中心に前記撮像装置を揺動させることを特徴とする請求項１～３のいずれか１項に記載の既定ルート走行車両。
【請求項5】
自車の使用中に、自車の将来の走行位置を含む前記既定ルートの前記路面の一部分の形状の情報を取得する路面形状情報取得部を有し、前記制御装置は、前記既定ルートの前記路面における自車の将来の走行位置が前記撮像装置の撮像範囲に含まれるように、前記路面形状情報取得部が取得した前記既定ルートの前記路面の前記一部分の形状の情報に基づいて、前記揺動装置の目標揺動角度を設定し、
前記揺動装置は、前記制御装置によって設定された前記目標揺動角度に基づいて、前記揺動軸線を中心に前記撮像装置を揺動させることを特徴とする請求項１～３のいずれか１項に記載の既定ルート走行車両。
【請求項6】
前記制御装置は、前記既定ルートの前記路面における自車の将来の走行位置が前記撮像装置の撮像範囲に含まれるように、自車の使用中に自車が取得した前記揺動装置の目標揺動角度に基づいて、前記揺動軸線を中心に前記撮像装置を揺動させることを特徴とする請求項１～３のいずれか１項に記載の既定ルート走行車両。
【請求項7】
前記路面位置関連情報取得部が、前記路面位置関連情報を予め記憶する記憶部であることを特徴とする請求項１～６のいずれか一項に記載の既定ルート走行車両。
【請求項8】
前記路面位置関連情報取得部は、前記路面位置関連情報として、前記既定ルートの前記路面の形状および幅の情報と、前記既定ルートの前記路面上の複数の位置の相対位置情報または絶対位置情報とを含む第２既定ルート地図情報を予め記憶し、前記制御装置は、前記既定ルートの前記路面における自車の現在位置を推定し、
前記制御装置は、前記路面位置関連情報取得部に記憶された前記第２既定ルート地図情報、前記制御装置によって推定された自車の現在位置、および、前記撮像装置の前記揺動軸線を中心とした現在の揺動角度に関連する情報に基づいて、揺動する前記撮像装置により撮像された前記画像中の前記既定ルートの前記路面の位置を推定することを特徴とする請求項７に記載の既定ルート走行車両。
【請求項9】
前記路面位置関連情報取得部は、前記路面位置関連情報として、前記撮像装置によって撮像された画像に投影可能な前記既定ルートの前記路面の３次元情報である３次元路面情報と、前記既定ルートの前記路面上の複数の位置の相対位置情報または絶対位置情報とを予め記憶し、前記制御装置は、前記既定ルートの前記路面における自車の現在位置を推定し、
前記制御装置は、前記路面位置関連情報取得部に記憶された前記３次元路面情報、前記路面位置関連情報取得部に記憶された前記既定ルートの前記路面上の複数の位置の相対位置情報または絶対位置情報、前記制御装置によって推定された自車の現在位置、および、前記撮像装置の前記揺動軸線を中心とした現在の揺動角度に関連する情報に基づいて、揺動する前記撮像装置により撮像された前記画像中の前記既定ルートの前記路面の位置を推定することを特徴とする請求項７に記載の既定ルート走行車両。
【請求項10】
前記路面位置関連情報取得部が、自車の使用中に前記路面位置関連情報を取得することを特徴とする請求項１～６のいずれか一項に記載の既定ルート走行車両。
【請求項11】
前記路面位置関連情報取得部は、自車の使用中に、前記路面位置関連情報として、自車の将来の走行位置を含む前記既定ルートの前記路面の一部分の形状の情報を取得し、前記既定ルートの前記路面の幅の情報を予め記憶する記憶部を有し、
前記制御装置は、前記記憶部に記憶された前記既定ルートの前記路面の幅の情報、前記路面位置関連情報取得部が取得した前記既定ルートの前記路面の前記一部分の形状の情報、および、前記撮像装置の前記揺動軸線を中心とした現在の揺動角度に関連する情報に基づいて、揺動する前記撮像装置により撮像された前記画像中の前記既定ルートの前記路面の位置を推定することを特徴とする請求項１０に記載の既定ルート走行車両。
【請求項12】
前記路面位置関連情報取得部は、自車の使用中に、前記路面位置関連情報として、自車の将来の走行位置を含む前記既定ルートの前記路面の一部分の形状および幅の情報を取得し、前記制御装置は、前記路面位置関連情報取得部が取得した前記既定ルートの前記路面の前記一部分の形状および幅の情報、および、前記撮像装置の前記揺動軸線を中心とした現在の揺動角度に関連する情報に基づいて、揺動する前記撮像装置により撮像された前記画像中の前記既定ルートの前記路面の位置を推定することを特徴とする請求項１０に記載の既定ルート走行車両。
【請求項13】
前記撮像装置が、左画像センサと、前記左画像センサから車両右方向に離れた位置に配置される右画像センサとを有するステレオカメラであることを特徴とする請求項１～８、１０～１２のいずれか一項に記載の既定ルート走行車両。
【請求項14】
前記制御装置は、前記画像中の前記既定ルートの前記路面上の前記障害物を検出した場合に、自車の速度を低下させる、または、自車の走行を停止させることを特徴とする請求項１～１３のいずれか一項に記載の既定ルート走行車両。
【発明の詳細な説明】
【技術分野】
【0001】
本発明は、既定ルートを走行する既定ルート走行車両に関する。
【背景技術】
【0002】
既定ルートを走行する既定ルート走行車両として、例えば特許文献１に記載されたゴルフカーがある。特許文献１に記載されたゴルフカーでは、撮像装置で撮像した画像に基づいて、既定ルートの路面上の障害物を検出している。
【先行技術文献】
【特許文献】
【0003】
【文献】特開２０１６－１６４７３５号公報
【発明の概要】
【発明が解決しようとする課題】
【0004】
一般的に、ゴルフカーは、走行速度が遅い。そのため、ゴルフカーは、曲率半径の小さいカーブでも走行できる。仮に、特許文献１の撮像装置の水平画角が小さいと、撮像装置の撮像範囲が小さくなる。そのため、曲率半径の小さいカーブを走行する際、既定ルートの路面上の障害物を検出することが難しい場合がある。もしくは、ゴルフカーが障害物にかなり接近するまで、既定ルートの路面上の障害物を検出することが難しい場合がある。
【0005】
そのため、特許文献１のゴルフカーが曲率半径の小さいカーブを走行する場合に、ゴルフカーが既定ルートの路面上の障害物に接近する前に障害物を検出するためには、撮像装置の水平画角を大きく設定する必要がある。
【0006】
その一方、撮像装置を用いた既定ルートの路面上の障害物の検出において、確実に検出可能な障害物とゴルフカーとの距離の拡大が求められている。言い換えると、自車からより遠い障害物を高精度に検出することが求められている。しかし、撮像装置の水平画角が大きいほど、撮像装置から遠い対象物の位置を正確に検出することが難しくなるため、自車から遠い障害物の検出精度は低くなる。また、撮像装置の水平画角が大きいほど、撮像装置から遠い対象物を検出すること自体も難しくなるため、自車から遠い障害物の検出率も低くなる。つまり、撮像装置を用いた既定ルートの路面上の障害物の検出において、自車から遠い障害物の検出精度および検出率を高めることと、曲率半径の小さいカーブを走行する場合に障害物に接近する前に障害物を検出することとは、両立が困難である。
【0007】
本発明は、既定ルートの路面上にあって既定ルート走行車両から遠い障害物の検出精度および検出率を向上できるとともに、曲率半径の小さいカーブを走行中であっても既定ルート走行車両が路面上の障害物に接近する前に障害物を検出可能な、既定ルート走行車両を提供することを目的とする。
【課題を解決するための手段】
【0008】
（１）本発明は、既定ルートを走行する既定ルート走行車両において、４０°以上９０°以下の水平画角で撮像する撮像装置と、前記既定ルートの路面における自車の将来の走行位置が前記撮像装置の撮像範囲に含まれるように、自車の車両上下方向に沿った揺動軸線を中心に前記撮像装置を車体に対して揺動させる揺動装置と、揺動する前記撮像装置により撮像された画像中の前記既定ルートの前記路面の位置を推定するための路面位置関連情報を取得する路面位置関連情報取得部と、前記揺動装置による前記撮像装置の揺動を制御し、前記路面位置関連情報取得部が取得した前記路面位置関連情報に基づいて、揺動する前記撮像装置によって撮像された前記画像中の前記既定ルートの前記路面の位置を推定し、前記画像中の推定された前記既定ルートの前記路面の位置に基づいて、前記画像中の前記既定ルートの前記路面上の障害物を検出し、自車の使用中に前記撮像装置により撮像された前記画像に基づかずに、自車の進行方向を制御する制御装置とを有することを特徴とする。
【0009】
この構成によると、既定ルートを走行する既定ルート走行車両は、撮像装置と、揺動装置と、路面位置関連情報取得部と、制御装置とを有する。撮像装置は、４０°以上９０°以下の水平画角で撮像する。つまり、撮像装置の水平画角は比較的小さい。言い替えると、撮像装置の撮像範囲が比較的小さい。揺動装置は、既定ルートの路面における既定ルート走行車両の将来の走行位置が撮像装置の撮像範囲に含まれるように、既定ルート走行車両の車両上下方向に沿った揺動軸線を中心に撮像装置を揺動させる。そのため、撮像装置の水平画角が小さくても、既定ルート走行車両が曲率半径の小さいカーブを走行する場合に、撮像装置の撮像範囲に、既定ルートの路面における将来の走行位置を確実に含めることができる。路面位置関連情報取得部は、路面位置関連情報を取得する。路面位置関連情報は、揺動する撮像装置により撮像された画像中の既定ルートの路面の位置を推定するための情報である。制御装置は、路面位置関連情報取得部が取得した路面位置関連情報に基づいて、揺動する撮像装置によって撮像された画像中の既定ルートの路面の位置を推定する。制御装置は、画像中の推定された既定ルートの路面の位置に基づいて、画像中の既定ルートの路面上の障害物を検出する。これにより、撮像装置の水平画角が小さいにも関わらず、曲率半径の小さいカーブを走行する場合に、既定ルート走行車両が既定ルートの路面上の障害物に接近する前に障害物を検出できる。しかも、撮像装置の水平画角が小さいことにより、既定ルートの路面上にあって既定ルート走行車両から遠い障害物の検出精度および検出率を向上できる。
以上のように、既定ルートの路面上にあって既定ルート走行車両から遠い障害物の検出精度および検出率を向上できるとともに、曲率半径の小さいカーブを走行中であっても既定ルート走行車両が既定ルートの路面上の障害物に接近する前に障害物を検出できる。
以上のように、既定ルートの路面上にあって既定ルート走行車両から遠い障害物の検出精度および検出率を向上できるとともに、曲率半径の小さいカーブを走行中であっても既定ルート走行車両が既定ルートの路面上の障害物に接近する前に障害物を検出できる。
【0010】
（２）本発明は、既定ルートを走行する既定ルート走行車両において、４０°以上９０°以下の水平画角で撮像する撮像装置と、前記既定ルートの路面における自車の将来の走行位置が前記撮像装置の撮像範囲に含まれるように、自車の車両上下方向に沿った揺動軸線を中心に前記撮像装置を車体に対して揺動させる揺動装置と、揺動する前記撮像装置により撮像された画像中の前記既定ルートの前記路面の位置を推定するための路面位置関連情報を取得する路面位置関連情報取得部と、前記揺動装置による前記撮像装置の揺動を制御し、前記路面位置関連情報取得部が取得した前記路面位置関連情報および前記撮像装置の前記揺動軸線を中心とした現在の揺動角度に関連する情報に基づいて、揺動する前記撮像装置によって撮像された前記画像中の前記既定ルートの前記路面の位置を推定し、前記画像中の推定された前記既定ルートの前記路面の位置に基づいて、前記画像中の前記既定ルートの前記路面上の障害物を検出する制御装置とを有することを特徴とする。
【0011】
この構成によると、既定ルートを走行する既定ルート走行車両は、撮像装置と、揺動装置と、路面位置関連情報取得部と、制御装置とを有する。撮像装置は、４０°以上９０°以下の水平画角で撮像する。つまり、撮像装置の水平画角は比較的小さい。言い替えると、撮像装置の撮像範囲が比較的小さい。揺動装置は、既定ルートの路面における既定ルート走行車両の将来の走行位置が撮像装置の撮像範囲に含まれるように、既定ルート走行車両の車両上下方向に沿った揺動軸線を中心に撮像装置を揺動させる。そのため、撮像装置の水平画角が小さくても、既定ルート走行車両が曲率半径の小さいカーブを走行する場合に、撮像装置の撮像範囲に、既定ルートの路面における将来の走行位置を確実に含めることができる。路面位置関連情報取得部は、路面位置関連情報を取得する。路面位置関連情報は、揺動する撮像装置により撮像された画像中の既定ルートの路面の位置を推定するための情報である。制御装置は、路面位置関連情報取得部が取得した路面位置関連情報および撮像装置の揺動軸線を中心とした現在の揺動角度に関連する情報に基づいて、揺動する撮像装置によって撮像された画像中の既定ルートの路面の位置を推定する。制御装置は、画像中の推定された既定ルートの路面の位置に基づいて、画像中の既定ルートの路面上の障害物を検出する。これにより、撮像装置の水平画角が小さいにも関わらず、曲率半径の小さいカーブを走行する場合に、既定ルート走行車両が既定ルートの路面上の障害物に接近する前に障害物を検出できる。しかも、撮像装置の水平画角が小さいことにより、既定ルートの路面上にあって既定ルート走行車両から遠い障害物の検出精度および検出率を向上できる。
以上のように、既定ルートの路面上にあって既定ルート走行車両から遠い障害物の検出精度および検出率を向上できるとともに、曲率半径の小さいカーブを走行中であっても既定ルート走行車両が既定ルートの路面上の障害物に接近する前に障害物を検出できる。
以上のように、既定ルートの路面上にあって既定ルート走行車両から遠い障害物の検出精度および検出率を向上できるとともに、曲率半径の小さいカーブを走行中であっても既定ルート走行車両が既定ルートの路面上の障害物に接近する前に障害物を検出できる。
【0012】
（３）本発明の１つの観点によると、本発明の既定ルート走行車両は、上記（１）または（２）の構成に加えて、以下の構成を有することが好ましい。
前記制御装置は、前記揺動軸線を中心とした３０°以上１８０°以下の揺動角度範囲内で前記撮像装置が揺動するように、前記揺動装置を制御する。
前記制御装置は、前記揺動軸線を中心とした３０°以上１８０°以下の揺動角度範囲内で前記撮像装置が揺動するように、前記揺動装置を制御する。
【0013】
この構成によると、揺動角度範囲が３０°以上と比較的大きい。そのため、撮像装置の水平画角が小さくても、既定ルート走行車両が曲率半径の小さいカーブを走行する場合に、撮像装置の撮像範囲に、既定ルートの路面における将来の走行位置をより確実に含めることができる。
【0014】
（４）本発明の１つの観点によると、本発明の既定ルート走行車両は、上記（１）～（３）のいずれかの構成に加えて、以下の構成を有することが好ましい。
前記既定ルートの前記路面の形状の情報と、前記既定ルートの前記路面上の複数の位置の相対位置情報または絶対位置情報とを含む第１既定ルート地図情報を予め記憶する記憶部を有し、前記制御装置は、前記既定ルートの前記路面における自車の現在位置を推定し、前記制御装置は、前記既定ルートの前記路面における自車の将来の走行位置が前記撮像装置の撮像範囲に含まれるように、前記記憶部に記憶された前記第１既定ルート地図情報、および、前記制御装置によって推定された自車の現在位置に基づいて、前記揺動装置の目標揺動角度を設定し、前記揺動装置は、前記制御装置によって設定された前記目標揺動角度に基づいて、前記揺動軸線を中心に前記撮像装置を揺動させる。
前記既定ルートの前記路面の形状の情報と、前記既定ルートの前記路面上の複数の位置の相対位置情報または絶対位置情報とを含む第１既定ルート地図情報を予め記憶する記憶部を有し、前記制御装置は、前記既定ルートの前記路面における自車の現在位置を推定し、前記制御装置は、前記既定ルートの前記路面における自車の将来の走行位置が前記撮像装置の撮像範囲に含まれるように、前記記憶部に記憶された前記第１既定ルート地図情報、および、前記制御装置によって推定された自車の現在位置に基づいて、前記揺動装置の目標揺動角度を設定し、前記揺動装置は、前記制御装置によって設定された前記目標揺動角度に基づいて、前記揺動軸線を中心に前記撮像装置を揺動させる。
【0015】
この構成によると、制御装置は、記憶部に記憶された第１既定ルート地図情報、および、制御装置によって推定された現在位置に基づいて、揺動装置の目標揺動角度を設定する。これにより、既定ルート走行車両の使用中に既定ルート走行車両が目標揺動角度の情報を取得する場合に比べて、既定ルート走行車両が使用中に取得する情報量を抑えつつ、目標揺動角度をより細かく設定することができる。それにより、撮像された画像内の好適な位置に既定ルートの路面をより確実に含ませることができる。その結果、既定ルートの路面上にあって既定ルート走行車両から遠い障害物の検出精度および検出率をより向上できる。
【0016】
（５）本発明の１つの観点によると、本発明の既定ルート走行車両は、上記（１）～（３）のいずれかの構成に加えて、以下の構成を有することが好ましい。
自車の使用中に、自車の将来の走行位置を含む前記既定ルートの前記路面の一部分の形状の情報を、取得する路面形状情報取得部を有し、前記制御装置は、前記既定ルートの前記路面における自車の将来の走行位置が前記撮像装置の撮像範囲に含まれるように、前記路面形状情報取得部が取得した前記既定ルートの前記路面の前記一部分の形状の情報に基づいて、前記揺動装置の目標揺動角度を設定し、前記揺動装置は、前記制御装置によって設定された前記目標揺動角度に基づいて、前記揺動軸線を中心に前記撮像装置を揺動させる。
自車の使用中に、自車の将来の走行位置を含む前記既定ルートの前記路面の一部分の形状の情報を、取得する路面形状情報取得部を有し、前記制御装置は、前記既定ルートの前記路面における自車の将来の走行位置が前記撮像装置の撮像範囲に含まれるように、前記路面形状情報取得部が取得した前記既定ルートの前記路面の前記一部分の形状の情報に基づいて、前記揺動装置の目標揺動角度を設定し、前記揺動装置は、前記制御装置によって設定された前記目標揺動角度に基づいて、前記揺動軸線を中心に前記撮像装置を揺動させる。
【0017】
この構成によると、撮像装置の目標揺動角度の設定のための現在位置の推定が不要である。
【0018】
（６）本発明の１つの観点によると、本発明の既定ルート走行車両は、上記（１）～（３）のいずれかの構成に加えて、以下の構成を有することが好ましい。
前記制御装置は、前記既定ルートの前記路面における自車の将来の走行位置が前記撮像装置の撮像範囲に含まれるように、自車の使用中に自車が取得した前記揺動装置の目標揺動角度に基づいて、前記揺動軸線を中心に前記撮像装置を揺動させる。
前記制御装置は、前記既定ルートの前記路面における自車の将来の走行位置が前記撮像装置の撮像範囲に含まれるように、自車の使用中に自車が取得した前記揺動装置の目標揺動角度に基づいて、前記揺動軸線を中心に前記撮像装置を揺動させる。
【0019】
この構成によると、撮像装置の目標揺動角度の設定のための現在位置の推定が不要でありながら、撮像装置の目標揺動角度を細かく設定できる。
【0020】
（７）本発明の１つの観点によると、本発明の既定ルート走行車両は、上記（１）～（６）のいずれかの構成に加えて、以下の構成を有することが好ましい。
前記路面位置関連情報取得部が、前記路面位置関連情報を予め記憶する記憶部である。
前記路面位置関連情報取得部が、前記路面位置関連情報を予め記憶する記憶部である。
【0021】
この構成によると、路面位置関連情報取得部は、路面位置関連情報を予め記憶する。これにより、既定ルート走行車両の使用中に既定ルート走行車両が路面位置関連情報を取得する場合に比べて、既定ルート走行車両の使用中に取得する情報量を抑えつつ、路面位置関連情報をより細かく取得することができる。制御装置は、このように取得された路面位置関連情報を用いて、既定ルートの路面上の障害物を検出する。そのため、既定ルートの路面上にあって既定ルート走行車両から遠い障害物の検出精度および検出率をより向上できる。
【0022】
（８）本発明の１つの観点によると、本発明の既定ルート走行車両は、上記（７）の構成に加えて、以下の構成を有することが好ましい。
前記路面位置関連情報取得部は、前記路面位置関連情報として、前記既定ルートの前記路面の形状および幅の情報と、前記既定ルートの前記路面上の複数の位置の相対位置情報または絶対位置情報とを含む第２既定ルート地図情報を予め記憶し、前記制御装置は、前記既定ルートの前記路面における自車の現在位置を推定し、前記制御装置は、前記路面位置関連情報取得部に記憶された前記第２既定ルート地図情報、前記制御装置によって推定された自車の現在位置、および、前記撮像装置の前記揺動軸線を中心とした現在の揺動角度に関連する情報に基づいて、揺動する前記撮像装置により撮像された前記画像中の前記既定ルートの前記路面の位置を推定する。
前記路面位置関連情報取得部は、前記路面位置関連情報として、前記既定ルートの前記路面の形状および幅の情報と、前記既定ルートの前記路面上の複数の位置の相対位置情報または絶対位置情報とを含む第２既定ルート地図情報を予め記憶し、前記制御装置は、前記既定ルートの前記路面における自車の現在位置を推定し、前記制御装置は、前記路面位置関連情報取得部に記憶された前記第２既定ルート地図情報、前記制御装置によって推定された自車の現在位置、および、前記撮像装置の前記揺動軸線を中心とした現在の揺動角度に関連する情報に基づいて、揺動する前記撮像装置により撮像された前記画像中の前記既定ルートの前記路面の位置を推定する。
【0023】
この構成によると、路面位置関連情報取得部は、路面位置関連情報として、既定ルートの路面の形状および幅の情報と、既定ルートの路面上の複数の位置の相対位置情報または絶対位置情報とを含む第２既定ルート地図情報を予め記憶する。そのため、制御装置は、予め記憶された路面位置関連情報（第２既定ルート地図情報）、制御装置によって推定された既定ルート走行車両の現在位置、および、撮像装置の現在の揺動角度に関連する情報に基づいて、撮像装置により撮像された画像中の既定ルートの路面の位置を推定することができる。
【0024】
（９）本発明の１つの観点によると、本発明の既定ルート走行車両は、上記（７）の構成に加えて、以下の構成を有することが好ましい。
前記路面位置関連情報取得部は、前記路面位置関連情報として、前記撮像装置によって撮像された画像に投影可能な前記既定ルートの前記路面の３次元情報である３次元路面情報と、前記既定ルートの前記路面上の複数の位置の相対位置情報または絶対位置情報とを予め記憶し、前記制御装置は、前記既定ルートの前記路面における自車の現在位置を推定し、前記制御装置は、前記路面位置関連情報取得部に記憶された前記３次元路面情報、前記路面位置関連情報取得部に記憶された前記既定ルートの前記路面上の複数の位置の相対位置情報または絶対位置情報、前記制御装置によって推定された自車の現在位置、および、前記撮像装置の前記揺動軸線を中心とした現在の揺動角度に関連する情報に基づいて、揺動する前記撮像装置により撮像された前記画像中の前記既定ルートの前記路面の位置を推定する。
前記路面位置関連情報取得部は、前記路面位置関連情報として、前記撮像装置によって撮像された画像に投影可能な前記既定ルートの前記路面の３次元情報である３次元路面情報と、前記既定ルートの前記路面上の複数の位置の相対位置情報または絶対位置情報とを予め記憶し、前記制御装置は、前記既定ルートの前記路面における自車の現在位置を推定し、前記制御装置は、前記路面位置関連情報取得部に記憶された前記３次元路面情報、前記路面位置関連情報取得部に記憶された前記既定ルートの前記路面上の複数の位置の相対位置情報または絶対位置情報、前記制御装置によって推定された自車の現在位置、および、前記撮像装置の前記揺動軸線を中心とした現在の揺動角度に関連する情報に基づいて、揺動する前記撮像装置により撮像された前記画像中の前記既定ルートの前記路面の位置を推定する。
【0025】
この構成によると、制御装置は、路面位置関連情報取得部に記憶された路面位置関連情報、制御装置によって推定された既定ルート走行車両の現在位置、および、撮像装置の現在の揺動角度に関連する情報に基づいて、撮像装置により撮像された画像中の既定ルートの路面の位置を推定する。これにより、既定ルート走行車両の使用中に路面位置関連情報を車両が取得する場合に比べて、既定ルート走行車両の使用中に取得する情報量を抑えつつ、路面位置関連情報をより細かく取得することができる。３次元路面情報を含む路面位置関連情報を用いることにより、既定ルートの路面が坂道を含む場合であっても、画像中の既定ルートの路面の位置を推定する精度が高い。制御装置は、このように取得された路面位置関連情報を用いて、既定ルートの路面上の障害物を検出する。そのため、既定ルートの路面上にあって既定ルート走行車両から遠い障害物の検出精度および検出率をより向上できる。
【0026】
（１０）本発明の１つの観点によると、本発明の既定ルート走行車両は、上記（１）～（６）のいずれかの構成に加えて、以下の構成を有することが好ましい。
前記路面位置関連情報取得部が、自車の使用中に前記路面位置関連情報を取得する。
前記路面位置関連情報取得部が、自車の使用中に前記路面位置関連情報を取得する。
【0027】
この構成によると、画像中の既定ルートの路面の位置の推定のための現在位置の推定が不要である。
【0028】
（１１）本発明の１つの観点によると、本発明の既定ルート走行車両は、上記（１０）の構成に加えて、以下の構成を有することが好ましい。
前記路面位置関連情報取得部は、自車の使用中に、前記路面位置関連情報として、自車の将来の走行位置を含む前記既定ルートの前記路面の一部分の形状の情報を取得し、前記既定ルートの前記路面の幅の情報を予め記憶する記憶部を有し、前記制御装置は、前記記憶部に記憶された前記既定ルートの前記路面の幅の情報、前記路面位置関連情報取得部が取得した前記既定ルートの前記路面の前記一部分の形状の情報、および、前記撮像装置の前記揺動軸線を中心とした現在の揺動角度に関連する情報に基づいて、揺動する前記撮像装置により撮像された前記画像中の前記既定ルートの前記路面の位置を推定する。
前記路面位置関連情報取得部は、自車の使用中に、前記路面位置関連情報として、自車の将来の走行位置を含む前記既定ルートの前記路面の一部分の形状の情報を取得し、前記既定ルートの前記路面の幅の情報を予め記憶する記憶部を有し、前記制御装置は、前記記憶部に記憶された前記既定ルートの前記路面の幅の情報、前記路面位置関連情報取得部が取得した前記既定ルートの前記路面の前記一部分の形状の情報、および、前記撮像装置の前記揺動軸線を中心とした現在の揺動角度に関連する情報に基づいて、揺動する前記撮像装置により撮像された前記画像中の前記既定ルートの前記路面の位置を推定する。
【0029】
この構成によると、画像中の既定ルートの路面の位置の推定のための現在位置の推定が不要でありながら、画像中の既定ルートの路面の位置を精度良く推定できる。
【0030】
（１２）本発明の１つの観点によると、本発明の既定ルート走行車両は、上記（１０）の構成に加えて、以下の構成を有することが好ましい。
前記路面位置関連情報取得部は、自車の使用中に、前記路面位置関連情報として、自車の将来の走行位置を含む前記既定ルートの前記路面の一部分の形状および幅の情報を取得し、前記制御装置は、前記路面位置関連情報取得部が取得した前記既定ルートの前記路面の前記一部分の形状および幅の情報、および、前記撮像装置の前記揺動軸線を中心とした現在の揺動角度に関連する情報に基づいて、揺動する前記撮像装置により撮像された前記画像中の前記既定ルートの前記路面の位置を推定する。
前記路面位置関連情報取得部は、自車の使用中に、前記路面位置関連情報として、自車の将来の走行位置を含む前記既定ルートの前記路面の一部分の形状および幅の情報を取得し、前記制御装置は、前記路面位置関連情報取得部が取得した前記既定ルートの前記路面の前記一部分の形状および幅の情報、および、前記撮像装置の前記揺動軸線を中心とした現在の揺動角度に関連する情報に基づいて、揺動する前記撮像装置により撮像された前記画像中の前記既定ルートの前記路面の位置を推定する。
【0031】
この構成によると、画像中の既定ルートの路面の位置の推定のための現在位置の推定が不要でありながら、画像中の既定ルートの路面の位置を精度良く推定できる。
【0032】
（１３）本発明の１つの観点によると、本発明の既定ルート走行車両は、上記（１）～（８）、（１０）～（１２）のいずれかの構成に加えて、以下の構成を有することが好ましい。前記撮像装置が、左画像センサと、前記左画像センサから車両右方向に離れた位置に配置される右画像センサとを有するステレオカメラである。
【0033】
この構成によると、撮像装置が、左画像センサと、右画像センサとを有するステレオカメラである。左画像センサと右画像センサとを有するステレオカメラを撮像装置として用いることで、左画像センサにより撮像された左画像と、右画像センサにより撮像された右画像とに基づいて視差画像を生成して、この視差画像を用いて障害物を検出することが可能となる。また、１次元スキャンのレーザーレーダを用いた障害物検出では、起伏のある路面を障害物として検出しやすいという問題がある。一方、ステレオカメラを用いた障害物検出では、路面の起伏の影響を抑えながら、障害物を検出することができる。その結果、既定ルートの路面上にあって既定ルート走行車両から遠い障害物の検出精度および検出率をより向上できる。
【0034】
（１４）本発明の１つの観点によると、本発明の既定ルート走行車両は、上記（１）～（１３）のいずれかの構成に加えて、以下の構成を有することが好ましい。
前記制御装置は、前記画像中の前記既定ルートの前記路面上の前記障害物を検出した場合に、自車の速度を低下させる、または、自車の走行を停止させる。
前記制御装置は、前記画像中の前記既定ルートの前記路面上の前記障害物を検出した場合に、自車の速度を低下させる、または、自車の走行を停止させる。
【0035】
この構成によると、制御装置は、既定ルートの路面上の障害物を検出した場合に、既定ルート走行車両の速度を低下させる、または、既定ルート走行車両の走行を停止させる。これにより、手動ではなく自動で、既定ルート走行車両を減速または停止させることができる。その結果、障害物との接触が回避される可能性を高めることができる。
【0036】
＜既定ルートの路面の定義＞
本発明において、「既定ルートの路面」は、既定ルート走行車両が走行するための路面である。「既定ルートの路面」は、一般道路の路面であってもよく、例えばゴルフ場などの施設における専用道路の路面であってもよい。「既定ルートの路面」は、幅方向の両端の位置が視覚的に明確であってもよく、明確でなくてもよい。前者の例としては、例えば、既定ルートの路面が舗装面で、既定ルートの路面の外が地面の場合などである。後者の例としては、例えば、既定ルートの路面が、舗装された広場に設けられる場合である。
本発明において、「既定ルートの路面」は、既定ルート走行車両が走行するための路面である。「既定ルートの路面」は、一般道路の路面であってもよく、例えばゴルフ場などの施設における専用道路の路面であってもよい。「既定ルートの路面」は、幅方向の両端の位置が視覚的に明確であってもよく、明確でなくてもよい。前者の例としては、例えば、既定ルートの路面が舗装面で、既定ルートの路面の外が地面の場合などである。後者の例としては、例えば、既定ルートの路面が、舗装された広場に設けられる場合である。
【0037】
＜既定ルート走行車両の定義＞
本発明において、「既定ルート走行車両」とは、既定ルートを走行する車両である。本発明の既定ルート走行車両は、例えば、ゴルフカー、自動運転バス、小型自動電動車両等が含まれる。本発明の既定ルート走行車両は、運転者が運転する路線バスのように、既定ルート以外も走行可能な車両は含まない。本発明の既定ルート走行車両は、オペレータの操作によらずに進行方向が制御される車両である。オペレータは、既定ルート走行車両の乗員と、既定ルート走行車両に対してリモート操作を行う者を含む。本発明の既定ルート走行車両は、オペレータの操作によらずに車速が制御可能であってもよい。本発明の既定ルート走行車両は、オペレータの操作によらずに停止可能であってもよい。本発明の既定ルート走行車両は既定ルートを自動的に走行する自動運転車両であってもよい。ここでの自動運転車両とは、オペレータの操作によらずに進行方向と車速が制御され、且つ、オペレータの操作によらずに停止する車両である。本発明の既定ルート走行車両は、オペレータの操作により停止可能であってもよい。本発明の既定ルート走行車両は、オペレータの操作によって車速を制御可能であってもよい。本発明の既定ルート走行車両は、オペレータの操作によって進行方向の制御ができるように切り替え可能であってもよい。
本発明において、「既定ルート走行車両」とは、既定ルートを走行する車両である。本発明の既定ルート走行車両は、例えば、ゴルフカー、自動運転バス、小型自動電動車両等が含まれる。本発明の既定ルート走行車両は、運転者が運転する路線バスのように、既定ルート以外も走行可能な車両は含まない。本発明の既定ルート走行車両は、オペレータの操作によらずに進行方向が制御される車両である。オペレータは、既定ルート走行車両の乗員と、既定ルート走行車両に対してリモート操作を行う者を含む。本発明の既定ルート走行車両は、オペレータの操作によらずに車速が制御可能であってもよい。本発明の既定ルート走行車両は、オペレータの操作によらずに停止可能であってもよい。本発明の既定ルート走行車両は既定ルートを自動的に走行する自動運転車両であってもよい。ここでの自動運転車両とは、オペレータの操作によらずに進行方向と車速が制御され、且つ、オペレータの操作によらずに停止する車両である。本発明の既定ルート走行車両は、オペレータの操作により停止可能であってもよい。本発明の既定ルート走行車両は、オペレータの操作によって車速を制御可能であってもよい。本発明の既定ルート走行車両は、オペレータの操作によって進行方向の制御ができるように切り替え可能であってもよい。
【0038】
＜既定ルートの路面における自車の将来の走行位置の定義＞
本発明において、「既定ルートの路面における自車の将来の走行位置」とは、既定ルートの路面において、自車の現在の走行位置から進行方向に離れた自車の将来の走行位置である。ここでいう走行位置は、既定ルートの路面において自車が配置される位置である。より詳細には、走行位置は、既定ルートの路面において自車の前面が配置される位置であってもよい。ここでいう進行方向に離れた距離は、固定された値であってもよく、自車の速度等に応じて変化される値であってもよい。つまり、「既定ルートの路面における自車の将来の走行位置」とは、既定ルートの路面における自車の直近の将来の走行位置である。
本発明において、「既定ルートの路面における自車の将来の走行位置」とは、既定ルートの路面において、自車の現在の走行位置から進行方向に離れた自車の将来の走行位置である。ここでいう走行位置は、既定ルートの路面において自車が配置される位置である。より詳細には、走行位置は、既定ルートの路面において自車の前面が配置される位置であってもよい。ここでいう進行方向に離れた距離は、固定された値であってもよく、自車の速度等に応じて変化される値であってもよい。つまり、「既定ルートの路面における自車の将来の走行位置」とは、既定ルートの路面における自車の直近の将来の走行位置である。
【0039】
＜既定ルートの路面における自車の現在位置の推定の定義＞
本発明において、「既定ルートの路面における自車の現在位置を推定する」とは、既定ルートの路面のある位置から現在位置までの距離を推定することであってもよく、基準となる位置に対する相対的な自車の現在位置を推定することであってもよく、自車の現在の絶対位置を推定することであってもよい。
本発明において、「既定ルートの路面における自車の現在位置を推定する」とは、既定ルートの路面のある位置から現在位置までの距離を推定することであってもよく、基準となる位置に対する相対的な自車の現在位置を推定することであってもよく、自車の現在の絶対位置を推定することであってもよい。
【0040】
＜撮像装置の水平画角の定義＞
本発明において、撮像装置の水平画角とは、既定ルート走行車両の水平方向における水平画角である。ここでの既定ルート走行車両の水平方向とは、既定ルート走行車両の全車輪（または車輪に代わる走行手段）が水平面に接触した状態で既定ルート走行車両が停止しているときの水平方向である。
本発明において、撮像装置の水平画角とは、既定ルート走行車両の水平方向における水平画角である。ここでの既定ルート走行車両の水平方向とは、既定ルート走行車両の全車輪（または車輪に代わる走行手段）が水平面に接触した状態で既定ルート走行車両が停止しているときの水平方向である。
【0041】
＜撮像装置により撮像された画像の定義＞
本発明の「撮像装置により撮像された画像」とは、ある時点で撮像装置により撮像された画像である。本発明の撮像装置が複数の画像センサ（イメージセンサ）を有するステレオカメラの場合、本発明の「撮像装置により撮像された画像」は、複数の画像センサで同じタイミングで撮像された複数の画像のうちの少なくとも１つの画像であってもよく、複数の画像センサで同じタイミングで撮像された複数の画像に基づいて生成された１つの画像であってもよい。本発明の撮像装置は画像センサを１つだけ有する単眼カメラであってもよい。
本発明の「撮像装置により撮像された画像」とは、ある時点で撮像装置により撮像された画像である。本発明の撮像装置が複数の画像センサ（イメージセンサ）を有するステレオカメラの場合、本発明の「撮像装置により撮像された画像」は、複数の画像センサで同じタイミングで撮像された複数の画像のうちの少なくとも１つの画像であってもよく、複数の画像センサで同じタイミングで撮像された複数の画像に基づいて生成された１つの画像であってもよい。本発明の撮像装置は画像センサを１つだけ有する単眼カメラであってもよい。
【0042】
＜画像中の既定ルートの路面の位置の推定の定義＞
本発明において、「画像中の既定ルートの路面の位置を推定する」とは、少なくとも、画像中の既定ルートの路面の幅方向両端の位置を推定することである。画像中の既定ルートの路面の幅方向両端の位置を推定するとは、画像中の既定ルートの路面の幅方向両端の位置を厳密に推定することに限らない。画像中の既定ルートの路面の幅方向両端の位置を推定する精度は、画像中の既定ルートの路面上の障害物を検出できる程度であればよい。
本発明において、「画像中の既定ルートの路面の位置を推定する」とは、少なくとも、画像中の既定ルートの路面の幅方向両端の位置を推定することである。画像中の既定ルートの路面の幅方向両端の位置を推定するとは、画像中の既定ルートの路面の幅方向両端の位置を厳密に推定することに限らない。画像中の既定ルートの路面の幅方向両端の位置を推定する精度は、画像中の既定ルートの路面上の障害物を検出できる程度であればよい。
【0043】
＜既定ルートの路面上の障害物の定義＞
本発明において、「既定ルートの路面上の障害物」とは、既定ルートの路面に接している障害物である。但し、本発明の既定ルート走行車両は、既定ルートの路面上の障害物だけでなく、既定ルートの路面に接しておらず既定ルートの路面の真上に存在する障害物も検出してもよい。
本発明において、「既定ルートの路面上の障害物」とは、既定ルートの路面に接している障害物である。但し、本発明の既定ルート走行車両は、既定ルートの路面上の障害物だけでなく、既定ルートの路面に接しておらず既定ルートの路面の真上に存在する障害物も検出してもよい。
【0044】
＜既定ルートの路面の形状の情報＞
本発明において、第１既定ルート地図情報に含まれる「既定ルートの路面の形状の情報」とは、既定ルートの路面全体の形状の情報である。「既定ルートの路面の形状の情報」は、既定ルートの路面の幅の情報を含まない。「既定ルートの路面の形状の情報」は、既定ルートの路面のうちの一部分が直線状であるか曲線状であるかを判別できる情報である。既定ルートの路面のある部分が曲線状の場合には、「既定ルートの路面の形状の情報」は曲がりの程度（例えば曲率半径）を判別できる情報である。
本発明の第２既定ルート地図情報に含まれる「既定ルートの路面の形状の情報」の定義は、第１既定ルート地図情報に含まれる「既定ルートの路面の形状の情報」の上記の定義と同じである。
本発明において、第１既定ルート地図情報に含まれる「既定ルートの路面の形状の情報」とは、既定ルートの路面全体の形状の情報である。「既定ルートの路面の形状の情報」は、既定ルートの路面の幅の情報を含まない。「既定ルートの路面の形状の情報」は、既定ルートの路面のうちの一部分が直線状であるか曲線状であるかを判別できる情報である。既定ルートの路面のある部分が曲線状の場合には、「既定ルートの路面の形状の情報」は曲がりの程度（例えば曲率半径）を判別できる情報である。
本発明の第２既定ルート地図情報に含まれる「既定ルートの路面の形状の情報」の定義は、第１既定ルート地図情報に含まれる「既定ルートの路面の形状の情報」の上記の定義と同じである。
【0045】
＜既定ルートの路面の一部分の形状の情報＞
本発明において、「既定ルートの路面の一部分の形状の情報」は、既定ルートの路面の当該一部分が直線状であるか曲線状であるかを判別できる情報であってもよい。当該一部分が曲線状の場合には、「既定ルートの路面の一部分の形状の情報」は曲がりの程度を判別できる情報であってもよい。「既定ルートの路面の一部分の形状の情報」は、既定ルートの路面の当該一部分の方向を示す情報であってもよい。
本発明において、「既定ルートの路面の一部分の形状の情報」は、既定ルートの路面の当該一部分が直線状であるか曲線状であるかを判別できる情報であってもよい。当該一部分が曲線状の場合には、「既定ルートの路面の一部分の形状の情報」は曲がりの程度を判別できる情報であってもよい。「既定ルートの路面の一部分の形状の情報」は、既定ルートの路面の当該一部分の方向を示す情報であってもよい。
【0046】
＜自車の使用中＞
本発明の「自車の使用中」とは、既定ルート走行車両を使用する目的で既定ルート走行車両が既定ルートを走行しているときである。「自車の使用中」は、既定ルート走行車両の記憶部に事前に記憶させる情報を取得するために既定ルート走行車両が既定ルートを走行しているときを含まない。
本発明の「自車の使用中」とは、既定ルート走行車両を使用する目的で既定ルート走行車両が既定ルートを走行しているときである。「自車の使用中」は、既定ルート走行車両の記憶部に事前に記憶させる情報を取得するために既定ルート走行車両が既定ルートを走行しているときを含まない。
【0047】
＜自車の使用中の情報の取得の定義＞
本発明において、「自車の使用中に自車が揺動装置の目標揺動角度を取得する」とは、自車の使用中に、揺動装置の目標揺動角度の情報を外部から自車が取得することであってもよい。もしくは、自車の使用中に、揺動装置の目標揺動角度に対応付けられた識別情報を外部から自車が取得し、この識別情報に基づいて自車の記憶部から揺動装置の目標揺動角度の情報が読み出されることであってもよい。「自車の使用中に自車が揺動装置の目標揺動角度を取得する」とは、自車の使用中に、自車が外部から取得する情報と関係なく、自車の記憶部から路面位置関連情報取得部が読み出されることは含まない。自車が外部から情報を取得するとは、例えば、無線通信装置、ＲＦＩＤタグなどから情報を取得することである。
また、本発明において、「自車の使用中に、路面位置関連情報取得部が路面位置関連情報を取得する」とは、自車の使用中に、路面位置関連情報取得部が、路面位置関連情報を外部から取得することであってもよい。もしくは、自車の使用中に、路面位置関連情報に対応付けられた識別情報を外部から自車が取得し、この識別情報に基づいて自車の記憶部から路面位置関連情報が読み出されて、路面位置関連情報取得部が路面位置関連情報を取得することであってもよい。「自車の使用中に、路面位置関連情報取得部が路面位置関連情報を取得する」とは、自車の使用中に、自車が外部から取得する情報と関係なく、路面位置関連情報取得部が、自車の記憶部から路面位置関連情報取得部を取得することは含まない。なお、本発明における「自車の使用中に、路面形状情報取得部が自車の将来の走行位置を含む既定ルートの路面の一部分の形状の情報を取得する」の定義も、上記の定義と同様である。
本発明において、「自車の使用中に自車が揺動装置の目標揺動角度を取得する」とは、自車の使用中に、揺動装置の目標揺動角度の情報を外部から自車が取得することであってもよい。もしくは、自車の使用中に、揺動装置の目標揺動角度に対応付けられた識別情報を外部から自車が取得し、この識別情報に基づいて自車の記憶部から揺動装置の目標揺動角度の情報が読み出されることであってもよい。「自車の使用中に自車が揺動装置の目標揺動角度を取得する」とは、自車の使用中に、自車が外部から取得する情報と関係なく、自車の記憶部から路面位置関連情報取得部が読み出されることは含まない。自車が外部から情報を取得するとは、例えば、無線通信装置、ＲＦＩＤタグなどから情報を取得することである。
また、本発明において、「自車の使用中に、路面位置関連情報取得部が路面位置関連情報を取得する」とは、自車の使用中に、路面位置関連情報取得部が、路面位置関連情報を外部から取得することであってもよい。もしくは、自車の使用中に、路面位置関連情報に対応付けられた識別情報を外部から自車が取得し、この識別情報に基づいて自車の記憶部から路面位置関連情報が読み出されて、路面位置関連情報取得部が路面位置関連情報を取得することであってもよい。「自車の使用中に、路面位置関連情報取得部が路面位置関連情報を取得する」とは、自車の使用中に、自車が外部から取得する情報と関係なく、路面位置関連情報取得部が、自車の記憶部から路面位置関連情報取得部を取得することは含まない。なお、本発明における「自車の使用中に、路面形状情報取得部が自車の将来の走行位置を含む既定ルートの路面の一部分の形状の情報を取得する」の定義も、上記の定義と同様である。
【0048】
＜相対位置情報および絶対位置情報の定義＞
本発明において位置Ａの相対位置情報とは、基準位置に対する位置Ａの相対的な位置を示す情報である。相対位置情報の基準位置は、既定ルートによって異なる。また、相対位置情報の基準位置は、位置Ａによって異なってもよい。本発明において位置Ａの絶対位置置情報とは、原点に対する位置Ａの相対的な位置を示す情報である。既定ルートに関わらず、原点は固定されている。
本発明において位置Ａの相対位置情報とは、基準位置に対する位置Ａの相対的な位置を示す情報である。相対位置情報の基準位置は、既定ルートによって異なる。また、相対位置情報の基準位置は、位置Ａによって異なってもよい。本発明において位置Ａの絶対位置置情報とは、原点に対する位置Ａの相対的な位置を示す情報である。既定ルートに関わらず、原点は固定されている。
【0049】
＜揺動装置による撮像装置の揺動の定義＞
本発明において、「揺動装置が撮像装置を揺動させる」とは、揺動装置が撮像装置を３６０°未満回転させることを意味する。本発明の揺動装置は、撮像装置を３６０°以上回転させることが可能であってもよい。本発明の揺動装置は、既定ルートの路面における既定ルート走行車両の将来の走行位置を撮像装置で撮像された画像内に含ませるために、撮像装置を３６０°以上回転させる場合があってもよい。
本発明において、「揺動装置が撮像装置を揺動させる」とは、揺動装置が撮像装置を３６０°未満回転させることを意味する。本発明の揺動装置は、撮像装置を３６０°以上回転させることが可能であってもよい。本発明の揺動装置は、既定ルートの路面における既定ルート走行車両の将来の走行位置を撮像装置で撮像された画像内に含ませるために、撮像装置を３６０°以上回転させる場合があってもよい。
【0050】
＜揺動角度範囲の定義＞
本発明における「揺動角度範囲」とは、１つの既定ルート走行車両において、制御装置により制御された揺動装置が、撮像装置を車体に対して揺動させることができる最大範囲である。揺動角度範囲が１８０°の場合、制御装置により制御された揺動装置は、例えば、撮像装置を基準位置から９０°と、基準位置から－９０°揺動させることができてもよい。この場合、揺動装置としては、３６０°回転可能な装置が使用されてもよい。つまり、揺動角度範囲は、制御装置による制御上の最大揺動範囲であって、揺動装置の構造上の最大揺動範囲ではない。
本発明における「揺動角度範囲」とは、１つの既定ルート走行車両において、制御装置により制御された揺動装置が、撮像装置を車体に対して揺動させることができる最大範囲である。揺動角度範囲が１８０°の場合、制御装置により制御された揺動装置は、例えば、撮像装置を基準位置から９０°と、基準位置から－９０°揺動させることができてもよい。この場合、揺動装置としては、３６０°回転可能な装置が使用されてもよい。つまり、揺動角度範囲は、制御装置による制御上の最大揺動範囲であって、揺動装置の構造上の最大揺動範囲ではない。
【0051】
＜現在の揺動角度の定義＞
本発明において、撮像装置の「現在の揺動角度」とは、現在の撮像装置の実際の揺動角度であってもよく、現在の撮像装置の揺動角度と推定される角度であってもよい。
本発明において、撮像装置の「現在の揺動角度」とは、現在の撮像装置の実際の揺動角度であってもよく、現在の撮像装置の揺動角度と推定される角度であってもよい。
【0052】
＜車両上下方向および車両右方向の定義＞
本発明において、「車両上下方向」は、全車輪が水平面に接した状態で既定ルート走行車両が停止しているときに、水平面に直交する方向である。
本発明において、「車両右方向」は、全車輪が水平面に接した状態で既定ルート走行車両が停止しているときに、水平面内の方向であって、既定ルート走行車両の進行方向を向いて乗車する乗員にとっての右方向である。
本発明において、「車両上下方向」は、全車輪が水平面に接した状態で既定ルート走行車両が停止しているときに、水平面に直交する方向である。
本発明において、「車両右方向」は、全車輪が水平面に接した状態で既定ルート走行車両が停止しているときに、水平面内の方向であって、既定ルート走行車両の進行方向を向いて乗車する乗員にとっての右方向である。
【0053】
＜左画像センサから車両右方向に離れた位置に配置される右画像センサの定義＞
本発明において、右画像センサが左画像センサから車両右方向に離れた位置に配置されるとは、撮像装置の揺動可能範囲の少なくとも一部において、右画像センサが左画像センサから車両右方向に離れた位置に配置されることを意味する。言い換えると、撮像装置の揺動角度がある角度のときに、右画像センサが左画像センサから車両右方向に離れた位置に配置されていればよい。
本発明において、「左画像センサから車両右方向に離れた位置」とは、左画像センサの車両右方向における右端を通り、車両右方向に直交する平面から、車両右方向に離れた位置である。
本発明において、右画像センサが左画像センサから車両右方向に離れた位置に配置されるとは、撮像装置の揺動可能範囲の少なくとも一部において、右画像センサが左画像センサから車両右方向に離れた位置に配置されることを意味する。言い換えると、撮像装置の揺動角度がある角度のときに、右画像センサが左画像センサから車両右方向に離れた位置に配置されていればよい。
本発明において、「左画像センサから車両右方向に離れた位置」とは、左画像センサの車両右方向における右端を通り、車両右方向に直交する平面から、車両右方向に離れた位置である。
【0054】
＜揺動角度に関連する情報の定義＞
本発明において「揺動角度に関連する情報」とは、揺動角度を直接的または間接的に示す情報である。
本発明において「揺動角度に関連する情報」とは、揺動角度を直接的または間接的に示す情報である。
【0055】
＜その他の用語の定義＞
本発明および本明細書において、Ａ方向に沿った直線とは、Ａ方向と平行な直線に限らない。Ａ方向に沿った直線とは、特に限定しない限り、Ａ方向を示す直線に対して－４５°以上＋４５°以下の範囲内で傾斜している直線を含む。同様の定義が、「沿った」を用いた他の表現にも適用される。「沿った」を用いた他の表現とは、例えば、「Ａ方向に沿った軸」や、「Ａ方向に沿った方向」や、「複数のＢがＡ方向に沿って配列される」や、「１つのＢがＡ方向に沿っている」等である。なお、Ａ方向は、特定の方向を指すものではない。Ａ方向を、水平方向や前後方向に置き換えることができる。本発明において、「車両上下方向に沿った揺動軸線」とは、車両上下方向に平行な揺動軸線に限らない。「車両上下方向に沿った揺動軸線」は、車両上下方向に対して±４５°の範囲内で傾斜している揺動軸線を含む。
本発明および本明細書において、Ａ方向に沿った直線とは、Ａ方向と平行な直線に限らない。Ａ方向に沿った直線とは、特に限定しない限り、Ａ方向を示す直線に対して－４５°以上＋４５°以下の範囲内で傾斜している直線を含む。同様の定義が、「沿った」を用いた他の表現にも適用される。「沿った」を用いた他の表現とは、例えば、「Ａ方向に沿った軸」や、「Ａ方向に沿った方向」や、「複数のＢがＡ方向に沿って配列される」や、「１つのＢがＡ方向に沿っている」等である。なお、Ａ方向は、特定の方向を指すものではない。Ａ方向を、水平方向や前後方向に置き換えることができる。本発明において、「車両上下方向に沿った揺動軸線」とは、車両上下方向に平行な揺動軸線に限らない。「車両上下方向に沿った揺動軸線」は、車両上下方向に対して±４５°の範囲内で傾斜している揺動軸線を含む。
【0056】
本発明において、含む（including）、有する（comprising）、備える（having）およびこれらの派生語は、列挙されたアイテムおよびその等価物に加えて追加的アイテムをも包含することが意図されて用いられている。
本発明において、取り付けられた（mounted）、接続された（connected）、結合された（coupled）、支持された（supported）という用語は、広義に用いられている。具体的には、直接的な取付、接続、結合、支持だけでなく、間接的な取付、接続、結合および支持も含む。さらに、接続された（connected）および結合された（coupled）は、物理的または機械的な接続／結合に限られない。それらは、直接的なまたは間接的な電気的接続／結合も含む。
本発明において、取り付けられた（mounted）、接続された（connected）、結合された（coupled）、支持された（supported）という用語は、広義に用いられている。具体的には、直接的な取付、接続、結合、支持だけでなく、間接的な取付、接続、結合および支持も含む。さらに、接続された（connected）および結合された（coupled）は、物理的または機械的な接続／結合に限られない。それらは、直接的なまたは間接的な電気的接続／結合も含む。
【0057】
他に定義されない限り、本明細書で使用される全ての用語（技術用語および科学用語を含む）は、本発明が属する当業者によって一般的に理解されるのと同じ意味を有する。一般的に使用される辞書に定義された用語のような用語は、関連する技術および本開示の文脈における意味と一致する意味を有すると解釈されるべきであり、理想化されたまたは過度に形式的な意味で解釈されることはない。
【0058】
本発明および本明細書において、複数の選択肢のうちの少なくとも１つとは、複数の選択肢から考えられる全ての組み合わせを含む。複数の選択肢のうちの少なくとも１つとは、複数の選択肢のいずれか１つであってもよく、複数の選択肢の全てであってもよい。例えば、ＡとＢとＣの少なくとも１つとは、Ａのみであってもよく、Ｂのみであってもよく、Ｃのみであってもよく、ＡとＢであってもよく、ＡとＣであってもよく、ＢとＣであってもよく、ＡとＢとＣであってもよい。
【0059】
本明細書において、「好ましい」という用語は非排他的なものである。「好ましい」は、「好ましいがこれに限定されるものではない」ということを意味する。本明細書において、「好ましい」と記載された構成は、少なくとも、上記（１）または（２）の構成により得られる上記効果を奏する。また、本明細書において、「してもよい」という用語は非排他的なものである。「してもよい」は、「してもよいがこれに限定されるものではない」という意味である。本明細書において、「してもよい」と記載された構成は、少なくとも、上記（１）または（２）の構成により得られる上記効果を奏する。
【0060】
特許請求の範囲において、ある構成要素の数を明確に特定しておらず、英語に翻訳された場合に単数で表示される場合、本発明は、この構成要素を、複数有していてもよい。また本発明は、この構成要素を１つだけ有していてもよい。
【0061】
本発明では、上述した好ましい構成を互いに組み合わせることを制限しない。本発明の実施形態を詳細に説明する前に、本発明は、以下の説明に記載されたまたは図面に図示された構成要素の構成および配置の詳細に制限されないことが理解されるべきである。本発明は、後述する実施形態以外の実施形態でも可能である。本発明は、後述する実施形態に様々な変更を加えた実施形態でも可能である。また、本発明は、後述する実施形態、具体例、および変更例を適宜組み合わせて実施することができる。
【発明の効果】
【0062】
本発明の既定ルート走行車両によると、既定ルートの路面上にあって既定ルート走行車両から遠い障害物の検出精度および検出率を向上できるとともに、曲率半径の小さいカーブを走行中であっても既定ルート走行車両が既定ルートの路面上の障害物に接近する前に障害物を検出できる。
【図面の簡単な説明】
【0063】
【図1】本発明の実施形態の既定ルート走行車両の使用状況の一例を示す模式図である。
【図2】本発明の実施形態の具体例１のゴルフカーを模式的に示す側面図である。
【図3】具体例１のゴルフカーの概略構成を示すブロック図である。
【図4】具体例１のゴルフカーが走行する既定ルートの路面の一例を示す模式図である。
【図5】具体例１の左撮像センサおよび右撮像センサの座標系を示す図である。
【図6】具体例１の制御装置が生成する視差画像Ｐ１を示す図である。
【図7】具体例１の変更例１の記憶部が記憶する事前取得視差画像Ｐ２を示す図である。
【図8】本発明の実施形態の具体例２のゴルフカーの概略構成を示すブロック図である。
【図9】本発明の実施形態の具体例３のゴルフカーの概略構成を示すブロック図である。
【図10】従来のゴルフカーの使用状況の一例を示す平面図である。
【発明を実施するための形態】
【0064】
以下、本発明の実施形態について図１を参照しつつ説明する。図１に示すように、本実施形態の既定ルート走行車両１は、撮像装置１０と、路面位置関連情報取得部２０と、制御装置３０と、揺動装置４０とを備える。撮像装置１０、路面位置関連情報取得部２０、制御装置３０、および揺動装置４０は、既定ルート走行車両１に搭載される。既定ルート走行車両１は、既定ルートの路面６０を走行する。つまり、既定ルート走行車両１は、既定ルートを走行する。
【0065】
撮像装置１０は、４０°以上９０°以下の水平画角Ａで撮像する。つまり、撮像装置１０の水平画角は比較的小さい。言い替えると、撮像装置１０の撮像範囲が比較的小さい。
【0066】
揺動装置４０は、既定ルートの路面６０における既定ルート走行車両１の将来の走行位置が撮像装置１０の撮像範囲に含まれるように、既定ルート走行車両１の車両上下方向に沿った揺動軸線Ｌ１を中心に撮像装置１０を車体に対して揺動させる。
【0067】
路面位置関連情報取得部２０は、路面位置関連情報を取得する。路面位置関連情報とは、揺動する撮像装置１０により撮像された画像中の既定ルートの路面６０の位置を推定するための情報である。
【0068】
制御装置３０は、揺動装置４０による撮像装置１０の揺動を制御する。制御装置３０は、路面位置関連情報取得部２０が取得した路面位置関連情報に基づいて、揺動する撮像装置１０によって撮像された画像中の既定ルートの路面６０の位置を推定する。制御装置３０は、画像中の既定ルートの路面６０上の障害物を検出する。
【0069】
図１は、既定ルートの路面６０上の既定ルート走行車両１を上から見た図であって、図１０は、既定ルートの路面６０上の従来の既定ルート走行車両３０１を上から見た図である。図１および図１０は、既定ルート走行車両１が急カーブ（曲率半径の小さいカーブ）に近づいた状況を示す。
【0070】
従来の既定ルート走行車両３０１の撮像装置３１０は揺動しない。撮像装置３１０の水平画角が撮像装置１０の水平画角Ａと同じである場合、撮像装置３１０の水平画角は比較的小さい。そのため、図１０に示すように、曲率半径の小さいカーブを走行する場合、撮像装置３１０の撮像範囲内に、既定ルートの路面６０における既定ルート走行車両３０１の将来の走行位置が含まれないか少ししか含まれない。それにより、既定ルート走行車両３０１が既定ルートの路面６０上の障害物に接近するまで、障害物を検出できない。仮に、撮像装置３１０の水平画角が大きい場合、既定ルート走行車両３０１が既定ルートの路面６０上の障害物に接近する前に障害物を検出できる。しかし、撮像装置３１０の水平画角が大きいと、既定ルートの路面６０上にあって既定ルート走行車両３０１から遠い障害物の検出精度および検出率が低い。
【0071】
一方、既定ルート走行車両１は、既定ルートの路面６０における既定ルート走行車両１の将来の走行位置が撮像装置１０の撮像範囲に含まれるように、撮像装置１０を揺動させる揺動装置４０を有する。そのため、図１に示すように、撮像装置１０の水平画角Ａが小さくても、曲率半径の小さいカーブを走行する場合に、撮像装置１０の撮像範囲に、既定ルートの路面６０における将来の走行位置を確実に含めることができる。そのため、撮像装置１０の水平画角Ａが小さいにも関わらず、曲率半径の小さいカーブを走行する場合に、既定ルート走行車両１が既定ルートの路面６０上の障害物に接近する前に障害物を検出できる。撮像装置１０の水平画角Ａが小さいことにより、既定ルートの路面６０上にあって既定ルート走行車両１から遠い障害物の検出精度および検出率を向上できる。
【0072】
以上のように、既定ルートの路面６０上にあって既定ルート走行車両１から遠い障害物の検出精度および検出率を向上できるとともに、曲率半径の小さいカーブを走行中であっても既定ルート走行車両１が既定ルートの路面６０上の障害物に接近する前に障害物を検出できる。
【0073】
（実施形態の具体例１）
次に、本発明の実施形態の具体例１について図２～図６を用いて説明する。具体例１は、ゴルフカーに本発明を適用した一例である。具体例１のゴルフカー１は、上述した実施形態の既定ルート走行車両１の特徴を全て有している。なお、以下の説明では、上述した実施形態と同じ部位についての説明は省略する。
次に、本発明の実施形態の具体例１について図２～図６を用いて説明する。具体例１は、ゴルフカーに本発明を適用した一例である。具体例１のゴルフカー１は、上述した実施形態の既定ルート走行車両１の特徴を全て有している。なお、以下の説明では、上述した実施形態と同じ部位についての説明は省略する。
【0074】
以下の説明において、上下方向、前後方向、左右方向は、車両上下方向、車両前後方向、車両左右方向である。車両上下方向は、全車輪が水平面に接した状態で既定ルート走行車両１が停止しているときに、水平面に直交する方向である。車両左右方向とは、全車輪が水平面に接した状態で既定ルート走行車両１が停止しているときに、水平面内の方向であって、既定ルート走行車両１の進行方向を向いて乗車する乗員にとっての左右方向である。車両前後方向とは、車両上下方向と車両左右方向に直交する方向であって、既定ルート走行車両の進行方向を向いて乗車する乗員にとっての前後方向である。各図に示す矢印Ｆ、矢印Ｂ、矢印Ｕ、矢印Ｄ、矢印Ｌ、矢印Ｒは、それぞれ、前方向、後方向、上方向、下方向、左方向、右方向を表している。
【0075】
＜ゴルフカーの全体構成＞
図２は、具体例１のゴルフカーを模式的に示した側面図である。図３は、ゴルフカーの概略構成を示すブロック図である。図２および図３に示すように、ゴルフカー１は、車体９と、４つの車輪３とを備える。４つの車輪３は、２つの前輪３ｆｌ、３ｆｒを含む。２つの前輪３ｆｌ、３ｆｒは、左右方向に並んで車体９の前部に配置されている。４つの車輪３は、２つの後輪３ｒｌ、３ｒｒを含む。２つの後輪３ｒｌ、３ｒｒは、左右方向に並んで車体９の後部に配置されている。ゴルフカー１は、４つの車輪３が回転することによって走行する。
図２は、具体例１のゴルフカーを模式的に示した側面図である。図３は、ゴルフカーの概略構成を示すブロック図である。図２および図３に示すように、ゴルフカー１は、車体９と、４つの車輪３とを備える。４つの車輪３は、２つの前輪３ｆｌ、３ｆｒを含む。２つの前輪３ｆｌ、３ｆｒは、左右方向に並んで車体９の前部に配置されている。４つの車輪３は、２つの後輪３ｒｌ、３ｒｒを含む。２つの後輪３ｒｌ、３ｒｒは、左右方向に並んで車体９の後部に配置されている。ゴルフカー１は、４つの車輪３が回転することによって走行する。
【0076】
車体９は、シート２と、屋根部９ａとを有する。シート２は、複数の乗員が着座可能に構成される。シート２は、フロントシート２ｆとリアシート２ｒを含む。フロントシート２ｆおよびリアシート２ｒは、前後方向に並んでいる。フロントシート２ｆおよびリアシート２ｒは、それぞれ、２人の乗員が着座可能に構成される。フロントシート２ｆは、リアシート２ｒの前に配置される。屋根部９ａは、フロントシート２ｆとリアシート２ｒの上に配置される。なお、シート２の構成は、これに限らない。シート２に着座可能な乗員の最大数は、４名に限らない。
【0077】
ゴルフカー１は、駆動装置４を備える。駆動装置４は、例えば、電気モータを有する。ゴルフカー１は電動車である。図示しないバッテリの電力が、駆動装置４の電気モータに供給される。駆動装置４は、後輪３ｒｒ、３ｒｌに駆動力を付与可能に構成されている。
【0078】
ゴルフカー１は、複数の制動装置５を備える。ゴルフカー１が有する制動装置５の数は４つである。４つの制動装置５は、４つの車輪３にそれぞれ設けられる。４つの制動装置５は、４つの車輪３に制動力を付与可能に構成されている。制動装置５は、例えば、油圧式のディスクブレーキ装置で構成される。
【0079】
図２および図３に示すように、ゴルフカー１は、ステアリングホイール１１を備える。ステアリングホイール１１は、操舵装置１５に接続される。ステアリングホイール１１は、フロントシート２ｆに座る１人の乗員によって操作可能な位置に配置されている。ステアリングホイール１１は、ゴルフカー１の進行方向を変えるために、乗員により操作される。ステアリングホイール１１の回転により、操舵装置１５が制御され、前輪３ｆｒ、３ｆｌが操舵される。具体例１のゴルフカー１は、自動運転モードと手動運転モードのいずれかで走行される。自動運転モードでは、ステアリングホイール１１の操作によらず、ゴルフカー１の進行方向が制御される。手動運転モードでは、乗員がステアリングホイール１１を操作することによって、ゴルフカー１の進行方向が制御される。
【0080】
ゴルフカー１は、アクセルペダル１２およびブレーキペダル１３を備える。アクセルペダル１２は、ゴルフカー１の走行を開始または加速させるために、乗員によって操作される。アクセルペダル１２の操作によって、駆動装置４によって後輪３ｒｒ、３ｒｌに付与される駆動力が増大する。ブレーキペダル１３は、ゴルフカー１の走行を停止または減速させるために、乗員によって操作される。ブレーキペダル１３の操作によって、制動装置５が作動する。具体例１のゴルフカー１は、自動運転モードと手動運転モードのいずれかで走行される。自動運転モードでは、アクセルペダル１２およびブレーキペダル１３の操作によらず、ゴルフカー１の速度が制御される。手動運転モードでは、乗員がアクセルペダル１２およびブレーキペダル１３を操作することによって、ゴルフカー１の速度が制御される。
【0081】
ゴルフカー１は、誘導線センサ８を備える。誘導線センサ８は、車体９の下部に設けられる。誘導線センサ８は、ゴルフカー１が走行する既定ルートに埋設された電磁誘導線を検出する。図４は、ゴルフカー１が走行する既定ルートの路面６０の一例を示す模式図である。図４に示すように、電磁誘導線６２は、既定ルートに沿って埋設される。電磁誘導線６２は、電磁波を発信する。誘導線センサ８は、電磁誘導線６２が発信する電磁波を受信する。誘導線センサ８は、電磁誘導線６２の電磁波を受信すると、電磁誘導線６２の強さを示す検出信号を、後述する制御装置５０に出力する。制御装置５０は、この検出信号に基づいて、誘導線センサ８に対する電磁誘導線６２の左右方向のずれ量を検出する。制御装置５０は、誘導線センサ８に対する電磁誘導線６２の左右方向のずれが解消されるように、操舵装置１５を制御することで、ゴルフカー１の進行方向を制御する。これにより、ゴルフカー１は既定ルートに沿って走行できる。
【0082】
ゴルフカー１は、車輪回転センサ６を備える。車輪回転センサ６は、後輪３ｒｌに設けられる。車輪回転センサ６は、後輪３ｒｌの回転角を検出する。車輪回転センサ６は、例えば、ロータリーエンコーダで構成される。車輪回転センサ６は、検出した後輪３ｒｌの回転角の信号を、後述する制御装置５０に出力する。なお、車輪回転センサ６は、前輪３ｆｌ、３ｆｒ、後輪３ｒｒのいずれかに設けられてもよい。
【0083】
ゴルフカー１は、埋設マーカ検出センサ７を備える。埋設マーカ検出センサ７は、車体９の下部に設けられる。埋設マーカ検出センサ７は、既定ルートの路面６０に埋設された埋設マーカ６１を検出する。図４に示すように、複数の埋設マーカ６１が、既定ルートの路面６０に沿って埋設されている。埋設マーカ６１は、磁気式の埋設マーカである。各埋設マーカ６１は、複数の磁石で構成される。埋設マーカ６１は、複数の磁石の配置や間隔の組み合わせで構成される磁場を生成する。図４において、既定ルートのスタート位置Ｓから例えば等間隔で、複数の埋設マーカ６１が埋設される。図４の例では、既定ルートのスタート位置Ｓに埋設マーカ６１が埋設されている。既定ルートのスタート位置Ｓに埋設された埋設マーカ６１が、ゴルフカー１が最初に通過する埋設マーカ６１である。なお、既定ルートのスタート位置Ｓに埋設マーカ６１が埋設されなくてもよい。埋設マーカは、電波式の埋設マーカであってもよく、光学式または超音波式の埋設マーカであってもよい。
【0084】
埋設マーカ検出センサ７は、埋設マーカ６１から情報を読み取り可能に構成される。埋設マーカ検出センサ７は、磁力センサである。埋設マーカ検出センサ７は、ゴルフカー１が埋設マーカ６１を通過した時点で、埋設マーカ６１の磁場を検出する。埋設マーカ検出センサ７は、埋設マーカ６１の磁場を検出すると、検出した磁場の情報を、後述する制御装置５０に出力する。制御装置５０は、ゴルフカー１の使用中に、埋設マーカ検出センサ７で検出した埋設マーカ６１の磁場の形状に基づいて識別される識別情報を示す検出信号を取得する。
【0085】
図２に示すように、ゴルフカー１は、撮像装置１０を備える。撮像装置１０は、車体９の前面中央部に設けられる。撮像装置１０は、車体９の上部に設けられてもよく、車体９の下部に設けられてもよく、車体９における上下方向の中央部に設けられてもよい。撮像装置１０の水平画角は、４０°以上９０°以下である。撮像装置１０の水平画角は、４５°以上であってもよい。撮像装置１０の水平画角は、８０°以下であってもよい。撮像装置１０の水平画角は、７５°以下であってもよい。
【0086】
ゴルフカー１は、揺動装置４０を備える。揺動装置４０は、揺動軸線Ｌ１を中心に撮像装置１０を揺動させるように構成されている。図２では、揺動軸線Ｌ１は上下方向に平行である。左右方向に見て、揺動軸線Ｌ１は上下方向に対して±４５°の範囲内で傾斜していてもよい。揺動装置４０は、車体９に対して撮像装置１０を３６０°未満の角度範囲内で揺動可能である。以下の説明において、撮像装置１０の揺動角度とは、撮像装置１０が車体９に対して揺動軸線Ｌ１を中心として揺動した角度である。なお。揺動装置４０は、車体９に対して撮像装置１０を３６０°以上回転可能に構成されていてもよい。揺動装置４０は、例えば、２方向に回転可能な電気モータを有する。図示しないバッテリの電力が、駆動装置４の電気モータに供給される。
【0087】
揺動装置４０は、制御装置５０によって制御される。制御装置５０に制御された揺動装置４０は、既定ルートの路面６０におけるゴルフカー１の将来の走行位置が撮像範囲に含まれるように撮像装置１０を揺動させる。つまり、揺動装置４０は、既定ルートの路面６０における自車１から進行方向に離れた領域が、撮像装置１０が撮像する画像内に含まれるように、撮像装置１０を揺動させる。揺動装置４０は、制御装置５０によって設定された目標揺動角度に基づいて、撮像装置１０を揺動させる。目標揺動角度は、数ｍ程度先（例えば、５ｍ先）の既定ルートの路面６０の方向と同じ又はほぼ同じである。目標揺動角度は、後述する既定ルート地図情報とゴルフカー１の現在位置とに基づいて設定される。
【0088】
制御装置５０は、揺動軸線Ｌ１を中心とした所定の揺動角度範囲内で撮像装置１０が揺動するように、揺動装置４０を制御する。揺動角度範囲は、例えば、３０°以上であってもよい。揺動角度範囲は、例えば、１８０°以下であってもよい。揺動角度範囲は、撮像装置１０の水平画角と揺動角度範囲との合計が、例えば、１２０°以上１８０°以下となるように設定されてもよい。つまり、撮像装置１０の水平画角が９０°の場合、揺動角度範囲は、３０°以上９０°以下であってもよい。また、撮像装置１０の水平画角が４０°の場合、揺動角度範囲は、８０°以上１４０°以下であってもよい。
【0089】
具体例１において、撮像装置１０は、ステレオカメラである。図３に示すように、撮像装置１０は、左画像センサ１０ａと、右画像センサ１０ｂと、これら２つの画像センサ１０ａ、１０ｂを保持する保持体１０ｃとを有する。左画像センサ１０ａおよび右画像センサ１０ｂは、予め定められた幾何条件の下で保持体１０ｃに保持されている。保持体１０ｃは揺動装置４０に支持される。左画像センサ１０ａの光軸と右画像センサ１０ｂの光軸は平行である。全車輪３が水平面に接した状態で既定ルート走行車両１が停止しているときに、左画像センサ１０ａと右画像センサ１０ｂは同じ高さにある。撮像装置１０の揺動角度がゼロのとき、右画像センサ１０ｂと左画像センサ１０ａは、左右方向に平行な１つの直線上にある。つまり、右画像センサ１０ｂは、左画像センサ１０ａから車両右方向に離れた位置に配置される。左画像センサ１０ａおよび右画像センサ１０ｂは、ＣＣＤ（Charge coupled Device）センサやＣＭＯＳ（Complementary Metal Oxide Semiconductor）センサなどの一般的な可視光センサである。
【0090】
左画像センサ１０ａおよび右画像センサ１０ｂに固定された座標系を図５に示す。撮像装置１０の揺動角度がゼロのとき、座標系のＸ軸は左右方向に平行であって、Ｙ軸は上下方向に平行であって、Ｚ軸は前後方向に平行である。Ｘ軸およびＹ軸は、左画像および右画像の座標軸である。左画像センサ１０ａが撮像した画像を左画像とし、右画像センサ１０ｂが撮像した画像を右画像とする。撮像装置１０は、左画像および右画像を、後述する制御装置５０に出力する。
【0091】
＜制御装置の概略構成＞
図３に示すように、ゴルフカー１は、制御装置５０を備える。制御装置５０は、プロセッサ５１および記憶部５２を備える。プロセッサ５１は、例えばＣＰＵ（Central Processing Unit）、ＧＰＵ（Graphics Processing Unit）、マイクロプロセッサ、マルチプロセッサ、特定用途向け集積回路（ＡＳＩＣ）、プログラム可能な論理回路（ＰＬＣ）、フィールドプログラマブルゲートアレイ（ＦＰＧＡ）および本明細書に記載する処理を実行することができる任意の他の回路が含まれる。記憶部５２は、プロセッサ５１で実行される処理に必要な情報を記憶する。記憶部５２は、例えば、ＲＯＭ（Read Only Memory）およびＲＡＭ（Random Access Memory）を含む。
図３に示すように、ゴルフカー１は、制御装置５０を備える。制御装置５０は、プロセッサ５１および記憶部５２を備える。プロセッサ５１は、例えばＣＰＵ（Central Processing Unit）、ＧＰＵ（Graphics Processing Unit）、マイクロプロセッサ、マルチプロセッサ、特定用途向け集積回路（ＡＳＩＣ）、プログラム可能な論理回路（ＰＬＣ）、フィールドプログラマブルゲートアレイ（ＦＰＧＡ）および本明細書に記載する処理を実行することができる任意の他の回路が含まれる。記憶部５２は、プロセッサ５１で実行される処理に必要な情報を記憶する。記憶部５２は、例えば、ＲＯＭ（Read Only Memory）およびＲＡＭ（Random Access Memory）を含む。
【0092】
ゴルフカー１は、自動運転モードと手動運転モードに切換え可能である。自動運転モードでは、ゴルフカー１は既定ルートを自動的に走行する。自動運転モードの場合、制御装置５０は、ゴルフカー１を自動的に走行させるための自動運転制御を行う。また、自動運転モードにおいて、制御装置５０は、後述する路面位置関連情報に基づいて、既定ルートの路面６０上の障害物を検出する障害物検出処理を行う。自動運転モードにおいて、制御装置５０は、既定ルートの路面６０上の障害物を検出した場合、ゴルフカー１の速度を低下させる。
【0093】
（１）通常の自動運転制御
制御装置５０は、誘導線センサ８からの検出信号を取得する。制御装置５０は、制御装置５０は、誘導線センサ８からの検出信号に基づいて、操舵装置１５を制御する。
制御装置５０は、誘導線センサ８からの検出信号を取得する。制御装置５０は、制御装置５０は、誘導線センサ８からの検出信号に基づいて、操舵装置１５を制御する。
【0094】
制御装置５０の記憶部５２は、速度制御情報を予め記憶している。速度制御情報は、磁場に基づいて識別される識別情報とゴルフカー１の速度とが関連付けられた情報である。制御装置５０は、取得した識別情報に基づいて、記憶部５２から速度制御情報を読み出す。そして、制御装置５０は、取得した識別情報に関連付けられたゴルフカー１の速度を取得する。制御装置５０は、車輪回転センサ６の信号に基づいて、ゴルフカー１の現在速度を算出する。そして、制御装置５０は、ゴルフカー１の現在速度が取得した速度になるように、駆動装置４および制動装置５を制御する。なお、ゴルフカー１は、ゴルフカー１の現在速度を検出するために、車輪回転センサ６とは別に、４つの車輪３のいずれかの車輪３の回転速度を検出するセンサを有していてもよい。
【0095】
ゴルフカー１の加速が必要な場合、制御装置５０は、駆動装置４に対して、後輪３ｒｒ、３ｒｌに付与される駆動力を増加させるための信号を送信する。ゴルフカー１の減速が必要な場合、制御装置５０は、制動装置５に対して、後輪３ｒｒ、３ｒｌに付与される駆動力を減少させるための信号を送信する。必要な減速度が大きい場合には、制御装置５０は、駆動装置４への信号の送付に加えて、制動装置５に対して、４つの車輪３に制動力を付与するための信号を送信する。
【0096】
（２）既定ルートの路面６０上の障害物を検出した場合の自動運転制御
制御装置５０は、既定ルートの路面６０上の障害物を検出した場合に、ゴルフカー１の速度を低下させる。制御装置５０は、既定ルートの路面６０上の障害物を検出した場合に、ゴルフカー１の速度を低下させた後、最終的に、ゴルフカー１の走行を停止させてもよい。制御装置５０は、既定ルートの路面６０上の障害物が検出されなくなった場合に、ゴルフカー１の速度を通常の自動運転制御時の速度に戻してもよい。制御装置５０は、既定ルートの路面６０上の障害物を検出した場合に、制動装置５および駆動装置４の少なくとも一方を制御することで、ゴルフカー１の速度を低下させる、または、ゴルフカー１の走行を停止させる。
制御装置５０は、既定ルートの路面６０上の障害物を検出した場合に、ゴルフカー１の速度を低下させる。制御装置５０は、既定ルートの路面６０上の障害物を検出した場合に、ゴルフカー１の速度を低下させた後、最終的に、ゴルフカー１の走行を停止させてもよい。制御装置５０は、既定ルートの路面６０上の障害物が検出されなくなった場合に、ゴルフカー１の速度を通常の自動運転制御時の速度に戻してもよい。制御装置５０は、既定ルートの路面６０上の障害物を検出した場合に、制動装置５および駆動装置４の少なくとも一方を制御することで、ゴルフカー１の速度を低下させる、または、ゴルフカー１の走行を停止させる。
【0097】
なお、ゴルフカー１は、音または光によって乗員およびゴルフカー１の周囲の者に報知する報知手段を有していてもよい。制御装置５０は、既定ルートの路面６０上の障害物を検出した場合に、報知手段を作動させてもよい。報知手段の作動は、ゴルフカー１の速度を低下させる前に開始してもよい。
【0098】
（３）障害物検出処理
次に、制御装置５０の障害物検出処理について説明する。制御装置５０の記憶部５２は、障害物検出処理に使用する既定ルート地図情報Ｉａを予め記憶している。既定ルート地図情報Ｉａは、通常の自動運転制御にも使用されてもよい。既定ルート地図情報Ｉａには、既定ルートの路面６０の形状および幅の情報と、既定ルートの路面６０上の複数の位置の相対位置情報または絶対位置情報とが含まれる。既定ルート地図情報Ｉａは、本発明の第１既定ルート地図情報と第２既定ルート地図情報のいずれにも相当する。図４に示すように、既定ルートの路面６０の形状は、直線とカーブとで構成される。既定ルートの路面６０の形状および幅の情報とは、電磁誘導線６２の形状と既定ルートの路面６０の幅の情報であってもよい。既定ルートの路面６０の形状は、電磁誘導線６２の形状と既定ルートの路面６０の幅から特定できる。既定ルートの路面６０上の複数の位置の相対位置情報は、例えば、図４に示すスタート位置Ｓからどれだけ離れた位置であるかという情報である。例えば、図４に示す位置Ｓａの相対位置情報は、スタート位置Ｓから距離Ｄａだけ離れているという情報である。既定ルートの路面６０上の複数の位置の絶対位置情報は、例えば、緯度と経度とで表される。
次に、制御装置５０の障害物検出処理について説明する。制御装置５０の記憶部５２は、障害物検出処理に使用する既定ルート地図情報Ｉａを予め記憶している。既定ルート地図情報Ｉａは、通常の自動運転制御にも使用されてもよい。既定ルート地図情報Ｉａには、既定ルートの路面６０の形状および幅の情報と、既定ルートの路面６０上の複数の位置の相対位置情報または絶対位置情報とが含まれる。既定ルート地図情報Ｉａは、本発明の第１既定ルート地図情報と第２既定ルート地図情報のいずれにも相当する。図４に示すように、既定ルートの路面６０の形状は、直線とカーブとで構成される。既定ルートの路面６０の形状および幅の情報とは、電磁誘導線６２の形状と既定ルートの路面６０の幅の情報であってもよい。既定ルートの路面６０の形状は、電磁誘導線６２の形状と既定ルートの路面６０の幅から特定できる。既定ルートの路面６０上の複数の位置の相対位置情報は、例えば、図４に示すスタート位置Ｓからどれだけ離れた位置であるかという情報である。例えば、図４に示す位置Ｓａの相対位置情報は、スタート位置Ｓから距離Ｄａだけ離れているという情報である。既定ルートの路面６０上の複数の位置の絶対位置情報は、例えば、緯度と経度とで表される。
【0099】
制御装置５０は、障害物検出処理において、現在位置推定処理と、路面位置推定処理と、障害物検出処理と、撮像装置揺動処理とを実行する。これらの処理は、ゴルフカー１の使用中に行われる。制御装置５０は、上述した実施形態の制御装置３０を含む。制御装置５０は、本発明の制御装置を含む。以下、各処理の詳細について説明する。
【0100】
（３－１）現在位置推定処理
制御装置５０は、既定ルートの路面６０における自車１の現在位置を推定する現在位置推定処理を実行する。制御装置５０は、現在位置推定処理において、記憶部５２に記憶された既定ルート地図情報Ｉａと、車輪回転センサ６からの検出信号と、誘導線センサ８からの検出信号とに基づいて、既定ルートの路面６０における自車１の現在位置を推定する。以下、現在位置推定処理の詳細を説明する。
制御装置５０は、既定ルートの路面６０における自車１の現在位置を推定する現在位置推定処理を実行する。制御装置５０は、現在位置推定処理において、記憶部５２に記憶された既定ルート地図情報Ｉａと、車輪回転センサ６からの検出信号と、誘導線センサ８からの検出信号とに基づいて、既定ルートの路面６０における自車１の現在位置を推定する。以下、現在位置推定処理の詳細を説明する。
【0101】
制御装置５０は、車輪回転センサ６からの検出信号を用いたオドメトリ（走行距離計測法）によって、スタート位置Ｓから、または、通過した埋設マーカ６１からのゴルフカー１の移動距離を算出する。また、制御装置５０は、誘導線センサ８からの検出信号に基づいて、誘導線センサ８に対する電磁誘導線６２の左右方向のずれ量を推定する。制御装置５０は、算出された移動距離と、既定ルート地図情報Ｉａと、推定されたずれ量とに基づいて、既定ルートの路面６０における自車１の現在位置を推定する。移動距離と、既定ルート地図情報Ｉａとから、既定ルートにおけるゴルフカー１の現在のおおよその位置を推定することができる。移動距離と既定ルート地図情報Ｉａに加えて、推定されたずれ量を使うことで、既定ルートの路面６０における自車１の現在位置を推定することができる。
【0102】
現在位置の推定に、埋設マーカ６１からの移動距離が使用される場合、現在位置の推定に、埋設マーカ検出センサ７が検出した埋設マーカ６１の識別情報も使用される。つまり、この場合、制御装置５０は、現在位置推定処理において、記憶部５２に記憶された既定ルート地図情報Ｉａと、車輪回転センサ６からの検出信号と、埋設マーカ検出センサ７からの検出信号と、誘導線センサ８からの検出信号とに基づいて、既定ルートの路面６０における自車１の現在位置を推定する。
【0103】
現在位置推定処理では、既定ルート地図情報Ｉａに含まれる既定ルートの路面６０の形状の情報と、既定ルートの路面６０上の複数の位置の相対位置情報または絶対位置情報が使用される。現在位置推定処理では、既定ルート地図情報Ｉａに含まれる既定ルートの路面６０の幅の情報は使用されない。
【0104】
（３－２）路面位置推定処理
制御装置５０は、現在位置推定処理の後、路面位置推定処理を実行する。制御装置５０は、路面位置推定処理において、ゴルフカー１の使用中に撮像装置１０によって撮像された画像中の既定ルートの路面７０の位置を推定する。この路面位置推定処理では、路面位置関連情報が用いられる。路面位置関連情報とは、ゴルフカー１の使用中に撮像装置１０により撮像された画像中の既定ルートの路面７０の位置を推定するための情報である。具体例１において、路面位置関連情報は、既定ルート地図情報Ｉａである。記憶部５２は、予め路面位置関連情報を記憶している。即ち、具体例１の記憶部５２は、上述した実施形態の路面位置関連情報取得部２０の一例である。
制御装置５０は、現在位置推定処理の後、路面位置推定処理を実行する。制御装置５０は、路面位置推定処理において、ゴルフカー１の使用中に撮像装置１０によって撮像された画像中の既定ルートの路面７０の位置を推定する。この路面位置推定処理では、路面位置関連情報が用いられる。路面位置関連情報とは、ゴルフカー１の使用中に撮像装置１０により撮像された画像中の既定ルートの路面７０の位置を推定するための情報である。具体例１において、路面位置関連情報は、既定ルート地図情報Ｉａである。記憶部５２は、予め路面位置関連情報を記憶している。即ち、具体例１の記憶部５２は、上述した実施形態の路面位置関連情報取得部２０の一例である。
【0105】
制御装置５０は、撮像装置１０の現在の揺動角度を取得する。制御装置５０は、記憶部５２に記憶された既定ルート地図情報Ｉａ（路面位置関連情報）、制御装置５０によって推定された既定ルート走行車両１の現在位置、および、撮像装置１０の現在の揺動角度に関連する情報に基づいて、撮像装置１０により撮像された画像中の既定ルートの路面７０の位置を推定する。推定された自車１の現在位置と、既定ルート地図情報Ｉａとから、自車１の将来の走行位置を含む既定ルートの路面６０の一部分の形状および幅を推定できる。また、自車１の将来の走行位置を含む既定ルートの路面６０の一部分の形状および幅と、撮像装置１０の現在の揺動角度とに基づいて、現在位置において現在の揺動角度で撮像装置１０により撮像された画像中の既定ルートの路面７０の位置を推定できる。そのため、既定ルート地図情報Ｉａと、推定された自車１の現在位置と、撮像装置１０の現在の揺動角度とから、画像中の既定ルートの路面７０の位置を推定することができる。
【0106】
路面位置推定処理では、既定ルート地図情報Ｉａに含まれる既定ルートの路面６０の形状および幅の情報と、既定ルートの路面６０上の複数の位置の相対位置情報または絶対位置情報が使用される。画像中の既定ルートの路面７０の位置を推定するとは、少なくとも、画像中の既定ルートの路面７０の幅方向両端の位置を推定することである。以下、路面位置推定処理の一例の詳細を説明する。
【0107】
制御装置５０は、左画像センサ１０ａにより撮像された左画像と右画像センサ１０ｂにより撮像された右画像とに基づいて視差画像を生成する。視差画像は、例えばＳＡＤ（Sum of Absolute Difference）等のステレオマッチングにより生成することができる。ステレオマッチングの方法は、他にも、面積相関法や、Census transformが挙げられる。視差画像の座標系は、図５に示す撮像装置１０に固定された座標系と同じである。つまり、視差画像は、図５に示すＸ軸とＹ軸を座標軸とする。視差画像は、座標値ごとに視差値を有する。視差値は、右画像と左画像の画素のずれ量である。視差値は、例えば、左画像に対する右画像の横方向の画素のずれ量であってもよい。制御装置５０が生成する視差画像の一例である視差画像Ｐ１を図６に示す。視差画像Ｐ１は、図４におけるスタート位置Ｓから距離Ｄａ離れた位置Ｓａにおいて揺動角度θａの撮像装置１０で撮像した画像に基づいて生成された視差画像である。
【0108】
制御装置５０は、既定ルート地図情報Ｉａ（路面位置関連情報）、推定された自車１の現在位置、および、撮像装置１０の現在の揺動角度に関連する情報に基づいて、視差画像中の既定ルートの路面７０の位置を推定する。具体的には、制御装置５０は、視差画像中の既定ルートの路面７０の両端を示す複数のＸ座標値を算出（推定）する。より詳細には、制御装置５０は、視差画像中の既定ルートの路面７０の両端を示す複数のＸ座標値と、各Ｘ座標値に対応付けられた視差値の範囲を算出する。つまり、制御装置５０は、視差画像中の既定ルートの路面７０の両端を厳密に示すのではなく、視差画像中の既定ルートの路面７０の両端とその近傍を示す複数のＸ座標値を算出する。
【0109】
例えば、制御装置５０は、既定ルート地図情報Ｉａに含まれる既定ルートの路面６０の形状の情報と、既定ルート地図情報Ｉａに含まれる既定ルートの路面６０上の複数の位置の相対位置情報または絶対位置情報と、推定された自車１の現在位置と、撮像装置１０の現在の揺動角度に関連する情報とに基づいて、視差画像中の既定ルートの路面７０の幅方向中央を通るラインを推定してもよい。この場合、制御装置５０は、推定されたライン上の複数の視差値と、既定ルート地図情報Ｉａに含まれる既定ルートの路面６０の実際の幅の情報とに基づいて、視差画像上の既定ルートの路面７０の両端を示す複数のＸ座標値および各Ｘ座標に対応する視差値の範囲を算出する。
また、例えば、制御装置５０は、既定ルート地図情報Ｉａと、推定された自車１の現在位置と、撮像装置１０の現在の揺動角度に関連する情報とに基づいて、視差画像中の既定ルートの路面７０の両端を示す複数のＸ座標値および各Ｘ座標に対応する視差値の範囲を直接算出してもよい。
また、例えば、制御装置５０は、既定ルート地図情報Ｉａと、推定された自車１の現在位置と、撮像装置１０の現在の揺動角度に関連する情報とに基づいて、視差画像中の既定ルートの路面７０の両端を示す複数のＸ座標値および各Ｘ座標に対応する視差値の範囲を直接算出してもよい。
【0110】
図６に示す視差画像Ｐ１中の既定ルートの路面７０の幅方向両端の位置を示す複数のＸ座標値は、視差値の範囲ｄａに対応付けられたＸ座標値Ｘ1およびＸ10と、視差値の範囲ｄｂに対応付けられたＸ座標値Ｘ2およびＸ9と、視差値の範囲ｄｃに対応付けられたＸ座標値Ｘ3およびＸ8と、視差値の範囲ｄｄに対応付けられたＸ座標値Ｘ4およびＸ7と、視差値の範囲ｄｅに対応付けられたＸ座標値Ｘ5およびＸ6である。視差値の範囲ｄａ～ｄｇの関係は、ｄａ＞ｄｂ＞ｄｃ＞ｄｄ＞ｄｅ＞ｄｆ＞ｄｇである。
【0111】
図６の視差画像Ｐ１では、障害物Ｏｂ４があることによって、視差値が範囲ｄｅ内でＸ座標値がＸ5である領域が存在しない。制御装置５０は、例えば、視差値が範囲ｄｅでＸ座標値がＸ6の線分などから、視差画像Ｐ１において視差値が範囲ｄｅでＸ座標値がＸ5の線分の位置を推定する。
【0112】
（３－３）障害物検出処理
制御装置５０は、路面位置推定処理の後、障害物検出処理を実行する。制御装置５０は、障害物検出処理において、撮像装置１０により撮像された画像中の既定ルートの路面７０（６０）上の障害物を検出する。
制御装置５０は、路面位置推定処理の後、障害物検出処理を実行する。制御装置５０は、障害物検出処理において、撮像装置１０により撮像された画像中の既定ルートの路面７０（６０）上の障害物を検出する。
【0113】
まず、制御装置５０は、撮像装置１０により撮像された画像中の障害物を検出する。制御装置５０は、生成した視差画像を用いて、画像中の障害物を検出する。ここでの障害物とは、ゴルフカー１の走行にとって障害となる可能性を有するか否かは問わず、立体物をいう。画像中の障害物を検出する処理は、画像中の既定ルートの路面７０の位置を推定した後に行ってもよく、推定する前に行ってもよい。制御装置５０は、生成した視差画像において、例えば、同じ視差値がＹ軸方向に予め定められた画素数を超えて連続し、視差値が異なる領域とＸ軸方向に隣接する領域を、障害物として検出してもよい。制御装置５０は、生成した視差画像において、例えば、所定の範囲内の視差値がＹ軸方向に予め定められた画素数を超えて連続し、視差値の差が所定値より大きい領域とＸ軸方に隣接する領域を、障害物として検出してもよい。図６において、領域Ｏｂ１、Ｏｂ２、Ｏｂ３、Ｏｂ４が障害物として検出される。
【0114】
次に、制御装置５０は、検出された障害物が、既定ルートの路面７０上に存在するか否かを判定する。つまり、制御装置５０は、視差画像中の障害物が、路面位置推定処理で推定された視差画像中の既定ルートの路面７０上に存在するか否かを判定する。具体的には、制御装置５０は、視差画像において、障害物の下端を示すＸ座標値が、既定ルートの路面７０を示し、障害物の下端の視差値と同じ視差値に対応付けられたＸ座標値の範囲内に含まれるかどうかを判定する。含まれる場合、障害物が既定ルートの路面７０上にあると判定される。この方法により、既定ルートの路面６０に接する障害物だけでなく、既定ルートの路面６０に接しておらず既定ルートの路面６０の真上に存在する障害物も検出できる。例えば、図６に示される障害物Ｏｂ１～Ｏｂ４のうち、障害物Ｏｂ４だけが既定ルートの路面７０上にあると判定される。このようにして、制御装置５０は、既定ルートの路面６０上の障害物を検出する。
【0115】
なお、制御装置５０は、視差画像中の障害物を囲む最小の矩形領域が、視差画像中の既定ルートの路面７０と重なるかどうかを判定した後で、既定ルートの路面７０と重なる矩形領域内の障害物に対して、上述した判定をしてもよい。この２段階判定により、より高速に障害物が既定ルートの路面７０上に存在するか否かを判定することができる。
【0116】
（３－４）撮像装置揺動処理
制御装置５０は、撮像装置揺動処理において、既定ルートの路面６０における自車１の将来の走行位置が撮像装置１０の撮像範囲に含まれるように、記憶部５２に記憶された既定ルート地図情報Ｉａ、および、制御装置５０によって推定された自車１の現在位置に基づいて、揺動装置４０の目標揺動角度を設定する。推定された自車１の現在位置と、既定ルート地図情報Ｉａとから、自車１の将来の走行位置を含む既定ルートの路面６０の一部分の形状を推定できる。つまり、推定された自車１の現在位置と、既定ルート地図情報Ｉａとから、自車１の将来の走行位置を含む既定ルートの路面６０の一部分の方向を推定できる。自車１の将来の走行位置を含む既定ルートの路面６０の一部分の方向から、既定ルートの路面６０における自車１の将来の走行位置が撮像装置１０の撮像範囲に含まれるように揺動装置４０の目標揺動角度を設定できる。
制御装置５０は、撮像装置揺動処理において、既定ルートの路面６０における自車１の将来の走行位置が撮像装置１０の撮像範囲に含まれるように、記憶部５２に記憶された既定ルート地図情報Ｉａ、および、制御装置５０によって推定された自車１の現在位置に基づいて、揺動装置４０の目標揺動角度を設定する。推定された自車１の現在位置と、既定ルート地図情報Ｉａとから、自車１の将来の走行位置を含む既定ルートの路面６０の一部分の形状を推定できる。つまり、推定された自車１の現在位置と、既定ルート地図情報Ｉａとから、自車１の将来の走行位置を含む既定ルートの路面６０の一部分の方向を推定できる。自車１の将来の走行位置を含む既定ルートの路面６０の一部分の方向から、既定ルートの路面６０における自車１の将来の走行位置が撮像装置１０の撮像範囲に含まれるように揺動装置４０の目標揺動角度を設定できる。
【0117】
目標揺動角度を設定する処理では、既定ルート地図情報Ｉａに含まれる既定ルートの路面６０の形状の情報と、既定ルートの路面６０上の複数の位置の相対位置情報または絶対位置情報が使用される。目標揺動角度を設定する処理では、既定ルート地図情報Ｉａに含まれる既定ルートの路面６０の幅の情報は使用されない。
【0118】
制御装置５０は、撮像装置揺動処理において、設定した目標揺動角度に基づいて揺動装置４０を制御する。揺動装置４０は、設定された目標揺動角度となるように撮像装置１０を揺動させる。以上が、障害物検出処理の説明である。
【0119】
具体例１は、上述した実施形態の効果に加えて、以下の効果を奏する。
【0120】
制御装置５０は、揺動軸線Ｌ１を中心とした３０°以上１８０°以下の揺動角度範囲内で撮像装置１０が揺動するように、揺動装置４０を制御する。揺動角度範囲が３０°以上と比較的大きい。そのため、撮像装置１０の水平画角が小さくても、ゴルフカー１が曲率半径の小さいカーブを走行する場合に、撮像装置１０によって撮像された画像に、既定ルートの路面６０における将来の走行位置をより確実に含めることができる。
【0121】
制御装置５０は、記憶部５２に記憶された既定ルート地図情報Ｉａ、および、制御装置５０によって推定された現在位置に基づいて、揺動装置４０の目標揺動角度を設定する。これにより、ゴルフカー１の使用中にゴルフカー１が目標揺動角度の情報を取得する場合に比べて、ゴルフカー１が使用中に取得する情報量を抑えつつ、目標揺動角度をより細かく設定することができる。それにより、撮像された画像内の好適な位置に既定ルートの路面６０をより確実に含ませることができる。その結果、既定ルートの路面６０上にあってゴルフカー１から遠い障害物の検出精度および検出率をより向上できる。
【0122】
記憶部５２（路面位置関連情報取得部）は、路面位置関連情報を予め記憶する。これにより、ゴルフカー１の使用中にゴルフカー１が路面位置関連情報を取得する場合に比べて、ゴルフカー１の使用中に取得する情報量を抑えつつ、路面位置関連情報をより細かく取得することができる。制御装置５０は、このように取得された路面位置関連情報を用いて、既定ルートの路面６０上の障害物を検出する。そのため、既定ルートの路面６０上にあってゴルフカー１から遠い障害物の検出精度および検出率をより向上できる。
【0123】
記憶部５２（路面位置関連情報取得部）は、路面位置関連情報として、既定ルートの路面６０の形状および幅の情報と、既定ルートの路面６０上の複数の位置の相対位置情報または絶対位置情報とを含む既定ルート地図情報Ｉａを予め記憶する。そのため、制御装置５０は、予め記憶された既定ルート地図情報Ｉａ（路面位置関連情報）、制御装置５０によって推定された現在位置、および、撮像装置１０の現在の揺動角度に関連する情報に基づいて、撮像装置１０により撮像された画像中の既定ルートの路面６０（７０）の位置を推定することができる。
【0124】
撮像装置１０は、左画像センサ１０ａと右画像センサ１０ｂとを有するステレオカメラである。左画像センサ１０ａと右画像センサ１０ｂとを有するステレオカメラを撮像装置１０として用いることで、左画像センサ１０ａにより撮像された左画像と、右画像センサ１０ｂにより撮像された右画像とに基づいて視差画像を生成して、この視差画像を用いて障害物を検出することが可能となる。また、１次元スキャンのレーザーレーダを用いた障害物検出では、起伏のある路面を障害物として検出しやすいという問題がある。一方、ステレオカメラを用いた障害物検出では、路面の起伏の影響を抑えながら、障害物を検出することができる。その結果、既定ルートの路面６０上にあってゴルフカー１から遠い障害物の検出精度および検出率をより向上できる。
【0125】
制御装置５０は、既定ルートの路面６０上の障害物を検出した場合に、ゴルフカー１の速度を低下させる、または、ゴルフカー１の走行を停止させる。これにより、手動ではなく自動で、ゴルフカー１を減速または停止させることができる。その結果、障害物との接触が回避される可能性を高めることができる。
【0126】
（実施形態の具体例１の変更例１）
具体例１において、記憶部５２は、路面位置関連情報として、既定ルート地図情報Ｉａを予め記憶している。そして、制御装置５０は、生成した視差画像、記憶部５２に記憶された既定ルート地図情報Ｉａ（路面位置関連情報）、制御装置５０によって推定された自車１の現在位置、および、撮像装置１０の現在の揺動角度に関連する情報に基づいて、視差画像中の既定ルートの路面７０の両端を示す複数のＸ座標値を算出している。
しかし、記憶部５２は、路面位置関連情報として、既定ルートの路面６０の複数の位置Ｓ１～Ｓｎの事前取得視差画像中の既定ルートの路面６０の両端を示す複数のＸ座標値を含む複数の路面座標情報を予め記憶していてもよい。
具体例１において、記憶部５２は、路面位置関連情報として、既定ルート地図情報Ｉａを予め記憶している。そして、制御装置５０は、生成した視差画像、記憶部５２に記憶された既定ルート地図情報Ｉａ（路面位置関連情報）、制御装置５０によって推定された自車１の現在位置、および、撮像装置１０の現在の揺動角度に関連する情報に基づいて、視差画像中の既定ルートの路面７０の両端を示す複数のＸ座標値を算出している。
しかし、記憶部５２は、路面位置関連情報として、既定ルートの路面６０の複数の位置Ｓ１～Ｓｎの事前取得視差画像中の既定ルートの路面６０の両端を示す複数のＸ座標値を含む複数の路面座標情報を予め記憶していてもよい。
【0127】
複数の位置Ｓ１～Ｓｎの事前取得視差画像とは、複数の位置Ｓ１～Ｓｎの各々においてゴルフカー１の撮像装置１０により事前に撮像された右画像と左画像に基づいて作成された視差画像である。より詳細には、事前取得視差画像は、ゴルフカー１の撮像装置１０を揺動させることなく撮像した右画像と左画像に基づいて生成された視差画像である。例えば、事前取得視差画像を撮像するときの撮像装置１０は、揺動角度がゼロの状態で固定されている。複数の位置Ｓ１～Ｓｎは、例えば等間隔で並んでいてもよい。複数の位置Ｓ１～Ｓｎは、スタート位置Ｓを含んでいてもよい。
【0128】
路面座標情報は、Ｘ座標値と対応付けられた視差値または視差値の範囲も含む。複数の路面座標情報は、複数の位置Ｓ１～Ｓｎと対応付けて記憶部５２に記憶されている。１つの位置に対する路面座標情報の数は１つである。このように、路面座標情報は、ゴルフカー１の撮像装置１０により事前に撮像された画像に基づいて生成されている。複数の路面座標情報は、ゴルフカー１の撮像装置１０を揺動させずに撮像した画像に基づいて生成されている。路面座標情報は、事前に撮像された画像と、この画像が撮像された位置の位置情報と、既定ルートの路面６０の形状の情報に基づいて生成される。なお、路面座標情報は、ゴルフカー１とは異なる車両の撮像装置によって事前に撮像された画像に基づいて生成されていてもよい。但し、この場合も撮像装置は揺動されない。
【0129】
図７に、具体例１の変更例１の路面位置関連情報を生成するために用いた事前取得視差画像の一例である事前取得視差画像Ｐ２を示す。図７に示される事前取得視差画像Ｐ２は、図４に示す位置Ｓａで撮像された画像に基づいて生成されている。なお、上述したように、図６に示される視差画像Ｐ１も、位置Ｓａで撮像された画像に基づいて生成されている。この事前取得視差画像Ｐ２に基づいて生成された路面座標情報は、視差値の範囲ｄａに対応付けられたＸ座標値Ｘ11およびＸ16と、視差値の範囲ｄｂに対応付けられたＸ座標値Ｘ12およびＸ17と、視差値の範囲ｄｃに対応付けられたＸ座標値Ｘ13およびＸ18と、視差値の範囲ｄｄに対応付けられたＸ座標値Ｘ14およびＸ19と、および、視差値の範囲ｄｅに対応付けられたＸ座標値Ｘ15およびＸ20とである。
【0130】
制御装置５０は、複数の位置Ｓ１～Ｓｎと対応付けて記憶部５２に記憶された複数の路面座標情報の中から、推定された自車１の現在位置に最も近い位置に対応付けられた路面座標情報を抽出する。例えば、推定された自車１の現在位置が位置Ｓａに最も近い場合、事前取得視差画像Ｐ２に基づいて生成された路面座標情報が抽出される。制御装置５０は、撮像装置１０の現在の揺動角度に関連する情報に基づいて、抽出された路面座標情報のＸ座標値及び視差値を補正する。制御装置５０は、補正後のＸ座標値および視差値から、現在の揺動角度の撮像装置１０で撮影された画像中の既定ルートの路面７０の位置を推定できるように、Ｘ座標値および視差値を補正する。
【0131】
具体例１の変更例１では、具体例１と路面位置関連情報が異なる。しかし、具体例１の変更例１では、具体例１と同様に、ゴルフカー１の使用中にゴルフカー１が路面位置関連情報を取得する場合に比べて、ゴルフカー１の使用中に取得する情報量を抑えつつ、路面位置関連情報をより細かく取得することができる。制御装置５０は、このように取得された路面位置関連情報を用いて、既定ルートの路面６０上の障害物を検出する。そのため、既定ルートの路面６０上にあってゴルフカー１から遠い障害物の検出精度および検出率をより向上できる。
【0132】
（実施形態の具体例１の変更例２）
具体例１の変更例１では、複数の路面座標情報は、ゴルフカー１の撮像装置１０を揺動させずに撮像した画像に基づいて生成されている。しかし、複数の路面座標情報は、既定ルートの路面６０における自車の将来の走行位置が画像内に含まれるように撮像装置１０を揺動させつつ撮像した画像に基づいて生成されてもよい。なお、具体例１の変更例１と同様に、路面座標情報は、ゴルフカー１とは異なる車両の撮像装置によって事前に撮像された画像に基づいて生成されていてもよい。以下、具体例１の変更例１と異なる点についてのみ説明する。
具体例１の変更例１では、複数の路面座標情報は、ゴルフカー１の撮像装置１０を揺動させずに撮像した画像に基づいて生成されている。しかし、複数の路面座標情報は、既定ルートの路面６０における自車の将来の走行位置が画像内に含まれるように撮像装置１０を揺動させつつ撮像した画像に基づいて生成されてもよい。なお、具体例１の変更例１と同様に、路面座標情報は、ゴルフカー１とは異なる車両の撮像装置によって事前に撮像された画像に基づいて生成されていてもよい。以下、具体例１の変更例１と異なる点についてのみ説明する。
【0133】
複数の路面座標情報の各々は、撮像装置１０の揺動角度と対応付けて記憶部５２に記憶されている。詳細には、路面座標情報は、事前取得視差画像を生成するための画像を撮像したときの撮像装置１０の揺動角度と対応付けて記憶されている。
【0134】
制御装置５０は、複数の位置Ｓ１～Ｓｎと対応付けて記憶部５２に記憶された複数の路面座標情報の中から、推定された自車１の現在位置に最も近い位置に対応付けられた路面座標情報を抽出する。制御装置５０は、撮像装置１０の現在の揺動角度に関連する情報と、抽出した路面座標情報に対応付けられた撮像装置１０の揺動角度とに基づいて、抽出された路面座標情報のＸ座標値及び視差値を補正する。制御装置５０は、補正後のＸ座標値および視差値から、現在の揺動角度の撮像装置１０で撮影された画像中の既定ルートの路面７０の位置を推定できるように、Ｘ座標値および視差値を補正する。
【0135】
具体例１の変更例２でも、ゴルフカー１の使用中にゴルフカー１が路面位置関連情報を取得する場合に比べて、ゴルフカー１の使用中に取得する情報量を抑えつつ、路面位置関連情報をより細かく取得することができる。制御装置５０は、このように取得された路面位置関連情報を用いて、既定ルートの路面６０上の障害物を検出する。そのため、既定ルートの路面６０上にあってゴルフカー１から遠い障害物の検出精度および検出率をより向上できる。
【0136】
（実施形態の具体例２）
本発明の実施形態の具体例２について、図８に基づいて説明する。図８は、ゴルフカーの概略構成を示すブロック図である。具体例２のゴルフカー１０１は、上述した実施形態の既定ルート走行車両１の特徴を全て有している。以下の説明では、上述した実施形態および具体例１と同じ部位についての説明は省略する。
本発明の実施形態の具体例２について、図８に基づいて説明する。図８は、ゴルフカーの概略構成を示すブロック図である。具体例２のゴルフカー１０１は、上述した実施形態の既定ルート走行車両１の特徴を全て有している。以下の説明では、上述した実施形態および具体例１と同じ部位についての説明は省略する。
【0137】
具体例２のゴルフカー１０１の制御装置１５０は、プロセッサ１５１および記憶部１５２を備える。記憶部１５２は、既定ルートの路面６０の幅の情報を予め記憶している。制御装置１５０は、既定ルートの路面６０における自車１０１の現在位置を推定しない。また、具体例２のゴルフカー１０１は、ゴルフカー１０１の使用中に、ゴルフカー１０１の速度の制御に使用される目標速度情報を取得する。目標速度情報は、目標速度情報が取得された直後のゴルフカー１０１の目標とする速度に関する情報である。よって、ゴルフカー１０１は、自車１０１の位置を推定したり、ゴルフカー１０１の速度を制御したりするために必要な車輪回転センサ６および埋設マーカ検出センサ７を備えていない。
【0138】
具体例２のゴルフカー１０１は、ＲＦＩＤ（Radio Frequency Identification）タグから情報を読み取るＲＦＩＤリーダ１７０を備えている。ＲＦＩＤリーダ１７０は、ゴルフカー１０１の使用中に、自車１０１の将来の走行位置を含む既定ルートの路面６０の一部分の形状の情報を取得する。ゴルフカー１０１の使用中にＲＦＩＤリーダ１７０が取得する既定ルートの路面６０の一部分の形状の情報は、本発明の路面位置関連情報に相当する。具体例２のＲＦＩＤリーダ１７０は、上述した実施形態の路面位置関連情報取得部２０の一例である。つまり、具体例２のＲＦＩＤリーダ１７０は、本発明の路面位置関連情報取得部に相当する。また、具体例２のＲＦＩＤリーダ１７０は、本発明の路面形状情報取得部にも相当する。
【0139】
具体例２では、図４に示す複数の埋設マーカ６１の代わりに、複数のＲＦＩＤタグが、既定ルートに沿って配置されている。ＲＦＩＤタグは、地表に剥き出しの状態であっても、地中に埋設されていてもよい。ＲＦＩＤタグの各々には、ゴルフカー１０１の目標速度情報と、既定ルートの路面６０の一部分の形状の情報とが記憶されている。
【0140】
ＲＦＩＤリーダ１７０は、ゴルフカー１０１がＲＦＩＤタグの上を通過する度に、直下のＲＦＩＤタグから目標速度情報を取得する。制御装置１５０は、ＲＦＩＤリーダ１７０が取得した目標速度情報に基づいて、駆動装置４または／および制動装置５を制御する。
【0141】
ＲＦＩＤリーダ１７０は、ゴルフカー１０１がＲＦＩＤタグの上を通過する度に、直下のＲＦＩＤタグから、既定ルートの路面６０の一部分の形状の情報を取得する。制御装置１５０は、記憶部１５２に記憶された既定ルートの路面６０の幅の情報、ＲＦＩＤリーダ１７０（路面位置関連情報取得部）が取得した既定ルートの路面６０の一部分の形状の情報、および、撮像装置１０の現在の揺動角度に関連する情報に基づいて、撮像装置１０により撮像された画像中の既定ルートの路面６０（７０）の位置を推定する。そして、制御装置１５０は、画像中の既定ルートの路面６０（７０）上の障害物を検出する。制御装置１５０は、上述した実施形態の制御装置３０を含む。
【0142】
ＲＦＩＤリーダ１７０は、ゴルフカー１０１がＲＦＩＤタグの上を通過する度に、直下のＲＦＩＤタグから、既定ルートの路面６０の一部分の形状の情報を取得する。制御装置１５０は、既定ルートの路面６０における自車１０１の将来の走行位置が撮像装置１０の撮像範囲に含まれるように、ＲＦＩＤリーダ１７０（路面形状情報取得部）が取得した既定ルートの路面６０の一部分の形状の情報に基づいて、揺動装置４０の目標揺動角度を設定する。揺動装置４０は、制御装置１５０によって設定された目標揺動角度に基づいて、撮像装置１０を揺動させる。
【0143】
具体例２は、上述した実施形態の効果に加えて、以下の効果を奏する。具体例２は、具体例１と同じ構成に関して、具体例１の効果と同じ効果を奏する。また、具体例２では、撮像装置１０の目標揺動角度の設定のための現在位置の推定が不要である。さらに、具体例２では、画像中の既定ルートの路面６０（７０）の位置の推定のための現在位置の推定が不要である。画像中の既定ルートの路面６０（７０）の位置の推定のための現在位置の推定が不要でありながら、画像中の既定ルートの路面６０（７０）の位置を精度良く推定できる。
【0144】
（実施形態の具体例２の変更例１）
具体例２において、ＲＦＩＤリーダ１７０は、ゴルフカー１０１の使用中に、路面位置関連情報として、既定ルートの路面６０の一部分の形状の情報を取得する。既定ルートの路面６０の幅の情報は、記憶部１５２に予め記憶されている。制御装置１５０は、記憶部１５２に記憶された既定ルートの路面６０の幅の情報、ＲＦＩＤリーダ１７０が取得した既定ルートの路面６０の一部分の形状の情報、および、撮像装置１０の現在の揺動角度に関連する情報に基づいて、撮像装置１０により撮像された画像中の既定ルートの路面６０（７０）の位置を推定する。
しかし、ＲＦＩＤリーダ１７０が、ゴルフカー１０１の使用中に、路面位置関連情報として、既定ルートの路面６０の一部分の形状および幅の情報を取得してもよい。この場合、記憶部１５２は、既定ルートの路面６０の幅の情報を記憶していなくてよい。制御装置１５０は、ＲＦＩＤリーダ１７０が取得した既定ルートの路面６０の一部分の形状および幅の情報、および、撮像装置１０の現在の揺動角度に関連する情報に基づいて、撮像装置１０により撮像された画像中の既定ルートの路面６０の位置を推定する。
具体例２において、ＲＦＩＤリーダ１７０は、ゴルフカー１０１の使用中に、路面位置関連情報として、既定ルートの路面６０の一部分の形状の情報を取得する。既定ルートの路面６０の幅の情報は、記憶部１５２に予め記憶されている。制御装置１５０は、記憶部１５２に記憶された既定ルートの路面６０の幅の情報、ＲＦＩＤリーダ１７０が取得した既定ルートの路面６０の一部分の形状の情報、および、撮像装置１０の現在の揺動角度に関連する情報に基づいて、撮像装置１０により撮像された画像中の既定ルートの路面６０（７０）の位置を推定する。
しかし、ＲＦＩＤリーダ１７０が、ゴルフカー１０１の使用中に、路面位置関連情報として、既定ルートの路面６０の一部分の形状および幅の情報を取得してもよい。この場合、記憶部１５２は、既定ルートの路面６０の幅の情報を記憶していなくてよい。制御装置１５０は、ＲＦＩＤリーダ１７０が取得した既定ルートの路面６０の一部分の形状および幅の情報、および、撮像装置１０の現在の揺動角度に関連する情報に基づいて、撮像装置１０により撮像された画像中の既定ルートの路面６０の位置を推定する。
【0145】
具体例２の変更例１では、画像中の既定ルートの路面６０（７０）の位置の推定の方法が具体例２と異なる。しかし、具体例２の変更例１では、具体例２と同様に、画像中の既定ルートの路面６０（７０）の位置の推定のための現在位置の推定が不要である。具体例２の変更例１では、画像中の既定ルートの路面６０（７０）の位置の推定のための現在位置の推定が不要でありながら、画像中の既定ルートの路面６０（７０）の位置を精度良く推定できる。
【0146】
（実施形態の具体例２の変更例２）
具体例２において、制御装置１５０は、ゴルフカー１０１の使用中にＲＦＩＤリーダ１７０が取得した既定ルートの路面６０の一部分の形状の情報に基づいて、揺動装置４０の目標揺動角度を設定する。
しかし、ゴルフカー１０１の使用中にＲＦＩＤリーダ１７０が目標揺動角度を取得し、制御装置１５０は、取得された目標揺動角度に基づいて揺動装置４０を制御してもよい。すなわち、ＲＦＩＤタグには、揺動装置４０の目標揺動角度に関連する情報が記憶されている。
具体例２において、制御装置１５０は、ゴルフカー１０１の使用中にＲＦＩＤリーダ１７０が取得した既定ルートの路面６０の一部分の形状の情報に基づいて、揺動装置４０の目標揺動角度を設定する。
しかし、ゴルフカー１０１の使用中にＲＦＩＤリーダ１７０が目標揺動角度を取得し、制御装置１５０は、取得された目標揺動角度に基づいて揺動装置４０を制御してもよい。すなわち、ＲＦＩＤタグには、揺動装置４０の目標揺動角度に関連する情報が記憶されている。
【0147】
具体例２の変更例２では、揺動装置４０の目標揺動角度の設定の方法が具体例２と異なる。しかし、具体例２の変更例２では、具体例２と同様に、揺動装置４０の目標揺動角度の設定のための現在位置の推定が不要である。具体例２の変更例２では、撮像装置の目標揺動角度の設定のための現在位置の推定が不要でありながら、撮像装置の目標揺動角度を細かく設定できる。
【0148】
（実施形態の具体例３）
本発明の実施形態の具体例３について、図９に基づいて説明する。図９は、ゴルフカーの概略構成を示すブロック図である。具体例３のゴルフカー２０１は、上述した実施形態の既定ルート走行車両１の特徴を全て有している。以下の説明では、上述した実施形態およびその具体例１、２と同じ部位についての説明は省略する。
本発明の実施形態の具体例３について、図９に基づいて説明する。図９は、ゴルフカーの概略構成を示すブロック図である。具体例３のゴルフカー２０１は、上述した実施形態の既定ルート走行車両１の特徴を全て有している。以下の説明では、上述した実施形態およびその具体例１、２と同じ部位についての説明は省略する。
【0149】
具体例３の制御装置２５０は、プロセッサ２５１および記憶部２５２を備える。記憶部２５２は、既定ルート地図情報Ｉｂを予め記憶している。既定ルート地図情報Ｉｂには、既定ルートの路面６０の形状の情報と、既定ルートの路面６０上の複数の位置の相対位置情報または絶対位置情報とが含まれる。既定ルート地図情報Ｉｂは、本発明の第１既定ルート地図情報に相当する。また、記憶部２５２は、既定ルートの路面６０の幅の情報を記憶する。つまり、実質的には、記憶部２５２は、具体例１と同様に、既定ルートの路面６０の形状および幅の情報と、既定ルートの路面６０上の複数の位置の相対位置情報または絶対位置情報とを記憶する。
【0150】
具体例３のゴルフカー２０１は、具体例１のゴルフカー１と同様に、車輪回転センサ６および埋設マーカ検出センサ７を備える。制御装置２５０は、記憶部２５２に記憶された既定ルート地図情報Ｉｂと、車輪回転センサ６からの検出信号と、誘導線センサ８からの検出信号とに基づいて、既定ルートの路面６０における自車２０１の現在位置を推定する。もしくは、具体例３の制御装置２５０は、記憶部２５２に記憶された既定ルート地図情報Ｉｂと、車輪回転センサ６からの検出信号と、埋設マーカ検出センサ７からの検出信号と、誘導線センサ８からの検出信号とに基づいて、既定ルートの路面６０における自車２０１の現在位置を推定する。
【0151】
また、具体例３のゴルフカー２０１は、具体例２のゴルフカー１０１と同様に、ＲＦＩＤリーダ１７０を備えている。ＲＦＩＤリーダ１７０は、ゴルフカー２０１の使用中に、路面位置関連情報として、既定ルートの路面６０の一部分の形状の情報をＲＦＩＤタグから取得する。具体例３のＲＦＩＤリーダ１７０は、上述した実施形態の路面位置関連情報取得部２０の一例である。
【0152】
制御装置２５０は、具体例２の制御装置１５０と同様に、記憶部２５２に記憶された既定ルートの路面６０の幅の情報、ＲＦＩＤリーダ１７０が取得した既定ルートの路面６０の一部分の形状の情報、および、撮像装置１０の現在の揺動角度に関連する情報に基づいて、撮像装置１０により撮像された画像中の既定ルートの路面６０（７０）の位置を推定する。制御装置２５０は、上述した実施形態の制御装置３０を含む。
【0153】
また、制御装置２５０は、具体例１の制御装置５０と同様に、既定ルートの路面６０における自車２０１の将来の走行位置が撮像装置１０の撮像範囲に含まれるように、記憶部２５２に記憶された既定ルート地図情報Ｉｂ、および、制御装置２５０によって推定された自車２０１の現在位置に基づいて、揺動装置４０の目標揺動角度を設定する。揺動装置４０は、制御装置２５０によって設定された目標揺動角度に基づいて、撮像装置１０を揺動させる。
【0154】
具体例３は、上述した実施形態の効果に加えて、以下の効果を奏する。具体例３は、具体例１と同じ構成に関して、具体例１の効果と同じ効果を奏する。具体例３は、具体例２と同じ構成に関して、具体例２の効果と同じ効果を奏する。
【0155】
具体例３では、揺動装置４０の目標揺動角度の設定の方法が、具体例１と同じある。具体例３では、記憶部２５２に記憶された既定ルート地図情報Ｉｂ、および、制御装置２５０によって推定された現在位置に基づいて、揺動装置４０の目標揺動角度が設定される。これにより、ゴルフカー２０１の使用中にゴルフカー２０１が目標揺動角度の情報を取得する場合に比べて、ゴルフカー２０１が使用中に取得する情報量を抑えつつ、目標揺動角度をより細かく設定することができる。それにより、撮像された画像内の好適な位置に既定ルートの路面６０をより確実に含ませることができる。その結果、既定ルートの路面６０上にあってゴルフカー２０１から遠い障害物の検出精度および検出率をより向上できる。
【0156】
具体例３では、画像中の既定ルートの路面６０（７０）の位置の推定の方法が、具体例２と同じである。具体例３では、具体例２と同様に、画像中の既定ルートの路面６０（７０）の位置の推定のための現在位置の推定が不要である。画像中の既定ルートの路面６０（７０）の位置の推定のための現在位置の推定が不要でありながら、画像中の既定ルートの路面６０（７０）の位置を精度良く推定できる。
【0157】
（実施形態の具体例３の変更例１）
具体例３において、ＲＦＩＤリーダ１７０は、ゴルフカー２０１の使用中に、路面位置関連情報として、既定ルートの路面６０の一部分の形状の情報を取得する。既定ルートの路面６０の幅の情報は、記憶部２５２に予め記憶されている。制御装置２５０は、記憶部２５２に記憶された既定ルートの路面６０の幅の情報、ＲＦＩＤリーダ１７０が取得した既定ルートの路面６０の一部分の形状の情報、および、撮像装置１０の現在の揺動角度に関連する情報に基づいて、撮像装置１０により撮像された画像中の既定ルートの路面６０の位置を推定する。
しかし、ＲＦＩＤリーダ１７０が、ゴルフカー２０１の使用中に、路面位置関連情報として、既定ルートの路面６０の一部分の形状および幅の情報を取得してもよい。この場合、記憶部２５２は、既定ルートの路面６０の幅の情報を記憶していなくてよい。制御装置２５０は、ＲＦＩＤリーダ１７０が取得した既定ルートの路面６０の一部分の形状および幅の情報、および、撮像装置１０の現在の揺動角度に関連する情報に基づいて、撮像装置１０により撮像された画像中の既定ルートの路面６０の位置を推定する。
具体例３において、ＲＦＩＤリーダ１７０は、ゴルフカー２０１の使用中に、路面位置関連情報として、既定ルートの路面６０の一部分の形状の情報を取得する。既定ルートの路面６０の幅の情報は、記憶部２５２に予め記憶されている。制御装置２５０は、記憶部２５２に記憶された既定ルートの路面６０の幅の情報、ＲＦＩＤリーダ１７０が取得した既定ルートの路面６０の一部分の形状の情報、および、撮像装置１０の現在の揺動角度に関連する情報に基づいて、撮像装置１０により撮像された画像中の既定ルートの路面６０の位置を推定する。
しかし、ＲＦＩＤリーダ１７０が、ゴルフカー２０１の使用中に、路面位置関連情報として、既定ルートの路面６０の一部分の形状および幅の情報を取得してもよい。この場合、記憶部２５２は、既定ルートの路面６０の幅の情報を記憶していなくてよい。制御装置２５０は、ＲＦＩＤリーダ１７０が取得した既定ルートの路面６０の一部分の形状および幅の情報、および、撮像装置１０の現在の揺動角度に関連する情報に基づいて、撮像装置１０により撮像された画像中の既定ルートの路面６０の位置を推定する。
【0158】
具体例３の変更例１は、画像中の既定ルートの路面６０（７０）の位置の推定の方法が具体例２の変更例１と同じである。具体例３の変更例１では、画像中の既定ルートの路面６０（７０）の位置の推定のための現在位置の推定が不要でありながら、画像中の既定ルートの路面６０（７０）の位置を精度良く推定できる。
【0159】
本発明は、上述した実施形態の具体例１、２、３およびその変更例に限られるものではなく、特許請求の範囲に記載した限りにおいて様々な変更が可能である。以下、本発明の実施形態の具体例の他の変更例について説明する。
【0160】
≪制御装置の変更例≫
実施形態の具体例１、２、３において、制御装置５０、１５０、２５０は、１つのプロセッサで構成される。制御装置５０、１５０、２５０は、複数のプロセッサで構成されてもよい。本発明の制御装置は、少なくとも１つのプロセッサで構成される。本発明の制御装置が複数のプロセッサで構成される場合、複数のプロセッサは物理的に離れた２つのプロセッサを含んでいてもよい。本発明の記憶部は、少なくとも１つの記憶装置で構成される。本発明の記憶部は、外部記憶装置を含んでいてもよい。本発明の記憶部が複数の記憶装置で構成される場合、複数の記憶装置は物理的に離れた２つの記憶装置を含んでいてもよい。
実施形態の具体例１、２、３において、制御装置５０、１５０、２５０は、１つのプロセッサで構成される。制御装置５０、１５０、２５０は、複数のプロセッサで構成されてもよい。本発明の制御装置は、少なくとも１つのプロセッサで構成される。本発明の制御装置が複数のプロセッサで構成される場合、複数のプロセッサは物理的に離れた２つのプロセッサを含んでいてもよい。本発明の記憶部は、少なくとも１つの記憶装置で構成される。本発明の記憶部は、外部記憶装置を含んでいてもよい。本発明の記憶部が複数の記憶装置で構成される場合、複数の記憶装置は物理的に離れた２つの記憶装置を含んでいてもよい。
【0161】
≪既定ルート走行車両の駆動装置の変更例≫
実施形態の具体例１、２、３において、駆動装置４は、電気モータを含み、電気エネルギーを運動エネルギーに変換する駆動装置である。しかし、本発明の既定ルート走行車両が有する駆動装置は、ガソリン等の燃料の燃焼エネルギーを運動エネルギーに変換する駆動装置であってもよい。本発明の駆動装置は、例えば、エンジンであってもよい。本発明の駆動装置は、エンジンと電気モータの両方を有していてもよい。
実施形態の具体例１、２、３において、駆動装置４は、電気モータを含み、電気エネルギーを運動エネルギーに変換する駆動装置である。しかし、本発明の既定ルート走行車両が有する駆動装置は、ガソリン等の燃料の燃焼エネルギーを運動エネルギーに変換する駆動装置であってもよい。本発明の駆動装置は、例えば、エンジンであってもよい。本発明の駆動装置は、エンジンと電気モータの両方を有していてもよい。
【0162】
≪既定ルート走行車両の制動装置の変更例≫
実施形態の具体例１、２、３において、制動装置５は、ディスクブレーキ装置である。しかし、本発明の制動装置は、ディスクブレーキ装置以外の運動エネルギーを熱エネルギーに変換する機械式ブレーキを含んでいてもよい。ディスクブレーキ装置以外の機械式ブレーキは、例えば、ドラムブレーキ装置であってもよい。また、本発明の既定ルート走行車両が有する制動装置は、運動エネルギーを電気エネルギーに変換する電気式ブレーキを含んでいてもよい。電気式ブレーキは、例えば、モータ機能付き発電機による回生ブレーキであってもよい。また、本発明の制動装置は、機械式ブレーキと電気式ブレーキを併用するものであってもよい。
実施形態の具体例１、２、３において、制動装置５は、ディスクブレーキ装置である。しかし、本発明の制動装置は、ディスクブレーキ装置以外の運動エネルギーを熱エネルギーに変換する機械式ブレーキを含んでいてもよい。ディスクブレーキ装置以外の機械式ブレーキは、例えば、ドラムブレーキ装置であってもよい。また、本発明の既定ルート走行車両が有する制動装置は、運動エネルギーを電気エネルギーに変換する電気式ブレーキを含んでいてもよい。電気式ブレーキは、例えば、モータ機能付き発電機による回生ブレーキであってもよい。また、本発明の制動装置は、機械式ブレーキと電気式ブレーキを併用するものであってもよい。
【0163】
≪既定ルート走行車両の車輪の変更例≫
実施形態の具体例１、２、３において、ゴルフカー１、１０１、２０１は、２つの前輪３ｆｒ、３ｆｌと２つの後輪３ｒｒ、３ｒｌを有する。しかし、本発明の既定ルート走行車両は、１つまたは２つより多い前輪を有してもよい。本発明の既定ルート走行車両は、１つまたは２つより多い後輪を有してもよい。
実施形態の具体例１、２、３において、ゴルフカー１、１０１、２０１は、２つの前輪３ｆｒ、３ｆｌと２つの後輪３ｒｒ、３ｒｌを有する。しかし、本発明の既定ルート走行車両は、１つまたは２つより多い前輪を有してもよい。本発明の既定ルート走行車両は、１つまたは２つより多い後輪を有してもよい。
【0164】
≪既定ルート走行車両の走行の制御の変更例１≫
実施形態の具体例１、２、３において、制御装置５０、１５０、２５０は、前輪３ｆｒ、３ｆｌを操舵して、ゴルフカー１、１０１、２０１の進行方向を制御する。しかしながら、本発明の制御装置は、少なくとも１つの後輪を操舵して、既定ルート走行車両の進行方向を制御してもよい。本発明の制御装置は、少なくとも１つの前輪と少なくとも１つの後輪を操舵して、既定ルート走行車両の進行方向を制御してもよい。本発明の制御装置は、複数の車輪の少なくとも１つの車輪を操舵して、既定ルート走行車両の進行方向を制御してもよい。また、本発明の制御装置は、車両の左部に配置された左車輪の回転速度と車両の右部に配置された右車輪の回転速度を異なるように制御することにより、既定ルート走行車両の進行方向を制御してもよい。
実施形態の具体例１、２、３において、制御装置５０、１５０、２５０は、前輪３ｆｒ、３ｆｌを操舵して、ゴルフカー１、１０１、２０１の進行方向を制御する。しかしながら、本発明の制御装置は、少なくとも１つの後輪を操舵して、既定ルート走行車両の進行方向を制御してもよい。本発明の制御装置は、少なくとも１つの前輪と少なくとも１つの後輪を操舵して、既定ルート走行車両の進行方向を制御してもよい。本発明の制御装置は、複数の車輪の少なくとも１つの車輪を操舵して、既定ルート走行車両の進行方向を制御してもよい。また、本発明の制御装置は、車両の左部に配置された左車輪の回転速度と車両の右部に配置された右車輪の回転速度を異なるように制御することにより、既定ルート走行車両の進行方向を制御してもよい。
【0165】
≪既定ルート走行車両の走行の制御の変更例２≫
実施形態の具体例１、２、３において、ゴルフカー１、１０１、２０１は、誘導線センサ８からの検出信号に基づいて進行方向が制御され、埋設マーカ検出センサ７からの検出信号に基づいて速度が制御される。しかし、本発明の既定ルート走行車両が自動的に走行する場合、自動的に走行するための速度および進行方向の制御の方法は、これに限らない。
実施形態の具体例１、２、３において、ゴルフカー１、１０１、２０１は、誘導線センサ８からの検出信号に基づいて進行方向が制御され、埋設マーカ検出センサ７からの検出信号に基づいて速度が制御される。しかし、本発明の既定ルート走行車両が自動的に走行する場合、自動的に走行するための速度および進行方向の制御の方法は、これに限らない。
【0166】
≪既定ルート走行車両の操作子の変更例≫
実施形態の具体例１、２、３において、ゴルフカー１、１０１、２０１は、ステアリングホイール１１を備えている。しかしながら、本発明の既定ルート走行車両は、ステアリングホイールを備えなくてもよい。
実施形態の具体例１、２、３において、ゴルフカー１、１０１、２０１は、アクセルペダル１２を備えている。しかしながら、本発明の既定ルート走行車両は、アクセルペダルを備えなくてもよい。
実施形態の具体例１、２、３において、ゴルフカー１、１０１、２０１は、ブレーキペダル１３を備えている。しかしながら、本発明の既定ルート走行車両は、アクセルペダルおよびブレーキペダルを備えなくてもよい。
実施形態の具体例１、２、３において、ゴルフカー１、１０１、２０１は、ステアリングホイール１１を備えている。しかしながら、本発明の既定ルート走行車両は、ステアリングホイールを備えなくてもよい。
実施形態の具体例１、２、３において、ゴルフカー１、１０１、２０１は、アクセルペダル１２を備えている。しかしながら、本発明の既定ルート走行車両は、アクセルペダルを備えなくてもよい。
実施形態の具体例１、２、３において、ゴルフカー１、１０１、２０１は、ブレーキペダル１３を備えている。しかしながら、本発明の既定ルート走行車両は、アクセルペダルおよびブレーキペダルを備えなくてもよい。
【0167】
≪既定ルート走行車両の種類の変更例≫
実施形態の具体例１、２、３において、ゴルフカー１、１０１、２０１の通常の進行方向は、車両前方向である。通常の進行方向は、一時的な進行方向は含まない。しかしながら、本発明の既定ルート走行車両は、進行方向を車両後方向に変更して走行することができるスイッチバック可能車両（Bi-directional vehicle）であってもよい。
実施形態の具体例１、２、３において、ゴルフカー１、１０１、２０１の通常の進行方向は、車両前方向である。通常の進行方向は、一時的な進行方向は含まない。しかしながら、本発明の既定ルート走行車両は、進行方向を車両後方向に変更して走行することができるスイッチバック可能車両（Bi-directional vehicle）であってもよい。
【0168】
≪既定ルート走行車両の種類の変更例≫
実施形態の具体例１、２、３の既定ルート走行車両は、ゴルフカーである。しかし、本発明の既定ルート走行車両は、自動運転バス、小型自動電動車両等であってもよい。本発明の既定ルート走行車両は、レール上をレールに沿って走行する車両を含んでもよく、含まなくてもよい。本発明の既定ルート走行車両は、乗員を乗せて走行する車両であってもよく、乗員を乗せない車両であってもよい。
実施形態の具体例１、２、３の既定ルート走行車両は、ゴルフカーである。しかし、本発明の既定ルート走行車両は、自動運転バス、小型自動電動車両等であってもよい。本発明の既定ルート走行車両は、レール上をレールに沿って走行する車両を含んでもよく、含まなくてもよい。本発明の既定ルート走行車両は、乗員を乗せて走行する車両であってもよく、乗員を乗せない車両であってもよい。
【0169】
≪現在位置を推定する処理の変更例≫
実施形態の具体例１、３において、制御装置５０、２５０は、記憶部５２、２５２に記憶された既定ルート地図情報Ｉａ、Ｉｂと、車輪回転センサ６からの検出信号と、埋設マーカ検出センサ７からの検出信号と、誘導線センサ８からの検出信号とに基づいて、ゴルフカー１、２０１の現在位置を推定している。
しかしながら、本発明の制御装置は、これ以外の方法で、既定ルート走行車両の現在位置を推定してもよい。例えば、制御装置５０、２５０は、誘導線センサ８からの検出信号を使用せずに、記憶部５２、２５２に記憶された既定ルート地図情報Ｉａ、Ｉｂと、車輪回転センサ６および埋設マーカ検出センサ７からの検出信号とに基づいて、既定ルート走行車両の現在位置を推定してもよい。また、例えば、本発明の制御装置は、ＧＰＳなどのＧＮＳＳ（Global Navigation Satellite System）を利用して、既定ルート走行車両の現在位置を推定してもよい。
実施形態の具体例１、３において、制御装置５０、２５０は、記憶部５２、２５２に記憶された既定ルート地図情報Ｉａ、Ｉｂと、車輪回転センサ６からの検出信号と、埋設マーカ検出センサ７からの検出信号と、誘導線センサ８からの検出信号とに基づいて、ゴルフカー１、２０１の現在位置を推定している。
しかしながら、本発明の制御装置は、これ以外の方法で、既定ルート走行車両の現在位置を推定してもよい。例えば、制御装置５０、２５０は、誘導線センサ８からの検出信号を使用せずに、記憶部５２、２５２に記憶された既定ルート地図情報Ｉａ、Ｉｂと、車輪回転センサ６および埋設マーカ検出センサ７からの検出信号とに基づいて、既定ルート走行車両の現在位置を推定してもよい。また、例えば、本発明の制御装置は、ＧＰＳなどのＧＮＳＳ（Global Navigation Satellite System）を利用して、既定ルート走行車両の現在位置を推定してもよい。
【0170】
≪ＲＦＩＤリーダの代替≫
具体例２、３およびその変更例において、ゴルフカー１０１、２０１の使用中に情報を取得する手段として、ＲＦＩＤリーダ１７０が用いられている。しかし、本発明において、既定ルート走行車両の使用中に情報を取得する手段として、ＲＦＩＤリーダの代わりに、無線通信により情報を取得する無線通信装置が使用されてもよい。例えば、既定ルート走行車両に搭載される無線通信装置は、既定ルートに沿って路面の外に配置された複数の通信機から情報を取得してもよい。既定ルート走行車両に搭載される無線通信装置は、具体例２、３のＲＦＩＤリーダ１７０のように、路面位置関連情報を取得してもよい。この場合、無線通信装置は、本発明の路面位置関連情報取得部に相当する。既定ルート走行車両に搭載される無線通信装置は、具体例２のＲＦＩＤリーダ１７０のように、自車の将来の走行位置を含む前記既定ルートの前記路面の一部分の形状の情報を取得してもよい。この場合、無線通信装置は、本発明の路面形状情報取得部に相当する。既定ルート走行車両に搭載される無線通信装置は、具体例２の変更例２のＲＦＩＤリーダ１７０のように、目標揺動角度を取得してもよい。既定ルート走行車両に搭載される無線通信装置は、具体例２のＲＦＩＤリーダ１７０のように、目標速度情報を取得してもよい。
具体例２、３およびその変更例において、ゴルフカー１０１、２０１の使用中に情報を取得する手段として、ＲＦＩＤリーダ１７０が用いられている。しかし、本発明において、既定ルート走行車両の使用中に情報を取得する手段として、ＲＦＩＤリーダの代わりに、無線通信により情報を取得する無線通信装置が使用されてもよい。例えば、既定ルート走行車両に搭載される無線通信装置は、既定ルートに沿って路面の外に配置された複数の通信機から情報を取得してもよい。既定ルート走行車両に搭載される無線通信装置は、具体例２、３のＲＦＩＤリーダ１７０のように、路面位置関連情報を取得してもよい。この場合、無線通信装置は、本発明の路面位置関連情報取得部に相当する。既定ルート走行車両に搭載される無線通信装置は、具体例２のＲＦＩＤリーダ１７０のように、自車の将来の走行位置を含む前記既定ルートの前記路面の一部分の形状の情報を取得してもよい。この場合、無線通信装置は、本発明の路面形状情報取得部に相当する。既定ルート走行車両に搭載される無線通信装置は、具体例２の変更例２のＲＦＩＤリーダ１７０のように、目標揺動角度を取得してもよい。既定ルート走行車両に搭載される無線通信装置は、具体例２のＲＦＩＤリーダ１７０のように、目標速度情報を取得してもよい。
【0171】
≪撮像装置の変更例≫
実施形態の具体例１、２、３において、撮像装置１０は、２つの画像センサを有するステレオカメラである。しかし、本発明の撮像装置は、３つ以上の画像センサを有するステレオカメラであってもよい。また、本発明の撮像装置は、単眼カメラでもよい。
実施形態の具体例１、２、３において、撮像装置１０は、２つの画像センサを有するステレオカメラである。しかし、本発明の撮像装置は、３つ以上の画像センサを有するステレオカメラであってもよい。また、本発明の撮像装置は、単眼カメラでもよい。
【0172】
≪画像中の路面の位置を推定する処理の変更例≫
本発明の制御装置は、撮像装置によって撮像された画像中の既定ルートの路面の位置を推定するために視差画像を用いなくてもよい。この場合、本発明の路面位置関連情報は、例えば、撮像装置によって撮像された画像に投影されて、画像中の既定ルートの路面を表す情報を含んでいてもよい。この情報を投影路面情報と称する。投影路面情報は、画像中の既定ルートの路面の形状と幅を表す情報である。投影路面情報は、例えば、事前に既定ルート走行車両が既定ルートを走行したときに取得した撮像装置の３次元の移動軌跡の情報と、既定ルートの路面の幅の情報とに基づいて生成された３次元路面情報であってもよい。３次元の移動軌跡の情報を取得する際には、撮像装置は揺動させずに固定したままとする。
本発明の制御装置は、撮像装置によって撮像された画像中の既定ルートの路面の位置を推定するために視差画像を用いなくてもよい。この場合、本発明の路面位置関連情報は、例えば、撮像装置によって撮像された画像に投影されて、画像中の既定ルートの路面を表す情報を含んでいてもよい。この情報を投影路面情報と称する。投影路面情報は、画像中の既定ルートの路面の形状と幅を表す情報である。投影路面情報は、例えば、事前に既定ルート走行車両が既定ルートを走行したときに取得した撮像装置の３次元の移動軌跡の情報と、既定ルートの路面の幅の情報とに基づいて生成された３次元路面情報であってもよい。３次元の移動軌跡の情報を取得する際には、撮像装置は揺動させずに固定したままとする。
【0173】
本発明の路面位置関連情報取得部が路面位置関連情報を予め記憶する場合、路面位置関連情報は、既定ルートの路面上の複数の位置の相対位置情報または絶対位置情報と、既定ルートの路面上の位置情報と対応付けられた既定ルートの路面全体の投影路面情報とを含んでいてもよい。この場合、制御装置は、予め記憶された路面位置関連情報と、制御装置によって推定された自車の現在位置と、撮像装置の現在の揺動角度とに基づいて、撮像装置によって撮像された画像中の既定ルートの路面の位置を推定してもよい。投影路面情報を含む路面位置関連情報を用いることにより、既定ルートの路面が坂道を含む場合であっても、画像中の既定ルートの路面の位置を推定する精度が高い。
【0174】
本発明の路面位置関連情報取得部が既定ルート走行車両の使用中に路面位置関連情報取得する場合、路面位置関連情報は、自車の将来の走行位置を含む既定ルートの路面の一部分の投影路面情報を含んでいてもよい。この場合、制御装置は、既定ルート走行車両の使用中に取得した路面位置関連情報と、撮像装置の現在の揺動角度とに基づいて、撮像装置によって撮像された画像中の既定ルートの路面の位置を推定してもよい。これにより、画像中の既定ルートの路面の位置の推定のための現在位置の推定が不要でありながら、画像中の既定ルートの路面の位置を精度良く推定できる。また、投影路面情報を含む路面位置関連情報を用いることにより、既定ルートの路面が坂道を含む場合であっても、画像中の既定ルートの路面の位置を推定する精度が高い。
【0175】
≪画像中の障害物を検出する処理の変更例≫
本発明の制御装置は、撮像装置によって撮像された画像中の障害物（立体物）を検出するために視差画像を用いなくてもよい。例えば、制御装置は、機械学習により、撮像装置によって撮像された画像から、人や車両などの特定の障害物（立体物）を検出してもよい。
本発明の制御装置は、撮像装置によって撮像された画像に基づいて既定ルートの路面上の障害物を検出するために、視差画像を利用しなくてもよい。視差画像が不要な場合、撮像装置は単眼カメラであってもよい。
本発明の制御装置は、撮像装置によって撮像された画像中の障害物（立体物）を検出するために視差画像を用いなくてもよい。例えば、制御装置は、機械学習により、撮像装置によって撮像された画像から、人や車両などの特定の障害物（立体物）を検出してもよい。
本発明の制御装置は、撮像装置によって撮像された画像に基づいて既定ルートの路面上の障害物を検出するために、視差画像を利用しなくてもよい。視差画像が不要な場合、撮像装置は単眼カメラであってもよい。
【0176】
≪路面上の障害物が検出された後の制御の変更例≫
実施形態の具体例１、２、３において、ゴルフカー１、１０１、２０１は、既定ルートの路面６０上の障害物が検出された場合、制御装置５０、１５０、２５０によって自動的に減速される。しかし、本発明の既定ルート走行車両は、既定ルートの路面上の障害物が検出された場合、自動的に減速されなくてもよい。
実施形態の具体例１、２、３において、ゴルフカー１、１０１、２０１は、既定ルートの路面６０上の障害物が検出された場合、制御装置５０、１５０、２５０によって自動的に減速される。しかし、本発明の既定ルート走行車両は、既定ルートの路面上の障害物が検出された場合、自動的に減速されなくてもよい。
【0177】
例えば、本発明の既定ルート走行車両は、音または光によって乗員および既定ルート走行車両の周囲の者（例えば歩行者）に報知する報知手段を有していてもよい。そして、既定ルートの路面上の障害物が検出された場合、制御装置は、報知手段を作動させてもよい。報知手段によって既定ルートの路面上に障害物があることを認識した乗員の操作によって、既定ルート走行車両が減速してもよい。この場合、乗員の操作によって、最終的に、既定ルート走行車両の走行が停止してもよい。具体例１、２、３における自動運転モード中、既定ルートの路面上の障害物が検出された場合、乗員の操作によって、既定ルート走行車両を減速させてもよい。
【0178】
また、例えば、既定ルートの路面上の障害物が検出された場合、既定ルート走行車両から管理装置に情報が送信されてもよい。管理装置が受信する情報は、リモート操作者によって監視される。リモート操作者は、制御装置から管理装置に送信された情報によって、既定ルートの路面上に障害物があることを認識する。障害物があることを認識したリモート操作者の操作によって、既定ルート走行車両に制御信号が送信される。既定ルート走行車両の制御装置は、この制御信号に基づいて既定ルート走行車両を減速させる。つまり、既定ルート走行車両は、リモート操作者の操作によって減速してもよい。この場合、リモート操作者の操作によって、最終的に、既定ルート走行車両の走行が停止してもよい。具体例１、２、３における自動運転モード中、既定ルートの路面上の障害物が検出された場合、リモート操作者の操作によって、既定ルート走行車両を減速させてもよい。
【0179】
なお、本出願の基礎出願である特願２０１９－４８４３６号における「既定走路」は、本出願の「既定ルートの走路」に相当する。同基礎出願における「画像走路特定情報」および「画像走路特定情報取得部」は、本出願の「路面位置関連情報」および「路面位置関連情報取得部」にそれぞれ相当する。同基礎出願における「走路形状情報取得部」は、本出願の「路面形状情報取得部」に相当する。同基礎出願における「第１既定走路地図情報」および「第２既定走路地図情報」は、本出願の「第１既定ルート地図情報」および「第２既定ルート地図情報」にそれぞれ相当する。同基礎出願における「３次元走路情報」は、本出願の「３次元路面情報」に相当する。
【符号の説明】
【0180】
１ 既定ルート走行車両、ゴルフカー
９ 車体
１０ 撮像装置
２０ 路面位置関連情報取得部
３０、５０ 制御装置
４０ 揺動装置
５２ 記憶部（路面位置関連情報取得部）
６０ 既定ルートの路面
７０ 画像中の既定ルートの路面
１０１ ゴルフカー（既定ルート走行車両）
１５０ 制御装置
１５１ プロセッサ
１５２ 記憶部
１７０ ＲＦＩＤリーダ（路面位置関連情報取得部、路面形状情報取得部）
２０１ ゴルフカー（既定ルート走行車両）
２５０ 制御装置
２５２ 記憶部（路面位置関連情報取得部）
Ｌ１ 揺動軸線
Ａ 水平画角
９ 車体
１０ 撮像装置
２０ 路面位置関連情報取得部
３０、５０ 制御装置
４０ 揺動装置
５２ 記憶部（路面位置関連情報取得部）
６０ 既定ルートの路面
７０ 画像中の既定ルートの路面
１０１ ゴルフカー（既定ルート走行車両）
１５０ 制御装置
１５１ プロセッサ
１５２ 記憶部
１７０ ＲＦＩＤリーダ（路面位置関連情報取得部、路面形状情報取得部）
２０１ ゴルフカー（既定ルート走行車両）
２５０ 制御装置
２５２ 記憶部（路面位置関連情報取得部）
Ｌ１ 揺動軸線
Ａ 水平画角
【図1】
【図2】
【図3】
【図4】
【図5】
【図6】
【図7】
【図8】
【図9】
【図10】