特開 2022-107174 運行データ作成方法及び運行制御装置

(19)【発行国】日本国特許庁(JP)

(12)【公報種別】公開特許公報(A)

(11)【公開番号】P2022107174

(43)【公開日】2022-07-21

(54)【発明の名称】運行データ作成方法及び運行制御装置

(51)【国際特許分類】

   G05D 1/02 20200101AFI20220713BHJP

   B66F 9/24 20060101ALI20220713BHJP

【ＦＩ】

G05D1/02 G

B66F9/24 Z

【審査請求】未請求

【請求項の数】7

【出願形態】ＯＬ

(21)【出願番号】P 2021001948

(22)【出願日】2021-01-08

(71)【出願人】

【識別番号】000003218

【氏名又は名称】株式会社豊田自動織機

(74)【代理人】

【識別番号】100088155

【弁理士】

【氏名又は名称】長谷川 芳樹

(74)【代理人】

【識別番号】100113435

【弁理士】

【氏名又は名称】黒木 義樹

(74)【代理人】

【識別番号】100124062

【弁理士】

【氏名又は名称】三上 敬史

(74)【代理人】

【識別番号】100148013

【弁理士】

【氏名又は名称】中山 浩光

(72)【発明者】

【氏名】開田 宏介

【テーマコード（参考）】

3F333

5H301

【Ｆターム（参考）】

3F333AA02

3F333AB20

3F333DB10

5H301AA01

5H301BB05

5H301BB07

5H301CC03

5H301CC06

5H301CC10

5H301EE08

5H301FF06

5H301FF17

5H301GG08

(57)【要約】

【課題】移動体の運行データの作成量を低減することができる運行データ作成方法及び運行制御装置を提供する。
【解決手段】運行データ作成方法は、走行経路Ａを取得する走行経路取得工程と、走行経路取得工程において取得された走行経路Ａをユニット単位で分割して複数の走行ユニットを生成するユニット化工程と、ユニット化工程において生成された走行ユニットに応じた運行データを作成する運行データ作成工程とを含む。
【選択図】図７

【特許請求の範囲】

【請求項1】

移動体が走行経路に沿って走行する際における前記移動体に対する運行動作の指示内容を表す運行データを作成する運行データ作成方法であって、
前記走行経路を取得する走行経路取得工程と、
前記走行経路取得工程において取得された前記走行経路をユニット単位で分割して複数の走行ユニットを生成するユニット化工程と、
前記ユニット化工程において生成された前記走行ユニットに応じた前記運行データを作成する運行データ作成工程とを含む運行データ作成方法。

【請求項2】

前記ユニット化工程において生成された前記走行ユニットと紐づいた運行データ番号を作成する紐づけデータ作成工程を更に含み、
前記運行データ作成工程では、前記運行データ番号に対応する前記運行データを作成する請求項１記載の運行データ作成方法。

【請求項3】

前記ユニット化工程では、前記移動体が左折または右折する場合には、前記移動体を左側または右側に曲げる曲部を有するような前記走行ユニットを生成し、
前記運行データ作成工程では、前記曲部の手前において前記移動体の左折または右折に関する運行動作を実施するような前記運行データを作成する請求項１または２記載の運行データ作成方法。

【請求項4】

移動体を走行経路に沿って目的地まで運行させる運行制御装置であって、
前記走行経路をユニット単位で分割して生成された複数の走行ユニットの情報と、前記移動体に対する運行動作の指示内容を表す複数の運行データとを記憶する記憶部と、
前記目的地までの経路探索を行うことで、前記記憶部に記憶された前記複数の運行データから、前記目的地までの経路を形成する走行ユニットを決定する経路探索部と、
前記記憶部に記憶された前記複数の運行データから、前記経路探索部により決定された前記走行ユニットに応じた運行データを抽出する運行データ抽出部と、
前記運行データ抽出部により抽出された前記運行データに従って前記移動体を運行させるように制御する運行制御部とを備える運行制御装置。

【請求項5】

前記目的地を設定する目的地設定部と、
前記移動体の現在位置を検出する位置検出部とを更に備え、
前記経路探索部は、前記目的地設定部により設定された前記目的地と前記位置検出部により検出された前記移動体の現在位置とに基づいて、前記目的地までの経路探索を行う請求項４記載の運行制御装置。

【請求項6】

前記記憶部は、前記走行ユニットと紐づいた複数の運行データ番号を更に記憶し、
前記運行データ抽出部は、前記記憶部に記憶された前記複数の運行データ番号から、前記経路探索部により決定された前記走行ユニットに対応する運行データ番号を抽出し、当該運行データ番号に対応する運行データを抽出する請求項４または５記載の運行制御装置。

