JP7496448B2 - 移動体制御装置、移動体及び移動体制御方法 - Google Patents

Description

本発明は、移動体制御装置、移動体及び移動体制御方法に関する。

特許文献１には、車線変更可否判定部の判定結果に応じて、自車線から隣接車線への自車両の車線変更を実行する車線変更支援装置が開示されている。

特許第６５５５０６７号公報

しかしながら、特許文献１は、車線変更の中止を必ずしも的確に行い得ない。

本発明の目的は、車線変更の中止を的確に行い得る移動体制御装置、移動体及び移動体制御方法を提供することにある。

本発明の一態様による移動体制御装置は、移動体の周辺情報を取得する周辺情報取得部と、前記周辺情報に基づいて前記移動体の走行を制御する走行制御部と、前記移動体の車線変更を制御する車線変更制御部と、前記移動体を操舵するための操作子に対する前記移動体の乗員による把持の状態を判定する把持判定部と、を備え、前記車線変更制御部は、車線変更先の対象車線の状況が前記車線変更に影響する又は影響する可能性がある所定の状況でない場合に前記移動体を前記対象車線に移動させることを開始させ、前記移動を開始させた後、前記対象車線の状況が前記所定の状況に変化した場合、前記移動体の位置が前記対象車線に対して所定の位置に存在し、且つ前記乗員の操作の把持の度合が第１度合以上である場合、前記移動体を前記対象車線へ車線変更させることを中止し、前記移動を開始させた後、前記対象車線の状況が前記所定の状況に変化した場合、前記移動体の位置が前記対象車線に対して前記所定の位置に存在し、且つ前記乗員の操作の把持の度合が前記第１度合未満である場合、前記移動体を前記対象車線へ車線変更させることを継続し、前記所定の状況は、前記対象車線を走行している他の移動体が所定速度以上で接近してきた状況、前記対象車線に落下物が存在している状況、又は、前記対象車線に合流する車線が存在している状況であり、前記所定の位置は、前記移動体とレーンマークとの間の車幅方向における距離が、第１距離閾値以上であり、且つ、前記第１距離閾値より大きい第２距離閾値未満となる位置である。

本発明の他の態様による移動体は、上記のような移動体制御装置を備える。

本発明の更に他の態様による移動体制御方法は、移動体の周辺情報に基づいて前記移動体の車線変更を車線変更制御部が制御する車線変更制御ステップと、前記移動体を操舵するための操作子に対する前記移動体の乗員による把持の状態を把持判定部が判定する判定ステップと、を有し、前記車線変更制御ステップでは、車線変更先の対象車線の状況が前記車線変更に影響する又は影響する可能性がある所定の状況でない場合に前記移動体を前記対象車線に移動させることを開始させ、前記移動を開始させた後、前記対象車線の状況が前記所定の状況に変化した場合、前記移動体の位置が前記対象車線に対して所定の位置に存在し、且つ前記乗員の操作の把持の度合が第１度合以上である場合、前記移動体を前記対象車線へ車線変更させることを中止し、前記移動を開始させた後、前記対象車線の状況が前記所定の状況に変化した場合、前記移動体の位置が前記対象車線に対して前記所定の位置に存在し、且つ前記乗員の操作の把持の度合が前記第１度合未満である場合、前記移動体を前記対象車線へ車線変更させることを継続し、前記所定の状況は、前記対象車線を走行している他の移動体が所定速度以上で接近してきた状況、前記対象車線に落下物が存在している状況、又は、前記対象車線に合流する車線が存在している状況であり、前記所定の位置は、前記移動体とレーンマークとの間の車幅方向における距離が、第１距離閾値以上であり、且つ、前記第１距離閾値より大きい第２距離閾値未満となる位置である。

本発明によれば、車線変更の中止を的確に行い得る移動体制御装置、移動体及び移動体制御方法を提供することができる。

一実施形態による移動体制御装置が備えられた移動体を示すブロック図である。 一実施形態による移動体に備えられた操作子の例を示す図である。 図３Ａ及び図３Ｂは、走行車線の例を示す図である。 一実施形態による移動体制御装置の動作の例を示すフローチャートである。 一実施形態の変形例による移動体制御装置の動作の例を示すフローチャートである。

本発明による移動体制御装置、移動体及び移動体制御方法について、好適な実施形態を挙げ、添付の図面を参照して以下に詳細に説明する。

［一実施形態］
一実施形態による移動体制御装置、移動体及び移動体制御方法について図面を用いて説明する。図１は、本実施形態による移動体制御装置が備えられた移動体を示すブロック図である。図２は、本実施形態による移動体に備えられた操作子の例を示す図である。ここでは、移動体１０が車両である場合を例に説明するが、移動体１０は車両に限定されるものではない。例えば、移動体１０がロボット等であってもよい。

移動体１０には、移動体制御装置１２、即ち、移動体制御ＥＣＵ（Ｅｌｅｃｔｒｏｎｉｃ Ｃｏｎｔｒｏｌ Ｕｎｉｔ）が備えられている。移動体１０には、外界センサ１４と、移動体挙動センサ１６と、移動体操作センサ１８と、通信部２０と、ＨＭＩ（ヒューマン・マシン・インタフェース）２２とが更に備えられている。移動体１０には、駆動装置２４と、制動装置２６と、操舵装置２８と、ナビゲーション装置３０と、測位部３３とが更に備えられている。移動体１０には、これらの構成要素以外の構成要素も備えられているが、ここでは説明を省略する。

外界センサ１４は、外界情報、即ち移動体１０の周辺情報を取得する。外界センサ１４には、複数のカメラ３２と、複数のレーダ３４とが備えられている。外界センサ１４には、複数のＬｉＤＡＲ（Ｌｉｇｈｔ Ｄｅｔｅｃｔｉｏｎ Ａｎｄ Ｒａｎｇｉｎｇ、Ｌａｓｅｒ Ｉｍａｇｉｎｇ Ｄｅｔｅｃｔｉｏｎ Ａｎｄ Ｒａｎｇｉｎｇ）３６が更に備えられている。

カメラ（撮像部）３２によって取得された情報、即ち、カメラ情報が、カメラ３２から移動体制御装置１２に供給される。カメラ情報としては、撮影情報等が挙げられる。カメラ情報は、後述するレーダ情報及びＬｉＤＡＲ情報と相俟って、外界情報を構成する。図１においては、１つのカメラ３２が図示されているが、実際には複数のカメラ３２が備えられている。

レーダ３４は、送信波を移動体１０の外部に向かって発射し、発射した送信波のうちの検出物体によって反射されて戻って来る反射波を受信する。送信波としては、例えば電磁波等が挙げられる。電磁波としては、例えば、ミリ波等が挙げられる。検出物体としては、例えば、移動体１０とは異なる他の移動体７０（図３Ａ参照）、即ち、他車両等が挙げられる。レーダ３４は、反射波等に基づいてレーダ情報（反射波信号）を生成する。レーダ３４は、生成した当該レーダ情報を移動体制御装置１２に供給する。図１においては、１つのレーダ３４が図示されているが、実際には、複数のレーダ３４が移動体１０に備えられている。なお、レーダ３４は、ミリ波レーダに限定されるものではない。例えば、レーザレーダ、超音波センサ等をレーダ３４として用いるようにしてもよい。

ＬｉＤＡＲ３６は、移動体１０の全方位にレーザを連続的に発射し、発射したレーザの反射波に基づいて反射点の３次元位置を測定し、当該３次元位置に関する情報、即ち、３次元情報を出力する。ＬｉＤＡＲ３６は、当該３次元情報、即ち、ＬｉＤＡＲ情報を、移動体制御装置１２に供給する。図１においては、１つのＬｉＤＡＲ３６が図示されているが、実際には、複数のＬｉＤＡＲ３６が移動体１０に備えられている。

移動体挙動センサ１６は、移動体１０の挙動に関する情報、即ち、移動体挙動情報を取得する。移動体挙動センサ１６には、不図示の速度センサ、不図示の車輪速センサ、不図示の加速度センサ、及び、不図示のヨーレートセンサが含まれる。速度センサは、移動体１０の速度、即ち、車速を検出する。また、速度センサは、移動体１０の進行方向を更に検出する。車輪速センサは、不図示の車輪の速度、即ち、車輪速を検出する。加速度センサは、移動体１０の加速度を検出する。加速度は、前後加速度、横加速度、及び、上下加速度を含む。なお、一部の方向のみの加速度が加速度センサによって検出されるようにしてもよい。ヨーレートセンサは、移動体１０のヨーレートを検出する。

移動体操作センサ（運転操作センサ）１８は、乗員（運転者）による運転操作に関する情報、即ち、運転操作情報を取得する。移動体操作センサ１８には、不図示のアクセルペダルセンサ、不図示のブレーキペダルセンサ、不図示の舵角センサ、及び、トルクセンサ（操舵トルクセンサ）１８Ａが含まれる。アクセルペダルセンサは、不図示のアクセルペダルの操作量を検出する。ブレーキペダルセンサは、不図示のブレーキペダルの操作量を検出する。舵角センサは、操作子７４（図２参照）、即ち、ステアリングホイールの舵角を検出する。トルクセンサ１８Ａは、操作子７４に加えられるトルク、即ち、操舵トルクを検出する。

通信部２０は、不図示の外部機器との間で無線通信を行う。外部機器には、例えば、不図示の外部サーバ等が含まれ得る。通信部２０は、移動体１０に対して、着脱不能であってもよいし、着脱可能であってもよい。移動体１０に対して着脱可能な通信部２０としては、例えば、携帯電話機、スマートフォン等が挙げられる。

ＨＭＩ２２は、乗員による操作入力を受け付けるとともに、各種情報を視覚的、聴覚的又は触覚的に乗員に提供する。ＨＭＩ２２には、例えば、自動運転スイッチ（運転アシストスイッチ）３８と、ディスプレイ４０と、接触センサ４２と、カメラ４４と、スピーカ４６と、操作入力部６８とが含まれる。

自動運転スイッチ３８は、自動運転の開始及び停止を乗員が指示するためのものである。自動運転スイッチ３８は、不図示の開始スイッチと不図示の停止スイッチとを含む。開始スイッチは、乗員の操作に応じて移動体制御装置１２に対して開始信号を出力する。停止スイッチは、乗員の操作に応じて移動体制御装置１２に対して停止信号を出力する。

ディスプレイ（表示部）４０は、例えば、液晶パネル、有機ＥＬパネル等を含む。ここでは、ディスプレイ４０がタッチパネルである場合を例に説明するが、これに限定されるものではない。

接触センサ４２は、乗員による操作子７４への接触を検出し得る。接触センサ４２から出力される信号は、把持判定部６６に供給され得る。把持判定部６６は、例えば接触センサ４２から供給される信号に基づいて、操作子７４に対する乗員による接触の状態を判定し得る。

カメラ４４は、移動体１０の内部、即ち、不図示の車室内を撮像する。また、カメラ４４は、乗員を撮像するように設けられ得る。カメラ４４は、例えば、不図示のダッシュボードに設けられてもよいし、不図示の天井に設けられてもよい。カメラ４４は、車室内を撮像することによって取得される情報、即ち、画像情報を、移動体制御装置１２に出力する。

スピーカ４６は、各種の情報を音声で乗員に提供するためのものである。移動体制御装置１２は、各種の通知、警報等を、スピーカ４６を用いて出力する。

操作入力部６８は、車線変更の指示のための操作入力を乗員が行うためのものである。また、車線変更の提案、即ち、車線変更提案が移動体制御装置１２によって行われる場合、乗員は、当該車線変更提案に同意するか否かの意思表示を、操作入力部６８を用いて行い得る。操作入力部６８は、例えば、不図示のレバー状の操作子であるが、これに限定されるものではない。操作入力部６８は、例えば、ステアリングコラム８０（図２参照）に設けられているが、これに限定されるものではない。操作入力部６８は、例えば、支軸を中心として、時計回り及び反時計回りに回動され得る。操作入力部６８には、不図示の操作位置センサが備えられている。操作位置センサは、操作入力部６８の操作位置を検出する。操作入力部６８は、操作位置センサによって得られた情報、即ち、操作入力部６８の操作位置に関する情報を、後述する移動体制御装置１２に供給する。

駆動装置（駆動力制御システム）２４には、不図示の駆動ＥＣＵと、不図示の駆動源とが備えられている。駆動ＥＣＵは、駆動源を制御することにより、移動体１０の駆動力（トルク）を制御する。駆動源としては、例えば、エンジン、駆動モータ等が挙げられる。駆動ＥＣＵは、アクセルペダルに対する乗員による操作に基づいて、駆動源を制御することにより、駆動力を制御し得る。また、駆動ＥＣＵは、移動体制御装置１２から供給される指令に基づいて、駆動源を制御することにより、駆動力を制御し得る。駆動源の駆動力は、不図示のトランスミッション等を介して不図示の車輪に伝達される。

制動装置（制動力制御システム）２６には、不図示の制動ＥＣＵと、不図示のブレーキ機構とが備えられている。ブレーキ機構は、ブレーキモータ、油圧機構等によってブレーキ部材を作動させる。制動ＥＣＵは、ブレーキペダルに対する乗員による操作に基づいて、ブレーキ機構を制御することにより、制動力を制御し得る。また、制動ＥＣＵは、移動体制御装置１２から供給される指令に基づいて、ブレーキ機構を制御することにより、制動力を制御し得る。

操舵装置（操舵システム）２８には、不図示の操舵ＥＣＵ、即ち、ＥＰＳ（電動パワーステアリングシステム）ＥＣＵと、不図示の操舵モータとが備えられている。操舵ＥＣＵは、操作子７４、即ち、ステアリングホイールに対する乗員による操作に基づいて、操舵モータを制御することによって、車輪（操舵輪）の向きを制御する。また、操舵ＥＣＵは、移動体制御装置１２から供給される指令に基づいて、操舵モータを制御することによって、車輪の向きを制御する。なお、左右の車輪に対するトルク配分や制動力配分を変更することによって操舵が行われるようにしてもよい。

ナビゲーション装置３０には、不図示のＧＮＳＳ（Ｇｌｏｂａｌ Ｎａｖｉｇａｔｉｏｎ Ｓａｔｅｌｌｉｔｅ Ｓｙｓｔｅｍ、全地球航法衛星システム）センサが備えられている。また、ナビゲーション装置３０には、不図示の演算部と、不図示の記憶部とが更に備えられている。ＧＮＳＳセンサは、移動体１０の現在位置を検出する。演算部は、ＧＮＳＳセンサによって検出された現在位置に対応する地図情報を、記憶部に記憶された地図データベースから読み出す。演算部は、当該地図情報を用い、現在位置から目的地までの目標経路を決定する。なお、目的地は、ＨＭＩ２２を介して乗員によって入力される。上述したように、ディスプレイ４０はタッチパネルである。タッチパネルが乗員によって操作されることによって、目的地の入力が行われる。ナビゲーション装置３０は、作成した目標経路を移動体制御装置１２に出力する。移動体制御装置１２は、当該目標経路をＨＭＩ２２に供給する。ＨＭＩ２２は、当該目標経路をディスプレイ４０に表示する。

測位部３３には、ＧＮＳＳ４８が備えられている。測位部３３には、ＩＭＵ（Ｉｎｅｒｔｉａｌ Ｍｅａｓｕｒｅｍｅｎｔ Ｕｎｉｔ、慣性計測装置）５０と、地図データベース（地図ＤＢ）５２とが更に備えられている。測位部３３は、ＧＮＳＳ４８によって得られる情報と、ＩＭＵ５０によって得られる情報と、地図データベース５２に記憶された地図情報とを適宜用いて、移動体１０の位置を特定する。測位部３３は、移動体１０の位置を示す情報である自己位置情報、即ち、移動体１０の位置情報を、移動体制御装置１２に対して供給し得る。また、測位部３３は、移動体制御装置１２に対して地図情報を供給し得る。

移動体制御装置１２には、演算部５４と、記憶部５６とが備えられている。演算部５４は、移動体制御装置１２の全体の制御を司る。演算部５４は、例えば１つ以上のプロセッサによって構成され得る。かかるプロセッサとしては、例えばＣＰＵ（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）等が用いられ得る。演算部５４は、記憶部５６に記憶されているプログラムに基づいて各部を制御することによって、移動体制御を実行する。

演算部５４には、制御部５７と、周辺情報取得部５８と、走行制御部６０と、車線変更制御部６２と、中止制御部６４と、把持判定部６６とが備えられている。制御部５７と、周辺情報取得部５８と、走行制御部６０と、車線変更制御部６２と、中止制御部６４と、把持判定部６６とは、記憶部５６に記憶されているプログラムが演算部５４によって実行されることによって実現され得る。

記憶部５６は、不図示の揮発性メモリと、不図示の不揮発性メモリとを含む。揮発性メモリとしては、例えばＲＡＭ（Ｒａｎｄｏｍ Ａｃｃｅｓｓ Ｍｅｍｏｒｙ）等が挙げられる。不揮発性メモリとしては、例えばＲＯＭ（Ｒｅａｄ Ｏｎｌｙ Ｍｅｍｏｒｙ）、フラッシュメモリ等が挙げられる。外界情報、移動体挙動情報、移動体操作情報等が、例えば揮発性メモリに格納される。プログラム、テーブル、マップ等が、例えば不揮発性メモリに記憶される。

制御部５７は、移動体制御装置１２の全体の制御を司る。

周辺情報取得部５８は、移動体１０の周辺情報を取得し得る。かかる周辺情報は、例えば外界センサ１４から供給され得る。

走行制御部６０は、周辺情報取得部５８によって取得される周辺情報に基づいて移動体１０の走行を制御し得る。

車線変更制御部６２は、移動体１０の車線変更の制御を行い得る。例えば、車線変更制御部６２は、車線変更提案を乗員に対して行い、当該車線変更提案に対して乗員が同意した場合に、車線変更を行い得るが、これに限定されるものではない。車線変更提案を乗員に対して行うことなく、車線変更制御部６２によって車線変更が行われるようにしてもよい。また、乗員による車線変更の指示に基づいて、車線変更制御部６２によって車線変更が行われるようにしてもよい。車線変更を行う際、中止制御部６４は、車線変更を行うことを示す情報を、例えばディスプレイ４０、スピーカ４６等を用いて乗員に報知し得る。

中止制御部６４は、車線変更が中止されるための第１中止条件及び第２中止条件が満たされた場合に車線変更の中止の制御を行い得る。第１中止条件は、基本的な中止条件である。例えば、後述する第２車線７２Ｂ（図３Ａ参照）を走行している他の移動体７０（図３Ａ参照）が所定速度以上で接近してきた場合、第１中止条件が満たされ得る。また、第２車線７２Ｂに落下物が存在している場合、第１中止条件が満たされ得る。また、第２車線７２Ｂに合流する不図示の車線が存在している場合、第１中止条件が満たされ得る。第２中止条件は、後述するレーンマーク７３（図３Ａ参照）と移動体１０との間の車幅方向における距離が所定の距離閾値以上である場合に満たされ得る。車線変更を中止する際、中止制御部６４は、車線変更を中止することを示す情報を、ディスプレイ４０、スピーカ４６等を用いて乗員に報知し得る。

把持判定部６６は、移動体１０を操舵するための操作子７４に対する移動体１０の乗員による把持の状態、即ち、把持の程度を判定し得る。把持判定部６６は、上述したように、例えば接触センサ４２から供給される信号に基づいて、操作子７４に対する移動体１０の乗員による把持の状態を判定し得る。例えば、把持判定部６６は、乗員の両手によって操作子７４で把持されているか、乗員の片手によって操作子７４が把持されているかを判定することも可能である。ここでは、操作子７４に対する乗員による把持の状態を判定する場合を例に説明したが、これに限定されるものではない。操作子７４が乗員によって把持されているか否かが、把持判定部６６によって判定されるようにしてもよい。

図３Ａ及び図３Ｂは、走行車線の例を示す図である。第１車線７２Ａと、当該第１車線７２Ａに隣接する第２車線７２Ｂとが、図３Ａ及び図３Ｂには示されている。第１車線７２Ａと第２車線７２Ｂとの間にはレーンマーク７３が存在している。移動体１０が第１車線７２Ａを走行している場合の例が図３Ａ及び図３Ｂには示されている。移動体１０の位置よりも後方に位置している他の移動体７０が第２車線７２Ｂを走行している状態の例が図３Ａ及び図３Ｂには示されている。車線一般について説明する際には、符号７２を用い、個々の車線について説明する際には、符号７２Ａ、７２Ｂを用いることとする。ここでは、第１車線７２Ａが進行方向右側に位置し、第２車線７２Ｂが進行方向左側に位置している場合の例が示されているが、第１車線７２Ａが進行方向左側に位置し、第２車線７２Ｂが進行方向右側に位置していてもよい。

第１車線７２Ａから第２車線７２Ｂへの車線変更を移動体１０が行っている際において、第２車線７２Ｂを走行している他の移動体７０が後方から急速に接近してきた際には、第１中止条件が満たされ得る。操作子７４、即ち、ステアリングホイールに対する乗員による把持が所定程度以上であることが把持判定部６６によって判定されている状態で第１中止条件が満たされた場合、中止制御部６４は、以下のような制御を行い得る。即ち、かかる場合、中止制御部６４は、図３Ａに示すように、レーンマーク７３と移動体１０との間の車幅方向における距離Ｌが第１距離閾値ＴＨ１以上であれば、第２中止条件が満たされたと判定する。第１中止条件と第２中止条件とが満たされるため、中止制御部６４は、第１車線７２Ａから第２車線７２Ｂへの移動体１０の車線変更を中止する。車線変更が中止された場合、走行制御部６０は、移動体１０が第１車線７２Ａの中心を走行するように移動体１０の走行を制御する。第１距離閾値ＴＨ１は、例えば０であるが、これに限定されるものではない。また、距離Ｌは、例えば、移動体１０のうちのレーンマーク７３に最も近い部位とレーンマーク７３との間の距離とし得るが、これに限定されるものではない。移動体１０の一部とレーンマーク７３とが平面視において重なり合っている場合には、距離Ｌは０未満、即ち、負の値となる。移動体１０に備えられた不図示の車輪がレーンマーク７３を横切った場合には、距離Ｌは０未満、即ち、負の値となる。

一方、操作子７４、即ち、ステアリングホイールに対する乗員による把持が所定程度未満であることが把持判定部６６によって判定されている状態で第１中止条件が満たされた場合、中止制御部６４は、以下のような制御を行い得る。かかる場合、中止制御部６４は、図３Ｂに示すように、レーンマーク７３と移動体１０との間に車幅方向における距離Ｌが第１距離閾値ＴＨ１より大きい第２距離閾値ＴＨ２以上であれば、第２中止条件が満たされたと判定する。第１中止条件と第２中止条件とが満たされるため、中止制御部６４は、第１車線７２Ａから第２車線７２Ｂへの移動体１０の車線変更を中止する。車線変更が中止された場合、上述したように、走行制御部６０は、移動体１０が第１車線７２Ａの中心を走行するように移動体１０の走行を制御する。

このように、本実施形態では、操作子７４に対する乗員による把持が所定程度以上である状態で第１中止条件が満たされた場合には、中止制御部６４は、距離Ｌが第１距離閾値ＴＨ１以上であれば、第２中止条件が満たされたと判定する。即ち、本実施形態では、操作子７４に対する乗員による把持が所定程度以上である状態で第１中止条件が満たされた場合には、中止制御部６４は、距離Ｌが比較的小さくなった際においても、第２中止条件が満たされたと判定する。一方、操作子７４に対する乗員による把持が所定程度未満である状態で第１中止条件が満たされた場合には、距離Ｌが第１距離閾値ＴＨ１より大きい第２距離閾値ＴＨ２以上であれば、中止制御部６４は、第２中止条件が満たされたと判定する。即ち、操作子７４に対する乗員による把持が所定程度未満である状態で第１中止条件が満たされた場合には、中止制御部６４は、距離Ｌがある程度大きくなければ第２中止条件が満たされたと判定しない。本実施形態においてこのように距離閾値を変更しているのは以下のような理由によるものである。即ち、操作子７４に対する乗員による把持が所定程度以上である状態においては、車線変更の中止が移動体制御装置１２から乗員に伝えられた際、乗員は必要な対処を必要に応じて速やかに行い得る。一方、操作子７４に対する乗員による把持が所定程度未満である状態においては、車線変更の中止が移動体制御装置１２から乗員に伝えられた際、乗員は必要な対処を必ずしも速やかに行い得ない。このような理由により、本実施形態では、操作子７４に対する乗員による把持が所定程度以上である状態で第１中止条件が満たされた場合には、中止制御部６４は、距離Ｌが比較的小さくなった際においても車線変更を中止する。即ち、操作子７４に対する乗員による把持が所定程度以上である状態で第１中止条件が満たされた場合には、距離Ｌが第１距離閾値ＴＨ１以上であれば、中止制御部６４は、第２中止条件が満たされたと判定して、車線変更を中止する。

移動体１０とレーンマーク７３との間の車幅方向における距離Ｌが第１距離閾値ＴＨ１以上、第２距離閾値ＴＨ２未満である状態で第１中止条件が満たされた場合には、以下のようになる。即ち、このような状態で第１中止条件が満たされ、且つ、操作子７４に対する乗員による把持が所定程度以上であることが把持判定部６６によって判定された場合、中止制御部６４は、第１車線７２Ａから第２車線７２Ｂへの移動体１０の車線変更を中止し得る。

なお、第１距離閾値ＴＨ１を、移動体１０の速度に応じて可変させるようにしてもよい。また、第２距離閾値ＴＨ２を、移動体１０の速度に応じて可変させるようにしてもよい。

図４は、本実施形態による移動体制御装置の動作の例を示すフローチャートである。車線変更の際の動作が図４には示されている。

ステップＳ１において、制御部５７は、車線変更を行うか否かを判定する。車線変更を行う場合（ステップＳ１においてＹＥＳ）、ステップＳ２に遷移する。車線変更を行わない場合（ステップＳ１においてＮＯ）、ステップＳ１が繰り返される。

ステップＳ２において、車線変更制御部６２は、車線変更制御を行う。この後、ステップＳ３に遷移する。

ステップＳ３において、制御部５７は、車線変更が完了したか否かを判定する。車線変更が完了した場合には（ステップＳ３においてＹＥＳ）、図４に示す処理が完了する。車線変更が完了していない場合には（ステップＳ３においてＮＯ）、ステップＳ４に遷移する。

ステップＳ４において、中止制御部６４は、第１中止条件が満たされたか否かを判定する。第１中止条件が満たされた場合には（ステップＳ４においてＹＥＳ）、ステップＳ５に遷移する。第１中止条件が満たされていない場合には（ステップＳ４においてＮＯ）、ステップＳ２以降の処理が繰り返される。

ステップＳ５において、把持判定部６６は、操作子７４に対する乗員による把持が所定程度以上であるか否かを判定する。操作子７４に対する乗員による把持が所定程度以上である場合（ステップＳ５においてＹＥＳ）、ステップＳ６に遷移する。操作子７４に対する乗員による把持が所定程度未満である場合（ステップＳ５においてＮＯ）、ステップＳ７に遷移する。

ステップＳ６において、中止制御部６４は、レーンマーク７３と移動体１０との間の車幅方向における距離Ｌが第１距離閾値ＴＨ１以上であるか否かを判定する。レーンマーク７３と移動体１０との間の車幅方向における距離Ｌが第１距離閾値ＴＨ１以上である場合（ステップＳ６においてＹＥＳ）、ステップＳ９に遷移する。レーンマーク７３と移動体１０との間の車幅方向における距離Ｌが第１距離閾値ＴＨ１未満である場合（ステップＳ６においてＮＯ）、ステップＳ８に遷移する。

ステップＳ７において、中止制御部６４は、レーンマーク７３と移動体１０との間の車幅方向における距離Ｌが第２距離閾値ＴＨ２以上であるか否かを判定する。レーンマーク７３と移動体１０との間の車幅方向における距離Ｌが第２距離閾値ＴＨ２以上である場合（ステップＳ７においてＹＥＳ）、ステップＳ９に遷移する。レーンマーク７３と移動体１０との間の車幅方向における距離Ｌが第２距離閾値ＴＨ２未満である場合（ステップＳ７においてＮＯ）、ステップＳ８に遷移する。

ステップＳ８において、中止制御部６４は、第２中止条件が満たされていないと判定して、第１車線７２Ａから第２車線７２Ｂへの移動体１０の車線変更を中止しない。この場合には、第１車線７２Ａから第２車線７２Ｂへの移動体１０の車線変更が完了するまで、車線変更制御部６２によって車線変更の制御が行われる。

ステップＳ９において、中止制御部６４は、第２中止条件が満たされていると判定して、第１車線７２Ａから第２車線７２Ｂへの移動体１０の車線変更を中止する。こうして、図４に示す処理が完了する。

このように、本実施形態によれば、操作子７４に対する乗員による把持が所定程度以上であることが把持判定部６６によって判定されている状態で第１中止条件が満たされた場合、中止制御部６４は、以下のような制御を行う。即ち、このような場合、第１車線７２Ａと第２車線７２Ｂとの間に位置するレーンマーク７３と移動体１０との間の車幅方向における距離Ｌが第１距離閾値ＴＨ１以上であれば、中止制御部６４は、第２中止条件が満たされたと判定する。第１中止条件と第２中止条件とが満たされるため、中止制御部６４は、第１車線７２Ａから第２車線７２Ｂへの移動体１０の車線変更を中止する。一方、操作子７４に対する乗員による把持が所定程度未満であることが把持判定部６６によって判定されている状態で第１中止条件が満たされた場合、中止制御部６４は、以下のような制御を行う。即ち、レーンマーク７３と移動体１０との間の車幅方向における距離Ｌが第１距離閾値ＴＨ１より大きい第２距離閾値ＴＨ２以上であれば、中止制御部６４は、第２中止条件が満たされたと判定する。第１中止条件と第２中止条件とが満たされるため、中止制御部６４は、第１車線７２Ａから第２車線７２Ｂへの移動体１０の車線変更を中止する。このように、本実施形態によれば、車線変更の中止を的確に行い得る移動体制御装置１２を提供することができる。

