JPH0546241A - 自律走行車両の操舵制御装置 - Google Patents

自律走行車両の操舵制御装置

Info

Publication number
JPH0546241A
JPH0546241A JP3222314A JP22231491A JPH0546241A JP H0546241 A JPH0546241 A JP H0546241A JP 3222314 A JP3222314 A JP 3222314A JP 22231491 A JP22231491 A JP 22231491A JP H0546241 A JPH0546241 A JP H0546241A
Authority
JP
Japan
Prior art keywords
vehicle
steering
traveling
steering control
white 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.)
Granted
Application number
JP3222314A
Other languages
English (en)
Other versions
JP2803404B2 (ja
Inventor
Akira Hattori
彰 服部
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nissan Motor Co Ltd
Original Assignee
Nissan Motor Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nissan Motor Co Ltd filed Critical Nissan Motor Co Ltd
Priority to JP3222314A priority Critical patent/JP2803404B2/ja
Publication of JPH0546241A publication Critical patent/JPH0546241A/ja
Application granted granted Critical
Publication of JP2803404B2 publication Critical patent/JP2803404B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Steering Control In Accordance With Driving Conditions (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

(57)【要約】 【目的】 様々な曲率を有する現実の道路への汎用的な
適用が可能となる自律走行車両の操舵制御装置を提供す
る。 【構成】 車両a前部に設けた撮像手段eにより車両a
前方の路面を撮影し、この路面画像に基づいて、画像処
理手段fによりその左右に設けられた基準線b、cの位
置を算出する。次いで、画像処理手段手段fで得られた
基準線b、cの位置に基づいて、車両aの旋回時におい
て車両aの側部が内側基準線bの近傍でその接線方向に
なるような走行経路を求め、この走行経路に沿って車両
aを走行させる操舵角信号を操舵制御手段gにより算出
し、この操舵制御手段gで得られた操舵角信号に応じ
て、ステアリング駆動手段hにより車両のステアリング
装置を駆動する。

Description

【発明の詳細な説明】
【0001】
【産業上の利用分野】本発明は、路面上に設けられた白
線(センターライン)等の基準線に沿って無人で自走す
る自律走行車両に係り、詳しくは、自律走行車両の操舵
制御を行う装置に関する。
【0002】
【従来の技術】従来の自律走行車両としては、車両前方
の路面を撮像装置で撮影し、撮像装置の画像内から路面
上に設けられたセンターライン等の基準線を画像処理に
より抽出し、この基準線に沿った走行目標点を設定し、
この走行目標点に向って車両が走行するように操舵角を
決定するようなものがあった(特開平2−48708号
公報参照)。
【0003】特開平2−48708号公報に示す例で
は、左端の基準線から所定距離だけ内方に走行目標点を
設定し、あるいは道路の幅が狭い場合には道路の中央に
走行目標点を設定し、この走行目標点に向って車両が走
行するように操舵角を決定していた。さらに、車速が予
め設定された閾値を越える高速領域にあるときに曲りく
ねった道を走行する場合には、図10に示すように、車
両に作用する横方向の加速度ができるだけ軽減されるよ
うな穏やかな曲率をもった走行目標点OCを設定してい
た。
【0004】
【発明が解決しようとする課題】しかしながら、上述し
た従来の自律走行車両にあっては、曲りくねった道を高
速で走行する際に、車両に作用する横方向の加速度を軽
減することのみを考慮して穏やかな曲率をもった走行目
標点OCを設定しているので、実際に車両が走行する経
路がセンターラインや車道境界線等の基準線を越えてし
まう可能性があった。従って、従来の自律走行車両は、
種々の曲率を有する現実の道路への適用が困難であっ
た。
【0005】本発明の目的は、車両の旋回時において内
側基準線を越えないような走行経路を設定することで現
実の道路への適用が可能となる自律走行車両の操舵制御
装置を提供することにある。
【0006】
【課題を解決するための手段】クレーム対応図である図
1に対応付けて説明すると、本発明は、少なくとも左右
2本の基準線b、cで規定される走行路dに沿って走行
する自律走行車両aの操舵制御装置に適用される。そし
て、上述した目的は、前記車両a前方の路面を撮影する
撮像手段eと、前記撮像手段eで得られた画像に基づい
て、前記基準線b、cの位置を算出する画像処理手段f
と、前記画像処理手段fで得られた基準線b、cの位置
に基づいて、前記車両aの旋回時において車両aの側部
が内側基準線bの近傍でその接線方向になるような走行
経路を求め、この走行経路に沿って車両aを走行させる
操舵角信号を出力する操舵制御手段gと、前記操舵制御
手段gで得られた操舵角信号に応じてステアリング装置
を駆動するステアリング駆動手段hとを設けることによ
り達成される。
【0007】
【作用】撮像手段eは車両a前方の路面を撮影し、画像
処理手段fは、この路面画像に基づいてその左右に設け
られた基準線b、cの位置を算出する。操舵制御手段g
は、画像処理手段手段fで得られた基準線b、cの位置
に基づいて、車両aの旋回時において車両aの側部が内
側基準線bの近傍でその接線方向になるような走行経路
を求め、この走行経路に沿って車両aを走行させる操舵
角信号を出力し、ステアリング駆動手段hは、操舵制御
手段gで得られた操舵角信号に応じてステアリング装置
を駆動する。
【0008】
【実施例】以下、図面を参照して、本発明の実施例につ
いて詳細に説明する。図2は、本発明による自律走行車
両の操舵制御装置の一実施例を示すブロック図、図3は
自律走行車両の外観を示す概略図である。
【0009】図3において、1は自律走行車両(以下、
単に車両と称する)であり、この車両1は、その前部に
設けられた撮像装置2により車両前方の路面を撮影して
この路面の両端に引かれた白線(基準線)3を検出し、
この白線3に沿って走行目標点を設定して操舵制御する
ことにより、白線3に沿った経路を自走するものであ
る。
【0010】車両1は、図2に示すように、撮像装置1
0、画像処理装置11、地図情報装置12、走行制御装
置13、操舵制御装置14およびステアリング制御装置
15を備えている。
【0011】撮像装置10は例えばTVカメラであり、
上述したように車両1の前部に固定されてこの車両1の
前方にある路面画像を撮影する。撮影された路面画像デ
ータは、画像処理装置11に送出される。
【0012】画像処理装置11は、撮像装置10から送
出された路面画像データの中から、周知の画像処理方法
により路面の両端に引かれた白線3を抽出し、この画像
中の白線3の位置に基づいて、車両1の前方に設けられ
た所定の前方注視点から白線3までの距離、およびこの
前方注視点における車両1に対する白線3の傾きを算出
する。なお、白線3の抽出方法、および前方注視点から
白線3までの距離および傾きの測定方法は周知であり、
その説明を省略する。算出された白線距離データおよび
白線傾きデータは操舵制御手段14に送出される。
【0013】地図情報装置12には、走行すべき経路に
ついての地図データ等のデータが格納されている。この
地図データには、例えば走行路のノードおよびパス等の
データが含まれる。なお、ノードとは道路の直線部と曲
線部との境界の点であり、パスとは隣り合うノード間の
距離である。
【0014】走行制御装置13は、地図情報装置12内
に格納されたデータに基づいて、指定された経路に従っ
た経路データを決定する。この経路データとしては、例
えば、走行車速、走行距離、進行経路(分岐点でどちら
に曲るか)、曲線部の回転半径等のデータがある。決定
された経路データは、操舵制御装置14に送出される。
【0015】操舵制御装置14は、走行制御装置13か
ら出力される経路データと、画像処理装置11から出力
される白線データとに基づいて、指定された経路に従っ
て走行する場合の操舵角を重回帰分析により算出する。
算出された操舵角指令値はステアリング駆動装置15に
送出される。
【0016】ステアリング駆動装置15は、操舵制御装
置14で得られた操舵角指令値に応じてアクチュエータ
を作動させ、ステアリング装置を駆動する。
【0017】なお、実施例と請求の範囲との対応におい
て、白線3は基準線を、撮像装置10は撮像手段を、画
像処理装置11は画像処理手段を、操舵制御装置14は
操舵制御手段を、ステアリング駆動装置15はステアリ
ング駆動手段をそれぞれ構成している。
【0018】次に、本実施例の作用を説明する。図4
は、本実施例におけるデータの流れを示す図である。図
4において、画像処理手段11で算出された白線データ
(x,θ)は操舵制御装置14に送出され、この白線デ
ータに基づいて、標準目標点距離Tおよび限界目標点距
離Wが操舵制御装置14によって算出される。これら標
準目標点距離データTおよび限界目標点距離データW、
そして白線傾きデータθに基づいて、L[m]先の前方注
視点における走行目標点距離tが操舵制御装置14によ
って算出される。そして、この走行目標点距離tおよび
白線距離データxに基づいて、操舵角S(x,t)が操
舵制御装置14によって算出され、この操舵角データS
はステアリング駆動装置15に送出される。以下、この
算出手順についてそれぞれ説明を行うが、白線データ算
出方法については上述のごとくその説明を省略する。
【0019】(1) 標準目標点、限界目標点 本実施例の特徴は、車両1の旋回時においてその内輪差
により車両1の側部が内側にある白線3を越えないよう
に操舵制御がなされる点である。そこで、車両1が旋回
時に内側白線3を越えないための条件について、図5を
参照して検討する。
【0020】図5(a)は白線3の曲線半径r1が小さい
場合、(b)は曲線半径r2が大きい場合を示す図であ
る。いま、車両の中心を前輪タイヤの中心としたとき、
図5に示すように車両1の側部が内側白線3との接線に
なるようにして走行する場合を仮定すると、前輪中心O
1、O2から白線3までの距離w1、w2は w1=(k/sinα)−r12=(k/sinβ)−r2 (k:前輪−後輪間のトレッド、α、β:操舵角) で表される(この場合、車両の最も内側部と曲線路の中
心とを結ぶ曲線半径がr2>r1であるからw1>w2とな
る)。ここで、前輪中心O1、O2と白線3の曲線中心O
とを結ぶ線(つまり白線3の半径)と白線3との交点P
1、P2における白線3の接線c1、c2のなす角(接線
角)は、図5に示すように操舵角α、βと等しいことが
幾何学的に証明できるので、この関係を用いて距離wを
一般式で表すと、 w=(k/sinΘ)−r ……(1) (Θは接線角、すなわち白線3の傾き) となる。この距離wを限界目標点距離Wとする。
【0021】一方、車両1の直進時には走行路の中央を
走行するものとして設定し、車両1の左右にある白線の
距離データの平均値を車両1の目標点距離とする。この
距離を標準目標点距離Tとする。
【0022】(2) 走行目標点 図6は、車両1の旋回時における走行目標点の設定手順
を説明するための図である。図6において、上述の標準
目標点距離Tを走行目標点距離tとするならば、車両1
は図中の点線に示す経路上に走行目標点が設定されて走
行することになるが、本実施例では、車両1の旋回時に
おいて徐々に内側白線3に近付き、曲線部の中間点を境
にして今度は内側白線3から徐々に遠ざかるような経路
(図中の1点鎖線)上に走行目標点が設定されている。
【0023】いま、車両1が図6に示すように走行路の
直線部から曲線部に向って走行している場合を考える。
車両1の進行方向前方に複数の前方注視点、例えばd
i-1、di、di+1を設定し、前方注視点diにおいてその
横方向に走行目標点Tgを設けたとすれば、この走行目
標点Tgから内側白線3までの距離(以下、走行目標点
距離と称する)t(n)を次式で与える。 t(n)=T-|[{θ(i)-θ(i-1)}+{θ(i+1)-θ(i)}]/2|×ε (t(n)>W+γ) …(2) t(n)=W+γ (t(n)≦W+γ) ……(3) (ただし|X|はXの絶対値を表す) ここに、θ(i-1)、θ(i)、θ(i+1)はそれぞれの前方注
視点における白線3の接線角、γはオフセット値、εは
比例定数である。
【0024】(2)式は差分(微分)式であり、走行路が
直線部である場合は白線3の接線角(つまり傾き)の微
分値は0であるためt(n)=Tであるが、曲線部の入口に
近付くにつれてt(n)<Tとなり、走行目標点Tgは内側
白線3に向って徐々に近付く。また、曲線の曲率によっ
て白線3の接線角の微分値が定まるので、曲線の曲率が
変化すればそれに従ってt(n)も変化する。そして、曲線
部の中間点を境として、走行路が曲線部の出口に近付く
につれてt(n)は増加し、走行目標点Tgは内側曲線3か
ら徐々に離れて直線部において再度t(n)=Tとなる。
【0025】t(n)=W+γにおいて車両1の上方から平
面的に見ると、その側部は内側白線3に接する。そこ
で、(2)式においてt(n)がW+γより小さくなると、
(3)式によって走行目標点Tgがそれ以上内側白線3に
近付かないように制限がかけられる。
【0026】なお、(1)式における白線3の曲線半径r
は、前方注視点di-1、di+1における白線3の距離デー
タx(i-1)、x(i+1)および傾きデータθ(i-1)、θ(i+1)
から求められるが、その算出手順は省略する。
【0027】(3) 操舵角 本実施例では、重回帰分析により操舵角Sの演算を行っ
ている。本発明者は、その詳細について既に出願を行っ
ているので(特願平3−68571号明細書)、本実施
例ではその概略についてのみ説明する。
【0028】走行路の曲線部においては、車両前方の白
線3の距離データの変化に遅れて操舵角の変化が同じよ
うな変化として現れる。そこで、所定時間後における操
舵角Sを、そのときの白線3の距離データの変化によっ
て重回帰分析により推定すれば適切な値が得られる。重
回帰式の中ではこのデータを無数に定義できるが、実験
の結果、現在、過去(1)、およびさらに手前の過去(2)
で十分であることが確認されている。従って、入力すべ
き値としては、現在の白線距離データx(n)、1制御周
期前のデータx(n-1)および2制御周期前のデータx(n-
2)である。この場合、所定時間後における操舵角Sを示
す関係式(回帰関数式f)は、 S=k1×(x(n)-t)+k2×(x(n-1)-t)+k3×(x(n-2)-t) =k1×x(n)+k2×x(n-1)+k3×x(n-2)+d ……(4) (但し、k1、k2、k3、dは定数、nは離散的な時刻) で表される。これら定数は、実際の白線距離データおよ
び実操舵角に基づいて重回帰分析法により導出される。
【0029】図7〜図9は、本発明者による操舵制御の
シミュレーション結果を示す図である。条件としては、
道路幅が4[m]、曲線部の曲率半径r=15[m]、車速10
[km/h]であり、t=2、4、0[m]の3種類について
シミュレーションを行った。これら図に示すように、t
の値を変化させるだけで忠実に指定されたtの位置で車
両が走行していることが理解できる。
【0030】従って、本実施例によれば、車両1の旋回
時にその側部が内側白線3に接するような操舵制御を行
ったので、従来のように曲りくねった道を走行する場合
にも実際に車両が走行する経路がセンターラインや車道
境界線等の基準線を越えることがなく、従って、曲率が
様々に変化する現実の道路等にも適用が可能となる。
【0031】しかも、単純に道の真ん中を走行させる場
合に比較して、曲線部内における経路がより直線に近く
なり、この曲線部内において操舵角を大きくとる必要が
ないため、車両旋回時の操舵保持力を低くすることがで
きる。このため、旋回時における車両1の横方向に作用
する加速度を減少することができ、旋回時の走行速度を
車両安定域の限界まで上昇させることが可能となる。さ
らに、道の真ん中を走行させる場合に比較して走行距離
の短縮化を図ることができ、省エネ走行にも効果的であ
る。
【0032】なお、本発明の自律走行車両の操舵制御装
置は、その細部が上述の一実施例に限定されず、種々の
変形例が可能である。一例として、上述の一実施例では
ステアリング装置の操舵角の制御のみを行っていたが、
白線の傾きデータを用いて車速を制御することも可能で
ある。たとえば、車速をv、標準車速をVとすれば、 v=V-|[{θ(i)-θ(i-1)}+{θ(i+1)-θ(i)}/2]|×ε´ (v>0)……(5) (但しε´は比例定数) なる式で車速vを制御することができる。(5)式からも
明らかなように、車速vは車両1が直線部を走行してい
る場合にv=Vであり、曲線部の入口に近くなるにつれ
て徐々に減速し、曲線部の出口に近くなると再度加速し
てv=Vとなる。
【0033】
【発明の効果】以上詳細に説明したように、本発明によ
れば、車両の旋回時に車両側部が内側基準線の近傍でそ
の接線方向になるような走行経路に沿ってこの車両を走
行させるような操舵制御を行ったので、曲率が様々に変
化する現実の道路等にも適用が可能となる。しかも、単
純に道の真ん中を走行させる場合に比較して旋回時にお
ける経路がより直線に近くなり、操舵角を大きくとる必
要がないため、車両旋回時の操舵保持力を低くすること
ができる。このため、旋回時における車両の横方向に作
用する加速度を減少することができ、旋回時の走行速度
を車両安定域の限界まで上昇させることが可能となる。
さらに、道の真ん中を走行させる場合に比較して走行距
離の短縮化を図ることができ、省エネ走行にも効果的で
ある。
【図面の簡単な説明】
【図1】本発明のクレーム対応図である。
【図2】本発明の一実施例である自律走行車両の操舵制
御装置の回路構成を示すブロック図である。
【図3】自律走行車両の外観を示す概略図である。
【図4】一実施例のデータの流れを示す図である。
【図5】限界目標点距離の算出方法を説明するための図
である。
【図6】走行目標点距離の算出方法を説明するための図
である。
【図7】一実施例による車両の操舵制御のシミュレーシ
ョン結果を示す図である。
【図8】図7と同様の図である。
【図9】図7と同様の図である。
【図10】従来の自律走行車両における目標走行点の設
定位置の一例を示す図である。
【符号の説明】
a 車両 b、c 基準線 d 走行路 e 撮像手段 f 画像処理手段 g 操舵制御手段 h ステアリング駆動手段 1 自律走行車両 2、10 撮像装置 3 白線 11 画像処理装置 12 地図情報装置 13 走行制御装置 14 操舵制御装置 15 ステアリング駆動装置

Claims (1)

    【特許請求の範囲】
  1. 【請求項1】 少なくとも左右2本の基準線で規定され
    る走行路に沿って走行する自律走行車両の操舵制御装置
    において、 前記車両の前方の路面を撮影する撮像手段と、 前記撮像手段で得られた画像に基づいて、前記基準線の
    位置を算出する画像処理手段と、 前記画像処理手段で得られた基準線の位置に基づいて、
    前記車両の旋回時において車両側部が内側基準線の近傍
    でその接線方向になるような走行経路を求め、この走行
    経路に沿って車両を走行させる操舵角信号を出力する操
    舵制御手段と、 前記操舵制御手段で得られた操舵角信号に応じてステア
    リング装置を駆動するステアリング駆動手段とを備えた
    ことを特徴とする自律走行車両の操舵制御装置。
JP3222314A 1991-08-07 1991-08-07 自律走行車両の操舵制御装置 Expired - Fee Related JP2803404B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP3222314A JP2803404B2 (ja) 1991-08-07 1991-08-07 自律走行車両の操舵制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP3222314A JP2803404B2 (ja) 1991-08-07 1991-08-07 自律走行車両の操舵制御装置

Publications (2)

Publication Number Publication Date
JPH0546241A true JPH0546241A (ja) 1993-02-26
JP2803404B2 JP2803404B2 (ja) 1998-09-24

Family

ID=16780420

Family Applications (1)

Application Number Title Priority Date Filing Date
JP3222314A Expired - Fee Related JP2803404B2 (ja) 1991-08-07 1991-08-07 自律走行車両の操舵制御装置

Country Status (1)

Country Link
JP (1) JP2803404B2 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8737537B2 (en) 2006-03-29 2014-05-27 Thomson Licensing Frequency translation module frequency limiting amplifier
WO2023085093A1 (ja) * 2021-11-12 2023-05-19 Jfeスチール株式会社 案内装置、案内方法、計測装置、物体の製造設備、計測方法、物体の製造方法、及び物体の品質管理方法

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8737537B2 (en) 2006-03-29 2014-05-27 Thomson Licensing Frequency translation module frequency limiting amplifier
WO2023085093A1 (ja) * 2021-11-12 2023-05-19 Jfeスチール株式会社 案内装置、案内方法、計測装置、物体の製造設備、計測方法、物体の製造方法、及び物体の品質管理方法
JPWO2023085093A1 (ja) * 2021-11-12 2023-05-19
EP4414668A4 (en) * 2021-11-12 2025-01-29 JFE Steel Corporation GUIDING DEVICE, GUIDING METHOD, MEASURING DEVICE, PRODUCT MANUFACTURING EQUIPMENT, MEASURING METHOD, PRODUCT MANUFACTURING METHOD AND PRODUCT QUALITY MANAGEMENT METHOD

Also Published As

Publication number Publication date
JP2803404B2 (ja) 1998-09-24

Similar Documents

Publication Publication Date Title
JP2835764B2 (ja) 自動走行装置
JP2669031B2 (ja) 自律走行車両
EP0448059B1 (en) Automatic travelling apparatus
JP2660727B2 (ja) 自動走行装置
JPH03265008A (ja) 自動走行装置
JP3015875B2 (ja) 自動車運転時の車線逸脱検出方法及び検出装置
JPH11208386A (ja) 車両運動制御装置
CN112513571B (zh) 距离计算装置
JPH11211492A (ja) 道路情報認識装置
JPH03113513A (ja) 自律走行車両の車速感応操舵制御装置
JP2844243B2 (ja) 自動走行装置
CN118991754A (zh) 车辆控制装置及方法
JP2707546B2 (ja) 車両の操舵制御装置
JP2803404B2 (ja) 自律走行車両の操舵制御装置
JPH06225308A (ja) 走行路検出装置
CN117922603A (zh) 轨道生成装置、轨道生成方法、存储介质以及移动体
JP2720630B2 (ja) 自律走行車の操舵制御装置
JPH04304502A (ja) 自律走行車における重回帰式による操舵制御装置
JP2881248B2 (ja) 移動車の環境認識装置
JPH10103968A (ja) カーブ曲率推定装置
JP3054952B2 (ja) 自動走行装置
JPH0344712A (ja) 自律走行車
JP2765877B2 (ja) 移動車の画像処理装置
JP2910142B2 (ja) 車両操舵角制御方法
KR100394671B1 (ko) 차선 이탈 판정 방법

Legal Events

Date Code Title Description
LAPS Cancellation because of no payment of annual fees