JP7380735B2 - 操舵制御装置 - Google Patents

Description

本開示は、操舵制御装置に関する。

従来から、例えば自動運転システムおよび運転支援システムにおいて、車両が車線内を維持するように操舵を制御する操舵制御装置が提案されている。この操舵制御装置は、操舵制御が途切れずに継続するために、車両が走行する車線情報を途切れずに検出することが求められる。

そこで、車両が走行する車線情報をできるだけ途切れずに検出する技術として、例えば、特許文献１には、走行車線の左右を区画する区画線成分の特徴量を抽出し、この特徴量から左右区画線を認識するに際し、この特徴量をデータメモリに記憶しておき、区画線が途切れて特定できなくなった場合、その後再度区画線成分の特徴量を抽出した際には、データメモリに記憶されている特徴量と比較し、途切れた後の区画線を推定することで区画線を早期に認識して運転支援を再開させることができる技術が開示されている。

特許第６６９７５２２号公報

この特許文献１の装置において、車両をスムーズに操舵することが求められている。

本開示は、車両をスムーズに操舵する操舵制御装置を提供することを目的とする。

本開示に係る操舵制御装置は、車両が走行する道路情報を検出する検出部と、車両の位置情報を取得する取得部と、道路情報に基づいて車両が走行する第１車線情報を算出すると共に、位置情報に基づいて車両が走行する第２車線情報を算出し、第１車線情報と第２車線情報を切り換えて車両の操舵を制御する制御部と、を備え、制御部は、第１車線情報から第２車線情報に切り換える場合に、第１車線情報の位置と第２車線情報の位置との差に基づいて、以降の第２車線情報の位置を第１車線情報側に変更して維持し、変更された第２車線情報に基づいて車両の操舵を制御するものである。

本開示によれば、車両をスムーズに操舵することが可能となる。

本開示の実施の形態１に係る操舵制御装置を備えた車両の構成を示す図である。 車線情報を算出する様子を示す図である。 実施の形態１の動作を示すフローチャートである。 車線情報を切り換える様子を示す図である。 第２車線情報の位置を変更する様子を示す図である。 実施の形態２に係る操舵制御装置の要部を示す図である。 実施の形態３に係る操舵制御装置の要部を示す図である。

以下、本開示に係る実施の形態を添付図面に基づいて説明する。

（実施の形態１）
図１に、本開示の実施の形態１に係る操舵制御装置を備えた車両１の構成を示す。車両１は、操舵制御装置２と、操舵部３とを有する。なお、操舵制御装置２は、例えば、自動運転システムおよび運転支援システムにおいて操舵を制御することができる。また、車両１としては、例えば、乗用車、トラック、バスおよびバンなどが挙げられる。

操舵制御装置２は、検出部４と、取得部５と、制御部６とを有する。

検出部４は、車両１が走行する道路情報を検出するもので、例えばカメラおよびＬｉＤＡＲなど、道路情報を直接的に検出する装置から構成することができる。検出部４は、例えば、車両１の前方の道路情報を検出するように車両１の前部に配置することができる。ここで、道路情報は、車線を示す情報、例えば、道路に引かれた区切り線（白線）、路肩および路側帯などの情報を含んでもよい。

取得部５は、車両１の位置情報を取得するもので、例えば衛星測位システム（例えば、ＧＮＳＳ（Ｇｌｏｂａｌ Ｎａｖｉｇａｔｉｏｎ Ｓａｔｅｌｌｉｔｅ Ｓｙｓｔｅｍ））、路車間通信部、道路特徴検出部（例えば、ＬｉＤＡＲ、カメラ）などから構成することができる。ここで、衛星測位システムは、衛星を用いて測定された車両１の位置情報を直接的に取得するシステムである。また、路車間通信部は、道路に設置された通信装置から位置情報を直接的に取得する装置である。また、道路特徴検出部は、地図情報から車両１の位置を特定するための道路の特徴情報、例えば道路の周囲に存在する建物、道路構造物および道路標識などの情報を検出する。これにより、検出された道路の特徴情報を、地図情報に含まれる特徴情報と照合させることで、車両１の位置を特定することができる。すなわち、位置情報は、車両１の位置を直接的に示す情報だけでなく、車両１の位置を特定するための情報も含むものである。

制御部６は、車線情報算出部７と、判定部８と、自車位置算出部９と、記憶部１０と、切換部１１と、操舵量算出部１２と、操舵制御部１３とを有する。

車線情報算出部７は、検出部４で検出された道路情報に基づいて、車両１が走行する第１車線情報を算出する。例えば、車線情報算出部７は、図２に示すように、車両１が走行する車線Ｌの左右の区切り線（白線）の位置および方向などの情報を算出する。続いて、車線情報算出部７は、区切り線の情報に基づいて、例えば車線Ｌの中央を通るように目標走行ラインＬａを算出する。そして、車線情報算出部７は、目標走行ラインＬａに基づいて、横偏差Ｙ、方位角θおよび半径Ｒなどを算出する。このように、第１車線情報は、例えば、目標走行ラインＬａ、横偏差Ｙ、方位角θおよび半径Ｒなどを含むことができる。なお、横偏差Ｙは、例えば、目標走行ラインＬａに対する車両１の横偏差を算出してもよい。また、方位角θは、目標走行ラインＬａの接線に対する車両１の角度を算出してもよい。また、半径Ｒは、目標走行ラインＬａの曲線半径を算出してもよい。

判定部８は、検出部４で検出された道路情報の検出レベルが第１閾値以下か否かを判定する。ここで、第１閾値は、例えば、車両１の操舵の安定性に基づいて設定することができる。

記憶部１０は、車両１が走行する道路を含む地図情報を記憶する。地図情報は、例えば、道路に設けられた車線の位置および方向などの情報を含んでもよい。例えば、地図情報は、車線Ｌの中央を通る目標走行ラインＬａおよび半径Ｒなどの情報を含んでもよい。また、地図情報は、道路特徴検出部で検出される道路の特徴情報を含んでもよい。

自車位置算出部９は、取得部５で取得された車両１の位置情報に基づいて、車線Ｌに対する車両１の位置を算出する。例えば、自車位置算出部９は、車両１の位置情報に基づいて記憶部１０に記憶された地図情報を参照し、車両１が走行する車線Ｌを特定する。そして、自車位置算出部９は、特定された車線Ｌの目標走行ラインＬａおよび半径Ｒを地図情報から取得すると共に、車両１の位置情報に基づいて車線Ｌに対する車両１の位置を算出する。そして、自車位置算出部９は、目標走行ラインＬａに基づいて横偏差Ｙおよび方位角θなどを算出する。このとき、自車位置算出部９は、直前の車両１の位置（例えば１つ前の車両１の情報）に基づいて車両１の向き（姿勢）を算出し、その車両１の向きに基づいて横偏差Ｙおよび方位角θを算出してもよい。このようにして、目標走行ラインＬａ、横偏差Ｙ、方位角θおよび半径Ｒなどの第２車線情報が、車両１の位置情報に基づいて算出される。

切換部１１は、所定の条件に基づいて、操舵量算出部１２に出力する車線情報を切り換える。例えば、切換部１１は、判定部８の判定結果に基づいて、操舵量算出部１２に出力する車線情報を切り換えてもよい。例えば、切換部１１は、判定部８において道路情報の検出レベルが第１閾値を超えていると判定された場合には、車線情報算出部７で算出された第１車線情報を操舵量算出部１２に出力してもよい。また、切換部１１は、判定部８において道路情報の検出レベルが第１閾値以下と判定された場合には、自車位置算出部９で算出された第２車線情報を操舵量算出部１２に出力してもよい。

操舵量算出部１２は、切換部１１から出力される第１車線情報に基づいて、車両１の操舵量を算出する。ここで、操舵量算出部１２は、切換部１１において第１車線情報から第２車線情報に切り換えられた場合には、第２車線情報に基づいて、車両１の操舵量を算出する。このように、操舵量算出部１２は、第１車線情報と第２車線情報を切り換えて車両１の操舵量を算出する。
なお、操舵量としては、例えば、目標操舵角および目標操舵トルクなどが挙げられる。