（変形例）
次に、本実施形態の変形例による移動体制御装置、移動体及び移動体制御方法について図面を用いて説明する。

本変形例では、操作子７４に対する乗員による把持が所定程度以上であることが接触センサ４２の出力に基づいて判定されている状態で第１中止条件が満たされた場合、中止制御部６４は、以下のような制御を行い得る。即ち、このような場合、中止制御部６４は、レーンマーク７３と移動体１０との間の車幅方向における距離Ｌが第１距離閾値ＴＨ１以上であれば、第２中止条件が満たされたと判定する。第１中止条件と第２中止条件とが満たされるため、中止制御部６４は、第１車線７２Ａから第２車線７２Ｂへの移動体１０の車線変更を中止し得る。操作子７４に対する乗員による把持が所定程度以上であることがトルクセンサ１８Ａの出力に基づいて判定されている状態で第１中止条件が満たされた場合、以下のようになる。即ち、このような場合、中止制御部６４は、レーンマーク７３と移動体１０との間の車幅方向における距離Ｌが第１距離閾値ＴＨ１より大きい第３距離閾値ＴＨ３以上であれば、第２中止条件が満たされたと判定する。第１中止条件と第２中止条件とが満たされるため、中止制御部６４は、第１車線７２Ａから第２車線７２Ｂへの移動体１０の車線変更を中止し得る。このように、本変形例では、操作子７４に対する乗員による把持の状態が接触センサ４２の出力に基づいて判定されるかトルクセンサ１８Ａの出力に基づいて判定されるかによって、距離閾値を異ならせる。

本変形例において、操作子７４に対する乗員による把持の状態が接触センサ４２の出力に基づいて判定されるかトルクセンサ１８Ａの出力に基づいて判定されるかによって、距離閾値を異ならせるのは、以下のような理由によるものである。即ち、操作子７４が把持されている場合であっても、操作子７４にトルクが加えられていない場合には、操作子７４が把持されていないと判定され得る。従って、操作子７４に対する乗員による把持の状態がトルクセンサ１８Ａの出力に基づいて判定されている状態で第１中止条件が満たされた場合には、中止制御部６４は、以下のように制御する。即ち、このような場合、中止制御部６４は、距離Ｌが第１距離閾値ＴＨ１より大きい第３距離閾値ＴＨ３以上であれば、第２中止条件が満たされたと判定して、第１車線７２Ａから第２車線７２Ｂへの移動体１０の車線変更を中止し得る。

図５は、本変形例による移動体制御装置の動作を示すフローチャートである。

ステップＳ１～Ｓ５は、図４を用いて上述したステップＳ１～Ｓ５と同様であるため、説明を省略する。操作子７４に対する乗員による把持が所定程度以上である場合には（ステップＳ５においてＹＥＳ）、ステップＳ１１に遷移する。操作子７４に対する乗員による把持が所定程度未満である場合には（ステップＳ５においてＮＯ）、ステップＳ７に遷移する。

ステップＳ１１において、操作子７４に対する乗員による把持の状態が接触センサ４２の出力に基づいて判定されたか否かを判定する。操作子７４に対する乗員による把持の状態が接触センサ４２の出力に基づいて判定された場合（ステップＳ１１においてＹＥＳ）、ステップＳ６に遷移する。操作子７４に対する乗員による把持の状態がトルクセンサ１８Ａの出力に基づいて判定された場合（ステップＳ１１においてＮＯ）、ステップＳ１２に遷移する。

ステップＳ１２において、中止制御部６４は、レーンマーク７３と移動体１０との間の車幅方向における距離Ｌが第３距離閾値ＴＨ３以上であるか否かを判定する。レーンマーク７３と移動体１０との間の車幅方向における距離Ｌが第３距離閾値ＴＨ３以上である場合（ステップＳ１２においてＹＥＳ）、ステップＳ９に遷移する。レーンマーク７３と移動体１０との間の車幅方向における距離Ｌが第３距離閾値ＴＨ３未満である場合（ステップＳ１２においてＮＯ）、ステップＳ８に遷移する。

ステップＳ６～Ｓ９は、図４を用いて上述したステップＳ６～Ｓ９と同様であるため、説明を省略する。こうして、図５に示す処理が完了する。

［変形実施形態］
本発明についての好適な実施形態を上述したが、本発明は上記実施形態に限定されるものではなく、本発明の要旨を逸脱しない範囲において、種々の改変が可能である。

例えば、上記実施形態では、操作子７４に対する乗員による把持の状態が、接触センサ４２の出力又はトルクセンサ１８Ａの出力に基づいて判定される場合を例に説明したが、これに限定されるものではない。例えば、操作子７４に対する乗員による把持の状態が、カメラ４４による撮像によって得られる画像に基づいて判定されるようにしてもよい。操作子７４に対する乗員による把持の状態がカメラ４４によって得られた画像に基づいて判定されている状態で第１中止条件が満たされた場合、中止制御部６４は、以下のような制御を行い得る。即ち、このような場合、中止制御部６４は、レーンマーク７３と移動体１０との間の車幅方向における距離Ｌが第１距離閾値ＴＨ１より大きい第４距離閾値ＴＨ４以上であれば、第２中止条件が満たされたと判定する。第１中止条件と第２中止条件とが満たされるため、中止制御部６４は、第１車線７２Ａから第２車線７２Ｂへの移動体１０の車線変更を中止し得る。

上記実施形態をまとめると以下のようになる。

