JP2017061265A - 車両の走行制御装置 - Google Patents
車両の走行制御装置 Download PDFInfo
- Publication number
- JP2017061265A JP2017061265A JP2015188257A JP2015188257A JP2017061265A JP 2017061265 A JP2017061265 A JP 2017061265A JP 2015188257 A JP2015188257 A JP 2015188257A JP 2015188257 A JP2015188257 A JP 2015188257A JP 2017061265 A JP2017061265 A JP 2017061265A
- Authority
- JP
- Japan
- Prior art keywords
- lane
- lane information
- information
- vehicle
- temporal change
- 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
- 230000008859 change Effects 0.000 claims description 29
- 230000002123 temporal effect Effects 0.000 claims description 23
- 230000002265 prevention Effects 0.000 abstract description 7
- 238000000034 method Methods 0.000 description 12
- 230000014509 gene expression Effects 0.000 description 7
- 230000008569 process Effects 0.000 description 6
- 238000002474 experimental method Methods 0.000 description 4
- 230000007246 mechanism Effects 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 241001632004 Tetrahymena sp. SIN Species 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
Images
Landscapes
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Traffic Control Systems (AREA)
Abstract
【解決手段】前方環境認識装置31からの画像情報に基づく車線情報を第1の車線情報として取得し、ナビゲーションシステム32からの自車位置情報と地図情報とに基づく車線情報を第2の車線情報として取得し、第2の車線情報を基準として第1の車線情報と第2の車線情報とを比較して、第1の車線情報が第2の車線情報と略等しいと判断した場合は、第1の車線情報を車線情報に設定する一方、第1の車線情報が第2の車線情報と異なると判断した場合は、前回の車線情報と第2の車線情報とに基づいて車線情報を設定し、該車線情報に基づいて操舵制御する。
【選択図】図2
Description
また、自車両の右側の車線区画線は最小自乗法により、以下の(2)式により近似される。
ここで、上述の(1)式、(2)式における、「AL」と「AR」は、それぞれの曲線における曲率を示し、左側の車線区画線の曲率κlは、2・ALであり、右側の車線区画線の曲率κrは、2・ARである。従って、画像情報に基づく車線の曲率κcは、以下の(3)式となる(図3参照)。
また、(1)式、(2)式における、「BL」と「BR」は、それぞれの曲線の自車両の幅方向における傾きを示し、「CL」と「CR」は、それぞれの曲線の自車両の幅方向における位置を示す。
また、画像情報に基づく(車線中央からの)車線内横位置xocは、以下の(5)式により、算出できる(図4参照)。
次いで、S102に進み、ナビゲーションシステム32から、自車位置情報と地図情報とに基づく第2の車線情報として、車線の曲率κm、車両の対車線ヨー角θmを取得する。ここで、κm、θmの添字「m」は、自車位置情報と地図情報に基づくデータであることを示すものである。尚、自車位置情報と地図情報とに基づく車線の曲率κmは、前述した如く、自車両の位置Po(k)に最も近いノード点Pn(k)の情報により、取得した情報である。また、自車位置情報と地図情報とに基づく車両の対車線ヨー角θmは、前回の自車位置Po(k-1)と今回の自車位置Po(k)で得られる自車両の進行方向(角度)と、今回の自車両の位置Po(k)に最も近いノード点Pn(k)の道路の方位角との差により算出される。
|dκm/dt|+DEκm>|dκc/dt| …(7)
|θm|+Eθm>|θc| …(8)
|dθm/dt|+DEθm>|dθc/dt| …(9)
ここで、dκm/dtは自車位置情報と地図情報とに基づく車線の曲率κmの時間的変化率、dκc/dtは画像情報に基づく車線の曲率κcの時間的変化率、dθm/dtは自車位置情報と地図情報とに基づく車両の対車線ヨー角θmの時間的変化率、dθc/dtは画像情報に基づく車両の対車線ヨー角θcの時間的変化率である。また、Eκm、DEκm、Eθm、DEθmは、それぞれナビゲーションシステム32、その他実験等により予め設定しておいた誤差範囲である。
θ=θ(k-1)+(dθm/dt)・Δt …(11)
ここで、Δtはステップ時間である。また、添字「(k-1)」は前回値であることを示す。
次に、S107に進み、画像情報に基づく車線内横位置xocの時間的変化率の絶対値|Dxoc|と、S106で算出した車線内横位置の時間的変化率の絶対値|Dx|とを比較する。
xo=xo(k-1)+V・Δt・sin(θm) …(13)
S104、S108、S109で、各車線情報の設定が完了した後は、S110に進み、所定の操舵制御(レーンキープ制御や車線逸脱防止制御等)を実行してプログラムを抜ける。
ここで、Giffは予め実験・演算等により設定しておいたフィードフォワードゲインを示す。
ここで、Gifbは、予め実験・演算等により設定しておいたゲインである。また、Δxは、図4に示すように、以下の(16)式により算出される。
この(16)式において、xvは車両の前方注視点(0,zv)のz座標における推定車両軌跡のx座標であり、前方注視点(0,zv)の前方注視距離(z座標)であるzvは、本実施の形態では、zv=tc・Vで算出される。ここで、tcは予め設定しておいた予見時間であり、例えば、1.2secに設定されている。
xv=(1/2)・(1/(1+As・V2))・(θH/Lw)
・(tc・V)2 …(17)
ここで、Lwはホイールベースである。また、(16)式における、xlは前方注視点(0,zv)のz座標における左白線のx座標であり、xrは前方注視点(0,zv)のz座標における右白線のx座標である。
xv=(1/2)・((dθ/dt)/V)・(V・tc)2 …(18)
xv=(1/2)・κ・(V・tc)2 …(19)
更に、車両のヨー角を目標経路に沿ったヨー角にフィードバック制御するヨー角フィードバック制御電流値Ifbyを、例えば、以下の(20)式により算出する。
ここで、Gifbyは、予め実験・演算等により設定しておいたゲインである。
尚、本実施の形態では、操舵制御の一例として、レーンキープ制御を行う場合を例に説明したが、車線逸脱防止制御についても、上述のように設定した各車線情報を用いて制御できることは言うまでもない。更に、上述のように設定した各車線情報を基に、車線に係るパラメータを必要とする様々な制御(運転支援制御や自動運転制御等)においても適用できる。
2 ステアリング軸
4 ステアリングホイール
5 ピニオン軸
10L、10R 車輪
12 電動モータ
20 操舵制御部(第1の車線情報取得手段、第2の車線情報取得手段、車線情報比較手段、車線情報設定手段)
21 モータ駆動部
31 前方環境認識装置(第1の車線情報取得手段)
32 ナビゲーションシステム(第2の車線情報取得手段)
33 車速センサ
34 操舵角センサ
35 ヨーレートセンサ
Claims (5)
- 走行する車線の車線情報を取得し、該車線情報に基づいて操舵制御する車両の走行制御装置において、
画像情報に基づく上記車線情報を第1の車線情報として取得する第1の車線情報取得手段と、
自車位置情報と地図情報とに基づく上記車線情報を第2の車線情報として取得する第2の車線情報取得手段と、
上記第2の車線情報を基準として上記第1の車線情報と上記第2の車線情報とを比較する車線情報比較手段と、
上記車線情報比較手段で、上記第1の車線情報が上記第2の車線情報と略等しいと判断した場合は、上記第1の車線情報を上記車線情報に設定する一方、上記第1の車線情報が上記第2の車線情報と異なると判断した場合は、前回の車線情報と上記第2の車線情報とに基づいて上記車線情報を設定する車線情報設定手段と、
を備えたことを特徴とする車両の走行制御装置。 - 上記第1の車線情報取得手段と上記第2の車線情報取得手段で取得し、上記車線情報比較手段で比較するのは、車線の曲率と、該車線の曲率の時間的変化率と、車両の対車線ヨー角と、該車両の対車線ヨー角の時間的変化率の各パラメータであって、
上記車線情報設定手段は、上記車線情報比較手段で、上記第1の車線情報による上記各パラメータと、上記第2の車線情報による上記各パラメータとが全て略等しいと判断した場合は、上記第1の車線情報による上記車線の曲率と上記車両の対車線ヨー角と車線に対する自車両の横位置を車線情報として設定することを特徴とする請求項1記載の車両の走行制御装置。 - 上記第1の車線情報取得手段と上記第2の車線情報取得手段で取得し、上記車線情報比較手段で比較するのは、車線の曲率と、該車線の曲率の時間的変化率と、車両の対車線ヨー角と、該車両の対車線ヨー角の時間的変化率の各パラメータであって、
上記車線情報設定手段は、上記車線情報比較手段で、上記第1の車線情報による上記各パラメータと、上記第2の車線情報による上記各パラメータとが全て略等しいと判断できない場合は、上記車線の曲率を、前回設定した車線の曲率と上記第2の車線情報取得手段で取得した車線の曲率の時間的変化率に応じて設定することを特徴とする請求項1又は請求項2記載の車両の走行制御装置。 - 上記第1の車線情報取得手段と上記第2の車線情報取得手段で取得し、上記車線情報比較手段で比較するのは、車線の曲率と、該車線の曲率の時間的変化率と、車両の対車線ヨー角と、該車両の対車線ヨー角の時間的変化率の各パラメータであって、
上記車線情報設定手段は、上記車線情報比較手段で、上記第1の車線情報による上記各パラメータと、上記第2の車線情報による上記各パラメータとが全て略等しいと判断できない場合は、上記車両の対車線ヨー角を、前回設定した車両の対車線ヨー角と上記第2の車線情報取得手段で取得した車両の対車線ヨー角の時間的変化率に応じて設定することを特徴とする請求項1乃至請求項3の何れか一つに記載の車両の走行制御装置。 - 上記第1の車線情報取得手段と上記第2の車線情報取得手段で取得し、上記車線情報比較手段で比較するのは、車線の曲率と、該車線の曲率の時間的変化率と、車両の対車線ヨー角と、該車両の対車線ヨー角の時間的変化率の各パラメータであって、
上記車線情報設定手段は、上記車線情報比較手段で、上記第1の車線情報による上記各パラメータと、上記第2の車線情報による上記各パラメータとが全て略等しいと判断できない際は、さらに、上記第1の車線情報による車線に対する自車両の横位置の時間的変化率と車両に実際に発生しているヨーレートの値から推測される車線に対する自車両の横位置の時間的変化率とを比較し、上記第1の車線情報による車線に対する自車両の横位置の時間的変化率が上記車両に実際に発生しているヨーレートの値から推測される車線に対する自車両の横位置の時間的変化率を超えている場合は、上記車線に対する自車両の横位置を、前回設定した車線に対する自車両の横位置と上記第2の車線情報取得手段で取得した車両の対車線ヨー角に基づいて設定する一方、上記第1の車線情報による車線に対する自車両の横位置の時間的変化率が上記車両に実際に発生しているヨーレートの値から推測される車線に対する自車両の横位置の時間的変化率より小さい場合は、上記車線に対する自車両の横位置として上記第1の車線情報による車線に対する自車両の横位置を設定することを特徴とする請求項1乃至請求項4の何れか一つに記載の車両の走行制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015188257A JP6535561B2 (ja) | 2015-09-25 | 2015-09-25 | 車両の走行制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015188257A JP6535561B2 (ja) | 2015-09-25 | 2015-09-25 | 車両の走行制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2017061265A true JP2017061265A (ja) | 2017-03-30 |
JP6535561B2 JP6535561B2 (ja) | 2019-06-26 |
Family
ID=58429895
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2015188257A Active JP6535561B2 (ja) | 2015-09-25 | 2015-09-25 | 車両の走行制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6535561B2 (ja) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2019056635A (ja) * | 2017-09-21 | 2019-04-11 | 株式会社Subaru | 位置検出装置 |
WO2020059068A1 (ja) * | 2018-09-20 | 2020-03-26 | 三菱電機株式会社 | 車両位置処理装置、車両制御装置、車両位置処理方法、及び車両制御方法 |
JP2021017073A (ja) * | 2019-07-17 | 2021-02-15 | トヨタ自動車株式会社 | 位置推定装置 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001291197A (ja) * | 2000-04-07 | 2001-10-19 | Honda Motor Co Ltd | 車両制御装置 |
JP2002008199A (ja) * | 2000-06-27 | 2002-01-11 | Nissan Motor Co Ltd | 車線追従走行制御装置 |
JP2002334400A (ja) * | 2001-05-10 | 2002-11-22 | Mitsubishi Motors Corp | 運転支援装置 |
JP2005346304A (ja) * | 2004-06-01 | 2005-12-15 | Toyota Motor Corp | 道路パラメータ算出装置および車両挙動制御装置 |
JP2006151066A (ja) * | 2004-11-26 | 2006-06-15 | Aisin Seiki Co Ltd | 車両の走行支援装置 |
JP2008049918A (ja) * | 2006-08-25 | 2008-03-06 | Toyota Motor Corp | 車両用制御装置、及び、車両用表示装置 |
US20140379164A1 (en) * | 2013-06-20 | 2014-12-25 | Ford Global Technologies, Llc | Lane monitoring with electronic horizon |
-
2015
- 2015-09-25 JP JP2015188257A patent/JP6535561B2/ja active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001291197A (ja) * | 2000-04-07 | 2001-10-19 | Honda Motor Co Ltd | 車両制御装置 |
JP2002008199A (ja) * | 2000-06-27 | 2002-01-11 | Nissan Motor Co Ltd | 車線追従走行制御装置 |
JP2002334400A (ja) * | 2001-05-10 | 2002-11-22 | Mitsubishi Motors Corp | 運転支援装置 |
JP2005346304A (ja) * | 2004-06-01 | 2005-12-15 | Toyota Motor Corp | 道路パラメータ算出装置および車両挙動制御装置 |
JP2006151066A (ja) * | 2004-11-26 | 2006-06-15 | Aisin Seiki Co Ltd | 車両の走行支援装置 |
JP2008049918A (ja) * | 2006-08-25 | 2008-03-06 | Toyota Motor Corp | 車両用制御装置、及び、車両用表示装置 |
US20140379164A1 (en) * | 2013-06-20 | 2014-12-25 | Ford Global Technologies, Llc | Lane monitoring with electronic horizon |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2019056635A (ja) * | 2017-09-21 | 2019-04-11 | 株式会社Subaru | 位置検出装置 |
JP7132704B2 (ja) | 2017-09-21 | 2022-09-07 | 株式会社Subaru | 位置検出装置 |
WO2020059068A1 (ja) * | 2018-09-20 | 2020-03-26 | 三菱電機株式会社 | 車両位置処理装置、車両制御装置、車両位置処理方法、及び車両制御方法 |
JPWO2020059068A1 (ja) * | 2018-09-20 | 2021-02-15 | 三菱電機株式会社 | 車両位置処理装置、車両制御装置、車両位置処理方法、及び車両制御方法 |
US11970207B2 (en) | 2018-09-20 | 2024-04-30 | Mitsubishi Electric Corporation | Vehicle control apparatus and vehicle control method |
JP2021017073A (ja) * | 2019-07-17 | 2021-02-15 | トヨタ自動車株式会社 | 位置推定装置 |
JP7234840B2 (ja) | 2019-07-17 | 2023-03-08 | トヨタ自動車株式会社 | 位置推定装置 |
Also Published As
Publication number | Publication date |
---|---|
JP6535561B2 (ja) | 2019-06-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6055528B1 (ja) | 車両の操舵制御装置 | |
JP6082415B2 (ja) | 車両の走行制御装置 | |
JP6087969B2 (ja) | 車両の走行制御装置 | |
US10793141B2 (en) | Vehicle traveling control apparatus | |
JP6055525B1 (ja) | 車両の走行制御装置 | |
CN111066071B (zh) | 驾驶辅助车辆的位置误差校正方法及位置误差校正装置 | |
JP6025273B2 (ja) | 車両の走行制御装置 | |
JP5947849B2 (ja) | 車両の車線逸脱防止制御装置 | |
JP6831734B2 (ja) | 車両の走行制御装置 | |
JP6579699B2 (ja) | 車両の走行制御装置 | |
KR101512784B1 (ko) | 자동주차 지원방법 및 자동주차 지원시스템 | |
US20050269145A1 (en) | Steering assistance method and device for a motor vehicle | |
JP2019028027A (ja) | 車両用運転支援装置 | |
JP6842339B2 (ja) | 車両の走行制御装置 | |
JP2019119277A (ja) | 車両の車線逸脱防止制御装置 | |
CN111055832A (zh) | 挂接辅助系统 | |
JP6535561B2 (ja) | 車両の走行制御装置 | |
US11912360B2 (en) | Vehicle control method, vehicle control system, and vehicle | |
JP6898636B2 (ja) | 車両の走行制御装置 | |
JP6595867B2 (ja) | 車両の自動運転制御装置 | |
JP6496588B2 (ja) | 車両挙動制御装置 | |
JP6654962B2 (ja) | 車両の操舵制御装置 | |
JP2018052270A (ja) | 車両の操舵制御装置 | |
JP6766738B2 (ja) | パス追従制御システム | |
JP2019107966A (ja) | 車両の車線逸脱防止制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20180614 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20190221 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20190226 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20190408 |
|
RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20190408 |
|
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: 20190507 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20190603 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6535561 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |