JP2024039084A - 車両制御装置及び車両制御方法 - Google Patents
車両制御装置及び車両制御方法 Download PDFInfo
- Publication number
- JP2024039084A JP2024039084A JP2022143367A JP2022143367A JP2024039084A JP 2024039084 A JP2024039084 A JP 2024039084A JP 2022143367 A JP2022143367 A JP 2022143367A JP 2022143367 A JP2022143367 A JP 2022143367A JP 2024039084 A JP2024039084 A JP 2024039084A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- yaw rate
- curvature
- lane
- azimuth
- 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
- 238000000034 method Methods 0.000 title claims description 5
- 238000005259 measurement Methods 0.000 claims abstract description 7
- 230000005484 gravity Effects 0.000 description 15
- 238000010586 diagram Methods 0.000 description 9
- 238000004088 simulation Methods 0.000 description 9
- 230000000694 effects Effects 0.000 description 4
- 238000004364 calculation method Methods 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000003384 imaging method Methods 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 230000001131 transforming effect Effects 0.000 description 2
- 238000012937 correction Methods 0.000 description 1
- 238000009472 formulation Methods 0.000 description 1
- 238000010191 image analysis Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000004043 responsiveness Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Images
Landscapes
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
【課題】目標軌道に対して定常的に横偏差が生じることを抑制する。
【解決手段】車両制御装置10は、車両Vに対する車線中心の横位置、車両Vの車線に対する向きを示す方位角、車線の車両Vの位置に対応する曲率、及び車両Vの車速の測定値を取得する取得部121と、取得部121が取得した横位置、方位角、曲率、車速の測定値に基づいて車両Vに対して発生すると推定される推定ヨーレートを出力するカルマンフィルタを用いて、推定ヨーレートを推定する推定部122と、取得部121が取得した横位置、方位角、及び曲率の測定値と、推定部122が推定した推定ヨーレートとに基づいて、車両Vが車線の中心を走行するように車両Vの操舵角を制御する操舵角制御部123と、を有する。
【選択図】図5
【解決手段】車両制御装置10は、車両Vに対する車線中心の横位置、車両Vの車線に対する向きを示す方位角、車線の車両Vの位置に対応する曲率、及び車両Vの車速の測定値を取得する取得部121と、取得部121が取得した横位置、方位角、曲率、車速の測定値に基づいて車両Vに対して発生すると推定される推定ヨーレートを出力するカルマンフィルタを用いて、推定ヨーレートを推定する推定部122と、取得部121が取得した横位置、方位角、及び曲率の測定値と、推定部122が推定した推定ヨーレートとに基づいて、車両Vが車線の中心を走行するように車両Vの操舵角を制御する操舵角制御部123と、を有する。
【選択図】図5
Description
本発明は、車両制御装置及び車両制御方法に関する。
従来、車両が目標軌道を走行するように車両の走行を制御することが行われている。例えば、特許文献1には、車両の車線中心からの横偏差、車両が走行する道路の曲率、車両のヨー角を観測し、これらの観測量をカルマンフィルタで構成した推定モデルに入力して横偏差、ヨー角、及びヨーレート等の状態量を推定し、推定した車両の状態量に基づいて車両が車線中心を走行するように操舵制御を行う技術が開示されている。
方位角やヨーレートのセンサ値に真値からのオフセットが含まれている場合に従来の技術を利用して操舵制御を行うと、目標軌道に対して定常的に横偏差が生じてしまうという問題が生じていた。
そこで、本発明はこれらの点に鑑みてなされたものであり、目標軌道に対して定常的に横偏差が生じることを抑制することを目的とする。
本発明の第1の態様に係る車両制御装置は、車両に対する車線中心の横位置、前記車両の車線に対する向きを示す方位角、前記車線の前記車両の位置に対応する曲率、及び前記車両の車速の測定値を取得する取得部と、前記取得部が取得した前記横位置、前記方位角、前記曲率、及び前記車速の測定値に基づいて前記車両に対して発生すると推定される推定ヨーレートを出力するカルマンフィルタを用いて、前記推定ヨーレートを推定する推定部と、前記取得部が取得した前記横位置、前記方位角、及び前記曲率の測定値と、前記推定部が推定した前記推定ヨーレートとに基づいて、前記車両が前記車線の中心を走行するように前記車両の操舵角を制御する操舵角制御部と、を有する。
前記取得部は、前記車両に対して発生するヨーレートを取得し、前記操舵角制御部は、前記取得部が取得した前記ヨーレートに、前記ヨーレートと前記推定ヨーレートとの差分の時間平均を加算して得られる値に基づいて、前記操舵角を制御してもよい。
前記操舵角制御部は、前記曲率が所定の値を超える場合に、前記曲率が所定の値を超える前に算出した前記時間平均を、前記ヨーレートに加算して得られる値に基づいて、前記操舵角を制御してもよい。
本発明の第2の態様に係る車両制御方法は、コンピュータが実行する、車両に対する車線中心の横位置、前記車両の車線に対する向きを示す方位角、前記車線の前記車両の位置に対応する曲率、及び前記車両の車速の測定値を取得するステップと、取得した前記横位置、前記方位角、前記曲率、及び前記車速の測定値に基づいて前記車両に対して発生すると推定される推定ヨーレートを出力するカルマンフィルタを用いて、前記推定ヨーレートを推定するステップと、取得した前記横位置、前記方位角、及び前記曲率の測定値と、推定した前記推定ヨーレートとに基づいて、前記車両が前記車線の中心を走行するように前記車両の操舵角を制御するステップと、を有する。
本発明によれば、目標軌道に対して定常的に横偏差が生じることを抑制することができるという効果を奏する。
[車両制御装置10の概要]
図1は、車両制御装置10の概要を説明するための図である。車両制御装置10は、車両Vに搭載され、車両Vが目標軌道Tを走行するように車両Vの操舵角を制御するためのコンピュータである。目標軌道Tは、例えば、車両Vが走行する車線の進行方向に存在する複数の点であって、車両Vの位置からそれぞれ異なる距離における車線の中心の点を結んだ線である。
図1は、車両制御装置10の概要を説明するための図である。車両制御装置10は、車両Vに搭載され、車両Vが目標軌道Tを走行するように車両Vの操舵角を制御するためのコンピュータである。目標軌道Tは、例えば、車両Vが走行する車線の進行方向に存在する複数の点であって、車両Vの位置からそれぞれ異なる距離における車線の中心の点を結んだ線である。
車両制御装置10は、車両Vに対する車線中心の横位置、車両Vの車線に対する向きを示す方位角、車両Vに対して発生するヨーレート、車線の車両Vの位置に対応する曲率、及び車両Vの車速の測定値を車両Vに設けられている各種センサ等から取得する。車両制御装置10は、取得した横位置、方位角、曲率、車速の測定値に基づいて、車両Vの現在の状態に対応する推定横位置、推定方位角、推定ヨーレート、及び推定曲率を出力するカルマンフィルタを用いて、現在のヨーレートを推定する。そして、車両制御装置10は、取得した横位置、方位角、及び曲率の測定値と、推定したヨーレートとに基づいて、車両Vが車線の中心、すなわち目標軌道Tを走行するように車両Vの操舵角を制御する。
従来の技術では、方位角やヨーレートの測定値に真値からのオフセットが含まれている場合に操舵制御を行うと、目標軌道に対して定常的に横偏差が生じてしまうという問題が生じていた。一方で、方位角の測定値とヨーレートの測定値とを比較して、それぞれ逆符号のオフセットが存在する場合、これらの測定値を用いて操舵制御を行うと、それぞれの影響が打ち消し合い目標軌道に対して定常的な横偏差が無く走行できることが確認されている。
そこで、本実施の形態に係る車両制御装置10は、横位置、方位角、曲率、車速の測定値に基づいて推定横位置、推定方位角、推定ヨーレート、及び推定曲率を出力するカルマンフィルタを用いて、方位角の測定値に含まれるオフセットと相殺されるオフセットを含むヨーレートを推定する。そして、車両制御装置10は、方位角の測定値と、推定したヨーレートとに基づいて、車両Vの操舵角を制御する。このようにすることで、車両制御装置10は、目標軌道に対して測定値のオフセットの影響により定常的に横偏差が生じることを抑制することができる。
[カルマンフィルタの構成]
車両制御装置10の詳細な説明を行うにあたり、まず、カルマンフィルタの構成について説明する。カルマンフィルタは、状態変数の離散的な時間遷移を表す離散時間状態方程式による予測ステップ及び観測量と状態変数の関係を記述する観測方程式による修正ステップから構成される。本実施の形態では車両Vの車線に対する横位置、方位角、曲率、ヨーレートを状態変数とし、車両Vの車線に対する横位置、方位角、曲率を観測量として扱う。以下、カルマンフィルタを想定した離散時間状態方程式と観測方程式との構築例について説明する。
車両制御装置10の詳細な説明を行うにあたり、まず、カルマンフィルタの構成について説明する。カルマンフィルタは、状態変数の離散的な時間遷移を表す離散時間状態方程式による予測ステップ及び観測量と状態変数の関係を記述する観測方程式による修正ステップから構成される。本実施の形態では車両Vの車線に対する横位置、方位角、曲率、ヨーレートを状態変数とし、車両Vの車線に対する横位置、方位角、曲率を観測量として扱う。以下、カルマンフィルタを想定した離散時間状態方程式と観測方程式との構築例について説明する。
図2は、車両Vの滑り角が微小で無視できると仮定したときの、微小時間幅Δtにおける車両運動を説明する図である。図2には時刻t1における車両Vと、時刻t1からΔtが経過した時刻t2における車両Vとを示している。図2において、円弧A1は車両Vの重心点の軌跡を示し、円弧A2は車線中心の軌跡を示している。また、φは、円弧A1と、円弧A1の両端と円弧A1に対応する円の中心とを結ぶ2つの線からなる扇形の中心角を示している。
Δxは、時刻t1における車両Vの進行方向に対する、時刻t1における車両Vの重心位置から、時刻t2における車両Vの重心位置までの距離を示している。Δyは、時刻t1における車両Vの進行方向と直交する横方向に対する、時刻t1における車両Vの重心位置から、時刻t2における車両Vの重心位置までの距離を示している。
また、V1、r1、U1、θ1、ρ1は、時刻t1における車両Vの車速、ヨーレート、横位置、方位角、車線の曲率を示し、V2、r2、U2、θ2、ρ2は、時刻t1からΔt経過した時刻t2における車両Vの車速、ヨーレート、横位置、方位角、車線の曲率を示している。U2’は、時刻t1における車両Vの進行方向と直交する横方向の向きに対する、時刻t2における車両Vの重心から車線中心線までの距離を示している。横位置は、車両Vの重心から車線中心までの横方向の距離を示しており、車両Vに対して車線の中心が右側にある場合を正とする。
方位角は、車両Vの中心線と車線中心線のなす角であり、車両Vに対して車線が左方向を向いている場合を正とする。曲率は、車線中心の曲線半径の逆数を示し、左旋回を正とする。なお、時刻t(ただし、t1≦t≦t2)、すなわちΔtの間、車速V1、ヨーレートr1、曲率ρ1は一定であるものとする。
まず、横位置の離散時間変化の式を導く。車線形状を2次多項式で近似すると、幾何学的な関係から次の式(1)が成り立つ。
また、Δtの間、車速V1、ヨーレートr1が一定であることから、次の式(2)、(3)が成り立つ。
Δtが小さいため、rΔtに関する3次以上の項を無視して定式化を行うと、以下に示される式(4)~(7)が成り立つ。
図3は、図2に示される時刻t2における車両Vの付近の拡大図である。rΔtに関する3次以上の項を無視して定式化を行うと、以下に示される式(8)~(10)が導かれる。
方位角、曲率、ヨーレートが小さいと仮定すると、以下に示される式(11)が成り立つ。
式(8)~(11)により、以下の式(12)が導かれる。
式(12)の一部について、以下の関係式(13)が成り立ち、U2’はU2に近似される。
したがって、式(1)のU2’をU2に置き換えるとともに、Δx、Δyを式(6)、(7)に基づいて変換すると、式(1)は、以下の式(14)に変換される。
式(14)を変形することにより、時刻t2における横位置U2は、時刻t1における横位置U1、車速V1、方位角θ1、曲率ρ1に基づいて以下の式(15)で表される。
次に方位角の離散時間変化の式を導く。図2から、ψ、φ、θ2の間で、以下の式(16)が成り立つ。
式(16)に式(3)、(11)を代入すると、以下の式(17)となる。
式(17)を変形することにより、時刻t2における方位角θ2は、時刻t1における車速V1、方位角θ1、ヨーレートr1、曲率ρ1に基づいて以下の式(18)で表される。
式(15)、(18)から、カルマンフィルタを想定した離散時間状態方程式と観測方程式を以下の式(19)~(25)のように構築する。
ここで、ykの各要素は観測値、wkは次元数が4であり、平均0、共分散行列Qのガウス白色雑音ベクトル、vkは次元数が3であり、平均0、共分散行列Rのガウス白色雑音ベクトルである。wkとvkは独立であるものとする。
カルマンフィルタの構成に用いた式(15)の特性を検証する。例えば、車両Vが直線の中央を走行している場合、車両Vの横位置、曲率、方位角は0である。また、方位角の測定値にθ0のオフセットが含まれているとする。式(15)において、U1、U2、ρ1に0を代入し、θ1にθ0を代入すると、以下の式(26)が導かれる。
車両Vが直進しており、実際のヨーレートが0である場合に、方位角にオフセットが含まれていると、式(26)に示すようにヨーレートの値は0ではない値となる。なお、図2において定義した方位角はセンサの測定値の定義と正負が反転している。このため、式(15)を用いて状態方程式を構成したカルマンフィルタを用いてヨーレートを推定することにより、オフセットを含む方位角と逆符号のオフセットを含むヨーレート推定値が得られることとなる。
なお、上述の説明では、車両Vの重心に対応する状態方程式を導いたが、横位置、方位角、曲率は、車両Vの前方部に設けられた撮像装置の位置において測定される。このため、上述したカルマンフィルタに適用するために、これらの測定値を重心位置に対応した値に変換する必要がある。
図4は、車両の重心位置における横位置、方位角、曲率と、車両の前方部における横位置、方位角、曲率との関係を説明する図である。図4に示されるU’、θ’、ρ’は、車両Vの前方部において得られる横位置、方位角、曲率を示している。図4におけるlは、車両Vの重心から車両Vの前方部までの距離を示している。図4から重心における横位置は、以下の式(27)で示される。
また、方位角、曲率が小さい場合には、重心位置における方位角は以下の式(28)で示される。車両Vの重心位置における横位置、方位角は、式(27)、(28)に基づいて算出されるものとする。
[車両制御装置10の構成]
続いて、車両制御装置10の構成について説明する。図5は、車両制御装置10に係る車両Vの構成を示す図である。車両Vは、車速センサ1と、測定装置2と、方位角センサ3と、ヨーレートセンサ4と、ステアリングECU5と、車両制御装置10とを有する。
続いて、車両制御装置10の構成について説明する。図5は、車両制御装置10に係る車両Vの構成を示す図である。車両Vは、車速センサ1と、測定装置2と、方位角センサ3と、ヨーレートセンサ4と、ステアリングECU5と、車両制御装置10とを有する。
車速センサ1は、車両Vの車速を測定し、車速の測定値を車両制御装置10に出力する。
測定装置2は、例えば、撮像装置及び画像解析装置等を含んでおり、車両Vに対する車線中心の横位置と、車両Vが走行する車線の曲率とを測定し、横位置と、曲率との測定値を車両制御装置10に出力する。
方位角センサ3は、車両Vの方位角を測定し、方位角の測定値を車両制御装置10に出力する。なお、方位角センサ3が方位角を測定することとしたが、これに限らない。例えば、測定装置2が方位角を測定できる場合には、測定装置2が方位角を測定してもよく、この場合、車両Vが方位角センサ3を有していなくてもよい。
ヨーレートセンサ4は、車両Vのヨーレートを測定し、ヨーレートの測定値を車両制御装置10に出力する。
測定装置2は、例えば、撮像装置及び画像解析装置等を含んでおり、車両Vに対する車線中心の横位置と、車両Vが走行する車線の曲率とを測定し、横位置と、曲率との測定値を車両制御装置10に出力する。
方位角センサ3は、車両Vの方位角を測定し、方位角の測定値を車両制御装置10に出力する。なお、方位角センサ3が方位角を測定することとしたが、これに限らない。例えば、測定装置2が方位角を測定できる場合には、測定装置2が方位角を測定してもよく、この場合、車両Vが方位角センサ3を有していなくてもよい。
ヨーレートセンサ4は、車両Vのヨーレートを測定し、ヨーレートの測定値を車両制御装置10に出力する。
ステアリングECU5は、電動パワーステアリングシステムの制御装置であり、車両Vのステアリング機構に組み込まれているアシストモータ(不図示)に接続されている。ステアリングECU5は、車両制御装置10から操舵制御信号を受信すると、操舵制御信号に基づいてアシストモータを駆動する。
車両制御装置10は、記憶部11と、制御部12とを有する。
記憶部11は、例えばROM(Read Only Memory)やRAM(Random Access Memory)やハードディスクである。記憶部11は、制御部12を機能させるための各種のプログラムを記憶する。記憶部11は、制御部12を、取得部121、推定部122、操舵角制御部123として機能させるプログラムを記憶する。
記憶部11は、例えばROM(Read Only Memory)やRAM(Random Access Memory)やハードディスクである。記憶部11は、制御部12を機能させるための各種のプログラムを記憶する。記憶部11は、制御部12を、取得部121、推定部122、操舵角制御部123として機能させるプログラムを記憶する。
制御部12は、例えばCPU(Central Processing Unit)である。制御部12は、記憶部11に記憶されているプログラムを実行することにより、取得部121、推定部122、操舵角制御部123として機能する。
取得部121は、車両Vに対する車線中心の横位置、車両Vの車線に対する向きを示す方位角、車両Vに対して発生するヨーレート、車線の車両Vの位置に対応する曲率、及び車両Vの車速の測定値を取得する。例えば、取得部121は、車速センサ1、測定装置2、方位角センサ3、及びヨーレートセンサ4から出力された、車速の測定値、横位置、車線曲率、方位角、及びヨーレートの測定値を取得する。
推定部122は、取得部121が取得した横位置、方位角、曲率、車速の測定値に基づいて、車両Vの現在の状態に対応する推定横位置、推定方位角、推定ヨーレート、及び推定曲率を出力するカルマンフィルタを用いて、現在のヨーレート(推定ヨーレート)を推定する。
具体的には、推定部122において、取得部121が取得した横位置、方位角、曲率、車速を用い、式(19)~式(25)で示された離散時間方程式に対して、カルマンフィルタの枠組みを適用して推定値を算出する。ここで、推定部122は、初めて横位置、方位角、曲率、ヨーレートを推定する場合に、取得部121が取得した横位置、方位角、曲率、ヨーレートの測定値を初期値として用いてもよい。
操舵角制御部123は、取得部121が取得した横位置、方位角、及び曲率の測定値と、推定部122が出力した推定ヨーレートとに基づいて、車両Vが車線の中心を走行するように操舵角を制御する。その際内部での計算では、車両Vが車線維持のために実現すべき目標ヨーレートの算出と、推定ヨーレートをその目標ヨーレートに近づけるための操舵角の算出とが階層的に行われるものとする。例えば、操舵角制御部123は、車速、横位置、方位角、曲率、ヨーレートの入力に対し、車両Vが車線の中心を走行するような操舵角を出力するドライバモデルに対し、取得部121が取得した車速、横位置、方位角、及び曲率の測定値と、推定部122が出力した推定ヨーレートとを入力し、ドライバモデルから操舵角を取得する。操舵角制御部123は、取得した操舵角を示す操舵制御信号をステアリングECUに出力することにより、車両Vの操舵角を制御する。
ここで、カルマンフィルタで推定するヨーレートは、センサのヨーレート測定値よりも、時間的に遅れを持ったものとなることが多い。また、推定ヨーレートは、ヨーレートの測定値の比較的短い周期の振幅に対して小さい振幅となる場合がある。このため、推定ヨーレートをそのまま操舵角の制御に用いることが好ましくない場合がある。
これに対し、操舵角制御部123は、取得部121が取得したヨーレートに、ヨーレートと推定ヨーレートとの差分の時間平均を加算して得られる値を補正後ヨーレートとする。そして、操舵角制御部123は、補正後ヨーレートに基づいて、操舵角を制御するようにしてもよい。すなわち、操舵角制御部123は、ドライバモデルに対し、推定ヨーレートの代わりに補正後ヨーレートを入力するようにしてもよい。このようにすることで、車両制御装置10は、ヨーレートセンサ4から取得したヨーレートの測定値に基づいて操舵角を制御する場合と同様の応答性を確保しつつ、方位角の測定値に含まれるオフセットと逆符号のオフセットを含むヨーレートに基づいて操舵制御を行い、定常的に車線の中央に対する車両Vの横偏差が生じることを抑制することができる。
[シミュレーション結果]
続いて、車両制御装置10のシミュレーション結果について説明する。シミュレーションでは、方位角センサ3に対して0.1°のオフセットを付与し、上述したカルマンフィルタを用いて推定ヨーレートの推定を行い、ヨーレートの測定値と推定ヨーレートとの差分の5秒間の時間平均をヨーレートの測定値に付加して補正後ヨーレートを算出し、操舵角制御部123に入力するものとした。
続いて、車両制御装置10のシミュレーション結果について説明する。シミュレーションでは、方位角センサ3に対して0.1°のオフセットを付与し、上述したカルマンフィルタを用いて推定ヨーレートの推定を行い、ヨーレートの測定値と推定ヨーレートとの差分の5秒間の時間平均をヨーレートの測定値に付加して補正後ヨーレートを算出し、操舵角制御部123に入力するものとした。
また、車両Vの車速を80km/hとし、直線、クロソイド、一定半径部を走行するものとした。また、クロソイドパラメータは386m、一定半径部の曲線半径を400mとした。図6は、車両制御装置10のシミュレーション結果を示す図である。図6(a)は、横位置のシミュレーション結果と、走行路の曲率とを示しており、図6(b)は、ヨーレートのシミュレーション結果を示している。図6(a)においてS1は、車両制御装置10のシミュレーション結果を示し、S2は、ヨーレートの測定値を操舵角制御部123に直接入力したときのシミュレーション結果を示している。また、図6(b)においてrsはヨーレートの測定値、rcは補正後ヨーレート、rtは目標ヨーレートを示している。
図6(a)に示されるように、ヨーレートの測定値を操舵角制御部123に直接入力した場合、車両が直線(時刻0秒~30秒)を走行しているときに、車両の横位置が-0.07m付近を維持して走行していることが確認できる。これに対し、ヨーレートの推定値を反映させた補正後ヨーレートを操舵角制御部123に入力した場合、車両Vが直線を走行しているときには、車両Vの横位置が0m付近を維持していることが確認できる。また、図6(b)に示されるように、車両Vが直線を走行しているときには、補正後ヨーレートrcの値が、ヨーレート測定値rsに比べて-0.1deg/s小さく、オフセットが付与されていることが確認できる。これにより、ヨーレートに対し、方位角のオフセットと相殺するようにオフセットが付されていることが確認できる。
なお、クロソイド及び一定半径部を走行している場合には、補正後ヨーレートに対し、-0.1deg/sよりも小さい値のオフセットが付されていることが確認できる。この現象は、車両Vの速度が車体の向きにのみ発生するものとして状態方程式を算出していることによるものと考えられる。すなわち、実際の車両の運動では、車両の横滑りが発生し、車両の向きと垂直方向の向きにも速度(横速度)が発生する。横速度は、ヨーレートが低ければ無視できるものの、車両がカーブを走行する場合等、ヨーレートが大きくなると無視できないものとなる。これにより、ヨーレートに含まれる、方位角の測定値に含まれるオフセットと逆符号のオフセットが大きく算出される場合がある。
これに対し、操舵角制御部123は、車線の曲率が所定の値を超える場合に、当該曲率が所定の値を超える前に算出した、取得部121が取得したヨーレートと推定ヨーレートとの差分の時間平均を、取得したヨーレートに加算して得られる値を補正後ヨーレートとしてもよい。例えば、操舵角制御部123は、車線の曲率が所定の値を超える場合に、当該曲率が所定の値を超える直前に算出した時間平均の値を、取得したヨーレートに加算して得られる値を補正後ヨーレートとしてもよい。そして、操舵角制御部123は、当該補正後ヨーレートに基づいて操舵角を制御してもよい。このようにすることで、車両制御装置10は、カーブ等を走行する場合にも、車線の中央に対する車両Vの横偏差が生じることを抑制することができる。
[本実施の形態の効果]
以上説明したように、本実施の形態に係る車両制御装置10は、車両Vに対する車線中心の横位置、車両Vの車線に対する向きを示す方位角、車線の車両Vの位置に対応する曲率、及び車両Vの車速の測定値を取得し、取得した横位置、方位角、曲率、車速の測定値に基づいて車両Vに対して発生すると推定される推定ヨーレートを出力するカルマンフィルタを用いて、次の時刻のヨーレートを推定する。そして、車両制御装置10は、取得した横位置、方位角、及び前記曲率の測定値と、推定ヨーレートとに基づいて、車両Vが車線の中心を走行するように車両Vの操舵角を制御する。このようにすることで、車両制御装置10は、目標軌道である車線の中心を結んだ軌道に対して定常的に横偏差が生じることを抑制することができる。
以上説明したように、本実施の形態に係る車両制御装置10は、車両Vに対する車線中心の横位置、車両Vの車線に対する向きを示す方位角、車線の車両Vの位置に対応する曲率、及び車両Vの車速の測定値を取得し、取得した横位置、方位角、曲率、車速の測定値に基づいて車両Vに対して発生すると推定される推定ヨーレートを出力するカルマンフィルタを用いて、次の時刻のヨーレートを推定する。そして、車両制御装置10は、取得した横位置、方位角、及び前記曲率の測定値と、推定ヨーレートとに基づいて、車両Vが車線の中心を走行するように車両Vの操舵角を制御する。このようにすることで、車両制御装置10は、目標軌道である車線の中心を結んだ軌道に対して定常的に横偏差が生じることを抑制することができる。
以上、本発明を実施の形態を用いて説明したが、本発明の技術的範囲は上記実施の形態に記載の範囲には限定されず、その要旨の範囲内で種々の変形及び変更が可能である。例えば、装置の全部又は一部は、任意の単位で機能的又は物理的に分散・統合して構成することができる。また、複数の実施の形態の任意の組み合わせによって生じる新たな実施の形態も、本発明の実施の形態に含まれる。組み合わせによって生じる新たな実施の形態の効果は、もとの実施の形態の効果を併せ持つ。
1 車速センサ
2 測定装置
3 方位角センサ
4 ヨーレートセンサ
5 ステアリングECU
10 車両制御装置
11 記憶部
12 制御部
121 取得部
122 推定部
123 操舵角制御部
V 車両
2 測定装置
3 方位角センサ
4 ヨーレートセンサ
5 ステアリングECU
10 車両制御装置
11 記憶部
12 制御部
121 取得部
122 推定部
123 操舵角制御部
V 車両
Claims (4)
- 車両に対する車線中心の横位置、前記車両の車線に対する向きを示す方位角、前記車線の前記車両の位置に対応する曲率、及び前記車両の車速の測定値を取得する取得部と、
前記取得部が取得した前記横位置、前記方位角、前記曲率、及び前記車速の測定値に基づいて前記車両に対して発生すると推定される推定ヨーレートを出力するカルマンフィルタを用いて、前記推定ヨーレートを推定する推定部と、
前記取得部が取得した前記横位置、前記方位角、及び前記曲率の測定値と、前記推定部が推定した前記推定ヨーレートとに基づいて、前記車両が前記車線の中心を走行するように前記車両の操舵角を制御する操舵角制御部と、
を有する車両制御装置。 - 前記取得部は、前記車両に対して発生するヨーレートを取得し、
前記操舵角制御部は、前記取得部が取得した前記ヨーレートに、前記ヨーレートと前記推定ヨーレートとの差分の時間平均を加算して得られる値に基づいて、前記操舵角を制御する、
請求項1に記載の車両制御装置。 - 前記操舵角制御部は、前記曲率が所定の値を超える場合に、前記曲率が所定の値を超える前に算出した前記時間平均を、前記ヨーレートに加算して得られる値に基づいて、前記操舵角を制御する、
請求項2に記載の車両制御装置。 - コンピュータが実行する、
車両に対する車線中心の横位置、前記車両の車線に対する向きを示す方位角、前記車線の前記車両の位置に対応する曲率、及び前記車両の車速の測定値を取得するステップと、
取得した前記横位置、前記方位角、前記曲率、及び前記車速の測定値に基づいて前記車両に対して発生すると推定される推定ヨーレートを出力するカルマンフィルタを用いて、前記推定ヨーレートを推定するステップと、
取得した前記横位置、前記方位角、及び前記曲率の測定値と、推定した前記推定ヨーレートとに基づいて、前記車両が前記車線の中心を走行するように前記車両の操舵角を制御するステップと、
を有する車両制御方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2022143367A JP7332008B1 (ja) | 2022-09-09 | 2022-09-09 | 車両制御装置及び車両制御方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2022143367A JP7332008B1 (ja) | 2022-09-09 | 2022-09-09 | 車両制御装置及び車両制御方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP7332008B1 JP7332008B1 (ja) | 2023-08-23 |
JP2024039084A true JP2024039084A (ja) | 2024-03-22 |
Family
ID=87576956
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2022143367A Active JP7332008B1 (ja) | 2022-09-09 | 2022-09-09 | 車両制御装置及び車両制御方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7332008B1 (ja) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008143269A (ja) * | 2006-12-07 | 2008-06-26 | Toyota Motor Corp | 車両用制御装置 |
JP2013129289A (ja) * | 2011-12-21 | 2013-07-04 | Toyota Motor Corp | 車両状態量推定装置、車両用操舵制御装置 |
US20150210300A1 (en) * | 2014-01-27 | 2015-07-30 | Lsis Co., Ltd. | Apparatus for estimating lateral forces of railroad vehicles |
JP2018060326A (ja) * | 2016-10-04 | 2018-04-12 | 株式会社豊田中央研究所 | トラッキング装置及びプログラム |
-
2022
- 2022-09-09 JP JP2022143367A patent/JP7332008B1/ja active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008143269A (ja) * | 2006-12-07 | 2008-06-26 | Toyota Motor Corp | 車両用制御装置 |
JP2013129289A (ja) * | 2011-12-21 | 2013-07-04 | Toyota Motor Corp | 車両状態量推定装置、車両用操舵制御装置 |
US20150210300A1 (en) * | 2014-01-27 | 2015-07-30 | Lsis Co., Ltd. | Apparatus for estimating lateral forces of railroad vehicles |
JP2018060326A (ja) * | 2016-10-04 | 2018-04-12 | 株式会社豊田中央研究所 | トラッキング装置及びプログラム |
Also Published As
Publication number | Publication date |
---|---|
JP7332008B1 (ja) | 2023-08-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6884276B2 (ja) | 車両を制御するシステム及び方法 | |
CN109476287B (zh) | 用于控制车辆的方法、***和非暂时性计算机可读存储器 | |
JP6191103B2 (ja) | 移動状態算出方法及び移動状態算出装置 | |
JP5955465B2 (ja) | 車両のステアリングコラムの操舵角を求める自動車、システム及び方法 | |
Wielitzka et al. | State estimation of vehicle's lateral dynamics using unscented Kalman filter | |
US20190220021A1 (en) | Travel trajectory determination system and automatic driving system | |
WO2017142075A1 (ja) | 推定装置 | |
KR102024986B1 (ko) | 차로 유지 제어 장치 및 방법 | |
JP4406608B2 (ja) | 車両の駐車過程用の幾何学的形状データを検出するための方法 | |
US20220113397A1 (en) | Target tracking device | |
US20200290577A1 (en) | System and Method for Determining Friction Curve of Tire | |
US11938952B2 (en) | Traveling trajectory estimation system, traveling trajectory estimation program, and traveling trajectory estimating method | |
JP3271952B2 (ja) | 車両の路面摩擦係数推定装置 | |
JP2001134320A (ja) | 車線追従制御装置 | |
JP2024039084A (ja) | 車両制御装置及び車両制御方法 | |
KR20160036922A (ko) | 곡률 추정 장치 및 방법 | |
JP2019066444A (ja) | 位置演算方法、車両制御方法及び位置演算装置 | |
CN114466776A (zh) | 车辆控制方法、车辆控制装置和包括该车辆控制装置的车辆控制*** | |
JP6340981B2 (ja) | 車両移動量算出装置,プログラム及び方法 | |
US11993272B2 (en) | Driving assistance method for a vehicle, control unit, driving assistance system, and vehicle | |
JP2021047153A (ja) | 追従経路生成装置、方法及びプログラム | |
US20190308629A1 (en) | Systems and methods for rough road detection | |
JP2013159246A (ja) | 車両位置姿勢推定装置及びプログラム | |
JP7206875B2 (ja) | 車両横速度推定装置 | |
JP2012163509A (ja) | 車両用推定航法装置、車両用推定航法及び車両用推定航法のプログラム |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20221019 |
|
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: 20230711 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230724 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7332008 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |