JP2023175613A - 道路対比での車両の傾きを推定するための装置およびその方法 - Google Patents
道路対比での車両の傾きを推定するための装置およびその方法 Download PDFInfo
- Publication number
- JP2023175613A JP2023175613A JP2022190777A JP2022190777A JP2023175613A JP 2023175613 A JP2023175613 A JP 2023175613A JP 2022190777 A JP2022190777 A JP 2022190777A JP 2022190777 A JP2022190777 A JP 2022190777A JP 2023175613 A JP2023175613 A JP 2023175613A
- Authority
- JP
- Japan
- Prior art keywords
- road
- inclination
- section
- vehicle
- data
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 33
- 238000007781 pre-processing Methods 0.000 claims abstract description 37
- 230000001133 acceleration Effects 0.000 claims description 42
- 239000000284 extract Substances 0.000 claims description 16
- 238000011156 evaluation Methods 0.000 claims description 9
- 238000010586 diagram Methods 0.000 description 13
- 239000000470 constituent Substances 0.000 description 4
- 230000003068 static effect Effects 0.000 description 4
- 230000005484 gravity Effects 0.000 description 3
- 238000012935 Averaging Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 239000000725 suspension Substances 0.000 description 2
- 238000003491 array Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000004313 glare Effects 0.000 description 1
- 238000005286 illumination Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Estimation 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Estimation 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/10—Estimation 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/11—Pitch movement
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C9/00—Measuring inclination, e.g. by clinometers, by levels
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/18—Propelling the vehicle
- B60W30/18009—Propelling the vehicle related to particular drive situations
- B60W30/18072—Coasting
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Estimation 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/02—Estimation 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 ambient conditions
- B60W40/06—Road conditions
- B60W40/076—Slope angle of the road
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Estimation 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/10—Estimation 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/105—Speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/04—Vehicle stop
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/10—Longitudinal speed
- B60W2520/105—Longitudinal acceleration
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/12—Lateral speed
- B60W2520/125—Lateral acceleration
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/16—Pitch
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/18—Roll
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/28—Wheel speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/15—Road slope, i.e. the inclination of a road segment in the longitudinal direction
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
【課題】道路対比での車両の傾きを推定するための装置およびその方法を提供する。【解決手段】道路対比での車両の傾きを測定するための装置は、ホイール速度データを獲得するホイール速度センサ部120、IMUデータを獲得するIMUセンサ部110、ホイール速度データとIMUデータとに基づいて停止区間と運動区間を抽出する前処理部130、および停止区間で車両の傾きを推定し、運動区間で道路の傾きを推定した後、車両の傾きと道路の傾きとに基づいて道路対比での車両の傾きを推定する傾き推定部140を含む。【選択図】図1
Description
実施例は道路対比での車両の傾きを推定するための装置およびその方法に関する。
一般的にヘッドランプは一定の方向に光を照射するように設置されるが、車両の車高が変わる場合にも一定の方向に光を照射する場合には十分な視野を確保できなかったり対向車両に眩しさが発生されるようにする場合が発生することになる。
このような車体の高さの変化をセンシングし、そのセンシングした値に基づいてヘッドランプの照射角を調整する方案が提示されるが、このような方案は車高センサを利用して車体の高さの変化をセンシングすることになる。
しかし、車高センサを利用した車両の傾きの算出は車両の車体とサスペンション間の高さの差に基づいてなされるため、算出される車両の傾きと車両の実際の傾きの間には差が発生し、一つの車高センサを利用する場合には、算出された傾きと実際の傾きの間の差はさらに大きくなる問題がある。
実施例は、道路対比での車両の傾きを推定するための装置およびその方法を提供することができる。
実施例で解決しようとする課題はこれに限定されるものではなく、以下で説明する課題の解決手段や実施形態から把握され得る目的や効果も含まれると言える。
実施例に係る道路対比での車両の傾きを測定するための装置は、ホイール速度データを獲得するホイール速度センサ部;IMUデータを獲得するIMUセンサ部;前記ホイール速度データと前記IMUデータとに基づいて停止区間と運動区間を抽出する前処理部;および前記停止区間で車両の傾きを推定し、前記運動区間で道路の傾きを推定した後、前記車両の傾きと前記道路の傾きとに基づいて道路対比での車両の傾きを推定する傾き推定部を含むことができる。
前記前処理部は前記IMUデータと予め定められた臨界値とを比較し、その比較した結果によって前記IMUデータが有効なデータであるか否かを点検する第1前処理部;および前記IMUデータが有効なデータである場合、前記IMUデータのうち加速度データと前記ホイール速度データとに基づいて前記停止区間と前記運動区間を抽出する第2前処理部を含むことができる。
前記運動区間は加速区間と減速区間を含み、前記第2前処理部は前記停止区間と前記加速区間または前記減速区間と前記停止区間を一つの対で抽出することができる。
前記第2前処理部は前記停止区間で前記IMUセンサ部のバイアスの平均値を算出し、前記算出されたバイアスの平均値を前記IMUデータのうち角速度データから差し引いて除去することができる。
前記傾き推定部は、前記停止区間で前記IMUデータのうち加速度データに基づいて前記車両の傾きを推定することができる。
前記傾き推定部は前記運動区間で予め定められた時間ごとに速度の入力を受け、前記入力を受けた速度に基づいて一定の大きさ以上の速度を有する区間を関心領域として抽出し、前記関心領域の各地点の速度に基づいて多数の道路の傾きを算出した後、前記算出された多数の道路の傾きの平均値を前記運動区間に対する前記道路の傾きとして最終的に推定することができる。
前記傾き推定部は、前記運動区間のうち少なくとも一部の区間に対する速度に基づいて前記道路の傾きを推定することができる。
前記傾き推定部は前記運動区間で予め定められた時間ごとに位置の入力を受け、前記運動区間における開始地点と終了地点の位置に基づいて前記運動区間に対する前記道路の傾きを最終的に推定することができる。
前記傾き推定部は、前記運動区間のうち少なくとも一部の区間に対する位置に基づいて前記道路の傾きを推定することができる。
前記傾き推定部は道路の形状に仮想の直線をフィッティングして前記仮想の直線と車両の位置に基づいてエラーの大きさを算出し、前記算出されたエラーの大きさと予め定められた臨界値とを比較して道路の線形性を評価し、前記評価した結果で前記道路の線形性が適合な場合、前記道路対比での車両の傾きを推定することができる。
実施例に係る道路対比での車両の傾きを測定するための方法は、ホイール速度データとIMUデータを獲得する段階;前記ホイール速度データと前記IMUデータとに基づいて停止区間と運動区間を抽出する前処理段階;前記停止区間で車両の傾きを推定する第1推定段階;前記運動区間で道路の傾きを推定する第2推定段階;および前記車両の傾きと前記道路の傾きとに基づいて道路対比での車両の傾きを推定する第3推定段階を含むことができる。
前記前処理段階は前記IMUデータと予め定められた臨界値とを比較し、その比較した結果によって前記IMUデータが有効なデータであるか否かを点検する第1前処理段階;および前記IMUデータが有効なデータである場合、前記IMUデータのうち加速度データと前記ホイール速度データとに基づいて前記停止区間と前記運動区間を抽出する第2前処理段階を含むことができる。
前記運動区間は加速区間または減速区間を含み、前記第2前処理段階は前記停止区間と前記加速区間または前記減速区間と前記停止区間を一つの対で抽出することができる。
前記第2前処理段階は前記停止区間でIMUセンサ部のバイアスの平均値を算出し、前記算出されたバイアスの平均値を前記IMUデータのうち角速度データから差し引いて除去することができる。
前記第1推定段階は、前記停止区間で前記IMUデータのうち加速度データに基づいて前記車両の傾きを推定することができる。
前記第2推定段階は前記運動区間で予め定められた時間ごとに速度の入力を受け、前記入力を受けた速度に基づいて一定の大きさ以上の速度を有する区間を関心領域として抽出し、前記関心領域の各地点の速度に基づいて多数の道路の傾きを算出した後、前記算出された多数の道路の傾きの平均値を前記運動区間に対する前記道路の傾きとして最終的に推定することができる。
前記第2推定段階は、前記運動区間のうち少なくとも一部の区間に対する速度に基づいて前記道路の傾きを推定することができる。
前記第2推定段階は前記運動区間で予め定められた時間ごとに位置の入力を受け、前記運動区間における開始地点と終了地点の位置に基づいて前記運動区間に対する前記道路の傾きを最終的に推定することができる。
前記第2推定段階は、前記運動区間のうち少なくとも一部の区間に対する位置に基づいて前記道路の傾きを推定することができる。
前記第3推定段階は道路の形状に仮想の直線をフィッティングして前記仮想の直線と車両の位置に基づいてエラーの大きさを算出し、前記算出されたエラーの大きさと予め定められた臨界値とを比較して道路の線形性を評価し、前記評価した結果で前記道路の線形性が適合な場合、前記道路対比での車両の傾きを推定することができる。
実施例によると、ホイール速度データとIMUデータとに基づいて停止区間と運動区間を抽出し、停止区間で車両の傾きを推定して運動区間で道路の傾きを推定した後、車両の傾きと道路の傾きに基づいて道路対比での車両の傾きを推定するようにすることによって、道路対比での車両の傾きを正確に推定することができる。
本発明の多様かつ有益な長所と効果は前述した内容に限定されず、本発明の具体的な実施形態を説明する過程でより容易に理解され得るであろう。
以下、添付された図面を参照して本発明の好ましい実施例を詳細に説明する。
ただし、本発明の技術思想は説明される一部の実施例に限定されるものではなく、互いに異なる多様な形態で具現され得、本発明の技術思想範囲内であれば、実施例間にその構成要素のうち一つ以上を選択的に結合、置き換えて使うことができる。
また、本発明の実施例で使われる用語(技術および科学的用語を含む)は、明白に特に定義されて記述されない限り、本発明が属する技術分野で通常の知識を有する者に一般的に理解され得る意味で解釈され得、辞書に定義された用語のように一般的に使われる用語は関連技術の文脈上の意味を考慮してその意味を解釈できるであろう。
また、本発明の実施例で使われた用語は実施例を説明するためのものであって、本発明を制限しようとするものではない。
本明細書で、単数型は文面で特に言及しない限り複数型も含むことができ、「Aおよび(と)B、Cのうち少なくとも一つ(または一つ以上)」と記載される場合、A、B、Cで組み合わせできるすべての組み合わせのうち一つ以上を含むことができる。
また、本発明の実施例の構成要素を説明するにおいて、第1、第2、A、B、(a)、(b)等の用語を使うことができる。
このような用語はその構成要素を他の構成要素と区別するためのものに過ぎず、その用語によって該当構成要素の本質や順番または順序などに限定されない。
そして、或る構成要素が他の構成要素に「連結」、「結合」または「接続」されると記載された場合、その構成要素はその他の構成要素に直接的に連結、結合または接続される場合だけでなく、その構成要素とその他の構成要素の間にあるさらに他の構成要素によって「連結」、「結合」または「接続」される場合も含むことができる。
また、各構成要素の「上(うえ)または下(した)」に形成または配置されるものとして記載される場合、上(うえ)または下(した)は二つの構成要素が互いに直接接触する場合だけでなく、一つ以上のさらに他の構成要素が二つの構成要素の間に形成または配置される場合も含む。また、「上(うえ)または下(した)」で表現される場合、一つの構成要素を基準として上側方向だけでなく下側方向の意味も含むことができる。
図1は実施例に係る道路対比での車両の傾きを推定するための装置を示す図面であり、図2a~図2cは実施例に係る座標系を説明するための図面であり、図3は車両の傾き、道路の傾き、道路対比での車両の傾きを説明するための図面である。
図1を参照すると、実施例に係る道路対比での車両の傾きを推定するための装置は、IMU(Inertial Measurement Unit)センサ部110、ホイール速度センサ部120、前処理部130、および傾き推定部140を含むことができる。
IMUセンサ部110は加速度(acceleration)、回転角速度(rotation rate)のような車両の動きに対するデータすなわち、IMUデータを獲得することができる。加速度はボディフレーム(body frame)上でx、y、z軸加速度と重力(gravitational force)を含み、回転角速度はボディフレーム上でx、y、z軸角速度を含むことができる。
この時、図2aのボディフレームは車両の動きにしたがって一緒に動く車両基準座標系であり、図2bのロードフレーム(road frame)は道路の傾きに合わせて変わる道路基準座標系であり、図2cのナビゲーションフレーム(navigation frame)は車両の動きに関係なく基準点を基準に変わらない座標系をそれぞれ示す。
IMUセンサ部110はジャイロスコープ(gyroscope)センサと加速度(acceleration)センサを含むことができる。まず、加速度センサはボディフレーム上で加速度と重力を測定することができる。IMUセンサ部100の3軸加速度と重力はボディフレーム上で測定され得る。また、ジャイロスコープセンサはボディフレーム上で角速度を測定することができる。角速度は車両の縦方向の動きが考慮されるため、車両のピッチ動きが測定されなければならない。したがって、単一y一軸ジャイロスコープが使われ得るが、単一y一軸ジャイロスコープがなくても具現可能であるが性能が低下する可能性がある。
ホイール速度センサ部120は、CAN(Controller Area Network)を通じてホイール速度データを獲得することができる。この時、ホイール速度データは駆動ホイール(driving wheel)ではなく二つのリアホイール(rear wheel)の速度を平均して獲得できるが、必ずしもこれに限定されない。
前処理部130はIMUセンサ部110から獲得したIMUデータとホイール速度センサ部120から獲得したホイール速度データを前処理することができる。前処理部130は第1前処理部131と第2前処理部132を含むことができる。
第1前処理部131は、IMUデータが有効なデータであるか否かを点検することができる。例えば、第1前処理部131はIMUデータが予め定められた臨界値以上の場合に有効なデータと判断し、臨界値未満の場合に有効でないデータと判断することができる。
第2前処理部132は、IMUデータとホイール速度データとに基づいて停止区間と運動区間を抽出することができる。停止区間は車両が停止状態である区間であって、ホイール速度データが0である区間であり得る。運動区間は車両が減速または加速する区間であり得る。
第1前処理部131は、IMUデータからIMUエラーを除去することができる。IMUエラーは、バイアス(bias)とゼロ平均ホワイトノイズ(zero mean white noise)の二つのタイプがある。このようなエラーは加速度と角速度を積分する場合、大きな問題となり得る。車両が停止する場合、ジャイロスコープの出力は唯一バイアスと雑音のみである。
実施例ではジャイロスコープのバイアスを除去してIMUデータの質を向上させ、平均値を通じてバイアスを推定してゼロ平均ホワイトノイズを除去する。
傾き推定部140は、前処理されたIMUデータとホイール速度データに基づいて道路対比での車両の傾きを推定することができる。傾き推定部140は第1傾き推定部141、第2傾き推定部142、第3傾き推定部143、線形性評価部144を含むことができる。
第1傾き推定部141は、停止状態での車両の傾きを推定することができる。第1傾き推定部141は、第2前処理部132から抽出された停止区間で車両の傾きを推定することができる。
第2傾き推定部142は、運動状態での道路の傾きを推定することができる。第2傾き推定部142は、第2前処理部132から抽出された運動区間で道路の傾きを推定することができる。
線形性評価部144は、道路の傾きを算出するための道路の線形性(直線性)を評価することができる。例えば、道路の線形性に適合であると評価した場合にのみ推定過程を遂行して第3傾き推定部143が道路対比での車両の傾きを推定することができる。
図4は道路対比での車両の傾きを推定するための方法を示す図面であり、図5a~図5dは図4に図示された道路の傾き推定区間の抽出過程を示す図面であり、図6は図4に図示されたバイアスの除去原理を説明するための図面であり、図7は図4に図示された車両の傾き推定原理を説明するための図面である。
図4を参照すると、実施例に係る車両の傾きを測定するための装置(以下、傾き推定装置という)はIMUデータとホイール速度データを受信することができる(S110)。
次に、傾き推定装置は受信されたIMUデータが有効なデータであるか否かを点検することができる(S120)。この時、傾き測定装置は予め定められたパラメータに基づいてIMUデータが有効なデータであるか否かを点検することができる。予め定められたパラメータは加速度、操舵角、道路の傾きを含むことができる。
例えば、傾き推定装置はIMUデータとホイール速度データに基づいて車両の加速度が予め定められた加速度以下であるか、車両の操舵角が予め定められた操舵角以上であるか、車両が位置する道路の傾きが予め定められた道路の傾き(pitch方向)以上の場合であるか、予め定められた道路の傾き(roll方向)以上である場合、IMUデータとホイール速度データが有効でないデータであると判断して傾き推定過程を終了することができる。
このような理由は、加速度は急加速の場合にサスペンション運動によるノイズが大部分であり、操舵角はY軸加速度の変化を引き起こし、一定の大きさ以上の道路の傾きは荷重による道路対比での車両の傾きの静的変化を起こすため、これを考慮するためである。
次に、傾き推定装置は受信されたIMUデータとホイール速度データに基づいて道路の傾き推定区間を抽出することができる(S130)。この時、道路の傾き推定区間は停止後加速される停止-加速区間と減速後停止される減速-停止区間を含むことができる。実施例に係る道路の傾き推定区間では停止後加速または走行中に減速後停止状態を判断するため、IMUデータのうちIMU加速度データを利用している。
具体的には、傾き推定装置は図5aのIMU加速度データを受信し、受信されたIMU加速度データをフィルタリングして一定の大きさ以上のIMU加速度データを抽出することができる。
傾き推定装置はフィルタリングされたIMU加速度データとホイール速度データに基づいて、図5bのように、停止区間、加速区間、減速区間を区分することができる。
この時、停止区間と加速区間または減速区間と停止区間は、加速度の大きさが一定の値以上の区間を運動区間すなわち、加速区間と減速区間として決定することができる。
傾き推定装置は、図5cおよび図5dのように区分された停止区間、加速区間、減速区間に基づいて、停止-加速区間または減速-停止区間を道路の傾き推定区間として抽出することができる。
実施例では、このように停止-加速区間または減速-停止区間でのIMUデータとホイール速度データを利用して道路対比での車両の傾きを推定しようとする。
次に、傾き推定装置は停止区間でバイアスの平均値を算出し、算出されたバイアスの平均値をIMUデータすなわち、IMU角速度データから差し引いて除去することができる(S140)。
図6のように角速度系の出力値すなわち、IMU角速度データはバイアスが含まれて高いため、バイアスの平均値を差し引いて除去して低くなることが分かる。
次に、傾き推定装置は停止区間でIMUデータすなわち、IMU加速度データに基づいて静的な車両の傾きすなわち、ピッチ(pitch)、ロール(roll)を推定することができる(S150)。この時、図7のように停止区間で重力(gn)の位置に基づいて静的な車両の傾きを推定するが、静的な車両の傾きは次の[数1]、[数2]のように定義される。
次に、傾き推定装置はIMUデータに基づいて道路の傾きを推定することができる(S160)。道路の傾きは加速度、速度、位置に基づいて算出され得るが、各道路の傾きは次の[数3]、[数4]、[数5]のように定義される。
この時、加速度、速度、位置の関係は次の[数6]、[数7]のように定義される。
図8a~図8bは、実施例に係る速度ベースの道路の傾き算出原理を説明するための図面である。
図8aを参照すると、傾き推定装置は運動区間で予め定められた時間ごとに速度の入力を受け、入力を受けた速度に基づいて一定の大きさ以上の速度を有する区間を関心領域として抽出することができる。
傾き推定装置は、各地点の速度に基づいて多数の第1道路の傾きを算出することができる。
傾き推定装置は算出された多数の第1道路の傾きを平均して一つの第2道路の傾きを算出するが、第2道路の傾きを最終道路の傾きとして算出することになる。
図8bを参照すると、実施例では速度に対する開始マージンと終了マージンを考慮して、運動区間全体ではなく一部の運動区間でのみ道路の傾きを算出しようとする。
例えば、全体運動区間のうち、開始部分の一部の運動区間と終了部分の一部の運動区間を除いた残りの区間で入力を受けた速度に基づいて道路の傾きを算出することになる。
図9a~図9bは、実施例に係る位置ベースの道路の傾き算出原理を説明するための図面である。
図9aを参照すると、傾き推定装置は運動区間で予め定められた時間ごとに位置の入力を受け、開始地点と終了地点の位置に基づいて道路の傾きを算出することになる。
図9bを参照すると、実施例では位置に対する開始マージンと終了マージンを考慮して、運動区間全体ではなく一部の運動区間でのみ道路の傾きを算出しようとする。
例えば、全体運動区間のうち、開始部分の一部の運動区間と終了部分の一部の運動区間を除いた残りの区間で入力を受けた位置に基づいて道路の傾きを算出することになる。
この時、開始マージンと終了マージンは開始マージン比率と終了マージン比率で設定され得る。ここでは開始マージンと終了マージンをすべて考慮した例を説明しているが、必ずしもこれに限定されず、開始マージンと終了マージンのうち少なくとも一つを適用することができる。
また、開始マージンと終了マージンは同一のマージン比率を有することができるが、必ずしもこれに限定されず、状況によって互いに異なるマージン比率を有し得る。例えば、停止後加速である区間では開始マージン比率が終了マージン比率より大きく、減速後停止区間では開始マージン比率より終了マージン比率が大きく設定され得る。
次に、傾き推定装置は道路の線形性を評価することができる(S170)。
図10は、図4に図示された道路の線形性評価原理を説明するための図面である。
図10を参照すると、傾き推定装置は道路の形状に仮想の直線をフィッティングし、仮想の直線と車両の位置に基づいてエラーの大きさを算出して算出されたエラーの大きさに基づいて道路の線形性を評価することができる。
例えば、傾き推定装置はエラーの大きさが予め定められた臨界値以上の場合、道路が屈曲が激しいため道路の傾きを算出するための道路の線形性に不適合であると判断して、道路対比での車両の傾きを推定せずに推定過程を終了することになる。
反面、傾き推定装置はエラーの大きさが予め定められた臨界値未満の場合、道路が屈曲が激しくないため道路の傾きを算出するための道路の線形性に適合であると判断することができる。
次に、傾き推定装置は道路の線形性に適合すると判断される場合、推定された車両の傾きと道路の傾きに基づいて道路対比での車両の傾きを推定することができる(S180)。このような道路対比での車両の傾きは次の[数8]のように定義される。
本実施例で使われる「~部」という用語は、ソフトウェアまたはFPGA(field-programmable gate array)またはASICのようなハードウェア構成要素を意味し、「~部」は何らかの役割を遂行する。しかし、「~部」はソフトウェアまたはハードウェアに限定される意味ではない。「~部」はアドレッシングできる保存媒体にあるように構成されてもよく、一つまたはそれ以上のプロセッサを再生させるように構成されてもよい。したがって、一例として、「~部」はソフトウェア構成要素、客体指向ソフトウェア構成要素、クラス構成要素およびタスク構成要素のような構成要素と、プロセス、関数、属性、プロシーザー、サブルーチン、プログラムコードのセグメント、ドライバ、ファームウェア、マイクロコード、回路、データ、データベース、データ構造、テーブル、アレイ、および変数を含む。構成要素と「~部」内で提供される機能は、さらに小さい数の構成要素および「~部」で結合されたり追加的な構成要素と「~部」にさらに分離され得る。それだけでなく、構成要素および「~部」はデバイスまたはセキュリティマルチメディアカード内の一つまたはそれ以上のCPUを再生させるように具現されてもよい。
前記では本発明の好ましい実施例を参照して説明したが、該当技術分野の熟練した当業者は、下記の特許請求の範囲に記載された本発明の思想および領域から逸脱しない範囲内で本発明を多様に修正および変更できることが理解できるであろう。
110:IMUセンサ部
120:ホイール速度センサ部
130:前処理部
131:第1前処理部
132:第2前処理部
140:傾き推定部
141:第1傾き推定部
142:第2傾き推定部
143:第3傾き推定部
144:線形性評価部
120:ホイール速度センサ部
130:前処理部
131:第1前処理部
132:第2前処理部
140:傾き推定部
141:第1傾き推定部
142:第2傾き推定部
143:第3傾き推定部
144:線形性評価部
Claims (20)
- ホイール速度データを獲得するホイール速度センサ部;
IMUデータを獲得するIMUセンサ部;
前記ホイール速度データと前記IMUデータとに基づいて停止区間と運動区間を抽出する前処理部;および
前記停止区間で車両の傾きを推定し、前記運動区間で道路の傾きを推定した後、前記車両の傾きと前記道路の傾きとに基づいて道路対比での車両の傾きを推定する傾き推定部を含む、道路対比での車両の傾きを測定するための装置。 - 前記前処理部は、
前記IMUデータと予め定められた臨界値とを比較し、その比較した結果によって前記IMUデータが有効なデータであるか否かを点検する第1前処理部;および
前記IMUデータが有効なデータである場合、前記IMUデータのうち加速度データと前記ホイール速度データとに基づいて前記停止区間と前記運動区間を抽出する第2前処理部を含む、請求項1に記載の道路対比での車両の傾きを測定するための装置。 - 前記運動区間は加速区間または減速区間を含み、
前記第2前処理部は前記停止区間と前記加速区間または前記減速区間と前記停止区間を一つの対で抽出する、請求項2に記載の道路対比での車両の傾きを測定するための装置。 - 前記第2前処理部は、
前記停止区間で前記IMUセンサ部のバイアスの平均値を算出し、前記算出されたバイアスの平均値を前記IMUデータのうち角速度データから差し引いて除去する、請求項2に記載の道路対比での車両の傾きを測定するための装置。 - 前記傾き推定部は、
前記停止区間で前記IMUデータのうち加速度データに基づいて前記車両の傾きを推定する、請求項1に記載の道路対比での車両の傾きを測定するための装置。 - 前記傾き推定部は、
前記運動区間で予め定められた時間ごとに速度の入力を受け、前記入力を受けた速度に基づいて一定の大きさ以上の速度を有する区間を関心領域として抽出し、
前記関心領域の各地点の速度に基づいて多数の道路の傾きを算出した後、前記算出された多数の道路の傾きの平均値を前記運動区間に対する前記道路の傾きとして最終的に推定する、請求項1に記載の道路対比での車両の傾きを測定するための装置。 - 前記傾き推定部は、
前記運動区間のうち少なくとも一部の区間に対する速度に基づいて前記道路の傾きを推定する、請求項1に記載の道路対比での車両の傾きを測定するための装置。 - 前記傾き推定部は、
前記運動区間で予め定められた時間ごとに位置の入力を受け、前記運動区間における開始地点と終了地点の位置に基づいて前記運動区間に対する前記道路の傾きを最終的に推定する、請求項1に記載の道路対比での車両の傾きを測定するための装置。 - 前記傾き推定部は、
前記運動区間のうち少なくとも一部の区間に対する位置に基づいて前記道路の傾きを推定する、請求項1に記載の道路対比での車両の傾きを測定するための装置。 - 前記傾き推定部は、
道路の形状に仮想の直線をフィッティングして前記仮想の直線と車両の位置に基づいてエラーの大きさを算出し、
前記算出されたエラーの大きさと予め定められた臨界値とを比較して道路の線形性を評価し、前記評価した結果で前記道路の線形性が適合な場合、前記道路対比での車両の傾きを推定する、請求項1に記載の道路対比での車両の傾きを測定するための装置。 - ホイール速度データとIMUデータを獲得する段階;
前記ホイール速度データと前記IMUデータとに基づいて停止区間と運動区間を抽出する前処理段階;
前記停止区間で車両の傾きを推定する第1推定段階;
前記運動区間で道路の傾きを推定する第2推定段階;および
前記車両の傾きと前記道路の傾きとに基づいて道路対比での車両の傾きを推定する第3推定段階を含む、道路対比での車両の傾きを測定するための方法。 - 前記前処理段階は、
前記IMUデータと予め定められた臨界値とを比較し、その比較した結果によって前記IMUデータが有効なデータであるか否かを点検する第1前処理段階;および
前記IMUデータが有効なデータである場合、前記IMUデータのうち加速度データと前記ホイール速度データとに基づいて前記停止区間と前記運動区間を抽出する第2前処理段階を含む、請求項11に記載の道路対比での車両の傾きを測定するための方法。 - 前記運動区間は加速区間と減速区間を含み、
前記第2前処理段階は前記停止区間と前記加速区間または前記減速区間と前記停止区間を一つの対で抽出する、請求項12に記載の道路対比での車両の傾きを測定するための方法。 - 前記第2前処理段階は、
前記停止区間でIMUセンサ部のバイアスの平均値を算出し、前記算出されたバイアスの平均値を前記IMUデータのうち角速度データから差し引いて除去する、請求項12に記載の道路対比での車両の傾きを測定するための方法。 - 前記第1推定段階は、
前記停止区間で前記IMUデータのうち加速度データに基づいて前記車両の傾きを推定する、請求項11に記載の道路対比での車両の傾きを測定するための方法。 - 前記第2推定段階は、
前記運動区間で予め定められた時間ごとに速度の入力を受け、前記入力を受けた速度に基づいて一定の大きさ以上の速度を有する区間を関心領域として抽出し、
前記関心領域の各地点の速度に基づいて多数の道路の傾きを算出した後、前記算出された多数の道路の傾きの平均値を前記運動区間に対する前記道路の傾きとして最終的に推定する、請求項11に記載の道路対比での車両の傾きを測定するための方法。 - 前記第2推定段階は、
前記運動区間のうち少なくとも一部の区間に対する速度に基づいて前記道路の傾きを推定する、請求項11に記載の道路対比での車両の傾きを測定するための方法。 - 前記第2推定段階は、
前記運動区間で予め定められた時間ごとに位置の入力を受け、前記運動区間における開始地点と終了地点の位置に基づいて前記運動区間に対する前記道路の傾きを最終的に推定する、請求項11に記載の道路対比での車両の傾きを測定するための方法。 - 前記第2推定段階は、
前記運動区間のうち少なくとも一部の区間に対する位置に基づいて前記道路の傾きを推定する、請求項11に記載の道路対比での車両の傾きを測定するための方法。 - 前記第3推定段階は、
道路の形状に仮想の直線をフィッティングして前記仮想の直線と車両の位置に基づいてエラーの大きさを算出し、
前記算出されたエラーの大きさと予め定められた臨界値とを比較して道路の線形性を評価し、前記評価した結果で前記道路の線形性が適合な場合、前記道路対比での車両の傾きを推定する、請求項11に記載の道路対比での車両の傾きを測定するための方法。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1020220066017A KR102635242B1 (ko) | 2022-05-30 | 2022-05-30 | 도로 대비 차량의 기울기를 추정하기 위한 장치 및 그 방법 |
KR10-2022-0066017 | 2022-05-30 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2023175613A true JP2023175613A (ja) | 2023-12-12 |
Family
ID=84358012
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2022190777A Pending JP2023175613A (ja) | 2022-05-30 | 2022-11-29 | 道路対比での車両の傾きを推定するための装置およびその方法 |
Country Status (5)
Country | Link |
---|---|
US (1) | US20230384088A1 (ja) |
EP (1) | EP4286233A1 (ja) |
JP (1) | JP2023175613A (ja) |
KR (1) | KR102635242B1 (ja) |
CN (1) | CN117141491A (ja) |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3375268B2 (ja) * | 1997-05-27 | 2003-02-10 | 株式会社日立製作所 | ナビゲーション装置 |
JP6326932B2 (ja) * | 2014-04-18 | 2018-05-23 | 株式会社デンソー | ピッチング角算出装置及び光軸調整装置 |
DE102016110461A1 (de) * | 2016-06-07 | 2017-12-07 | Connaught Electronics Ltd. | Verfahren zum Erkennen einer Neigung in einer Fahrbahn für ein Kraftfahrzeug, Fahrerassistenzsystem sowie Kraftfahrzeug |
KR101909953B1 (ko) * | 2016-10-06 | 2018-12-19 | 충북대학교 산학협력단 | 라이다 센서를 이용한 차량의 자세 추정 방법 |
KR101977749B1 (ko) * | 2017-11-21 | 2019-08-28 | 현대오트론 주식회사 | 노면 기울기를 이용한 차량 위치 추정 장치 및 그것의 위치 추정 방법 |
-
2022
- 2022-05-30 KR KR1020220066017A patent/KR102635242B1/ko active IP Right Grant
- 2022-11-15 EP EP22207438.7A patent/EP4286233A1/en active Pending
- 2022-11-18 US US18/057,174 patent/US20230384088A1/en active Pending
- 2022-11-23 CN CN202211474308.0A patent/CN117141491A/zh active Pending
- 2022-11-29 JP JP2022190777A patent/JP2023175613A/ja active Pending
Also Published As
Publication number | Publication date |
---|---|
CN117141491A (zh) | 2023-12-01 |
US20230384088A1 (en) | 2023-11-30 |
EP4286233A1 (en) | 2023-12-06 |
KR20230166272A (ko) | 2023-12-07 |
KR102635242B1 (ko) | 2024-02-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US7477760B2 (en) | Vehicle state sensing system and vehicle state sensing method | |
KR101761933B1 (ko) | 이동 상태 검출 장치 | |
JP4780614B2 (ja) | 車体挙動測定装置 | |
CN107074241B (zh) | 用于估计四轮车辆的侧滑角度的方法 | |
EP1722239B1 (en) | Apparatus and method for measuring speed of a moving object | |
US9045081B2 (en) | Device and method for adjusting the headlight range of a motor vehicle | |
US20070179735A1 (en) | Method and arrangement for monitoring a measuring device located in a wheeled vehicle | |
EP3194211B1 (en) | Driver assist system utilizing an inertial sensor | |
JP2009510424A (ja) | 水平面に対する絶対傾斜角を求める装置 | |
JP2011116201A (ja) | ヘッドランプの光軸調整装置 | |
JPH08145654A (ja) | 旋回半径計算方法および旋回半径計算装置 | |
CN112776552B (zh) | 一种车辆悬挂用的主动式控制系统 | |
CN107310551A (zh) | 使用行驶信息以供优化的车辆侧翻感测系统 | |
JP7237632B2 (ja) | 自動車の全体傾斜を自律的に求めるための方法及び装置 | |
JP4043529B2 (ja) | 車両の慣性姿勢を検出するための方法及び装置 | |
US6915200B2 (en) | Abnormality determining device for longitudinal acceleration sensor for vehicle and method thereof | |
CN105270255B (zh) | 用于修正机动车辆的前照灯的定向的方法和系统 | |
ES2608936T3 (es) | Sistema de adquisición de datos de medición, vehículo con sillín que tiene un sistema de adquisición de datos de medición, procedimiento y programa informático | |
JP2023175613A (ja) | 道路対比での車両の傾きを推定するための装置およびその方法 | |
US7053762B2 (en) | Projecting direction control system for vehicle headlamp | |
KR20230166273A (ko) | 차량의 헤드 램프를 제어하기 위한 시스템 및 그 방법 | |
JP3296208B2 (ja) | カーブ曲率推定装置 | |
JP4606861B2 (ja) | 車両状態検知装置 | |
EP3396317A1 (en) | Method and device for classifying driving maneuvers in a vehicle | |
JP6454857B2 (ja) | 姿勢検出装置及び姿勢検出方法 |