【請求項7】

前記記憶部は、前記移動体に対する運行動作の指示位置を表す複数のマークの情報を更に記憶し、
前記マークは、前記走行ユニットに少なくとも１つ設定されている請求項４～６の何れか一項記載の運行制御装置。

【発明の詳細な説明】

【技術分野】

【0001】

本発明は、運行データ作成方法及び運行制御装置に関する。

【背景技術】

【0002】

例えば特許文献１には、移動ロボット制御システムが記載されている。特許文献１に記載の移動ロボット制御システムは、移動ロボットが所定の移動領域を移動する際の走行ルールを反映させた走行ルール情報を含む地図情報を記憶する地図情報記憶部と、この地図情報記憶部に記憶された地図情報に基づいて、移動始点から移動終点に至る経路を探索する経路探索部と、この経路探索部で探索した経路に基づいて、移動ロボットの移動装置の制御指令値を生成する移動制御部とを備えている。走行ルールは、移動ロボットの移動方向及び移動速度である。

【先行技術文献】

【特許文献】

【0003】

【特許文献1】特許第５４０２０５７号

【発明の概要】

【発明が解決しようとする課題】

【0004】

しかしながら、上記従来技術においては、地図情報に基づいて走行経路を探索し、走行ルール（移動方向及び移動速度）に基づいて移動ロボットを走行させるだけである。自動運転フォークリフトや自動運転トーイング車等では、場所ごとに荷の移載、交差点進入申請、ウインカー点灯、ホーン鳴動及び障害物エリア切替等といったタスク（運行動作）を実施する必要がある。従って、移動体の現在位置から目的地に至るまで運行動作を実施するには、移動体に対する運行動作の指示内容を表す運行データをユーザが別途作成する必要がある。この場合には、移動体の現在位置から目的地までの組み合わせが増えるにつれて、ユーザが運行データを作成する量が膨大となる。

【0005】

本発明の目的は、移動体の運行データの作成量を低減することができる運行データ作成方法及び運行制御装置を提供することである。

【課題を解決するための手段】

【0006】

本発明の一態様は、移動体が走行経路に沿って走行する際における移動体に対する運行動作の指示内容を表す運行データを作成する運行データ作成方法であって、走行経路を取得する走行経路取得工程と、走行経路取得工程において取得された走行経路をユニット単位で分割して複数の走行ユニットを生成するユニット化工程と、ユニット化工程において生成された走行ユニットに応じた運行データを作成する運行データ作成工程とを含む。

【0007】

このような運行データ作成方法においては、予め決められた走行経路をユニット単位で分割して複数の走行ユニットを生成し、これらの走行ユニットに応じた運行データをそれぞれ作成する。実際に移動体を走行経路に沿って目的地まで運行させるときは、目的地までの経路探索を行うことで、目的地までの経路を形成する走行ユニットが決定され、その走行ユニットに応じた運行データが抽出され、その運行データに従って移動体が運行する。このように目的地までの経路探索によって走行ユニットが決定されると、その走行ユニットに応じた運行データが抽出されることになる。このため、移動体の現在位置から目的地までの組み合わせが増えるたびに、移動体の運行データをユーザが逐一作成しなくて済む。これにより、移動体の運行データの作成量が低減される。

【0008】

運行データ作成方法は、ユニット化工程において生成された走行ユニットと紐づいた運行データ番号を作成する紐づけデータ作成工程を更に含み、運行データ作成工程では、運行データ番号に対応する運行データを作成してもよい。

【0009】

このような方法では、走行ユニットと紐づいた運行データ番号を抽出し、当該運行データ番号に対応する運行データを抽出することで、走行ユニットに応じた運行データが得られる。従って、走行ユニットは違うが、運行データの内容が同じである場合に、走行ユニットに応じた運行データを作成しなくて済む。従って、移動体の運行データの作成量が更に低減される。

【0010】

ユニット化工程では、移動体が左折または右折する場合には、移動体を左側または右側に曲げる曲部を有するような走行ユニットを生成し、運行データ作成工程では、曲部の手前において移動体の左折または右折に関する運行動作を実施するような運行データを作成してもよい。

【0011】

このような方法では、移動体の左折または右折に関する運行動作を実施するような運行データの内容（例えば左ウインカーまたは右ウインカーの点灯）を容易に設定することができる。

【0012】

