JP2007333657A - Steering angle detector - Google Patents
Steering angle detector Download PDFInfo
- Publication number
- JP2007333657A JP2007333657A JP2006168231A JP2006168231A JP2007333657A JP 2007333657 A JP2007333657 A JP 2007333657A JP 2006168231 A JP2006168231 A JP 2006168231A JP 2006168231 A JP2006168231 A JP 2006168231A JP 2007333657 A JP2007333657 A JP 2007333657A
- Authority
- JP
- Japan
- Prior art keywords
- steering
- angle
- absolute
- resolver sensor
- resolver
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Landscapes
- Measurement Of Length, Angles, Or The Like Using Electric Or Magnetic Means (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Power Steering Mechanism (AREA)
Abstract
Description
本発明は、レゾルバセンサを用いて操舵部材の絶対角度を検出する操舵角検出装置に関する。 The present invention relates to a steering angle detection device that detects an absolute angle of a steering member using a resolver sensor.
従来から、レゾルバセンサを用いて車両の操舵軸の絶対角度(絶対舵角)を検出する技術が知られている。例えば、特許文献1に提案された車両用操舵装置は、操舵軸に設けられる一対のレゾルバセンサと、イグニッションキーが抜かれたとき操舵軸回りに等間隔で設けられたロック位置で操舵軸の回転を規制するロック機構とを備える。また、操舵軸の絶対角度を検出するために、一対のレゾルバセンサの出力信号の軸倍角をそれぞれm×,n×(m>n)に設定するとともに、操舵軸回りのロック位置の数Nを、(m−n)≦Nという関係に設定している。
Conventionally, a technique for detecting an absolute angle (absolute rudder angle) of a steering shaft of a vehicle using a resolver sensor is known. For example, in the vehicle steering device proposed in
この構成においては、一対のレゾルバセンサの出力信号の差をとることにより、操舵軸が360°/(m−n)回転するごとに繰り返される周期波形信号を得ることができる。この場合、イグニッションキーが抜かれて操舵軸がロック機構により回転規制される状況においては、この周期波形信号の出力は、操舵軸が回転できる規制角度領域内の異なる角度において同一レベルの値にはならない。
従って、イグニッションキーが抜かれた時点の操舵軸の絶対角度を記憶しておくことにより、次回の車両運転時に、この記憶した絶対角度と現時点における操舵軸の回転角度位置との関係から操舵軸の絶対角度を検出できる。
In this configuration, by taking the difference between the output signals of the pair of resolver sensors, it is possible to obtain a periodic waveform signal that is repeated every time the steering shaft rotates 360 ° / (mn). In this case, in a situation where the ignition key is removed and the steering shaft is restricted from rotation by the lock mechanism, the output of the periodic waveform signal does not become the same level value at different angles within the restriction angle region where the steering shaft can rotate. .
Therefore, by storing the absolute angle of the steering shaft at the time when the ignition key is removed, the absolute value of the steering shaft is calculated from the relationship between the stored absolute angle and the current rotational angle position of the steering shaft at the next vehicle operation. The angle can be detected.
また、特許文献2には、操舵軸の中立位置を舵角センサに記憶させ、この中立位置を基準にした回転角を舵角センサにより測定することで操舵角を検出する舵角検出装置が提案されている。この装置においては、ステアリング組み付け工程において中立位置を舵角センサに記憶させるが、その記憶させる中立位置がずれてしまうことがある。そこで、電動パワーステアリング装置に使用される電動モータの1回転以内の絶対回転角に基づいて中立位置のずれを検出し、正しい中立位置に更新記憶するようにしている。
しかしながら、特許文献1の装置においては、ロック機構が複雑になってしまう。また、イグニッションキーが抜かれた時点の操舵角を記憶しておく必要がある。このため、電源バッテリを外した場合においても記憶保持できる構成を備えなければならない。
また、特許文献2の装置においては、組み付け工程において中立位置を正確に記憶させる必要があり、製造工数が多くなってしまう。また、中立位置のずれ補正といった処理も必要となってくる。
However, in the apparatus of
Moreover, in the apparatus of patent document 2, it is necessary to memorize | store a neutral position correctly in an assembly | attachment process, and a manufacturing man-hour will increase. In addition, processing such as neutral position deviation correction is required.
本発明は、上記問題に対処するためになされたもので、操舵軸の絶対角や中立位置を記憶する必要がない操舵角検出装置を提供することを目的とする。 The present invention has been made to address the above problems, and an object thereof is to provide a steering angle detection device that does not need to store the absolute angle or neutral position of the steering shaft.
上記目的を達成するために、本発明の特徴は、左操舵限界位置から右操舵限界位置まで操舵部材が操舵されるとn回の周期波形信号を出力する第1レゾルバセンサと、左操舵限界位置から右操舵限界位置まで操舵部材が操舵されると(n+1)回の周期波形信号を出力する第2レゾルバセンサと、左操舵限界位置から右操舵限界位置まで操舵部材が操舵されると(n+2)回の周期波形信号を出力する第3レゾルバセンサと、上記第1レゾルバセンサの信号出力値と上記第2レゾルバセンサの信号出力値との差、あるいは、上記第2レゾルバセンサの信号出力値と上記第3レゾルバセンサの信号出力値との差に基づいて、上記左操舵限界位置から右操舵限界位置までの操舵可能範囲において操舵角の変化に対して1つのピーク値が現れる特性を有する第1電気角を算出する第1電気角算出手段と、上記第1レゾルバセンサの信号出力値と上記第3レゾルバセンサの信号出力値との差に基づいて、上記左操舵限界位置から右操舵限界位置までの操舵可能範囲において操舵角の変化に対して2つのピーク値が現れる特性を有する第2電気角を算出する第2電気角算出手段と、上記第1電気角算出手段により算出された第1電気角と、上記第2電気角算出手段により算出された第2電気角とに基づいて、上記操舵部材の中立位置と絶対舵角とを算出する絶対舵角算出手段とを備えたことにある。 In order to achieve the above object, the present invention is characterized in that a first resolver sensor that outputs a periodic waveform signal n times when a steering member is steered from a left steering limit position to a right steering limit position, and a left steering limit position When the steering member is steered from the right steering limit position to the right steering limit position, the second resolver sensor that outputs (n + 1) periodic waveform signals and when the steering member is steered from the left steering limit position to the right steering limit position (n + 2) A third resolver sensor that outputs a periodic waveform signal, and a difference between a signal output value of the first resolver sensor and a signal output value of the second resolver sensor, or a signal output value of the second resolver sensor and the above Based on the difference from the signal output value of the third resolver sensor, a characteristic in which one peak value appears with respect to the change of the steering angle in the steerable range from the left steering limit position to the right steering limit position. Based on the difference between the signal output value of the first resolver sensor and the signal output value of the third resolver sensor based on the first electrical angle calculation means for calculating the first electrical angle, and the right steering from the left steering limit position. Calculated by a second electrical angle calculating means for calculating a second electrical angle having a characteristic in which two peak values appear with respect to a change in the steering angle in a steerable range up to the limit position, and calculated by the first electrical angle calculating means. Absolute steering angle calculating means for calculating a neutral position and an absolute steering angle of the steering member based on the first electrical angle and the second electrical angle calculated by the second electrical angle calculating means; It is in.
この発明によれば、操舵部材が左操舵限界位置から右操舵限界位置まで操舵されると、第1レゾルバセンサはn回の周期波形信号を、第2レゾルバセンサは(n+1)回の周期波形信号を、第3レゾルバセンサは(n+2)回の周期波形信号を出力する。従って、第1レゾルバセンサの信号出力値と第2レゾルバセンサの信号出力値との差、あるいは、第2レゾルバセンサの信号出力値と第3レゾルバセンサの信号出力値との差を求めることにより、左操舵限界位置から右操舵限界位置までの操舵可能範囲において操舵角の変化に対して周期性を有しない1つのピーク値が現れる特性を有する電気角を得ることができる。第1電気角算出手段は、この電気角を第1電気角として算出する。 According to this invention, when the steering member is steered from the left steering limit position to the right steering limit position, the first resolver sensor generates n periodic waveform signals, and the second resolver sensor outputs (n + 1) periodic waveform signals. The third resolver sensor outputs (n + 2) number of periodic waveform signals. Therefore, by calculating the difference between the signal output value of the first resolver sensor and the signal output value of the second resolver sensor, or the difference between the signal output value of the second resolver sensor and the signal output value of the third resolver sensor, In the steerable range from the left steering limit position to the right steering limit position, it is possible to obtain an electrical angle having a characteristic in which one peak value having no periodicity appears with respect to a change in the steering angle. The first electrical angle calculation means calculates this electrical angle as the first electrical angle.
また、第1レゾルバセンサの信号出力値と上記第3レゾルバセンサの信号出力値との差を求めることにより、左操舵限界位置から右操舵限界位置までの操舵可能範囲において操舵角の変化に対して2つのピーク値が現れる特性を有する電気角を得ることができる。第2電気角算出手段は、この電気角を第2電気角として算出する。
そして、絶対舵角算出手段は、第1電気角算出手段により算出された第1電気角と、第2電気角算出手段により算出された第2電気角とに基づいて、操舵部材の中立位置と絶対舵角とを算出する。
Further, by obtaining the difference between the signal output value of the first resolver sensor and the signal output value of the third resolver sensor, the change in the steering angle in the steerable range from the left steering limit position to the right steering limit position is detected. An electrical angle having a characteristic in which two peak values appear can be obtained. The second electrical angle calculation means calculates this electrical angle as the second electrical angle.
The absolute rudder angle calculating means calculates the neutral position of the steering member based on the first electric angle calculated by the first electric angle calculating means and the second electric angle calculated by the second electric angle calculating means. The absolute rudder angle is calculated.
第2電気角算出手段で算出される第2電気角は、操舵可能範囲において操舵角の変化に対して2周期分の周期波形信号として現れる。従って、その周期波形信号の境界(1周期目と2周期目との境界)を算出することで操舵部材の中立位置を求めることができる。例えば、第2電気角を、操舵角の変化に対して鋸歯形状に変化する周期波形信号として出力させた場合には、その鋸歯形状信号における三角形頂点の通過を検出したときに操舵部材が中立位置に存在すると判断することができる。
従って、中立位置の検出を正確に簡単に行うことができる。また、操舵部材の操舵中に中立位置を検出することができるため、製造工程において中立位置を記憶させる必要がなく、製造工数を低減することができる。
The second electrical angle calculated by the second electrical angle calculation means appears as a periodic waveform signal for two cycles with respect to the change in the steering angle within the steerable range. Therefore, the neutral position of the steering member can be obtained by calculating the boundary of the periodic waveform signal (the boundary between the first period and the second period). For example, when the second electrical angle is output as a periodic waveform signal that changes in a sawtooth shape with respect to a change in the steering angle, the steering member is in a neutral position when the passage of a triangular vertex in the sawtooth shape signal is detected. Can be determined to exist.
Therefore, the neutral position can be detected accurately and simply. Further, since the neutral position can be detected during the steering of the steering member, it is not necessary to store the neutral position in the manufacturing process, and the number of manufacturing steps can be reduced.
一方、第1電気角算出手段で算出される第1電気角は、レゾルバセンサの出力する周期波形信号の位相差により、周期性を有することなく変化し、操舵可能範囲にわたって操舵部材の位置(絶対舵角)と一対一に対応する値となる。
従って、第1電気角により操舵部材の絶対舵角を算出することができる。この場合、例えば、第1電気角と第2電気角とを組み合わせて絶対舵角をさらに精度良く検出することもできる。
第2電気角は、中立位置より右操舵側の右操舵領域と左操舵側の左操舵領域との2つの領域において、それぞれ1周期分の周期波形信号を出力するため、第1電気角に比べて操舵角の変化に対する出力変化が大きい。また、この第2電気角の値は、2つの操舵領域において操舵部材の位置(絶対舵角)と一対一に対応する。従って、第1電気角に基づいて操舵領域を特定し、この特定された操舵領域における第2電気角の値から絶対舵角を検出することで検出精度を向上できる。
また、絶対舵角の算出は、操舵部材の操舵中に行うため、次回の運転走行まで絶対舵角を記憶する必要がない。従って、記憶装置の暗電流の消費を低減することができる。
On the other hand, the first electrical angle calculated by the first electrical angle calculation means changes without periodicity due to the phase difference of the periodic waveform signal output from the resolver sensor, and the position of the steering member (absolutely over the steerable range). (Steering angle) and a one-to-one value.
Therefore, the absolute steering angle of the steering member can be calculated from the first electrical angle. In this case, for example, the absolute steering angle can be detected with higher accuracy by combining the first electrical angle and the second electrical angle.
Since the second electrical angle outputs a periodic waveform signal for one cycle in each of the two regions of the right steering region on the right steering side and the left steering region on the left steering side from the neutral position, the second electrical angle is compared with the first electrical angle. The output change with respect to the change of the steering angle is large. The value of the second electrical angle corresponds to the position of the steering member (absolute steering angle) on a one-to-one basis in the two steering regions. Therefore, the detection accuracy can be improved by specifying the steering region based on the first electrical angle and detecting the absolute steering angle from the value of the second electrical angle in the specified steering region.
Further, since the absolute rudder angle is calculated during the steering of the steering member, it is not necessary to store the absolute rudder angle until the next driving run. Accordingly, the consumption of dark current of the storage device can be reduced.
本発明の他の特徴は、上記絶対舵角算出手段は、上記第1電気角の値が零でなく、かつ、上記第2電気角の値が零となったとき、上記操舵ハンドルが中立位置にあると判定することにある。 Another feature of the present invention is that the absolute steering angle calculating means is configured such that when the value of the first electrical angle is not zero and the value of the second electrical angle is zero, the steering wheel is in a neutral position. It is to be determined that there is.
第2電気角は、第1レゾルバセンサの信号出力値と第3レゾルバセンサの信号出力値との差に基づいて算出されるが、この2つの信号出力値は、操舵可能範囲における中立位置において同一値となる。この2つの信号出力値は、中立位置以外にも操舵限界角度位置において同一となる。そこで、第1電気角の値が零でなく、かつ、第2電気角の値が零になったことを検出することで、操舵部材の中立位置を高精度でしかも簡単に求めることができる。 The second electrical angle is calculated based on the difference between the signal output value of the first resolver sensor and the signal output value of the third resolver sensor. The two signal output values are the same at the neutral position in the steerable range. Value. These two signal output values are the same at the steering limit angle position in addition to the neutral position. Therefore, by detecting that the value of the first electrical angle is not zero and the value of the second electrical angle is zero, the neutral position of the steering member can be easily obtained with high accuracy.
本発明の他の特徴は、上記絶対舵角算出手段は、上記第1電気角と上記第2電気角との大小関係に基づいて上記操舵部材の操舵位置が右操舵領域にあるいか左操舵領域にあるかを判定し、その領域判定結果と上記第2電気角の値とに基づいて上記絶対舵角を算出することにある。 Another feature of the present invention is that the absolute rudder angle calculating means determines whether the steering position of the steering member is in the right steering area based on the magnitude relationship between the first electric angle and the second electric angle. And determining the absolute steering angle based on the region determination result and the value of the second electrical angle.
第2電気角は、中立位置より右操舵側の右操舵領域と左操舵側の左操舵領域との2つの領域において、操舵部材の位置(絶対舵角)と一対一に対応する値をとり、第1電気角に比べて操舵角の変化に対する出力変化が大きい。従って、操舵部材の操舵領域が分かれば、この第2電気角の値から精度の高い絶対舵角を算出することができる。一方、第1電気角と第2電気角とは、左右の操舵領域によってその大小関係が異なる。
そこで、絶対舵角算出手段は、第1電気角と第2電気角との大小関係に基づいて操舵部材の位置する操舵領域を判定し、この判定された操舵領域における第2電気角の値から絶対舵角を算出する。この結果、絶対舵角を高精度に算出することができる。
The second electrical angle takes a value corresponding to the position of the steering member (absolute rudder angle) on a one-to-one basis in the two regions of the right steering region on the right steering side and the left steering region on the left steering side from the neutral position. The output change with respect to the change of the steering angle is larger than that of the first electrical angle. Therefore, if the steering area of the steering member is known, a highly accurate absolute steering angle can be calculated from the value of the second electrical angle. On the other hand, the magnitude relationship between the first electrical angle and the second electrical angle differs depending on the left and right steering areas.
Therefore, the absolute rudder angle calculating means determines the steering region where the steering member is located based on the magnitude relationship between the first electrical angle and the second electrical angle, and from the value of the second electrical angle in the determined steering region. Calculate the absolute rudder angle. As a result, the absolute steering angle can be calculated with high accuracy.
本発明の他の特徴は、上記第1レゾルバセンサと第2レゾルバセンサと第3レゾルバセンサの異常を検出する異常検出手段と、上記3つのレゾルバセンサのうち1つのレゾルバセンサの異常が検出されたとき、異常が検出されていない2つのレゾルバセンサの信号出力値の差に基づいて、上記操舵部材の絶対舵角を算出する異常時絶対舵角算出手段とを備えたことにある。 Another feature of the present invention is that abnormality detection means for detecting an abnormality in the first resolver sensor, the second resolver sensor, and the third resolver sensor, and an abnormality in one resolver sensor among the three resolver sensors are detected. In some cases, there is provided an abnormal-time absolute rudder angle calculating means for calculating an absolute rudder angle of the steering member based on a difference between signal output values of two resolver sensors in which no abnormality is detected.
これによれば、1つのレゾルバセンサが故障しても、他のレゾルバセンサにより操舵部材の絶対舵角を算出するため車両の安全性が向上する。 According to this, even if one resolver sensor fails, the absolute steering angle of the steering member is calculated by the other resolver sensor, so that the safety of the vehicle is improved.
本発明の他の特徴は、異常時絶対舵角算出手段は、上記第2レゾルバセンサの異常が検出されたとき、上記第2電気角算出手段により算出される第2電気角の推移に基づいて、上記操舵部材の操舵位置が右操舵領域にあるいか左操舵領域にあるかを判定し、その領域判定結果と上記第2電気角の値とに基づいて上記操舵角を算出することにある。 Another feature of the present invention is that the abnormal absolute steering angle calculation means is based on the transition of the second electrical angle calculated by the second electrical angle calculation means when an abnormality of the second resolver sensor is detected. Then, it is determined whether the steering position of the steering member is in the right steering region or the left steering region, and the steering angle is calculated based on the region determination result and the value of the second electrical angle.
第2レゾルバセンサの異常時においては、第1電気角を算出することができないため、第2電気角のみにより絶対舵角を算出する必要がある。第2電気角は、操舵可能範囲において操舵角の変化に対して2周期分の周期波形信号として現れる。従って、第2電気角の推移を検出することにより、操舵部材の位置する操舵領域を判定することができる。 Since the first electrical angle cannot be calculated when the second resolver sensor is abnormal, it is necessary to calculate the absolute steering angle only from the second electrical angle. The second electrical angle appears as a periodic waveform signal for two cycles with respect to the change of the steering angle in the steerable range. Therefore, the steering region where the steering member is located can be determined by detecting the transition of the second electrical angle.
例えば、第2電気角を、操舵角の変化に対して鋸歯形状に変化する周期波形信号として出力させた場合には、その鋸歯形状信号における三角形頂点の通過を検出したときに操舵部材が中立位置を通過したと判断することができる。また、第2電気角の信号出力の変化は、右方向に操舵されて中立位置を通過した場合と、左方向に操舵されて中立位置を通過した場合とで相違する。従って、第2電気角の推移から操舵部材の位置する操舵領域を判定することができる For example, when the second electrical angle is output as a periodic waveform signal that changes in a sawtooth shape with respect to a change in the steering angle, the steering member is in a neutral position when the passage of a triangular vertex in the sawtooth shape signal is detected. Can be determined to have passed. Further, the change in the signal output of the second electrical angle is different between when the steering is performed in the right direction and passed through the neutral position and when the steering is performed in the left direction and passes through the neutral position. Accordingly, the steering region where the steering member is located can be determined from the transition of the second electrical angle.
異常時絶対舵角算出手段は、こうした原理を利用して、第2電気角の周期波形信号の推移に基づく操舵領域判定と第2電気角の値とに基づいて操舵角を算出する。
従って、第2レゾルバセンサが故障しても、精度良く操舵角を算出することができる。
The abnormal absolute steering angle calculation means calculates the steering angle based on the steering region determination based on the transition of the periodic waveform signal of the second electrical angle and the value of the second electrical angle, using such a principle.
Therefore, even if the second resolver sensor fails, the steering angle can be calculated with high accuracy.
以下、本発明の一実施形態について図面を用いて説明する。図1は、一実施形態としての操舵角検出装置を備えた車両の操舵装置を示している。 Hereinafter, an embodiment of the present invention will be described with reference to the drawings. FIG. 1 shows a vehicle steering apparatus provided with a steering angle detection apparatus as one embodiment.
この車両の操舵装置は、運転者によって操舵操作される操舵操作装置10と、転舵輪としての左右前輪FW1,FW2を運転者の操舵操作に応じて転舵する転舵装置20とを機械的に分離したステアバイワイヤ方式を採用している。操舵操作装置10は、運転者によって回動操作される操作部としての操舵ハンドル11を備えている。操舵ハンドル11は操舵入力軸12の上端に固定され、操舵入力軸12の下部には操舵反力用電動モータ13が組み付けられている。操舵反力用電動モータ13は、減速機構14を介して操舵入力軸12を軸線周りに回転駆動する。
This vehicle steering device mechanically includes a
転舵装置20は、車両の左右方向に延びて配置されたラックバー21を備えている。このラックバー21の両端部には、図示省略したタイロッドおよびナックルアームを介して、転舵輪としての左右前輪FW1,FW2が転舵可能に接続されている。左右前輪FW1,FW2は、ラックバー21の軸線方向の変位により左右に転舵される。ラックバー21の外周上には、図示しないハウジングに組み付けられた転舵用電動モータ22が設けられている。転舵用電動モータ22の回転は、ねじ送り機構23により減速されるとともにラックバー21の軸線方向の変位に変換される。また、転舵装置20は、軸線周りに回転可能な操舵出力軸24も有している。操舵出力軸24の下端にはピニオンギヤ25が固定されており、同ピニオンギヤ25はラックバー21に設けたラック歯21aに噛み合っていて、操舵出力軸24の軸線周りの回転によりラックバー21が軸線方向に変位する。
The steered
操舵入力軸12と操舵出力軸24との間には中間部材としてのケーブル31が配置されている。ケーブル31は、操舵入力軸12の軸線周りの回転を操舵出力軸24に伝達するものである。このケーブル31の上端の固定部材31aと操舵入力軸12の下端との間には第1電磁クラッチ32が配置されている。第1電磁クラッチ32は、通電状態にて切断状態に設定されてケーブル31と操舵入力軸12とを動力伝達不能に切り離し、非通電状態にて接続状態に設定されてケーブル31と操舵入力軸12とを動力伝達可能に連結する。ケーブル31の下端の固定部材31bと操舵出力軸24の上端との間には第2電磁クラッチ33が配置されている。第2電磁クラッチ33は、通電状態にて切断状態に設定されてケーブル31と操舵出力軸24とを動力伝達不能に切り離し、非通電状態にて接続状態に設定されてケーブル31と操舵出力軸24とを動力伝達可能に連結する。
A
次に、操舵反力用電動モータ13、転舵用電動モータ22および電磁クラッチ32,33を制御する電気制御装置40について説明する。
電気制御装置40は、操舵ハンドル11の操舵角θを検出するための操舵角検出装置50と、操舵反力用電子制御ユニット(以下、操舵反力用ECUという)60と、前輪転舵用電子制御ユニット(以下、前輪転舵用ECUという)70とを備えている。
Next, the
The
操舵角検出装置50は、第1レゾルバセンサ51と、第2レゾルバセンサ52と、第3レゾルバセンサ53と、絶対角検出用演算装置(以下、絶対角検出用ECUと呼ぶ)54とから構成される。
第1レゾルバセンサ51は、操舵入力軸12の中間部に設けられる第1レゾルバ51sと、第1レゾルバ51sの出力信号から相対角θaを検出する第1相対角検出回路51cとからなる。
第2レゾルバセンサ52は、第1レゾルバ51sと並んで操舵入力軸12の中間部に設けられる第2レゾルバ52sと、第2レゾルバ52sの出力信号から相対角θbを検出する第2相対角検出回路52cとからなる。
第3レゾルバセンサ53は、第2レゾルバ52sと並んで操舵入力軸12の中間部に設けられる第3レゾルバ53sと、第3レゾルバ53sの出力信号から相対角θcを検出する第3相対角検出回路53cとからなる。
The steering
The
The
The
各レゾルバ51s,52s,53sは、それぞれ環状のレゾルバロータ51sr,52sr,53srとレゾルバステータ51ss,52ss,53ssとを備える。各レゾルバ51s,52s,53sにおいては、レゾルバロータ51sr,52sr,53srが操舵入力軸12の外周面上に固定されており、レゾルバステータ51ss,52ss,53ssがその内周面にレゾルバロータ51sr,52sr,53srの外周面が対向するように車体側に固定して設けられる。
各レゾルバ51s,52s,53sは、それぞれレゾルバロータ51sr,52sr,53srに励磁コイルである1次巻線(図示略)が設けられ、レゾルバステータ51ss,52ss,53ssに検出コイルである2次巻線(図示略)が複数設けられる。
Each
Each
また、各相対角検出回路51c,52c,53cは、それぞれレゾルバ51s,52s,53sの1次巻線を正弦波信号により励磁するとともに、その励磁信号による誘起電圧信号を複数の2次巻線から入力する。操舵入力軸12が回転して各レゾルバ51s,52s,53sのレゾルバステータ51ss,52ss,53ssとレゾルバロータ51sr,52sr,53srとの位置関係が変化すると、2次巻線を通過する磁束が変化する。従って、1次巻線に印加される正弦波電圧と2次巻線に作用する誘起電圧との位相差を比較することにより、レゾルバステータ51ss,52ss,53ssとレゾルバロータ51sr,52sr,53srとの相対的な角度位置を検出することができる。
Each of the relative
操舵入力軸12は、図示しないストロークエンドにより、その軸線回りの回転が規制されている。この操舵入力軸12の回転可能範囲は、操舵ハンドル11の回転可能範囲と同一である。以下、この範囲を操舵可能範囲と呼ぶ。
操舵可能範囲は、本実施形態においては、操舵ハンドル11の中立位置を「0」とし、左方向の操舵限界角度−θmaxから右方向の操舵限界角度+θmaxまでとする。
The steering
In the present embodiment, the steerable range is set such that the neutral position of the steering handle 11 is “0” and the steering limit angle −θmax in the left direction to the steering limit angle + θmax in the right direction.
そして、第1相対角検出回路51cは、操舵ハンドル11が左操舵限界角度−θmaxから右操舵限界角度+θmaxまで回転する過程において11回の周期波形信号を出力するように構成される。
一方、第2相対角検出回路52cは、操舵ハンドル11が左操舵限界角度−θmaxから右操舵限界角度+θmaxまで回転する過程において12回の周期波形信号を出力するように構成される。また、第3相対角検出回路53cは、操舵ハンドル11が左操舵限界角度−θmaxから右操舵限界角度+θmaxまで回転する過程において13回の周期波形信号を出力するように構成される。
The first relative
On the other hand, the second relative
操舵ハンドル11が左操舵限界角度−θmaxから右操舵限界角度+θmaxまで回転する過程における周期波形信号の出力回数については、上記示した値に限定するものではないが、各相対角検出回路51c,52c,53cにおいて、「1」ずつ異なるように設定する。以下、第1相対角検出回路51cの周期波形信号の出力回数をn回、第2相対角検出回路52cの出力回数を(n+1)回、第3相対角検出回路53cの出力回数を(n+2)回として説明する。
The number of outputs of the periodic waveform signal in the process in which the steering handle 11 rotates from the left steering limit angle −θmax to the right steering limit angle + θmax is not limited to the above-described values, but the relative
図8は、第1相対角検出回路51c、第2相対角検出回路52c、第3相対角検出回路53cの出力する周期波形信号を表す。横軸は、操舵ハンドル11の操舵角θ(絶対舵角θ)を表し、縦軸は、電気角を表す。図中、破線で表される信号波形は、第1相対角検出回路51cの出力する相対角θaを、2点鎖線で表される信号波形は、第2相対角検出回路52cの出力する相対角θbを、1点鎖線で表される信号波形は、第3相対角検出回路53cの出力する相対角θc表す。
FIG. 8 shows periodic waveform signals output from the first relative
相対角θaは、操舵可能範囲を値nで徐算した角度(2・θmax/n)を1周期(2π)とした電気角であり、第1レゾルバ51sのレゾルバステータ51ssに対するレゾルバロータ51srの相対的な位置を表す。同様に、相対角θbは、操舵可能範囲を値(n+1)で徐算した角度(2・θmax/(n+1))を1周期(2π)とした電気角であり、第2レゾルバ52sのレゾルバステータ52ssに対するレゾルバロータ52srの相対的な位置を表す。同様に、相対角θcは、操舵可能範囲を値(n+2)で徐算した角度(2・θmax/(n+2))を1周期(2π)とした電気角であり、第3レゾルバ53sのレゾルバステータ53ssに対するレゾルバロータ53srの相対的な位置を表す。
これに対して絶対舵角θは、操舵ハンドル11の中立位置を「0」として、この中立位置を基準とした操舵ハンドル11の機械的な回転角度(回転位置)を表す。
以下の説明において、相対角θaを表す第1相対角検出回路51cの出力信号を第1レゾルバセンサ51の出力信号θaと呼び、相対角θbを表す第2相対角検出回路52cの出力信号を第2レゾルバセンサ52の出力信号θbと呼び、相対角θcを表す第3相対角検出回路53cの出力信号を第3レゾルバセンサ53の出力信号θcと呼ぶ。
The relative angle θa is an electrical angle with an angle (2 · θmax / n) obtained by subtracting the steerable range by the value n as one cycle (2π), and the relative angle of the resolver rotor 51sr to the resolver stator 51ss of the
On the other hand, the absolute steering angle θ represents a mechanical rotation angle (rotation position) of the steering handle 11 with the neutral position of the steering handle 11 as “0” with reference to the neutral position.
In the following description, the output signal of the first relative
図8に示すように、第1レゾルバセンサ51、第2レゾルバセンサ52、第3レゾルバセンサ53の出力する周期波形信号θa,θb,θcは、横軸に対して垂直な辺を有する直角三角形を複数連ねた鋸歯形状の信号として現れる。この鋸歯形状の信号波形の一山分が1周期となる。
各レゾルバセンサ51,52,53は、操舵ハンドル11が左操舵限界角度−θmax位置に回された状態において、出力がそれぞれ電気角で0ラジアンとなるようにそれぞれ設定され、操舵ハンドル11が右操舵限界角度+θmax位置にまで回されたときに、出力がそれぞれ2πラジアンとなるように設定される。
As shown in FIG. 8, the periodic waveform signals θa, θb, θc output from the
Each
各レゾルバセンサ51,52,53は、操舵ハンドル11を左操舵限界角度−θmaxから右操舵限界角度+θmaxまで回転する過程において、その周期波形信号の出力回数がそれぞれ1回だけ異なるように設定されるため、操舵角θに対する出力(電気角)に位相差が生じる。
この場合、第1レゾルバセンサの出力信号θaと第2レゾルバセンサ52の出力信号θbとは、操舵ハンドル11が左操舵限界角度−θmaxから右操舵限界角度+θmaxまで回転すると位相差がなくなる。
同様に、第2レゾルバセンサ52の出力信号θbと第3レゾルバセンサ53の出力信号θcとは、操舵ハンドル11が左操舵限界角度−θmaxから右操舵限界角度+θmaxまで回転すると位相差がなくなる。
一方、第1レゾルバセンサ51の出力信号θaと第3レゾルバセンサ53の出力信号θcとは、操舵ハンドル11が左操舵限界角度−θmaxから右操舵限界角度+θmaxまで回転したときに、その中間位置においても同位相となる。この同位相となる中間位置は、操舵ハンドル11の中立位置に相当する。
Each
In this case, there is no phase difference between the output signal θa of the first resolver sensor and the output signal θb of the
Similarly, there is no phase difference between the output signal θb of the
On the other hand, the output signal θa of the
第1レゾルバセンサ51、第2レゾルバセンサ52、第3レゾルバセンサ53の出力信号θa,θb、θcは、絶対角検出用ECU54に入力される。絶対角検出用ECU54は、マイクロコンピュータを主要部として構成され、相対角θa,θb,θcを用いて操舵ハンドル11の中立位置および操舵角θ(絶対舵角)を算出する。この絶対角検出用ECU54が行う操舵角算出処理については後述する。
The output signals θa, θb, θc of the
操舵反力用ECU60は、マイクロコンピュータを主要部として構成され、運転者のハンドル操作に対して適切な操舵反力を発生させる制御装置で、絶対角検出用ECU54および車速センサ41を接続している。車速センサ41は、車速Vを表す検出信号を出力する。操舵反力用ECU60は、絶対角検出用ECU54で算出された操舵角θおよび車速センサ41により検出された車速Vに基づいて目標操舵反力を算出する。この目標操舵反力の算出に当たっては、図9に示す操舵反力テーブルを参照する。この操舵反力テーブルは、操舵反力用ECU60のROM内に記憶されるもので、複数の代表的な車速値ごとに、ハンドル操舵角θの増加に従って非線形増加する複数の目標操舵反力値が設定されている。
なお、この操舵反力テーブルを利用するのに代えて、操舵角θおよび車速Vに応じて変化する目標操舵反力値を関数により予め定義しておき、同関数を利用して目標操舵反力値を計算するようにしてもよい。
The steering
Instead of using this steering reaction force table, a target steering reaction force value that changes according to the steering angle θ and the vehicle speed V is defined in advance by a function, and the target steering reaction force is calculated using the function. A value may be calculated.
操舵反力用ECU60は、計算した目標操舵反力に対応した駆動電流を図示しない駆動回路を介して操舵反力用電動モータ13に流す。これにより、操舵ハンドル11の回動操作に対して、操舵反力用電動モータ13による目標操舵反力が付与され、運転者は、適度な操舵反力を感じながら、操舵ハンドル11を回動操作できる。
尚、操舵反力用電動モータ13は、3相同期式永久磁石モータが使用され、2相回転磁束座標系で記述されるベクトル制御により回転制御される。この場合、2相・3相変換処理を行うためにモータ回転角に同期した信号を入力する必要がある。そこで、操舵反力用ECU60は、絶対角検出用ECU54から同期信号として相対角θa、相対角θb、相対角θcのいずれかの信号を入力する。
The steering
The steering reaction force
前輪転舵用ECU70は、マイクロコンピュータを主要部として構成され、運転者のハンドル操作に応じた舵角で前輪(転舵輪)を転舵する制御装置であり、絶対角検出用ECU54、車速センサ41、転舵角センサ43を接続する。
転舵角センサ43は、ラックバー21に組み付けられて、ラックバー21の軸線方向の変位を測定することにより、左右前輪FW1,FW2の実転舵角δを検出して出力する。なお、実転舵角δは、左右前輪FW1,FW2の中立位置を「0」とし、左右前輪FW1,FW2の右方向の転舵角を正の値で表し、左右前輪FW1,FW2の左方向の転舵角を負の値で表す。また、この転舵角センサ43を、操舵出力軸24の回転角を検出することにより、実転舵角δを検出するように構成してもよい。
The front-wheel steering ECU 70 is configured by a microcomputer as a main part, and is a control device that steers front wheels (steered wheels) at a steering angle corresponding to a driver's steering wheel operation. The absolute-
The turning
前輪転舵用ECU70は、絶対角検出用ECU54で算出されたハンドル操舵角θおよび車速センサ41により検出された車速Vに基づいて目標前輪転舵角を算出する。この目標前輪転舵角の算出に当たっては、図10に示す転舵角テーブルを参照する。この転舵角テーブルは、前輪転舵用ECU70のROM内に記憶されるもので、複数の代表的な車速値ごとに、ハンドル操舵角θの増加に従って非線形に増加するステヤバイワイヤ用の目標前輪転舵角が設定されている。この目標前輪転舵角のハンドル操舵角θに対する変化率は、ハンドル操舵角θの絶対値|θ|の小さな範囲内で小さく、ハンドル操舵角θの絶対値|θ|が大きくなると大きくなるように設定されている。なお、この転舵角テーブルを利用するのに代えて、ハンドル操舵角θと目標前輪転舵角との関係を示す関数を予め用意しておき、同関数を利用してステヤバイワイヤ用の目標前輪転舵角を計算するようにしてもよい。
The front wheel steering ECU 70 calculates a target front wheel steering angle based on the steering wheel steering angle θ calculated by the absolute
前輪転舵用ECU70は、転舵角センサ43により検出した実転舵角δが最終的な目標前輪転舵角に等しくなるように、その舵角差を用いて図示しない駆動回路を介して転舵用電動モータ22の回転を制御する。これにより、転舵用電動モータ22は回転駆動され、ねじ送り機構23を介してラックバー21を軸線方向に駆動して、左右前輪FW1,FW2を目標転舵角に転舵する。
The front wheel turning ECU 70 turns the vehicle through a drive circuit (not shown) using the steering angle difference so that the actual turning angle δ detected by the turning
次に、操舵角検出装置50が行う操舵ハンドル11の操舵角検出処理について説明する。まず、車両起動時において行う初期制御ルーチンについて説明する。図2は、絶対角検出用ECU54が車両起動時において実施する初期制御ルーチンを表すフローチャートである。この処理は、絶対角検出用ECU54のROM内に制御プログラムとして記憶され、車両のイグニッションスイッチがONしたときに実行される。
Next, the steering angle detection process of the steering handle 11 performed by the steering
車両のイグニッションスイッチがONして本初期制御ルーチンが起動すると、絶対角検出用ECU54は、ステップS11において、第1レゾルバセンサ51、第2レゾルバセンサ52、第3レゾルバセンサ53が全て正常であるか否かを判断する。この判断は、各レゾルバ51s、52s、53sに設けられる巻線の端子電圧をチェックすることにより行う。各レゾルバ51s、52s、53sに設けられる巻線に断線、ショート、絶縁不良等が発生した場合には、この巻線端子電圧が基準範囲から外れる。従って、このステップS11においては、第1相対角検出回路51c、第2相対角検出回路52c、第3相対角検出回路53cにより巻線端子電圧を検出し、検出電圧が基準範囲から外れているときにレゾルバ51s、52s、53sが異常であると判断する。
When the ignition switch of the vehicle is turned on and this initial control routine is started, the absolute
尚、各レゾルバセンサ51,52,53の異常検出に当たっては、相対角検出回路51c,52c,53c自身の異常も含めて、絶対角検出用ECU54にて検出するようにしてもよい。例えば、相対角検出回路51c,52c,53cの出力する周期波形信号の電圧値を絶対角検出用ECU54にてチェックし、その電圧値が基準範囲から外れたとき回路異常と判断してもよい。また、相対角検出回路51c,52c,53cの出力信号の波形から回路異常を判断してもよい。
In detecting the abnormality of each
第1レゾルバセンサ51、第2レゾルバセンサ52、第3レゾルバセンサ53が全て正常であると判断された場合には(S11:YES)、ステップS12において、第1絶対舵角算出処理を行う。この第1絶対舵角算出処理については後述する。
また、第1レゾルバセンサ51、第2レゾルバセンサ52、第3レゾルバセンサ53のうちいずれか一つでも異常が検出された場合には(S11:NO)、ステップS13において、第1電磁クラッチ32および第2電磁クラッチ33に接続指令を出力する。この接続指令により、第1電磁クラッチ32は、ケーブル31と操舵入力軸12とを動力伝達可能に連結する。また、第2電磁クラッチ33は、ケーブル31と操舵出力軸24とを動力伝達可能に連結する。この結果、操舵入力軸12と操舵出力軸24とは、ケーブル31を介して動力伝達可能に連結される。従って、運転者の行う操舵ハンドル11の回動操作により、左右前輪FW1,FW2が直接転舵される状態に設定される。
こうしてステップS12あるいはステップS13の処理が完了すると、本制御ルーチンを終了する。
When it is determined that the
In addition, when any one of the
When the process of step S12 or step S13 is completed in this way, this control routine is terminated.
次に、初期制御処理が完了した後の絶対舵角算出処理について説明する。図3は、絶対角検出用ECU54が実施する絶対舵角算出ルーチンを表すフローチャートである。この処理は、絶対角検出用ECU54のROM内に制御プログラムとして記憶され、初期制御処理が完了した後に所定の短い周期で繰り返し行われる。
Next, an absolute steering angle calculation process after the initial control process is completed will be described. FIG. 3 is a flowchart showing an absolute steering angle calculation routine executed by the absolute
本ルーチンが起動すると、絶対角検出用ECU54は、ステップS21において、第1レゾルバセンサ51、第2レゾルバセンサ52、第3レゾルバセンサ53が全て正常であるか否かを判断する。この判断は、先のステップS11と同様な異常検出処理であるが、車両のイグニッションスイッチがオン状態にあるあいだ繰り返し行われる。
そして、レゾルバセンサ51,52,53の異常が検出されていないあいだは、第1絶対舵角算出処理を繰り返し行う(S22)。
When this routine is started, the absolute
And while the abnormality of the
一方、レゾルバセンサ51,52,53のいずれかに異常が検出された場合には、その異常となるレゾルバセンサが、第1レゾルバセンサ51のみであるか否かを判断し(S23)、第1レゾルバセンサ51のみ異常が検出されている場合には(S23:YES)、第2絶対舵角算出処理を行う(S24)。
また、ステップS23における判断が「NO」、つまり、第1レゾルバセンサ51のみの異常ではない場合は、異常となるレゾルバセンサが第3レゾルバセンサ53のみであるか否かを判断し(S25)、第3レゾルバセンサ53のみ異常が検出されている場合には(S25:YES)、第3絶対舵角算出処理を行う(S26)。
また、ステップS25における判断が「NO」、つまり、第3レゾルバセンサ53のみの異常ではない場合は、異常となるレゾルバセンサが第2レゾルバセンサ52のみであるか否かを判断し(S27)、第2レゾルバセンサ52のみ異常が検出されている場合には(S27:YES)、第4絶対舵角算出処理を行う(S28)。
On the other hand, when an abnormality is detected in any of the
If the determination in step S23 is “NO”, that is, it is not an abnormality of only the
If the determination in step S25 is “NO”, that is, if the abnormality is not only in the
更に、ステップS27における判断が「NO」、つまり、3つのレゾルバセンサ51,52,53のうち複数のレゾルバセンサに異常が検出されている場合には、第1電磁クラッチ32および第2電磁クラッチ33に接続指令を出力する(S29)。従って、運転者の行う操舵ハンドル11の回動操作により、左右前輪FW1,FW2が直接転舵される状態に設定される。
Further, if the determination in step S27 is “NO”, that is, if an abnormality is detected in a plurality of resolver sensors among the three
本制御ルーチンは、車両の運転中において繰り返し実行される。従って、走行途中でレゾルバセンサ51,52,53のいずれかが故障した場合には、その故障したレゾルバセンサ51,52,53に応じた絶対舵角算出処理が選択される。また、複数のレゾルバセンサが故障した場合には、絶対舵角算出処理を行わずに、操舵操作装置10と転舵装置20とを機械的に連結して、運転者の操舵操作により左右前輪FW1,FW2が直接転舵される状態に設定する。
This control routine is repeatedly executed during operation of the vehicle. Therefore, when any of the
次に、第1絶対舵角算出処理について説明する。図4は、絶対角検出用ECU54が実施する第1絶対舵角算出ルーチンを表すフローチャートである。この第1絶対舵角算出ルーチンは、上述した初期制御ルーチンにおけるステップS12の処理、および、絶対舵角算出ルーチンにおけるステップS22の処理に相当するもので、絶対角検出用ECU54のROM内に制御プログラムとして記憶される。
Next, the first absolute steering angle calculation process will be described. FIG. 4 is a flowchart showing a first absolute steering angle calculation routine executed by the absolute
本ルーチンが起動すると、絶対角検出用ECU54は、ステップS31において、第1レゾルバセンサ51、第2レゾルバセンサ52、第3レゾルバセンサ53の出力信号θa,θb,θcを読み込む。続いて、読み込んだ信号から相対角θcが相対角θb以上であるか否かを判断し(S32)、θc≧θbである場合には(S32:YES)、θcからθbを減算した値を相対角差θcb(=θc−θb)として算出する(S33)。一方、θc<θbである場合には(S32:NO)、θcからθbを減算し2πを加算した値を相対角差θcb(=θc−θb+2π)として算出する(S34)。
When this routine is started, the absolute
図8に示すように、操舵ハンドル11を左操舵限界角度−θmaxから右操舵限界角度+θmaxまで回転する過程において、第3レゾルバセンサ51は(n+2)回の鋸歯形状信号θcを出力し、第2レゾルバセンサ52は(n+1)回の鋸歯形状信号θbを出力する。
As shown in FIG. 8, in the process of rotating the steering handle 11 from the left steering limit angle −θmax to the right steering limit angle + θmax, the
ここで、操舵ハンドル11が左操舵限界角度−θmaxの位置から右方向に操舵操作されるケースを考える。第3レゾルバセンサ53の出力信号θcと第2レゾルバセンサ52の出力信号θbとの位相差は、左操舵限界角度−θmaxの位置を基準(位相差=0)とすると、右操舵方向に進むにつれて増大し、右操舵限界角度+θmaxの位置で最大の「2π」となり同位相に戻る。従って、操舵可能範囲における位相差がわかれば操舵角θ(絶対舵角)を求めることができる。
Here, consider a case where the steering handle 11 is steered rightward from the position of the left steering limit angle −θmax. As for the phase difference between the output signal θc of the
ステップS33,S34の処理は、この位相差を算出するものであるが、相対角θcと相対角θbとは、途中で大小関係が逆転する。そこで、相対角θcと相対角θbとの大小関係が逆転する場合(θc<θb)には、相対角差θcbに2πを加算する。
従って、相対角差θcbは、図8の実線にて示すように、操舵ハンドル11が左操舵限界角度−θmaxから右操舵限界角度+θmaxまで回転する過程において、周期性を有することなく操舵角θに比例して「0」から「2π」まで直線的に増加する。これにより、相対角差θcbを求めることで操舵ハンドル11の操舵角θを検出することができる。
The processing in steps S33 and S34 calculates this phase difference, but the relative relationship between the relative angle θc and the relative angle θb is reversed in the middle. Therefore, when the magnitude relationship between the relative angle θc and the relative angle θb is reversed (θc <θb), 2π is added to the relative angle difference θcb.
Therefore, as shown by the solid line in FIG. 8, the relative angle difference θcb becomes the steering angle θ without periodicity in the process in which the steering handle 11 rotates from the left steering limit angle −θmax to the right steering limit angle + θmax. It increases linearly from “0” to “2π” in proportion. Accordingly, the steering angle θ of the steering handle 11 can be detected by obtaining the relative angle difference θcb.
次に、絶対角検出用ECU54は、ステップS35において、相対角θcが相対角θa以上であるか否かを判断する。θc≧θaである場合には(S35:YES)、θcからθaを減算した値を相対角差θca(=θc−θa)として算出する(S36)。一方、θc<θaである場合には(S35:NO)、θcからθaを減算し2πを加算した値を相対角差θca(=θc−θa+2π)として算出する(S37)。
Next, the absolute
この処理は、第3レゾルバセンサ53の出力信号θcと、第1レゾルバセンサ51の出力信号θaとの位相差を算出する処理である。
図8に示すように、第1レゾルバセンサ51は、操舵ハンドル11を左操舵限界角度−θmaxから右操舵限界角度+θmaxまで回転する過程において、n回の鋸歯形状信号θaを出力する。一方、第3レゾルバセンサ53は、(n+2)回の鋸歯形状信号θcを出力する。
従って、第3レゾルバセンサ53の出力信号θcと、第1レゾルバセンサ51の出力信号θaとの位相差は、左操舵限界角度−θmaxの位置を基準(位相差=0)とすると、図8に示すように、右操舵方向に進むにつれて増大し、操舵可能範囲の中間位置において最大の「2π」となって同位相に戻った後、再度増大して右操舵限界角度+θmaxの位置で最大の「2π」となる。
This process is a process for calculating the phase difference between the output signal θc of the
As shown in FIG. 8, the
Therefore, the phase difference between the output signal θc of the
この位相差は、相対角θcと相対角θaとの差である相対角差θcaにより表すことができるが、途中で両者の大小関係が逆転する。そこで、相対角θcと相対角θaとの大小関係が逆転する場合(θc<θa)には、相対角差に2πを加算して相対角差θcaとしている。
この結果、相対角差θcaは、図8に示すように、操舵ハンドル11を左操舵限界角度−θmaxから右操舵限界角度+θmaxまで回転する過程において、鋸歯形状の2サイクルの周期波形信号を出力することになる。従って、操舵ハンドル11の操舵位置が右操舵領域に属するのか右操舵領域に属するのか識別できれば、この相対角差θcaから操舵ハンドル11の絶対舵角を検出することができる。
This phase difference can be expressed by a relative angle difference θca that is a difference between the relative angle θc and the relative angle θa, but the magnitude relationship between the two is reversed halfway. Therefore, when the magnitude relationship between the relative angle θc and the relative angle θa is reversed (θc <θa), 2π is added to the relative angle difference to obtain the relative angle difference θca.
As a result, the relative angle difference θca outputs a sawtooth-shaped two-cycle periodic waveform signal in the process of rotating the steering handle 11 from the left steering limit angle −θmax to the right steering limit angle + θmax, as shown in FIG. It will be. Therefore, if it can be identified whether the steering position of the steering handle 11 belongs to the right steering region or the right steering region, the absolute steering angle of the steering handle 11 can be detected from the relative angle difference θca.
絶対角検出用ECU54は、ステップS36またはステップS37において相対角差θcaを算出すると、次に、ステップS38の判断処理を行う。
このステップS38においては、相対角差θcaが「0」であり(θca=0)、かつ、相対角差θcbが「0」でない(θcb≠0)か否かを判断する。図8に示すように、相対角差θcaは、操舵ハンドル11が左操舵限界角度−θmaxに位置する場合と中立位置において「0」となる。一方、相対角差θcbは、操舵ハンドル11が左操舵限界角度−θmaxに位置する場合に「0」となる。
従って、このステップS38において「YES」と判断された場合には、操舵ハンドル11の操舵角θ(絶対舵角)が「0」、つまり、中立位置にあると判定する(S39)。
この中立位置の検出に当たっては、例えば、相対角差θcaが「0」から「2π」側、あるいは、「2π」から「0」側に大きく変動したときに、操舵ハンドル11が中立位置にある(操舵角θ=0)と判定するとよい。
After calculating the relative angle difference θca in step S36 or step S37, the absolute
In this step S38, it is determined whether the relative angle difference θca is “0” (θca = 0) and the relative angle difference θcb is not “0” (θcb ≠ 0). As shown in FIG. 8, the relative angle difference θca becomes “0” when the
Therefore, if “YES” is determined in step S38, it is determined that the steering angle θ (absolute rudder angle) of the steering handle 11 is “0”, that is, in the neutral position (S39).
In detecting the neutral position, for example, when the relative angle difference θca greatly fluctuates from “0” to “2π” or from “2π” to “0”, the
続いて、絶対角検出用ECU54は、ステップS40において、操舵反力用ECU60および前輪転舵用ECU70に対して中立位置信号を出力する。これにより、操舵反力用ECU60および前輪転舵用ECU70においては、この中立位置信号に基づいて、中立位置を認識して操舵角に応じた反力制御および転舵角制御における零点補正を行う。
Subsequently, the absolute
一方、ステップS38において「NO」と判断された場合には、ステップS41の判断処理を行う。このステップS41においては、相対角差θcaが相対角差cbより小さい(θca<θcb)、あるいは、相対角差θcaが相対角差θcbと等しく、かつ、「0」でない(θca=θcb≠0)か否かを判断する。
このステップS41における判断は、操舵ハンドル11の操舵位置が右操舵領域(にある否かを判断するものである。
ステップS41において「YES」と判断された場合は、操舵ハンドル11の操舵領域を表すフラグSIGを「1」に設定する(S42)。このフラグSIGは、操舵ハンドル11が右操舵領域に位置するときに「1」に設定され、左操舵領域に位置するときに「0」に設定される。
On the other hand, if “NO” is determined in the step S38, the determination process of the step S41 is performed. In step S41, the relative angle difference θca is smaller than the relative angle difference cb (θca <θcb), or the relative angle difference θca is equal to the relative angle difference θcb and is not “0” (θca = θcb ≠ 0). Determine whether or not.
The determination in step S41 is to determine whether or not the steering position of the steering handle 11 is in the right steering region (or not).
If “YES” is determined in the step S41, the flag SIG indicating the steering region of the
続いてステップS43において、相対角差θcaに基づいて操舵角の大きさ|θ|を算出する。この操舵角の大きさ|θ|は、操舵ハンドル11が左操舵領域に位置するときは左操舵限界位置からの回転角度を表し、操舵ハンドル11が右操舵領域に位置するときは中立位置からの回転角度を表す。
相対角差θcaは、図8に示すように、操舵ハンドル11が左操舵限界角度−θmaxから右操舵限界角度+θmaxまで回転する過程において、2サイクルの周期波形信号を出力する。従って、相対角差θcaからは2通りの操舵角が求められる。そこで、このステップS43においては、操舵角θを算出する過程として、まず操舵角の大きさ|θ|を算出する。
In step S43, the steering angle magnitude | θ | is calculated based on the relative angle difference θca. The magnitude of the steering angle | θ | represents the rotation angle from the left steering limit position when the steering handle 11 is located in the left steering region, and from the neutral position when the steering handle 11 is located in the right steering region. Represents the rotation angle.
As shown in FIG. 8, the relative angle difference θca outputs a two-cycle periodic waveform signal in the process in which the
この操舵角の大きさ|θ|は、図11に示す操舵角|θ|テーブルを参照して算出することができる。この操舵角|θ|テーブルは、絶対角検出用ECU54のROM内に記憶され、操舵角の大きさ|θ|と相対角差θcaとが正比例の関係に対応付けられている。
尚、操舵角の大きさ|θ|は、関数を用いて算出してもよい。例えば、操舵ハンドル11が左操舵限界角度−θmaxから右操舵限界角度+θmaxまで回転する回転角度を2・θmaxとすると、相対角差θcaは、操舵ハンドル11が2・θmax回転するあいだに電気角で4π変化する。従って、操舵角の大きさ|θ|は次式のように算出することができる。
|θ|=θmax・θca/(2・π)
The magnitude of the steering angle | θ | can be calculated with reference to the steering angle | θ | table shown in FIG. The steering angle | θ | table is stored in the ROM of the absolute
The steering angle magnitude | θ | may be calculated using a function. For example, if the rotation angle at which the steering handle 11 rotates from the left steering limit angle −θmax to the right steering limit angle + θmax is 2 · θmax, the relative angle difference θca is an electrical angle while the steering handle 11 rotates 2 · θmax. It changes by 4π. Therefore, the steering angle magnitude | θ | can be calculated as follows.
| Θ | = θmax · θca / (2 · π)
続いて、ステップS44において、操舵ハンドル11の操舵角θ(絶対舵角)を次式のように算出する。
θ=|θ|
この場合、操舵ハンドル11が右操舵領域に位置するため、操舵角の大きさ|θ|は、そのまま操舵ハンドル11の操舵角θとして設定される。
Subsequently, in step S44, the steering angle θ (absolute steering angle) of the steering handle 11 is calculated as follows.
θ = | θ |
In this case, since the steering handle 11 is located in the right steering region, the magnitude of the steering angle | θ | is set as the steering angle θ of the steering handle 11 as it is.
一方、ステップS41において「NO」と判断された場合には、操舵ハンドル11が左操舵領域に位置するため、ステップS45において、フラグSIGを「0」にセットする。続いて、ステップS46において、相対角差θcaに基づいて操舵角の大きさ|θ|を算出する。この算出処理は、ステップS43と同様に図11に示す操舵角|θ|テーブルあるいは関数を用いて行えばよい。
次に、ステップS47において、操舵ハンドル11の操舵角θ(絶対舵角)を次式のように算出する。
θ=|θ|−θmax
この場合、操舵ハンドル11が左操舵領域に位置するため、操舵角の大きさ|θ|から左操舵限界角度(−θmax)を減算した値が、操舵ハンドル11の操舵角θとして設定される。
On the other hand, if “NO” is determined in the step S41, the
Next, in step S47, the steering angle θ (absolute steering angle) of the steering handle 11 is calculated as follows.
θ = | θ | −θmax
In this case, since the steering handle 11 is located in the left steering region, a value obtained by subtracting the left steering limit angle (−θmax) from the steering angle magnitude | θ | is set as the steering angle θ of the
絶対角検出用ECU54は、ステップS39,S44,S47にて操舵角θを算出すると、ステップS48において、操舵角θ(絶対舵角θ)を表す舵角検出信号を操舵反力用ECU60および前輪転舵用ECU70に出力し、本制御ルーチンを終了する。
When the absolute
本制御ルーチンは、図3にて示す絶対舵角算出ルーチンに組み込まれて繰り返し実行される。従って、第1レゾルバセンサ51、第2レゾルバセンサ52、第3レゾルバセンサ53が正常であるときに、相対角差θcaと相対角差θcbとに基づいて操舵ハンドル11の中立位置と操舵角θが算出される。
操舵角θの算出に当たっては、相対角差θcaと相対角差θcbとの大小関係から操舵ハンドル11の左右の操舵領域を判別し、操舵角の大きさ|θ|については相対角差θcaから算出する。
This control routine is incorporated into the absolute steering angle calculation routine shown in FIG. 3 and repeatedly executed. Therefore, when the
In calculating the steering angle θ, the left and right steering regions of the steering handle 11 are determined from the magnitude relationship between the relative angle difference θca and the relative angle difference θcb, and the magnitude of the steering angle | θ | is calculated from the relative angle difference θca. To do.
操舵角θは、相対角差θcbを用いても算出できるが、本実施形態においては、相対角差θcaを用いて算出する。この理由は、相対角差θcaを用いたほうが操舵角θの検出精度が高いためである。相対角差θcaは、図8に示すように、相対角差θcbに比べて、操舵角θに対する変化量が大きい。この例では、操舵ハンドル11が左操舵限界角度−θmaxから右操舵限界角度+θmaxまで回転するあいだに、相対角差θcbでは電気角で2π変化するのに対して、相対角差θcaにおいては電気角で4πの変化が得られる。従って、相対角差θcaを用いたほうが検出精度が向上する。
The steering angle θ can be calculated using the relative angle difference θcb. However, in the present embodiment, the steering angle θ is calculated using the relative angle difference θca. This is because the detection accuracy of the steering angle θ is higher when the relative angle difference θca is used. As shown in FIG. 8, the relative angle difference θca has a larger amount of change with respect to the steering angle θ than the relative angle difference θcb. In this example, while the
また、操舵ハンドル11の中立位置の検出については、相対角差θcbを用いても算出できるが、本実施形態においては、相対角差θcaを用いて算出する。この理由は、相対角差θcaを用いたほうが、その検出が容易であるためである。
相対角差θcbを用いて中立位置を検出する場合には、相対角差θcbが、右操舵限界角度+θmaxにおける値「2π」の半分、つまり、「π」となったことを検出すればよい。しかし、相対角差θcbは、操舵角θの変化に比例して緩やかに変化するため、その中立位置の判定が難しい。
The neutral position of the
When the neutral position is detected using the relative angle difference θcb, it is only necessary to detect that the relative angle difference θcb is half of the value “2π” at the right steering limit angle + θmax, that is, “π”. However, since the relative angle difference θcb changes gently in proportion to the change in the steering angle θ, it is difficult to determine the neutral position.
一方、相対角差θcaは、中立位置において、その値が大きく変動する。つまり、操舵ハンドル11が回転操作されて中立位置を通過するとき、相対角差θcaは、「2π」から「0」に(右方向に操舵したとき)、あるいは「0」から「2π」に(左方向に操舵したとき)大きく変動する。従って、相対角差θcaの大きな変化を検出したときに中立位置の通過を判断できる。例えば、直前回に検出した相対角差θca(n-1)と今回検出した相対角差θca(n)とを比較して、その差の絶対値|θca(n-1)−θca(n)|が所定値(例えば、π)以上あるときに中立位置を通過したと判断することができる。従って、相対角差θcbを用いる場合に比べて、中立位置通過時の大きな出力変動量を得ることができ、中立位置検出が容易となる。 On the other hand, the value of the relative angle difference θca varies greatly at the neutral position. That is, when the steering handle 11 is rotated and passes through the neutral position, the relative angle difference θca is changed from “2π” to “0” (when steered in the right direction) or from “0” to “2π” ( Fluctuates significantly (when steering left). Therefore, the passage of the neutral position can be determined when a large change in the relative angle difference θca is detected. For example, the relative angle difference θca (n−1) detected immediately before is compared with the relative angle difference θca (n) detected this time, and the absolute value of the difference | θca (n−1) −θca (n) When | is equal to or greater than a predetermined value (for example, π), it can be determined that the neutral position has been passed. Therefore, compared with the case where the relative angle difference θcb is used, a large output fluctuation amount when the neutral position is passed can be obtained, and the neutral position can be easily detected.
尚、この第1絶対舵角算出ルーチンにおいて、相対角差θcbに代えて、相対角θbから相対角θaを減算した相対角差θba(θb−θa)を用いても良い。操舵角θに対する相対角差θbaの特性は、図8に示すように、操舵角θに対する相対角差θcbの特性と全く同じになるからである。 In the first absolute steering angle calculation routine, a relative angle difference θba (θb−θa) obtained by subtracting the relative angle θa from the relative angle θb may be used instead of the relative angle difference θcb. This is because the characteristic of the relative angle difference θba with respect to the steering angle θ is exactly the same as the characteristic of the relative angle difference θcb with respect to the steering angle θ, as shown in FIG.
次に、第2絶対舵角算出ルーチンについて説明する。
この第2絶対舵角算出ルーチンは、第1レゾルバセンサ51のみに異常が検出されたときに実行される制御ルーチンで、図5に示すフローチャートに沿って処理される。
Next, the second absolute steering angle calculation routine will be described.
The second absolute steering angle calculation routine is a control routine that is executed when an abnormality is detected only in the
この第2異常ルーチンが開始されると、絶対角検出用ECU54は、ステップS51において、第2レゾルバセンサ52、第3レゾルバセンサ53の出力信号θb,θcを読み込む。続いて、読み込んだ信号から相対角θcが相対角θb以上であるか否かを判断し(S52)、θc≧θbである場合には(S52:YES)、θcからθbを減算した値を相対角差θcb(=θc−θb)として算出する(S53)。一方、θc<θbである場合には(S52:NO)、θcからθbを減算し2πを加算した値を相対角差θcb(=θc−θb+2π)として算出する(S34)。
When the second abnormality routine is started, the absolute
図8に示すように、操舵ハンドル11を左操舵限界角度−θmaxから右操舵限界角度+θmaxまで回転する過程において、第2レゾルバセンサ52は(n+1)回の鋸歯形状信号θbを出力し、第3レゾルバセンサ53は(n+2)回の鋸歯形状信号θcを出力する。
従って、両レゾルバセンサ52,53の信号出力の位相差を、相対角θcと相対角θbとの差である相対角差θcbにより表すことができるが、途中で両者の大小関係が逆転する。そこで、相対角θcと相対角θbとの大小関係が逆転する場合(θc<θb)には、相対角差に2πを加算して相対角差θcbとしている。
As shown in FIG. 8, in the process of rotating the steering handle 11 from the left steering limit angle −θmax to the right steering limit angle + θmax, the
Therefore, the phase difference between the signal outputs of the
続いて、ステップS53あるいはS54において算出した相対角差θcbに基づいて操舵角θを算出する(S55)。この操舵角θの算出は、図12に示す操舵角θテーブルを参照して行う。この操舵角θテーブルは、絶対角検出用ECU54のROM内に記憶され、操舵ハンドル11の操舵角θと相対角差θcbとを関係付けたものである。
尚、操舵角θは、関数を用いて算出してもよい。例えば、操舵ハンドル11が左操舵限界角度−θmaxから右操舵限界角度+θmaxまで回転する回転角度を2・θmaxとすると、相対角差θcbは、操舵ハンドル11が2・θmax回転する間に電気角で2π変化する。従って、操舵角θは次式のように算出することができる。
θ=θmax・θcb/π
Subsequently, the steering angle θ is calculated based on the relative angle difference θcb calculated in step S53 or S54 (S55). The calculation of the steering angle θ is performed with reference to the steering angle θ table shown in FIG. This steering angle θ table is stored in the ROM of the absolute
The steering angle θ may be calculated using a function. For example, if the rotation angle at which the steering handle 11 rotates from the left steering limit angle −θmax to the right steering limit angle + θmax is 2 · θmax, the relative angle difference θcb is an electrical angle while the steering handle 11 rotates 2 · θmax. It changes by 2π. Therefore, the steering angle θ can be calculated as follows:
θ = θmax · θcb / π
絶対角検出用ECU54は、ステップS55にて操舵角θを算出すると、次のステップS56において、操舵角θ(絶対舵角θ)を表す舵角検出信号を操舵反力用ECU60および前輪転舵用ECU70に出力し、本制御ルーチンを終了する。
When the absolute
本第2絶対舵角算出ルーチンは、図3にて示す絶対舵角算出ルーチンに組み込まれて第1レゾルバセンサ51の異常時に繰り返し実行される。従って、第1レゾルバセンサ51が故障した場合であっても、第2レゾルバセンサ52、第3レゾルバセンサ53による相対角差θcbに基づいて操舵角θが算出される。
The second absolute steering angle calculation routine is incorporated in the absolute steering angle calculation routine shown in FIG. 3 and is repeatedly executed when the
次に、第3絶対舵角算出ルーチンについて説明する。
この第3絶対舵角算出ルーチンは、第3レゾルバセンサ53のみに異常が検出されたときに実行される制御ルーチンで、図6に示すフローチャートに沿って処理される。
Next, a third absolute steering angle calculation routine will be described.
This third absolute steering angle calculation routine is a control routine that is executed when an abnormality is detected only in the
この第3異常ルーチンが開始されると、絶対角検出用ECU54は、ステップS61において、第1レゾルバセンサ51、第2レゾルバセンサ52の出力信号θa,θbを読み込む。続いて、読み込んだ信号から相対角θbが相対角θa以上であるか否かを判断し(S62)、θb≧θaである場合には(S62:YES)、θbからθaを減算した値を相対角差θba(=θb−θa)として算出する(S63)。一方、θb<θaである場合には(S62:NO)、θbからθaを減算し2πを加算した値を相対角差θba(=θb−θa+2π)として算出する(S64)。
こうして算出される相対角差θbaは、図8に示すように、操舵ハンドル11を左操舵限界角度−θmaxから右操舵限界角度+θmaxまで回転したときに、操舵角θの増加に比例して「0」から「2π」まで直線的に増加する。
When the third abnormality routine is started, the absolute
As shown in FIG. 8, the relative angle difference θba calculated in this way is “0” in proportion to the increase in the steering angle θ when the
続いて、ステップS63あるいはS64において算出した相対角差θbaに基づいて操舵角θを算出する(S65)。この操舵角θの算出は、図12に示す操舵角θテーブルを参照して行う。この操舵角θテーブルは、絶対角検出用ECUのROM内に記憶され、操舵ハンドル11の操舵角θと相対角差θbaとを関係付けたものである。
尚、操舵角θは、関数を用いて算出してもよい。例えば、操舵ハンドル11が左操舵限界角度−θmaxから右操舵限界角度+θmaxまで回転する回転角度を2・θmaxとすると、相対角差θbaは、操舵ハンドル11が2・θmax回転する間に電気角で2π変化する。従って、操舵角θは次式のように算出することができる。
θ=θmax・θba/π
Subsequently, the steering angle θ is calculated based on the relative angle difference θba calculated in step S63 or S64 (S65). The calculation of the steering angle θ is performed with reference to the steering angle θ table shown in FIG. This steering angle θ table is stored in the ROM of the absolute angle detection ECU, and associates the steering angle θ of the
The steering angle θ may be calculated using a function. For example, if the rotation angle at which the steering handle 11 rotates from the left steering limit angle −θmax to the right steering limit angle + θmax is 2 · θmax, the relative angle difference θba is an electrical angle while the steering handle 11 rotates 2 · θmax. It changes by 2π. Therefore, the steering angle θ can be calculated as follows:
θ = θmax · θba / π
絶対角検出用ECU54は、ステップS65にて操舵角θを算出すると、次のステップS66において、操舵角θ(絶対舵角θ)を表す舵角検出信号を操舵反力用ECU60および前輪転舵用ECU70に出力し、本制御ルーチンを終了する。
When the absolute
本第3絶対舵角算出ルーチンは、図3にて示す絶対舵角算出ルーチンに組み込まれて第3レゾルバセンサ53の異常時に繰り返し実行される。従って、第3レゾルバセンサ53が故障した場合であっても、第1レゾルバセンサ51、第2レゾルバセンサ52による相対角差θbaに基づいて操舵角θが算出される。
The third absolute steering angle calculation routine is incorporated in the absolute steering angle calculation routine shown in FIG. 3 and is repeatedly executed when the
次に、第4絶対舵角算出ルーチンについて説明する。
この第4絶対舵角算出ルーチンは、第2レゾルバセンサ52のみに異常が検出されたときに実行される制御ルーチンで、図7に示すフローチャートに沿って処理される。
Next, a fourth absolute steering angle calculation routine will be described.
This fourth absolute steering angle calculation routine is a control routine that is executed when an abnormality is detected only in the
この第4異常ルーチンが開始されると、絶対角検出用ECU54は、ステップS71において、第1レゾルバセンサ51、第3レゾルバセンサ53の出力信号θa,θcを読み込む。続いて、読み込んだ信号から相対角θcが相対角θa以上であるか否かを判断し(S72)、θc≧θaである場合には(S72:YES)、θcからθaを減算した値を相対角差θca(=θc−θa)として算出する(S73)。一方、θc<θaである場合には(S72:NO)、θcからθaを減算し2πを加算した値を相対角差θca(=θc−θa+2π)として算出する(S74)。
When the fourth abnormality routine is started, the absolute
続いて、絶対角検出用ECU54は、ステップS73あるいはS74において算出した相対角差θcaに基づいて操舵角の大きさ|θ|を算出する(S75)。
この操舵角の大きさ|θ|は、操舵ハンドル11が左操舵領域に位置するときは左操舵限界位置−θmaxからの回転角度を表し、操舵ハンドル11が右操舵領域に位置するときは中立位置からの回転角度を表す。
この操舵角の大きさ|θ|の算出については、図4の第1絶対舵角算出ルーチンにおけるステップS43,S46と同様に、図11に示す操舵角|θ|テーブルを参照して、あるいは関数を用いて算出する。
Subsequently, the absolute
The magnitude of the steering angle | θ | represents a rotation angle from the left steering limit position −θmax when the steering handle 11 is located in the left steering region, and is a neutral position when the steering handle 11 is located in the right steering region. Represents the rotation angle from.
The calculation of the steering angle magnitude | θ | is similar to steps S43 and S46 in the first absolute steering angle calculation routine of FIG. 4, with reference to the steering angle | θ | table shown in FIG. Calculate using.
続いて、絶対角検出用ECU54は、ステップS76において、相対角差θcaの値が「2π」から「0」側に変化したか否かを判断する。つまり、図8に示すように相対角差θcaの値は、操舵角θに対して鋸歯形状の周期波信号となるが、この波形頂点となる値「2π」から波形谷部となる値「0」側に変化したか否かを判断する。例えば、図8の相対角差θcaの信号波形において、点Aが波形頂点、点Bが波形谷部となる。この場合、直前回検出した相対角差θca(n-1)と今回検出した相対角差θca(n)との関係から、波形頂点Aの通過を判断する。
Subsequently, in step S76, the absolute
左操舵領域に位置する操舵ハンドル11が右方向に回転して右操舵領域に入った場合には、図8の矢印a1にて示すように、相対角差θcaは、波形頂点Aを通過するときに2π減少する。そこで、本実施形態においては、例えば、直前回検出した相対角差θca(n-1)に対して、今回検出した相対角差θca(n)の値が所定値(例えば、π)以上減少した場合に、相対角差θcaの値が「2π」から「0」側に変化したと判断する。
この場合には、操舵ハンドル11が左操舵領域から右操舵領域に入ったと判断して、フラグSIGを「1」に設定する。
When the steering handle 11 located in the left steering region rotates rightward and enters the right steering region, the relative angle difference θca passes through the waveform vertex A as indicated by an arrow a1 in FIG. Decrease by 2π. Therefore, in the present embodiment, for example, the value of the relative angular difference θca (n) detected this time has decreased by a predetermined value (for example, π) or more with respect to the relative angular difference θca (n−1) detected immediately before. In this case, it is determined that the value of the relative angle difference θca has changed from “2π” to “0”.
In this case, it is determined that the steering handle 11 has entered the right steering area from the left steering area, and the flag SIG is set to “1”.
一方、ステップS76において、相対角差θcaの値が「2π」から「0」側に変化していないと判断された場合には(S76:NO)、次に、ステップS78の判断処理を行う。このステップS78においては、相対角差θcaの値が「0」から「2π」側に変化したか否かを判断する。つまり、相対角差θcaの値を表す鋸歯形状の出力信号が、その波形谷部Bとなる値「0」から波形頂点Aとなる値「2π」側に変化したか否かを判断する。 On the other hand, if it is determined in step S76 that the value of the relative angle difference θca has not changed from “2π” to “0” (S76: NO), then the determination process of step S78 is performed. In step S78, it is determined whether or not the value of the relative angle difference θca has changed from “0” to “2π”. That is, it is determined whether or not the sawtooth-shaped output signal representing the value of the relative angle difference θca has changed from the value “0” corresponding to the waveform valley B to the value “2π” corresponding to the waveform vertex A.
この場合においても、直前回検出した相対角差θca(n-1)と今回検出した相対角差θca(n)との関係から、波形頂点Aの通過を判断する。
右操舵領域に位置する操舵ハンドル11が左方向に回転して左操舵領域に入った場合には、図8の矢印a2にて示すように、相対角差θcaは、波形谷部Bを通過するときに2π増大する。そこで、本実施形態においては、例えば、直前回検出した相対角差θca(n-1)に対して、今回検出した相対角差θca(n)の値が所定値(例えば、π)以上増大した場合に、相対角差θcaの値が「0」から「2π」側に変化したと判断する。
この場合には、操舵ハンドル11が右操舵領域から左操舵領域に入ったと判断して、フラグSIGを「0」に設定する。
ステップS76およびステップS78の判断が「NO」の場合には、フラグSIGの設定処理は行わない。
Even in this case, the passage of the waveform apex A is determined from the relationship between the relative angle difference θca (n−1) detected immediately before and the relative angle difference θca (n) detected this time.
When the steering handle 11 located in the right steering region rotates leftward and enters the left steering region, the relative angle difference θca passes through the waveform valley B as shown by an arrow a2 in FIG. Sometimes increases by 2π. Therefore, in the present embodiment, for example, the value of the relative angle difference θca (n) detected this time has increased by a predetermined value (for example, π) or more with respect to the relative angle difference θca (n−1) detected immediately before. In this case, it is determined that the value of the relative angle difference θca has changed from “0” to “2π”.
In this case, it is determined that the steering handle 11 has entered the left steering area from the right steering area, and the flag SIG is set to “0”.
If the determinations in steps S76 and S78 are “NO”, the flag SIG setting process is not performed.
次に、絶対角検出用ECU54は、ステップS80に処理を進める。このステップS80においては、フラグSIGが「1」に設定されているか否かを判断する。フラグSIG=1である場合には(S80:YES)、ステップS81において、操舵ハンドル11の操舵角θ(絶対舵角)を次式のように算出する。
θ=|θ|
この場合、操舵ハンドル11が右操舵領域に位置するため、操舵角の大きさ|θ|は、そのまま操舵ハンドル11の操舵角θとして設定される。
Next, the absolute
θ = | θ |
In this case, since the steering handle 11 is located in the right steering region, the magnitude of the steering angle | θ | is set as the steering angle θ of the steering handle 11 as it is.
一方、ステップS80において「NO」と判断された場合、つまり、フラグSIG=0の場合には、操舵ハンドル11が左操舵領域に位置するため、ステップS82において、操舵ハンドル11の操舵角θ(絶対舵角)を次式のように算出する。
θ=|θ|−θmax
この場合、操舵ハンドル11が左操舵領域に位置するため、操舵角の大きさ|θ|から左操舵限界角度(−θmax)を減算した値が、操舵ハンドル11の操舵角θとして設定される。
On the other hand, if “NO” is determined in the step S80, that is, if the flag SIG = 0, the steering handle 11 is located in the left steering region, and therefore the steering angle θ (absolute) of the steering handle 11 is determined in the step S82. (Steering angle) is calculated as follows:
θ = | θ | −θmax
In this case, since the steering handle 11 is located in the left steering region, a value obtained by subtracting the left steering limit angle (−θmax) from the steering angle magnitude | θ | is set as the steering angle θ of the
絶対角検出用ECU54は、ステップS81あるいはステップS82にて操舵角θを算出すると、次にステップS83において、操舵角θ(絶対舵角θ)を表す舵角検出信号を操舵反力用ECU60および前輪転舵用ECU70に出力し、本制御ルーチンを終了する。
When the absolute
本第4絶対舵角算出ルーチンは、図3にて示す絶対舵角算出ルーチンに組み込まれて第2レゾルバセンサ52の異常時に繰り返し実行される。従って、第2レゾルバセンサ52が故障した場合であっても、第1レゾルバセンサ51、第3レゾルバセンサ53による相対角差θcaに基づいて操舵角θが算出される。
The fourth absolute steering angle calculation routine is incorporated in the absolute steering angle calculation routine shown in FIG. 3 and is repeatedly executed when the
尚、この本第4絶対舵角算出ルーチンにおいて、ステップS76あるいはステップS78にて相対角差θcaの変化(「2π」から「0」、あるいは、「0」から「2π」)を検出したときに、中立位置信号を操舵反力用ECU60および前輪転舵用ECU70に出力するようにしてもよい。
In the fourth absolute steering angle calculation routine, when a change in the relative angle difference θca (“2π” to “0” or “0” to “2π”) is detected in step S76 or step S78. The neutral position signal may be output to the steering
以上本実施形態の車両の操舵装置によれば、3つのレゾルバセンサ51,52,53の出力信号からの相対角差θba,θcb,θcaに基づいて操舵角θおよび中立位置を算出するため、その算出が容易である。しかも、操舵量の変化に対して変動量の大きな相対角差θcaを用いて操舵角θを算出するため、操舵角検出精度が極めて高いものとなる。
また、操舵ハンドル11の中立位置の検出に当たっては、相対角差θcaの値に基づいている(θca=0)ため、その検出が容易である。つまり、相対角差θcaは、操舵ハンドル11の操舵位置が中立位置を通過すると、「0」から「2π」、あるいは、「2π」から「0」に大きく変動する。従って、この相対角差θcaの大きな変動を検出したときに、操舵ハンドル11が中立位置にある(操舵角θ=0)と判定しているため、その検出が容易であり検出精度も高い。
As described above, according to the vehicle steering apparatus of the present embodiment, the steering angle θ and the neutral position are calculated based on the relative angle differences θba, θcb, θca from the output signals of the three
Further, when detecting the neutral position of the
また、こうした絶対舵角θおよび中立位置は、車両が運転状態にあるときに常時算出されるため、運転停止後、次回の運転走行まで記憶しておく必要がない。従って、電源バッテリが外された場合を想定した構成を新たに設ける必要がなく低コストにて実施することができる。また、記憶装置の暗電流の消費を低減することができる。更に、従来装置のように、製造工程に中立位置を記憶させる必要がないため、製造工数を低減することができる。 Since the absolute steering angle θ and the neutral position are always calculated when the vehicle is in a driving state, there is no need to store it until the next driving after the driving is stopped. Therefore, it is not necessary to provide a new configuration assuming that the power battery is removed, and the configuration can be implemented at low cost. Further, the consumption of dark current in the storage device can be reduced. Furthermore, unlike the conventional apparatus, it is not necessary to store the neutral position in the manufacturing process, so that the number of manufacturing steps can be reduced.
更に、車両運転途中においてレゾルバセンサの1つが故障しても、他のレゾルバセンサにより操舵角θを算出するため、操舵反力用ECU60による操舵反力制御、および、前輪転舵用ECU70による前輪転舵制御を継続することができる。
また、第1〜第4絶対舵角算出処理を制御プログラムとして記憶し、レゾルバセンサの故障状況に応じて処理を選択するため、故障状況にあった最適な絶対舵角算出処理を行うことができる。
また、車両の起動時からレゾルバセンサが一つでも故障している場合には、電磁クラッチ32,33の作動により操舵入力軸12と操舵出力軸24とを連結するため、操舵ハンドル11の回動操作により左右前輪FW1,FW2を直接転舵することができる。
これらの結果、ステアバイワイヤ方式の操舵装置の信頼性を向上することができ、車両の安全性向上を図ることができる。
Furthermore, even if one of the resolver sensors fails during vehicle operation, the steering angle θ is calculated by the other resolver sensors, so that the steering reaction force control by the steering
In addition, since the first to fourth absolute steering angle calculation processes are stored as a control program and the process is selected according to the failure state of the resolver sensor, the optimum absolute steering angle calculation process suitable for the failure state can be performed. .
Further, when even one resolver sensor has failed since the start of the vehicle, the steering
As a result, the reliability of the steer-by-wire steering device can be improved, and the safety of the vehicle can be improved.
以上、本発明の回転角検出装置の実施形態として操舵装置について説明したが、本発明は上記実施形態に限定されるものではなく、本発明の目的を逸脱しない限りにおいて種々の変更が可能である。 The steering device has been described as an embodiment of the rotation angle detection device of the present invention. However, the present invention is not limited to the above embodiment, and various modifications can be made without departing from the object of the present invention. .
尚、本実施形態における相対角差θbaおよび相対角差θcbが本発明の第1電気角に相当し、本実施形態における相対角差θcaが本発明の第2電気角に相当する。また、本実施形態における絶対角検出用ECU54が行う絶対舵角算出ルーチンにおけるステップS33,S34,S53,S54,S63,S64の処理が本発明の第1電気角算出手段に相当し、本実施形態における絶対角検出用ECU54が行う絶対舵角算出ルーチンにおけるステップS36,S37,S73,S74の処理が本発明の第2電気角算出手段に相当する。また、本実施形態における絶対角検出用ECU54が行う絶対舵角算出ルーチンにおけるステップS38〜S47の処理が本発明の絶対舵角算出手段に相当する。
また、本実施形態における絶対角検出用ECU54が行う絶対舵角算出ルーチンにおけるステップS21,S23,S25,S27の処理が本発明の異常検出手段に相当する。また、本実施形態における絶対角検出用ECU54が行う操舵角算出ルーチンにおけるステップS55,S65,S75〜S82の処理が本発明の異常時絶対舵角算出手段に相当する。
The relative angle difference θba and the relative angle difference θcb in the present embodiment correspond to the first electrical angle of the present invention, and the relative angle difference θca in the present embodiment corresponds to the second electrical angle of the present invention. In addition, the processing of steps S33, S34, S53, S54, S63, and S64 in the absolute steering angle calculation routine performed by the absolute
Further, the processing of steps S21, S23, S25, and S27 in the absolute steering angle calculation routine performed by the absolute
10…操舵操作装置、11…操舵ハンドル、12…操舵入力軸、13…操舵反力用電動モータ、20…転舵装置、22…転舵用電動モータ、24…転舵出力軸、40…電気制御装置、50…操舵角検出装置、51…第1レゾルバセンサ、51s…第1レゾルバ、51c…第1相対角検出回路、52…第2レゾルバセンサ、52s…第2レゾルバ、52c…第2相対角検出回路、53…第3レゾルバセンサ、53s…第3レゾルバ、53c…第3相対角検出回路、54…絶対角検出用ECU、θ…操舵角(絶対舵角)、θa,θb,θc…相対角、θba,θcb,θca…相対角差。
DESCRIPTION OF
Claims (5)
左操舵限界位置から右操舵限界位置まで操舵部材が操舵されると(n+1)回の周期波形信号を出力する第2レゾルバセンサと、
左操舵限界位置から右操舵限界位置まで操舵部材が操舵されると(n+2)回の周期波形信号を出力する第3レゾルバセンサと、
上記第1レゾルバセンサの信号出力値と上記第2レゾルバセンサの信号出力値との差、あるいは、上記第2レゾルバセンサの信号出力値と上記第3レゾルバセンサの信号出力値との差に基づいて、上記左操舵限界位置から右操舵限界位置までの操舵可能範囲において操舵角の変化に対して1つのピーク値が現れる特性を有する第1電気角を算出する第1電気角算出手段と、
上記第1レゾルバセンサの信号出力値と上記第3レゾルバセンサの信号出力値との差に基づいて、上記左操舵限界位置から右操舵限界位置までの操舵可能範囲において操舵角の変化に対して2つのピーク値が現れる特性を有する第2電気角を算出する第2電気角算出手段と、
上記第1電気角算出手段により算出された第1電気角と、上記第2電気角算出手段により算出された第2電気角とに基づいて、上記操舵部材の中立位置と絶対舵角とを算出する絶対舵角算出手段と
を備えたことを特徴とする操舵角検出装置。 A first resolver sensor that outputs n periodic waveform signals when the steering member is steered from the left steering limit position to the right steering limit position;
A second resolver sensor that outputs a (n + 1) number of periodic waveform signals when the steering member is steered from the left steering limit position to the right steering limit position;
A third resolver sensor that outputs a periodic waveform signal of (n + 2) times when the steering member is steered from the left steering limit position to the right steering limit position;
Based on the difference between the signal output value of the first resolver sensor and the signal output value of the second resolver sensor, or the difference between the signal output value of the second resolver sensor and the signal output value of the third resolver sensor. A first electrical angle calculating means for calculating a first electrical angle having a characteristic in which one peak value appears with respect to a change in the steering angle in a steerable range from the left steering limit position to the right steering limit position;
Based on the difference between the signal output value of the first resolver sensor and the signal output value of the third resolver sensor, 2 for the change of the steering angle in the steerable range from the left steering limit position to the right steering limit position. Second electrical angle calculating means for calculating a second electrical angle having a characteristic in which two peak values appear;
Based on the first electrical angle calculated by the first electrical angle calculation means and the second electrical angle calculated by the second electrical angle calculation means, the neutral position and the absolute steering angle of the steering member are calculated. A steering angle detection device comprising: an absolute steering angle calculation means.
上記3つのレゾルバセンサのうち1つのレゾルバセンサの異常が検出されたとき、異常が検出されていない2つのレゾルバセンサの信号出力値の差に基づいて、上記操舵部材の絶対舵角を算出する異常時絶対舵角算出手段と
を備えたことを特徴とする請求項1ないし請求項3の何れか一項記載の操舵角検出装置。 An abnormality detecting means for detecting an abnormality of the first resolver sensor, the second resolver sensor, and the third resolver sensor;
An abnormality that calculates an absolute steering angle of the steering member based on a difference between signal output values of two resolver sensors in which no abnormality is detected when an abnormality of one of the three resolver sensors is detected The steering angle detection device according to any one of claims 1 to 3, further comprising: hour absolute steering angle calculation means.
When the abnormality is detected in the second resolver sensor, the absolute steering angle calculation means at the time of abnormality determines the steering position of the steering member based on the transition of the second electric angle calculated by the second electric angle calculation means. 5. The steering according to claim 4, wherein it is determined whether the vehicle is in a right steering region or a left steering region, and the absolute steering angle is calculated based on the region determination result and the value of the second electrical angle. Angle detection device.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2006168231A JP2007333657A (en) | 2006-06-19 | 2006-06-19 | Steering angle detector |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2006168231A JP2007333657A (en) | 2006-06-19 | 2006-06-19 | Steering angle detector |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2007333657A true JP2007333657A (en) | 2007-12-27 |
Family
ID=38933259
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2006168231A Pending JP2007333657A (en) | 2006-06-19 | 2006-06-19 | Steering angle detector |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2007333657A (en) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010137821A (en) * | 2008-12-15 | 2010-06-24 | Toyota Motor Corp | Wheel steering control device |
JP2011005933A (en) * | 2009-06-25 | 2011-01-13 | Nissan Motor Co Ltd | Steering control device, angle detecting device, and vehicle with steering control device |
JP2012011861A (en) * | 2010-06-30 | 2012-01-19 | Toyota Motor Corp | Vehicle steering device |
WO2016059903A1 (en) * | 2014-10-17 | 2016-04-21 | 日本精工株式会社 | Electric power steering device |
JP2017052448A (en) * | 2015-09-10 | 2017-03-16 | 株式会社ジェイテクト | Steering control device |
JP2018128429A (en) * | 2017-02-10 | 2018-08-16 | 株式会社デンソー | Rotation detector |
CN110371181A (en) * | 2018-04-12 | 2019-10-25 | 奥迪股份公司 | The method to decay to the oscillation of superposing type steering system |
-
2006
- 2006-06-19 JP JP2006168231A patent/JP2007333657A/en active Pending
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010137821A (en) * | 2008-12-15 | 2010-06-24 | Toyota Motor Corp | Wheel steering control device |
JP2011005933A (en) * | 2009-06-25 | 2011-01-13 | Nissan Motor Co Ltd | Steering control device, angle detecting device, and vehicle with steering control device |
JP2012011861A (en) * | 2010-06-30 | 2012-01-19 | Toyota Motor Corp | Vehicle steering device |
CN102958783A (en) * | 2010-06-30 | 2013-03-06 | 丰田自动车株式会社 | Vehicle steering device |
US10053142B2 (en) | 2014-10-17 | 2018-08-21 | Nsk Ltd. | Electric power steering apparatus |
JP5967338B1 (en) * | 2014-10-17 | 2016-08-10 | 日本精工株式会社 | Electric power steering device |
CN107074272A (en) * | 2014-10-17 | 2017-08-18 | 日本精工株式会社 | Electric power-assisted steering apparatus |
WO2016059903A1 (en) * | 2014-10-17 | 2016-04-21 | 日本精工株式会社 | Electric power steering device |
CN107074272B (en) * | 2014-10-17 | 2019-03-26 | 日本精工株式会社 | Electric power steering apparatus |
JP2017052448A (en) * | 2015-09-10 | 2017-03-16 | 株式会社ジェイテクト | Steering control device |
JP2018128429A (en) * | 2017-02-10 | 2018-08-16 | 株式会社デンソー | Rotation detector |
CN110371181A (en) * | 2018-04-12 | 2019-10-25 | 奥迪股份公司 | The method to decay to the oscillation of superposing type steering system |
US11377147B2 (en) | 2018-04-12 | 2022-07-05 | Audi Ag | Damping of an oscillation of a superimposed steering system |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102916641B (en) | Multi-phase rotary machine control appliance and use its electric boosting steering system | |
JP5679136B2 (en) | Rotation angle detection device and electric power steering device provided with rotation angle detection device | |
JP3789791B2 (en) | Absolute position detection apparatus and absolute position detection method | |
JP7047738B2 (en) | Steering system | |
JP2007333657A (en) | Steering angle detector | |
JP2009029217A (en) | Steering assisting device | |
EP2369317A1 (en) | Torque detector and electric power steering system | |
JP2005091137A (en) | Rudder angle sensor | |
US9638509B2 (en) | Phase difference detector and rotation angle detection device including the same | |
JP2007206018A (en) | Rotation angle detector, abnormality detector therefor, and motor-driven power steering unit | |
JP2007333658A (en) | Rotation angle detector | |
CN109073354A (en) | The control device of angle detection device and electric power steering | |
JP2017196991A (en) | Steering control device | |
US9658050B2 (en) | Rotation angle detection device | |
JP4281595B2 (en) | Angle detector | |
JP4882513B2 (en) | Rotation angle detection device and torque sensor | |
JP6672652B2 (en) | Steering control device | |
JP2020165952A (en) | Detector and control device | |
JP2008037255A (en) | Electric power steering device | |
JP5950459B2 (en) | Power steering device | |
JP2018113836A (en) | Motor control device, electric power steering device and vehicle | |
JP2008203199A (en) | Rotation angle detector | |
JP4380317B2 (en) | Correction value detection method for torque sensor device | |
JP2020079000A (en) | Vehicle control device | |
JP2007327800A (en) | Rotation angle detector, and electric power steering device equipped therewith |