JP5746264B2 - Steering control device and steering speed detection method - Google Patents
Steering control device and steering speed detection method Download PDFInfo
- Publication number
- JP5746264B2 JP5746264B2 JP2013110812A JP2013110812A JP5746264B2 JP 5746264 B2 JP5746264 B2 JP 5746264B2 JP 2013110812 A JP2013110812 A JP 2013110812A JP 2013110812 A JP2013110812 A JP 2013110812A JP 5746264 B2 JP5746264 B2 JP 5746264B2
- Authority
- JP
- Japan
- Prior art keywords
- steering
- speed
- steering speed
- steering angle
- estimated
- 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.)
- Expired - Fee Related
Links
- 238000001514 detection method Methods 0.000 title claims description 11
- 238000004364 calculation method Methods 0.000 claims description 54
- 238000012937 correction Methods 0.000 claims description 47
- 238000000034 method Methods 0.000 claims description 19
- 230000008569 process Effects 0.000 claims description 17
- 238000012545 processing Methods 0.000 claims description 12
- 230000008859 change Effects 0.000 description 12
- 230000004044 response Effects 0.000 description 11
- 238000010586 diagram Methods 0.000 description 10
- 230000000694 effects Effects 0.000 description 9
- 238000001914 filtration Methods 0.000 description 7
- 230000007935 neutral effect Effects 0.000 description 5
- 230000007246 mechanism Effects 0.000 description 4
- 230000032683 aging Effects 0.000 description 3
- 230000003111 delayed effect Effects 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 238000012546 transfer Methods 0.000 description 3
- 230000015556 catabolic process Effects 0.000 description 2
- 238000006731 degradation reaction Methods 0.000 description 2
- 230000014759 maintenance of location Effects 0.000 description 2
- 230000009467 reduction Effects 0.000 description 2
- 230000006866 deterioration Effects 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 238000006557 surface reaction Methods 0.000 description 1
Images
Description
この発明は操舵制御装置及び操舵速度検出方法に関し、特に、運転者の操舵をアシストする操舵制御装置及び操舵速度検出方法に関するものである。 The present invention relates to a steering control device and a steering speed detection method, and more particularly to a steering control device and a steering speed detection method for assisting a driver's steering.
従来の電動パワーステアリング装置においては、運転者の操作をアシストするために、操舵系(車両のハンドル)にトルクを付与するためのモータが設けられている。従来の電動パワーステアリング装置においては、モータの端子間電圧を用いて、運転者の操舵速度を検出していた(例えば、特許文献1〜2参照)。
In a conventional electric power steering apparatus, a motor for applying torque to a steering system (vehicle handle) is provided to assist a driver's operation. In the conventional electric power steering apparatus, the steering speed of the driver is detected using the voltage between the terminals of the motor (see, for example,
特許文献1には、モータの角速度を、モータの端子間電圧に基づいて求める電動パワーステアリング装置について記載されている。
特許文献2には、モータの電流および電圧から操舵速度を検出する電動パワーステアリング装置について記載されている。特許文献2では、検出した操舵速度のオフセット誤差をハイパスフィルタで除去している。
特許文献1は、モータの端子間電圧を用いて、モータの角速度を検出することについては記載されているが、モータの端子間電圧にオフセット誤差が含まれる場合について考慮していない。そのため、モータの端子間電圧にオフセット誤差が含まれる場合には、検出した操舵速度もオフセット誤差を含むという問題点があった。 Japanese Patent Application Laid-Open No. 2004-228561 describes the detection of the angular velocity of the motor using the voltage between the terminals of the motor, but does not consider the case where the offset voltage is included in the voltage between the terminals of the motor. Therefore, when the offset voltage is included in the voltage between the terminals of the motor, there is a problem that the detected steering speed also includes the offset error.
特許文献2には、操舵速度のオフセット誤差をハイパスフィルタで除去することが記載されているが、当該ハイパスフィルタで操舵速度の低周波成分が除去されてしまうという問題点があった。
本発明は、かかる問題点を解決するためになされたものであり、オフセット誤差を含まない操舵速度を得ることが可能な操舵制御装置及び操舵速度検出方法を得ることを目的としている。 The present invention has been made to solve such a problem, and an object thereof is to obtain a steering control device and a steering speed detection method capable of obtaining a steering speed that does not include an offset error.
本発明は、車両の操舵系に操舵補助トルクを付与するモータを備え、前記操舵系の操舵角を検出する操舵角情報取得部と、前記モータの誘起電圧から操舵速度を推定して、推定操舵速度として出力する操舵速度情報取得部と、前記操舵角情報取得部で検出した前記操舵角から操舵速度を求め、当該操舵速度にローパスフィルタ処理を施した値を補正値として、前記操舵速度情報取得部で取得した前記推定操舵速度にハイパスフィルタ処理を施して取得した前記推定操舵速度の低周波成分を、前記補正値を加算することで補正し、前記操舵系の操舵速度として出力する補正部とを備えた操舵制御装置である。 The present invention includes a motor that applies a steering assist torque to a steering system of a vehicle, a steering angle information acquisition unit that detects a steering angle of the steering system, and a steering speed that is estimated from an induced voltage of the motor to estimate steering. A steering speed information acquisition unit that outputs as a speed and a steering speed obtained from the steering angle detected by the steering angle information acquisition unit, and a value obtained by subjecting the steering speed to a low-pass filter process as a correction value, the steering speed information acquisition A correction unit that corrects a low frequency component of the estimated steering speed acquired by performing a high-pass filter process on the estimated steering speed acquired by a unit by adding the correction value, and outputs the corrected steering speed as a steering speed of the steering system; Is a steering control device.
本発明は、車両の操舵系に操舵補助トルクを付与するモータを備え、前記操舵系の操舵角を検出する操舵角情報取得部と、前記モータの誘起電圧から操舵速度を推定して、推定操舵速度として出力する操舵速度情報取得部と、前記操舵角情報取得部で検出した前記操舵角から操舵速度を求め、当該操舵速度にローパスフィルタ処理を施した値を補正値として、前記操舵速度情報取得部で取得した前記推定操舵速度にハイパスフィルタ処理を施して取得した前記推定操舵速度の低周波成分を、前記補正値を加算することで補正し、前記操舵系の操舵速度として出力する補正部とを備えた操舵制御装置であるので、オフセット誤差を含まない操舵速度を得ることができる。 The present invention includes a motor that applies a steering assist torque to a steering system of a vehicle, a steering angle information acquisition unit that detects a steering angle of the steering system, and a steering speed that is estimated from an induced voltage of the motor to estimate steering. A steering speed information acquisition unit that outputs as a speed and a steering speed obtained from the steering angle detected by the steering angle information acquisition unit, and a value obtained by subjecting the steering speed to a low-pass filter process as a correction value, the steering speed information acquisition A correction unit that corrects a low frequency component of the estimated steering speed acquired by performing a high-pass filter process on the estimated steering speed acquired by a unit by adding the correction value, and outputs the corrected steering speed as a steering speed of the steering system; Therefore, a steering speed that does not include an offset error can be obtained.
実施の形態1.
図1は、本発明の実施の形態1による操舵制御装置およびその周辺を示す構成図である。操舵制御装置は、自動車等の車両に搭載される。車両には、2つの前輪(転舵輪3)と、2つの後輪(駆動輪)(図示せず)とが設けられている。図1に示すように、車両には、運転者が操作するための操舵系であるハンドル1(steering wheel)が設けられている。ハンドル1には、ステアリング軸2が連結されている。また、ステアリング軸2には、2つの転舵輪3が連結されている。運転者がハンドル1を操舵すると、ステアリング軸2の回転に応じて、左右の転舵輪3が転舵される。ハンドル1には、操舵角度を検出する操舵角度センサ4が配置されている。ステアリング軸2には、トルクセンサ5が配置されている。トルクセンサ5は、ステアリング軸2に作用する操舵トルクを検出する。また、モータ6が、減速機構7を介して、ステアリング軸2に連結されている。モータ6が発生する操舵補助トルクは、ステアリング軸2に付与される。車両の車速は、車速センサ8で検出する。また、モータ6に流れる電流(以下、モータ電流と呼ぶ。)は電流センサ9で検出する。モータ6の端子間電圧(以下、モータ電圧と呼ぶ。)は、電圧センサ10で検出する。
FIG. 1 is a configuration diagram showing a steering control device according to
なお、ここでは、操舵角度センサ4が、車両の操舵系の操舵角に関する情報を取得する操舵角情報取得部を構成している。しかしながら、この場合に限らず、車両の操舵系の操舵角に関する情報を取得する操舵角情報取得部は、車両の操舵系の操舵角に関する情報が取得できればよいため、例えば、ヨーレートセンサから構成してもよい。ヨーレートセンサとは、ヨーレート(車両の旋回方向への回転角の変化速度)を検出するセンサである。
Here, the
制御ユニット11には、操舵角度センサ4、トルクセンサ5、車速センサ8、電流センサ9、および、電圧センサ10による検出値が入力される。制御ユニット11は、それらの検出値に基づいてモータ6が発生すべき目標操舵補助トルクを演算し、当該目標操舵補助トルクに基づいて、モータ6に供給すべき電流の値を制御する。
Detection values from the
図2は、本実施の形態1に係る操舵制御装置の構成を示した図である。図2に示すように、操舵制御装置は、操舵角度センサ4、トルクセンサ5、車速センサ8、電流センサ9、および、電圧センサ10を含む複数のセンサと、制御ユニット11とから構成されている。制御ユニット11は、図2に示すように、ROMおよびRAMを含むメモリ(図示せず)が設けられたマイクロコンピュータから構成される演算装置40と、モータ6に電流を供給してモータ6を駆動する電流駆動器19とから構成される。
FIG. 2 is a diagram illustrating a configuration of the steering control device according to the first embodiment. As shown in FIG. 2, the steering control device includes a
なお、本実施の形態1においては、運転者の操舵をアシストする制御(以下、操舵アシスト制御)と、路面反力トルクが小さく、ハンドル1が中立位置に戻らない領域においても、ハンドル1を中立位置に戻すことを目的とした制御(以下、ハンドル戻し制御とする。)とを備えた操舵制御装置を例に挙げて説明する。
In the first embodiment, the
演算装置40内には、図2に示すように、操舵速度演算部12と、保舵判定部13と、目標操舵速度設定部14と、第1の操舵補助トルク演算部15と、操舵状態判定部16と、第2の操舵補助トルク演算部17と、加算部18とが設けられている。
In the
操舵速度演算部12は、操舵角度センサ4、電流センサ9、および、電圧センサ10から検出値が入力され、それらの検出値に基づいて操舵速度を演算する。操舵速度演算部12は、電流センサ9からモータ電流を取得し、電圧センサ10からモータ電圧を取得する。操舵速度演算部12は、モータ電流およびモータ電圧から、モータ6の誘起電圧を求める。なお、誘起電圧の演算方法は、実施の形態2で説明する。次に、操舵速度演算部12は、誘起電圧に基づいて操舵速度を推定する。しかしながら、この推定した操舵速度には、接触部酸化膜および経年劣化などによるオフセット誤差が含まれている。そこで、操舵速度演算部12は、操舵角度センサ4から取得した操舵角度に基づいて、推定した操舵速度を補正するための補正値を求める。操舵速度演算部12は、当該補正値を用いて、推定した操舵速度を補正し、補正後の操舵速度を出力する。
The steering
なお、ここでは、操舵速度演算部12が、操舵系の操舵速度に関する第1の情報を取得する操舵速度情報取得部と、当該操舵速度情報取得部で取得した第1の情報を、操舵角情報取得部(操舵角度センサまたはヨーレートセンサ)で取得した操舵系の操舵角に関する情報に基づいて補正し、操舵系の操舵速度に関する第2の情報を取得する補正部とを構成している。また、ここでは、操舵系の操舵速度に関する第1の情報として、モータ6の誘起電圧を例として挙げているが、その場合に限らず、レゾルバ等の操舵速度を検出する装置から得られる操舵速度を第1の情報としてもよい。なお、操舵速度演算部12の詳細な動作については、後述する実施の形態2,3で説明する。
Here, the steering
保舵判定部13は、車両の操舵系が保舵状態か否かを判定する。すなわち、保舵判定部13は、ハンドル1がほぼ一定操舵角度で留まっている状態か否かを判定する。保舵判定部13は、操舵速度演算部12で演算した操舵速度を用い、当該操舵速度が閾値より小さい場合に「保舵状態」と判定し、そのときの操舵角度を出力する。一方、当該操舵速度が閾値以上の場合は、「保舵状態でない」と判定し、出力する操舵角度は更新せず、前回の保舵判定時の操舵角度を出力する。
The steering holding
目標操舵速度設定部14には、操舵角度センサ4からの操舵角度、車速センサ8からの車速、および、保舵判定部13からの操舵角度が、入力される。目標操舵速度設定部14は、それらの値に基づいて、目標操舵速度を演算する。演算方法としては、例えば、それらの値に対する目標操舵速度を記憶したルックアップテーブルを予め記憶しておき、当該ルックアップテーブルに、操舵角度センサ4からの操舵角度、車速センサ8からの車速、および、保舵判定部13からの操舵角度の値を入力して、対応する目標操舵速度を求めるようにしてもよい。あるいは、目標操舵速度を求める演算式を記憶しておき、当該演算式に、操舵角度センサ4からの操舵角度、車速センサ8からの車速、および、保舵判定部13からの操舵角度を入力して、目標操舵速度を求めるようにしてもよい。
The target steering
第1の操舵補助トルク演算部15には、操舵速度演算部12で演算した操舵速度が入力されるとともに、目標操舵速度設定部14で演算した目標操舵速度が入力される。第1の操舵補助トルク演算部15は、当該操舵速度と目標操舵速度との偏差を求め、当該偏差に基づき、第1の操舵補助トルクを演算する。第1の操舵補助トルクは、ハンドル1を中立位置まで復帰させるためのトルクである。なお、第1の操舵補助トルクの演算方法は、操舵速度と目標操舵速度との偏差に対する第1の操舵補助トルクの値を記憶したルックアップテーブルを予め記憶しておき、当該ルックアップテーブルに偏差の値を入力して、対応する第1の操舵補助トルクの値を求めるようにすればよい。あるいは、操舵速度と目標操舵速度との偏差から、第1の操舵補助トルクを求める演算式を予め記憶しておき、当該演算式に偏差の値を入力して、第1の操舵補助トルクを求めるようにしてもよい。
The first steering assist
操舵状態判定部16には第1の操舵補助トルク演算部15で演算した第1の操舵補助トルクが入力される。操舵状態判定部16では第1の操舵補助トルク演算部15で演算した第1の操舵補助トルクが必要か否かを判定し、必要と判断されるときには第1の操舵補助トルクを、不必要と判断されるときには0を出力する。ここでは、トルクセンサ5からの操舵トルクに基づいて、運転者がハンドルを手放ししているかどうかを判定し、手放しであれば第1の操舵補助トルクを付与、手放しでなければ付与しないことを目的とする。本実施の形態では手放し状態か否かの判定を、トルクセンサ5の検出値(絶対値)が閾値以上で操舵状態、閾値未満で手放しと判定するものを例として記載する。
The first steering assist torque calculated by the first steering assist
第2の操舵補助トルク演算部17には、トルクセンサ5から操舵トルクが入力される。第2の操舵補助トルク演算部17は、操舵トルクに基づいて、運転者の操舵をアシストするための第2の操舵補助トルクを演算する。なお、第2の操舵補助トルクの演算方法は、操舵トルクに対する第2の操舵補助トルクの値を記憶したルックアップテーブルを予め記憶しておき、当該ルックアップテーブルに操舵トルクの値を入力して、当該ルックアップテーブルから、対応する第2の操舵補助トルクの値を求めるようにすればよい。あるいは、操舵トルクから第2の操舵補助トルクを求める演算式を予め記憶しておき、当該演算式に操舵トルクの値を入力して、第2の操舵補助トルクを求めるようにしてもよい。
A steering torque is input from the
加算部18には、操舵状態判定部16からの出力値(すなわち、第1の操舵補助トルク演算部15からの第1の操舵補助トルク、または、0)と、第2の操舵補助トルク演算部17からの第2の操舵補助トルクとが入力される。加算部18は、操舵状態判定部16からの出力値と第2の操舵補助トルクとを加算し、最終的な操舵補助トルクを演算する。
The
電流駆動器19は、加算部18で求めた操舵補助トルクに基づく電流をモータ6に供給し、モータ6を駆動する。これにより、モータ6は、必要な操舵補助トルクを発生する。
The
次に、本実施の形態1に係る操舵制御装置の動作について説明する。図3は、本実施の形態1に係る操舵制御装置の動作を示したフローチャートである。なお、図3の動作は、制御周期ごとに繰り返し実行される。 Next, the operation of the steering control device according to the first embodiment will be described. FIG. 3 is a flowchart showing the operation of the steering control device according to the first embodiment. Note that the operation of FIG. 3 is repeatedly executed every control cycle.
まず、ステップS1で、制御ユニット11は、操舵角度センサ4から操舵角度を、電圧センサ10からモータ電圧を、電流センサ9からモータ電流を、トルクセンサ5から運転者の操舵トルクを、車速センサ8から車速を、それぞれ取得する。
First, in step S1, the
ステップS2では、まず、操舵速度演算部12が、モータ電流およびモータ電圧から誘起電圧を求める。次に、操舵速度演算部12は、操舵角度および誘起電圧を用いて、操舵速度を演算し、当該操舵速度を出力する。
In step S2, first, the steering
ステップS3では、保舵判定部13が、車両の操舵系が保舵状態か否かを判定し、保舵状態と判定した場合に、そのときの操舵角度を出力する。一方、保舵状態でないと判定した場合には、操舵角度は更新せず、前回の保舵判定時の操舵角度を出力する。
In step S3, the
ステップS4では、目標操舵速度設定部14が、ステップS1で取得した操舵角および車速と、ステップ3で得た操舵角度とに基づいて、目標操舵速度を演算し、目標操舵速度を設定する。
In step S4, the target steering
ステップS5では、第1の操舵補助トルク演算部15が、目標操舵速度と操舵速度の偏差に基づき、第1の操舵補助トルクを演算する。
In step S5, the first steering assist
ステップS6では、操舵状態判定部16が、第1の操舵補助トルク演算部15で演算した第1の操舵補助トルクが必要か否かを判定し、必要と判断されるときには第1の操舵補助トルクを、不必要と判断されるときには0を出力する。ここでは、必要か否かの判定として、トルクセンサ5からの操舵トルクに基づいて、運転者がハンドルを手放ししているかどうかを判定し、手放しであれば第1の操舵補助トルクを出力し、手放しでなければ第1の操舵補助トルクを0として出力する。
In step S6, the steering
ステップS7では、第2の操舵補助トルク演算部17が、ステップS1で取得した操舵トルクに基づいて、運転者の操舵をアシストする第2の操舵補助トルクを演算する。
In step S7, the second steering assist
ステップS8では、加算部18が、操舵状態判定部16が出力した第1の操舵補助トルクと、第2の操舵補助トルク演算部17が出力した第2の操舵補助トルクとを加算し、最終的な操舵補助トルクとして出力する。
In step S8, the adding
ステップS9では、電流駆動器19が、ステップS8で得た最終的な操舵補助トルクに基づいて、モータ6に電流を供給し、モータ6を駆動する。
In step S9, the
上記のような操舵制御装置におけるハンドル戻し制御は、操舵速度と閾値から保舵状態を判定する。従って、操舵速度にオフセット誤差がある場合、または、低分解能である場合には、保舵判定を誤判定してしまう可能性がある。また、ハンドル1を中立位置まで復帰させるための第1の操舵補助トルクは、操舵速度が目標操舵速度に追従するように、操舵補助トルクを発生させるものである。そのため、操舵補助トルクがオフセット誤差を含む場合には、適切な操舵補助トルクが得られず、ハンドル戻りフィーリングが悪化する可能性がある。従って、本実施の形態1においては、操舵速度演算部12に、下記の実施の形態2および実施の形態3で示す操舵速度の演算処理を適用することにより、高応答および高分解能で、かつ、オフセット誤差を抑えた、操舵速度を得ることができ、目標操舵速度に応じた好適なハンドル戻しフィーリングを得ることができる。
In the steering wheel return control in the steering control device as described above, the steering holding state is determined from the steering speed and the threshold value. Therefore, when there is an offset error in the steering speed or when the resolution is low, the steering retention determination may be erroneously determined. Further, the first steering assist torque for returning the
以上のように、本実施の形態1においては、車両の操舵系の操舵角に関する情報を取得する操舵角情報取得部と、操舵系の操舵速度に関する第1の情報を取得する操舵速度情報取得部と、操舵速度情報取得部で取得した操舵速度に関する第1の情報を、操舵角情報取得部で取得した前記操舵角に関する情報に基づいて補正し、前記操舵系の操舵速度に関する第2の情報を取得する補正部とを備えた操舵制御装置であるので、オフセット誤差を含む操舵速度に関する第1の情報を、操舵角度に関する情報で補正するため、オフセット誤差を含まない操舵速度に関する第2の情報を求めることができる。 As described above, in the first embodiment, the steering angle information acquisition unit that acquires information about the steering angle of the steering system of the vehicle, and the steering speed information acquisition unit that acquires the first information about the steering speed of the steering system. And the first information regarding the steering speed acquired by the steering speed information acquisition unit is corrected based on the information regarding the steering angle acquired by the steering angle information acquisition unit, and the second information regarding the steering speed of the steering system is corrected. Therefore, in order to correct the first information relating to the steering speed including the offset error with the information relating to the steering angle, the second information relating to the steering speed not including the offset error is obtained. Can be sought.
特に、図2に示した実施形態では、車両の操舵系であるハンドル1の操舵角度を検出する操舵角度センサ4と、操舵系にトルクを付与するモータ6に流れる電流(モータ電流)を検出する電流センサ9と、モータ6の端子間電圧(モータ電圧)を検出する電圧センサ10と、操舵角度センサ4で検出された操舵角度、電流センサ9で検出された電流、および、電圧センサ10で検出された電圧に基づいて、操舵系の操舵速度を求める操舵速度演算部12と、操舵速度演算部12で求めた操舵系の操舵速度に基づいて操舵補助トルクを演算し、第1の操舵補助トルクとして出力する第1の操舵補助トルク演算部15と、第1の操舵補助トルクに基づいて、モータ6を駆動する電流駆動器19とを備え、操舵速度演算部12は、電流および電圧に基づいて操舵速度を第1の操舵速度(操舵速度に関する第1の情報)として推定し、操舵角度に基づいて、第1の操舵速度を補正するための補正値(操舵角に関する情報)を演算し、前記補正値を用いて第1の操舵速度を補正して、操舵系の操舵速度(操舵速度に関する第2の情報)として出力する。当該構成により、本実施の形態1では、オフセット誤差を含む第1の操舵速度(操舵速度に関する第1の情報を、操舵角度に応じて求めた補正値(操舵角に関する情報)で補正するため、オフセット誤差を含まない操舵速度(操舵速度に関する第2の情報)を求めることができる。
In particular, in the embodiment shown in FIG. 2, a current (motor current) flowing in the
また、本実施の形態1においては、電流センサ9で検出された電流および電圧センサ10で検出された電圧に基づいて、モータ6の誘起電圧を求め、当該誘起電圧に基づいて第1の操舵速度(操舵速度に関する第1の情報)を求めるようにした。これにより、高分解能の操舵速度を得ることができる。
In the first embodiment, the induced voltage of the motor 6 is obtained based on the current detected by the
また、本実施の形態1においては、操舵系に配置され、操舵系の操舵トルクを検出するトルクセンサ5と、トルクセンサ5により検出された操舵系の操舵トルクに基づいて第2の操舵補助トルクを演算する第2の操舵補助トルク演算部17とをさらに備え、電流駆動器19は、第1の操舵補助トルクと第2の操舵補助トルクとを加算部18で加算した加算値に基づいて、モータ6を駆動するようにした。これにより、ハンドル1を中立位置まで復帰させるための第1の操舵補助トルクと、運転者の操舵をアシストするための第2の操舵補助トルクとの両方を用いて、操舵補助トルクを演算するので、ハンドル戻し制御と操舵アシスト制御との両方を行うことができる。
In the first embodiment, the
実施の形態2.
本実施の形態2では、図4のフローチャートを用いて、制御ユニット11に設けられた操舵速度演算部12で実行される操舵速度の演算について説明する。すなわち、図4のフローチャートは、図3のフローチャートのステップS2の処理を詳細に示した図である。
In the second embodiment, the calculation of the steering speed executed by the steering
本実施の形態2に係る操舵制御装置の全体の構成および動作については、上記の実施の形態1と同じであるため、ここでは、説明を省略する。また、上記の実施の形態1と共通する構成については、同一の符号を用いることとし、以下では、実施の形態1と異なる点について主に説明する。 Since the overall configuration and operation of the steering control device according to the second embodiment are the same as those of the first embodiment, description thereof is omitted here. In addition, the same reference numerals are used for configurations common to the above-described first embodiment, and differences from the first embodiment will be mainly described below.
図4に示すように、まず、ステップS11で、操舵速度演算部12は、電圧センサ10からのモータ電圧EM、および、電流センサ9からのモータ電流IMを用いて、操舵速度に相当するモータ6の誘起電圧EEを求める。
As shown in FIG. 4, first, in step S <b> 11, the
ここで、モータ6の誘起電圧EEは、モータ電圧EMおよびモータ電流IMを用いて、下記の式(1)で得られる。 Here, the induced voltage EE of the motor 6 is obtained by the following equation (1) using the motor voltage EM and the motor current IM.
EE=EM−IM・RM−Eb (1) EE = EM-IM / RM-Eb (1)
ここで、RMはモータ6のアマチュア抵抗、Ebはモータ6のブラシのドロップ電圧とする。 Here, RM is an amateur resistance of the motor 6, and Eb is a drop voltage of the brush of the motor 6.
次に、ステップS12で、誘起電圧EEから、モータ回転速度VMを、下記の式(2)で演算する。 Next, in step S12, the motor rotation speed VM is calculated from the induced voltage EE by the following equation (2).
VM=EE/Kp (2) VM = EE / Kp (2)
ここで、Kpは誘起電圧係数である。 Here, Kp is an induced voltage coefficient.
次に、ステップS13で、モータ回転速度VMから操舵速度θomegaを推定する。なお、モータ回転速度と操舵速度とは、減速用ギア、ハンドル、タイヤ軸のラック、及び、ピニオンのような構造機構等に基づく関係がある。言い換えれば、モータ回転速度と操舵速度とは比例する。従って、モータ回転速度に基づき、推定操舵速度θomegaは、下記の式(3)で求められる。なお、モータ回転速度は誘起電圧に基づいて求められるものであるため、推定操舵速度θomegaを、以下では、「誘起電圧に基づく推定操舵速度」(第1の操舵速度)と呼ぶこととする。 Next, in step S13, the steering speed θ omega is estimated from the motor rotation speed VM. The motor rotation speed and the steering speed have a relationship based on a reduction gear, a handle, a tire shaft rack, and a structural mechanism such as a pinion. In other words, the motor rotation speed and the steering speed are proportional. Therefore, based on the motor rotation speed, the estimated steering speed θ omega is obtained by the following equation (3). Since the motor rotation speed is obtained based on the induced voltage, the estimated steering speed θ omega is hereinafter referred to as “estimated steering speed based on the induced voltage” (first steering speed).
θomega=Ggear × VM (3) θ omega = G gear × VM (3)
ここで、Ggearは、上記の構造機構により決定される比例係数である。 Here, G gear is a proportionality coefficient determined by the above structural mechanism.
ただし、モータ6のブラシのドロップ電圧Ebは、接触部酸化膜および経年劣化などの影響で変化するため、誘起電圧EEはそれらの変化分をオフセット誤差として含んだものとなる。これにより、誘起電圧EEから推定した操舵速度θomegaも、オフセット誤差を含む。 However, since the drop voltage Eb of the brush of the motor 6 changes due to the influence of the contact portion oxide film and aging deterioration, the induced voltage EE includes those changes as an offset error. Thereby, the steering speed θ omega estimated from the induced voltage EE also includes an offset error.
従って、ステップS14では、操舵速度演算部12は、操舵角度から得られる情報を用いて、操舵速度θomegaを補正する。図5に、その構成を示す。図5において、21は、操舵速度θomegaが入力されるハイパスフィルタである。22は、操舵角度から演算した操舵速度sθhが入力されるローパスフィルタである。23は、ハイパスフィルタ21からの出力とローパスフィルタ22からの出力とを加算する加算器である。
Therefore, in step S14, the steering
図5の構成は、誘起電圧EEのオフセット誤差が影響する低周波数領域においては、操舵角度θhから求める速度を用い、一方、高周波数領域においては、誘起電圧EEに基づく推定速度θomegaを用いて、最終的な操舵速度θhybridを演算するものである。ハイパスフィルタ21の伝達関数G1をG1=Ts/(Ts+1)とし、ローパスフィルタ22の伝達関数G2をG2=1/(Ts+1)とすると、図5の構成は、下記の式(4)であらわすことができる。
The configuration of FIG. 5 uses the speed obtained from the steering angle θ h in the low frequency region where the offset error of the induced voltage EE affects, while using the estimated speed θ omega based on the induced voltage EE in the high frequency region. Thus, the final steering speed θ hybrid is calculated. When the transfer function G1 of the high-
ここで、Tは、ハイパスフィルタ21およびローパスフィルタ22のカットオフ周波数の時定数であり、sはラプラス演算子である。
Here, T is a time constant of the cutoff frequency of the high-
図5の構成においては、誘起電圧EEに基づく推定操舵速度θomega(第1の操舵速度)のオフセット誤差を除去するために、ハイパスフィルタ21によるフィルタ処理を実施する。なお、ハイパスフィルタ21のカットオフ周波数は、オフセット誤差を除去できる値に設定してある。そのため、ハイパスフィルタ21によるフィルタ処理により、操舵速度θomegaのオフセット誤差を除去することができる。しかしながら、操舵速度が、ハイパスフィルタ21のカットオフ周波数以下の低周波数である場合には、当該操舵速度は、オフセット誤差と共に除去されるため、ハイパスフィルタ21の処理では得ることができない。
In the configuration of FIG. 5, filtering processing by the high-
そこで、図5の構成では、低周波数の操舵速度を得るために、操舵角度θhから得られる操舵速度sθh(第2の操舵速度)を演算する。そうして、操舵角度θhのみから得られる操舵速度sθhに対して、ローパスフィルタ22によるフィルタ処理を実施する。ローパスフィルタ22のカットオフ周波数は、ハイパスフィルタ21のカットオフ周波数と同じ値に設定されている。ローパスフィルタ22によるフィルタ処理により、カットオフ周波数以下の低周波数の操舵速度を得ることができる。
Therefore, in the configuration of FIG. 5, in order to obtain a low-frequency steering speed, a steering speed sθ h (second steering speed) obtained from the steering angle θ h is calculated. Thus, the filtering process by the low-
このように、ハイパスフィルタ21およびローパスフィルタ22のカットオフ周波数を同じ値に設定し、ハイパスフィルタ21およびローパスフィルタ22からの出力結果を、加算器23で足し合わせる。これにより、操舵角度の周波数がカットオフ周波数より大きい場合は、誘起電圧EEを用いた操舵速度を用い、一方、操舵角度の周波数がカットオフ周波数以下の場合は、操舵角度θhを用いた操舵速度を用いることで、オフセット誤差を含まない正確な操舵速度θhybridを得ることができる。
Thus, the cut-off frequencies of the high-
また、上記の式(4)は、下記の式(5)のように等価変換することが可能である。 Further, the above equation (4) can be equivalently transformed as the following equation (5).
これは、誘起電圧EEに基づく推定操舵速度θomegaと操舵角度θhを時定数Tで割った値との和(θomega+θh/T)に対し、ハイパスフィルタ26によるフィルタ処理を行って、最終的な操舵速度θhybridを得るものである。式(5)をブロック図に表すと図6となる。図6において、24は、操舵角度θhを時定数Tで除算する除算器である。25は、誘起電圧EEに基づく推定操舵速度θomegaと除算器24の出力とを加算する加算器である。26は、加算器25の出力に対し、フィルタ処理を行うハイパスフィルタである。Tはハイパスフィルタ22のカットオフ周波数の時定数であり、sはラプラス演算子である。ハイパスフィルタ26の伝達関数G1をG1=Ts/(Ts+1)する。
This is because the high-
式(4)では、誘起電圧EEによる推定速度θomegaにハイパスフィルタ21によるフィルタ処理を実施し、且つ、操舵角度θhから演算した操舵速度にローパスフィルタ22によるフィルタ処理を実施する必要があった。従って、図5に示す式(4)の構成では、フィルタ処理の演算を2回する必要があった。
In the equation (4), it is necessary to perform the filtering process by the high-
一方、図6に示す式(5)の構成では、1回のフィルタ処理で演算ができるようになり、演算負荷を軽減する効果がある。 On the other hand, in the configuration of the equation (5) shown in FIG. 6, the calculation can be performed by one filtering process, and the calculation load is reduced.
次に、本実施の形態2の効果を示す。 Next, the effect of the second embodiment will be described.
モータ6のブラシのドロップ電圧Ebは、接触部酸化膜および経年劣化などの影響で変化するため、誘起電圧EEは、それらの変化分をオフセット誤差として含んだものとなる。これにより、誘起電圧EEに基づく推定操舵速度θomegaも、オフセット誤差を含んだものとなるという従来の課題があった。 Since the drop voltage Eb of the brush of the motor 6 changes due to the influence of the contact portion oxide film and aging degradation, the induced voltage EE includes those changes as an offset error. Thus, there has been a conventional problem that the estimated steering speed θ omega based on the induced voltage EE also includes an offset error.
一方で、操舵角度センサ4によって検出した操舵角度は、分解能が粗い場合がある。操舵角度センサ4の分解能をθstepとし、速度演算周期をTstepとすると、操舵角度センサ4から演算できる操舵速度の分解能は、θstep/Tstepとなる。例えば、操舵角度センサ4の分解能θstepが1deg、速度演算周期Tstepが10msの場合、操舵速度分解能は100deg/sとなり、操舵速度の分解能としては粗くなる。操舵速度の分解能を細かくするためには、速度演算周期Tstepを大きく設定する、または、演算した操舵速度にローパスフィルタ処理を実施する対策が考えられるが、両者とも、操舵速度演算の応答が遅れてしまうという課題を生じる。
On the other hand, the steering angle detected by the
また、操舵角度センサ4によって検出した操舵角は、CANネットワークを経由して得られる情報であるため、更新周期が長くなる場合がある。その場合、速度演算周期Tstepが更新周期以上となり、操舵速度演算の応答が遅れてしまう。すなわち、速度演算の周波数帯域を高くすることができないという課題が生じる。よって、操舵角度センサ4から操舵速度を演算するときに、操舵速度の分解能を細かくする場合には、操舵速度演算の応答が遅れてしまい、逆に、操舵速度演算の応答性を高める場合には、操舵速度の分解能が粗くなるというトレードオフの課題が生じる。
Moreover, since the steering angle detected by the
本実施の形態2においては、操舵速度演算部12が、オフセット誤差を含んだ誘起電圧EEに基づく推定操舵速度θomegaから、ハイパスフィルタ21の効果から、オフセットを除去した周波数帯域の高い操舵速度を得ることができ、一方、操舵角度θhから、ローパスフィルタ22の効果から、オフセット誤差のない高分解能の操舵速度を得ることができる。その両者を用いることにより、高応答および高分解能で、且つ、オフセット誤差を抑えた操舵速度を得ることができる。
In the second embodiment, the steering
図7は、図5のハイパスフィルタ21およびローパスフィルタ22のカットオフ周波数の設定を0.3Hzとしたときの結果である。図7において、30が本実施の形態2による操舵速度のグラフで、31がオフセット誤差を含んだ誘起電圧に基づく操舵速度のグラフである。図7から、操舵速度0付近で、誘起電圧EEのオフセット影響を排除でき、且つ、低周波数領域についても良好な操舵速度演算結果が得られていることがわかる。
FIG. 7 shows the result when the setting of the cut-off frequency of the high-
以上のように、本実施の形態2においても、操舵速度に関する第1の情報を、操舵角に関する情報に基づいて補正して、操舵速度に関する第2の情報を取得するようにしたので、上記の実施の形態1と同様の効果が得られる。 As described above, also in the second embodiment, the first information regarding the steering speed is corrected based on the information regarding the steering angle, and the second information regarding the steering speed is acquired. The same effect as in the first embodiment can be obtained.
さらに、本実施の形態2(図5に示す実施形態)では、操舵角に関する情報から演算された操舵速度情報から抽出した周波数成分と、操舵速度に関する第1の情報から抽出した周波数成分とに基づいて、操舵速度に関する第2の情報を取得するようにしたので、高応答および高分解能で、且つ、オフセット誤差を抑えた操舵速度を得ることができる。具体的には、図5に示す実施形態では、操舵速度演算部12が、操舵角度センサ4で検出された操舵角度θhに基づいて、操舵系の操舵速度を第2の操舵速度として演算し、第2の操舵速度にローパスフィルタ処理を施した値を補正値として、誘起電圧EEに基づく推定操舵速度θomega(第1の操舵速度)にハイパスフィルタ処理を施した値に当該補正値を加算することにより、誘起電圧EEに基づく推定操舵速度θomega(操舵速度に関する第1の情報)を補正して、操舵系の操舵速度(操舵速度に関する第2の情報)として出力するようにした。これは、すなわち、オフセット誤差を含んだ誘起電圧EEに基づく推定操舵速度θomegaからオフセット誤差を除去した高周波数の操舵速度を得て、一方、操舵角度θhからオフセット誤差のない高分解能の低周波数の操舵速度を得ることとなり、このようにして、その両方の操舵速度を用いることにより、高応答および高分解能で、且つ、オフセット誤差を抑えた操舵速度を得ることができる。
Furthermore, in the second embodiment (the embodiment shown in FIG. 5), based on the frequency component extracted from the steering speed information calculated from the information on the steering angle and the frequency component extracted from the first information on the steering speed. Since the second information related to the steering speed is acquired, it is possible to obtain a steering speed with high response and high resolution and with reduced offset error. Specifically, in the embodiment illustrated in FIG. 5, the steering
また、本実施の形態2(図6に示す実施形態)では、操舵速度に関する第1の情報の低周波成分を、前記操舵角に関する情報に基づいて補正するようにしたので、高応答および高分解能で、且つ、オフセット誤差を抑えた操舵速度を得ることができる。具体的には、図6に示す実施形態では、操舵速度演算部12が、操舵角度センサ4で検出された操舵角度θhを時定数Tで除算した値(操舵角に関する情報)を補正値とし、誘起電圧EEに基づく推定操舵速度θomega(操舵速度に関する第1の情報)に当該補正値を加算した値にハイパスフィルタ処理を施した値を、操舵系の操舵速度(操舵速度に関する第2の情報)として出力するようにした。これは、すなわち、オフセット誤差を含んだ誘起電圧EEに基づく推定操舵速度θomegaからオフセット誤差を除去した高周波数の操舵速度を得て、一方、操舵角度θhからオフセット誤差のない高分解能の低周波数の操舵速度を得ることとなり、このようにして、その両方の操舵速度を用いることにより、高応答および高分解能で、且つ、オフセット誤差を抑えた操舵速度を得ることができる。
In the second embodiment (the embodiment shown in FIG. 6), since the low frequency component of the first information related to the steering speed is corrected based on the information related to the steering angle, high response and high resolution are achieved. In addition, a steering speed with reduced offset error can be obtained. Specifically, in the embodiment shown in FIG. 6, a value (information regarding the steering angle) obtained by dividing the steering angle θ h detected by the
実施の形態3.
本実施の形態3では、図8のフローチャートを用いて、制御ユニット11に設けられた操舵速度演算部12で実行される操舵速度の演算について、実施の形態2とは別の演算方法を説明する。すなわち、図8のフローチャートは、図3のフローチャートのステップS2の処理を詳細に示した図である。
In the third embodiment, a calculation method different from that of the second embodiment will be described with respect to the calculation of the steering speed executed by the steering
本実施の形態3において、上記実施の形態1,2と共通する構成については、同一の符号を用いることとし、以下では、実施の形態1,2と異なる点について主に説明する。本実施の形態3においては、操舵角度の変化が小さいときの誘起電圧から得られる操舵速度を補正値としてメモリに記憶しておき、誘起電圧EEに基づく推定操舵速度θomegaを、当該補正値を用いて補正する構成である。 In the third embodiment, the same reference numerals are used for the configurations common to the first and second embodiments, and the differences from the first and second embodiments will be mainly described below. In the third embodiment, the steering speed obtained from the induced voltage when the change in the steering angle is small is stored in the memory as a correction value, and the estimated steering speed θ omega based on the induced voltage EE is set as the correction value. It is the structure corrected using.
図8は、本実施の形態3に係る制御ユニット11の操舵速度演算部12の動作を示したフローチャートである。実施の形態2で示した図4のフローチャートとの相違点は、図8において、ステップS21とステップS22とが追加され、図4のステップS14の代わりに図8のステップS23が設けられている点である。
FIG. 8 is a flowchart showing the operation of the steering
本実施の形態3においては、まず、ステップS21で、制御ユニット11は、操舵角度センサ4から得られる操舵角度の変化が小さいと判断できたときに、誘起電圧EEに基づく推定操舵速度θomegaを求め、それを、補正値θrefとしてメモリ28(図9参照)に記憶する。当該補正値θrefについて、以下に説明する。
In the third embodiment, first, in step S21, when the
制御ユニット11は、操舵角度センサ4から得られる操舵角度θhの変化量が閾値より小さいと判断できるとき、すなわち、操舵速度θhが0付近の領域内である(−ε<θh<ε、εは任意の数)と判断したときに、そのときの誘起電圧EEに基づく推定操舵速度θomegaを求める。演算方法は、実施の形態2で示した演算方法と同じである。このときの推定操舵速度θomegaは、実際の操舵速度0からのオフセット誤差とみなすことができる。従って、制御ユニット11は、この推定操舵速度θomegaを、操舵速度の補正値θrefとしてメモリ28に記憶する。
When the
次に、操舵速度演算部12は、ステップS11〜S13の処理を行い、誘起電圧EEに基づく推定操舵速度θomegaを求める。ステップS11〜S13の処理は、実施の形態2で説明した処理と同じであるため、ここではその説明を省略する。
Next, the steering
次に、ステップS22で、操舵速度演算部12は、ステップS21でメモリ28に記憶した操舵速度の補正値θrefを、メモリ28から読み出す。
Next, in step S <b> 22, the steering
次に、操舵速度演算部12は、ステップS23で、メモリ28に記憶された操舵速度の補正値θrefを用いて、ステップS13で求めた推定操舵速度θomegaを補正する。図9に、その構成を示す。図9において、27は、誘起電圧EEに基づく推定操舵速度θomegaが入力されるハイパスフィルタである。28は、操舵速度の補正値θrefが記憶されるメモリである。29は、ハイパスフィルタ27からの出力から、メモリ28から読み出した操舵速度の補正値θrefを減算する加算器である。
Next, in step S23, the steering
以上のように、本実施の形態3においては、制御ユニット11が、操舵角度センサ4から得られる操舵角度の変化が小さいときの誘起電圧から得られる操舵速度を、オフセット誤差としてみなし、予め、メモリ28に記憶する。そうして、メモリ28に記憶した補正用の操舵速度θrefを用いて、誘起電圧EEに基づく操舵速度θomegaを補正する。これにより、オフセット誤差を排除でき、かつ、実施の形態2と同様に、高分解能および高応答で、オフセット誤差を抑えた、正確な操舵速度を得ることができる。
As described above, in the third embodiment, the
なお、上記の説明においては、操舵速度の補正値θrefとして、操舵角度θhの変化が小さいと判断したときの推定操舵速度を用いると説明した。
しかしながら、この場合に限らず、操舵制御装置のシステム起動時で、運転者による操舵がなされる前の、操舵速度0のときの誘起電圧EEに基づく操舵速度θomegaを、操舵速度の補正値θrefとして用いるようにしてもよい。
また、車輪速センサおよびヨーレートセンサなどの検出値を用いて、操舵角度θhの変化が小さいか否かを判定してもよい。車輪速センサを用いる場合は、前後輪の車輪速を比較し、その差異が小さいときに、車両が直進している状態であると判定できる。直進状態が継続するときは、操舵角度が0の状態を継続していると判断できるので、操舵速度0として判断できる。また、ヨーレートセンサを用いる場合には、車速およびヨーレートの変化を併せて用いることで、車両の旋回状態に変化がないことが判断でき、保舵状態つまり操舵角度に変化がないことを判断でき、操舵速度0と判定できる。
In the above description, as the correction value theta ref of the steering speed has been described as using the estimated steering speed when it is determined that a small change in the steering angle theta h.
However, the present invention is not limited to this, and the steering speed θ omega based on the induced voltage EE at the
Further, by using the detection value, such as wheel speed sensors and a yaw rate sensor may determine whether the change in the steering angle theta h is small. When the wheel speed sensor is used, the wheel speeds of the front and rear wheels are compared, and when the difference is small, it can be determined that the vehicle is traveling straight. When the straight traveling state continues, it can be determined that the state where the steering angle is 0 is continued, so that the steering speed can be determined as 0. Further, when using the yaw rate sensor, it is possible to determine that there is no change in the turning state of the vehicle by using the change in the vehicle speed and the yaw rate, and it is possible to determine that the steering state, that is, the steering angle is not changed, It can be determined that the steering speed is zero.
以上のようにして、本実施の形態3においても、操舵速度に関する第1の情報を、操舵角に関する情報に基づいて補正して、操舵速度に関する第2の情報を取得するようにしたので、上記の実施の形態1と同様の効果が得られる。 As described above, also in the third embodiment, the first information regarding the steering speed is corrected based on the information regarding the steering angle, and the second information regarding the steering speed is acquired. The same effect as in the first embodiment can be obtained.
さらに、本実施の形態3においては、操舵角に関する情報の変化量が閾値より小さいときの操舵速度に関する第1の情報を補正値(操舵角に関する情報)として予め記憶しておき、操舵速度情報取得部で取得した操舵速度に関する第1の情報を、当該補正値(操舵角に関する情報)に基づいて補正し、操舵速度に関する第2の情報を取得するようにしたので、実施の形態2と同様の効果が得られる。 Further, in the third embodiment, the first information regarding the steering speed when the change amount of the information regarding the steering angle is smaller than the threshold value is stored in advance as a correction value (information regarding the steering angle), and the steering speed information is acquired. Since the first information related to the steering speed acquired by the unit is corrected based on the correction value (information related to the steering angle) and the second information related to the steering speed is acquired, the same as in the second embodiment An effect is obtained.
具体的には、上記の実施形態では、操舵角度センサ4で検出される操舵角度の変化量が閾値より小さいか否かを判定し、当該変化量が閾値より小さい場合に、操舵速度演算部12が演算したそのときの操舵系の操舵速度を補正値θrefとして予め記憶しておき、操舵角度の変化量が閾値より大きいときの誘起電圧EEに基づく推定操舵速度θomega(第1の操舵速度)から当該補正値を減算することにより、第1の操舵速度を補正して、操舵系の操舵速度として出力するようにした。すなわち、本実施の形態3では、操舵速度が0付近であることを判定し、そのときの誘起電圧に基づく推定操舵速度θomegaを、補正値θrefとしてメモリ28に記憶し、それを用いて、操舵速度が0付近でないときの誘起電圧EEに基づく推定操舵速度θomegaを補正することで、実施の形態2と同様の効果が得られる。
Specifically, in the above-described embodiment, it is determined whether or not the amount of change in the steering angle detected by the
1 ハンドル、2 ステアリング軸、3 転舵輪、4 操舵角度センサ、5 トルクセンサ、6 モータ、7 減速機構、8 車速センサ、9 電流センサ、10 電圧センサ、11 制御ユニット、12 操舵速度演算部、13 保舵判定部、14 目標操舵速度設定部、15 第1の操舵補助トルク演算部、16 操舵状態判定部、17 第2の操舵補助トルク演算部、18 加算部、19 電流駆動器。 1 steering wheel, 2 steering shaft, 3 steered wheels, 4 steering angle sensor, 5 torque sensor, 6 motor, 7 deceleration mechanism, 8 vehicle speed sensor, 9 current sensor, 10 voltage sensor, 11 control unit, 12 steering speed calculation unit, 13 Steering hold determination unit, 14 Target steering speed setting unit, 15 First steering assist torque calculation unit, 16 Steering state determination unit, 17 Second steering assist torque calculation unit, 18 Addition unit, 19 Current driver.
Claims (5)
前記操舵系の操舵角を検出する操舵角情報取得部と、
前記モータの誘起電圧から操舵速度を推定して、推定操舵速度として出力する操舵速度情報取得部と、
前記操舵角情報取得部で検出した前記操舵角から操舵速度を求め、当該操舵速度にローパスフィルタ処理を施した値を補正値として、前記操舵速度情報取得部で取得した前記推定操舵速度にハイパスフィルタ処理を施して取得した前記推定操舵速度の低周波成分を、前記補正値を加算することで補正し、前記操舵系の操舵速度として出力する補正部と
を備えた操舵制御装置。 A motor for applying steering assist torque to the steering system of the vehicle;
A steering angle information acquisition unit for detecting a steering angle of the steering system;
A steering speed information acquisition unit that estimates a steering speed from the induced voltage of the motor and outputs the estimated steering speed ;
Wherein from the steering angle detected by the steering angle information acquiring unit obtains a steering speed, a high-pass filter value obtained by performing a low-pass filter process on the steering speed as the correction value, the estimated steering speed obtained by the steering speed information obtaining unit A steering control device comprising: a correction unit that corrects a low-frequency component of the estimated steering speed obtained by performing processing by adding the correction value and outputs the corrected low-frequency component as a steering speed of the steering system.
前記操舵系の操舵角を検出する操舵角情報取得部と、
前記モータの誘起電圧から操舵速度を推定して、推定操舵速度として出力する操舵速度情報取得部と、
前記操舵角情報取得部で取得した前記操舵角を時定数で除算した値を補正値として、前記操舵速度情報取得部で取得した前記推定操舵速度に前記補正値を加算して補正した値にハイパスフィルタ処理を施した値を前記操舵系の操舵速度として出力する補正部と
を備えた操舵制御装置。 A motor for applying steering assist torque to the steering system of the vehicle;
A steering angle information acquisition unit for detecting a steering angle of the steering system;
A steering speed information acquisition unit that estimates a steering speed from the induced voltage of the motor and outputs the estimated steering speed ;
The value obtained by dividing the steering angle acquired by the steering angle information acquisition unit by a time constant is used as a correction value, and the correction value is added to the estimated steering speed acquired by the steering speed information acquisition unit to correct the value. A steering control device comprising: a correction unit that outputs a value subjected to filter processing as a steering speed of the steering system.
請求項1または2に記載の操舵制御装置。 The first steering assist torque calculation unit that calculates the steering assist torque based on a deviation between a steering speed of the steering system and a target steering speed output from the correction unit. Steering control device.
前記車両の操舵系に操舵補助トルクを付与するモータの誘起電圧からモータ回転速度を求め、当該モータ回転速度から操舵速度を推定して、推定操舵速度として出力する操舵速度情報取得ステップと、
前記操舵角情報取得ステップで検出した前記操舵角から操舵速度を求め、当該操舵速度にローパスフィルタ処理を施した値を補正値として、前記操舵速度情報取得ステップで取得した前記推定操舵速度にハイパスフィルタ処理を施して取得した前記推定操舵速度の低周波成分を、前記補正値を加算することで補正し、前記操舵系の操舵速度として出力する補正ステップと
を備えた操舵速度検出方法。 A steering angle information acquisition step of detecting a steering angle of a steering system of the vehicle using a steering angle sensor ;
Steering speed information acquisition step of obtaining a motor rotation speed from an induced voltage of a motor that applies a steering assist torque to the steering system of the vehicle, estimating a steering speed from the motor rotation speed, and outputting the estimated steering speed ;
Wherein from the steering angle detected by the steering angle information acquiring step obtains a steering speed, a high-pass filter value obtained by performing a low-pass filter process on the steering speed as the correction value, the estimated steering speed obtained by the steering speed information obtaining step A correction method of correcting a low frequency component of the estimated steering speed obtained by performing processing by adding the correction value and outputting the corrected low-frequency component as a steering speed of the steering system.
前記車両の操舵系に設けられ前記操舵系に操舵補助トルクを付与するモータの誘起電圧からモータ回転速度を求め、当該モータ回転速度から操舵速度を推定して、推定操舵速度として出力する操舵速度情報取得ステップと、
前記操舵角情報取得ステップで検出した前記操舵角を時定数で除算した値を補正値として、前記操舵速度情報取得ステップで取得した前記推定操舵速度に前記補正値を加算して補正した値にハイパスフィルタ処理を施した値を前記操舵系の操舵速度として出力する補正ステップと
を備えた操舵速度検出方法。 A steering angle information acquisition step of detecting a steering angle of a steering system of the vehicle using a steering angle sensor ;
Steering speed information for obtaining a motor rotation speed from an induced voltage of a motor provided in the steering system of the vehicle and applying a steering assist torque to the steering system, estimating the steering speed from the motor rotation speed, and outputting the estimated steering speed. An acquisition step;
A value obtained by dividing the steering angle detected in the steering angle information acquisition step by a time constant is used as a correction value, and the correction value is added to the estimated steering speed acquired in the steering speed information acquisition step to correct the value. A steering speed detection method comprising: a correction step of outputting a value subjected to filter processing as a steering speed of the steering system .
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2013110812A JP5746264B2 (en) | 2013-05-27 | 2013-05-27 | Steering control device and steering speed detection method |
CN201410035113.5A CN104176114B (en) | 2013-05-27 | 2014-01-24 | Steering control device and steering speed detection method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2013110812A JP5746264B2 (en) | 2013-05-27 | 2013-05-27 | Steering control device and steering speed detection method |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2014227143A JP2014227143A (en) | 2014-12-08 |
JP5746264B2 true JP5746264B2 (en) | 2015-07-08 |
Family
ID=51957546
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2013110812A Expired - Fee Related JP5746264B2 (en) | 2013-05-27 | 2013-05-27 | Steering control device and steering speed detection method |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP5746264B2 (en) |
CN (1) | CN104176114B (en) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102354755B1 (en) * | 2015-12-14 | 2022-01-25 | 현대모비스 주식회사 | Apparatus and method of compensating steering angle signal and motor angle signal of mdps system |
JP6873362B2 (en) * | 2016-12-16 | 2021-05-19 | 日立Astemo株式会社 | Electric power steering device |
CN106685302B (en) * | 2017-01-17 | 2019-01-29 | 株洲易力达机电有限公司 | A kind of Hall-type position sensor decoding algorithm and EPS controller |
CN110650885B (en) * | 2017-05-18 | 2022-02-15 | 三菱电机株式会社 | Electric power steering apparatus and control method of electric power steering |
US10272944B2 (en) * | 2017-07-26 | 2019-04-30 | GM Global Technology Operations LLC | Steering systems and methods for generating haptic feel torque |
KR101981480B1 (en) * | 2017-12-07 | 2019-05-23 | 현대모비스 주식회사 | Apparatus and method for controlling of mdps system |
US11738802B2 (en) * | 2018-12-20 | 2023-08-29 | Hl Mando Corporation | Steering control system and control method thereof |
CN110109464B (en) * | 2019-05-29 | 2022-10-04 | 江苏盛海智能科技有限公司 | Steering speed control method and control end of unmanned vehicle |
CN113022600B (en) * | 2021-03-09 | 2022-04-22 | 中国煤炭科工集团太原研究院有限公司 | Shuttle vehicle differential control method and device based on current and vehicle |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2001171533A (en) * | 1999-12-20 | 2001-06-26 | Toyoda Mach Works Ltd | Motor-driven power steering device |
JP3603736B2 (en) * | 2000-03-29 | 2004-12-22 | 三菱電機株式会社 | Electric power steering control device |
JP2001278082A (en) * | 2000-04-04 | 2001-10-10 | Honda Motor Co Ltd | Motor-driven power steering device |
JP3527469B2 (en) * | 2000-09-07 | 2004-05-17 | 三菱電機株式会社 | Electric power steering device |
JP4227133B2 (en) * | 2005-10-18 | 2009-02-18 | 三菱電機株式会社 | Electric power steering control device |
JP4553862B2 (en) * | 2006-03-31 | 2010-09-29 | 三菱電機株式会社 | Vehicle steering system |
JP4391534B2 (en) * | 2007-02-13 | 2009-12-24 | 三菱電機株式会社 | Vehicle steering system |
JP5151181B2 (en) * | 2007-02-28 | 2013-02-27 | 日本精工株式会社 | Control device for electric power steering device |
JP5265415B2 (en) * | 2009-03-05 | 2013-08-14 | 株式会社ショーワ | Electric power steering apparatus, rotation speed estimation apparatus, and rotation speed estimation method |
-
2013
- 2013-05-27 JP JP2013110812A patent/JP5746264B2/en not_active Expired - Fee Related
-
2014
- 2014-01-24 CN CN201410035113.5A patent/CN104176114B/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP2014227143A (en) | 2014-12-08 |
CN104176114A (en) | 2014-12-03 |
CN104176114B (en) | 2017-04-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5746264B2 (en) | Steering control device and steering speed detection method | |
JP6299415B2 (en) | Steering device | |
US9914473B2 (en) | Electric power steering system | |
US9002579B2 (en) | Steering assist device | |
JP6187042B2 (en) | Electric power steering device | |
JP4852964B2 (en) | Control device for electric power steering device | |
WO2014136516A1 (en) | Electric power steering device | |
US20140005894A1 (en) | Electric power steering apparatus | |
JP5313729B2 (en) | Electric power steering device | |
JP4999984B2 (en) | Electric power steering control device | |
JP2018183046A (en) | Motor control device | |
CN107776656B (en) | Vehicle control device | |
EP3056410B1 (en) | Drive assist control apparatus | |
US8838340B2 (en) | Electric power steering system | |
JP2015013583A (en) | Electric power steering device | |
JP2005088806A (en) | Steering control device | |
JP6058221B2 (en) | Steering control device | |
JP2009137442A (en) | Vehicular power steering device | |
JP5234025B2 (en) | Electric power steering device | |
JP2005001481A (en) | Electric power steering device | |
JP2008254558A (en) | Vehicular steering device | |
JP4840232B2 (en) | Vehicle steering control device | |
JP2013082424A (en) | Electric power steering device | |
JP2008018865A (en) | Electric power steering device | |
JP2010030431A (en) | Control device for electric power steering device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20140909 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20141030 |
|
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: 20150407 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20150507 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 5746264 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
LAPS | Cancellation because of no payment of annual fees |