本発明の他の態様は、移動体を走行経路に沿って目的地まで運行させる運行制御装置であって、走行経路をユニット単位で分割して生成された複数の走行ユニットの情報と、移動体に対する運行動作の指示内容を表す複数の運行データとを記憶する記憶部と、目的地までの経路探索を行うことで、記憶部に記憶された複数の運行データから、目的地までの経路を形成する走行ユニットを決定する経路探索部と、記憶部に記憶された複数の運行データから、経路探索部により決定された走行ユニットに応じた運行データを抽出する運行データ抽出部と、運行データ抽出部により抽出された運行データに従って移動体を運行させるように制御する運行制御部とを備える。

【0013】

このような運行制御装置においては、目的地までの経路探索を行うことで、目的地までの経路を形成する走行ユニットが決定され、その走行ユニットに応じた運行データが抽出され、その運行データに従って移動体が運行する。このように目的地までの経路探索によって走行ユニットが決定されると、その走行ユニットに応じた運行データが抽出されることになる。このため、移動体の現在位置から目的地までの組み合わせが増えるたびに、移動体の運行データをユーザが逐一作成しなくて済む。これにより、移動体の運行データの作成量が低減される。

【0014】

運行制御装置は、目的地を設定する目的地設定部と、移動体の現在位置を検出する位置検出部とを更に備え、経路探索部は、目的地設定部により設定された目的地と位置検出部により検出された移動体の現在位置とに基づいて、目的地までの経路探索を行ってもよい。

【0015】

このような構成では、目的地と移動体の現在位置とに基づいて、目的地までの経路探索が自動的に行われることで、目的地までの経路を形成する走行ユニットが決定される。従って、ユーザが目的地までの経路を選択しなくて済む。

【0016】

記憶部は、走行ユニットと紐づいた複数の運行データ番号を更に記憶し、運行データ抽出部は、記憶部に記憶された複数の運行データ番号から、経路探索部により決定された走行ユニットに対応する運行データ番号を抽出し、当該運行データ番号に対応する運行データを抽出してもよい。

【0017】

このような構成では、走行ユニットと紐づいた運行データ番号が抽出され、当該運行データ番号に対応する運行データが抽出されることで、走行ユニットに応じた運行データが得られる。従って、走行ユニットは違うが、運行データの内容が同じである場合に、走行ユニットに応じた運行データを作成しなくて済む。従って、移動体の運行データの作成量が更に低減される。

【0018】

記憶部は、移動体に対する運行動作の指示位置を表す複数のマークの情報を更に記憶し、マークは、走行ユニットに少なくとも１つ設定されていてもよい。

【0019】

このような構成では、運行データの内容が移動体に対して走行ユニットの適切な位置で指示されるため、運行データの内容を確実に実施することができる。

【発明の効果】

【0020】

本発明によれば、移動体の運行データの作成量を低減することができる。

【図面の簡単な説明】

【0021】

【図1】本発明の一実施形態に係る運行制御装置を示す概略構成図である。

【図2】走行経路の一例をマークと共に示す概略図である。

【図3】図２に示された走行経路が複数の走行ユニットにユニット化された状態を示す概略図である。

【図4】走行ユニットと運行データ番号と運行データ及びマークとの関係を表すテーブルデータの一例を示す表である。

【図5】図１に示された運行データ抽出部により実行される運行データ抽出処理の手順を示すフローチャートである。

【図6】本発明の一実施形態に係る運行データ作成方法を実施するための運行データ作成システムを示す概略構成図である。

【図7】ユーザがパソコンを使用して運行データを作成する工程を示すフローチャートである。

【発明を実施するための形態】

【0022】

以下、本発明の実施形態について図面を参照して詳細に説明する。

【0023】

図１は、本発明の一実施形態に係る運行制御装置を示す概略構成図である。図１において、本実施形態の運行制御装置１は、図２に示されるように、移動体２を走行経路Ａに沿って目的地Ｐまで自動的に運行させる装置である。移動体２は、例えば空港等で使用される自動運転用のトーイング車である。

【0024】

走行経路Ａは、移動体２を走行させる仮想的な経路であり、３次元の点列データ（ＸＹＺ座標）で表されている。走行経路Ａには、移動体２に対する運行動作（タスク）の指示に使用される複数のマークＭ（後述）が設定されている。

【0025】

運行制御装置１は、移動体２に搭載されている。運行制御装置１は、入力器３と、自己位置推定器４と、記憶部５と、運行制御用コントローラ６と、制御対象７とを備えている。

【0026】

入力器３は、ユーザが移動体２の目的地を設定したり、移動体２の運行経路等を選択するための機器であり、例えばタッチパネルで構成される。

【0027】

