JP3933085B2 - Automatic steering device for vehicles - Google Patents
Automatic steering device for vehicles Download PDFInfo
- Publication number
- JP3933085B2 JP3933085B2 JP2003108235A JP2003108235A JP3933085B2 JP 3933085 B2 JP3933085 B2 JP 3933085B2 JP 2003108235 A JP2003108235 A JP 2003108235A JP 2003108235 A JP2003108235 A JP 2003108235A JP 3933085 B2 JP3933085 B2 JP 3933085B2
- Authority
- JP
- Japan
- Prior art keywords
- set time
- vehicle
- gaze point
- steering
- calculated
- 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 - Lifetime
Links
Images
Landscapes
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Description
【0001】
【発明の属する技術分野】
本発明は、自動操舵を行う車両用自動操舵装置に関するものである。
【0002】
【従来の技術】
従来、この種の車両用自動操舵装置として、例えば、所定時間後に自車両が到達する遠方先読み地点と、上記所定時間より短い所定時間後に自車両が到達する近傍先読み地点とを夫々算出し、次いで遠方先読み地点での道路の曲がり具合に応じたフィードフォワード制御用の操舵量と、近傍先読み地点での道路に対する自車位置のずれ具合に応じたフィードバック制御用の操舵補正量とを夫々算出し、これら操舵量と操舵補正量とに基づいて車両の操舵制御を行うように構成された車両走行制御装置がある(特許文献1参照)。
【0003】
【特許文献1】
特開2000−122719号公報
【0004】
【発明が解決しようとする課題】
しかしながら、上記従来例にあっては、遠方先読み地点及び近傍先読み地点は、各所定時間後に自車両が到達する夫々の地点として算出されるように構成されているので、例えば、低車速であるほど遠方先読み地点及び近傍先読み地点が共に自車両の手前に寄ってしまうことで自車両がカーブに接近しているのにカーブに進入する直前まで操舵が開始されなかったり、逆に高車速であるほど遠方先読み地点及び近傍先読み地点が共に自車両から遠く離れてしまうことで自車両がカーブに十分接近していないのにカーブ手前から操舵が開始されたりして、スムーズな操舵を確保できないという未解決の課題がある。
そこで、本発明は上記従来例の未解決の課題に着目してなされたものであり、スムーズな自動操舵を実現できる車両用自動操舵装置を提供することを目的としている。
【0005】
【課題を解決するための手段】
上記目的を達成するために、本発明の車両用自動操舵装置は、自車速に応じて第1設定時間及び第2設定時間を算出し、自車両を走行させる基準経路で、第1設定時間が経過するときに自車両が通過する第1前方注視地点、及び前記第2設定時間が経過するときに自車両が通過する第2前方注視地点を夫々設定し、当該第1前方注視地点における道路形状に応じた第1操舵量、及び第2前方注視地点を自車両が通過する際の基準経路との横偏差に応じた第2操舵量を夫々算出し、当該第1操舵量及び第2操舵量の加算値に基づいて自車両の操舵制御を行うことを特徴としている。
【0006】
【発明の効果】
本発明の車両用自動操舵装置によれば、自車速に応じて第1設定時間及び第2設定時間を算出し、自車両を走行させる基準経路で、第1設定時間が経過するときに自車両が通過する第1前方注視地点、及び前記第2設定時間が経過するときに自車両が通過する第2前方注視地点を夫々設定し、この第1前方注視地点における道路形状に応じた第1操舵量と、第2前方注視地点を自車両が通過する際の基準経路との横偏差に応じた第2操舵量とを夫々算出し、これらの第1操舵量及び第2操舵量の加算値に基づいて自車両の操舵制御を行うように構成されているので、第1前方注視地点及び第2前方注視地点の双方が、自車速に応じて自車両の手前に寄ったり自車両から遠く離れたりすることを抑制することができ、結果としてスムーズな自動操舵を実現できるという効果が得られる。
【0007】
【発明の実施の形態】
以下、本発明の実施形態を図面に基づいて説明する。
図1は、本発明の一実施形態を示す概略構成図であり、図中、1FL、1FR、1RL及び1RRは夫々左前輪、右前輪、左後輪及び右後輪であり、後輪1RL及び1RRは、エンジン2の駆動力が自動変速機3、プロペラシャフト4、最終減速装置5及び車軸6を順に介して伝達される駆動輪である。
【0008】
また、前輪1FL及び1FRは、ステアリングギヤ7、ステアリングシャフト8を介してステアリングホイール9に連結された操舵輪であり、ステアリングシャフト8には、電動モータで構成された操舵アクチュエータ10が連結されている。この操舵アクチュエータ10は、後述するコントローラ16から出力される操舵制御量δCに応じて、前輪1FL及び1FRの操舵方向、操舵角、及び操舵速度を制御するように構成されている。
【0009】
また、各車輪1FL〜1RRには、車輪の回転速度に応じた周波数の車輪速VFL〜VRRを出力する車輪速センサ11FL〜11RRが配設されている。さらに、車両には、前後加速度Xgを検出する前後加速度センサ12と、横加速度Ygを検出する横加速度センサ13と、ヨーレートφを検出するヨーレートセンサ14とが備えられている。
【0010】
また、車両には、人口衛星から送られる衛星電波を受信して現在の自車位置を検出するGPS14と、所定領域の道路地図情報を記憶したCD−ROMやDVD−ROM等の記憶媒体がセットされた記憶ユニット15とが搭載されている。これら、各車輪速センサ11FL〜11RRで検出する車輪速VFL〜VRRと、前後加速度センサ12で検出される前後加速度Xgと、横加速度センサ13で検出される横加速度Ygと、GPS14で検出する自車位置情報と、記憶ユニット15に記憶された道路地図情報とが、例えばマイクロコンピュータで構成されたコントローラ16に入力される。このコントローラ16では、図2の操舵制御処理を常時実行することで前述した操舵アクチュエータ10に対する操舵制御量δCの出力を制御し、自動操舵により自車両を基準経路に沿って走行させるように構成されている。
【0011】
次に、コントローラ16で常時実行する操舵制御処理を図2のフローチャートに従って説明する。
先ず、ステップS1では、GPS14で検出された自車位置に従って記憶ユニット15に記憶された道路地図情報を読込み、道路地図情報を構成するノードデータ(X,Y)のうち、図2に示すように、自車位置を基準とし前後に所定距離だけとった範囲(Xo,Yo)〜(Xn,Yn)を常時バッファに保有する。ここで、前方側の距離は、例えば、車速Vに所定時間t1を乗じた値(=V・t1)、又は予め設定した最小値のうち大きい方に設定する。
【0012】
次に、ステップS2に移行して、各種センサから出力される各車輪速VFL〜VRRと、前後加速度Xgと、横加速度Ygと、ヨーレートφとを読込んだら、続いて移行するステップS3で各車輪速VFL〜VRRの平均から車速VCを算出する。次に、ステップS4に移行して、図3の設定時間算出マップを参照して、ステップS3で算出した車速VCから第1設定時間T1及び第2設定時間T2を夫々設定する。この設定時間算出マップは、図3に示すように、横軸が車速VCを、縦軸が設定時間Tを夫々表している。そして、第1設定時間T1は、実線で示すように、車速VCが低車速から増加するときに比較的大きな値THから徐々に減少すると共に、その減少率が車速VCの増加に応じて次第に緩やかになるように設定され、一方の第2設定時間T2は、一点鎖線で示すように車速VCが低車速から増加するときに前述したTHよりも小さな値TLから徐々に増加すると共に、その増加率が車速VCの増加に応じて次第に緩やかになるように設定される。また、車速VCが中速域の所定値VMを上回るときに、第1設定時間T1及び第2設定時間T2における大小の関係が逆転するように構成されている。
【0013】
そして、ステップS5に移行して、ステップS4で算出された第1設定時間T1が経過するときに自車両が通過する第1前方注視地点P1を算出する。具体的には、第1設定時間T1に車速VCを乗じてT1が経過する間に自車両が進む距離D1(=T1・VC)を算出し、現在の自車位置から距離D1分だけ進んだ地点における最寄りのノードを夫々第1前方注視地点P1として設定する。
【0014】
次に、ステップS6に移行して、ステップS5で算出された第1前方注視地点P1における道路の曲率半径ρを算出する。先ずは、図4に示すように、P1を中央として前後に所定距離DSをとった地点における最寄りのノードをPF及びPRとし、P1及びPRを結ぶ線分P1PRと、P1及びPFを結ぶ線分P1PFとで成す角度θと、PF及びPRの距離dとを夫々算出する。ここで、所定距離DSは、車速Vに例えば1秒程度の一定時間t2を乗じて算出する。なお、所定距離DSが極めて短くなることを抑制するために最小値DMINを設定し、この最小値DMIN及び車速Vに応じて算出される値のうち大きい方を所定距離DSとして算出してもよい。そして、PF、P1及びPRを通る円弧の中心Oは、線分P1PFの中点aを通る垂直2等分線Aと、線分P1PRの中点bを通る垂直2等分線Bとの交点であり、線分P1PRと線分P1PFとで成す角度θは、垂直2等分線A及びBの成す∠aObに等しくなる。また∠PFOPRは∠aObの2倍であるので、下記(1)式に従って、角度θ及び距離dから曲率半径ρを算出する。
ρ=d/2・sinθ ・・・・・・(1)
【0015】
次に、ステップS7に移行して、ステップS6で算出された第1前方注視地点P1での曲率半径ρと、車両のホイールベースLとに基づいて、下記(2)式より第1操舵量δ1を算出する。
δ1=L/ρ ・・・・・・(2)
そして、ステップS8に移行して、前記ステップS4で算出された第2設定時間T2が経過するときに自車両が通過する第2前方注視地点P2を算出する。具体的には、GPS14から今回読込んだ自車位置及び前回読込んだ自車位置の位置関係から自車両の速度ベクトルVを算出すると共に、第2設定時間T2に車速VCを乗じてT2が経過する間に自車両が進む距離D2(=T2・VC)を算出し、現在の自車位置から速度ベクトルVの延長上を距離D2分だけ進んだ地点を第2前方注視地点P2として設定する。
【0016】
次に、ステップS9に移行して、ステップS7で算出された第2前方注視地点P2を自車両が通過するときの基準経路に対する横偏差YEを算出する。この基準経路に対する横偏差YEは、自車両の車両姿勢から求まる横偏差YSと、車両旋回状態から求まる横偏差YPとを加算して算出する。
先ず、車両のスリップ角θSは、前後加速度Xg及び横加速度Ygを用いて下記(2)式のように表される。
θS=tan-1(Yg/Xg) ・・・・・・(3)
【0017】
また、図5に示すような基準座標上における自車両のヨー角をε1、第2前方注視地点P2を通り速度ベクトルVに直角な直線Cと基準経路との交点Qにおける基準座標に対する基準経路のずれ角をεTとすると、基準経路に対する自車両のヨー角εRを、下記(4)式のように表すことができる。
εR=εT−ε1 ・・・・・・(4)
【0018】
さらに、初期状態における基準経路と自車位置との横偏差をYUとすると、車両姿勢に応じた横偏差YSは下記(5)式のように表されるので、この(5)式に従って、YU、D2、εR及びθSから車両姿勢に応じた横偏差YSを算出する。
YS=YU+D2・tan(εR+θS) ・・・・・・(5)
【0019】
次に、車両が定常円旋回を行っているとすると、スリップレートを無視することができるので、車両旋回状態から求まる横偏差YPは、下記(6)式で表すことができ、この(6)式中のβは、下記(7)で表すことができる。したがって、これら(6)及び(7)式を解き、車両旋回状態に応じた横偏差YPを算出する。
YP=D2・tanβ ・・・・・・(6)
β=1/2・sin-1(D2・ε1/Xg) ・・・・・・(7)
こうして算出された横偏差YSと横偏差YPとを加算して基準経路に対する横偏差YE(=YS+YP)を算出したら、ステップS10に移行する。
【0020】
このステップS10では、ステップS9で算出された第2前方注視地点P2を通過する基準経路に対する横偏差YEに基づいて、下記(8)式より第2操舵量δ2を算出する。ここで、K1及びK2は係数であり、直線走行時の外乱に対して追従誤差が拡大しないように最適な値を実験から求めることが望ましい。
δ2=K1・YE+K2・(dYE/dt) ・・・・・・(8)
そして、ステップS11に移行して、前記ステップS7で算出された第1操舵量δ1と、ステップS10で算出された第2操舵量δ2とを加算して、操舵制御量δC(=δ1+δ2)を算出してから、続くステップS12に移行して、この操舵制御量δCを操舵アクチュエータ10に出力し、前記ステップS1に戻る。
【0021】
以上より、図1のGPS14及び記憶ユニット15と、図3におけるステップS1の処理とが基準経路検出手段に対応し、図1の各車輪速センサ11FL〜11RRと、図3におけるステップS3の処理とが車速検出手段に対応している。また、ステップS4の処理が第1設定時間算出手段及び第2設定時間算出手段に対応し、ステップS5の処理が第1前方注視地点設定手段に対応し、ステップS6の処理が道路形状検出手段に対応し、ステップS7の処理が第1操舵量算出手段に対応し、ステップS8の処理が第2前方注視地点設定手段に対応し、ステップS9の処理が横偏差検出手段に対応し、ステップS10の処理が第2操舵量算出手段に対応し、図1の操舵アクチュエータ10と、図3におけるステップS11及びステップS12の処理とが操舵制御手段に対応している。
【0022】
次に、上記一実施形態の動作について説明する。
今、自車両を自動操舵で走行させているとすると、コントローラ16で常時実行される操舵制御処理では、先ず、GPS15で検出される自車位置を基準にして所定範囲の道路地図情報を記憶ユニット16から読み出し、自車両を走行させる基準経路を検出している(ステップS1)。
【0023】
そして、図3の設定時間算出マップを参照して自車速Vに応じた第1設定時間T1及び第2設定時間T2を算出し(ステップS4)、自車両が走行する基準経路で、各第1設定時間T1及び第2設定時間T2が経過するときに自車両が通過する第1前方注視地点P1と第2前方注視地点P2とを設定する(ステップS5及びステップS8)。
【0024】
このとき、第1設定時間T1は車速が高いほど短くなるように設定され、逆に第2設定時間T2は車速が高いほど長くなるように設定され、且つ両者の相対的な関係が、低速走行時には第2設定時間T2よりも第1設定時間T1の方が長くなるように、逆に高速走行時には第1設定時間T1よりも第2設定時間T2の方が長くなるように設定される。
【0025】
次に、設定された第1前方注視地点P1における基準経路の曲率半径ρを算出し(ステップS6)、この曲率半径ρに応じて自車両に必要とされるフィードフォワード的な、すなわち車両挙動のスムーズさを向上させる第1操舵量δ1を算出する(ステップS7)。また、比較的近くに設定された第2前方注視地点P2を自車両が通過する際の基準経路との横偏差YEを、現在の車両姿勢及び旋回状態に基づいて算出し(ステップS9)、この横偏差YEに応じて自車両に必要とされるフィードバック的な、すなわち基準経路に対する追従性を向上させる第2操舵量δ2を算出する(ステップS10)。
【0026】
こうして、フィードフォワード的な第1操舵量δ1と、フィードバック的な第2操舵量δ2とを加算して求めた操舵制御量δCを、電動モータで構成された操舵アクチュエータ10に対して出力することにより、操舵輪としての前輪1FL及び1FRの操舵方向、操舵角、及び操舵速度を制御する(ステップS11及びステップS12)。
【0027】
したがって、自車両が低速で走行している場合には、第1前方注視地点P1は比較的遠くに設定されるので、この低速走行状態でカーブに接近するとフィードフォワード的に作用する第1操舵量δ1の値が増加してゆくことにより操舵開始の遅れが防止される。
また、自車両が高速で走行している場合には、第1前方注視地点P1は自車両から遠ざかることが抑制されるので、フィードフォワード的に作用する第1操舵量δ1の増加を抑制し、カーブに十分接近していないのにカーブ手前から操舵が開始されることが防止される。また、フィードバック的に作用する第2操舵量δ2を算出するための第2前方注視地点P2が比較的遠くに設定されることにより、車両挙動のスムーズさが更に向上する。
【0028】
このように、車速Vに応じて第1設定時間T1及び第2設定時間T2の値が変更されるので、第1前方注視地点P1及び第2前方注視地点P2の双方が、自車速に応じて自車両の手前に寄ったり自車両から遠く離れたりすることが抑制され、スムーズな自動操舵が実現される。
【0029】
なお、上記一実施形態においては、設定時間算出マップを図4で示したように、第2設定時間T2は、低速走行時よりも高速走行時の方が長くなるように設定されている場合について説明したが、これに限定されるものではない。例えば、図7(a)に示すように、第2設定時間T2を車速Vの変化に係りなく常に一定値に設定すると共に、第1設定時間T1が低速走行時には第2設定時間T2よりも長く、高速走行時には第2設定時間T2よりも短くなるように設定することにより、第1前方注視地点P1及び第2前方注視地点P2の双方が、車速Vの増加に応じて自車両から遠く離れることを抑制してもよい。また、図7(b)に示すように、車速Vが中速の所定範囲にあるときに、第1設定時間T1及び第2設定時間T2の双方に車速Vが上昇するときと減少するときとでヒステリシスを持たせるようにしてもよい。この場合、第1設定時間T1は、車速Vが増加するときよりも減少するときの方が短くなるようにヒステリシスを持たせ、一方の第2設定時間T2は、車速Vが増加するときよりも減少するときの方が長くなるようにヒステリシスを持たせることが望ましい。また、このような中速走行時のヒステリシスを、車速Vの上昇及び減少で変更する場合に限らず、運転者の好みに応じて変更できるようにしてもよい。
【0030】
また、上記一実施形態においては、GPS14で検出される自車位置と、記憶ユニット15から読込む道路地図情報とに基づいて自車両を走行させる基準経路を検出する場合について説明したが、これに限定されるものではない。すなわち、例えば、道路のインフラストラクチャーが整備された場合に、インフラストラクチャー側との路車間通信によって経路情報を取得したり、或いはCCDカメラやCMOSカメラ等による画像処理により検出される白線に基づいて基準経路を取得したりしてもよい。
【0031】
以上のように、上記一実施形態によれば、ステップS1の処理で、自車位置と道路地図情報とに基づいて自車両を走行させるための基準経路を検出し、ステップS3の処理で、車輪速VFL〜VRRから自車速Vを検出し、ステップS4の処理で、図4の設定時間算出マップから自車速Vに応じて第1設定時間T1及び第2設定時間T2を算出し、ステップS5の処理で、第1設定時間T1が経過するときに自車両が通過する基準経路上の地点を第1前方注視地点P1として設定し、ステップS6の処理で、第1前方注視地点P1における基準経路の曲率半径ρを検出し、ステップS7の処理で、第1前方注視地点P1における基準経路の曲率半径ρに応じて第1操舵量δ1を算出し、ステップS8の処理で、第2設定時間T2が経過するときに自車両が通過する基準経路上の地点を第2前方注視地点P2として設定し、ステップS9の処理で、第2前方注視地点P2を自車両が通過するときの基準経路に対する横偏差YEを検出し、ステップS10の処理で、第2前方注視地点P2での横偏差YEに応じて第2操舵量δ2を算出し、ステップS11及びS12の処理で、第1操舵量δ1及び第2操舵量δ2に基づいて自車両の操舵制御を行うように構成されているので、第1前方注視地点P1及び第2前方注視地点P2の双方が、車速Vに応じて自車両の手前に寄ったり自車両から遠く離れたりすることを抑制することができ、結果としてスムーズな自動操舵を実現できるという効果が得られる。
【0032】
また、ステップS4の処理では、低速走行時よりも高速走行時の方が短くなるように第1設定時間T1を算出しているので、高速走行時に第1前方注視地点P1が自車両から遠く離れることと、低速走行時に第1前方注視地点P1が自車両の手前に寄り過ぎることとを抑制できるという効果が得られる。
また、ステップS4の処理では、高速走行時には、第2設定時間T2よりも短くなるように第1設定時間T1を算出しているので、高速走行時に第1前方注視地点P1が自車両から遠く離れることを確実に抑制できるという効果が得られる。
【0033】
さらに、ステップS4の処理では、低速走行時よりも高速走行時の方が長くなるように第2設定時間T2を算出しているので、フィードバック的に作用する第2操舵量δ2を算出するための第2前方注視地点P2が自車両から離れることにより車両挙動のスムーズさが向上するという効果が得られる。
さらにまた、ステップS4の処理では、高速走行時には、第1設定時間T1よりも長くなるように第2設定時間T2を算出しているので、フィードバック的に作用する第2操舵量δ2を算出するための第2前方注視地点P2が自車両から更に離れることで、より車両挙動のスムーズさが向上するという効果が得られる。
【0034】
また、ステップS9の処理では、車両姿勢と自車両の旋回状態とに基づいて基準経路に対する横偏差YEを算出しているので、第2前方注視地点P2を自車両が通過するときの基準経路に対する横偏差YEを正確に算出できるという効果が得られる。
さらに、基準経路における第1前方注視地点P1の前後に所定距離DSをとった範囲の道路曲率半径ρを検出し、この所定距離DSは、車速Vが早いほど長くなるように構成されているので、運転者に近い感覚で的確に道路曲率半径ρを算出できるという効果が得られる。
【図面の簡単な説明】
【図1】本発明の一実施形態の概略構成図である。
【図2】操舵制御処理の一例を示すフローチャートである。
【図3】道路地図情報の構成を説明した図である。
【図4】設定時間算出マップである。
【図5】第1前方注視地点P1における道路曲率半径ρの算出方法を説明した図である。
【図6】第2前方注視地点P2における横偏差YEの算出方法を説明した図である。
【図7】設定時間算出マップの他の設定例である。
【符号の説明】
10 操舵アクチュエータ
11FL〜11RR 車輪速センサ
12 前後加速度センサ
13 横加速度センサ
14 ヨーレートセンサ
15 ディファレンシャルGPS
16 記憶ユニット
17 コントローラ[0001]
BACKGROUND OF THE INVENTION
The present invention relates to an automatic steering apparatus for a vehicle that performs automatic steering.
[0002]
[Prior art]
Conventionally, as this type of vehicle automatic steering device, for example, a far-ahead look-ahead point where the host vehicle reaches after a predetermined time and a nearby look-ahead point where the host vehicle reaches after a predetermined time shorter than the predetermined time are calculated. Calculate the steering amount for feed-forward control according to the degree of curve of the road at the distant pre-reading point and the steering correction amount for feedback control according to the degree of deviation of the vehicle position with respect to the road at the pre-reading point, There is a vehicle travel control device configured to perform vehicle steering control based on the steering amount and the steering correction amount (see Patent Document 1).
[0003]
[Patent Document 1]
Japanese Patent Laid-Open No. 2000-122719
[Problems to be solved by the invention]
However, in the above-described conventional example, the far-ahead look-ahead point and the near-ahead look-ahead point are configured to be calculated as the respective points where the host vehicle reaches after each predetermined time. Both the far-ahead look-ahead point and the near-ahead look-ahead point approach the front of the vehicle so that the vehicle is approaching the curve, but the steering is not started until just before entering the curve, or conversely, the higher the vehicle speed. Unresolved that it is impossible to ensure smooth steering because the far-forward look-ahead point and the nearby look-ahead point are both far away from the own vehicle, and the own vehicle is not sufficiently close to the curve, but steering is started from the front of the curve. There is a problem.
Accordingly, the present invention has been made paying attention to the unsolved problems of the above-described conventional example, and an object thereof is to provide an automatic steering device for a vehicle that can realize smooth automatic steering.
[0005]
[Means for Solving the Problems]
To achieve the above object, a vehicular automatic steering device of the present invention calculates a first set time and the second set time in accordance with the vehicle speed, in reference trajectory for running the vehicle, the first set time A first forward gaze point through which the host vehicle passes when the vehicle passes and a second front gaze point through which the vehicle passes when the second set time elapses are set, respectively, and the road shape at the first front gaze point. And a second steering amount corresponding to a lateral deviation from a reference route when the host vehicle passes through the second forward gazing point, respectively. The first steering amount and the second steering amount are calculated. The steering control of the host vehicle is performed based on the added value .
[0006]
【The invention's effect】
According to the vehicle automatic steering device of the present invention, the first vehicle is calculated when the first set time elapses on the reference route for running the host vehicle by calculating the first set time and the second set time according to the host vehicle speed. The first forward gaze point through which the vehicle passes and the second front gaze point through which the host vehicle passes when the second set time elapses are set, and the first steering according to the road shape at the first front gaze point And the second steering amount corresponding to the lateral deviation between the vehicle and the reference route when the host vehicle passes through the second forward gaze point, and the sum of the first steering amount and the second steering amount is calculated . Since the vehicle is configured to perform the steering control based on the vehicle, both the first front gaze point and the second front gaze point may approach the front of the own vehicle or move away from the own vehicle according to the own vehicle speed. Can be suppressed and as a result smooth automatic Effect is obtained that can be realized rudder.
[0007]
DETAILED DESCRIPTION OF THE INVENTION
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
FIG. 1 is a schematic configuration diagram showing an embodiment of the present invention, in which 1FL, 1FR, 1RL, and 1RR are a left front wheel, a right front wheel, a left rear wheel, and a right rear wheel, respectively. 1RR is a drive wheel to which the driving force of the engine 2 is transmitted through the
[0008]
The front wheels 1FL and 1FR are steering wheels connected to a
[0009]
In addition, wheel speed sensors 11FL to 11RR that output wheel speeds V FL to V RR having a frequency corresponding to the rotational speed of the wheels are disposed on the wheels 1FL to 1RR, respectively. Further, the vehicle includes a
[0010]
The vehicle is also provided with a
[0011]
Next, steering control processing that is always executed by the
First, in step S1, the road map information stored in the
[0012]
Next, the process proceeds to step S2, and after the wheel speeds V FL to V RR output from the various sensors, the longitudinal acceleration Xg, the lateral acceleration Yg, and the yaw rate φ are read, the process proceeds to step S3. The vehicle speed V C is calculated from the average of the wheel speeds V FL to V RR . Next, the process proceeds to step S4, and the first set time T 1 and the second set time T 2 are set from the vehicle speed V C calculated in step S3 with reference to the set time calculation map of FIG. In this set time calculation map, as shown in FIG. 3, the horizontal axis represents the vehicle speed V C , and the vertical axis represents the set time T. The first set time T 1, as shown by the solid line, while gradually decreases from a relatively large value T H when the vehicle speed V C is increased from a low vehicle speed, the decrease rate of the increase of the vehicle speed V C Accordingly, the second set time T 2 is gradually decreased from a value T L smaller than T H described above when the vehicle speed V C increases from the low vehicle speed, as indicated by a one-dot chain line. And the rate of increase is set so as to gradually decrease as the vehicle speed V C increases. Further, when the vehicle speed V C exceeds the predetermined value V M of the medium speed region, the magnitude of the relationship in the first set time T 1 and the second set time T 2 are configured to reverse.
[0013]
Then, the process shifts to step S5, and calculates a first forward fixed point P 1 where the vehicle passes when the first set time T 1 calculated in step S4 has elapsed. Specifically, a distance D 1 (= T 1 · V C ) that the host vehicle travels while T 1 elapses by multiplying the first set time T 1 by the vehicle speed V C is calculated from the current host vehicle position. setting the nearest node in the distance a point advanced D 1 minute only as each first forward fixed point P 1.
[0014]
Then control proceeds to step S6, to calculate the radius of curvature ρ of the road in the first look-ahead point P 1 calculated in step S5. First, as shown in FIG. 4, the nearest node in the point taken a predetermined distance D S around the P 1 as the central and P F and P R, the line segment P 1 P R connecting the P 1 and P R When the angle θ which forms with the line segment P 1 P F connecting the P 1 and P F, respectively calculates the distance d P F and P R. Here, the predetermined distance D S is calculated by multiplying the vehicle speed V by a fixed time t 2 of about 1 second, for example. Note that a minimum value D MIN is set to suppress the predetermined distance D S from becoming extremely short, and the larger one of the values calculated according to the minimum value D MIN and the vehicle speed V is calculated as the predetermined distance D S. May be. Then, the center O of the arc through the P F, P 1 and P R passes through a vertical bisector A which passes through the middle point a of the line segment P 1 P F, the midpoint b of the line segment P 1 P R and an intersection of the vertical bisector B, the angle θ which forms with the line segment P 1 P R and the line segment P 1 P F, equal to ∠aOb formed by the vertical bisectors a and B. Since ∠P F OP R is twice の aOb, the radius of curvature ρ is calculated from the angle θ and the distance d according to the following equation (1).
ρ = d / 2 · sinθ (1)
[0015]
Then, the process proceeds to step S7, and the radius of curvature ρ of the first forward gaze point P 1 calculated in step S6, on the basis of the wheel base L of the vehicle, the following (2) the first steering amount than Formula δ 1 is calculated.
δ 1 = L / ρ (2)
Then, the process proceeds to step S8, calculates a second forward fixed point P 2 where the vehicle passes when the second set time T 2 calculated in the step S4 has elapsed. More specifically, the speed vector V of the host vehicle is calculated from the positional relationship between the host vehicle position read from the
[0016]
Then control proceeds to step S9, it calculates the lateral deviation Y E the second headway point P 2 calculated in step S7 with respect to the reference path when the own vehicle passes. The lateral deviation Y E with respect to the reference route is calculated by adding the lateral deviation Y S obtained from the vehicle posture of the host vehicle and the lateral deviation Y P obtained from the vehicle turning state.
First, the slip angle θ S of the vehicle is expressed by the following equation (2) using the longitudinal acceleration Xg and the lateral acceleration Yg.
θ S = tan −1 (Yg / Xg) (3)
[0017]
The reference to the reference coordinates at the intersection Q of the perpendicular straight line C and the reference path to the own yaw angle epsilon 1 of the vehicle, the second forward fixed point P 2 the street velocity vector V on the reference coordinates as shown in FIG. 5 Assuming that the deviation angle of the route is ε T , the yaw angle ε R of the host vehicle with respect to the reference route can be expressed as the following equation (4).
ε R = ε T −ε 1 (4)
[0018]
Further, if the lateral deviation between the reference route and the vehicle position in the initial state is Y U , the lateral deviation Y S corresponding to the vehicle posture is expressed by the following equation (5). , Y U , D 2 , ε R and θ S, the lateral deviation Y S corresponding to the vehicle attitude is calculated.
Y S = Y U + D 2 · tan (ε R + θ S ) (5)
[0019]
Next, assuming that the vehicle is making a steady circular turn, the slip rate can be ignored. Therefore, the lateral deviation Y P obtained from the vehicle turning state can be expressed by the following equation (6). ) In the formula can be expressed by the following (7). Accordingly, solving these (6) and (7), and calculates the lateral deviation Y P corresponding to the vehicle turning state.
Y P = D 2 · tan β (6)
β = 1/2 · sin −1 (D 2 · ε 1 / Xg) (7)
When the lateral deviation Y S and lateral deviation Y P calculated in this way are added to calculate the lateral deviation Y E (= Y S + Y P ) relative to the reference route, the process proceeds to step S10.
[0020]
In step S10, the second steering amount δ 2 is calculated from the following equation (8) based on the lateral deviation Y E with respect to the reference route passing through the second forward gaze point P 2 calculated in step S9. Here, K 1 and K 2 are coefficients, and it is desirable to obtain an optimum value from an experiment so that the following error does not increase with respect to disturbance during straight running.
δ 2 = K1 · Y E + K2 · (dY E / dt) (8)
Then, the process proceeds to step S11, where the first steering amount δ 1 calculated in step S7 and the second steering amount δ 2 calculated in step S10 are added to obtain a steering control amount δ C (= δ 1 + δ 2 ) is calculated, the process proceeds to the subsequent step S12, the steering control amount δ C is output to the
[0021]
From the above, the
[0022]
Next, the operation of the one embodiment will be described.
Assuming that the host vehicle is currently running by automatic steering, in the steering control process that is always executed by the
[0023]
Then, the first set time T 1 and the second set time T 2 corresponding to the host vehicle speed V are calculated with reference to the set time calculation map of FIG. 3 (step S4). A first forward gaze point P 1 and a second front gaze point P 2 through which the host vehicle passes when the first set time T 1 and the second set time T 2 have passed are set (steps S5 and S8).
[0024]
At this time, the first set time T 1 is set to be shorter as the vehicle speed is higher, and conversely the second set time T 2 is set to be longer as the vehicle speed is higher, and the relative relationship between the two is as becomes longer toward the first set time T 1 than T 2 second set time at the time of low-speed running, reverse so that longer direction of the second set time T 2 than T 1 the first set time during high-speed travel in Set to
[0025]
Next, the radius of curvature ρ of the reference route at the set first forward gaze point P 1 is calculated (step S6), and the feedforward, that is, the vehicle behavior required for the host vehicle is calculated according to the radius of curvature ρ. The first steering amount δ 1 that improves the smoothness of the vehicle is calculated (step S7). Further, a lateral deviation Y E with respect to the reference route when the host vehicle passes through the second forward gaze point P 2 set relatively close is calculated based on the current vehicle posture and turning state (step S9). Based on the lateral deviation Y E , the second steering amount δ 2 that is required for the host vehicle and that improves the followability to the reference route is calculated (step S10).
[0026]
In this way, the steering control amount δ C obtained by adding the feedforward first steering amount δ 1 and the feedback second steering amount δ 2 is output to the
[0027]
Therefore, when the host vehicle is traveling at a low speed, the first forward gazing point P 1 is set relatively far, so that the first steering that acts in a feed-forward manner when approaching a curve in this low-speed traveling state. A delay in the start of steering is prevented by increasing the value of the amount δ 1 .
Further, when the host vehicle is traveling at a high speed, the first front gazing point P 1 is suppressed from moving away from the host vehicle, and thus an increase in the first steering amount δ 1 acting in a feedforward manner is suppressed. However, it is possible to prevent the steering from being started before the curve even though the curve is not sufficiently approached. In addition, since the second forward gaze point P 2 for calculating the second steering amount δ 2 acting in a feedback manner is set relatively far, the smoothness of the vehicle behavior is further improved.
[0028]
Thus, since the values of the first set time T 1 and the second set time T 2 are changed according to the vehicle speed V, both the first front gaze point P 1 and the second front gaze point P 2 Depending on the vehicle speed, it is possible to prevent the vehicle from approaching or moving away from the host vehicle, thereby realizing smooth automatic steering.
[0029]
In the above embodiment, when the set time calculation map is shown in FIG. 4, the second set time T 2 is set to be longer at high speed than at low speed. However, the present invention is not limited to this. For example, FIG. 7 (a), the sets the second set time T 2 always a constant value irrespective to the change in vehicle speed V, the at the time of the first set time T 1 is low speed T 2 second set time Longer than the second set time T 2 when traveling at high speed, both the first front gazing point P 1 and the second front gazing point P 2 correspond to the increase in the vehicle speed V. You may suppress moving away from the own vehicle. Further, as shown in FIG. 7B, when the vehicle speed V is within a predetermined range of medium speed, the vehicle speed V decreases when the vehicle speed V increases during both the first set time T 1 and the second set time T 2. You may make it have a hysteresis by occasion. In this case, the first set time T 1 has hysteresis so that the time when the vehicle speed V decreases is shorter than the time when the vehicle speed V increases, while the second set time T 2 is when the vehicle speed V increases. It is desirable to provide hysteresis so that the time when the voltage decreases is longer. In addition, the hysteresis at the time of traveling at medium speed is not limited to changing by increasing and decreasing the vehicle speed V, but may be changed according to the driver's preference.
[0030]
In the above-described embodiment, the case where the reference route for driving the vehicle is detected based on the vehicle position detected by the
[0031]
As described above, according to the above-described embodiment, the reference route for driving the host vehicle is detected based on the host vehicle position and the road map information in the process of step S1, and the wheel is processed in the process of step S3. The own vehicle speed V is detected from the speeds V FL to V RR, and the first set time T 1 and the second set time T 2 are calculated according to the own vehicle speed V from the set time calculation map of FIG. , by the process at step S5, sets the point on the reference trajectory T 1 first set time passes the own vehicle when the passed as the first forward fixed point P 1, in the process of step S6, the first headway The curvature radius ρ of the reference route at the point P 1 is detected, and the first steering amount δ 1 is calculated according to the curvature radius ρ of the reference route at the first forward gaze point P 1 in the process of step S7. in the process, the host vehicle when the second set time T 2 has elapsed Set the point on the reference path through the second forward fixed point P 2, in the process of step S9, to detect the lateral deviation Y E relative to the reference path when the second headway point P 2 is the vehicle passes In step S10, the second steering amount δ 2 is calculated according to the lateral deviation Y E at the second forward gaze point P 2 , and in steps S11 and S12, the first steering amount δ 1 and the second steering amount δ 2 are calculated. Since the steering control of the host vehicle is performed based on the steering amount δ 2 , both the first front gaze point P 1 and the second front gaze point P 2 are in front of the host vehicle according to the vehicle speed V. It is possible to prevent the vehicle from approaching or moving away from the host vehicle, and as a result, it is possible to achieve smooth automatic steering.
[0032]
Further, the process of step S4, since better at high speeds than at low speeds and calculates the first set time T 1 to be shorter, the first forward fixed point P 1 from the vehicle at the time of high speed and the farther away, the first forward fixed point P 1 during low-speed traveling effect that can be suppressed and it too close to the front of the vehicle.
In the processes of step S4, at the time of high speed running, since the calculated T 1 first set time to be shorter than the second set time T 2, the first forward fixed point P 1 is the vehicle at high speed The effect that it can suppress reliably that it leaves | separates far from is acquired.
[0033]
Furthermore, the process of step S4, since better at high speeds than at low speeds and calculates the second set time T 2 to be longer, and calculates the second steering amount [delta] 2 acting feedback manner effect that smoothness of the vehicle behavior is improved by the second forward fixed point P 2 for leaves from the vehicle.
Furthermore, in the process of step S4, the second set time T 2 is calculated so as to be longer than the first set time T 1 during high speed traveling, so the second steering amount δ 2 acting in a feedback manner is calculated. by the second forward fixed point P 2 to calculate the further away from the vehicle, the effect is obtained that further improved smoothness of the vehicle behavior.
[0034]
Further, in the process of step S9, since the lateral deviation Y E with respect to the reference route is calculated based on the vehicle posture and the turning state of the host vehicle, the reference when the host vehicle passes through the second forward gaze point P 2 is calculated. An effect is obtained that the lateral deviation Y E with respect to the route can be accurately calculated.
Further, a road curvature radius ρ in a range having a predetermined distance D S before and after the first forward gaze point P 1 on the reference route is detected, and the predetermined distance D S is configured to become longer as the vehicle speed V is higher. As a result, the road curvature radius ρ can be accurately calculated with a sense close to that of the driver.
[Brief description of the drawings]
FIG. 1 is a schematic configuration diagram of an embodiment of the present invention.
FIG. 2 is a flowchart illustrating an example of a steering control process.
FIG. 3 is a diagram illustrating a configuration of road map information.
FIG. 4 is a set time calculation map.
FIG. 5 is a diagram illustrating a method for calculating a road curvature radius ρ at a first forward gaze point P 1 .
FIG. 6 is a diagram illustrating a method for calculating a lateral deviation Y E at the second forward gaze point P 2 .
FIG. 7 shows another setting example of the set time calculation map.
[Explanation of symbols]
10 Steering actuators 11FL to 11RR
16 Storage unit 17 Controller
Claims (8)
該車速検出手段で検出した自車速に応じて第1設定時間を算出する第1設定時間算出手段と、前記基準経路検出手段が検出した基準経路で、前記第1設定時間算出手段で算出された第1設定時間が経過するときに自車両が通過する地点を第1前方注視地点として設定する第1前方注視地点設定手段と、該第1前方注視地点設定手段で設定した第1前方注視地点における基準経路の形状を検出する経路形状検出手段と、該経路形状検出手段で検出された前記第1前方注視地点における基準経路の形状に応じて第1操舵量を算出する第1操舵量算出手段と、
前記車速検出手段で検出した自車速に応じて第2設定時間を算出する第2設定時間算出手段と、前記基準経路検出手段が検出した基準経路で、前記第2設定時間算出手段で算出された第2設定時間が経過するときに自車両が通過する地点を第2前方注視地点として設定する第2前方注視地点設定手段と、該第2前方注視地点設定手段で設定した第2前方注視地点を自車両が通過するときの基準経路に対する横偏差を検出する横偏差検出手段と、該横偏差検出手段で検出された前記第2前方注視地点での横偏差に応じて第2操舵量を算出する第2操舵量算出手段と、
前記第1操舵量算出手段で算出した第1操舵量、及び前記第2操舵量算出手段で算出した第2操舵量の加算値に基づいて自車両の操舵制御を行う操舵制御手段とを備えることを特徴とする車両用自動操舵装置。Reference route detection means for detecting a reference route for running the host vehicle, vehicle speed detection means for detecting the host vehicle speed,
The first set time calculating means for calculating the first set time according to the vehicle speed detected by the vehicle speed detecting means, and the reference route detected by the reference route detecting means, calculated by the first set time calculating means. In the first forward gaze point setting means set by the first front gaze point setting means and the first front gaze point setting means for setting the point through which the host vehicle passes as the first front gaze point when the first set time elapses. Route shape detection means for detecting the shape of the reference route, and first steering amount calculation means for calculating the first steering amount according to the shape of the reference route at the first forward gaze point detected by the route shape detection means; ,
A second set time calculating means for calculating a second set time according to the host vehicle speed detected by the vehicle speed detecting means, and a reference route detected by the reference route detecting means, calculated by the second set time calculating means. A second forward gaze point setting means for setting a point through which the host vehicle passes when the second set time elapses as a second front gaze point; and a second front gaze point set by the second front gaze point setting means. A lateral deviation detecting means for detecting a lateral deviation with respect to a reference route when the host vehicle passes, and a second steering amount is calculated according to the lateral deviation at the second forward gaze point detected by the lateral deviation detecting means. A second steering amount calculating means;
Steering control means for performing steering control of the host vehicle based on an addition value of the first steering amount calculated by the first steering amount calculation means and the second steering amount calculated by the second steering amount calculation means. An automatic steering device for a vehicle characterized by the above.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003108235A JP3933085B2 (en) | 2003-04-11 | 2003-04-11 | Automatic steering device for vehicles |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2003108235A JP3933085B2 (en) | 2003-04-11 | 2003-04-11 | Automatic steering device for vehicles |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2004314692A JP2004314692A (en) | 2004-11-11 |
| JP3933085B2 true JP3933085B2 (en) | 2007-06-20 |
Family
ID=33469834
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2003108235A Expired - Lifetime JP3933085B2 (en) | 2003-04-11 | 2003-04-11 | Automatic steering device for vehicles |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3933085B2 (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20220204051A1 (en) * | 2020-12-29 | 2022-06-30 | Trimble Inc. | Techniques for maintaining offsets in vehicle formations |
Families Citing this family (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP4735676B2 (en) | 2008-08-06 | 2011-07-27 | 株式会社デンソー | Driving support device |
| JP5429062B2 (en) | 2010-06-11 | 2014-02-26 | トヨタ自動車株式会社 | Vehicle travel control device |
| JP5429234B2 (en) * | 2011-03-23 | 2014-02-26 | トヨタ自動車株式会社 | Information processing apparatus for vehicle |
| JP6058603B2 (en) | 2014-09-12 | 2017-01-11 | アイシン精機株式会社 | Vehicle control device |
| JP6567936B2 (en) * | 2015-09-30 | 2019-08-28 | 株式会社Subaru | Steering support control device |
| JP6654933B2 (en) * | 2016-03-04 | 2020-02-26 | 株式会社Soken | Steering amount control device and steering amount control method |
| JP6690450B2 (en) * | 2016-07-19 | 2020-04-28 | 株式会社デンソー | Driving support device |
| JP7147643B2 (en) * | 2019-03-18 | 2022-10-05 | トヨタ自動車株式会社 | Driving support device |
| JP7460328B2 (en) * | 2019-03-20 | 2024-04-02 | Thk株式会社 | Mobile robot, mobile robot control system, and mobile robot control method |
-
2003
- 2003-04-11 JP JP2003108235A patent/JP3933085B2/en not_active Expired - Lifetime
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20220204051A1 (en) * | 2020-12-29 | 2022-06-30 | Trimble Inc. | Techniques for maintaining offsets in vehicle formations |
| US11787445B2 (en) * | 2020-12-29 | 2023-10-17 | Trimble Inc. | Techniques for maintaining offsets in vehicle formations |
Also Published As
| Publication number | Publication date |
|---|---|
| JP2004314692A (en) | 2004-11-11 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP4270259B2 (en) | Obstacle avoidance control device | |
| JP4148179B2 (en) | Lane maintenance support device | |
| JP4231910B2 (en) | Lane keeping device | |
| JP3539362B2 (en) | Lane following travel control device | |
| JP5359085B2 (en) | Lane maintenance support device and lane maintenance support method | |
| JP5569631B2 (en) | Lane maintenance support method and lane maintenance support device | |
| JP6952014B2 (en) | Vehicle control device, vehicle control method, and vehicle control system | |
| JP4696720B2 (en) | Automatic steering control device | |
| JP5332703B2 (en) | Lane maintenance support device and lane maintenance support method | |
| JP4468509B2 (en) | Vehicle steering system | |
| JP2018103761A (en) | Self-driving vehicle | |
| JPWO2014064805A1 (en) | Vehicle travel support device | |
| JP4211686B2 (en) | Vehicle steering assist device | |
| JP7188236B2 (en) | vehicle controller | |
| JP3933085B2 (en) | Automatic steering device for vehicles | |
| JP5790401B2 (en) | Vehicle travel support device | |
| JP5380861B2 (en) | Lane maintenance support device and lane maintenance support method | |
| JP5380860B2 (en) | Lane maintenance support device and lane maintenance support method | |
| JP4622453B2 (en) | Self-steering vehicle | |
| JP4333484B2 (en) | Road parameter calculation device and vehicle behavior control device | |
| JP4599835B2 (en) | Automatic steering control device for vehicle | |
| JP5045108B2 (en) | Driving support device | |
| JP4403962B2 (en) | Automatic steering control device | |
| JP4148022B2 (en) | Vehicle steering control device | |
| JP4240000B2 (en) | Vehicle steering control device |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20050126 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20070123 |
|
| A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20070209 |
|
| 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: 20070227 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20070312 |
|
| R150 | Certificate of patent or registration of utility model |
Ref document number: 3933085 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100330 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110330 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20110330 Year of fee payment: 4 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120330 Year of fee payment: 5 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130330 Year of fee payment: 6 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130330 Year of fee payment: 6 |
|
| EXPY | Cancellation because of completion of term |