特開 2023-17161 移動体制御システム

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

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

(11)【公開番号】P2023017161

(43)【公開日】2023-02-07

(54)【発明の名称】移動体制御システム

(51)【国際特許分類】

   G05D 1/00 20060101AFI20230131BHJP

   G08G 1/16 20060101ALI20230131BHJP

   G08G 1/00 20060101ALI20230131BHJP

   B60W 30/10 20060101ALI20230131BHJP

   B60W 60/00 20200101ALI20230131BHJP

   G16Y 10/40 20200101ALI20230131BHJP

   G16Y 40/30 20200101ALI20230131BHJP

【ＦＩ】

G05D1/00 B

G08G1/16 A

G08G1/00 X

B60W30/10

B60W60/00

G16Y10/40

G16Y40/30

【審査請求】未請求

【請求項の数】15

【出願形態】ＯＬ

(21)【出願番号】P 2021121200

(22)【出願日】2021-07-26

(71)【出願人】

【識別番号】000005108

【氏名又は名称】株式会社日立製作所

(74)【代理人】

【識別番号】110000350

【氏名又は名称】ポレール弁理士法人

(72)【発明者】

【氏名】今西 裕人

(72)【発明者】

【氏名】山田 弘幸

(72)【発明者】

【氏名】タン チュンキム

(72)【発明者】

【氏名】渡邉 夏美

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

3D241

5H181

5H301

【Ｆターム（参考）】

3D241BA11

3D241BC01

3D241BC02

3D241CA08

3D241CA18

3D241CC01

3D241CC08

3D241CC17

3D241CE02

3D241CE05

3D241CE08

3D241DB20Z

3D241DC31Z

5H181AA01

5H181AA21

5H181AA27

5H181BB04

5H181BB20

5H181CC03

5H181CC04

5H181FF05

5H181FF13

5H181LL01

5H181LL02

5H181LL04

5H181LL09

5H181LL14

5H181MB01

5H181MB11

5H301AA01

5H301BB05

5H301CC03

5H301CC06

5H301CC10

5H301DD07

5H301DD15

5H301GG08

5H301GG09

5H301LL02

5H301LL06

5H301LL11

(57)【要約】

【課題】 自車の動きに対する歩行者の反応を予測しながら動作計画することで、自車に社会的な動きを実現させ、歩行者と適切な譲り合いを実現する移動体制御システムを提供する。
【解決手段】 移動体を制御する制御装置と、前記移動体の周辺の他者の位置を検出する他者位置検出装置と、を有する移動体制御システムであって、前記制御装置は、前記移動体の複数の計画軌道候補を演算する自己計画軌道候補演算部と、前記他者の位置と前記計画軌道候補に基づいて、前記計画軌道候補の各軌道に対する前記他者の反応を、複数の予測軌道候補として演算する他者予測軌道候補演算部と、前記他者の位置に基づいて、前記他者の予測行動目標を演算する他者予測行動目標演算部と、前記予測軌道候補と前記予測行動目標に基づいて、前記移動体の計画行動目標と前記他者の予測行動目標を両立するように、前記複数の計画軌道候補から自己計画軌道を選択する自己計画軌道選択部と、を備える移動体制御システム。
【選択図】 図３

【特許請求の範囲】

【請求項1】

移動体を制御する制御装置と、
前記移動体の周辺の他者の位置を検出する他者位置検出装置と、
を有する移動体制御システムであって、
前記制御装置は、
前記移動体の複数の計画軌道候補を演算する自己計画軌道候補演算部と、
前記他者の位置と前記計画軌道候補に基づいて、前記計画軌道候補の各軌道に対する前記他者の反応を、複数の予測軌道候補として演算する他者予測軌道候補演算部と、
前記他者の位置に基づいて、前記他者の予測行動目標を演算する他者予測行動目標演算部と、
前記予測軌道候補と前記予測行動目標に基づいて、前記移動体の計画行動目標と前記他者の予測行動目標を両立するように、前記複数の計画軌道候補から自己計画軌道を選択する自己計画軌道選択部と、
を備えることを特徴とする移動体制御システム。