自己位置推定器４は、移動体２の現在の自己位置を推定する。自己位置推定器４は、例えばレーザセンサの検出データと地図情報とに基づいて、移動体２の自己位置を推定する。レーザセンサは、移動体２の周囲にレーザを照射し、レーザの反射光を受光することにより、移動体２の周囲に存在する物体との距離を計測する。

【0028】

自己位置推定器４は、レーザＳＬＡＭ（simultaneous localization andmapping）手法を用いて、移動体２の自己位置の推定演算を行う。ＳＬＡＭは、センサデータ及び地図データを使って自己位置推定を行う自己位置推定技術である。自己位置推定器４は、レーザセンサの検出データと地図情報とをマッチングさせて、移動体２の自己位置の推定演算を行う。

【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】

その後、移動体２が走行ユニットＡ２に設定されたマークＭ２を通過すると、運行データ番号２０に対応する運行データの内容が実施される。つまり、交差点進入申請が上位システムに対して行われると共に、左ウインカーが所定時間だけ点灯するように制御対象７が制御される。そして、移動体２は、走行ユニットＡ２の屈曲部８Ｌを左折して走行する。

【0057】

その後、移動体２が走行ユニットＡ３に設定されたマークＭ３を通過すると、運行データ番号３０に対応する運行データの内容が実施される。つまり、右ウインカーが所定時間だけ点灯するように制御対象７が制御されると共に、移動体２が一時停止を行うように制御対象７が制御される。そして、移動体２は、走行ユニットＡ３の屈曲部８Ｒを右折して走行する。そして、移動体２は、目的地Ｐに到達すると停止する。

【0058】

次に、上記の運行データを作成する運行データ作成方法について説明する。なお、運行データは、上述した運行制御装置１が運用される前に、予め作成されて記憶部５に保存されている。

【0059】

図６は、本発明の一実施形態に係る運行データ作成方法を実施するための運行データ作成システムを示す概略構成図である。本実施形態の運行データ作成方法は、ユーザによって実施される。

【0060】

図６において、運行データ作成システム２０は、ユーザが操作するパソコン２１と、このパソコン２１に走行経路Ａを入力する走行経路入力部２２とを備えている。パソコン２１には、上記の記憶部５が接続されている。

【0061】

図７は、ユーザがパソコン２１を使用して運行データを作成する工程を示すフローチャートである。図７において、ユーザは、まず走行経路入力部２２により入力された走行経路Ａを取得してパソコン２１の画面に表示させる（工程Ｓ１１１）。本工程は、走行経路入力部２２による走行経路Ａの入力作業と協働して、走行経路Ａを取得する走行経路取得工程に相当する。

【0062】

続いて、ユーザは、図３に示されるように、走行経路Ａをユニット単位で分割して複数の走行ユニットを生成する（工程Ｓ１１２）。本工程は、走行経路取得工程において取得された走行経路Ａをユニット単位で分割して複数の走行ユニットを生成するユニット化工程に相当する。

【0063】

続いて、ユーザは、図４（ａ）に示されるように、複数の走行ユニットと紐づいた運行データ番号をそれぞれ紐づけデータとして作成する（工程Ｓ１１３）。本工程は、ユニット化工程において生成された走行ユニットと紐づいた運行データ番号を作成する紐づけデータ作成工程に相当する。

【0064】

続いて、ユーザは、図４（ｂ）に示されるように、各運行データ番号に対応する運行データをそれぞれ作成する（工程Ｓ１１４）。本工程は、ユニット化工程において生成された走行ユニットに応じた運行データを作成する運行データ作成工程に相当する。

【0065】

続いて、ユーザは、走行ユニットの情報と、運行データ番号と、運行データと、運行データの内容が実施される位置を表すマークＭの情報とを記憶部５に保存する（工程Ｓ１１５）。

【0066】

以上のように本実施形態にあっては、予め決められた走行経路Ａをユニット単位で分割して複数の走行ユニットを生成し、これらの走行ユニットに応じた運行データをそれぞれ作成する。実際に移動体２を走行経路Ａに沿って目的地Ｐまで運行させるときは、目的地Ｐまでの経路探索を行うことで、目的地Ｐまでの経路を形成する走行ユニットが決定され、その走行ユニットに応じた運行データが抽出され、その運行データに従って移動体２が運行する。このように目的地Ｐまでの経路探索によって走行ユニットが決定されると、その走行ユニットに応じた運行データが抽出されることになる。このため、移動体２の現在位置から目的地Ｐまでの組み合わせが増えるたびに、移動体２の運行データをユーザが逐一作成しなくて済む。これにより、移動体２の運行データの作成量が低減される。

【0067】

