JPH04304503A - 道路線形推定装置 - Google Patents
道路線形推定装置Info
- Publication number
- JPH04304503A JPH04304503A JP3096297A JP9629791A JPH04304503A JP H04304503 A JPH04304503 A JP H04304503A JP 3096297 A JP3096297 A JP 3096297A JP 9629791 A JP9629791 A JP 9629791A JP H04304503 A JPH04304503 A JP H04304503A
- Authority
- JP
- Japan
- Prior art keywords
- road
- sampling period
- road alignment
- estimated
- sensor
- 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.)
- Granted
Links
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【０００１】
【産業上の利用分野】この発明は、自動走行車両がカメ
ラなどによって検知した道路線形情報に基づいて走行す
る際，一時的に道路線形情報が得られなくなった場合に
，過去の道路線形情報を用いて道路線形を推定する装置
に関する。
ラなどによって検知した道路線形情報に基づいて走行す
る際，一時的に道路線形情報が得られなくなった場合に
，過去の道路線形情報を用いて道路線形を推定する装置
に関する。
【０００２】
【従来の技術】従来の自動走行制御装置としては特開昭
６３ー３１４６１６に示されるようなものがある。この
場合、道路線形情報の検出を行なうサンプリング周期は
ハンドル、ブレーキ、アクセル等のアクチュエータの制
御周期（サンプリングタイミング）と同じタイミングで
行なわれ、一定のサンプリング周期で取り込んだ道路線
形情報に基づいて車両前方の道路線形を判断している。
６３ー３１４６１６に示されるようなものがある。この
場合、道路線形情報の検出を行なうサンプリング周期は
ハンドル、ブレーキ、アクセル等のアクチュエータの制
御周期（サンプリングタイミング）と同じタイミングで
行なわれ、一定のサンプリング周期で取り込んだ道路線
形情報に基づいて車両前方の道路線形を判断している。
【０００３】
【発明が解決しようとする課題】しかしながら、このよ
うな従来の自動走行制御装置にあっては、道路線形情報
を道路上に描かれた白線から検出しているために、例え
ばその白線上に建物の影などがかかることによって走行
途中で道路線形情報が途絶えたとき、その時点までに得
ていた情報を基に前方の道路線形を推定して盲走行を行
なう必要が生じた際、推定値と実際の道路線形とは車速
と道路線形が偶然マッチしていると良く一致するが、車
両速度が増加すると大きくずれてくる。
うな従来の自動走行制御装置にあっては、道路線形情報
を道路上に描かれた白線から検出しているために、例え
ばその白線上に建物の影などがかかることによって走行
途中で道路線形情報が途絶えたとき、その時点までに得
ていた情報を基に前方の道路線形を推定して盲走行を行
なう必要が生じた際、推定値と実際の道路線形とは車速
と道路線形が偶然マッチしていると良く一致するが、車
両速度が増加すると大きくずれてくる。
【０００４】すなわち比較的車両速度が低く道路線形の
変化が緩やかな場合には図５（ａ）のようによく一致す
る。図中，Ｐ０ 、Ｐ−１、Ｐ−２およびθ０ 、θ−
１、θ−２、…は現時点（ｔ０ ）、前回検出時（ｔ−
１）、前々回検出時（ｔ−２）、…の白線位置および方
位であり、Ｐ−２、Ｐ−１、Ｐ０ 点のデータを結んで
推定予測される破線の線形は実線で示される実際の道路
線形と一致する。
変化が緩やかな場合には図５（ａ）のようによく一致す
る。図中，Ｐ０ 、Ｐ−１、Ｐ−２およびθ０ 、θ−
１、θ−２、…は現時点（ｔ０ ）、前回検出時（ｔ−
１）、前々回検出時（ｔ−２）、…の白線位置および方
位であり、Ｐ−２、Ｐ−１、Ｐ０ 点のデータを結んで
推定予測される破線の線形は実線で示される実際の道路
線形と一致する。
【０００５】車両速度が高くなると、サンプリング周期
が一定であるため、記憶データが遥か後方の値を含むこ
とになり、図５（ｂ）から分かるように道路線形の変化
が大きい道路を走行する場合は、各実測点を結んでも実
際の道路線形を正しくは追えない。したがって破線の推
定値は実際の実線線形と異なる方向へ延びることとなり
、推定の精度が低下し盲走行できる領域または距離が減
少するという問題がある。したがってこの発明はどのよ
うな走行状況にあっても道路線形を精度よく推定できる
道路線形推定装置を提供することを目的とする。
が一定であるため、記憶データが遥か後方の値を含むこ
とになり、図５（ｂ）から分かるように道路線形の変化
が大きい道路を走行する場合は、各実測点を結んでも実
際の道路線形を正しくは追えない。したがって破線の推
定値は実際の実線線形と異なる方向へ延びることとなり
、推定の精度が低下し盲走行できる領域または距離が減
少するという問題がある。したがってこの発明はどのよ
うな走行状況にあっても道路線形を精度よく推定できる
道路線形推定装置を提供することを目的とする。
【０００６】
【課題を解決するための手段】このため本発明は、車両
前方の道路線形情報を検知するセンサと、該情報を記憶
する記憶装置と、記憶した過去の道路線形情報に基づき
車両前方の道路線形を推定する推定装置と、タイミング
調節装置を備え、センサで検知した道路線形と推定され
た線形との偏差に応じてタイミング調節装置により前記
センサのサンプリング周期を調節する道路線形推定装置
とした。
前方の道路線形情報を検知するセンサと、該情報を記憶
する記憶装置と、記憶した過去の道路線形情報に基づき
車両前方の道路線形を推定する推定装置と、タイミング
調節装置を備え、センサで検知した道路線形と推定され
た線形との偏差に応じてタイミング調節装置により前記
センサのサンプリング周期を調節する道路線形推定装置
とした。
【０００７】
【作用】これにより、推定した道路線形と実際の道路線
形との偏差が所定値より大きくならないようにサンプリ
ング周期が制御されるから、車両の自動走行時例えば車
両速度が変化した場合にあっても、盲走行時の道路線形
の推定精度を高く維持し、許容走行領域が拡大される。
形との偏差が所定値より大きくならないようにサンプリ
ング周期が制御されるから、車両の自動走行時例えば車
両速度が変化した場合にあっても、盲走行時の道路線形
の推定精度を高く維持し、許容走行領域が拡大される。
【０００８】
【実施例】図１および図２はこの発明の一実施例を示す
図で、道路線形情報として道路に描かれた白線を用いる
。白線検知センサ１００はＴＶカメラ等で車両前方の道
路白線を画像データとして取り込み、画像処理装置によ
り車両前方の特定位置（例えば車両前方５ｍから２５ｍ
の範囲内の複数位置）に於ける車両座標系に対する白線
の相対位置Ｐｍｉ（Ｘｉ，Ｙｍｉ）、相対姿勢θｍｉを
白線情報として、図２の（ａ）のように出力する。
図で、道路線形情報として道路に描かれた白線を用いる
。白線検知センサ１００はＴＶカメラ等で車両前方の道
路白線を画像データとして取り込み、画像処理装置によ
り車両前方の特定位置（例えば車両前方５ｍから２５ｍ
の範囲内の複数位置）に於ける車両座標系に対する白線
の相対位置Ｐｍｉ（Ｘｉ，Ｙｍｉ）、相対姿勢θｍｉを
白線情報として、図２の（ａ）のように出力する。
【０００９】記憶装置１０１はこの白線情報を記憶して
おき、記憶装置１０１に蓄えられた情報に基づいて線形
推定装置１０２が車両前方の道路線形を推定すると、タ
イミング調節装置１０３がその推定値（ｃ）と次の実測
値（ａ）とを比較し、その偏差に応じてサンプリング周
期を調節する。
おき、記憶装置１０１に蓄えられた情報に基づいて線形
推定装置１０２が車両前方の道路線形を推定すると、タ
イミング調節装置１０３がその推定値（ｃ）と次の実測
値（ａ）とを比較し、その偏差に応じてサンプリング周
期を調節する。
【００１０】記憶装置１０１は容量に制限があるため、
送られてくるデータの内車両前方直近の１組の相対位置
データＰＮＥＷ （＝Ｐｍ１ ）、θＮＥＷ （＝θｍ
１ ）だけを図２（ｂ）のようにサンプリングの都度（
時刻ｔ＝ｔ０ 、ｔ−１、ｔ−２、…、ｔ−Ｎ）蓄えて
いく。
送られてくるデータの内車両前方直近の１組の相対位置
データＰＮＥＷ （＝Ｐｍ１ ）、θＮＥＷ （＝θｍ
１ ）だけを図２（ｂ）のようにサンプリングの都度（
時刻ｔ＝ｔ０ 、ｔ−１、ｔ−２、…、ｔ−Ｎ）蓄えて
いく。
【００１１】次に、フローチャートを示した図３に基づ
いてこの実施例の動作を説明する。ステップ１１におい
て線形推定装置１０２は記憶装置１０１に記憶されてい
る図２（ｂ）に示すような過去の道路線形情報を用い、
図２（ｃ）に示すような道路線形の推定値（Ｘｉ，Ｆ（
Ｘｉ））を演算する。なお、道路線形を推定するのに使
用される推定式としては、２次の補完式
いてこの実施例の動作を説明する。ステップ１１におい
て線形推定装置１０２は記憶装置１０１に記憶されてい
る図２（ｂ）に示すような過去の道路線形情報を用い、
図２（ｃ）に示すような道路線形の推定値（Ｘｉ，Ｆ（
Ｘｉ））を演算する。なお、道路線形を推定するのに使
用される推定式としては、２次の補完式
【００１２】
【数１】
あるいは、３次の補完式
【００１３】
【数２】
等が一般に知られている。
【００１４】ステップ１２において、白線検知センサ１
００は車両前方の特定位置における白線位置を検知して
、図２（ａ）に示すような実測値Ｐｍｉ、θｍｉを出力
する。
００は車両前方の特定位置における白線位置を検知して
、図２（ａ）に示すような実測値Ｐｍｉ、θｍｉを出力
する。
【００１５】ステップ１３においてタイミング調節装置
１０３は、Ｘｉ（ｉ＝１、２、…、Ｌ）座標に対する推
定値Ｆ（Ｘｉ）と実測値Ｙｍｉの偏差Ｄを
１０３は、Ｘｉ（ｉ＝１、２、…、Ｌ）座標に対する推
定値Ｆ（Ｘｉ）と実測値Ｙｍｉの偏差Ｄを
【００１６】
【数３】
として計算する。
【００１７】ステップ１４において、タイミング調節装
置１０３は算出した偏差Ｄから許容値εを減算し、その
減算結果Ｓが０未満であるか０以上であるかを判断する
。ここで減算結果Ｓが０未満である場合にはステップ１
５へ進み、減算結果Ｓが０以上である場合にはステップ
１６へ進む。
置１０３は算出した偏差Ｄから許容値εを減算し、その
減算結果Ｓが０未満であるか０以上であるかを判断する
。ここで減算結果Ｓが０未満である場合にはステップ１
５へ進み、減算結果Ｓが０以上である場合にはステップ
１６へ進む。
【００１８】ステップ１５においてタイミング調節装置
１０３は、次のサンプリング周期Ｔが現在のサンプリン
グ周期よりも所定時間△Ｔだけ長くなるようにＴ＝Ｔ＋
△Ｔ とする。ステップ１６に進んだ場合には、タイミング装
置１０３は次のサンプリング周期Ｔが現在のサンプリン
グ周期よりも所定時間△Ｔだけ短くなるようにＴ＝Ｔ−
△Ｔ とする。
１０３は、次のサンプリング周期Ｔが現在のサンプリン
グ周期よりも所定時間△Ｔだけ長くなるようにＴ＝Ｔ＋
△Ｔ とする。ステップ１６に進んだ場合には、タイミング装
置１０３は次のサンプリング周期Ｔが現在のサンプリン
グ周期よりも所定時間△Ｔだけ短くなるようにＴ＝Ｔ−
△Ｔ とする。
【００１９】なお、白線検知センサ１００をＴＶカメラ
と画像処理装置とにより構成する場合、画像処理速度に
限度があるので上記の所定時間△Ｔはビデオレートと呼
ばれる１／３０秒とするとよい。
と画像処理装置とにより構成する場合、画像処理速度に
限度があるので上記の所定時間△Ｔはビデオレートと呼
ばれる１／３０秒とするとよい。
【００２０】これにより図４（ａ）のように破線で示す
推定線形が実線で示される実際の道路線形とずれると、
サンプリング周期を短くし、その結果車両速度が同じで
も（ｂ）のように記憶されるデータの間隔が密になり道
路線形が精度よく推定される。
推定線形が実線で示される実際の道路線形とずれると、
サンプリング周期を短くし、その結果車両速度が同じで
も（ｂ）のように記憶されるデータの間隔が密になり道
路線形が精度よく推定される。
【００２１】この後ステップ１７において、実測値デー
タのうち車両から直近の１組のデータＰＮＥＷ （＝Ｐ
ｍ１ ）、θＮＥＷ （＝θｍ１ ）を加え記憶装置１
０１のデータを更新する。更新は、 ＰＮＥＷ →Ｐ
０ 、Ｐ０ →Ｐ−１、…、Ｐ−（Ｎ−１）→Ｐ−Ｎ θＮＥＷ →θ０ 、θ０ →θ−１、…、θ−（Ｎ−
１）→θ−Ｎのように行なわれる。
タのうち車両から直近の１組のデータＰＮＥＷ （＝Ｐ
ｍ１ ）、θＮＥＷ （＝θｍ１ ）を加え記憶装置１
０１のデータを更新する。更新は、 ＰＮＥＷ →Ｐ
０ 、Ｐ０ →Ｐ−１、…、Ｐ−（Ｎ−１）→Ｐ−Ｎ θＮＥＷ →θ０ 、θ０ →θ−１、…、θ−（Ｎ−
１）→θ−Ｎのように行なわれる。
【００２２】以上の構成によれば、推定した道路線形と
実際の道路線形との偏差が所定値より大きくならないよ
うにサンプリング周期が制御されるから、車両の自動走
行時例えば車両速度が変化した場合にあっても、道路線
形の推定精度を高く維持することができる。さらに、車
両前方の白線の位置を複数位置で検知しそれぞれに対応
する複数の推定値を算出して照合するから、数３の式に
よる偏差算出と相まって推定精度の判断が正確になされ
、サンプリング周期の調節が精密に行なわれる。
実際の道路線形との偏差が所定値より大きくならないよ
うにサンプリング周期が制御されるから、車両の自動走
行時例えば車両速度が変化した場合にあっても、道路線
形の推定精度を高く維持することができる。さらに、車
両前方の白線の位置を複数位置で検知しそれぞれに対応
する複数の推定値を算出して照合するから、数３の式に
よる偏差算出と相まって推定精度の判断が正確になされ
、サンプリング周期の調節が精密に行なわれる。
【００２３】なお、上記実施例では道路左側に描かれた
白線位置を道路線形情報として用いたがさらに右側の白
線の位置も検知して線形情報に加え、より精度の高い推
定および自動走行を得ることができる。
白線位置を道路線形情報として用いたがさらに右側の白
線の位置も検知して線形情報に加え、より精度の高い推
定および自動走行を得ることができる。
【００２４】
【発明の効果】以上説明してきたように、記憶した道路
線形情報を基に線形推定装置により前方の道路線形を推
定し、実測値と推定値とを比較して道路線形の一致度合
いによってタイミング調節装置がサンプリング周期を調
節することとしたため、走行途中で例えば白線情報が得
られなくなるような緊急事態になったとしても、道路線
形によらず安定してしかも速度変化にもリアルタイムで
対応して、精度よくその道路線形を推定予測し走行を継
続することができる。
線形情報を基に線形推定装置により前方の道路線形を推
定し、実測値と推定値とを比較して道路線形の一致度合
いによってタイミング調節装置がサンプリング周期を調
節することとしたため、走行途中で例えば白線情報が得
られなくなるような緊急事態になったとしても、道路線
形によらず安定してしかも速度変化にもリアルタイムで
対応して、精度よくその道路線形を推定予測し走行を継
続することができる。
【図１】本発明の実施例を示すブロック図である。
【図２】線形情報のデータを示す図である。
【図３】本発明における制御のフロー図である。
【図４】タイミング調節の説明図である。
【図５】従来例における推定の説明図である。
１００ 白線検知センサ
１０１ 記憶装置
１０２ 推定装置
１０３ タイミング調節装置
Claims (1)
- 【請求項１】道路線形情報を検知するセンサと、該情報
を記憶する記憶装置と、記憶した過去の道路線形情報に
基づき車両前方の道路線形を推定する推定装置と、前記
センサで検知した道路線形と推定装置で推定された線形
との偏差に応じて前記センサの検知する道路線形情報の
サンプリング周期を調節するタイミング調節装置とを備
えたことを特徴とする道路線形推定装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP3096297A JP2768036B2 (ja) | 1991-04-01 | 1991-04-01 | 道路線形推定装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP3096297A JP2768036B2 (ja) | 1991-04-01 | 1991-04-01 | 道路線形推定装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH04304503A true JPH04304503A (ja) | 1992-10-27 |
| JP2768036B2 JP2768036B2 (ja) | 1998-06-25 |
Family
ID=14161108
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP3096297A Expired - Fee Related JP2768036B2 (ja) | 1991-04-01 | 1991-04-01 | 道路線形推定装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2768036B2 (ja) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH1159459A (ja) * | 1997-08-21 | 1999-03-02 | Honda Motor Co Ltd | ステアリング制御装置 |
| CN113753060A (zh) * | 2020-10-30 | 2021-12-07 | 北京京东乾石科技有限公司 | 车辆的控制方法、装置、计算设备及介质 |
-
1991
- 1991-04-01 JP JP3096297A patent/JP2768036B2/ja not_active Expired - Fee Related
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH1159459A (ja) * | 1997-08-21 | 1999-03-02 | Honda Motor Co Ltd | ステアリング制御装置 |
| CN113753060A (zh) * | 2020-10-30 | 2021-12-07 | 北京京东乾石科技有限公司 | 车辆的控制方法、装置、计算设备及介质 |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2768036B2 (ja) | 1998-06-25 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US5414625A (en) | System and method for providing steering control for autonomous vehicle | |
| EP0207989B1 (en) | Navigation systems | |
| CA1325904C (en) | Method of correcting zero point of gyro and apparatus therefor | |
| CN110015304B (zh) | 用于求取和提供地面特性的方法和系统 | |
| EP3644293A1 (en) | Travel control method and travel control device | |
| JP3204121B2 (ja) | 車両用前後加速度推定装置 | |
| JP2000180545A (ja) | これに基づいて車両が運動する走行路曲線を検出可能な少なくとも１つのセンサの信号を修正する方法 | |
| JPH04304503A (ja) | 道路線形推定装置 | |
| US20240384996A1 (en) | Vehicle control device and vehicle control method | |
| JP2768038B2 (ja) | 自動走行制御装置 | |
| JP3431231B2 (ja) | ジャイロのドリフト補正方法及びその補正回路 | |
| KR101967315B1 (ko) | 차량의 전방 객체 검출 장치 및 방법 | |
| EP0498416B1 (en) | Inter-car distance detecting device | |
| JP2001202131A (ja) | 無人搬送車 | |
| JP3206423B2 (ja) | 車両走行誘導装置 | |
| JP2915474B2 (ja) | 移動車の走行制御装置 | |
| KR20230104981A (ko) | 인식에 맞춘 제어 시스템 및 방법 | |
| KR100199988B1 (ko) | 무인차의 조향방법 및 조향장치 | |
| JP3433057B2 (ja) | 車両用追従制御装置 | |
| JP2910357B2 (ja) | 微分量演算装置 | |
| JPH11283200A (ja) | 車両の位置検出装置 | |
| US20260028013A1 (en) | Method to effectively predict tire saturation for evasive steering and active safety control | |
| JPH03230203A (ja) | 車両の自動操舵方法及びその自動操舵装置 | |
| JPH03109611A (ja) | 車両用自動操縦制御装置 | |
| JPS6133514A (ja) | 位置制御装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 19980310 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090410 Year of fee payment: 11 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090410 Year of fee payment: 11 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100410 Year of fee payment: 12 |
|
| LAPS | Cancellation because of no payment of annual fees |