JP2022541082A - マルチセンサ情報融合に基づくモデル適応横方向速度推定方法 - Google Patents

マルチセンサ情報融合に基づくモデル適応横方向速度推定方法 Download PDF

Info

Publication number
JP2022541082A
JP2022541082A JP2021529850A JP2021529850A JP2022541082A JP 2022541082 A JP2022541082 A JP 2022541082A JP 2021529850 A JP2021529850 A JP 2021529850A JP 2021529850 A JP2021529850 A JP 2021529850A JP 2022541082 A JP2022541082 A JP 2022541082A
Authority
JP
Japan
Prior art keywords
model
lateral
tire
adaptive
yaw rate
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
JP2021529850A
Other languages
English (en)
Other versions
JP7361242B2 (ja
Inventor
偉達 王
超 楊
昌楽 項
興華 郭
金剛 劉
中国 張
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.)
BEIJING INSTITUTE OF TECHONOLOGY
Original Assignee
BEIJING INSTITUTE OF TECHONOLOGY
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 BEIJING INSTITUTE OF TECHONOLOGY filed Critical BEIJING INSTITUTE OF TECHONOLOGY
Publication of JP2022541082A publication Critical patent/JP2022541082A/ja
Application granted granted Critical
Publication of JP7361242B2 publication Critical patent/JP7361242B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/10Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
    • B60W40/105Speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F18/00Pattern recognition
    • G06F18/20Analysing
    • G06F18/25Fusion techniques
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F30/00Computer-aided design [CAD]
    • G06F30/20Design optimisation, verification or simulation
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W2050/0001Details of the control system
    • B60W2050/0019Control system elements or transfer functions
    • B60W2050/0028Mathematical models, e.g. for simulation
    • B60W2050/0031Mathematical model of the vehicle
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation

Landscapes

  • Engineering & Computer Science (AREA)
  • Theoretical Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Engineering & Computer Science (AREA)
  • Data Mining & Analysis (AREA)
  • Mechanical Engineering (AREA)
  • Transportation (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Evolutionary Computation (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Human Computer Interaction (AREA)
  • Bioinformatics & Computational Biology (AREA)
  • Bioinformatics & Cheminformatics (AREA)
  • Mathematical Physics (AREA)
  • Artificial Intelligence (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Evolutionary Biology (AREA)
  • Computer Hardware Design (AREA)
  • Geometry (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)
  • Regulating Braking Force (AREA)
  • Feedback Control In General (AREA)
  • Electric Propulsion And Braking For Vehicles (AREA)

Abstract

【要約】本発明は、マルチセンサ情報融合に基づくモデル適応横方向速度推定方法であって、まず、車両の横方向加速度、ヨーレート及び前輪操舵角等の情報を参照して、SR-UKFアルゴリズムの適応過程ノイズ行列と測定ノイズ行列を設計し、その後、元の推定方法動力学モデルを基礎として、運動学モデルを融合するように適応項を加えて、両モデル重み比が適応項の係数により調整され、最後に、適応ノイズ行列と適応モデルをSR-UKFアルゴリズムに代入して横方向速度推定を行う、方法を提供する。ここで、横方向加速度及びヨーレートセンサ値と動力学モデル計算値との偏差により両センサ信頼度の基本確率関数を定義し、そしてDempster-Shafer証拠理論に準じて両センサ情報を融合することにより、両センサの観測値から動力学モデルの精度とセンサの不確定性を定量的に計算評価し、推定方法モデルにおける適応項の係数値を得て、最終的にモデルの適応を実現する。【選択図】図1

Description

本発明は、横方向速度を推定する技術分野に関し、具体的にマルチセンサ情報融合に基づくモデル適応横方向速度推定方法に関する。
車両の走行安全は自動車工業の発展から終わりまでのテーマであり、車両の走行安全を確保するためには、その安定性制御が第一の問題である。車両安定製御システムは、車両の横縦方向速度、加速度、ヨーレート、重心側スリップ角などの状態情報を用いて、車両の両側の駆動またはブレーキトルクを制御配分し、車両の安定走行を保証する。その中で、車両の横縦方向加速度とヨーレートは既存の車載センサーで測定できるが、他の動力学的状態パラメータは状態推定のアルゴリズムを用いて推定する必要がある。センサ測定情報では、センサノイズのばらつきも無視できないため、動力学モデルと合わせてセンサシグナルを補正する必要がある。動力学モデルは車両の非線形状況下で大きなモデル誤差が発生するため、逆にセンサー情報を結合して推定アルゴリズムの収束と正確性を保証する必要がある。また、車両の横縦方向速度と加速度は、車両自体のピッチ角、ロール角、ヨー角の影響を受けるため、車両重心側スリップ角(横方向速度)の推定精度は常に上記の様々な要因に制限される。
縦速度に比べて、車両の横方向速度に関する情報が少なく、推定難易度が高く、原始的なカルマンフィルタ推定方法の精度とロバスト性は要求を満たすことができないため、新しい適応的な推定方法を用いて横方向速度の推定を行う必要がある。
本発明の目的は、まず、車両の横方向加速度、ヨーレート及び前輪操舵角等の情報を参照し、SR-UKFアルゴリズムの適応過程ノイズ行列と測定ノイズ行列を設計し、その後、元の推定方法動力学モデルを基礎として、運動学モデルを融合するように適応項を加えて、両モデル重み比が適応項の係数により調整され、最後に、適応ノイズ行列と適応モデルをSR-UKFアルゴリズムに代入して横方向速度推定を行う、マルチセンサ情報融合に基づくモデル適応横方向速度推定方法を提供することにある。ここで、横方向加速度及びヨーレートセンサ値と動力学モデル計算値との偏差により両センサ信頼度の基本確率関数を定義し、そしてDempster-Shafer証拠理論に準じて両センサ情報を融合することにより、両センサの観測値から動力学モデルの精度とセンサの不確定性を定量的に計算評価し、推定方法モデルにおける適応項の係数値を得て、最終的にモデルの適応を実現する。
上記技術課題を解決するために、本発明は、以下の実施形態を提供する。
マルチセンサ情報融合に基づくモデル適応横方向速度推定方法であって、
工程1:車両の横方向加速度、ヨーレート、縦方向速度、ステアリングホイール偏向角、横方向加速度センサ測定結果を含むセンサデータを入力して、車両動力学モデルと運動学モデルを作成し、動力学モデルでマジックフォーミュラタイヤモデルを採用してタイヤ縦方向力と横方向力を計算することと、
Figure 2022541082000002
工程3:車両動力学モデルと運動学モデルを融合して観測システムモデルを作成し、そして観測システムモデル重み適応項により、観測システムモデル適応を実現し、観測システムモデルの適応方法として、観測システムモデル重み適応項係数の調節により動力学モデルと運動学モデルとの重み比を調整し、観測システムモデル重み適応項係数の具体的な数値が、横方向加速度とヨーレートセンサ情報を参照してDempster-Shafer証拠理論に準じて計算されてなり、ここで、観測システムモデル重み適応項の決定方法として、車両の横方向加速度センサとヨーレートセンサの測定情報から、車両の横方向加速度センサの測定情報と動力学モデルにおける横方向力との偏差値を計算し、並びに、ヨーレートセンサの測定情報と動力学モデルにおけるヨーレートとの偏差値を計算し、2つの偏差値を動力学モデルの誤差判定統計量とし、誤差判定統計量により車両の横方向加速度センサ及びヨーレートセンサ信頼度の基本確率関数を定義し、そしてDempster-Shafer証拠理論に準じて横方向加速度センサ及びヨーレートセンサの情報値を融合することにより、横方向加速度センサとヨーレートセンサの観測値から動力学モデルの精度と横方向加速度センサ及びヨーレートセンサの不確定性を定量的に計算評価し、観測システムモデルにおける重み適応項係数の係数値を得て、最終的に観測システムモデルの適応調節を実現することであることと、
工程4:ノイズ行列と観測システムモデルをSR-UKFアルゴリズムに代入して、適応SR-UKFアルゴリズム(ASR-UKF)を構成して、横方向速度推定を行い、ここで、SR-UKFアルゴリズム(ASR-UKF)工程が、重みの計算とSigma点の生成、Sigma点の伝播、状態値と共分散値の更新/時間の更新、推定値と測定値の更新/計測の更新、カルマンフィルターゲインの更新工程を含むことと、
を含む、方法。
Figure 2022541082000003
・・・(5.11)
前記運動学モデルを作成することは、即ち、式(4.27)であり、
Figure 2022541082000004
前記タイヤ縦方向力と横方向力は、マジックフォーミュラを採用して計算され、マジックフォーミュラタイヤモデルには、三角関数の組み合わせを使用してタイヤ実験データをフィッティングし、同じ形式の一つの式を使用してタイヤ縦方向力、横方向力と戻しトルクの運転状態を完全に表記でき、タイヤの横・縦方向力が合わせて作用する場合でも同様に適用し、そしてフィッティング精度があり、そのため、マジックタイヤフォーミュラを採用してタイヤモデルを作成し、縦方向力と横方向力の計算式が、式2.8であり、
Figure 2022541082000005
ここでBが剛性因子であり、関数曲線原点での傾きを決定するとともに、線形タイヤモデルの剛性係数にも近似することができ、Cが曲線形状因子であり、関数曲線の形状を決定し、Dがピーク因子であり、関数曲線の最大値を決定し、Eが曲線曲率因子であり、関数曲線最大値付近の曲線形状を示し、が車輪の縦方向スリップ率であり、がタイヤ側スリップ角であり、車両の旋回走行の途中において、タイヤの縦方向力と横方向力に一定のカップリング関係が存在し、その場合、マジックタイヤフォーミュラ計算結果が以下の通り補正する。
式2.13
Figure 2022541082000006
上記推定方法では、前記工程2におけるノイズ適応の具体的な方法は、横方向加速度により構成される動力学モデルの誤差判定統計量が、式5.12で示され、
Figure 2022541082000007
Figure 2022541082000008
Figure 2022541082000009
・・・(5.16)
Figure 2022541082000010
上記式5.17により当該係数の作用をより直感的に示し、当該適応項係数がゼロである場合、式5.16における第2の項が完全にマジックタイヤフォーミュラに基づく動力学モデルであり、一方、係数が1である場合、式5.16における第2の項が完全に加速度センサに基づく運動学モデルとなり、式5.18で示されるように、そのため、動力学モデルとセンサの偏差値を参照し、当該適応項係数の具体的な数値を計算することにより、動力学モデルと運動学モデルの重み適応調節を実現することができ、
式5.18
Figure 2022541082000011
Figure 2022541082000012
同じように、車体ヨーレートセンサにより観測される動力学モデル精度の基本確率分配関数が、式5.29であり、
Figure 2022541082000013
センサ情報の精度kの組み合わせmass関数が、式5.32であり、
Figure 2022541082000014
ここでμが標定パラメータであり、シミュレーションと実際の実験により定義される。
従来技術と比較して、本発明が達成した有益な効果は、本発明がアルゴリズムモデル適応調節、ノイズ行列適応調節及び平方根無軌跡カルマンフィルター(SR-UKF)アルゴリズムの応用という3つの点で車両の横方向速度推定の適応を実現する。まず、車両の横方向加速度とヨーレートセンサ情報を参照して、SR-UKFアルゴリズムの過程ノイズ行列と測定ノイズ行列を設計し、推定方法が様々な運転状態でのノイズ適応を実現する。その後、推定方法モデルに適応項を加えて、D-S証拠理論に準じて適応項パラメータの数値を計算することにより、動力学モデルと運動学モデルとの重み比を定量的に分配し、推定方法モデルの適応を実現する。最後に、適応ノイズ行列と適応モデルをSR-UKFアルゴリズムに代入して横方向速度推定を行う。
添付の図面は本発明のさらなる理解を提供するために使用され、明細書の一部を構成し、本発明の実施例とともに本発明を説明するために使用され、本発明を限定するものではない。
本発明の実施例における横方向速度適応推定方法の概略構成図である。 本発明推定方法が高付着路面の二重動線運転状態下での横方向速度推定結果を検証する概要図である。 本発明推定方法が低付着路面の二重動線運転状態下での横方向速度推定結果を検証する概要図である。
以下、本発明の実施例における実施形態を、本発明の実施例における添付図面を参照して明確かつ完全に説明するが、説明する実施例は、本発明の一部の実施例にすぎず、全ての実施例ではないことは明らかである。本発明における実施例に基づいて、当業者が創造的な労働をしないことを前提にして得た他のすべての実施例は、本発明の保護の範囲に属する。
実施例一
低付着路面の場合での車両モデルとタイヤモデルの誤差、並びに、有色ノイズの場合でのセンサの累積誤差を考慮しながら、本発明は、マルチセンサ情報融合に基づくモデル適応横方向速度推定方法を提供する。まず、車両の横方向加速度、ヨーレート及び前輪操舵角等の情報を参照し、SR-UKFアルゴリズムの過程ノイズ行列と測定ノイズ行列を設計することにより、車両の様々な運転状態でアルゴリズムノイズの適応を実現する。その後、元の推定方法動力学モデルを基礎として、運動学モデルを融合するように適応項を加えて、両モデル重み比が適応項の係数により調整される。インホイールモーター駆動車両の縦方向力情報が比較的に精確的であるため、動力学モデルのヨーレート情報が、基本的にモデルにおける横方向力の精確程度を反映し、同様にそれを適応項に引入して推定計算することができる。車両ESPにおける横方向加速度センサとヨーレートセンサ測定情報により、それぞれ、動力学モデルにおける横方向力とヨーレートとの偏差値を計算し、動力学モデルの誤差判定統計量とする。当該統計量により両センサ信頼度の基本確率関数を定義し、そしてDempster-Shafer証拠理論に準じて両センサの情報値を融合し、両センサの観測値から動力学モデルの精度とセンサの不確定性を定量的に計算評価し、推定方法モデルにおける適応項の係数値を得て、最終的にモデルの適応を実現し、横方向速度推定方法のロバスト性を向上する。
本発明は、車両の横方向加速度、ヨーレート及び前輪操舵角等の情報を参照し、平方根無軌跡カルマンフィルターSR-UKF方法を利用して車両の横方向速度推定を行う。それにより、車両の様々な運転状態でアルゴリズムノイズの適応を実現する。つまり、本発明の中核は、SR-UKFアルゴリズムを利用して推定を行い、推定の前にセンサデータによりノイズ行列とモデルを姿勢向かい計算を行うことにある。モデルは、動力学と運動学モデルとの2つの部分からなり、2つのモデル重み(占める比率)は、D-S証拠理論に準じて計算する。重みを得た後、適応モデルを得る。その具体的な概略は、図4で示されるようになる。横方向速度推定過程におけるロバスト性と推定精度を向上させるために、推定方法に対して適応則設計を行う。一方、横方向加速度とヨーレートによりノイズ行列を定義し、様々な運転状態でのノイズ適応を実現し、一方、推定方法モデルに適応項を加えて、適応項係数の調節により動力学モデルと運動学モデルとの重み比を調整し、適応項係数の具体的な数値は、横方向加速度とヨーレートセンサ情報を参照してDempster-Shafer証拠理論に準じて計算されてなる。
本発明は、以下の工程を含む、マルチセンサ情報融合に基づくモデル適応横方向速度推定方法を提供する。
工程1:車両の横方向加速度、ヨーレート、縦方向速度、ステアリングホイール偏向角等を含むセンサデータを入力して、車両動力学モデルと運動学モデルを作成する。
Figure 2022541082000015
工程3:動力学モデルと運動学モデルを融合して観測システムモデルを作成し、そしてモデル重み適応項により、モデル適応を実現する。モデル適応方法として、推定方法モデルに適応項を加えて、適応項係数の調節により動力学モデルと運動学モデルとの重み比を調整し、適応項係数の具体的な数値は、横方向加速度とヨーレートセンサ情報を参照してDempster-Shafer証拠理論に準じて計算されてなる。ここで、モデル適応項(即ち、動力学モデルと運動学モデルとの重み比)の決定方法として、車両の横方向加速度センサとヨーレートセンサ測定情報により、それぞれ、動力学モデルにおける横方向力とヨーレートとの偏差値を計算し、動力学モデルの誤差判定統計量とする。当該統計量により両センサ信頼度の基本確率関数を定義し、そしてDempster-Shafer証拠理論に準じて両センサの情報値を融合し、両センサの観測値から動力学モデルの精度とセンサの不確定性を定量的に計算評価し、推定方法モデルにおける適応項の係数値を得て、最終的にモデルの適応を実現する。
工程4:適応ノイズ行列と適応モデルをSR-UKFアルゴリズムに代入して横方向速度推定を行う。SR-UKFアルゴリズム工程は、重みの計算とSigma点の生成、Sigma点の伝播、状態値と共分散値の更新/時間の更新、推定値と測定値の更新/計測の更新、カルマンフィルターゲインの更新等の工程を含む。
Figure 2022541082000016
上記工程1において、前記運動学モデルを作成することは、即ち、式(4.27)である。
Figure 2022541082000017
上記工程1において、タイヤ縦方向力と横方向力は、マジックフォーミュラを採用して計算される。
マジックフォーミュラタイヤモデルには、三角関数の組み合わせを使用してタイヤ実験データをフィッティングし、同じ形式の一つの式を使用してタイヤ縦方向力、横方向力と戻しトルクの運転状態を完全に表記でき、タイヤの横・縦方向力が合わせて作用する場合でも同様に適用し、そしてフィッティング精度がある。そのため、マジックタイヤフォーミュラを採用してタイヤモデルを作成する。縦方向力と横方向力の計算式が、式2.8である。
Figure 2022541082000018
Figure 2022541082000019
車両の旋回走行の途中において、タイヤの縦方向力と横方向力に一定のカップリング関係が存在する。その場合、マジックタイヤフォーミュラ計算結果が以下の通り補正し、式2.13である。
Figure 2022541082000020
上記工程2において、推定方法ノイズ適応は、具体的に、以下のとおりである。
Figure 2022541082000021
ここで、
Figure 2022541082000022
Figure 2022541082000023
Figure 2022541082000024
Figure 2022541082000025
Figure 2022541082000026
Figure 2022541082000027
当該動力学モデル適応項の意義は、適応的に運動学モデルと動力学モデルとの重み値を調整することができることにある。式5.16を展開すると、
Figure 2022541082000028
上記式5.17により当該係数の作用をより直感的に示す。当該適応項係数がゼロである場合、式5.16における第2の項が完全にマジックタイヤフォーミュラに基づく動力学モデルである。一方、係数が1である場合、式5.16における第2の項が完全に加速度センサに基づく運動学モデルとなり、式5.18で示されるようになる。そのため、動力学モデルとセンサの偏差値を参照し、当該適応項係数の具体的な数値を計算することにより、動力学モデルと運動学モデルの重み適応調節を実現することができる。
Figure 2022541082000029
モデル適応に基づくUKF推定方法は、適応因子によりノイズを調整することにより、モデルの不精確性による誤差を補償する。動力学モデルに横方向加速度センサ情報に基づく適応項を加えることにより、モデルパラメータと加速度センサノイズ累積の影響を軽減する。それとともに、元の共分散の代わりに、平方根アルゴリズムを使用して反復して、ステップ誤差及びカットオフ誤差により共分散が正定性を失い、フィルタリングができなくなる課題を解決する。
Dempster-Shafer証拠理論を導入して、横方向加速度センサ、車体ヨーレートセンサと車両動力学モデルとの不確定性情報を処理することにより、各情報源の確率値を計算し、最終的に動力学モデル適応項係数の具体的な数値を得る。
以上での推定方法のモデル適応項係数の計算
車両重心側スリップ角の推定において、本発明は、横方向加速度センサ及び車体ヨーレートセンサを観測量として使用して、推定される重心側スリップ角と横縦方向速度値を、マジックフォーミュラタイヤモデルに反復することにより、各タイヤの横方向力を計算する。車両の七つの自由度動力学モデルは、マジックタイヤフォーミュラにより計算される横方向力を基礎として、車両の旋回運動時の動力学関係式を作成する。動力学モデルの精確程度を評価するために、以上で横方向力の計算結果と横方向加速度センサ測定結果との偏差値を誤差判定統計量として、横方向加速度センサ情報動力学モデルを参照してある程度の補正を行うことを提案する。しかしながら、実際の場合に、横方向加速度センサは、ある外部の要因による干渉を受ける可能性があるため、その測定値の偏差が比較的に大きくなることがあり、この場合、横方向運動の動力学モデル精確程度が、正確的に補正と評価できなくなる。式5.17によりわかるように、ヨーレートの動力学モデル精度は、かなり四つの車輪の縦方向力と横方向力精度に依存し、そしてインホイールモーター駆動車両の縦方向力が正確的に知られるとみなすため、ヨーレート計算数値も同様に動力学モデル横方向力の精度を反映することができる。アルゴリズムのロバスト性を向上させるために、本発明には、ヨーレートセンサ測定情報を導入し、新たなヨーレート動力学モデル誤差判定統計量を作成し、横方向加速度偏差統計量と交差検証を行い、D-S証拠理論と組み合わせて動力学モデルの正確程度を推定することにより、最終的な動力学モデル適応項係数値を計算する。
車体のヨーレートが、ヨーモーメントと車体のz軸回転慣性モーメントとの比の積分と同じであり、以下の式5.26で示されるとおりである。
Figure 2022541082000030
Figure 2022541082000031
Figure 2022541082000032
Figure 2022541082000033
同じように、車体ヨーレートセンサにより観測される動力学モデル精度の基本確率分配関数が、式5.29である。
Figure 2022541082000034
まず、正規化定数Kを計算し、式5.30のとおりである。
Figure 2022541082000035
その後、動力学モデル精度dの組み合わせmass関数を計算し、式5.31のとおりである。
Figure 2022541082000036
センサ情報の精度kの組み合わせmass関数が、式5.32である。
Figure 2022541082000037
この場合、d、kの組み合わせmass関数について、その信頼関数と尤度関数値とを組み合わせた後のmass関数値がいずれも同等である。即ち、式5.33である。
Figure 2022541082000038
動力学モデル適応項係数について、以下の式に従って計算することができ、式5.34のとおりである。
Figure 2022541082000039
ここでμが標定パラメータであり、シミュレーションと実際の実験により定義される。
上記工程4で、適応ノイズ行列と適応モデルを代入SR-UKFアルゴリズム横方向速度推定を行う。SR-UKFアルゴリズム工程は、重みの計算とSigma点の生成、Sigma点の伝播、状態値と共分散値の更新/時間の更新、推定値と測定値の更新/計測の更新、カルマンフィルターゲインの更新等の工程を含む。
SR-UKFアルゴリズム工程に含まれる内容である、重みの計算とSigma点の生成、Sigma点の伝播、状態値と共分散値の更新/時間の更新、推定値と測定値の更新/計測の更新、カルマンフィルターゲインの更新工程は、いずれも従来技術の工程である。
本発明は、システムノイズ行列、アルゴリズムモデル、SR-UKFアルゴリズムという3つの点で車輪の横方向速度推定の適応を実現する。まず、RLSアルゴリズムを使用して、それぞれ、車両の質量及び重心の位置を標識し、担持の変化による動力学モデル誤差を低下させる。その後、車両の横方向加速度とヨーレートセンサ情報を参照してSR-UKFアルゴリズムの過程ノイズ行列と測定ノイズ行列を設計し、推定方法の様々な運転状態でのノイズ適応を実現する。最後に、推定方法モデルに適応項を加えて、D-S証拠理論に準じて適応項パラメータの数値を計算することにより、動力学モデルと運動学モデルとの重み比を定量的に分配し、推定方法モデルの適応を実現する。
本発明の推定方法の推定効果を検証するために、以下の検証方式により検証を行った。
1、本発明の推定方法に対して高付着路面の二重動線運転状態で検証を行い、検証効果を得た。
路面付着係数が0.85であり、標準二重動線運転状態、目的速度が60km/hと設定された。高付着路面の二重動線運転状態での横方向速度の推定誤差は、以下の表1で示される。
Figure 2022541082000040
表1及び図2からわかるように、本発明の方法は、高付着路面の安定運転状態で車両が旋回した場合、SR-UKFアルゴリズムとモデル適応に基づくSR-UKFアルゴリズムが、いずれも横方向速度の変化によく追従できた。しかしながら、車両が安定的に直進し、即ち操舵角が比較的小さい場合、ASR-UKFアルゴリズムの精確性は、SR-UKFよりも優れ、即ち、アルゴリズムの適応方法は効果的であった。
2、本発明の推定方法に対して低付着路面の二重動線運転状態で検証を行い、検証効果を得た。
CarSimで、車両の初期速度を48km/hと設定し、路面状態が、氷結路面と設定し、路面付着係数が0.4であり、二重動線運転状態で行った。前輪回転角、各車輪の車輪速度、ガウスホワイトノイズを加えた横方向加速度シグナル及びヨーレートシグナルである。
誤差分析は、以下の表2で示される。
Figure 2022541082000041
表2及び図3からわかるように、車両が正常に走行する場合、ASR-UKFとSR-UKFの相違が大きくなく、いずれも比較的に精確的に追従して横方向速度の値を推定することができた。しかしながら、車両は操舵角が最も大きい、即ち極端的な非線形領域に入った場合、元のSR-UKFアルゴリズムが、一定の偏差を示し、かつ時間に渡って増加する誤差は、次の安定走行状態に累積した。一方、本発明により提出したモデル適応に基づくSR-UKFアルゴリズムは、依然としてよく追従して横方向速度の値を推定することができた。即ち、本発明方法におけるアルゴリズムの適応規則は、車両の級端運転状態での動力学状態の推定課題をよく処理できた。
なお、以上の説明は本発明の好適な実施例にすぎず、本発明を限定するものではなく、前述の実施例を参照して本発明を詳細に説明したが、当業者にとっては、前述の各実施例に記載された技術的手段を修正したり、その技術的特徴の一部を均等に置き換えたりすることができる。本発明の精神と原則の中で、いかなる修正、同等の置換、改善なども本発明の保護範囲に含まれなければならない。

Claims (4)

  1. マルチセンサ情報融合に基づくモデル適応横方向速度推定方法であって、
    工程1:車両の横方向加速度、ヨーレート、縦方向速度、ステアリングホイール偏向角、横方向加速度センサ測定結果を含むセンサデータを入力して、車両動力学モデルと運動学モデルを作成し、動力学モデルでマジックフォーミュラタイヤモデルを採用してタイヤ縦方向力と横方向力を計算することと、
    Figure 2022541082000042
    工程3:車両動力学モデルと運動学モデルを融合して観測システムモデルを作成し、そして観測システムモデル重み適応項により、観測システムモデル適応を実現し、観測システムモデルの適応方法として、観測システムモデル重み適応項係数の調節により動力学モデルと運動学モデルとの重み比を調整し、観測システムモデル重み適応項係数の具体的な数値が、横方向加速度とヨーレートセンサ情報を参照してDempster-Shafer証拠理論に準じて計算されてなり、ここで、観測システムモデル重み適応項の決定方法として、車両の横方向加速度センサとヨーレートセンサの測定情報から、車両の横方向加速度センサの測定情報と動力学モデルにおける横方向力との偏差値を計算し、並びに、ヨーレートセンサの測定情報と動力学モデルにおけるヨーレートとの偏差値を計算し、2つの偏差値を動力学モデルの誤差判定統計量とし、誤差判定統計量により車両の横方向加速度センサ及びヨーレートセンサ信頼度の基本確率関数を定義し、そしてDempster-Shafer証拠理論に準じて横方向加速度センサ及びヨーレートセンサの情報値を融合することにより、横方向加速度センサとヨーレートセンサの観測値から動力学モデルの精度と横方向加速度センサ及びヨーレートセンサの不確定性を定量的に計算評価し、観測システムモデルにおける重み適応項係数の係数値を得て、最終的に観測システムモデルの適応調節を実現することであることと、
    工程4:ノイズ行列と観測システムモデルをSR-UKFアルゴリズムに代入して、適応SR-UKFアルゴリズム(ASR-UKF)を構成して、横方向速度推定を行い、ここで、SR-UKFアルゴリズム(ASR-UKF)工程が、重みの計算とSigma点の生成、Sigma点の伝播、状態値と共分散値の更新/時間の更新、推定値と測定値の更新/計測の更新、カルマンフィルターゲインの更新工程を含むことと、
    を含む、ことを特徴とする、推定方法。
  2. 請求項1記載の推定方法であって、
    前記工程1において、前記車両動力学モデルを作成することは、
    Figure 2022541082000043
    前記タイヤ縦方向力と横方向力は、マジックフォーミュラを採用して計算され、
    マジックフォーミュラタイヤモデルには、三角関数の組み合わせを使用してタイヤ実験データをフィッティングし、同じ形式の一つの式を使用してタイヤ縦方向力、横方向力と戻しトルクの運転状態を完全に表記でき、タイヤの横・縦方向力が合わせて作用する場合でも同様に適用し、そしてフィッティング精度があり、そのため、マジックタイヤフォーミュラを採用してタイヤモデルを作成し、縦方向力と横方向力の計算式が、式2.8であり、
    Figure 2022541082000044
    ここでBが剛性因子であり、関数曲線原点での傾きを決定するとともに、線形タイヤモデルの剛性係数にも近似することができ、Cが曲線形状因子であり、関数曲線の形状を決定し、Dがピーク因子であり、関数曲線の最大値を決定し、Eが曲線曲率因子であり、関数曲線最大値付近の曲線形状を示し、が車輪の縦方向スリップ率であり、がタイヤ側スリップ角であり、
    車両の旋回走行の途中において、タイヤの縦方向力と横方向力に一定のカップリング関係が存在し、その場合、マジックタイヤフォーミュラ計算結果が以下の通り補正し、式2.13のとおりである、
    Figure 2022541082000045
    ことを特徴とする、推定方法。
  3. 請求項1記載の推定方法であって、
    前記工程2におけるノイズ適応の具体的な方法は、
    横方向加速度により構成される動力学モデルの誤差判定統計量が、式5.12で示され、
    Figure 2022541082000046
    Figure 2022541082000047
  4. 請求項1記載の推定方法であって、
    前記工程3の具体的な方法は、
    Figure 2022541082000048
    Figure 2022541082000049
    上記式5.17により当該係数の作用をより直感的に示し、当該適応項係数がゼロである場合、式5.16における第2の項が完全にマジックタイヤフォーミュラに基づく動力学モデルであり、一方、係数が1である場合、式5.16における第2の項が完全に加速度センサに基づく運動学モデルとなり、式5.18で示されるため、動力学モデルとセンサの偏差値を参照し、当該適応項係数の具体的な数値を計算することにより、動力学モデルと運動学モデルの重み適応調節を実現することができ、式5.18のとおりであり、
    Figure 2022541082000050
    車体のヨーレートはヨーモーメントと車体のz軸回転慣性モーメントとの比の積分に等しく、以下の式5.26で示されるとおりであり、
    Figure 2022541082000051
    Figure 2022541082000052
    同じように、車体ヨーレートセンサにより観測される動力学モデル精度の基本確率分配関数が、式5.29であり、
    Figure 2022541082000053
    その後、動力学モデル精度dの組み合わせmass関数を計算し、
    式5.31
    Figure 2022541082000054
    センサ情報の精度kの組み合わせmass関数が、式5.32であり、
    Figure 2022541082000055
    ここでμが標定パラメータであり、シミュレーションと実際の実験により標定される、
    ことを特徴とする、推定方法。
JP2021529850A 2020-06-10 2020-07-22 マルチセンサ情報融合に基づくモデル適応横方向速度推定方法 Active JP7361242B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
CN202010525798.7A CN111645699B (zh) 2020-06-10 2020-06-10 基于多传感器信息融合的模型自适应侧向速度估计方法
CN202010525798.7 2020-06-10
PCT/CN2020/103631 WO2021248641A1 (zh) 2020-06-10 2020-07-22 基于多传感器信息融合的模型自适应侧向速度估计方法

Publications (2)

Publication Number Publication Date
JP2022541082A true JP2022541082A (ja) 2022-09-22
JP7361242B2 JP7361242B2 (ja) 2023-10-16

Family

ID=72345004

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2021529850A Active JP7361242B2 (ja) 2020-06-10 2020-07-22 マルチセンサ情報融合に基づくモデル適応横方向速度推定方法

Country Status (3)

Country Link
JP (1) JP7361242B2 (ja)
CN (1) CN111645699B (ja)
WO (1) WO2021248641A1 (ja)

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113030504B (zh) * 2021-03-18 2023-03-07 北京航迹科技有限公司 车辆测速方法、装置、车载计算机设备和存储介质
CN113830094B (zh) * 2021-09-16 2024-04-30 常州工学院 一种考虑多源输入信息的车辆质心侧偏角自适应融合与补偿方法
CN114136273B (zh) * 2021-11-30 2023-09-22 吉林大学 一种车轮转角综合测量系统
CN114506388B (zh) * 2021-12-27 2023-04-07 广东机电职业技术学院 一种车辆转向控制方法、装置、计算机设备和存储介质
CN114357651A (zh) * 2022-01-04 2022-04-15 北京理工大学 一种高效的不确定性柔性多体系统动力学响应预测方法
CN114357794B (zh) * 2022-01-12 2024-07-05 东南大学 一种基于改进卡尔曼滤波的公交进站停车测评方法
CN114454893B (zh) * 2022-01-27 2024-08-16 中国矿业大学 一种路面自适应矿卡轨迹跟踪预测控制方法
CN117540464A (zh) * 2023-11-13 2024-02-09 青岛高速集团有限公司 基于kriging代理模型的桥梁数字孪生体构建方法
CN117485325B (zh) * 2024-01-02 2024-03-19 中国重汽集团济南动力有限公司 一种多轴分布式电驱车辆转向控制方法及车辆
CN118025223A (zh) * 2024-01-15 2024-05-14 华南理工大学 基于长短时记忆网络的无人驾驶汽车学习型预测控制方法
CN117848332B (zh) * 2024-03-07 2024-05-03 北京理工大学前沿技术研究院 一种车载多源融合高精度定位系统的imu噪声消除方法
CN117911414A (zh) * 2024-03-20 2024-04-19 安徽大学 一种基于强化学习的自动驾驶汽车运动控制方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6816804B1 (en) * 2003-06-04 2004-11-09 Visteon Global Technologies, Inc. System and method for estimating velocity using reliability indexed sensor fusion
JP2006046986A (ja) * 2004-08-02 2006-02-16 Hitachi Ltd センサ情報統合解析装置および方法
DE102008051962A1 (de) * 2007-10-18 2009-05-14 GM Global Technology Operations, Inc., Detroit Verfahren mit rekonfigurierbarer Struktur zum Schätzen der Quergeschwindigkeit eines Fahrzeugs
US20110125455A1 (en) * 2008-11-24 2011-05-26 Gm Global Technology Operations, Llc System for estimating the lateral velocity of a vehicle
JP2012141953A (ja) * 2010-11-09 2012-07-26 Ntt Docomo Inc モバイルネットワーク内のモバイル動作データ及び/又は地理的情報を使用する人口追跡、計数、及び移動推定のためのシステム及び方法
US20160159365A1 (en) * 2014-12-03 2016-06-09 The Goodyear Tire & Rubber Company Intelligent tire-based road friction estimation system and method
JP2019523176A (ja) * 2016-07-29 2019-08-22 ツェットエフ、フリードリッヒスハーフェン、アクチエンゲゼルシャフトZf Friedrichshafen Ag 走行状態変数を決定する方法

Family Cites Families (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102006055550A1 (de) * 2006-11-24 2008-05-29 Robert Bosch Gmbh Verfahren zur Schätzung zumindest einer Fahrzustandsgröße eines Fahrzeugs
DE102007013261B4 (de) * 2007-03-20 2017-03-16 Ford Global Technologies, Llc Verfahren und Vorrichtung zum Schätzen der Quergeschwindigkeit eines Fahrzeuges
JP6278745B2 (ja) * 2014-02-28 2018-02-14 東京計器株式会社 船舶用自動操舵装置
CN104182991A (zh) * 2014-08-15 2014-12-03 辽宁工业大学 一种车辆行驶状态估计方法及装置
WO2016062327A1 (en) * 2014-10-20 2016-04-28 Politecnico Di Milano Method for estimating a vehicle side slip angle, computer program implementing said method, control unit having said computer program loaded, and vehicle comprising said control unit
CN104401323A (zh) * 2014-11-04 2015-03-11 河北工程大学 一种重型车辆侧翻预警方法及装置
CN105083373B (zh) * 2015-06-15 2017-11-28 南京航空航天大学 一种基于参数估计的线控转向路感装置及其控制方法
CN108594652B (zh) * 2018-03-19 2021-05-25 江苏大学 一种基于观测器信息迭代的车辆状态融合估计方法
CN108545081B (zh) * 2018-03-20 2020-04-28 北京理工大学 基于鲁棒无迹卡尔曼滤波的质心侧偏角估计方法及系统
CN109591827B (zh) * 2018-11-13 2020-05-15 南京航空航天大学 一种基于侧向速度估计的汽车质量辨识方法
CN109606378B (zh) * 2018-11-19 2020-06-09 江苏大学 面向非高斯噪声环境的车辆行驶状态估计方法
CN109664890B (zh) * 2018-12-24 2020-08-04 河北工程大学 基于svm模型的汽车侧翻预警算法
CN110532590B (zh) * 2019-07-12 2023-06-13 南京航空航天大学 一种基于自适应容积粒子滤波的车辆状态估计方法
CN110987068B (zh) * 2019-11-28 2021-11-30 中国人民解放军陆军炮兵防空兵学院郑州校区 一种多传感器综合控制系统数据融合方法
CN110861651B (zh) * 2019-12-02 2021-07-23 吉林大学 一种前车纵侧向运动状态估计方法
CN110884499B (zh) * 2019-12-19 2021-03-19 北京理工大学 一种确定车辆质心侧偏角的方法和系统
CN111055921B (zh) * 2019-12-31 2021-06-29 吉林大学 一种基于数据驱动的四轮转向模型预测控制方法
CN111152795B (zh) * 2020-01-08 2022-12-13 东南大学 一种基于模型和参数动态调整的自适应车辆状态预测系统及预测方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6816804B1 (en) * 2003-06-04 2004-11-09 Visteon Global Technologies, Inc. System and method for estimating velocity using reliability indexed sensor fusion
JP2006046986A (ja) * 2004-08-02 2006-02-16 Hitachi Ltd センサ情報統合解析装置および方法
DE102008051962A1 (de) * 2007-10-18 2009-05-14 GM Global Technology Operations, Inc., Detroit Verfahren mit rekonfigurierbarer Struktur zum Schätzen der Quergeschwindigkeit eines Fahrzeugs
US20110125455A1 (en) * 2008-11-24 2011-05-26 Gm Global Technology Operations, Llc System for estimating the lateral velocity of a vehicle
JP2012141953A (ja) * 2010-11-09 2012-07-26 Ntt Docomo Inc モバイルネットワーク内のモバイル動作データ及び/又は地理的情報を使用する人口追跡、計数、及び移動推定のためのシステム及び方法
US20160159365A1 (en) * 2014-12-03 2016-06-09 The Goodyear Tire & Rubber Company Intelligent tire-based road friction estimation system and method
JP2019523176A (ja) * 2016-07-29 2019-08-22 ツェットエフ、フリードリッヒスハーフェン、アクチエンゲゼルシャフトZf Friedrichshafen Ag 走行状態変数を決定する方法

Also Published As

Publication number Publication date
JP7361242B2 (ja) 2023-10-16
WO2021248641A1 (zh) 2021-12-16
CN111645699A (zh) 2020-09-11
CN111645699B (zh) 2021-08-31

Similar Documents

Publication Publication Date Title
JP2022541082A (ja) マルチセンサ情報融合に基づくモデル適応横方向速度推定方法
Li et al. Comprehensive tire–road friction coefficient estimation based on signal fusion method under complex maneuvering operations
EP1992537B1 (en) Motion control unit for vehicle based on jerk information
Zhao et al. Design of a nonlinear observer for vehicle velocity estimation and experiments
CN103407451B (zh) 一种道路纵向附着系数估计方法
JP5096781B2 (ja) 車両の路面摩擦係数推定装置
CN106828464A (zh) 一种基于路面附着系数估算的车身稳定控制方法及系统
CN111483467B (zh) 一种车辆控制方法及装置
US6745112B2 (en) Method of estimating quantities that represent state of vehicle
CN108248583B (zh) 一种汽车电子稳定控制系统及其分层控制方法
CN112758097A (zh) 一种用于无人驾驶车辆的状态预测与估计方法
JP2002145037A (ja) 車両の路面摩擦係数推定装置
CN105253141A (zh) 一种基于车轮纵向力调节的车辆操纵稳定性控制方法
KR20080105032A (ko) 차량 특성 결정 방법
JP2004521023A (ja) 車両性能モニタ装置および方法
CN104354697A (zh) 一种利用在线修正的汽车状态参数估计路面附着系数的方法
CN111688715B (zh) 四轮驱动电动汽车基于融合技术的质心侧偏角观测方法
US11787394B2 (en) Supervisory control for e-AWD and e-LSD
CN110979026A (zh) 一种基于实时路况的分布式驱动公交车转矩分配方法
CN116061934A (zh) 用于管理底盘和传动系致动器的架构和基于模型预测控制的方法
CN110516311B (zh) 一种针对车用加速度传感器常值误差的综合补偿策略构建方法
JP3271956B2 (ja) 車両の路面摩擦係数推定装置
US20080167777A1 (en) Method for Controlling the Steering Orientation of a Vehicle
KR20180068681A (ko) 차량의 거동 산출 시스템 및 방법
JP4926729B2 (ja) 車両の路面摩擦係数推定装置

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20210526

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20221004

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20221206

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: 20230404

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230426

R150 Certificate of patent or registration of utility model

Ref document number: 7361242

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150