また、本実施形態では、走行ユニットと紐づいた運行データ番号を抽出し、当該運行データ番号に対応する運行データを抽出することで、走行ユニットに応じた運行データが得られる。従って、走行ユニットは違うが、運行データの内容が同じである場合に、走行ユニットに応じた運行データを作成しなくて済む。例えば図４に示されるように、走行ユニットＡ１，Ａ６，Ａ８の運行データは同じであるため、走行ユニットＡ１，Ａ６，Ａ８の運行データ番号を同じにすることで、走行ユニットＡ１，Ａ６，Ａ８に応じた運行データをそれぞれ作成する必要がない。従って、運行データの作成量が更に低減される。

【0068】

また、本実施形態では、移動体２が左折または右折する場合には、移動体２を左側に曲げる屈曲部８Ｌまたは移動体２を右側に曲げる屈曲部８Ｒを有するような走行ユニットを生成し、屈曲部８Ｌ，８Ｒの手前において移動体２の左折または右折に関する運行動作を実施するような運行データを作成する。このため、移動体２の左折または右折に関する運行動作を実施するような運行データの内容（例えば左ウインカーまたは右ウインカーの点灯）を容易に設定することができる。

【0069】

また、本実施形態では、移動体２の目的地Ｐと移動体２の現在位置とに基づいて、目的地Ｐまでの経路探索が自動的に行われることで、目的地Ｐまでの経路を形成する走行ユニットが決定される。従って、ユーザが目的地Ｐまでの経路を選択しなくて済む。

【0070】

また、本実施形態では、記憶部５は、移動体２に対する運行動作の指示位置を表す複数のマークＭの情報を記憶し、マークＭは、走行ユニットに少なくとも１つ設定されている。このため、運行データの内容が移動体２に対して走行ユニットの適切な位置で指示されるため、運行データの内容を確実に実施することができる。

【0071】

なお、本発明は、上記実施形態には限定されない。例えば上記実施形態では、走行ユニット番号と運行データ番号との対応関係を示す紐づけ用テーブルデータが記憶されているが、そのような紐づけ用テーブルデータとしては、走行ユニット番号と運行データ番号との対応関係に加えて、走行ユニットに設定されたマークＭの番号と走行ユニットの点列データ（ＸＹＺ座標）とを含んでいてもよい。

【0072】

また、上記実施形態では、走行ユニットと紐づいた運行データ番号が抽出され、当該運行データ番号に対応する運行データが抽出されているが、特にその形態には限られず、走行ユニット＝運行データ番号とルール化し、走行ユニットと紐づいた運行データ番号を無くしてもよい。

【0073】

また、上記実施形態では、入力器３により設定入力された目的地Ｐと自己位置推定器４により推定された移動体２の現在位置とに基づいて、目的地Ｐまでの経路探索が自動的に行われることで、目的地Ｐまでの経路を形成する走行ユニットが決定されているが、特にその形態には限られず、ユーザが入力器３により経路探索を行って走行ユニットを選択してもよい。

【0074】

また、上記実施形態では、ユーザがパソコン２１を使用して運行データを作成しているが、特にその形態には限られず、コントローラが走行経路Ａに基づいて走行ユニットの生成及び運行データの作成を自動的に行ってもよい。

【0075】

また、上記実施形態では、自己位置推定器４は、レーザＳＬＡＭ手法を用いて、移動体２の自己位置を推定しているが、特にそのような形態には限られない。自己位置推定器４は、例えばＲＴＫ－ＧＮＳＳ（realtimekinematic-global navigation satellite system）測位法等を用いて、移動体２の自己位置を推定してもよい。

【0076】

また、上記実施形態では、走行経路ＡがＸＹＺ座標の点列データで表されているが、特にその形態には限られず、例えばＳＬＡＭで扱われる地図（グリッドマップ）のピクセルデータで走行経路Ａを表してもよい。

【0077】

また、上記実施形態は、自動運転用のトーイング車に適用されているが、本発明は、自動運転用のフォークリフトや牽引車等にも適用可能である。

【符号の説明】

【0078】

１…運行制御装置、２…移動体、３…入力器（目的地設定部）、４…自己位置推定器（位置検出部）、５…記憶部、８Ｌ，８Ｒ…屈曲部（曲部）、１１…目的地取得部（目的地設定部）、１２…現在位置取得部（位置検出部）、１３…経路探索部、１４…運行データ抽出部、１５…運行制御部、Ａ…走行経路、Ａ１～Ａ１０…走行ユニット、Ｍ…マーク、Ｐ…目的地。

【図1】

【図2】

【図3】

【図4】

【図5】

【図6】

【図7】