JP4595258B2 - 自動操舵装置 - Google Patents
自動操舵装置 Download PDFInfo
- Publication number
- JP4595258B2 JP4595258B2 JP2001202110A JP2001202110A JP4595258B2 JP 4595258 B2 JP4595258 B2 JP 4595258B2 JP 2001202110 A JP2001202110 A JP 2001202110A JP 2001202110 A JP2001202110 A JP 2001202110A JP 4595258 B2 JP4595258 B2 JP 4595258B2
- Authority
- JP
- Japan
- Prior art keywords
- lane
- detection unit
- marker
- marker row
- line
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Landscapes
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Traffic Control Systems (AREA)
Description
【０００１】
【発明の属する技術分野】
本発明は自動操舵装置に関し、特に車両が車線内保持走行を行うための自動操舵装置に関するものである。
【０００２】
【従来の技術】
自動操舵装置は、自車が走行する車線を検出する車線検出部、自動操舵に必要な情報を算出する演算部、この演算部の情報に基づいて操舵輪を制御する操舵アクチュエータによって構成され、操舵アクチュエータからステアリングを制御することにより車両の自動操舵を実現している。
【０００３】
車線検出部としては、▲１▼区分車線をカメラ等を用いて視覚的に検出する車線区分線検出部、▲２▼車線内に磁石や電波発信機から成るマーカー列を敷設し、このマーカー列を磁気センサや電波アンテナで検出するマーカー列検出部、などが一般的に知られている。
【０００４】
動作において、演算部は、車線検出部によって検出された車線区分線と車両との相対位置（例えば、車線幅中央位置、区分車線位置又は車両基準位置）を求めると共に目標車線内位置を決定する。操舵アクチュエータは、この目標車線内位置に基づき、運転者に代わって操舵輪を操舵する。
【０００５】
通常は、車線内の中央を走行することが望ましいと考えられるので、上記の車線区分線検出部▲１▼の場合には車線幅の中央を自動操舵の目標車線内位置として制御を行い、また、上記のマーカー列検出部▲２▼の場合には、目標車線内位置としてマーカー列が車線幅の中央に敷設されており、自動操舵装置は該マーカーを目標車線内位置として制御を行っている。
【０００６】
【発明が解決しようとする課題】
車線区分線検出部▲１▼により検出する場合には、検出対象となる車線区分線はすでに整備されているため、自動操舵のために道路に対する新たな開発や整備を行わなくて済む反面、車両にカメラなどを設置する際に光軸を調整する必要があり、設計上想定した光軸にカメラ光軸を合致させないと左右方向の位置検出などに誤差を生じてしまうという問題点がある。
【０００７】
一方、マーカー列検出部▲２▼の場合には、磁石や電波発信機という視覚的でない方法でマーカー列を検出しているため積雪など気象条件に関わらず高い精度でマーカー列を検出ができる反面、マーカー列のインフラは現状では少ないため新たに設置が必要とされ、実用性に乏しいという欠点がある。
【０００８】
すなわち、車両の車線内位置を検出する上ではマーカー列を検出する方が精度が高いが、現状ではそのインフラが整っていないためマーカー列検出部のみによる自動操舵装置は実用性が低い。
その一方で、車線区分線検出部を利用する場合には検出精度は落ちるが既存の車線区分線を利用することができるため検出精度を上げることができれば高い実用性を発揮することができる。
【０００９】
そこで本発明に係る自動操舵装置は、マーカー列が検出できない状態が発生しても、車線区分線を利用して高い精度で車線内保持走行が実現できるようにすることを課題とする。
【００１０】
【課題を解決する手段】
上記の目的を解決するため、本発明に係る自動操舵装置は、図1に原理的に示すように、車線区分線を検出する車線区分線検出部1と、走行路上のマーカー列を検出するマーカー列検出部2と、該車線区分線または該マーカー列から目標車線内位置を求める演算部3と、該目標車線内位置に基づいて操舵制御を行うアクチュエータ4と、を備えた自動操舵装置において、該演算部3は、該マーカー列及び車線区分線が検出されているときには、該マーカー列に基づいて算出される第２車線内位置を該目標車線内位置とすると共に、該車線区分線から算出される第１車線内位置と前記第２車線内位置との偏差から補正値を算出し、該車線区分線が検出されており該マーカー列が検出されていないときには、該車線区分線から算出された該第１車線内位置と前記補正値とから該目標車線内位置を求めることを特徴としている。
【００１１】
すなわち本発明においては、車線区分線検出部1が車線区分線を検出し、マーカー列検出部2が走行路上のマーカー列を検出する。そして演算部3は、該車線区分線から第1車線内位置を算出し該マーカー列から第2車線内位置を算出して目標車線内位置とする。
【００１２】
そしてさらに、演算部3は、両車線内位置の偏差から補正値を算出して記憶しておき、車線区分線は検出されたが該マーカー列が検出されなかったときに該補正値に基づき第1車線内位置を補正する。このようにして、精度の高いマーカー列により得られた第2車線内位置に基づいて第1車線内位置のずれを補正しておくことにより、マーカー列が敷設されていない走行路において、例えば車線区分検出部にカメラが用いられていて且つその光軸がずれているような場合でも、第1車線内位置をより正確な値にすることができるため、より精度の高い自動操舵を実現することができる。
【００１４】
【発明の実施の形態】
図2は、図1に原理的に示された本発明に係る自動操舵装置の一実施例の構成図を示したものである。この実施例において、演算部3は、車線区分線検出部1からの装置故障信号を含む車線情報、マーカー列検出部2からの装置故障信号を含む車線情報、制御ON/OFFスイッチ5からの自動操舵制御ON/OFF信号及び選択スイッチ6からの選択スイッチ信号を読み込む入力部11と、この入力部11からの出力信号を用いて自動操舵制御に関する演算処理を行うCPU12と、演算処理でCPU12が使用するRAM13と、制御プログラムや制御パラメータを格納しておくROM14と、CPU12で演算された出力データに従って操舵アクチュエータ4を駆動する出力部15と、車両電源からこれらの各部に必要な電源を供給するための電源部16とで構成されている。
【００１５】
ここで、車線区分線検出部1は、車線区分線を視覚的に検出するカメラと画像処理装置との組み合わせで構成され、自車を基準として検出した車線の相対位置に関する情報と装置故障の有無に関する情報を出力するものである。
マーカー列検出部2は、道路に敷設されたマーカー列を検出するレーンマーカー・センサーと信号処理装置との組み合わせにより構成され、自車を基準として検出された車線、すなわちマーカー列の相対位置に関する情報と、装置故障の有無に関する情報を出力する。
【００１６】
操舵アクチュエータ4は、出力部15からの出力によりステアリング（図示せず）を介して車両の操舵輪を自動的に作動させるものである。
制御ON/OFFスイッチ5は、運転者の操作に従い自動操舵制御の開始及び解除を切り替えるためのスイッチである。
【００１７】
選択スイッチ6は、運転者の操作に従い、車線区分線検出部1とマーカー列検出部2のどちらを自動操舵制御に用いるかを選択して切り替えるスイッチである。なお、スイッチ5及び6は本発明に不可欠な構成ではない。
図3は、図2に示した演算部1におけるROM14に格納されている制御プログラムの流れを示したものであり、以下、図3を参照して図2の実施例の動作を説明する。
【００１８】
なお、このフローチャートは所定時間間隔で開始されるものとし、制御装置の制御に係る部分のみを記述しているが、CPU12などのハードウェア起動時の初期処理などは省略されている。
また、本フローチャート内で使用する位置は、全て自車左右方向中心線を0として、車両右側を＋、車両左側を−として表現するものとする。車線区分検出部1及びマーカー列検出部2も、自車左右方向中心線を0として車線情報を表現しているものとする。
【００１９】
まずCPU12は、入力部11を介して入力信号を読み込む。読み込まれる入力信号は、制御ON/OFFスイッチ5からの自動操舵制御ON/OFF信号、車線区分線検出部1からの装置故障信号を含む車線情報、マーカー列検出部2からの装置故障信号を含む車線情報、及び選択スイッチ6からの選択スイッチ信号である（ステップS1）。
【００２０】
次に、CPU12は、ステップS1で読み込んだ制御ON/OFF信号により、制御スイッチ5のON/OFFを確認する（同S2）。制御ON/OFFスイッチ5がOFFである場合、自動操舵制御を行わないため、操舵アクチュエータ4を操舵無制御（同S3）として処理を終了する。
【００２１】
ステップS2において制御ON/OFFスイッチ5がONであると判定した場合、CPU12は、ステップS1で読み込んだマーカー列検出部2の故障有無信号をチェックする（同S4）。
マーカー列検出部2が故障の場合には、車線区分線検出部1の故障有無信号をチェックし（同S13）、車線区分線検出部1も故障の場合には、操舵アクチュエータ4を無制御として終了する（同S3）。
【００２２】
車線区分線検出部1が正常の場合には、CPU12は、ステップS1で読み込んだ車線区分線検出部1からの出力信号により車線区分線の有無をチェックする（同S14）。車線区分線が無いと判定した場合は、操舵アクチュエータ4を無制御として終了する（同S3）。
【００２３】
ステップS4において、マーカー列検出部2が正常の場合には、CPU12は、走行路のマーカー列の有無をマーカー列検出部2からの出力信号によりチェックする（同S5）。ステップS5において、CPU12がマーカー列が無いと判定した場合は、ステップS13に進む。
【００２４】
ステップS5において、マーカー列が有ると判定した場合は、CPU12はステップS1で読み込んだ選択スイッチ信号をチェックする。「車線区分線検出」が選択されている場合はステップS13へ進み、「マーカー列検出」が選択されている場合はステップS7の処理を行う（同S6）。
【００２５】
CPU12は、マーカー列検出部2からのマーカー列位置を車線幅中央位置（第2車線内位置）としてRAM13に記憶する（同S7）。
次に、CPU12は、車線区分線検出部1の故障有無信号をチェックし、車線区分線検出部1が故障と判定された場合はステップS12へ進む（同S8）。
【００２６】
車線区分線検出部1が正常であると判定された場合、CPU12は車線区分線検出部1からの出力信号により車線区分線の有無を判定する。車線区分線が無いと判定された場合は、ステップS12へ進む（同S9）。
車線区分線が有ると判定された場合は、CPU12は車線区分線検出部1からの車線情報に含まれる左側車線区分線と右側車線区分線の中央を車線幅中央位置（第1車線内位置）として算出し、RAM13に記憶する（同S10）。
【００２７】
次に、CPU12は、ステップS10で求めた車線区分線による車線幅中央位置から、ステップS7で求めたマーカー列による車線幅中央位置を減算し、その偏差を補正値としてRAM13に記憶する（同S11）。
次に、CPU12は、ステップS7で求めたマーカー列による車線幅中央位置を操舵制御のための車線幅中央位置とする（同S12）。これは、マーカー列検出が可能であったため、CPU12はあえて車線区分線による車線幅中央位置を操舵制御のために使用する必要が無いからである。
【００２８】
一方、ステップS13及びS14において、車線区分線検出部1が正常で車線区分線が有ると判定された場合は、ステップS4で既にマーカー列検出部2が故障していることが分かっているため、車線区分線検出部1による出力信号を用いて操舵制御を行うべく、以下の処理を行う。
【００２９】
まず、CPU12は、ステップS10と同様に、車線区分線検出部1からの左側車線区分線と右側車線区分線の中央を車線幅中央位置として算出し、RAM13に記憶する（同S15）。
次に、CPU12は、ステップS11で補正値の算出が行われたか否かをRAM13を確認することにより判定し、行われていればステップS18へ進む（同S16）。補正値の算出が行われていなければCPU12は代用値として補正値に０を代入する（同S17）。
【００３０】
次に、CPU12は、ステップS15で求めた車線幅中央位置に、ステップS11又はステップS17で求めた補正値（負値の場合も有る。）を加えて新たな車線幅中央位置としてRAM13に記憶する（同S18）。
以上のようにステップS12又はステップS18で求めた車線幅中央位置から目標車線内位置を決定する（ステップS19）。この場合、車線幅中央位置をそのまま目標車線内位置としてもよいが、左右方向に若干オフセットするように設定してもよい。
【００３１】
ステップS19で求められる目標車線内位置は、自車左右方向中心線を基準としているので次のようになる。
（a）目標車線内位置＝0：目標車線内位置が自車左右方向中心線上にある。
（b）目標車線内位置＜0：目標車線内位置が自車左右方向中心線より左側にある。
（c）目標車線内位置＞0：目標車線内位置が自車左右方向中心線より右側にある。
【００３２】
このようにして決定した目標車線内位置を上記のいずれに該当するかを判定する（同S20）。
すなわち、目標車線内位置＝0の場合(a)には、自車左右方向中心線上に目標車線内位置が存在するので、操舵アクチュエータ4を中立保持するように制御する（同S21）。
【００３３】
また、目標車線内位置＜0の場合(b)には、目標車線内位置が自車左右方向中心線より左側にあるので、操舵アクチュエータ4を左転舵制御する（同S22）。
さらに目標車線内位置＞0の場合(c)には、目標車線内位置が自車左右方向中心線より右側にあるので、操舵アクチュエータ4を右転舵制御を行う（同S23）。
【００３４】
なお、上述の如く、同図のフローチャートは所定時間間隔で開始されるものであり、図1に示した電源部36を介して演算部3に車両電源が供給されている間は、制御スイッチ5がOFFの状態であっても処理が開始される。すなわち、制御スイッチ5がOFFである間は、ステップS1〜S3の処理が繰り返される。
【００３５】
また、上述の実施例では車線内位置の一例として、車線幅中央位置を用いて説明したが、特にこれに限定されるものではなく、例えば車線区分線との所定距離距離又は比率等を用いて算出することもできる。
図4は、車線区分線20とマーカー列21が併用されている走行路（同図（1））と車線区分線20のみが用いられている走行路（同図（2））の各自動操舵を比較して示した図である。車線区分線20は車線区分線検出部1により検出され、マーカー列21はマーカー列検出部2により検出される。
【００３６】
同図（1）は、第1車線内位置22が車線区分線20に基づき算出され、第2車線内位置23がマーカー列21に基づき算出された例を示している。
この例では両方の車線内位置が得られているので、自動操舵には車線内位置23が用いられる。偏差24は車線内位置22と車線内位置23の偏差を示しており、この偏差24の分だけ車線区分線検出部1により誤って検出されているとしてRAM13に記憶される。
【００３７】
同図（2）は車線区分線20のみが用いられ、マーカー列21が走行路上にない場合である。車線内位置22は車線区分線21に基づき算出されるが、マーカー列21が無いため、RAM13に記憶されていた偏差24により補正され、このときの車線内位置22により自動操舵を行う。
【００３８】
このようにマーカー列21が無い場合でも、車線区分線20とマーカー列21が併用されている走行路で算出された偏差24に基づき車線内位置22が補正され、より正確な自動制御が実現される。
【００３９】
【発明の効果】
以上説明したように、本発明に係る自動操舵装置によれば、精度の高いマーカー列により得られた第2車線内位置に基づいて第1車線内位置のずれを補正することが可能となる。
【００４０】
よってマーカー列が敷設されていない走行路において、例えば車線区分検出部にカメラが用いられていて且つその光軸がずれているような場合でも、第1車線内位置をより正確な値にすることができるため、より精度の高い自動操舵を実現することができる。
【図面の簡単な説明】
【図１】本発明に係る自動操舵装置を原理的に示した図である。
【図２】本発明に係る自動操舵装置の一実施例を示したブロック図である。
【図３】図2に示した本発明に係る自動操舵装置の実施例に用いられる制御プログラムを示したフローチャート図である。
【図４】本発明に係る自動操舵装置の実施例による動作を説明する図である。
【符号の説明】
1 車線区分線検出部
2 マーカー列検出部
3 演算部
4 操舵アクチュエータ
5 制御ON/OFFスイッチ
6 選択スイッチ
図中、同一符号は同一又は相当部分を示す。
【発明の属する技術分野】
本発明は自動操舵装置に関し、特に車両が車線内保持走行を行うための自動操舵装置に関するものである。
【０００２】
【従来の技術】
自動操舵装置は、自車が走行する車線を検出する車線検出部、自動操舵に必要な情報を算出する演算部、この演算部の情報に基づいて操舵輪を制御する操舵アクチュエータによって構成され、操舵アクチュエータからステアリングを制御することにより車両の自動操舵を実現している。
【０００３】
車線検出部としては、▲１▼区分車線をカメラ等を用いて視覚的に検出する車線区分線検出部、▲２▼車線内に磁石や電波発信機から成るマーカー列を敷設し、このマーカー列を磁気センサや電波アンテナで検出するマーカー列検出部、などが一般的に知られている。
【０００４】
動作において、演算部は、車線検出部によって検出された車線区分線と車両との相対位置（例えば、車線幅中央位置、区分車線位置又は車両基準位置）を求めると共に目標車線内位置を決定する。操舵アクチュエータは、この目標車線内位置に基づき、運転者に代わって操舵輪を操舵する。
【０００５】
通常は、車線内の中央を走行することが望ましいと考えられるので、上記の車線区分線検出部▲１▼の場合には車線幅の中央を自動操舵の目標車線内位置として制御を行い、また、上記のマーカー列検出部▲２▼の場合には、目標車線内位置としてマーカー列が車線幅の中央に敷設されており、自動操舵装置は該マーカーを目標車線内位置として制御を行っている。
【０００６】
【発明が解決しようとする課題】
車線区分線検出部▲１▼により検出する場合には、検出対象となる車線区分線はすでに整備されているため、自動操舵のために道路に対する新たな開発や整備を行わなくて済む反面、車両にカメラなどを設置する際に光軸を調整する必要があり、設計上想定した光軸にカメラ光軸を合致させないと左右方向の位置検出などに誤差を生じてしまうという問題点がある。
【０００７】
一方、マーカー列検出部▲２▼の場合には、磁石や電波発信機という視覚的でない方法でマーカー列を検出しているため積雪など気象条件に関わらず高い精度でマーカー列を検出ができる反面、マーカー列のインフラは現状では少ないため新たに設置が必要とされ、実用性に乏しいという欠点がある。
【０００８】
すなわち、車両の車線内位置を検出する上ではマーカー列を検出する方が精度が高いが、現状ではそのインフラが整っていないためマーカー列検出部のみによる自動操舵装置は実用性が低い。
その一方で、車線区分線検出部を利用する場合には検出精度は落ちるが既存の車線区分線を利用することができるため検出精度を上げることができれば高い実用性を発揮することができる。
【０００９】
そこで本発明に係る自動操舵装置は、マーカー列が検出できない状態が発生しても、車線区分線を利用して高い精度で車線内保持走行が実現できるようにすることを課題とする。
【００１０】
【課題を解決する手段】
上記の目的を解決するため、本発明に係る自動操舵装置は、図1に原理的に示すように、車線区分線を検出する車線区分線検出部1と、走行路上のマーカー列を検出するマーカー列検出部2と、該車線区分線または該マーカー列から目標車線内位置を求める演算部3と、該目標車線内位置に基づいて操舵制御を行うアクチュエータ4と、を備えた自動操舵装置において、該演算部3は、該マーカー列及び車線区分線が検出されているときには、該マーカー列に基づいて算出される第２車線内位置を該目標車線内位置とすると共に、該車線区分線から算出される第１車線内位置と前記第２車線内位置との偏差から補正値を算出し、該車線区分線が検出されており該マーカー列が検出されていないときには、該車線区分線から算出された該第１車線内位置と前記補正値とから該目標車線内位置を求めることを特徴としている。
【００１１】
すなわち本発明においては、車線区分線検出部1が車線区分線を検出し、マーカー列検出部2が走行路上のマーカー列を検出する。そして演算部3は、該車線区分線から第1車線内位置を算出し該マーカー列から第2車線内位置を算出して目標車線内位置とする。
【００１２】
そしてさらに、演算部3は、両車線内位置の偏差から補正値を算出して記憶しておき、車線区分線は検出されたが該マーカー列が検出されなかったときに該補正値に基づき第1車線内位置を補正する。このようにして、精度の高いマーカー列により得られた第2車線内位置に基づいて第1車線内位置のずれを補正しておくことにより、マーカー列が敷設されていない走行路において、例えば車線区分検出部にカメラが用いられていて且つその光軸がずれているような場合でも、第1車線内位置をより正確な値にすることができるため、より精度の高い自動操舵を実現することができる。
【００１４】
【発明の実施の形態】
図2は、図1に原理的に示された本発明に係る自動操舵装置の一実施例の構成図を示したものである。この実施例において、演算部3は、車線区分線検出部1からの装置故障信号を含む車線情報、マーカー列検出部2からの装置故障信号を含む車線情報、制御ON/OFFスイッチ5からの自動操舵制御ON/OFF信号及び選択スイッチ6からの選択スイッチ信号を読み込む入力部11と、この入力部11からの出力信号を用いて自動操舵制御に関する演算処理を行うCPU12と、演算処理でCPU12が使用するRAM13と、制御プログラムや制御パラメータを格納しておくROM14と、CPU12で演算された出力データに従って操舵アクチュエータ4を駆動する出力部15と、車両電源からこれらの各部に必要な電源を供給するための電源部16とで構成されている。
【００１５】
ここで、車線区分線検出部1は、車線区分線を視覚的に検出するカメラと画像処理装置との組み合わせで構成され、自車を基準として検出した車線の相対位置に関する情報と装置故障の有無に関する情報を出力するものである。
マーカー列検出部2は、道路に敷設されたマーカー列を検出するレーンマーカー・センサーと信号処理装置との組み合わせにより構成され、自車を基準として検出された車線、すなわちマーカー列の相対位置に関する情報と、装置故障の有無に関する情報を出力する。
【００１６】
操舵アクチュエータ4は、出力部15からの出力によりステアリング（図示せず）を介して車両の操舵輪を自動的に作動させるものである。
制御ON/OFFスイッチ5は、運転者の操作に従い自動操舵制御の開始及び解除を切り替えるためのスイッチである。
【００１７】
選択スイッチ6は、運転者の操作に従い、車線区分線検出部1とマーカー列検出部2のどちらを自動操舵制御に用いるかを選択して切り替えるスイッチである。なお、スイッチ5及び6は本発明に不可欠な構成ではない。
図3は、図2に示した演算部1におけるROM14に格納されている制御プログラムの流れを示したものであり、以下、図3を参照して図2の実施例の動作を説明する。
【００１８】
なお、このフローチャートは所定時間間隔で開始されるものとし、制御装置の制御に係る部分のみを記述しているが、CPU12などのハードウェア起動時の初期処理などは省略されている。
また、本フローチャート内で使用する位置は、全て自車左右方向中心線を0として、車両右側を＋、車両左側を−として表現するものとする。車線区分検出部1及びマーカー列検出部2も、自車左右方向中心線を0として車線情報を表現しているものとする。
【００１９】
まずCPU12は、入力部11を介して入力信号を読み込む。読み込まれる入力信号は、制御ON/OFFスイッチ5からの自動操舵制御ON/OFF信号、車線区分線検出部1からの装置故障信号を含む車線情報、マーカー列検出部2からの装置故障信号を含む車線情報、及び選択スイッチ6からの選択スイッチ信号である（ステップS1）。
【００２０】
次に、CPU12は、ステップS1で読み込んだ制御ON/OFF信号により、制御スイッチ5のON/OFFを確認する（同S2）。制御ON/OFFスイッチ5がOFFである場合、自動操舵制御を行わないため、操舵アクチュエータ4を操舵無制御（同S3）として処理を終了する。
【００２１】
ステップS2において制御ON/OFFスイッチ5がONであると判定した場合、CPU12は、ステップS1で読み込んだマーカー列検出部2の故障有無信号をチェックする（同S4）。
マーカー列検出部2が故障の場合には、車線区分線検出部1の故障有無信号をチェックし（同S13）、車線区分線検出部1も故障の場合には、操舵アクチュエータ4を無制御として終了する（同S3）。
【００２２】
車線区分線検出部1が正常の場合には、CPU12は、ステップS1で読み込んだ車線区分線検出部1からの出力信号により車線区分線の有無をチェックする（同S14）。車線区分線が無いと判定した場合は、操舵アクチュエータ4を無制御として終了する（同S3）。
【００２３】
ステップS4において、マーカー列検出部2が正常の場合には、CPU12は、走行路のマーカー列の有無をマーカー列検出部2からの出力信号によりチェックする（同S5）。ステップS5において、CPU12がマーカー列が無いと判定した場合は、ステップS13に進む。
【００２４】
ステップS5において、マーカー列が有ると判定した場合は、CPU12はステップS1で読み込んだ選択スイッチ信号をチェックする。「車線区分線検出」が選択されている場合はステップS13へ進み、「マーカー列検出」が選択されている場合はステップS7の処理を行う（同S6）。
【００２５】
CPU12は、マーカー列検出部2からのマーカー列位置を車線幅中央位置（第2車線内位置）としてRAM13に記憶する（同S7）。
次に、CPU12は、車線区分線検出部1の故障有無信号をチェックし、車線区分線検出部1が故障と判定された場合はステップS12へ進む（同S8）。
【００２６】
車線区分線検出部1が正常であると判定された場合、CPU12は車線区分線検出部1からの出力信号により車線区分線の有無を判定する。車線区分線が無いと判定された場合は、ステップS12へ進む（同S9）。
車線区分線が有ると判定された場合は、CPU12は車線区分線検出部1からの車線情報に含まれる左側車線区分線と右側車線区分線の中央を車線幅中央位置（第1車線内位置）として算出し、RAM13に記憶する（同S10）。
【００２７】
次に、CPU12は、ステップS10で求めた車線区分線による車線幅中央位置から、ステップS7で求めたマーカー列による車線幅中央位置を減算し、その偏差を補正値としてRAM13に記憶する（同S11）。
次に、CPU12は、ステップS7で求めたマーカー列による車線幅中央位置を操舵制御のための車線幅中央位置とする（同S12）。これは、マーカー列検出が可能であったため、CPU12はあえて車線区分線による車線幅中央位置を操舵制御のために使用する必要が無いからである。
【００２８】
一方、ステップS13及びS14において、車線区分線検出部1が正常で車線区分線が有ると判定された場合は、ステップS4で既にマーカー列検出部2が故障していることが分かっているため、車線区分線検出部1による出力信号を用いて操舵制御を行うべく、以下の処理を行う。
【００２９】
まず、CPU12は、ステップS10と同様に、車線区分線検出部1からの左側車線区分線と右側車線区分線の中央を車線幅中央位置として算出し、RAM13に記憶する（同S15）。
次に、CPU12は、ステップS11で補正値の算出が行われたか否かをRAM13を確認することにより判定し、行われていればステップS18へ進む（同S16）。補正値の算出が行われていなければCPU12は代用値として補正値に０を代入する（同S17）。
【００３０】
次に、CPU12は、ステップS15で求めた車線幅中央位置に、ステップS11又はステップS17で求めた補正値（負値の場合も有る。）を加えて新たな車線幅中央位置としてRAM13に記憶する（同S18）。
以上のようにステップS12又はステップS18で求めた車線幅中央位置から目標車線内位置を決定する（ステップS19）。この場合、車線幅中央位置をそのまま目標車線内位置としてもよいが、左右方向に若干オフセットするように設定してもよい。
【００３１】
ステップS19で求められる目標車線内位置は、自車左右方向中心線を基準としているので次のようになる。
（a）目標車線内位置＝0：目標車線内位置が自車左右方向中心線上にある。
（b）目標車線内位置＜0：目標車線内位置が自車左右方向中心線より左側にある。
（c）目標車線内位置＞0：目標車線内位置が自車左右方向中心線より右側にある。
【００３２】
このようにして決定した目標車線内位置を上記のいずれに該当するかを判定する（同S20）。
すなわち、目標車線内位置＝0の場合(a)には、自車左右方向中心線上に目標車線内位置が存在するので、操舵アクチュエータ4を中立保持するように制御する（同S21）。
【００３３】
また、目標車線内位置＜0の場合(b)には、目標車線内位置が自車左右方向中心線より左側にあるので、操舵アクチュエータ4を左転舵制御する（同S22）。
さらに目標車線内位置＞0の場合(c)には、目標車線内位置が自車左右方向中心線より右側にあるので、操舵アクチュエータ4を右転舵制御を行う（同S23）。
【００３４】
なお、上述の如く、同図のフローチャートは所定時間間隔で開始されるものであり、図1に示した電源部36を介して演算部3に車両電源が供給されている間は、制御スイッチ5がOFFの状態であっても処理が開始される。すなわち、制御スイッチ5がOFFである間は、ステップS1〜S3の処理が繰り返される。
【００３５】
また、上述の実施例では車線内位置の一例として、車線幅中央位置を用いて説明したが、特にこれに限定されるものではなく、例えば車線区分線との所定距離距離又は比率等を用いて算出することもできる。
図4は、車線区分線20とマーカー列21が併用されている走行路（同図（1））と車線区分線20のみが用いられている走行路（同図（2））の各自動操舵を比較して示した図である。車線区分線20は車線区分線検出部1により検出され、マーカー列21はマーカー列検出部2により検出される。
【００３６】
同図（1）は、第1車線内位置22が車線区分線20に基づき算出され、第2車線内位置23がマーカー列21に基づき算出された例を示している。
この例では両方の車線内位置が得られているので、自動操舵には車線内位置23が用いられる。偏差24は車線内位置22と車線内位置23の偏差を示しており、この偏差24の分だけ車線区分線検出部1により誤って検出されているとしてRAM13に記憶される。
【００３７】
同図（2）は車線区分線20のみが用いられ、マーカー列21が走行路上にない場合である。車線内位置22は車線区分線21に基づき算出されるが、マーカー列21が無いため、RAM13に記憶されていた偏差24により補正され、このときの車線内位置22により自動操舵を行う。
【００３８】
このようにマーカー列21が無い場合でも、車線区分線20とマーカー列21が併用されている走行路で算出された偏差24に基づき車線内位置22が補正され、より正確な自動制御が実現される。
【００３９】
【発明の効果】
以上説明したように、本発明に係る自動操舵装置によれば、精度の高いマーカー列により得られた第2車線内位置に基づいて第1車線内位置のずれを補正することが可能となる。
【００４０】
よってマーカー列が敷設されていない走行路において、例えば車線区分検出部にカメラが用いられていて且つその光軸がずれているような場合でも、第1車線内位置をより正確な値にすることができるため、より精度の高い自動操舵を実現することができる。
【図面の簡単な説明】
【図１】本発明に係る自動操舵装置を原理的に示した図である。
【図２】本発明に係る自動操舵装置の一実施例を示したブロック図である。
【図３】図2に示した本発明に係る自動操舵装置の実施例に用いられる制御プログラムを示したフローチャート図である。
【図４】本発明に係る自動操舵装置の実施例による動作を説明する図である。
【符号の説明】
1 車線区分線検出部
2 マーカー列検出部
3 演算部
4 操舵アクチュエータ
5 制御ON/OFFスイッチ
6 選択スイッチ
図中、同一符号は同一又は相当部分を示す。
Claims (1)
- 車線区分線を検出する車線区分線検出部と、
走行路上のマーカー列を検出するマーカー列検出部と、
該車線区分線または該マーカー列から目標車線内位置を求める演算部と、
該目標車線内位置に基づいて操舵制御を行うアクチュエータと、
を備えた自動操舵装置において、
該演算部は、該マーカー列及び車線区分線が検出されているときには、該マーカー列に基づいて算出される第２車線内位置を該目標車線内位置とすると共に、該車線区分線から算出される第１車線内位置と前記第２車線内位置との偏差から補正値を算出し、該車線区分線が検出されており該マーカー列が検出されていないときには、該車線区分線から算出された該第１車線内位置と前記補正値とから該目標車線内位置を求めることを特徴とした自動操舵装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2001202110A JP4595258B2 (ja) | 2001-07-03 | 2001-07-03 | 自動操舵装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2001202110A JP4595258B2 (ja) | 2001-07-03 | 2001-07-03 | 自動操舵装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2003016594A JP2003016594A (ja) | 2003-01-17 |
| JP4595258B2 true JP4595258B2 (ja) | 2010-12-08 |
Family
ID=19038973
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2001202110A Expired - Fee Related JP4595258B2 (ja) | 2001-07-03 | 2001-07-03 | 自動操舵装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP4595258B2 (ja) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP6252252B2 (ja) * | 2014-02-28 | 2017-12-27 | 株式会社デンソー | 自動運転装置 |
Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH09245298A (ja) * | 1996-03-13 | 1997-09-19 | Toyota Motor Corp | 車両用自動走行装置 |
| JPH10103966A (ja) * | 1996-09-30 | 1998-04-24 | Sumitomo Electric Ind Ltd | 車線逸脱警告装置 |
| JPH10307997A (ja) * | 1997-05-01 | 1998-11-17 | Fujitsu Ten Ltd | 隊列走行用制御装置および方法 |
-
2001
- 2001-07-03 JP JP2001202110A patent/JP4595258B2/ja not_active Expired - Fee Related
Patent Citations (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH09245298A (ja) * | 1996-03-13 | 1997-09-19 | Toyota Motor Corp | 車両用自動走行装置 |
| JPH10103966A (ja) * | 1996-09-30 | 1998-04-24 | Sumitomo Electric Ind Ltd | 車線逸脱警告装置 |
| JPH10307997A (ja) * | 1997-05-01 | 1998-11-17 | Fujitsu Ten Ltd | 隊列走行用制御装置および方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2003016594A (ja) | 2003-01-17 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US6721638B2 (en) | AGV position and heading controller | |
| JPH1186182A (ja) | 自動運転制御システム | |
| KR20080037708A (ko) | 차량용 측위 정보 갱신 장치 | |
| CN110745135B (zh) | 用于补偿航向角的装置和方法 | |
| JP4734795B2 (ja) | 自動操舵装置 | |
| JP2002286456A (ja) | 車両位置認識装置 | |
| JP2002002427A (ja) | 車両用制御装置 | |
| JP4595258B2 (ja) | 自動操舵装置 | |
| JP2003276628A (ja) | 自動操舵装置 | |
| JP3873658B2 (ja) | 自動操舵装置 | |
| JP3945185B2 (ja) | 自動操舵装置 | |
| JP3687640B2 (ja) | 自動操舵装置 | |
| JP2008275344A (ja) | ヨーレートセンサの出力判定装置および追従先行車判定装置 | |
| JP2003067053A (ja) | 無人搬送車 | |
| JP2007106250A (ja) | 走行支援装置 | |
| JPH04300781A (ja) | 移動車の走行制御装置 | |
| JP2748456B2 (ja) | 車両の操舵角検出装置 | |
| JP2000227998A (ja) | 車載磁気センサ、車両位置検出装置および自動運転システム | |
| JP2003241837A (ja) | 無人搬送車 | |
| JP2007233604A (ja) | 道路情報取得装置、及びこれを利用した車両用走行制御装置、並びに道路交通システム | |
| JP2000214180A (ja) | センサ中立位置学習装置及び記録媒体 | |
| JP2009078693A (ja) | 操舵制御装置 | |
| JP2001202131A (ja) | 無人搬送車 | |
| SE541719C2 (en) | Method and system for facilitating steering of a vehicle by a driver of the vehicle during driving along a road | |
| JP3744473B2 (ja) | 自動操舵装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20080619 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20100608 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20100806 |
|
| TRDD | Decision of grant or rejection written | ||
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20100824 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20100906 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20131001 Year of fee payment: 3 |
|
| LAPS | Cancellation because of no payment of annual fees |