操舵制御部１３は、操舵量算出部１２で算出される操舵量に基づいて操舵部３を制御する。操舵制御部１３は、例えば、操舵量に応じた電流または電圧を操舵部３に出力することで、操舵部３を制御することができる。

操舵部３は、車輪の角度を変更して車両１を操舵するもので、例えばモータおよびアクチュエータなどから構成される。操舵部３は、例えば、操舵制御部１３から出力される電流または電圧に応じた角度だけ車輪の向きを変更する。

次に、本実施の形態の動作について、図３のフローチャートを参照して説明する。

まず、検出部４が、ステップＳ１で、車両１の走行に応じて道路情報を順次検出する。検出部４は、例えば、車両１の前方を撮影するカメラから構成され、道路情報を含む画像を生成することで道路情報を検出する。検出部４は、道路情報を含む画像を車線情報算出部７に出力する。
また、取得部５が、車両１の位置情報を取得する。取得部５は、例えば、衛星測位システムから車両１の位置情報を取得するように構成され、車両１の走行に応じて変化する位置情報を順次取得する。取得部５は、取得した位置情報を自車位置算出部９に出力する。

車線情報算出部７は、検出部４で検出された画像を入力すると、ステップＳ２で、その画像から、車両１が走行する第１車線情報を算出する。例えば図２に示すように、車線情報算出部７は、画像から区切り線などの道路情報を抽出し、その抽出された道路情報から車両１が走行する車線Ｌの位置および方向などの情報を算出する。そして、車線情報算出部７は、車線Ｌの情報に基づいて目標走行ラインＬａを算出し、その目標走行ラインＬａに基づいて横偏差Ｙ、方位角θおよび半径Ｒなどを算出する。このようにして、車線情報算出部７は、目標走行ラインＬａ、横偏差Ｙ、方位角θおよび半径Ｒなどの第１車線情報を算出すると、その第１車線情報を切換部１１に出力する。また、車線情報算出部７は、検出部４で検出された画像の情報、例えば第１車線情報などを判定部８に出力する。

続いて、判定部８が、検出部４で検出された画像の情報に基づいて、道路情報の検出レベルが第１閾値以下か否かを判定する。ここで、第１車線情報の値は、検出レベルの低下に応じてぶれが大きくなる傾向を有する。例えば、区切り線に基づいて車線Ｌを示す関数を算出する場合に、検出レベルの低下に応じて区切り線の検出数が低下するため、車線Ｌの関数のぶれが大きくなる。そこで、判定部８は、例えば車線情報算出部７で算出された第１車線情報のぶれに基づいて、道路情報の検出レベルを判定してもよい。判定部８は、検出レベルの判定結果を切換部１１に出力する。

一方、自車位置算出部９は、取得部５で取得された車両１の位置情報を入力すると、その位置情報に基づいて記憶部１０に記憶された地図情報を参照し、車両１が走行する車線Ｌを特定する。そして、自車位置算出部９は、特定された車線Ｌの目標走行ラインＬａおよび半径Ｒを地図情報から取得し、その取得情報に基づいて車両１が走行する第２車線情報を算出する。例えば、自車位置算出部９は、車両１の位置と目標走行ラインＬａとに基づいて、横偏差Ｙおよび方位角θなどを算出する。このようにして、自車位置算出部９は、車両１の位置、目標走行ラインＬａ、横偏差Ｙ、方位角θおよび半径Ｒなどの第２車線情報を算出すると、その第２車線情報を切換部１１に出力する。

このようにして、切換部１１には、第１車線情報、第２車線情報、および検出レベルの判定結果が順次入力されることになる。そして、切換部１１は、所定の条件に基づいて、操舵量算出部１２に出力する車線情報を切り換える。例えば、切換部１１は、ステップＳ３で、判定部８の判定結果を参照し、道路情報の検出レベルが第１閾値を超えているとの判定結果（第１信号）である場合には、ステップＳ４に進んで、第１車線情報を操舵量算出部１２に出力する。

これにより、操舵量算出部１２は、切換部１１から入力された第１車線情報に基づいて操舵量を算出する。例えば、操舵量算出部１２は、現在の操舵角に対する目標操舵角、すなわち目標走行ラインＬａを維持するための操舵角を操舵量として算出することができる。操舵量算出部１２は、算出された操舵量を操舵制御部１３に出力する。

続いて、操舵制御部１３が、操舵量算出部１２で算出された操舵量に基づいて操舵部３を制御する。これにより、車両１は、目標走行ラインＬａに沿って走行するように操舵されることになる。

ここで、検出部４における道路情報の検出レベルが低下する場合が考えられる。例えば、摩耗などによる車線Ｌの区切り線の部分的な除去、路面の濡れによる区切り線の不検出、雪による区切り線の隠れなどが生じた場合に、道路情報の検出レベルが低下するおそれがある。

そこで、切換部１１は、ステップＳ３において、道路情報の検出レベルが第１閾値以下との判定結果（第２信号）である場合には、ステップＳ５に進んで、第２車線情報を操舵量算出部１２に出力する。

これにより、操舵量算出部１２は、第１車線情報から第２車線情報に切り換えて車両１の操舵量を算出する。このとき、操舵量算出部１２は、第２車線情報の位置を第１車線情報の位置との差に基づいて変更し、その変更された第２車線情報に基づいて車両１の操舵量を算出する。

例えば、図４に示すように、第１車線情報の目標走行ラインＬ１と第２車線情報の目標走行ラインＬ２との位置が車線Ｌの車幅方向にずれている場合を考える。制御部６が、目標走行ラインＬ１に基づいて横偏差Ｙ、方位角θおよび半径Ｒを算出し、この横偏差Ｙ、方位角θおよび半径Ｒに基づいて操舵を制御、すなわち第１車線情報に基づいて操舵を制御しているものとする。このとき、時刻ｔ１において第１信号から第２信号に切り換えられた場合（道路情報の検出レベルが所定の閾値以下と判定された場合）に、例えば目標走行ラインＬ１から目標走行ラインＬ２にそのまま切り換えると、目標走行ラインの位置がステップ状に大きく変化することになる。このため、目標走行ラインＬ２に基づいて算出される車両１の操舵量もまた大きく変化するおそれがある。特に、車線情報を微分した値に基づいて車両１の操舵量を算出する場合、操舵量が急激に変化するおそれがある。

そこで、制御部６は、第２車線情報の位置を第１車線情報の位置との差に基づいて変更し、その変更された第２車線情報に基づいて車両の操舵を制御する。

例えば、図５に示すように、操舵量算出部１２は、時刻ｔ１において第１信号から第２信号に切り換えられると、目標走行ラインＬ１と目標走行ラインＬ２との位置の差を算出する。そして、操舵量算出部１２は、算出された差の値だけ、目標走行ラインＬ２の位置を目標走行ラインＬ１側に移すように変更する。すなわち、操舵量算出部１２は、算出された差の値を目標走行ラインＬ２に順次足し合わせることで目標走行ラインＬ２の位置を変更する。これにより、目標走行ラインＬ１から目標走行ラインＬ２が連続して繋がる目標走行ラインＬ３が生成されることになる。
また、操舵量算出部１２は、横偏差Ｙ、方位角θおよび半径Ｒなどの他の第２車線情報についても、第１車線情報と第２車線情報との位置の差に基づいて変更することができる。続いて、操舵量算出部１２は、算出された横偏差Ｙ、方位角θおよび半径Ｒに基づいて操舵量を算出する。そして、操舵制御部１３が、操舵量算出部１２で算出された操舵量に基づいて操舵部３を制御する。

このように、制御部６は、第１車線情報から第２車線情報に切り換える場合に、第２車線情報の位置を第１車線情報の位置との差に基づいて変更し、その変更された第２車線情報に基づいて車両１の操舵を制御する。これにより、第１車線情報から第２車線情報への切り換えに応じた操舵量の変化を抑制することができ、車両１をスムーズに操舵することができる。

また、制御部６は、第２車線情報の位置を差の値だけ第１車線情報側に移すように変更する。これにより、車両１をよりスムーズに操舵することができる。

このようにして、制御部６は、時刻ｔ１において第１車線情報から第２車線情報に切り換えると、時刻ｔ１以降の操舵量は、その差の値に基づいて第２車線情報の位置を順次変更しつつ算出し、算出された操舵量に基づいて車両１の操舵を制御する。

本実施の形態によれば、制御部６は、第１車線情報から第２車線情報に切り換える場合に、第２車線情報の位置を第１車線情報の位置との差に基づいて変更し、その変更された第２車線情報に基づいて第１車線情報から第２車線情報に切り換えて車両１の操舵を制御する。これにより、第１車線情報から第２車線情報への切り換えに応じた操舵量の変化を抑制することができ、車両１をスムーズに操舵することができる。

（実施の形態２）
以下、本開示の実施の形態２について説明する。ここでは、上記の実施の形態１との相違点を中心に説明し、上記の実施の形態１との共通点については、共通の参照符号を使用して、その詳細な説明を省略する。

上記の実施の形態１において、制御部６は、取得部５で取得される位置情報の精度に基づいて第１車線情報から第２車線情報に切り換えて車両１の操舵を制御してもよい。

例えば、図６に示すように、実施の形態１の自車位置算出部９に判定部２３を新たに接続してもよい。

判定部２３は、取得部５で取得される位置情報の精度が第２閾値を超えているか否かを判定する。ここで、第２閾値は、例えば、車両１の操舵の安定性に基づいて設定することができる。

切換部１１は、判定部８および２３の判定結果に基づいて、操舵量算出部１２に出力する車線情報を切り換える。具体的には、切換部１１は、判定部８において道路情報の検出レベルが第１閾値を超えていると判定された場合には、車線情報算出部７で算出された第１車線情報を操舵量算出部１２に出力する。また、切換部１１は、判定部８において道路情報の検出レベルが第１閾値以下で且つ判定部２３において位置情報の精度が第２閾値を超えていると判定された場合には、自車位置算出部９で算出された第２車線情報を操舵量算出部１２に出力する。また、切換部１１は、判定部８において道路情報の検出レベルが第１閾値以下で且つ判定部２３において位置情報の精度が第２閾値以下と判定された場合には、第１車線情報および第２車線情報の出力を停止し、車両１の操舵を手動に切り換えることを指示する手動指示を操舵量算出部１２に出力する。

次に、本実施の形態の動作について説明する。

まず、実施の形態１と同様に、車線情報算出部７が、検出部４で検出された道路情報に基づいて第１車線情報を算出し、その第１車線情報を、切換部１１に出力する。
また、自車位置算出部９が、取得部５で取得された車両１の位置情報に基づいて第２車線情報を算出し、その第２車線情報を切換部１１に出力する。ここで、自車位置算出部９は、取得部５で取得された位置情報の精度を示す情報、例えば衛星測位システムにおいて位置情報を取得した衛星の数、道路特徴検出部で検出された道路の特徴情報と地図情報の特徴情報との一致数などを判定部２３に出力する。

続いて、判定部２３は、取得部５で取得された位置情報の精度が第２閾値以下か否かを判定する。例えば、判定部２３は、位置情報を取得する衛星の数が所定数以上か否かに基づいて、取得部５の位置情報の精度を判定することができる。また、判定部２３は、道路の特徴情報と地図情報に含まれる特徴情報との一致数が所定数以上か否かに基づいて、取得部５の位置情報の精度を判定することができる。判定部２３は、位置情報の精度の判定結果を切換部１１に出力する。

このようにして、切換部１１には、第１車線情報、第２車線情報、検出レベルの判定結果、および位置情報の精度の判定結果が順次入力されることになる。切換部１１は、判定部８において道路情報の検出レベルが第１閾値を超えていると判定された場合には、実施の形態１と同様に、第１車線情報を操舵量算出部１２に出力する。
これにより、操舵量算出部１２が、第１車線情報に基づいて操舵量を算出し、操舵制御部１３が、操舵量算出部１２で算出された操舵量に基づいて操舵部３を制御する。

また、切換部１１は、判定部８において道路情報の検出レベルが第１閾値以下と判定され、且つ、判定部２３において位置情報の精度が第２閾値を超えていると判定された場合には、第２車線情報を操舵量算出部１２に出力する。

これにより、操舵量算出部１２が、第１車線情報から第２車線情報に切り換えて車両１の操舵量を算出する。このとき、操舵量算出部１２は、第２車線情報の位置を第１車線情報の位置との差に基づいて変更し、その変更された第２車線情報に基づいて車両１の操舵量を算出する。そして、操舵制御部１３が、操舵量算出部１２で算出された操舵量に基づいて操舵部３を制御する。

このように、制御部６は、道路情報の検出レベルが第１閾値以下で且つ位置情報の精度が第２閾値を超えている場合に、第１車線情報から第２車線情報に切り換えて車両１の操舵を制御する。これにより、第１車線情報から第２車線情報への切り換えに応じた操舵量の変化を適切に抑制することができ、車両１をよりスムーズに操舵することができる。

また、切換部１１は、判定部８において道路情報の検出レベルが第１閾値以下と判定され、且つ、判定部２３において位置情報の精度が第２閾値以下と判定された場合には、車両１の操舵を手動に切り換えることを指示する手動指示を操舵量算出部１２に出力する。

操舵量算出部１２は、切換部１１から手動指示が出力された場合には、車両１の操舵量を算出することなく、操舵部３の制御の抑制または停止を指示する抑制信号を操舵制御部１３に出力する。そして、操舵制御部１３が、操舵量算出部１２からの抑制信号に応じて、操舵部３の制御を抑制または停止し、車両１の操舵を手動に切り換える。

このように、制御部６は、道路情報の検出レベルが第１閾値以下で且つ取得部５で取得される位置情報の精度が第２閾値以下の場合に、車両１の操舵を手動に切り換える。これにより、操舵制御装置２による操舵の制御が困難な場合には、運転者により車両１が操舵されるため、車両１を安全に走行させることができる。

本実施の形態によれば、制御部６は、道路情報の検出レベルが第１閾値以下で且つ位置情報の精度が第２閾値を超えている場合に、第１車線情報から第２車線情報に切り換える。これにより、第１車線情報から第２車線情報への切り換えに応じた操舵量の変化を適切に抑制することができ、車両１をよりスムーズに操舵することができる。

（実施の形態３）
以下、本開示の実施の形態３について説明する。ここでは、上記の実施の形態１および２との相違点を中心に説明し、上記の実施の形態１および２との共通点については、共通の参照符号を使用して、その詳細な説明を省略する。

上記の実施の形態１および２において、操舵制御装置２は、複数の取得部を配置してもよい。

例えば、図７に示すように、実施の形態２の取得部５に換えて２つの取得部３１および３２を配置してもよい。

取得部３１と取得部３２は、互いに種類の異なる位置情報を取得する。
取得部３１は、例えば、衛星を用いて測定された車両１の位置情報を取得してもよい。取得部３１は、例えば、ＧＮＳＳ（Ｇｌｏｂａｌ Ｎａｖｉｇａｔｉｏｎ Ｓａｔｅｌｌｉｔｅ Ｓｙｓｔｅｍ）などの衛星測位システムから構成することができる。

また、取得部３２は、車両１の位置を特定するための道路の特徴情報、例えば道路の周囲に存在する建物、道路構造物および道路標識などの情報を位置情報として検出してもよい。取得部３２は、例えば、ＬｉＤＡＲおよびカメラなどの道路特徴検出部から構成することができる。

自車位置算出部９は、取得部３１で取得された車両１の位置情報に基づいて地図情報を参照し、第２車線情報を算出する。また、自車位置算出部９は、取得部３２で取得された道路の特徴情報を、地図情報に含まれる特徴情報と照合することで車両１の位置を特定し、その車両１の位置に基づいて第２車線情報を算出する。

