JP7351012B2 - Vehicle weight estimation method, device, electronic device, storage medium and computer program - Google Patents

Vehicle weight estimation method, device, electronic device, storage medium and computer program Download PDF

Info

Publication number
JP7351012B2
JP7351012B2 JP2022538073A JP2022538073A JP7351012B2 JP 7351012 B2 JP7351012 B2 JP 7351012B2 JP 2022538073 A JP2022538073 A JP 2022538073A JP 2022538073 A JP2022538073 A JP 2022538073A JP 7351012 B2 JP7351012 B2 JP 7351012B2
Authority
JP
Japan
Prior art keywords
vehicle
wheel
edge torque
speed
command
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.)
Active
Application number
JP2022538073A
Other languages
Japanese (ja)
Other versions
JP2023539541A (en
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.)
Apollo Intelligent Connectivity Beijing Technology Co Ltd
Original Assignee
Apollo Intelligent Connectivity Beijing Technology Co Ltd
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
Priority claimed from CN202110650457.7A external-priority patent/CN113392518B/en
Application filed by Apollo Intelligent Connectivity Beijing Technology Co Ltd filed Critical Apollo Intelligent Connectivity Beijing Technology Co Ltd
Publication of JP2023539541A publication Critical patent/JP2023539541A/en
Application granted granted Critical
Publication of JP7351012B2 publication Critical patent/JP7351012B2/en
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/12Estimation 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 parameters of the vehicle itself, e.g. tyre models
    • B60W40/13Load or weight
    • 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/02Estimation 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/06Road conditions
    • B60W40/076Slope angle of the road
    • 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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • B60W60/0015Planning or execution of driving tasks specially adapted for safety
    • B60W60/0016Planning or execution of driving tasks specially adapted for safety of the vehicle or its occupants
    • 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/0002Automatic control, details of type of controller or control system architecture
    • B60W2050/0004In digital systems, e.g. discrete-time systems involving sampling
    • B60W2050/0005Processor details or data handling, e.g. memory registers or chip architecture
    • 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/0043Signal treatments, identification of variables or parameters, parameter estimation or state estimation
    • B60W2050/0052Filtering, filters
    • 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/10Longitudinal speed
    • 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/30Wheel torque
    • 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
    • B60W2530/00Input parameters relating to vehicle conditions or values, not covered by groups B60W2510/00 or B60W2520/00
    • B60W2530/10Weight
    • 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
    • B60W2552/00Input parameters relating to infrastructure
    • B60W2552/15Road 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)
  • Human Computer Interaction (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Description

相互参照cross reference

本願は、2021年06月08日に提出した、出願番号が202110650457.7である中国特許出願の優先権を要求し、そのすべての内容は援用により本願に組み込まれる。 This application claims priority to the Chinese patent application filed on June 8, 2021, application number 202110650457.7, the entire contents of which are incorporated by reference into this application.

本開示は、コンピュータ技術分野に関し、具体的に、自動運転分野に関し、特に車両重量の推定方法、装、電子機器、記憶媒体およびコンピュータプログラムに関する。 The present disclosure relates to the field of computer technology, specifically to the field of automatic driving, and particularly to a method , device , device, electronic device, storage medium, and computer program for estimating vehicle weight.

車両の自動運転技術の発展に伴い、車両の自動制御の効果に対する要求も徐々高くなり、小型車両よりも、自動運転バス、自動運転トラックなどを含む大型車両の方が、重量変化範囲が大きく、空荷から満載までの重量変化は300%に達することも可能である。車両重量は、自動運転ソフトウェアが車両動力学制御、駐車ポジション決定、駐車停車、車両運行状態監視を行うキーパラメータであり、車両重量を用いて自動運転制御ソフトウェアと監視ソフトウェアとを合理的に調整すれば、車両の安全性、快適性、動力性をさらに向上させることになる。 With the development of self-driving vehicle technology, the requirements for the effectiveness of automatic vehicle control are gradually increasing, and the weight change range of large vehicles such as self-driving buses and self-driving trucks is larger than that of small vehicles. Weight changes from empty to fully loaded can reach 300%. Vehicle weight is a key parameter for automatic driving software to control vehicle dynamics, determine parking position, park and stop, and monitor vehicle operation status. Vehicle weight can be used to rationally adjust automatic driving control software and monitoring software. This will further improve the safety, comfort, and power of vehicles.

ハードウェアセンサを用いて車両の重量を測定すれば、価格が高く、かつ耐用年数に問題がある。ソフトウェアアルゴリズムを用いれば、車両の重量を直接に推定でき、極めて経済性及び利便性を有する。ソフトウェアアルゴリズムを用いて車両の重量を推定する技術では、車両の輪縁トルクパラメータを提供して車両の重量を推定する必要がある。システムが輪縁トルク信号を提供できない場合、重量推定ソフトウェアは動作できない。 Measuring the weight of a vehicle using a hardware sensor is expensive and has problems with its service life. Using software algorithms, the weight of the vehicle can be directly estimated, which is extremely economical and convenient. Techniques for estimating vehicle weight using software algorithms require providing vehicle wheel edge torque parameters to estimate vehicle weight. If the system cannot provide a wheel edge torque signal, the weight estimation software cannot operate.

本開示は、車両重量の推定方法、装置、電子機器、記憶媒体およびコンピュータプログラムを提供している。 The present disclosure provides a vehicle weight estimation method, device, electronic device , storage medium , and computer program .

第1の局面によれば、車両重量を推定する方法であって、前記車両の現在速度と前記車両に対する制御コマンドとに応じて、速度-コマンド輪縁トルクのマッピング関係を用いて前記車両の輪縁トルク値を取得することと、取得された輪縁トルク値を用いて、車両縦方向動力学方程式に基づいて前記車両の重量を推定することと、を含む、車両重量の推定方法を提供している。 According to a first aspect, there is provided a method for estimating the weight of a vehicle using a speed-command wheel edge torque mapping relationship according to a current speed of the vehicle and a control command for the vehicle. A method for estimating vehicle weight includes: obtaining an edge torque value; and using the obtained edge torque value to estimate a weight of the vehicle based on a vehicle longitudinal dynamics equation. ing.

第2の局面によれば、車両重量を推定する装置であって、前記車両の現在速度と前記車両に対する制御コマンドとに応じて、速度-コマンド-輪縁トルクのマッピング関係を用いて前記車両の輪縁トルク値を取得するように配置されている輪縁トルク値取得モジュールと、取得された輪縁トルク値を用いて、車両縦方向動力学方程式に基づいて前記車両の重量を推定するように配置されている重量推定モジュールと、を含む、車両重量の推定装置を提供している。 According to a second aspect, there is provided a device for estimating the weight of a vehicle using a speed-command-wheel edge torque mapping relationship according to the current speed of the vehicle and a control command for the vehicle. a wheel edge torque value acquisition module arranged to obtain wheel edge torque values, and using the acquired wheel edge torque values to estimate a weight of the vehicle based on vehicle longitudinal dynamics equations; A vehicle weight estimating device is provided, including a weight estimating module disposed therein.

第3の局面によれば、少なくとも1つのプロセッサと、前記少なくとも1つのプロセッサと通信接続するメモリとを有する電子機器であって、前記メモリに、前記少なくとも1つのプロセッサによって実行され得るコマンドが記憶されており、前記コマンドが前記少なくとも1つのプロセッサによって実行されることで、前記少なくとも1つのプロセッサが上記方法を実行することができる、電子機器を提供している。 According to a third aspect, an electronic device includes at least one processor and a memory communicatively connected to the at least one processor, the memory storing commands that can be executed by the at least one processor. The present invention provides an electronic device in which the command is executed by the at least one processor so that the at least one processor can execute the method.

第4の局面によれば、コンピュータに上記方法を実行させるためのコンピュータコマンドを記憶している、非一時的なコンピュータ読取可能な記憶媒体を提供している。 According to a fourth aspect, there is provided a non-transitory computer readable storage medium storing computer commands for causing a computer to perform the above method.

第5の局面によれば、プロセッサにより実行される場合に、上記方法を実現するコンピュータプログラムを提供している。 According to a fifth aspect, there is provided a computer program that , when executed by a processor, implements the method described above.

本開示による車両重量の推定方法及び装置は、より効率的に、かつより正確に車両重量を推定することができる。 The vehicle weight estimation method and device according to the present disclosure can more efficiently and accurately estimate vehicle weight.

理解されるべきこととして、本部分に記載された内容は、本開示の実施例のキーポイント又は重要な特徴を示すことを意図するものではなく、本開示の範囲を限定するものでもない。本開示の他の特徴は、以下の説明により容易に理解される。 It should be understood that the content described in this section is not intended to represent key points or important features of the embodiments of the disclosure, nor is it intended to limit the scope of the disclosure. Other features of the disclosure will be readily understood from the following description.

ここで、図面は、本技術案をよりよく理解するために用いられ、本開示を限定するものではない。
図1は、本開示の実施例による車両重量を推定するための方法のフローチャートを示している。 図2は、本開示の実施例による速度-コマンド-輪縁トルクのキャリブレーションテーブルの模式図を示している。 図3は、本開示の実施例による制御コマンド遅延及び車両加速度のフィルタリング遅延を考慮して、採用すべき制御コマンドと車両加速度とを決める模式図を示している。 図4は、速度-コマンド-輪縁トルクのマッピング関係を用いて車両の輪縁トルク値を取得する方法のフローチャートを示している。 図5は、速度-コマンド-輪縁トルクのキャリブレーションテーブルにおいて線性補間を行うことによって輪縁トルク値を取得する模式図を示している。 図6は、本開示の実施例による車両の縦方向動力学方程式に基づいて車両の重量を推定する方法のフローチャートを示している。 図7は、本開示の実施例による拡張カルマンフィルタ(EKF)に基づいて道路勾配角を推定する方法のフローチャートを示している。 図8は、本開示の実施例による車両重量を推定するための装置のブロック図を示している。 図9は、本開示の実施例を実施するために用いられる例示的電子機器のブロック図を示している。
Here, the drawings are used to better understand the technical solution and are not intended to limit the disclosure.
FIG. 1 shows a flowchart of a method for estimating vehicle weight according to an embodiment of the present disclosure. FIG. 2 shows a schematic diagram of a speed-command-rim torque calibration table according to an embodiment of the present disclosure. FIG. 3 shows a schematic diagram for determining the control command and vehicle acceleration to be adopted, taking into account the control command delay and vehicle acceleration filtering delay according to an embodiment of the present disclosure. FIG. 4 shows a flowchart of a method for obtaining wheel edge torque values for a vehicle using a speed-command-wheel edge torque mapping relationship. FIG. 5 shows a schematic diagram of obtaining a wheel edge torque value by performing linear interpolation in a speed-command-wheel edge torque calibration table. FIG. 6 shows a flowchart of a method for estimating the weight of a vehicle based on vehicle longitudinal dynamics equations according to an embodiment of the present disclosure. FIG. 7 shows a flowchart of a method for estimating road slope angle based on an Extended Kalman Filter (EKF) according to an embodiment of the present disclosure. FIG. 8 shows a block diagram of an apparatus for estimating vehicle weight according to an embodiment of the present disclosure. FIG. 9 depicts a block diagram of exemplary electronic equipment used to implement embodiments of the present disclosure.

以下、図面を参照して本開示の例示的な実施例を説明する。ここで、より理解しやすいために本開示の実施例の様々な詳細は含まれ、それらが例示的なものであると考えられるべきである。したがって、当業者であれば、ここで記載される実施例に対して様々な変更・修正を行うことができ、本開示の範囲及び精神から逸脱することはないと分るべきである。同様に、明確かつ簡潔に説明するために、以下の記載において周知の機能や構成に対する説明を省略する。 Hereinafter, exemplary embodiments of the present disclosure will be described with reference to the drawings. Various details of the embodiments of the present disclosure are included herein to provide a better understanding and are to be considered exemplary. Accordingly, it should be understood by those skilled in the art that various changes and modifications may be made to the embodiments described herein without departing from the scope and spirit of the disclosure. Similarly, for the sake of clarity and conciseness, descriptions of well-known functions and configurations are omitted in the following description.

自動運転分野において、自動運転車両システムの入出力時間関数に基づいて車両重量を特定することで車両重量推定を行う。車両重量推定は車両全体の数学的モデルを作成する必要があり、ここで車両全体の重量はこの数学的モデルにおける重要なパラメータである。この数学的モデルに係るシステムの入出力データに基づいて、特定の推定アルゴリズムを用いて車両重量を推定する。システムが輪縁トルク信号を提供できない場合、重量推定アルゴリズムは動作できない。自動運転ソフトウェアにおいて、輪縁トルク信号は車両シャーシのコア信号であり、輪縁トルクにより車両シャーシのコア特性指標を推定することができるため、大部分の自動運転車両シャーシの提供業者は輪縁トルク信号を提供しない傾向にある。 In the field of automated driving, vehicle weight estimation is performed by specifying the vehicle weight based on the input/output time function of the automated driving vehicle system. Vehicle weight estimation requires creating a mathematical model of the entire vehicle, where the weight of the entire vehicle is an important parameter in this mathematical model. Based on the input/output data of the system based on this mathematical model, the vehicle weight is estimated using a specific estimation algorithm. If the system cannot provide a wheel edge torque signal, the weight estimation algorithm cannot operate. In autonomous driving software, the wheel edge torque signal is the core signal of the vehicle chassis, and most autonomous vehicle chassis providers use the wheel edge torque They tend not to provide a signal.

図1は、本開示の実施例による車両重量を推定するための方法100のフローチャートを示している。 FIG. 1 shows a flowchart of a method 100 for estimating vehicle weight according to an embodiment of the present disclosure.

ステップS110において、車両の現在速度と車両に対する制御コマンドとに応じて、速度-コマンド-輪縁トルクのマッピング関係を用いて車両の輪縁トルク値を取得する。 In step S110, a wheel edge torque value of the vehicle is obtained using a speed-command-wheel edge torque mapping relationship according to the current speed of the vehicle and a control command for the vehicle.

幾つかの実施例において、速度-コマンド-輪縁トルクのマッピング関係は、速度-コマンド-輪縁トルクのキャリブレーションテーブルを含んでもよい。幾つかの実施例において、速度-コマンド-輪縁トルクのキャリブレーションテーブルは、事前に収集した車両制御コマンドと車両制御コマンドに対応する車両センシングデータとに基づいて予め決められてもよい。例えば、平坦な標準フィールドで、車両センサによって車両速度を含む車両センシングデータを収集してもよい。平坦な標準フィールドは、地面勾配が0.1度より小さく、かつフィールドが直線的に加速可能な最大長さが100mより大きいフィールドを含んでもよい。幾つかの実施例において、車両センシングデータが収集された後、オフライン状態でデータ処理技術を用いて速度-コマンド-輪縁トルクのキャリブレーションテーブルを作成してもよい。 In some embodiments, the speed-command-rim torque mapping relationship may include a speed-command-rim torque calibration table. In some embodiments, the speed-command-rim torque calibration table may be predetermined based on previously collected vehicle control commands and vehicle sensing data corresponding to the vehicle control commands. For example, vehicle sensing data including vehicle speed may be collected by vehicle sensors in a flat standard field. A flat standard field may include a field where the ground slope is less than 0.1 degree and the maximum length over which the field can be linearly accelerated is greater than 100 m. In some embodiments, after vehicle sensing data is collected, data processing techniques may be used off-line to create a speed-command-rim torque calibration table.

ステップS120において、取得された輪縁トルク値を用いて、車両縦方向動力学方程式に基づいて車両の重量を算出する。幾つかの実施例において、車両縦方向動力学方程式は、車両走行状態データに基づいて作成されてもよく、且つ車両走行状態データは、車両速度vと、車両加速度

Figure 0007351012000001
と、慣性モーメントJと、角加速度
Figure 0007351012000002
と、道路勾配角βとの少なくとも1つを含んでもよい。 In step S120, the acquired wheel edge torque value is used to calculate the weight of the vehicle based on a vehicle longitudinal dynamic equation. In some embodiments, vehicle longitudinal dynamics equations may be created based on vehicle driving condition data, and the vehicle driving condition data includes vehicle speed v and vehicle acceleration.
Figure 0007351012000001
, moment of inertia J, and angular acceleration
Figure 0007351012000002
and a road slope angle β.

本開示の実施例によれば、より効率的に、且つより正確に車両重量を推定することができる。また、本開示の実施例によれば、輪縁トルクフィードバック信号がない場合、車両重量を推定することができる。 According to the embodiments of the present disclosure, vehicle weight can be estimated more efficiently and more accurately. Additionally, according to embodiments of the present disclosure, vehicle weight can be estimated when there is no wheel edge torque feedback signal.

幾つかの実施例において、車両縦方向動力学方程式は、 In some embodiments, the vehicle longitudinal dynamics equations are:

Figure 0007351012000003
Figure 0007351012000003

であってもよい。 It may be.

ただし、mは車両重量を表し、単位がkgであり、

Figure 0007351012000004
は車両速度の導関数、即ち、車両加速度であり、単位がm/sであり、
vは車両速度であり、単位がm/sであり、
Jは慣性モーメントであり、単位がkg・mであり、
Figure 0007351012000005
は車両のヨーレートの導関数、即ち、車両角加速度であり、単位がrad/ であり、
Twheelは輪縁トルクであり、単位がN・mであり、
rは車両の車輪ロール半径であり、単位がmであり、
Figure 0007351012000006
即ち、等価風抵抗係数であり、ただし、ρは空気抵抗係数であり、Aは車両実効風上面積、CDは風抵抗係数であり、
βは道路勾配角であり、単位がradであり、
μは転がり抵抗係数であり、
gは重力加速度であり、単位がm/sである。 However, m represents the vehicle weight, and the unit is kg,
Figure 0007351012000004
is the derivative of the vehicle speed, i.e. the vehicle acceleration, in m/s 2 ;
v is the vehicle speed, the unit is m/s,
J is the moment of inertia, the unit is kg・m2 ,
Figure 0007351012000005
is the derivative of the vehicle yaw rate, i.e. the vehicle angular acceleration, in units of rad/s2 ,
Twheel is the wheel edge torque, the unit is N・m,
r is the wheel roll radius of the vehicle, the unit is m,
Figure 0007351012000006
That is, it is the equivalent wind resistance coefficient, where ρ is the air resistance coefficient, A is the vehicle effective windward area, CD is the wind resistance coefficient,
β is the road slope angle, the unit is rad,
μ is the rolling resistance coefficient,
g is the gravitational acceleration, and its unit is m/ s2 .

幾つかの実施例において、上記車両縦方向動力学方程式に対してデータ処理を行う時にハンドル判断条件を使用してもよいため、

Figure 0007351012000007
相応的に、上記式(1)は、 In some embodiments, steering wheel determination conditions may be used when performing data processing for the vehicle longitudinal dynamics equation;
Figure 0007351012000007
Correspondingly, the above formula (1) is

Figure 0007351012000008
Figure 0007351012000008

としてさらに簡素化されてもよい。 It may be further simplified as

式(2)において、βμは地面摩擦抵抗係数を表す。それ以外、式(2)における他のパラメータは、式(1)における同一パラメータと同じ物理的意味を表す。 In equation (2), β μ represents the ground frictional resistance coefficient. Other than that, other parameters in equation (2) represent the same physical meanings as the same parameters in equation (1).

図2は、本開示の実施例による速度-コマンド-輪縁トルクのキャリブレーションテーブルの模式図を示している。 FIG. 2 shows a schematic diagram of a speed-command-rim torque calibration table according to an embodiment of the present disclosure.

図2に示すように、x軸は車両速度を示し、単位がm/sである。車両速度は車両センサによって取得されてもよい。y軸は車両を制御するためのコマンド(即ち、制御コマンド)を示す。例えば、制御コマンドは、ユーザが車両アクセルペダルを踏みこむことで得られるペダルコマンドを含んでもよい。この場合、制御コマンドは車両アクセルペダルの開度パーセントとして示され、単位が%である。z軸は輪縁トルク値を示し、単位がN・mである。 As shown in FIG. 2, the x-axis shows vehicle speed, with units of m/s. Vehicle speed may be acquired by vehicle sensors. The y-axis shows commands for controlling the vehicle (ie, control commands). For example, the control command may include a pedal command obtained by a user depressing a vehicle accelerator pedal. In this case, the control command is expressed as a percent opening of the vehicle accelerator pedal, and is in %. The z-axis indicates the wheel edge torque value, and the unit is N·m.

幾つかの実施例において、コマンドを極大-極小の区間範囲に基づいて10~20等分して、均一な間隔の10~20のコマンドを得てもよい。順次にこれらのコマンドに応じて、車両が静止から最高速度に加速したり、最高速度から静止に減速したりように制御することで、速度と、コマンドと、輪縁トルクとの間のマッピング関係、即ち、速度-コマンド-輪縁トルクのマッピング関係を得る。コマンドが車両アクセルペダルの開度パーセントとして示される場合、速度-コマンド-輪縁トルクのマッピング関係は、図2に示すような速度-コマンド-輪縁トルクのキャリブレーションテーブル、即ち、速度-ペダル開度-輪縁トルクのキャリブレーションテーブルとして示されてもよい。 In some embodiments, the commands may be divided into 10 to 20 equal parts based on the maximum-minimum interval range to obtain 10 to 20 equally spaced commands. By sequentially controlling the vehicle to accelerate from standstill to maximum speed or decelerate from maximum speed to standstill in response to these commands, a mapping relationship between speed, commands, and wheel edge torque is established. , that is, a mapping relationship of speed-command-rim torque is obtained. If the command is expressed as a percentage of vehicle accelerator pedal opening, then the speed-command-wheel-edge torque mapping relationship is based on a speed-command-wheel-edge torque calibration table as shown in Figure 2, i.e., speed-pedal opening. It may also be shown as a degree-to-rim torque calibration table.

本開示の実施例によれば、センシングデータ収集と速度-コマンド-輪縁トルクのキャリブレーションテーブル作成とはオフライン状態で行われてもよく、一方、車両重量推定がオンラインで行われてもよい。リアルタイムオンラインの方式で車両重量推定を実行する場合、制御コマンド遅延及び車両加速度のフィルタリング遅延が存在し、かつ両方の遅延が一致していない可能性があることによって、制御コマンドに対してリアルタイムに収集された車両加速度とこの制御コマンドとが不整合になるため、制御コマンド遅延及び車両加速度のフィルタリング遅延を考慮して採用すべき制御コマンドと車両加速度とを決める必要がある。 According to embodiments of the present disclosure, sensing data collection and speed-command-rim torque calibration table creation may be performed offline, while vehicle weight estimation may be performed online. When performing vehicle weight estimation in a real-time online manner, there is a control command delay and a vehicle acceleration filtering delay, and both delays may not match. Since the vehicle acceleration determined by the driver and this control command do not match, it is necessary to determine the control command and vehicle acceleration to be adopted in consideration of the control command delay and the vehicle acceleration filtering delay.

図3は、本開示の実施例による制御コマンド遅延及び車両加速度のフィルタリング遅延を考慮して採用すべき制御コマンドと車両加速度とを決める模式図を示している。 FIG. 3 shows a schematic diagram for determining the control command and vehicle acceleration to be adopted in consideration of the control command delay and vehicle acceleration filtering delay according to an embodiment of the present disclosure.

図3は、2つのキャッシュキュー、即ち、コマンド(Cmd)キャッシュキューQuene1と加速度(Acc)キャッシュキューQuene2を示している。コマンドキャッシュキューQuene1及び加速度キャッシュキューQuene2の長さは、それぞれL1及びL2である。L1及びL2は、それぞれ制御コマンドの遅延と車両加速度のフィルタリング遅延とに基づいて算出され、即ち、 FIG. 3 shows two cache queues: a command (Cmd) cache queue Quene1 and an acceleration (Acc) cache queue Quene2. The lengths of the command cache queue Quene1 and the acceleration cache queue Quene2 are L1 and L2, respectively. L1 and L2 are calculated based on the control command delay and vehicle acceleration filtering delay, respectively, i.e.

Figure 0007351012000009
Figure 0007351012000009

キャッシュキューQuene1及びQuene2は、先入れ先出しの方式でデータをキャッシュする。図3において、キャッシュキューQuene1及びQuene2において最も右側のデータは最新のデータである。最新のデータを直接利用することにより、遅延を有する制御コマンドと、遅延を有するフィルタリングされた後の加速度データとが整合しない可能性があるため、本開示の実施例によれば、コマンドキャッシュキューQuene1と加速度キャッシュキューQuene2とを利用して、得られたL1番目の制御コマンドとL2番目のフィルタリングされた後の加速度データとが整合している。したがって、L1番目の制御コマンドに対して、L2番目のフィルタリングされた後の加速度データを、車両重量推定を実行するための入力データとして採用し、より正確な結果が得られる。 Cache queues Quene1 and Quene2 cache data on a first-in, first-out basis. In FIG. 3, the rightmost data in cache queues Quene1 and Quene2 is the latest data. By directly using the latest data, there is a possibility that a control command with a delay and filtered acceleration data with a delay do not match, so according to an embodiment of the present disclosure, the command cache queue Quene1 The obtained L1-th control command and the L2-th filtered acceleration data match each other using the acceleration cache queue Quene2 and the acceleration cache queue Quene2. Therefore, for the L1-th control command, the L2-th filtered acceleration data is employed as input data for estimating the vehicle weight, and more accurate results can be obtained.

幾つかの実施例によれば、収集されたデータの有効性を判断してもよい。例えば、実際のハンドル操舵角度<ハンドル最大操舵角*3%という条件に基づいて、収集されたデータの有効性を判断してもよい。実際のハンドル操舵角度が以上の条件を満たせば、対応する制御コマンドに対して、上記キャッシュ方式で得られた車両加速度、及びセンサによって取得された車両速度、並びにセンサによって得られた道路勾配角測定値(もし存在すれば)を有効データとして使用する。 According to some embodiments, the validity of the collected data may be determined. For example, the validity of the collected data may be determined based on the condition that actual steering wheel steering angle<maximum steering wheel steering angle*3%. If the actual steering angle satisfies the above conditions, the vehicle acceleration obtained by the above cache method, the vehicle speed obtained by the sensor, and the road slope angle measurement obtained by the sensor are sent to the corresponding control command. Use the value (if it exists) as valid data.

図4は、速度-コマンド-輪縁トルクのマッピング関係を用いて車両の輪縁トルク値を取得する方法のフローチャートを示している。 FIG. 4 shows a flowchart of a method for obtaining wheel edge torque values for a vehicle using a speed-command-wheel edge torque mapping relationship.

ステップS411において、車両の現在速度と制御コマンドとに応じて、速度-コマンド-輪縁トルクのマッピング関係において現在速度が属するキャリブレーション区間及び制御コマンドが属するキャリブレーション区間を特定する。幾つかの実施例において、速度-コマンド-輪縁トルクのマッピング関係は、速度-コマンド-輪縁トルクのキャリブレーションテーブルを含んでもよい。幾つかの実施例において、速度-コマンド-輪縁トルクのキャリブレーションテーブルは、速度-ペダル開度-輪縁トルクのキャリブレーションテーブルとして示されてもよい。 In step S411, in accordance with the current speed of the vehicle and the control command, a calibration section to which the current speed belongs and a calibration section to which the control command belongs are specified in the mapping relationship of speed-command-wheel edge torque. In some embodiments, the speed-command-rim torque mapping relationship may include a speed-command-rim torque calibration table. In some embodiments, the speed-command-rim torque calibration table may be represented as a speed-pedal opening-rim torque calibration table.

ステップS412において、速度-コマンド-輪縁トルクのマッピング関係に応じて、現在速度が属するキャリブレーション区間及び制御コマンドが属するキャリブレーション区間に基づいて、特定されたキャリブレーション区間に対応する複数の輪縁トルク値をそれぞれ取得する。 In step S412, a plurality of wheel edges corresponding to the specified calibration zone are determined based on the calibration zone to which the current speed belongs and the calibration zone to which the control command belongs, according to the speed-command-wheel edge torque mapping relationship. Obtain each torque value.

ステップS413において、複数の輪縁トルク値に基づいて車両現在の速度及び制御コマンドに対応する輪縁トルク値を算出する。 In step S413, a wheel edge torque value corresponding to the current vehicle speed and control command is calculated based on the plurality of wheel edge torque values.

本開示の実施例によれば、速度-コマンド-輪縁トルクのマッピング関係を用いて車両の輪縁トルク値を取得する方法は、車両重量を測定するためのハードウェアセンサを省くとともに、正確な輪縁トルク値を提供することができる。 According to embodiments of the present disclosure, a method of obtaining a wheel edge torque value of a vehicle using a speed-command-wheel edge torque mapping relationship eliminates a hardware sensor for measuring vehicle weight, and provides an accurate A wheel edge torque value can be provided.

幾つかの実施例において、車両現在の速度と制御コマンドとに応じて、速度-コマンド-輪縁トルクのキャリブレーションテーブルにおいて線性補間を行うことで輪縁トルク値を取得してもよい。 In some embodiments, the wheel edge torque value may be obtained by linear interpolation in a speed-command-wheel edge torque calibration table depending on the vehicle's current speed and the control command.

図5は、速度-コマンド-輪縁トルクのキャリブレーションテーブルにおいて線性補間を行って輪縁トルク値を取得する模式図を示している。 FIG. 5 shows a schematic diagram of obtaining a wheel edge torque value by performing linear interpolation in the speed-command-wheel edge torque calibration table.

図5において、vは車両の現在速度を表し、Cmdは制御コマンドを表し、Twheelは現在速度v及び制御コマンドCmdに対応する輪縁トルク値を表す。図5に示すように、速度-コマンド-輪縁トルクのキャリブレーションテーブルにおいて、車両の現在速度vと制御コマンドCmdとに応じて、現在速度v及び制御コマンドCmdがそれぞれ属するキャリブレーション区間[vt-1、v]、[Cmdt-1、Cmd]を見つけ、ただし、vとvt-1はそれぞれ現在速度が属するキャリブレーション区間における速度であり、CmdとCmdt-1はそれぞれ制御コマンドが属するキャリブレーション区間における制御コマンドである。 In FIG. 5, v represents the current speed of the vehicle, Cmd represents the control command, and T wheel represents the wheel edge torque value corresponding to the current speed v and the control command Cmd. As shown in FIG. 5, in the speed-command-wheel edge torque calibration table, the calibration section [v t -1 , v t ], [Cmd t-1 , Cmd t ], where v t and v t-1 are the speeds in the calibration interval to which the current speed belongs, and Cmd t and Cmd t-1 are These are control commands in the calibration interval to which each control command belongs.

図5に示すように、速度-コマンド-輪縁トルクのキャリブレーションテーブルにおいて、{v、Cmd}として示される点の周囲の4つの点が(vt-1、Cmdt-1)、(vt-1、Cmd)、(v、Cmdt-1)、(v、Cmd)にそれぞれ対応する。その後、(vt-1、Cmdt-1)、(vt-1、Cmd)、(v、Cmdt-1)、(v、Cmd)にそれぞれ対応するキャリブレーション輪縁トルク値T、T、T、Tを見つける。その後、以下の式によって算出しようとする輪縁トルク値Twheelを得る。 As shown in FIG. 5, in the velocity-command-rim torque calibration table, four points around the point denoted as {v, Cmd} are (v t-1 , Cmd t-1 ), (v t-1 , Cmd t ), (v t , Cmd t-1 ), and (v t , Cmd t ), respectively. Then, the calibration wheel edge torques corresponding to (v t-1 , Cmd t-1 ), (v t-1 , Cmd t ), (v t , Cmd t-1 ), and (v t , Cmd t ), respectively Find the values T 1 , T 2 , T 3 , T 4 . Thereafter, the wheel edge torque value T wheel to be calculated is obtained using the following formula.

Figure 0007351012000010
Figure 0007351012000010

本開示の実施例によれば、車両重量を測定するためのハードウェアセンサを省くと共に、正確な輪縁トルク値を提供することができる。 According to embodiments of the present disclosure, a hardware sensor for measuring vehicle weight can be omitted and accurate wheel edge torque values can be provided.

図6は、本開示の実施例による車両縦方向動力学方程式に基づいて車両の重量を推定する方法のフローチャートを示している。 FIG. 6 depicts a flowchart of a method for estimating vehicle weight based on vehicle longitudinal dynamics equations according to an embodiment of the present disclosure.

ステップS621において、車両縦方向動力学方程式に対して忘却係数を有する最小二乗再帰方程式(RLS)を作成する。ここで、車両縦方向動力学方程式は、上記式(1)又は(2)に示す方程式であってもよい。 In step S621, a least squares recursive equation (RLS) having a forgetting factor is created for the vehicle longitudinal dynamics equation. Here, the vehicle longitudinal dynamic equation may be the equation shown in the above equation (1) or (2).

ステップS622において、忘却係数を有する最小二乗再帰方程式(RLS)を用いて反復計算を行って、車両の重量を取得する。 In step S622, an iterative calculation is performed using a least squares recursive equation (RLS) with a forgetting factor to obtain the weight of the vehicle.

幾つかの実施例において、忘却係数を有する最小二乗再帰方程式(RLS)は、 In some embodiments, the least squares recursive equation (RLS) with a forgetting factor is

Figure 0007351012000011
Figure 0007351012000011

として示されてもよい。 It may be shown as

ただし、

Figure 0007351012000012
(mは車両重量であり、例えば、車種、ブランドなどに応じてmの初期値を設定してもよい)、
Figure 0007351012000013
はRLSアルゴリズムにおける推定すべき変数であり、kはk回目の反復計算を表し、
y(k)はRLSアルゴリズムが観測しようとする量であり、ここでは、k回目で観測された車両加速度
Figure 0007351012000014
を表し、
Figure 0007351012000015
の転置であり、ただし、Twheelは車両の輪縁トルクであり、rは車両の車輪ロール半径であり、vは車両速度であり、
Figure 0007351012000016
即ち等価風抵抗係数、ただし、ρは空気抵抗係数であり、Aは車両実効風上面積であり、Cは風抵抗係数であり、
L(k)は毎回の反復計算のゲインを表し、
P(k)はRLS計算の中間変数を表し、且つ、
λは忘却係数であり、且つ0<λ<1。幾つかの実施例において,λが0.97に設定される。 however,
Figure 0007351012000012
(m is the vehicle weight; for example, the initial value of m may be set depending on the vehicle type, brand, etc.)
Figure 0007351012000013
is the variable to be estimated in the RLS algorithm, k represents the k-th iteration,
y(k) is the quantity that the RLS algorithm attempts to observe, here the kth observed vehicle acceleration
Figure 0007351012000014
represents,
Figure 0007351012000015
where T wheel is the vehicle wheel edge torque, r is the vehicle wheel roll radius, v is the vehicle speed,
Figure 0007351012000016
That is, the equivalent wind resistance coefficient, where ρ is the air resistance coefficient, A is the vehicle effective windward area, CD is the wind resistance coefficient,
L(k) represents the gain of each iteration,
P(k) represents an intermediate variable of RLS calculation, and
λ is the forgetting factor, and 0<λ<1. In some embodiments, λ is set to 0.97.

本開示の実施例によれば、RLSアルゴリズムを利用することで、より正確に車両の重量を推定することができる。 According to the embodiment of the present disclosure, the weight of the vehicle can be estimated more accurately by using the RLS algorithm.

また、前文で説明した車両縦方向動力学方程式に示すように、道路勾配角βは車両重量を推定するためのキーパラメータであり、車両重量と高く整合し、勾配角パラメータ誤差が20%に達すれば、重量推定結果誤差が50%に達することになる。幾つかの実施例において、道路勾配角βは車両センサによって取得されてもよい。他の実施例において、道路勾配角βは拡張カルマンフィルタ(EKF)に基づいて推定されてもよい。 In addition, as shown in the vehicle longitudinal dynamics equation explained in the preamble, the road slope angle β is a key parameter for estimating the vehicle weight, and it is highly consistent with the vehicle weight, and the slope angle parameter error should reach 20%. For example, the weight estimation result error will reach 50%. In some embodiments, the road slope angle β may be obtained by a vehicle sensor. In other embodiments, the road slope angle β may be estimated based on an Extended Kalman Filter (EKF).

以降、拡張カルマンフィルタ(EKF)に基づいて道路勾配角βを推定する方法を詳しく説明する。 Hereinafter, a method for estimating the road slope angle β based on the extended Kalman filter (EKF) will be described in detail.

図7は、本開示の実施例による拡張カルマンフィルタ(EKF)に基づいて道路勾配角を推定する方法700のフローチャートを示している。 FIG. 7 shows a flowchart of a method 700 for estimating a road slope angle based on an Extended Kalman Filter (EKF) according to an embodiment of the present disclosure.

ステップS710において、EKFのシステム状態方程式とEKFのシステム測定方程式とに基づいて、道路勾配角を推定する。幾つかの実施例において、道路勾配角を推定するためのシステム状態方程式は In step S710, the road slope angle is estimated based on the EKF system state equation and the EKF system measurement equation. In some embodiments, the system state equation for estimating road slope angle is

Figure 0007351012000017
Figure 0007351012000017

である。ただし、

Figure 0007351012000018
は道路勾配角β導関数の導関数を表す。それ以外、式(11)における他のパラメータは、式(1)における同一パラメータと同じ物理的意味を表す。 It is. however,
Figure 0007351012000018
represents the derivative of the road slope angle β derivative. Other than that, other parameters in equation (11) represent the same physical meanings as the same parameters in equation (1).

EKFのシステムノイズベクトル及び測定ノイズベクトルはそれぞれWとVであり、WとVとは互いに独立し、かつ平均値がいずれもゼロである白色ガウスノイズであってもよく、得られたEKFのシステム状態方程式は、 The EKF system noise vector and measurement noise vector are W and V, respectively, and W and V may be white Gaussian noises that are independent of each other and have an average value of zero, and the resulting EKF system The equation of state is

Figure 0007351012000019
Figure 0007351012000019

である。 It is.

また、得られたEKFのシステム測定方程式は、 In addition, the obtained EKF system measurement equation is

Figure 0007351012000020
Figure 0007351012000020

である。 It is.

以上の式(12)において、v(k)、v(k-1)はそれぞれk回目、k-1回目の反復計算によって算出された車両速度であり、ΔtはEKFを実際に使用する時の反復計算の周期を表し、β(k)、β(k-1)、β(k-2)及びβ(k-3)はそれぞれk回目、k-1回目、k-2回目、k-3回目の反復計算によって算出された道路勾配角である。幾つかの実施例において、車両センサによって取得された道路勾配角が存在する場合、β(k)、β(k-1)、β(k-2)及びβ(k-3)の初期値を車両センサによって取得された道路勾配角に設定する。車両センサによって取得された道路勾配角が存在しない場合、β(k)、β(k-1)、β(k-2)及びβ(k-3)の初期値を0に設定する。それ以外、式(12)における他のパラメータは、式(1)における同一パラメータと同じ物理的意味を表す。 In the above equation (12), v(k) and v(k-1) are the vehicle speeds calculated by the k-th and k-1st iteration calculations, respectively, and Δt is the vehicle speed when the EKF is actually used. Represents the period of iterative calculation, β(k), β(k-1), β(k-2) and β(k-3) are the kth, k-1st, k-2nd, k-3th, respectively. This is the road slope angle calculated by the second iterative calculation. In some embodiments, if there is a road slope angle acquired by the vehicle sensor, the initial values of β(k), β(k-1), β(k-2), and β(k-3) are Set to the road slope angle acquired by the vehicle sensor. If there is no road slope angle acquired by the vehicle sensor, the initial values of β(k), β(k-1), β(k-2), and β(k-3) are set to 0. Other than that, other parameters in equation (12) represent the same physical meanings as the same parameters in equation (1).

以上の式(13)において、z(k)はEKFが測定しようとする車両速度を表し、Hは測定行列であり、センサによって取得された道路勾配角が存在する場合、

Figure 0007351012000021
センサによって取得された道路勾配角が存在しない場合、
Figure 0007351012000022
In the above equation (13), z(k) represents the vehicle speed that the EKF attempts to measure, H is the measurement matrix, and if there is a road gradient angle acquired by the sensor,
Figure 0007351012000021
If there is no road slope angle acquired by the sensor,
Figure 0007351012000022

1つの実施例によれば、拡張カルマンフィルタ(EKF)による道路勾配角の推定方法700はステップS720をさらに含んでもよい。 According to one embodiment, the method 700 for estimating a road slope angle using an Extended Kalman Filter (EKF) may further include step S720.

ステップS720において、EKFを用いて反復計算を行う時、EKFの時間更新方程式及び測定更新方程式を用いてEKFを更新する。具体的に、式(12)と式(13)を組合わせることによってEKFの状態空間数式: In step S720, when performing iterative calculations using the EKF, the EKF is updated using the time update equation and measurement update equation of the EKF. Specifically, by combining equations (12) and (13), the EKF state space formula:

Figure 0007351012000023
Figure 0007351012000023

を得る。 get.

ただし、

Figure 0007351012000024
はプロセス状態非線性関数であり、
Figure 0007351012000025
は式(12)における数式 however,
Figure 0007351012000024
is the process state nonlinear function,
Figure 0007351012000025
is the mathematical expression in equation (12)

Figure 0007351012000026
Figure 0007351012000026

である。 It is.

EKFは、反復計算を行う時、

Figure 0007351012000027
を線性化する必要があるため、更新する度にヤコビ(Jacobian)行列F(k): When EKF performs repeated calculations,
Figure 0007351012000027
Since it is necessary to linearize the Jacobian matrix F(k):

Figure 0007351012000028
Figure 0007351012000028

を算出する必要がある。 It is necessary to calculate

EKFのシステムノイズ共分散行列をQとし、得られたEKFの時間更新方程式は、 Let the system noise covariance matrix of EKF be Q, and the obtained EKF time update equation is:

Figure 0007351012000029
Figure 0007351012000029

である。 It is.

EKFの測定ノイズ共分散行列をRとし、得られたEKFの測定更新方程式は、 Let the EKF measurement noise covariance matrix be R, and the obtained EKF measurement update equation is:

Figure 0007351012000030
Figure 0007351012000030

である。 It is.

ただし、

Figure 0007351012000031
はEKFのシステム状態を表す。また、EKFに対して初期パラメータ設定を行う時、P(0)を10に設定し、R行列を
Figure 0007351012000032
に設定し、且つ実際のセンシングデータノイズ特性に応じてQ行列を設定する。 however,
Figure 0007351012000031
represents the EKF system status. Also, when setting initial parameters for EKF, P(0) is set to 10 and R matrix is
Figure 0007351012000032
and set the Q matrix according to the actual sensing data noise characteristics.

本開示の実施例によれば、EKFに基づいて道路勾配角を推定することで、道路勾配角を測定するためのハードウェアセンサコストを低減するとともに、正確な道路勾配角を提供することができる。 According to the embodiments of the present disclosure, by estimating the road slope angle based on the EKF, it is possible to reduce the hardware sensor cost for measuring the road slope angle and provide an accurate road slope angle. .

本開示の実施例によれば、センシングデータ収集及び速度-コマンド-輪縁トルクのキャリブレーションテーブル作成がオフライン状態で行われてもよく、一方、車両重量推定及び道路勾配角推定がオンラインで行われてもよい。速度-コマンド-輪縁トルクのキャリブレーションテーブルに基づいて、車両重量推定及び道路勾配角推定のために輪縁トルク情報を提供することができる。また、各車両動作周期内において、車両重量推定及び道路勾配角推定は、いずれも独立して並行に反復計算を行う。各車両動作周期内において、車両重量推定の重量値を道路勾配角推定の次の計算周期の内部パラメータとし、同様に、道路勾配角推定の道路勾配角を車両重量推定の次の計算周期の内部パラメータとする。 According to embodiments of the present disclosure, sensing data collection and speed-command-wheel edge torque calibration table creation may be performed offline, while vehicle weight estimation and road slope angle estimation may be performed online. It's okay. Based on the speed-command-rim torque calibration table, wheel torque information can be provided for vehicle weight estimation and road slope angle estimation. Furthermore, within each vehicle operation cycle, vehicle weight estimation and road slope angle estimation are both independently and iteratively calculated in parallel. Within each vehicle operation cycle, the weight value for vehicle weight estimation is used as an internal parameter for the next calculation cycle for road slope angle estimation, and similarly, the road slope angle for road slope angle estimation is used as the internal parameter for the next calculation cycle for vehicle weight estimation. Take it as a parameter.

本開示の実施例によれば、正確な車両重量及び道路勾配角情報を提供することができる。大型重荷重車両エネルギーの最適化適用において、正確な重量及び勾配角情報は車両全体コントローラが合理的にエネルギーを割り当てるように支持し、エネルギー消費を低減し、自動運転車両の航続距離を大幅に向上させることができる。また、本開示の実施例によれば、同等の精度の車両重量センサを替えて、ハードウェアコストを大幅に低減することができる。 According to the embodiments of the present disclosure, accurate vehicle weight and road slope angle information can be provided. In large, heavy-duty vehicle energy optimization applications, accurate weight and slope angle information can help the whole vehicle controller allocate energy rationally, reduce energy consumption, and greatly improve the cruising range of autonomous vehicles. can be done. Furthermore, according to the embodiments of the present disclosure, it is possible to replace a vehicle weight sensor with equivalent accuracy and significantly reduce hardware costs.

図8は、本開示の実施例による車両重量を推定するための装置800のブロック図を示している。 FIG. 8 shows a block diagram of an apparatus 800 for estimating vehicle weight according to an embodiment of the present disclosure.

図8に示すように、車両重量を推定するための装置800は、輪縁トルク値取得モジュール810と重量推定モジュール820とを含む。 As shown in FIG. 8, an apparatus 800 for estimating vehicle weight includes a wheel edge torque value acquisition module 810 and a weight estimation module 820.

輪縁トルク値取得モジュール810は、車両の現在速度と車両に対する制御コマンドとに応じて、速度-コマンド-輪縁トルクのマッピング関係を用いて車両の輪縁トルク値を取得するように配置されている。幾つかの実施例において、速度-コマンド-輪縁トルクのマッピング関係は、速度-コマンド-輪縁トルクのキャリブレーションテーブルを含んでもよい。幾つかの実施例において、速度-コマンド-輪縁トルクのキャリブレーションテーブルは、事前に収集された車両制御コマンドと車両制御コマンドに対応する車両センシングデータとに基づいて予め決められてもよい。 The wheel edge torque value acquisition module 810 is arranged to obtain wheel edge torque values of the vehicle using a speed-command-wheel edge torque mapping relationship in response to a current speed of the vehicle and a control command for the vehicle. There is. In some embodiments, the speed-command-rim torque mapping relationship may include a speed-command-rim torque calibration table. In some embodiments, the speed-command-rim torque calibration table may be predetermined based on previously collected vehicle control commands and vehicle sensing data corresponding to the vehicle control commands.

重量推定モジュール820は、取得された輪縁トルク値を用いて、車両縦方向動力学方程式に基づいて車両の重量を推定するように配置されている。幾つかの実施例において、車両縦方向動力学方程式は、車両走行状態データに基づいて作成されてもよく、且つ、車両走行状態データは、車両速度v、車両加速度

Figure 0007351012000033
、慣性モーメントJ、角加速度
Figure 0007351012000034
及び道路勾配角βのうちの少なくとも1つを含んでもよい。 Weight estimation module 820 is arranged to use the obtained wheel edge torque values to estimate the weight of the vehicle based on vehicle longitudinal dynamics equations. In some embodiments, vehicle longitudinal dynamics equations may be created based on vehicle driving condition data, and the vehicle driving condition data includes vehicle speed v, vehicle acceleration
Figure 0007351012000033
, moment of inertia J, angular acceleration
Figure 0007351012000034
and a road slope angle β.

幾つかの実施例において、輪縁トルク値取得モジュール810は、第1のサブモジュールと、第2のサブモジュールと、第3のサブモジュールとを含んでもよい。第1のサブモジュールは、車両の現在速度と制御コマンドとに応じて、速度-コマンド-輪縁トルクのマッピング関係において現在速度が属すキャリブレーション区間、及び制御コマンドが属すキャリブレーション区間を特定する。第2のサブモジュールは、速度-コマンド-輪縁トルクのマッピング関係に基づいて、現在速度が属するキャリブレーション区間、及び制御コマンドが属するキャリブレーション区間に応じて、特定されたキャリブレーション区間に対応する複数の輪縁トルク値をそれぞれ取得する。第3のサブモジュールは、複数の輪縁トルク値から車両現在の速度及び制御コマンドに対応する輪縁トルク値を算出する。 In some examples, the wheel edge torque value acquisition module 810 may include a first sub-module, a second sub-module, and a third sub-module. The first sub-module identifies a calibration interval to which the current speed belongs and a calibration interval to which the control command belongs in the mapping relationship of speed-command-wheel-edge torque, depending on the current speed of the vehicle and the control command. The second sub-module corresponds to the identified calibration interval according to the calibration interval to which the current speed belongs and the calibration interval to which the control command belongs, based on the speed-command-wheel edge torque mapping relationship. A plurality of wheel edge torque values are each obtained. A third sub-module calculates a wheel edge torque value corresponding to the vehicle current speed and control command from the plurality of wheel edge torque values.

幾つかの実施例において、重量推定モジュール820は、第4のサブモジュールと第5のサブモジュールとを含んでもよい。第4のサブモジュールは、車両縦方向動力学方程式に対して忘却係数を有する最小二乗再帰方程式を作成する。第5のサブモジュールは、忘却係数を有する最小二乗再帰方程式を用いて反復計算を行い、車両の重量を取得する。 In some examples, weight estimation module 820 may include a fourth sub-module and a fifth sub-module. The fourth submodule creates least squares recursive equations with forgetting factors for the vehicle longitudinal dynamics equations. The fifth sub-module performs iterative calculations using a least squares recursive equation with a forgetting factor to obtain the weight of the vehicle.

本開示の実施例によれば、本開示は、電子機器、読取可能な記憶媒体及びコンピュータプログラムをさらに提供している。 According to embodiments of the disclosure, the disclosure further provides an electronic device, a readable storage medium, and a computer program product .

図9は、本開示の実施例を実施することが可能な例示的電子機器900の模式的ブロック図を示している。電子機器は、様々な形式のデジタルコンピュータを示すことを目的とし、例えば、ラップトップコンピュータ、デスクトップコンピュータ、ワークステーション、パーソナルデジタルアシスタント、サーバ、ブレードサーバ、大型コンピュータ及び他の適切なコンピュータである。電子機器は、さらに様々な形式の移動装置を示してもよく、例えば、パーソナルデジタルアシスタント、携帯電話、スマートフォン、ウェアラブル機器及び他の類似の演算装置である。本明細書に示された部材、それらの接続及び関係、並びにそれらの機能は、例示に過ぎず、本明細書に記載された及び/又は要求された本開示の実現を限定しない。 FIG. 9 depicts a schematic block diagram of an exemplary electronic device 900 in which embodiments of the present disclosure may be implemented. Electronic equipment is intended to refer to various types of digital computers, such as laptop computers, desktop computers, workstations, personal digital assistants, servers, blade servers, large computers and other suitable computers. Electronic devices may also refer to various types of mobile devices, such as personal digital assistants, mobile phones, smart phones, wearable devices and other similar computing devices. The components shown herein, their connections and relationships, and their functions are exemplary only and do not limit implementation of the present disclosure as described and/or required herein.

図9に示すように、機器900は、計算手段901を含み、計算手段901は、リードオンリーメモリ(ROM)902に記憶されたコンピュータプログラム又は記憶手段908からランダムアクセスメモリ(RAM)903にロードされたコンピュータプログラムに基づいて、様々な適切な動作及び処理を実行してもよい。RAM903には、さらに機器900の操作に必要な様々なプログラム及びデータを記憶してもよい。計算手段901、ROM902、及びRAM903は、バス904を介して相互に接続される。入出力(I/O)インターフェース905も、バス904に接続される。 As shown in FIG. 9, the device 900 includes a calculation means 901 that is loaded into a random access memory (RAM) 903 from a computer program stored in a read only memory (ROM) 902 or from a storage means 908. Various suitable operations and processes may be performed based on the computer program. The RAM 903 may further store various programs and data necessary for operating the device 900. Calculation means 901, ROM 902, and RAM 903 are interconnected via bus 904. An input/output (I/O) interface 905 is also connected to bus 904.

機器900における複数の部品は、I/Oインターフェース905に接続され、例えばキーボード、マウス等の入力手段906と、例えば様々な種類のディスプレイ、スピーカ等の出力手段907と、例えば磁気ディスク、光ディスク等の記憶手段908と、例えばネットワークカード、モデム、無線通信トランシーバ等の通信手段909とを含む。通信手段909は、機器900がインターネット等のコンピュータネットワーク及び/又は各種の電気ネットワークを介して他の機器と情報・データをやり取りすることを可能にする。 A plurality of components in the device 900 are connected to an I/O interface 905, and include input means 906 such as a keyboard and mouse, output means 907 such as various types of displays and speakers, and output means 907 such as a magnetic disk, an optical disk, etc. It includes storage means 908 and communication means 909, such as a network card, modem, wireless communication transceiver, etc. The communication means 909 enables the device 900 to exchange information and data with other devices via a computer network such as the Internet and/or various electrical networks.

計算手段901は、処理及び演算能力を有する各種の汎用及び/又は専用の処理モジュールであってもよい。計算手段901の幾つかの例として、中央処理ユニット(CPU)、GPU(Graphics Processing Unit)、各種専用の人工知能(AI)演算チップ、各種機械学習モデルアルゴリズムをランニングする演算ユニット、DSP(Digital Signal Processor)、並びに任意の適切なプロセッサ、コントローラ、マイクロコントローラ等が挙げられるが、これらに限定されない。計算手段901は、前文で説明した各方法と処理、例えば、車両重量を推定するための方法を実行する。例えば、幾つかの実施例において、車両重量を推定するための方法は、例えば記憶手段908のような機械可読媒体に有形的に含まれるコンピュータソフトウェアプログラムとして実現されてもよい。いくつかの実施例において、コンピュータプログラムの一部又は全部は、ROM902及び/又は通信手段909を介して機器900にロード及び/又はインストールされてもよい。コンピュータプログラムがRAM903にロードされて計算手段901により実行される場合、前文で説明した車両重量を推定するための方法の1つ又は複数のステップを実行してもよい。代替的に、他の実施例において、計算手段901は、他の任意の適切な方式(例えば、ファームウェアを介する)により車両重量を推定するための方法を実行するように構成されてもよい。 The calculation means 901 may be various general-purpose and/or dedicated processing modules having processing and computing capabilities. Some examples of the calculation means 901 include a central processing unit (CPU), a GPU (Graphics Processing Unit), various dedicated artificial intelligence (AI) calculation chips, a calculation unit that runs various machine learning model algorithms, and a DSP (Digital Signal). and any suitable processor, controller, microcontroller, etc. The calculation means 901 executes the methods and processes described in the preamble, for example the method for estimating vehicle weight. For example, in some embodiments, the method for estimating vehicle weight may be implemented as a computer software program tangibly contained in a machine-readable medium, such as storage means 908. In some embodiments, part or all of the computer program may be loaded and/or installed on the device 900 via the ROM 902 and/or the communication means 909. When the computer program is loaded into the RAM 903 and executed by the calculation means 901, it may carry out one or more steps of the method for estimating vehicle weight as described in the preamble. Alternatively, in other embodiments, the calculation means 901 may be configured to perform the method for estimating vehicle weight in any other suitable manner (e.g. via firmware).

本明細書で以上に説明されたシステム及び技術の様々な実施形態は、デジタル電子回路システム、集積回路システム、フィールドプログラマブルゲートアレイ(FPGA)、特定用途向け集積回路(ASIC)、特定用途向け標準製品(ASSP)、システムオンチップ(SOC)、コンプレックスプログラムマブルロジックデバイス(CPLD)、コンピュータハードウェア、ファームウェア、ソフトウェア、及び/又はそれらの組み合わせにおいて実現されてもよい。これらの様々な実施形態は、1つ又は複数のコンピュータプログラムにおいて実施され、該1つ又は複数のコンピュータプログラムは、少なくとも1つのプログラムマブルプロセッサを含むプログラムマブルシステムで実行され及び/又は解釈されることが可能であり、該プログラムマブルプロセッサは、専用又は汎用のプログラムマブルプロセッサであってもよく、記憶システム、少なくとも1つの入力装置、及び少なくとも1つの出力装置からデータ及び命令を受信し、かつデータ及び命令を該記憶システム、該少なくとも1つの入力装置、及び該少なくとも1つの出力装置に伝送することができることを含んでもよい。 Various embodiments of the systems and techniques described herein above include digital electronic circuit systems, integrated circuit systems, field programmable gate arrays (FPGAs), application specific integrated circuits (ASICs), application specific standard products. (ASSP), system on a chip (SOC), complex programmable logic device (CPLD), computer hardware, firmware, software, and/or combinations thereof. These various embodiments are implemented in one or more computer programs that are executed and/or interpreted on a programmable system that includes at least one programmable processor. The programmable processor may be a special purpose or general purpose programmable processor and receives data and instructions from a storage system, at least one input device, and at least one output device. , and capable of transmitting data and instructions to the storage system, the at least one input device, and the at least one output device.

本開示の方法を実施するためのプログラムコードは、1つ又は複数のプログラミング言語の任意の組み合わせで作成されてもよい。これらのプログラムコードは、汎用コンピュータ、専用コンピュータ又は他のプログラマブルデータ処理装置のプロセッサ又はコントローラに提供されてもよく、それによって、プログラムコードがプロセッサ又はコントローラにより実行される時に、フローチャート及び/又はブロック図に規定された機能・操作が実施される。プログラムコードは、機器に完全に実行されてもよく、部分的に機器で実行されてもよく、独立したソフトウェアパッケージとして部分的に機器で実行され、かつ部分的に遠隔機器で実行されるか又は完全に遠隔機器又はサーバで実行されてもよい。 Program code for implementing the methods of this disclosure may be written in any combination of one or more programming languages. These program codes may be provided to a processor or controller of a general purpose computer, special purpose computer, or other programmable data processing device, such that when executed by the processor or controller, the program codes may be provided in a flowchart and/or block diagram. The functions and operations specified in the above shall be carried out. The program code may be executed entirely on the device, partially on the device, partially on the device as a separate software package, and partially on a remote device, or It may be performed entirely on a remote device or server.

本開示のコンテキストにおいて、機械可読媒体は、有形の媒体であってもよく、命令実行システム、装置又は電子機器に使用され、又は命令実行システム、装置又は電子機器と組み合わせて使用されるプログラムを含んで又は記憶してもよい。機械可読媒体は、機械可読信号媒体又は機械可読記憶媒体であってもよい。機械可読媒体は、電子の、磁気的、光学的、電磁的、赤外線の、又は半導体システム、装置又は電子機器、又は上記内容の任意の適切な組み合わせを含んでもよいが、それらに限定されない。機械可読記憶媒体のより具体的な例としては、1つ以上の線による電気的接続、携帯式コンピュータディスク、ハードディスク、ランダムアクセスメモリ(RAM)、読み出し専用メモリ(ROM)、消去可能なプログラマブルリードオンリーメモリ(EPROM又はフラッシュメモリ)、光ファイバ、コンパクトディスクリードオンリーメモリ(CD-ROM)、光学記憶装置、磁気記憶装置、又は上記内容の任意の適切な組み合わせを含む。 In the context of this disclosure, a machine-readable medium may be a tangible medium and includes a program for use in or in combination with an instruction-execution system, device, or electronic device. It may also be stored. A machine-readable medium may be a machine-readable signal medium or a machine-readable storage medium. Machine-readable media may include, but are not limited to, electronic, magnetic, optical, electromagnetic, infrared, or semiconductor systems, devices or electronics, or any suitable combination of the above. More specific examples of machine-readable storage media include electrical connection through one or more wires, portable computer disks, hard disks, random access memory (RAM), read-only memory (ROM), erasable programmable read-only memory (EPROM or flash memory), fiber optics, compact disk read-only memory (CD-ROM), optical storage, magnetic storage, or any suitable combination of the above.

ユーザとの対話を提供するために、コンピュータにここで説明されたシステム及び技術を実施させてもよく、該コンピュータは、ユーザに情報を表示するための表示装置(例えば、CRT(陰極線管)又はLCD(液晶ディスプレイ)モニタ)と、キーボード及びポインティングデバイス(例えば、マウス又はトラックボール)とを備え、ユーザは、該キーボード及び該ポインティングデバイスを介して入力をコンピュータに提供することができる。他の種類の装置は、さらにユーザとの対話を提供してもよく、例えば、ユーザに提供されたフィードバックは、いかなる形式のセンシングフィードバック(例えば、視覚フィードバック、聴覚フィードバック、又は触覚フィードバック)であってもよく、かついかなる形式(音声入力、語音入力又は、触覚入力を含む)でユーザからの入力を受信してもよい。 A computer may implement the systems and techniques described herein to provide user interaction, and the computer may include a display device (e.g., a CRT (cathode ray tube) or a liquid crystal display (LCD) monitor), a keyboard and a pointing device (eg, a mouse or trackball) through which a user can provide input to the computer. Other types of devices may further provide interaction with the user, for example, the feedback provided to the user may be any form of sensing feedback (e.g., visual feedback, auditory feedback, or haptic feedback). Input from the user may be received in any form, including voice input, speech input, or tactile input.

ここで説明されたシステム及び技術は、バックグラウンド部品を含むコンピューティングシステム(例えば、データサーバとする)、又はミドルウェア部品を含むコンピューティングシステム(例えば、アプリケーションサーバ)、又はフロントエンド部品を含むコンピューティングシステム(例えば、グラフィカルユーザインタフェース又はウェブブラウザを有するユーザコンピュータ、ユーザが該グラフィカルユーザインタフェース又は該ネットワークブラウザを介してここで説明されたシステム及び技術の実施形態と対話することができる)、又はこのようなバックグラウンド部品、ミドルウェア部品、又はフロントエンド部品のいずれかの組み合わせを含むコンピューティングシステムに実施されることが可能である。任意の形式又は媒体のデジタルデータ通信(例えば、通信ネットワーク)によりシステムの部品を互いに接続することができる。通信ネットワークの例としては、ローカルエリアネットワーク(LAN)、ワイドエリアネットワーク(WAN)及びインターネットを例示的に含む。 The systems and techniques described herein may be used in a computing system that includes background components (e.g., a data server), or a computing system that includes middleware components (e.g., an application server), or a computing system that includes front-end components. a system (e.g., a user computer having a graphical user interface or a web browser through which a user can interact with embodiments of the systems and techniques described herein); The present invention may be implemented in a computing system that includes any combination of background components, middleware components, or front-end components. The components of the system may be interconnected by any form or medium of digital data communication (eg, a communication network). Examples of communication networks illustratively include local area networks (LANs), wide area networks (WANs), and the Internet.

コンピュータシステムは、クライアント及びサーバを含んでもよい。クライアントとサーバ同士は、一般的に離れており、通常、通信ネットワークを介して対話する。クライアントとサーバとの関係は、該当するコンピュータ上でランニングし、クライアント-サーバの関係を有するコンピュータプログラムによって生成される。サーバは、クラウドサーバであってもよく、分散型システムのサーバであってもよく、又はブロックチェーンを組合せたサーバであってもよい。 A computer system may include a client and a server. Clients and servers are generally remote and typically interact via a communications network. The relationship between client and server is created by a computer program running on the relevant computer and having a client-server relationship. The server may be a cloud server, a distributed system server, or a blockchain combined server.

理解されるべきこととして、以上に示された様々な形式のフローを使用してもよく、操作を改めてソーティングしたり、追加したり又は削除してもよい。例えば、本開示に記載の各操作は、並列に実行されたり、順次に実行されたり、又は異なる順序で実行されてもよく、本開示に開示された技術案が所望する結果を実現することができれば、本明細書はここで限定されない。 It should be understood that various types of flows illustrated above may be used and operations may be re-sorted, added, or deleted. For example, each operation described in this disclosure may be performed in parallel, sequentially, or in a different order, and the techniques disclosed in this disclosure may achieve the desired results. Preferably, the specification is not limited here.

本開示の技術案では、係られたユーザ個人情報の取得、記憶及び応用などは、いずれも関連法律や法規の規定に合致しており、公序良俗に反していない。 In the technical solution disclosed herein, the acquisition, storage, application, etc. of the user's personal information are all in accordance with the provisions of relevant laws and regulations, and do not violate public order and morals.

上記具体的な実施形態は、本開示の保護範囲を限定するものではない。当業者であれば、設計要件及び他の要因に応じて、様々な修正、組み合わせ、サブコンビネーション及び代替を行うことが可能であると理解すべきである。本開示の精神と原則内で行われる任意の修正、均等置換及び改良などは、いずれも本開示の保護範囲内に含まれるべきである。 The above specific embodiments do not limit the protection scope of the present disclosure. Those skilled in the art should appreciate that various modifications, combinations, subcombinations, and substitutions may be made depending on design requirements and other factors. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of this disclosure should be included within the protection scope of this disclosure.

Claims (16)

車両重量を推定する方法であって、
前記車両の現在速度と前記車両に対する制御コマンドとに応じて、速度-コマンド-輪縁トルクのマッピング関係を用いて前記車両の輪縁トルク値を取得することと、
取得された輪縁トルク値を用いて、車両縦方向動力学方程式に基づいて前記車両の重量を推定することと、を含む、
車両重量の推定方法。
A method for estimating vehicle weight, the method comprising:
obtaining a wheel edge torque value of the vehicle using a speed-command-wheel edge torque mapping relationship in response to a current speed of the vehicle and a control command for the vehicle;
estimating a weight of the vehicle based on vehicle longitudinal dynamics equations using the obtained wheel edge torque values;
How to estimate vehicle weight.
前記速度-コマンド-輪縁トルクのマッピング関係を用いて車両の輪縁トルク値を取得することは、
車両の現在速度と前記制御コマンドとに応じて、前記速度-コマンド-輪縁トルクのマッピング関係において前記現在速度が属するキャリブレーション区間、及び制御コマンドが属するキャリブレーション区間を特定することと、
前記速度-コマンド-輪縁トルクのマッピング関係に基づいて、前記現在速度が属するキャリブレーション区間及び制御コマンドが属するキャリブレーション区間に応じて、特定されたキャリブレーション区間に対応する複数の輪縁トルク値をそれぞれ取得することと、
前記複数の輪縁トルク値から車両現在の速度及び制御コマンドに対応する輪縁トルク値を算出することと、を含む、
請求項1に記載の方法。
Obtaining the wheel edge torque value of the vehicle using the speed-command-wheel edge torque mapping relationship includes:
In accordance with the current speed of the vehicle and the control command, specifying a calibration section to which the current speed belongs and a calibration section to which the control command belongs in the speed-command-wheel-edge torque mapping relationship;
Based on the speed-command-wheel-edge torque mapping relationship, a plurality of wheel-edge torque values corresponding to the specified calibration interval according to the calibration interval to which the current speed belongs and the calibration interval to which the control command belongs. and to obtain each of
calculating a wheel edge torque value corresponding to a vehicle current speed and a control command from the plurality of wheel edge torque values;
The method according to claim 1.
前記複数の輪縁トルク値から車両現在の速度及び制御コマンドに対応する輪縁トルク値を算出することは、
Figure 0007351012000035
を含み、
ただし、
vは車両現在の速度であり、v及びvt-1はそれぞれ前記現在速度が属するキャリブレーション区間における速度であり、
Cmdは制御コマンドであり、Cmd及びCmdt-1はそれぞれ制御コマンドが属するキャリブレーション区間における制御コマンドであり、
wheelは輪縁トルク値であり、 、T 、T 及びT は前記特定されたキャリブレーション区間に対応する複数の輪縁トルク値である、
請求項2に記載の方法。
Calculating a wheel edge torque value corresponding to the vehicle current speed and a control command from the plurality of wheel edge torque values includes:
Figure 0007351012000035
including;
however,
v is the current speed of the vehicle, v t and v t-1 are the speeds in the calibration interval to which the current speed belongs,
Cmd is a control command, Cmd t and Cmd t-1 are control commands in the calibration interval to which the control command belongs,
T wheel is a wheel edge torque value, and T 1 , T 2 , T 3 and T 4 are a plurality of wheel edge torque values corresponding to the identified calibration interval.
The method according to claim 2.
前記車両縦方向動力学方程式に基づいて車両の重量を推定することは、
前記車両縦方向動力学方程式に対して忘却係数を有する最小二乗再帰方程式を作成することと、
前記忘却係数を有する最小二乗再帰方程式を用いて反復計算を行い、車両の重量を取得することと、を含む、
請求項1に記載の方法。
Estimating the weight of the vehicle based on the vehicle longitudinal dynamics equation includes:
creating a least squares recursive equation with a forgetting factor for the vehicle longitudinal dynamics equation;
performing an iterative calculation using a least squares recursive equation having the forgetting factor to obtain the weight of the vehicle;
The method according to claim 1.
前記車両縦方向動力学方程式は、車両走行状態データに基づいて作成され、前記車両走行状態データは、
車両速度vと、車両加速度
Figure 0007351012000036
と、慣性モーメントJと、角加速度
Figure 0007351012000037
と、道路勾配角βとの少なくとも1つを含む、
請求項1に記載の方法。
The vehicle longitudinal dynamic equation is created based on vehicle running state data, and the vehicle running state data is:
Vehicle speed v and vehicle acceleration
Figure 0007351012000036
, moment of inertia J, and angular acceleration
Figure 0007351012000037
and a road slope angle β.
The method according to claim 1.
前記道路勾配角は、拡張カルマンフィルタEKFに基づいて推定される、
請求項5に記載の方法。
The road slope angle is estimated based on an extended Kalman filter EKF.
The method according to claim 5.
拡張カルマンフィルタEKFに基づいて道路勾配角を推定することは、
EKFのシステム状態方程式とEKFのシステム測定方程式とに基づいて道路勾配角を推定することを含み、
前記システム状態方程式は、
Figure 0007351012000038
であり、
ただし、
mは車両重量であり、単位がkgであり、
vは車両速度であり、単位がm/sであり、
v(k)、v(k-1)はそれぞれk回目、k-1回目の反復計算によって算出された車両速度であり、
Δtは実際にEKFを利用する時の反復計算の周期を表し、
Jは車両の慣性モーメントであり、単位がkg・mであり、
Figure 0007351012000039

は車両角加速度であり、単位がrad/ であり、
wheelは車両の輪縁トルクであり、単位がN・mであり、
rは前記車両の車輪ロール半径であり、単位がmであり、
Figure 0007351012000040
即ち、等価風抵抗係数であり、ただしρは空気抵抗係数であり、Aは車両実効風上面積であり、Cは風抵抗係数であり、
βは道路勾配角であり、単位がradであり、
β(k)、β(k-1)、β(k-2)及びβ(k-3)はそれぞれk回目、k-1回目、k-2回目、k-3回目の反復計算によって算出された道路勾配角であり、
μは転がり抵抗係数であり、
gは重力加速度であり、単位がm/sであり、且つ
WはEKFのシステムノイズベクトルであり、
前記EKFのシステム測定方程式は
Figure 0007351012000041
であり、
ただし、
z(k)はEKFが測定しようとする車両速度を表し、
VはEKFの測定ノイズベクトルであり、
Hは測定行列であり、センサによって取得された道路勾配角が存在する場合、
Figure 0007351012000042
センサによって取得された道路勾配角が存在しない場合、
Figure 0007351012000043
である、
請求項6に記載の方法。
Estimating the road slope angle based on the extended Kalman filter EKF is as follows:
estimating a road slope angle based on an EKF system state equation and an EKF system measurement equation;
The system state equation is
Figure 0007351012000038
and
however,
m is the vehicle weight, the unit is kg,
v is the vehicle speed, the unit is m/s,
v(k) and v(k-1) are the vehicle speeds calculated by the k-th and k-1th iteration calculations, respectively,
Δt represents the cycle of iterative calculation when actually using EKF,
J is the moment of inertia of the vehicle, the unit is kg・m2 ,
Figure 0007351012000039

is the vehicle angular acceleration in rad/s2 ,
T wheel is the wheel edge torque of the vehicle, the unit is N・m,
r is the wheel roll radius of the vehicle, the unit is m,
Figure 0007351012000040
That is, it is the equivalent wind resistance coefficient, where ρ is the air resistance coefficient, A is the vehicle effective windward area, CD is the wind resistance coefficient,
β is the road slope angle, the unit is rad,
β(k), β(k-1), β(k-2) and β(k-3) are calculated by the kth, k-1st, k-2nd and k-3rd iterations, respectively. is the road slope angle,
μ is the rolling resistance coefficient,
g is the gravitational acceleration in m/ s2 , and W is the system noise vector of the EKF,
The system measurement equation for the EKF is
Figure 0007351012000041
and
however,
z(k) represents the vehicle speed that the EKF attempts to measure;
V is the measurement noise vector of the EKF,
H is the measurement matrix, and if there is a road slope angle acquired by the sensor,
Figure 0007351012000042
If there is no road slope angle acquired by the sensor,
Figure 0007351012000043
is,
The method according to claim 6.
前記システムノイズベクトルWと前記測定ノイズベクトルVとは互いに独立し、かつ平均値がいずれもゼロである白色ガウスノイズである、
請求項7に記載の方法。
The system noise vector W and the measurement noise vector V are white Gaussian noises that are independent of each other and have an average value of zero;
The method according to claim 7.
前記速度-コマンド-輪縁トルクのマッピング関係は、事前に収集された車両制御コマンドと前記車両制御コマンドに対応する車両センシングデータとに基づいて予め決められ、
ただし、前記車両センシングデータは車両センサによって収集された車両速度を含む、
請求項1に記載の方法。
The speed-command-wheel edge torque mapping relationship is predetermined based on vehicle control commands collected in advance and vehicle sensing data corresponding to the vehicle control commands,
However, the vehicle sensing data includes vehicle speed collected by vehicle sensors;
The method according to claim 1.
車両重量を推定する装置であって、
前記車両の現在速度と前記車両に対する制御コマンドとに応じて、速度-コマンド-輪縁トルクのマッピング関係を用いて前記車両の輪縁トルク値を取得するように配置されている輪縁トルク値取得モジュールと、
取得された輪縁トルク値を用いて、車両縦方向動力学方程式に基づいて前記車両の重量を推定するように配置されている重量推定モジュールと、を含む、
車両重量の推定装置。
A device for estimating vehicle weight,
a wheel edge torque value acquisition arranged to obtain a wheel edge torque value of the vehicle using a speed-command-wheel edge torque mapping relationship in response to a current speed of the vehicle and a control command for the vehicle; module and
a weight estimation module configured to use the obtained wheel edge torque values to estimate the weight of the vehicle based on vehicle longitudinal dynamics equations;
Vehicle weight estimation device.
前記輪縁トルク値取得モジュールは、
車両の現在速度と前記制御コマンドとに応じて、前記速度-コマンド-輪縁トルクのマッピング関係において前記現在速度が属するキャリブレーション区間、及び制御コマンドが属するキャリブレーション区間を特定する第1のサブモジュールと、
前記速度-コマンド-輪縁トルクのマッピング関係に基づいて、前記現在速度が属するキャリブレーション区間及び制御コマンドが属するキャリブレーション区間に応じて、特定されたキャリブレーション区間に対応する複数の輪縁トルク値をそれぞれ取得する第2のサブモジュールと、
前記複数の輪縁トルク値から車両現在の速度及び制御コマンドに対応する輪縁トルク値を算出する第3のサブモジュールと、を含む、
請求項10に記載の装置。
The wheel edge torque value acquisition module includes:
A first submodule that identifies a calibration section to which the current speed belongs and a calibration section to which the control command belongs in the speed-command-wheel-edge torque mapping relationship according to the current speed of the vehicle and the control command. and,
Based on the speed-command-wheel-edge torque mapping relationship, a plurality of wheel-edge torque values corresponding to the specified calibration interval according to the calibration interval to which the current speed belongs and the calibration interval to which the control command belongs. a second sub-module that obtains, respectively;
a third sub-module that calculates a wheel edge torque value corresponding to a vehicle current speed and a control command from the plurality of wheel edge torque values;
Apparatus according to claim 10.
前記第3のサブモジュールは、以下の式に基づいて車両現在の速度及び制御コマンドに対応する輪縁トルク値を算出し、
Figure 0007351012000044
ただし、
vは車両現在の速度であり、v及びvt-1はそれぞれ前記現在速度が属するキャリブレーション区間における速度であり、
Cmdは制御コマンドであり、Cmd及びCmdt-1はそれぞれ制御コマンドが属するキャリブレーション区間における制御コマンドであり、
wheelは輪縁トルク値であり、 、T 、T 及びT は前記特定されたキャリブレーション区間に対応する複数の輪縁トルク値である、
請求項11に記載の装置。
The third sub-module calculates a wheel edge torque value corresponding to the vehicle current speed and control command based on the following equation,
Figure 0007351012000044
however,
v is the current speed of the vehicle, v t and v t-1 are the speeds in the calibration interval to which the current speed belongs,
Cmd is a control command, Cmd t and Cmd t-1 are control commands in the calibration interval to which the control command belongs,
T wheel is a wheel edge torque value, and T 1 , T 2 , T 3 and T 4 are a plurality of wheel edge torque values corresponding to the identified calibration interval.
Apparatus according to claim 11.
前記重量推定モジュールは、
前記車両縦方向動力学方程式に対して忘却係数を有する最小二乗再帰方程式を作成する第4のサブモジュールと、
前記忘却係数を有する最小二乗再帰方程式を用いて反復計算を行い、車両の重量を取得する第5のサブモジュールと、を含む、
請求項10に記載の装置。
The weight estimation module includes:
a fourth submodule for creating a least squares recursive equation with a forgetting factor for the vehicle longitudinal dynamics equation;
a fifth sub-module for performing iterative calculations using the least squares recursive equation having the forgetting factor to obtain the weight of the vehicle;
Apparatus according to claim 10.
少なくとも1つのプロセッサと、
前記少なくとも1つのプロセッサと通信接続するメモリとを有する電子機器であって、
前記メモリに、前記少なくとも1つのプロセッサによって実行され得るコマンドが記憶されており、前記コマンドが前記少なくとも1つのプロセッサによって実行されることで、前記少なくとも1つのプロセッサが請求項1~9のいずれか一項に記載の方法を実行することができる、
電子機器。
at least one processor;
An electronic device comprising a memory communicatively connected to the at least one processor,
A command that can be executed by the at least one processor is stored in the memory, and the execution of the command by the at least one processor causes the at least one processor to execute the command according to any one of claims 1 to 9. can carry out the method described in section.
Electronics.
コンピュータに請求項1~9のいずれか一項に記載の方法を実行させるためのコンピュータコマンドを記憶している、
非一時的なコンピュータ読取可能な記憶媒体。
storing computer commands for causing a computer to execute the method according to any one of claims 1 to 9;
Non-transitory computer-readable storage medium.
プロセッサにより実行される場合に、請求項1~9のいずれか一項に記載の方法を実現するコンピュータプログラム。 A computer program implementing a method according to any one of claims 1 to 9 when executed by a processor.
JP2022538073A 2021-06-08 2021-10-09 Vehicle weight estimation method, device, electronic device, storage medium and computer program Active JP7351012B2 (en)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
CN202110650457.7A CN113392518B (en) 2021-06-08 2021-06-08 Method and apparatus for estimating vehicle weight
CN202110650457.7 2021-06-08
PCT/CN2021/122796 WO2022257310A1 (en) 2021-06-08 2021-10-09 Method and apparatus for estimating weight of vehicle

Publications (2)

Publication Number Publication Date
JP2023539541A JP2023539541A (en) 2023-09-15
JP7351012B2 true JP7351012B2 (en) 2023-09-26

Family

ID=82403317

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2022538073A Active JP7351012B2 (en) 2021-06-08 2021-10-09 Vehicle weight estimation method, device, electronic device, storage medium and computer program

Country Status (2)

Country Link
JP (1) JP7351012B2 (en)
KR (1) KR20220099577A (en)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004037255A (en) 2002-07-03 2004-02-05 Sumitomo Rubber Ind Ltd Method and apparatus for estimating mass of vehicle, and method and apparatus for estimating gradient using the method
JP2006337087A (en) 2005-05-31 2006-12-14 Nissan Motor Co Ltd Vehicle weight estimator
JP2007008334A (en) 2005-06-30 2007-01-18 Toyota Motor Corp Braking control unit of vehicle
JP2018091754A (en) 2016-12-05 2018-06-14 いすゞ自動車株式会社 Device and method for estimation of vehicle weight
CN113392518A (en) 2021-06-08 2021-09-14 阿波罗智联(北京)科技有限公司 Method and device for estimating vehicle weight

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004037255A (en) 2002-07-03 2004-02-05 Sumitomo Rubber Ind Ltd Method and apparatus for estimating mass of vehicle, and method and apparatus for estimating gradient using the method
JP2006337087A (en) 2005-05-31 2006-12-14 Nissan Motor Co Ltd Vehicle weight estimator
JP2007008334A (en) 2005-06-30 2007-01-18 Toyota Motor Corp Braking control unit of vehicle
JP2018091754A (en) 2016-12-05 2018-06-14 いすゞ自動車株式会社 Device and method for estimation of vehicle weight
CN113392518A (en) 2021-06-08 2021-09-14 阿波罗智联(北京)科技有限公司 Method and device for estimating vehicle weight

Also Published As

Publication number Publication date
KR20220099577A (en) 2022-07-13
JP2023539541A (en) 2023-09-15

Similar Documents

Publication Publication Date Title
CN113392518B (en) Method and apparatus for estimating vehicle weight
CN111873991B (en) Vehicle steering control method, device, terminal and storage medium
US11254315B2 (en) Friction adaptive vehicle control
CN110850895B (en) Path tracking method, device, equipment and storage medium
CN113183975B (en) Control method, device, equipment and storage medium for automatic driving vehicle
CN107380169B (en) Online prediction method and system for automobile steering control characteristics
CN114987607B (en) Steering control method, device and equipment for vehicle and storage medium
CN111186445B (en) Lateral control method and system for automatic driving vehicle
CN112441012A (en) Vehicle driving track prediction method and device
CN114312843B (en) Method and device for determining information
CN114852089A (en) Vehicle running control method and device, electronic equipment and storage medium
JP7351012B2 (en) Vehicle weight estimation method, device, electronic device, storage medium and computer program
CN113792265A (en) Gradient estimation method and device, electronic equipment and storage medium
CN113978465A (en) Lane-changing track planning method, device, equipment and storage medium
WO2024016892A1 (en) Method and apparatus for external-parameter calibration of sensors, and electronic device
CN113212431A (en) Tracking control method, device, equipment and storage medium
Zhou et al. A layered roll stability control strategy for commercial vehicles based on adaptive model predictive control
WO2024093016A1 (en) Vehicle weight estimation method and apparatus, storage medium and engineering vehicle
CN115288872B (en) Torque control method, device and system
CN113734182A (en) Vehicle self-adaptive control method and device
CN115991187A (en) Vehicle control method, controller and storage medium based on non-offset model prediction
CN114620074A (en) Vehicle control method, device, electronic device and storage medium
CN117346782B (en) Positioning optimization method, device, electronic equipment and storage medium
CN117289686B (en) Parameter calibration method and device, electronic equipment and storage medium
CN117864172B (en) Automatic driving control method, device and equipment

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220620

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20220620

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230913

R150 Certificate of patent or registration of utility model

Ref document number: 7351012

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150