【請求項2】

請求項１に記載の移動体制御システムにおいて、
前記他者の実軌道が、選択した自己計画軌道に対応した予測軌道と相反すると判定された場合に、前記移動体を減速または停止させるように修正計画軌道を演算する、自己計画軌道検証部を備えることを特徴とする移動体制御システム。

【請求項3】

請求項１または請求項２に記載の移動体制御システムにおいて、
前記予測行動目標は、前記他者の予測目標軌道、または、前記他者の予測目標地点であることを特徴とする移動体制御システム。

【請求項4】

請求項２に記載の移動体制御システムにおいて、
前記相反するとは、
前記移動体と前記他者が対向しており、かつ、前記他者が進行方向と直角な向きに対して前記予測軌道と逆方向に所定以上移動する場合、
または、前記他者が前記予測軌道と逆方向に所定以上速度変化する場合であることを特徴とする移動体制御システム。

【請求項5】

請求項２に記載の移動体制御システムにおいて、
前記他者位置検出装置は、前記移動体の移動経路に設置した路側センサであることを特徴とする移動体制御システム。

【請求項6】

請求項２に記載の移動体制御システムにおいて、
前記他者位置検出装置は、前記移動体に設置した車載センサであることを特徴とする移動体制御システム。

【請求項7】

請求項６に記載の移動体制御システムにおいて、
前記修正計画軌道と、前記車載センサから取得した前記他者の位置と、から補正自己計画軌道を演算する、自己計画軌道補正部を備えることを特徴とする移動体制御システム。

【請求項8】

請求項２に記載の移動体制御システムにおいて、
前記移動体の計画軌道を前記他者に提示する軌道表示装置を備えることを特徴とする移動体制御システム。

【請求項9】

請求項８に記載の移動体制御システムにおいて、
前記軌道表示装置は、前記他者の予測軌道を提示することを特徴とする移動体制御システム。

【請求項10】

請求項９に記載の移動体制御システムにおいて、
前記軌道表示装置は、前記他者が複数存在する環境では、各他者の予測軌道を、当人のみに提示することを特徴とする移動体制御システム。

【請求項11】

請求項８に記載の移動体制御システムにおいて、
前記軌道表示装置が有効であるか否かを判定する表示有効性判定部を備え、
前記表示有効性判定部が、前記軌道表示装置が有効であると判定した場合に、前記相反と判定する判定閾値を大きくすることを特徴とする移動体制御システム。

【請求項12】

請求項１から請求項１１のいずれか１項に記載の移動体制御システムにおいて、
前記他者位置検出装置は、前記他者の属性を演算し、
前記他者予測軌道候補演算部は、前記属性に基づいて他者軌道予測モデルを切り替え、
前記他者予測行動目標演算部は、前記属性に基づいて他者目標予測モデルを切り替えることを特徴とする移動体制御システム。

【請求項13】

請求項１２に記載の移動体制御システムにおいて、
前記属性は、人と自転車と車両の種別、または、前記他者の固有識別子であることを特徴とする移動体制御システム。

【請求項14】

請求項５に記載の移動体制御システムにおいて、
前記自己計画軌道候補演算部と前記自己計画軌道選択部は、前記移動体に搭載された車載制御装置に配置され、
前記他者予測軌道候補演算部と前記他者予測行動目標演算部は、前記移動体の外部の遠隔制御装置に配置されることを特徴とする移動体制御システム。

【請求項15】

請求項６に記載の移動体制御システムにおいて、
前記自己計画軌道候補演算部と前記自己計画軌道選択部と前記他者予測軌道候補演算部と前記他者予測行動目標演算部は、前記移動体に搭載された車載制御装置に配置されることを特徴とする移動体制御システム。

【発明の詳細な説明】

【技術分野】

【0001】

本発明は、他の移動体（歩行者など）との衝突を回避するように、自動運転中の移動体（車両など）を移動させる移動体制御システムに関する。