移動体制御装置（１２）は、移動体（１０）の周辺情報を取得する周辺情報取得部（５８）と、前記周辺情報に基づいて前記移動体の走行を制御する走行制御部（６０）と、前記移動体の車線変更を制御する車線変更制御部（６２）と、前記車線変更が中止されるための第１中止条件及び第２中止条件が満たされた場合に前記車線変更の中止の制御を行う中止制御部（６４）と、前記移動体を操舵するための操作子（７４）に対する前記移動体の乗員による把持の状態を判定する把持判定部（６６）と、を備え、前記操作子に対する前記乗員による把持が所定程度以上であることが前記把持判定部によって判定されている状態で前記第１中止条件が満たされた場合、前記中止制御部は、前記移動体が走行している第１車線（７２Ａ）と前記第１車線に隣接する第２車線（７２Ｂ）との間に位置するレーンマーク（７３）と前記移動体との間の車幅方向における距離（Ｌ）が第１距離閾値（ＴＨ１）以上であれば、前記第２中止条件が満たされたと判定して、前記第１車線から前記第２車線への前記移動体の前記車線変更を中止し、前記レーンマークと前記移動体との間の車幅方向における距離が前記第１距離閾値未満であれば、前記第２中止条件が満たされていないと判定して、前記第１車線から前記第２車線への前記移動体の前記車線変更を実行し、前記操作子に対する前記乗員による把持が前記所定程度未満であることが前記把持判定部によって判定されている状態で前記第１中止条件が満たされた場合、前記中止制御部は、前記レーンマークと前記移動体との間の車幅方向における距離が前記第１距離閾値より大きい第２距離閾値（ＴＨ２）以上であれば、前記第２中止条件が満たされたと判定して、前記第１車線から前記第２車線への前記移動体の前記車線変更を中止し、前記レーンマークと前記移動体との間の車幅方向における距離が第２距離閾値未満であれば、前記第２中止条件が満たされていないと判定して、前記第１車線から前記第２車線への前記移動体の前記車線変更を実行する。このような構成によれば、移動体１０の車線変更が中止され得る条件を緩和し得る移動体制御装置を提供することができる。

前記移動体と前記レーンマークとの間の車幅方向における距離が前記第１距離閾値以上、前記第２距離閾値未満である状態で前記第１中止条件が満たされ、且つ、前記操作子に対する前記乗員による把持が前記所定程度以上であることが前記把持判定部によって判定された場合、前記中止制御部は、前記第１車線から前記第２車線への前記移動体の前記車線変更を中止するようにしてもよい。

前記車線変更が中止された場合、前記走行制御部は、前記移動体が前記第１車線の中心を走行するように前記移動体の走行を制御するようにしてもよい。

前記乗員による前記操作子への接触を検出する接触センサ（４２）と、前記操作子に加えられるトルクを検出するトルクセンサ（１８Ａ）とが前記移動体に備えられており、前記操作子に対する前記乗員による把持が前記所定程度以上であることが前記接触センサの出力に基づいて判定されている状態で前記第１中止条件が満たされた場合、前記中止制御部は、前記レーンマークと前記移動体との間の車幅方向における距離が前記第１距離閾値以上であれば、前記第２中止条件が満たされたと判定して、前記第１車線から前記第２車線への前記移動体の前記車線変更を中止し、前記操作子に対する前記乗員による把持が前記接触センサによって検出されておらず、且つ、前記操作子に対する前記乗員による把持が前記所定程度以上であることが前記トルクセンサの出力に基づいて判定されている状態で前記第１中止条件が満たされた場合、前記中止制御部は、前記レーンマークと前記移動体との間の車幅方向における距離が前記第１距離閾値より大きい第３距離閾値（ＴＨ３）以上であれば、前記第２中止条件が満たされたと判定して、前記第１車線から前記第２車線への前記移動体の前記車線変更を中止するようにしてもよい。

前記第１距離閾値は、前記移動体の速度に応じて可変するようにしてもよい。

前記第２距離閾値は、前記移動体の速度に応じて可変するようにしてもよい。

前記第２車線を走行している他の移動体（７０）の接近によって前記第１中止条件が満たされるようにしてもよい。

前記第１距離閾値は、０であるようにしてもよい。

前記把持判定部は、前記操作子が前記乗員によって把持されているか否かを判定し、前記操作子が前記乗員によって把持されていることが前記把持判定部によって判定されている状態で前記第１中止条件が満たされた場合、前記中止制御部は、前記レーンマークと前記移動体との間の車幅方向における距離が前記第１距離閾値以上であれば、前記第２中止条件が満たされたと判定して、前記第１車線から前記第２車線への前記移動体の前記車線変更を中止し、前記レーンマークと前記移動体との間の車幅方向における距離が前記第１距離閾値未満であれば、前記第２中止条件が満たされていないと判定して、前記第１車線から前記第２車線への前記移動体の前記車線変更を実行し、前記操作子が前記乗員によって把持されていないことが前記把持判定部によって判定されている状態で前記第１中止条件が満たされた場合、前記中止制御部は、前記レーンマークと前記移動体との間の車幅方向における距離が前記第２距離閾値以上であれば、前記第２中止条件が満たされたと判定して、前記第１車線から前記第２車線への前記移動体の前記車線変更を中止し、前記レーンマークと前記移動体との間の車幅方向における距離が第２距離閾値未満であれば、前記第２中止条件が満たされていないと判定して、前記第１車線から前記第２車線への前記移動体の前記車線変更を実行するようにしてもよい。

移動体（１０）は、上記のような移動体制御装置を備える。

移動体制御方法は、移動体の周辺情報に基づいて前記移動体の車線変更を制御する車線変更制御ステップ（Ｓ２）と、前記車線変更が中止されるための第１中止条件及び第２中止条件が満たされた場合に前記車線変更の中止の制御を行う中止制御ステップ（Ｓ４、Ｓ６～Ｓ９）と、前記移動体を操舵するための操作子に対する前記移動体の乗員による把持の状態を判定する把持判定ステップ（Ｓ５）と、を有し、前記中止制御ステップでは、前記操作子に対する前記乗員による把持が所定程度以上であることが前記把持判定ステップにおいて判定されている状態で前記第１中止条件が満たされた場合（Ｓ４、Ｓ５）、前記移動体が走行している第１車線と前記第１車線に隣接する第２車線との間に位置するレーンマークと前記移動体との間の車幅方向における距離が第１距離閾値以上であれば、前記第２中止条件が満たされたと判定して、前記第１車線から前記第２車線への前記移動体の前記車線変更を中止し（Ｓ６、Ｓ９）、前記レーンマークと前記移動体との間の車幅方向における距離が前記第１距離閾値未満であれば、前記第２中止条件が満たされていないと判定して、前記第１車線から前記第２車線への前記移動体の前記車線変更を実行し（Ｓ６、Ｓ８）、前記中止制御ステップでは、前記操作子に対する前記乗員による把持が前記所定程度未満であることが前記把持判定ステップにおいて判定されている状態で前記第１中止条件が満たされた場合（Ｓ４、Ｓ５）、前記レーンマークと前記移動体との間の車幅方向における距離が前記第１距離閾値より大きい第２距離閾値以上であれば、前記第２中止条件が満たされたと判定して、前記第１車線から前記第２車線への前記移動体の前記車線変更を中止し（Ｓ７、Ｓ９）、前記レーンマークと前記移動体との間の車幅方向における距離が前記第２距離閾値未満であれば、前記第２中止条件が満たされていないと判定して、前記第１車線から前記第２車線への前記移動体の前記車線変更を実行する（Ｓ７、Ｓ８）。

１０：移動体 １２：移動体制御装置
１４：外界センサ １６：車体挙動センサ
１８：移動体操作センサ １８Ａ：トルクセンサ
２０：通信部 ２４：駆動装置
２６：制動装置 ２８：操舵装置
３０：ナビゲーション装置 ３２、４４：カメラ
３３：測位部 ３４：レーダ
３８：自動運転スイッチ ４０：ディスプレイ
４２：接触センサ ４６：スピーカ
５２：地図データベース ５４：演算部
５６：記憶部 ５７：制御部
５８：周辺情報取得部 ６０：走行制御部
６２：車線変更制御部 ６４：中止制御部
６６：把持判定部 ６８：操作入力部
７０：他の移動体 ７２Ａ：第１車線
７２Ｂ：第２車線 ７３：レーンマーク
７４：操作子 ８０：ステアリングコラム
Ｌ：距離 ＴＨ１：第１距離閾値
ＴＨ２：第２距離閾値 ＴＨ３：第３距離閾値

Claims (6)

1. 移動体の周辺情報を取得する周辺情報取得部と、
   前記周辺情報に基づいて前記移動体の走行を制御する走行制御部と、
   前記移動体の車線変更を制御する車線変更制御部と、
   前記移動体を操舵するための操作子に対する前記移動体の乗員による把持の状態を判定する把持判定部と、を備え、
   前記車線変更制御部は、
   車線変更先の対象車線の状況が前記車線変更に影響する又は影響する可能性がある所定の状況でない場合に前記移動体を前記対象車線に移動させることを開始させ、
   前記移動を開始させた後、前記対象車線の状況が前記所定の状況に変化した場合、前記移動体の位置が前記対象車線に対して所定の位置に存在し、且つ前記乗員の操作の把持の度合が第１度合以上である場合、前記移動体を前記対象車線へ車線変更させることを中止し、
   前記移動を開始させた後、前記対象車線の状況が前記所定の状況に変化した場合、前記移動体の位置が前記対象車線に対して前記所定の位置に存在し、且つ前記乗員の操作の把持の度合が前記第１度合未満である場合、前記移動体を前記対象車線へ車線変更させることを継続し、
   前記所定の状況は、前記対象車線を走行している他の移動体が所定速度以上で接近してきた状況、前記対象車線に落下物が存在している状況、又は、前記対象車線に合流する車線が存在している状況であり、
   前記所定の位置は、前記移動体とレーンマークとの間の車幅方向における距離が、第１距離閾値以上であり、且つ、前記第１距離閾値より大きい第２距離閾値未満となる位置である、移動体制御装置。
2. 請求項１に記載の移動体制御装置において、
   前記第１距離閾値は、前記移動体の速度に応じて可変される、移動体制御装置。
3. 請求項１に記載の移動体制御装置において、
   前記第２距離閾値は、前記移動体の速度に応じて可変される、移動体制御装置。
4. 請求項１に記載の移動体制御装置において、
   前記第１距離閾値は、０である、移動体制御装置。
5. 請求項１に記載の移動体制御装置を備える移動体。
6. 移動体の周辺情報に基づいて前記移動体の車線変更を車線変更制御部が制御する車線変更制御ステップと、
   前記移動体を操舵するための操作子に対する前記移動体の乗員による把持の状態を把持判定部が判定する判定ステップと、
   を有し、
   前記車線変更制御ステップでは、
   車線変更先の対象車線の状況が前記車線変更に影響する又は影響する可能性がある所定の状況でない場合に前記移動体を前記対象車線に移動させることを開始させ、
   前記移動を開始させた後、前記対象車線の状況が前記所定の状況に変化した場合、前記移動体の位置が前記対象車線に対して所定の位置に存在し、且つ前記乗員の操作の把持の度合が第１度合以上である場合、前記移動体を前記対象車線へ車線変更させることを中止し、
   前記移動を開始させた後、前記対象車線の状況が前記所定の状況に変化した場合、前記移動体の位置が前記対象車線に対して前記所定の位置に存在し、且つ前記乗員の操作の把持の度合が前記第１度合未満である場合、前記移動体を前記対象車線へ車線変更させることを継続し、
   前記所定の状況は、前記対象車線を走行している他の移動体が所定速度以上で接近してきた状況、前記対象車線に落下物が存在している状況、又は、前記対象車線に合流する車線が存在している状況であり、
   前記所定の位置は、前記移動体とレーンマークとの間の車幅方向における距離が、第１距離閾値以上であり、且つ、前記第１距離閾値より大きい第２距離閾値未満となる位置である、移動体制御方法。

Images