判定部２３は、取得部３１および３２で取得される位置情報の精度がそれぞれ第２閾値を超えているか否かを判定する。また、判定部２３は、取得部３１および３２で取得された２つの位置情報のうち、車両１の位置を示す精度が高い特定の位置情報を判定する。判定部２３は、例えば、最も位置精度が高い特定の位置情報を判定してもよい。

次に、本実施の形態の動作について説明する。

まず、実施の形態２と同様に、車線情報算出部７が、検出部４で検出された道路情報に基づいて第１車線情報を算出し、その第１車線情報を切換部１１に出力する。
一方、取得部３１が衛星測位システムで測定された車両１の位置情報を取得し、取得部３２が道路の特徴情報からなる車両１の位置情報を取得する。取得部３１および３２は、それぞれ、取得した車両１の位置情報を自車位置算出部９に出力する。そして、自車位置算出部９が、取得部３１から出力された車両１の位置情報に基づいて第２車線情報を算出すると共に、取得部３２で取得された車両１の位置情報に基づいて第２車線情報を算出する。

自車位置算出部９は、算出した第２車線情報を切換部１１に出力する。また、自車位置算出部９は、取得部３１および３２で取得された位置情報の精度を示す情報、例えば取得部３１で位置情報を取得した衛星の数、取得部３２で取得された道路の特徴情報と地図情報の特徴情報との一致数などを判定部２３に出力する。

判定部２３は、取得部３１および３２で取得された２つの位置情報のうち、車両１の位置精度が高い特定の位置情報を判定する。例えば、判定部２３は、位置情報を取得する衛星の数が所定数以上か否かに基づいて、取得部３１の位置精度を判定することができる。また、判定部２３は、道路の特徴情報と地図情報に含まれる特徴情報との一致数が所定数以上か否かに基づいて、取得部３２の位置精度を判定することができる。
ここで、判定部２３は、取得部３１で取得される位置情報が取得部３２で取得される位置情報より車両１の位置精度が高いと判定したものとする。判定部２３は、判定結果を切換部１１に出力する。

このようにして、切換部１１には、第１車線情報、第２車線情報、検出レベルの判定結果、および位置情報の精度の判定結果などが順次入力される。そして、切換部１１は、自車位置算出部９で算出された２つの第２車線情報のうち、判定部２３で位置精度が高いと判定された第２車線情報、すなわち取得部３１の位置情報に基づいて算出された第２車線情報を選択する。そして、切換部１１は、選択された第２車線情報を操舵量算出部１２に出力する。

このように、切換部１１が、取得部３１および３２で取得された２つの位置情報のうち、車両１の位置精度が高い特定の位置情報に基づいて算出された第２車線情報を選択する。これにより、位置精度が高い第２車線情報に基づいて操舵量が算出されるため、車両１を高精度に操舵することができる。

本実施の形態によれば、制御部６が、取得部３１および３２で取得された２つの位置情報のうち、車両１の位置精度が他の位置情報より高い特定の位置情報に基づいて第２車線情報を算出する。これにより、第２車線情報に基づいて車両１を高精度に操舵することができる。

以上、本開示に係る実施の形態について図面を参照して詳述してきたが、上述した各装置の機能は、コンピュータプログラムにより実現することができる。

上述した各装置の機能をプログラムにより実現するコンピュータは、キーボードやマウス、タッチパッドなどの入力装置、ディスプレイやスピーカなどの出力装置、ＣＰＵ（Ｃｅｎｔｒａｌ Ｐｒｏｃｅｓｓｉｎｇ Ｕｎｉｔ）、ＲＯＭ（Ｒｅａｄ Ｏｎｌｙ Ｍｅｍｏｒｙ）、ＲＡＭ（Ｒａｎｄｏｍ Ａｃｃｅｓｓ Ｍｅｍｏｒｙ）、ハードディスク装置やＳＳＤ（Ｓｏｌｉｄ Ｓｔａｔｅ Ｄｒｉｖｅ）などの記憶装置、ＤＶＤ－ＲＯＭ（Ｄｉｇｉｔａｌ Ｖｅｒｓａｔｉｌｅ Ｄｉｓｋ Ｒｅａｄ Ｏｎｌｙ Ｍｅｍｏｒｙ）やＵＳＢ（Ｕｎｉｖｅｒｓａｌ Ｓｅｒｉａｌ Ｂｕｓ）メモリなどの記録媒体から情報を読み取る読取装置、ネットワークを介して通信を行うネットワークカードなどを備え、各部はバスにより接続される。