【背景技術】

【0002】

近年、経路脇に設置したカメラやＬｉＤＡＲ（light detection and ranging）などの路側センサを利用して歩行者を検出し、その検出結果に基づいて移動体（自動運転車両など）の移動を制御する移動体制御システムが開発されている。

【0003】

路側センサを利用して歩行者経路を予測する従来技術の一例に特許文献１がある。例えば、特許文献１の要約書には、「経路予測装置１０２は、車載センサ及び路側センサ１０４の少なくともいずれか一方により取得されたセンサデータを、無線通信又は有線通信を介して収集する収集部としてのパケット受信部１８０と、収集部により収集されたセンサデータから移動物体を検出し、当該移動物体の位置及び兆候を特定する解析部としての解析処理部１８４と、解析部により特定された移動物体の位置及び兆候を用いて、移動物体の未来の位置を含む経路を予測する予測部１８８と、解析部により特定された位置及び兆候を、移動物体毎に対応させて記憶する記憶部と、記憶部に記憶された位置及び兆候を用いて、予測部を学習させる学習部１８６とを含む。」と記載されており、自車両外の経路予測装置が、路側センサの取得データから検出した移動物体（歩行者）の位置と兆候に基づいて、移動物体（歩行者）の経路を予測している。

【0004】

また、同文献の段落００５８や段落００５９では、予測部が予測に用いる「兆候」が、歩行者の「体の向き及び顔の向き」であると説明されている。さらに、同文献の段落００６５には、「歩行者の体の向きは、歩行者が進行方向を変更するタイミングにならないと変化しないので、体の向きだけで予測された経路の精度はそれ程高くはない。一方、通常、屋外の歩行者は進行方向を変更する場合、他の移動物体（車両、歩行者等）との衝突を回避するために、新たな進行方向を含む周囲に顔を向けて目視により確認を行う。したがって、進路変更の兆候として顔の向きを使用することにより、精度よく予測経路を決定できる。特に、体の向き及び顔の向きを使用することにより、より精度よく予測経路を決定できる。」と記載されており、歩行者の体の向きと顔の向きの双方を考慮することで、歩行者の経路を精度よく予測できる、としている。

【先行技術文献】

【特許文献】

【0005】

【特許文献1】特開２０２０－１７３６００号公報

【発明の概要】

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

【0006】

特許文献１の段落００５４には、「パケット送信部１８２は、予測部１８８から入力される予測経路を含むパケットデータを生成して、車載装置に対して配信（例えば、ブロードキャスト）する。予測経路を受信した車載装置は、予測経路を運転支援情報として使用できる。」と記載されている。仮に、同段落の車載装置が自動運転車両のものであれば、歩行者の予測経路を考慮し、歩行者との衝突を回避しながら自動運転車両の移動を制御することも可能と考えられる。

【0007】

しかしながら、歩行者の予測経路に対して衝突しない様に自動運転車両の経路を演算すると、自車の挙動に呼応した歩行者の反応（自車に合わせて歩行者が脇に寄ってくれる、といった社会的振る舞い）を考慮できず、自車の運航継続性が低下する可能性があった。

【0008】

そこで、本発明の目的は、自車の動きに対する歩行者の反応を予測しながら動作計画することで、自車に社会的な動きを実現させ、歩行者と適切な譲り合いを実現する、移動体制御システムを提供することにある。

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

【0009】

上記目的を達成するために、本発明の移動体制御システムは、移動体を制御する制御装置と、前記移動体の周辺の他者の位置を検出する他者位置検出装置と、を有する移動体制御システムであって、前記制御装置は、前記移動体の複数の計画軌道候補を演算する自己計画軌道候補演算部と、前記他者の位置と前記計画軌道候補に基づいて、前記計画軌道候補の各軌道に対する前記他者の反応を、複数の予測軌道候補として演算する他者予測軌道候補演算部と、前記他者の位置に基づいて、前記他者の予測行動目標を演算する他者予測行動目標演算部と、前記予測軌道候補と前記予測行動目標に基づいて、前記移動体の計画行動目標と前記他者の予測行動目標を両立するように、前記複数の計画軌道候補から自己計画軌道を選択する自己計画軌道選択部と、を備える。

【発明の効果】

【0010】

本発明の移動体制御システムによれば、自車の動きに対する歩行者の反応を予測しながら動作計画することで、自車に社会的な動きを実現させ、歩行者と適切な譲り合いを実現することができる。上記した以外の課題、構成及び効果は、以下の実施例の説明により明らかにされる。

【図面の簡単な説明】

【0011】

【図1】実施例１の移動体制御システムの概略構成図。

【図2】実施例１の車両の概略構成図。

【図3】実施例１の移動体制御システムのブロック図。

【図4】実施例１の車載制御装置の動作を示すフローチャート。

【図5】実施例１の遠隔制御装置の動作を示すフローチャート。

【図6】実施例１の移動体制御システムの動作例。

【図7】実施例２の移動体制御システムの動作例。

【図8】実施例３の移動体制御システムのブロック図。

【図9】車両と作業者のニアミスを説明する図。

【図10】実施例３の自己計画軌道検証部の動作例。

【図11】実施例４の移動体制御システムのブロック図。

【図12】実施例５の移動体制御システムの概略構成図。

【図13】実施例５の移動体制御システムのブロック図。

【図14】実施例６の移動体制御システムの概略構成図。

【図15】実施例６の移動体制御システムのブロック図。

【図16】実施例７の移動体制御システムの概略構成図。

【図17】実施例７の移動体制御システムのブロック図。

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

【0012】

以下、図を参照して、本発明の移動体制御システムの実施例について説明する。

【実施例0013】

まず、図１から図６を用いて、本発明の実施例１に係る移動体制御システムを説明する。なお、本実施例では、倉庫内を走行する搬送車両（以下、「車両Ｖ」と称する）の誘導に適用した場合を例に挙げて本発明を説明するが、本発明は、一般道や駐車場を走行する自動車、建設現場を走行する建設車両などの自動運転装置にも適用することができる。

【0014】

図１は、実施例１の移動体制御システムの概略構成を示す図である。ここに示すように、本実施例の移動体制御システムは、車両Ｖに搭載された車載制御装置１と、倉庫内の各所に設置された他者位置検出装置２と、車両Ｖの外部に設置された遠隔制御装置３を備えている。なお、図中の破線矢印は信号の流れを示しており、車載制御装置１と遠隔制御装置３は無線通信で接続され、他者位置検出装置２と遠隔制御装置３は有線通信または無線通信で接続されている。まず、車両Ｖ、車載制御装置１、他者位置検出装置２、遠隔制御装置３を概説する。

【0015】

車両Ｖは、作業者Ｗとの混在環境下（例えば、倉庫内）で物品を搬送する自動運転車両であり、作業者Ｗを回避しながら自動走行するために、車載制御装置１を有している。この車載制御装置１は、具体的には、ＣＰＵ（Central Processing Unit）等の演算装置、半導体メモリ等の主記憶装置、補助記憶装置、および、通信装置などを備えたコンピュータユニットであり、演算装置が主記憶装置にロードされたプログラムを実行することで、後述する各機能を実現するものである。なお、以下では、車載制御装置１のＣＰＵがプログラムを実行する際の、コンピュータ分野における周知動作を適宜省略しながら説明する。

【0016】

他者位置検出装置２は、作業者Ｗの位置（以下、「他者位置」と称する。）を検出するためのセンサであり、図１ではその一種として路側センサ２ａを例示している。この路側センサ２ａは、具体的には、カメラやＬｉＤＡＲなどであるが、以下では、路側センサ２ａがカメラであるものとして説明する。この路側センサ２ａは、撮影した動画像から抽出した作業者Ｗの位置を他者位置として検出し、遠隔制御装置３へ送信する。

【0017】