そして、読取装置は、上記各装置の機能を実現するためのプログラムを記録した記録媒体からそのプログラムを読み取り、記憶装置に記憶させる。あるいは、ネットワークカードが、ネットワークに接続されたサーバ装置と通信を行い、サーバ装置からダウンロードした上記各装置の機能を実現するためのプログラムを記憶装置に記憶させる。

そして、ＣＰＵが、記憶装置に記憶されたプログラムをＲＡＭにコピーし、そのプログラムに含まれる命令をＲＡＭから順次読み出して実行することにより、上記各装置の機能が実現される。

以上、本開示の具体例を詳細に説明したが、これらは例示にすぎず、請求の範囲を限定するものではない。請求の範囲に記載の技術には、以上に例示した具体例を様々に変形、変更したものが含まれる。

本開示に係る操舵制御装置は、車両の操舵を制御する装置に利用できる。

１ 車両
２ 操舵制御装置
３ 操舵部
４ 検出部
５，３１，３２ 取得部
６ 制御部
７ 車線情報算出部
８ 判定部
９ 自車位置算出部
１０ 記憶部
１１ 切換部
１２ 操舵量算出部
１３ 操舵制御部
２３ 判定部
Ｌ 車線
Ｌａ，Ｌ１，Ｌ２，Ｌ３ 目標走行ライン
Ｒ 半径
ｔ１ 時刻
Ｙ 横偏差
θ 方位角

Claims (7)

1. 車両が走行する道路情報を検出する検出部と、
   前記車両の位置情報を取得する取得部と、
   前記道路情報に基づいて前記車両が走行する第１車線情報を算出すると共に、前記位置情報に基づいて前記車両が走行する第２車線情報を算出し、前記第１車線情報と前記第２車線情報を切り換えて前記車両の操舵を制御する制御部と、
   を備え、
   前記制御部は、前記第１車線情報から前記第２車線情報に切り換える場合に、前記第１車線情報の位置と前記第２車線情報の位置との差に基づいて、以降の前記第２車線情報の位置を前記第１車線情報側に変更して維持し、変更された第２車線情報に基づいて前記車両の操舵を制御する操舵制御装置。
2. 前記検出部は、前記道路情報を撮影するカメラを含み、
   前記取得部は、衛星測位システムから前記位置情報を取得する請求項１に記載の操舵制御装置。
3. 前記制御部は、前記第２車線情報の位置を前記差の値だけ前記第１車線情報側に移すように変更する請求項１または２に記載の操舵制御装置。
4. 前記制御部は、前記検出部で検出される前記道路情報の検出レベルが第１閾値以下の場合に、前記第１車線情報から前記第２車線情報に切り換える請求項１～３のいずれか一項に記載の操舵制御装置。
5. 前記制御部は、前記検出部で検出される前記道路情報の検出レベルが第１閾値以下で且つ前記取得部で取得される前記位置情報の精度が第２閾値を超えている場合に、前記第１車線情報から前記第２車線情報に切り換える請求項４に記載の操舵制御装置。
6. 前記制御部は、前記道路情報の検出レベルが第１閾値以下で且つ前記取得部で取得される前記位置情報の精度が第２閾値以下の場合に、前記車両の操舵を手動に切り換える請求項４または５に記載の操舵制御装置。
7. 前記取得部は、種類の異なる複数の位置情報を取得し、
   前記制御部は、前記複数の位置情報のうち、前記車両の位置の検出レベルが他の位置情報より高い特定の位置情報に基づいて前記第２車線情報を算出する請求項１～６のいずれか一項に記載の操舵制御装置。