遠隔制御装置３は、車載制御装置１や他者位置検出装置２の出力に基づいて求めた、他者の予測軌道候補や予測行動目標を、車載制御装置１へ送信するサーバーである。この遠隔制御装置３は、具体的には、ＣＰＵ等の演算装置、半導体メモリ等の主記憶装置、ハードディスクドライブ等の補助記憶装置、および、通信装置などを備えたコンピュータユニットであり、演算装置が主記憶装置にロードされたプログラムを実行することで、後述する各機能を実現するものである。なお、以下では、遠隔制御装置３のＣＰＵがプログラムを実行する際の、コンピュータ分野における周知動作を適宜省略しながら説明する。

【0018】

＜車両Ｖ＞
図２は、本実施例の車両Ｖの概略構成を示す図であり、図示のように車両Ｖの前後左右を定義する。なお、図２の破線矢印も信号の流れを示している。ここに示すように、本実施例の車両Ｖは、左右の駆動輪１１と、車両Ｖを駆動するモータ１２と、車両Ｖを制動させるブレーキ１３と、モータ１２が発生した駆動力を減速する減速機１４と、モータ１２のモータ回転数を検出するエンコーダ１５と、周辺環境の特徴点である周辺特徴点を検出する車載センサ１６と、遠隔制御装置３と無線通信する通信装置１７と、モータ１２等を指令する車載制御装置１と、を備えている。

【0019】

モータ１２が電気エネルギーを変換することにより発生させた動力は、減速機１４に伝えられ、この減速機１３内部の歯車式減速機構により減速された後に、左右の駆動輪１１に伝えられ、車両Ｖを駆動する駆動力となる。左右の駆動輪１１を独立に回転させることで車両Ｖを旋回させることができる。

【0020】

モータ１２の近傍には車両Ｖの制動力を発生させるブレーキ１３が設けられている。ブレーキ１３には無励磁作動形の機構が備えられており、モータ１２へ通電を切ることによりブレーキ１３内部のロータをスプリングで静止部分に押し付けて摩擦力を発生させる。これにより運動エネルギーを熱エネルギーに変換し、車両Ｖを制動させることができる。

【0021】

車載センサ１６は、カメラやＬｉＤＡＲなどのセンサであるが、以下では、車載センサ１６がカメラであるものとして説明する。この車載センサ１６は、車両前方を撮影した動画像から周辺特徴点を検出し、車載制御装置１へ送信することができる。

【0022】

車載制御装置１は、ＣＰＵやメモリなどから構成され車載制御プログラムを実行して、モータ１２への指令値を演算するコンピュータユニットである。これにより車両Ｖの加減速や旋回を制御することができる。

【0023】

＜移動体制御システムの機能ブロック図＞
次に、図３から図５を用いて、実施例１の移動体制御システムの詳細を説明する。

【0024】

車載制御装置１のＣＰＵが所定の制御プログラムを実行することで、図３の機能ブロック図に示す、自己位置演算部１ａと、自己計画軌道候補演算部１ｂと、自己計画軌道選択部１ｃと、自己計画軌道追従部１ｄを構成し、これらが、車両Ｖの電源（不図示）がオンしている間、図４のフローチャートに示す動作（車載制御プログラム）を繰り返し実行する。

【0025】

同様に、遠隔制御装置３のＣＰＵが所定の制御プログラムを実行することで、図３の機能ブロック図に示す、他者予測軌道候補演算部３ａと、他者予測行動目標演算部３ｂを構成し、これらが、車両Ｖが送信した計画軌道候補のパケットデータの受信をトリガーとして、図５のフローチャートに示す動作（遠隔制御プログラム）を実行する。

【0026】

以下、図４と図５を併用して、車両Ｖの電源オン後に並列処理される、各部の動作を順次説明する。

【0027】

まず、図４のステップＳ１では、車載制御装置１の自己位置演算部１ａは、車載センサ１６から入力される車両Ｖの周辺の特徴点と、エンコーダ１５から入力されるモータ回転数に基づいて、車両Ｖの自己位置（位置座標）を演算する。ここでは、例えば、Visual SLAM（Simultaneous Localization and Mapping）を用いて、モータ回転数から車両Ｖの移動量を推定しつつ周辺特徴量を予め備えられたデータベースと照合することで、車両Ｖの位置座標を推定する。

【0028】

次に、図４のステップＳ２で、車載制御装置１の自己計画軌道候補演算部１ｂは、自己位置演算部１ａから入力される自己位置に基づいて、車両Ｖが追従し得る軌道の候補である、計画軌道候補Ｐを演算する。ここでは、例えば、車両Ｖ前方の複数地点をサンプリングし、当該地点へ到達できる軌道を時系列データとして演算する。さらに得られた時系列データから、実際に走行可能な場所、速度、曲率の範囲内に収まっている軌道を計画軌道候補Ｐとする。演算された計画軌道候補Ｐは、通信装置１７を介して無線通信で遠隔制御装置３へ送信される。

【0029】

遠隔制御装置３が、車載制御装置１から計画軌道候補Ｐを受信すると、それをトリガーとして、図５のフローチャートを開始する。

【0030】

まず、図５のステップＳ１１では、遠隔制御装置３の他者予測軌道候補演算部３ａは、路側センサ２ａから入力される他者位置と、自己計画軌道候補演算部１ｂから入力される計画軌道候補Ｐに基づいて、計画軌道候補Ｐの各軌道に対して予測される作業者Ｗの反応の時系列データである、予測軌道候補Ｒを演算する。ここでは、予測軌道候補Ｒは、他者位置の履歴を他者軌道予測モデルに入力することで演算する。他者軌道予測モデルとしては、作業者Ｗの歩行位置に対する歩行向きの統計モデルを用いることが考えられる。また、作業者Ｗ－車両Ｖ間および作業者Ｗ－壁面間での相互作用を考慮したSocial force modelを用いても良い。さらに、作業者Ｗの歩行軌道データを用いて学習させたニューラルネットワークモデルを用いても良い。演算された予測軌道候補Ｒは通信装置１７を介して無線通信で車載制御装置１へ送信される。

【0031】

次に、図５のステップＳ１２では、遠隔制御装置３の他者予測行動目標演算部３ｂは、路側センサ２ａから入力される他者位置に基づいて、車両Ｖが存在しない場合に予測される作業者Ｗの軌道の時系列データである、予測行動目標Ｔを演算する。予測行動目標Ｔは、他者位置の履歴を他者目標予測モデルに入力することで演算する。他者目標予測モデルとしては、作業者Ｗの歩行位置に対する歩行向きの統計モデルを用いることが考えられる。また、作業者Ｗ－車両Ｖ間および作業者Ｗ－壁面間での相互作用を考慮したSocial force modelを用いても良い。さらに、作業者Ｗの歩行軌道データを用いて学習させたニューラルネットワークモデルを用いても良い。演算された予測行動目標Ｔは通信装置１７を介して無線通信で車載制御装置１へ送信される。

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

以上のような環境下では、車両Ｖは狭路を図中の右方向に進もうとしているため、直進する軌道Ｐ２が、最も効率よく目的地へ接近できる軌道である。一方で、軌道Ｐ２に対応した作業者Ｗの軌道Ｒ２は、図中の星印で示した他者予測目標地点からの偏差（各軌道の先端までの距離）が最も大きい軌道である。図７の車両Ｖにとって、左端を進む軌道Ｐ１と、右端を進む軌道Ｐ３の効率は等価であるが、作業者Ｗにとっては、右端を進む軌道Ｒ３よりも左端を進む軌道Ｒ１の方が、他者予測目標地点との偏差が小さく都合の良い軌道である。そのため、自己計画軌道選択部１ｃは、作業者Ｗの軌道Ｒ１に対応した車両Ｖの軌道Ｐ１を、自己計画軌道として選択する。これにより、車両Ｖの計画行動目標と作業者Ｗの他者予測目標地点を両立しつつ、車両Ｖの輸送効率を向上することができる。