JP2015148079A - Opening and closing body control device - Google Patents
Opening and closing body control device Download PDFInfo
- Publication number
- JP2015148079A JP2015148079A JP2014020926A JP2014020926A JP2015148079A JP 2015148079 A JP2015148079 A JP 2015148079A JP 2014020926 A JP2014020926 A JP 2014020926A JP 2014020926 A JP2014020926 A JP 2014020926A JP 2015148079 A JP2015148079 A JP 2015148079A
- Authority
- JP
- Japan
- Prior art keywords
- opening
- motor
- closing body
- differential value
- closing
- 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
- 238000001514 detection method Methods 0.000 claims abstract description 34
- 239000005357 flat glass Substances 0.000 abstract description 54
- 238000000034 method Methods 0.000 description 39
- 230000008569 process Effects 0.000 description 37
- 230000007423 decrease Effects 0.000 description 6
- 230000007246 mechanism Effects 0.000 description 6
- 230000004913 activation Effects 0.000 description 5
- 230000003247 decreasing effect Effects 0.000 description 4
- 230000008859 change Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000007704 transition Effects 0.000 description 2
- 230000008901 benefit Effects 0.000 description 1
- 238000009499 grossing Methods 0.000 description 1
- 230000000630 rising effect Effects 0.000 description 1
Images
Landscapes
- Power-Operated Mechanisms For Wings (AREA)
- Window Of Vehicle (AREA)
Abstract
Description
本発明は、車両の開閉体の開閉を制御する装置に関し、特に、開閉体の閉動作時に異物の挟み込みを検出する機能を備えた開閉体制御装置に関する。 The present invention relates to an apparatus for controlling opening / closing of an opening / closing body of a vehicle, and more particularly, to an opening / closing body control apparatus having a function of detecting a foreign object being caught when the opening / closing body is closed.
車両に搭載される開閉体制御装置として、たとえばパワーウインドウ制御装置がある。パワーウインドウ制御装置は、モータを正転または逆転して、パワーウインドウ開閉機構を作動させることにより、開閉体である窓ガラスを開閉動作させる。 As an opening / closing body control device mounted on a vehicle, for example, there is a power window control device. The power window control device opens and closes the window glass, which is an opening and closing body, by rotating the motor forward or backward and operating the power window opening and closing mechanism.
また、パワーウインドウ制御装置では、窓の閉動作時に、窓への異物の挟み込みがあると、これが検出される。具体的には、たとえば特許文献1では、モータの回転に応じてパルス発生器から発生されたパルス信号に基づき、モータの周期を算出し、該周期と所定の閾値との比較結果に基づいて、挟み込みの有無を判定している。
In the power window control device, when a foreign object is caught in the window during the window closing operation, this is detected. Specifically, for example, in
モータの周期以外に、モータの回転数、周波数、負荷、またはモータに流れる電流などのような、モータの駆動状態を表す物理量と、所定の閾値とに基づいて、挟み込みの有無を検出する方法も種々提案されている。 In addition to the motor cycle, there is also a method for detecting the presence or absence of pinching based on a physical quantity representing the driving state of the motor, such as the motor rotation speed, frequency, load, or current flowing through the motor, and a predetermined threshold. Various proposals have been made.
また、特許文献1では、ドアを閉めた時の衝撃や、モータ起動直後の動作の不安定などの種々の要因により、モータの周期が上昇して、挟み込みであると誤判定するのを防止するため、周期が判定値より大きい状態が連続している場合に、周期の2回微分値を算出している。そして、2回微分値が負の値である間は、挟み込みの判定を行わないようにしている。
Further, in
たとえばパワーウインドウ制御装置では、窓を閉動作させるためのモータの起動直後に、パワーウインドウ開閉機構のあそびなどの機械的要因により、モータの駆動状態が不安定になることがある。特に、ワイヤー式のパワーウインドウ開閉機構では、ワイヤーの弛みがモータの駆動を不安定にする主な機械的要因となる。モータの駆動状態が不安定になると、モータの回転数やモータに流れる電流などが上下に振動するため、モータの駆動状態を表す物理量に基づいて、窓に異物を挟み込んだと誤検出してしまうおそれがある。 For example, in a power window control device, the drive state of the motor may become unstable due to mechanical factors such as play of the power window opening / closing mechanism immediately after the start of the motor for closing the window. In particular, in a wire-type power window opening / closing mechanism, loosening of the wire is a main mechanical factor that makes the drive of the motor unstable. If the motor drive state becomes unstable, the motor rotation speed and the current flowing through the motor vibrate up and down, so that it is erroneously detected that a foreign object is caught in the window based on a physical quantity that represents the motor drive state. There is a fear.
本発明の課題は、開閉体を閉動作させるためのモータの起動直後に、開閉体への異物の挟み込みを誤検出することを防止できる開閉体制御装置を提供することである。 An object of the present invention is to provide an opening / closing body control device that can prevent erroneous detection of foreign matter caught in an opening / closing body immediately after the start of a motor for closing the opening / closing body.
本発明による開閉体制御装置は、車両の開閉体を開閉動作させるモータの駆動を制御する装置であって、開閉体の閉動作時におけるモータの駆動状態を表す物理量を順次検出する検出手段と、この検出手段が検出した物理量の2回微分値を算出する2回微分値算出手段と、この2回微分値算出手段が算出した2回微分値と予め設定された安定閾値とを比較した結果に基づいて、物理量が安定したか否かを判定する安定判定手段と、この安定判定手段により物理量が安定したと判定された場合に、物理量と予め設定された挟み込み閾値とに基づいて、開閉体への異物の挟み込みの有無を判定する挟み込み判定手段とを備えている。 An opening / closing body control apparatus according to the present invention is an apparatus that controls driving of a motor that opens and closes an opening / closing body of a vehicle, and that sequentially detects a physical quantity representing a driving state of the motor when the opening / closing body is closed, As a result of comparing the twice differential value calculating means for calculating the twice differential value of the physical quantity detected by the detecting means, and the twice differential value calculated by the twice differential value calculating means and a preset stable threshold value. Based on the stability determination means for determining whether the physical quantity is stable based on the physical quantity and a preset pinching threshold when the stability determination means determines that the physical quantity is stable. And a pinch judging means for judging whether or not the foreign object is pinched.
上記によると、開閉体の閉動作時に、モータの駆動状態を表す物理量の2回微分値、すなわち物理量の差分値の差分値と、安定閾値との比較結果に基づいて、物理量が安定したか否かを判定している。このとき、たとえば、物理量の2回微分値が正の値であっても、負の値であっても、その絶対値が安定閾値以下である場合に、物理量が安定したと判定する。そして、物理量が安定したと判定された場合に、物理量と挟み込み閾値とに基づいて、開閉体への異物の挟み込みの有無を判定している。つまり、物理量が安定するまでは、物理量と挟み込み閾値とに基づいて挟み込みの有無を判定しないので、開閉体を閉動作させるためのモータの起動直後に、機械的要因によりモータの駆動状態が不安定になっても、開閉体への異物の挟み込みの誤検出を防止することができる。 According to the above, whether or not the physical quantity is stabilized based on the comparison result between the second differential value of the physical quantity representing the driving state of the motor, that is, the difference value of the physical quantity difference value, and the stability threshold value when the opening / closing body is closed. Judging. At this time, for example, if the absolute value of the double differential value of the physical quantity is a positive value or a negative value, the physical quantity is determined to be stable. Then, when it is determined that the physical quantity is stable, the presence / absence of foreign matter sandwiched in the opening / closing body is determined based on the physical quantity and the sandwiching threshold value. In other words, until the physical quantity is stabilized, the presence or absence of pinching is not determined based on the physical quantity and the pinching threshold value, so that the motor drive state is unstable due to mechanical factors immediately after starting the motor for closing the opening / closing body. Even in this case, it is possible to prevent erroneous detection of foreign matter caught in the opening / closing body.
また、本発明では、上記開閉体制御装置において、物理量の1回微分値を算出する1回微分値算出手段をさらに備え、挟み込み判定手段は、1回微分値算出手段が算出した1回微分値と挟み込み閾値とを比較した結果に基づいて、開閉体への異物の挟み込みの有無を判定してもよい。 In the present invention, the opening / closing body control device further includes a one-time differential value calculating means for calculating a one-time differential value of the physical quantity, and the pinching determining means is the one-time differential value calculated by the one-time differential value calculating means. Whether or not foreign matter is caught in the opening / closing body may be determined based on the result of comparing the pinching threshold and the pinching threshold.
また、本発明では、上記開閉体制御装置において、安定判定手段は、2回微分値が複数回連続で安定閾値以下となった場合に、物理量が安定したと判定してもよい。 In the present invention, in the above opening / closing body control device, the stability determination means may determine that the physical quantity is stable when the double differential value is continuously equal to or less than the stability threshold value a plurality of times.
また、本発明では、上記開閉体制御装置において、安定判定手段により物理量が安定したと判定されないまま、開閉体の移動量が所定値を超えた場合に、挟み込み判定手段は、開閉体への異物の挟み込みの有無を判定してもよい。 Further, in the present invention, in the opening / closing body control device, when the movement amount of the opening / closing body exceeds a predetermined value without being determined that the physical quantity is stable by the stability determination section, the pinching determination section The presence or absence of pinching may be determined.
また、本発明では、上記開閉体制御装置において、検出手段は、物理量として、モータの駆動状態に応じたパルス信号を出力する出力手段から出力された、パルス信号の周波数を順次検出してもよい。または、検出手段は、物理量として、モータに流れる電流を順次検出してもよい。あるいは、検出手段は、物理量として、モータに流れる電流に含まれるリップルの周波数を順次検出してもよい。 In the present invention, in the above opening / closing body control device, the detection means may sequentially detect the frequency of the pulse signal output from the output means for outputting the pulse signal corresponding to the driving state of the motor as a physical quantity. . Alternatively, the detection means may sequentially detect the current flowing through the motor as a physical quantity. Alternatively, the detection means may sequentially detect the ripple frequency included in the current flowing through the motor as a physical quantity.
本発明によれば、開閉体を閉動作させるためのモータの起動直後に、開閉体への異物の挟み込みを誤検出することを防止できる開閉体制御装置を提供することが可能となる。 ADVANTAGE OF THE INVENTION According to this invention, it becomes possible to provide the opening / closing body control apparatus which can prevent erroneously detecting the foreign object being caught in the opening / closing body immediately after the start of the motor for closing the opening / closing body.
以下、本発明の実施形態につき、図面を参照しながら説明する。各図において、同一の部分または対応する部分には、同一符号を付してある。 Hereinafter, embodiments of the present invention will be described with reference to the drawings. In the drawings, the same or corresponding parts are denoted by the same reference numerals.
まず、第1実施形態の構成を、図1を参照しながら説明する。以下では、「パワーウインドウ」を「PW」と表記する。 First, the configuration of the first embodiment will be described with reference to FIG. Hereinafter, the “power window” is expressed as “PW”.
第1実施形態のPW制御システム100は、自動車に搭載され、PW制御装置1とその他の構成要素6〜10を含んでいる。
A PW control system 100 according to the first embodiment is mounted on an automobile and includes a
PW制御装置1は、モータ9を駆動して、PW開閉機構8を作動させ、車両のドアに設けられた窓6の窓ガラス7を開閉動作させる。PW制御装置1は、本発明の「開閉体制御装置」の一例である。窓6および窓ガラス7は、本発明の「開閉体」の一例である。
The
PW制御装置1には、制御部2、PW操作部3、駆動部4、パルス検出部5、およびロータリエンコーダ10が備わっている。ロータリエンコーダ10は、PW制御装置1の外部に設けられていてもよい。
The
制御部2は、マイクロコンピュータから成り、窓6の開閉を制御する。制御部2には、周波数検出部2a、記憶部2b、2回微分値算出部2c、安定判定部2d、1回微分値算出部2e、および挟み込み判定部2fが設けられている。
The
PW操作部3は、窓6の開閉を操作するためのスイッチから成り、車内に設けられている。PW操作部3は、利用者により操作されて、その操作に応じた信号を出力する。制御部2は、PW操作部3から出力される信号に基づいて、PW操作部3の操作状態を検出する。本例では、PW操作部3でマニュアル開閉操作とオート開閉操作を行うことができる。
The
駆動部4は、モータ9を正転または逆転で駆動する回路から成る。ロータリエンコーダ10は、モータ9の回転駆動状態に応じたパルス信号を出力する。パルス検出部5は、ロータリエンコーダ10から出力されたパルス信号を検出する回路から成る。ロータリエンコーダ10は、本発明の「出力手段」の一例である。
The
PW操作部3により開閉操作を行うと、制御部2が、その操作状態に応じて駆動部4を制御して、モータ9を正転または逆転させる。これにより、PW開閉機構8が作動して、窓ガラス7が下降または上昇し、窓6が開閉される。
When the opening / closing operation is performed by the
その際、制御部2は、パルス検出部5によるロータリエンコーダ10からのパルス信号の検出結果に基づいて、窓ガラス7の開閉移動量やモータ9の回転数を算出する。そして、制御部2は、その算出結果に基づいて、駆動部4によりモータ9の回転を制御する。
At that time, the
また、窓ガラス7の閉動作時に、制御部2の周波数検出部2aが、パルス検出部5により検出されたパルス信号の周波数を順次検出する。この検出された周波数は、モータ9の駆動状態を表す物理量の一例であり、以下では「モータ周波数」という。周波数検出部2aにより検出されたモータ周波数は、記憶部2bに順次記憶される。記憶部2bには、その他の制御データも記憶される。周波数検出部2aは、本発明の「検出手段」の一例である。
In addition, when the window glass 7 is closed, the
また、窓ガラス7の閉動作時に、2回微分値算出部2cは、モータ周波数の2回微分値を算出する。たとえば、検出されたモータ周波数は有限の離散的なデータであるので、これらのデータを用いて微分値を近似する。本実施形態では、モータ周波数の差分値を微分値と近似し、モータ周波数の差分値の差分値を2回微分値とする。近似方法は、これに限定されない。
In addition, when the window glass 7 is closed, the twice differential
安定判定部2dは、2回微分値算出部2cにより算出された2回微分値と、予め設定された安定閾値とを比較し、その比較結果に基づいて、モータ周波数が安定しているか否かを判定する。2回微分値算出部2cは、本発明の「2回微分値算出手段」の一例である。安定判定部2dは、本発明の「安定判定手段」の一例である。
The
また、窓ガラス7の閉動作時に、1回微分値算出部2eは、モータ周波数の1回微分値、すなわちモータ周波数の差分値を算出する。挟み込み判定部2fは、安定判定部2dによりモータ周波数が安定していると判定された場合に、モータ周波数と予め設定された挟み込み閾値とに基づいて、窓6への異物の挟み込みの有無を判定する。
Further, when the window glass 7 is closed, the one-time differential
具体的には、挟み込み判定部2fは、1回微分値算出部2eにより算出されたモータ周波数の1回微分値と、挟み込み閾値とを比較し、その比較結果に基づいて、窓6への異物の挟み込みの有無を判定する。1回微分値算出部2eは、本発明の「1回微分値算出手段」の一例である。挟み込み判定部2fは、本発明の「挟み込み判定手段」の一例である。
Specifically, the
次に、PW制御装置1の動作を、図2〜図8を参照しながら説明する。本動作は、窓6を閉じる場合の動作である。
Next, the operation of the
図2は、PW制御装置1のメイン動作を示したフローチャートである。利用者がPW操作部3で閉操作を行うと、制御部2は、窓6の閉操作が有ったことを検出し(ステップS1)、駆動部4によりモータ9を駆動して、窓ガラス7の閉動作を開始する(ステップS2)。
FIG. 2 is a flowchart showing the main operation of the
このとき、PW操作部3でマニュアル閉操作が行われた場合は、マニュアル閉操作が行われている間だけ、窓ガラス7の閉動作が行われる。また、PW操作部3でオート閉操作が行われた場合は、その後オート閉操作が解除されても、窓ガラス7が全閉位置に到達するまで、閉動作が行われる。但し、窓6に異物が挟み込まれた場合は、窓ガラス7の閉動作が停止される。
At this time, when the manual closing operation is performed by the
窓ガラス7の閉動作が開始されると、モータ9の駆動状態に応じたパルス信号がロータリエンコーダ10から出力されて、パルス検出部5により検出される。すると、制御部2は、パルス検出部5で検出されたパルス信号に基づいて、周波数検出部2aによりモータ周波数を検出する(ステップS3)。
When the closing operation of the window glass 7 is started, a pulse signal corresponding to the driving state of the
詳しくは、周波数検出部2aが、パルス検出部5で検出された各パルス信号の周波数を算出した後、所定の係数や関数で補正し、その補正後周波数F(n)を平滑化用のフィルタにより処理して、補正後周波数の1次遅れFn(n)を検出する。そして、補正後周波数F(n)と補正後周波数の1次遅れFn(n)とを、モータ周波数とする。nは任意数である。このように、モータ周波数として、補正後周波数F(n)と補正後周波数の1次遅れFn(n)とを検出するのは、モータ9の駆動状態が安定したときの、モータ周波数の変動を小さく抑えて、後述する安定判定や挟み込み判定の精度を高めるためである。
Specifically, after the
また、制御部2は、パルス検出部5で検出されたパルス信号に基づいて、モータ9を起動してからの窓ガラス7の移動量Pを検出する(図2のステップS4)。詳しくは、制御部2は、パルス信号の立ち上がりなどの数を数えて、その計数値を窓ガラス7の移動量Pとする。
Moreover, the
上記のように検出されたモータ周波数F(n)、Fn(n)と窓ガラス7の移動量Pとは、関連付けて記憶部2bに随時記憶される。
The motor frequencies F (n) and Fn (n) detected as described above and the movement amount P of the window glass 7 are associated and stored in the
図7は、窓ガラス7の閉方向への移動量Pに対する、モータ周波数F(n)、Fn(n)の変化と、後述する各微分値と各閾値の一例を示した図である。 FIG. 7 is a diagram showing an example of changes in motor frequencies F (n) and Fn (n) with respect to the amount of movement P in the closing direction of the window glass 7, and differential values and threshold values described later.
窓ガラス7を閉動作するためのモータ9の起動直後は、PW開閉機構8のあそびなどの機械的要因により、モータ9の駆動状態が不安定になる。このため、図7に示すように、モータ9の起動直後に、補正後周波数F(n)と補正後周波数の1次遅れFn(n)とが上下に振動し、その後その振動幅が徐々に小さくなって行く。そして、窓6に異物が挟み込まれなければ、補正後周波数F(n)と補正後周波数の1次遅れFn(n)とは、ほぼ一定値に安定して行く。また、窓6に異物が挟み込まれると、補正後周波数F(n)と補正後周波数の1次遅れFn(n)とは、単調(一定)に減少して行く。
Immediately after starting the
モータ9の起動直後の不安定な状態(周波数が上下に振動した状態)で、モータ周波数に基づいて、窓6への異物の挟み込みの有無を判定すると、挟み込みが有ると誤判定してしまうことがある。そこで、挟み込みの有無を判定する前に、モータ周波数が安定しているか否かを確認する。以下、その詳細について説明する。 If it is determined whether or not foreign matter is caught in the window 6 based on the motor frequency in an unstable state immediately after the start of the motor 9 (frequency is oscillated up and down), it may be erroneously determined that there is pinching. There is. Therefore, it is confirmed whether or not the motor frequency is stable before determining the presence or absence of pinching. The details will be described below.
図8は、モータ周波数と各微分値の変化の一例を示した図である。たとえば、図8の(a)欄に示すように、モータ周波数(たとえば、補正後周波数の1次遅れFn(n))がsin(サイン)カーブを描くような、上下に振動した不安定状態で推移した場合、モータ周波数の1回微分値は、cos(コサイン)カーブを描くように推移する。そして、モータ周波数の2回微分値は、−sin(マイナスサイン)カーブを描くように推移する。 FIG. 8 is a diagram illustrating an example of changes in the motor frequency and each differential value. For example, as shown in the column (a) of FIG. 8, in an unstable state in which the motor frequency (for example, the first-order lag Fn (n) of the corrected frequency) oscillates vertically, draws a sin (sine) curve. In the case of transition, the one-time differential value of the motor frequency transitions so as to draw a cos (cosine) curve. Then, the twice differential value of the motor frequency changes so as to draw a −sin (minus sign) curve.
これに対して、図8の(b)欄に示すように、モータ周波数がほぼ平坦(一定)となるような安定状態で推移した場合、モータ周波数の1回微分値と2回微分値は、ほぼ0で推移する。 On the other hand, as shown in the column (b) of FIG. 8, when the motor frequency changes in a stable state such that the motor frequency is substantially flat (constant), the first and second differential values of the motor frequency are It changes at almost zero.
また、窓6に異物が挟み込まれたため、図8の(c)欄に示すように、モータ周波数が単調に減少するように推移した場合(本例では、この場合も安定状態とみなす。)、モータ周波数の1回微分値は、一旦下降した後、ほぼ一定値で推移する。そして、モータ周波数の2回微分値は、一旦下降した後上昇して、ほぼ0で推移する。 In addition, since a foreign object is caught in the window 6, as shown in the column (c) of FIG. 8, when the motor frequency changes so as to monotonously decrease (in this example, this case is also regarded as a stable state). The once differentiated value of the motor frequency once decreases and then changes at a substantially constant value. Then, the twice-differentiated value of the motor frequency once rises and then rises and changes at almost zero.
つまり、モータ周波数の2回微分値がほぼ0である状態が続くことから、モータ周波数が安定したこと(上下に振動していない状態)を検出することができる。 That is, since the state where the twice differential value of the motor frequency is approximately zero continues, it is possible to detect that the motor frequency is stable (a state in which the motor frequency does not vibrate up and down).
そのために、制御部2は、2回微分値算出部2cにより2回微分値の算出処理を実行する(図2のステップS5)。
For this purpose, the
図3は、2回微分値算出処理の詳細を示したフローチャートである。2回微分値算出部2cは、直前の図2のステップS4で検出された現在の窓ガラス7の移動量Pを確認する(図3のステップS21)。
FIG. 3 is a flowchart showing details of the twice differential value calculation processing. The twice differential
そして、現在の窓ガラス7の移動量Pが、所定の安定判定用差分間隔Nを2倍した値以下であるときは(ステップS21:P≦2N、図7のT1区間)、2回微分値算出部2cは、所定の安定閾値Qに1を加算した値を、モータ周波数Fn(n)の2回微分値d2Fn(n)とする(ステップS22、d2Fn(n)=Q+1)。
When the current movement amount P of the window glass 7 is equal to or less than a value obtained by doubling the predetermined stability determination difference interval N (step S21: P ≦ 2N, T1 interval in FIG. 7), a differential value twice. The
ここで、上記のように2回微分値d2Fn(n)を設定するのは、次の理由による。窓ガラス7の移動量Pにおけるモータ周波数と、Pから所定の安定判定用差分間隔N離れた移動量P+Nにおけるモータ周波数とから1回微分の演算を行う場合、2回微分の演算を行うには、さらにPから2N離れた移動量P+2Nにおけるモータ周波数が必要となる。しかし、窓ガラス7の移動量Pが2N以下の場合には、2回微分が計算できないため、図7のT1区間においては、2回微分値d2Fn(n)が安定閾値Qを超える値(本例では、Q+1)に強制的に設定されている。 Here, the reason why the twice differential value d 2 Fn (n) is set as described above is as follows. To perform a first differential calculation from the motor frequency at the movement amount P of the window glass 7 and the motor frequency at the movement amount P + N separated from the P by a predetermined stability determination difference interval N, Further, a motor frequency at a movement amount P + 2N that is 2N away from P is required. However, since the second derivative cannot be calculated when the movement amount P of the window glass 7 is 2N or less, the value twice the differential value d 2 Fn (n) exceeds the stability threshold Q in the T1 section of FIG. (In this example, it is forcibly set to Q + 1).
一方、窓ガラス7の移動量Pが、安定判定用差分間隔Nを2倍した値に1を加算した値以上になると(図3のステップS21:P≧2N+1、図7のT2区間)、2回微分値算出部2cは、次のようにモータ周波数Fn(n)の2回微分値d2Fn(n)を算出する。
On the other hand, when the moving amount P of the window glass 7 is equal to or greater than the value obtained by adding 1 to the value obtained by doubling the stability determination difference interval N (step S21 in FIG. 3: P ≧ 2N + 1, T2 section in FIG. 7), 2 The second differential
まず、今回の補正後周波数の1次遅れFn(n)から前回の補正後周波数の1次遅れFn(n−N)を減算した値を、今回の差分値dFn(n)とする。また、前回の補正後周波数の1次遅れFn(n−N)から前々回の補正後周波数の1次遅れFn(n−2N)を減算した値を、前回の差分値dFn(n−N)とする。そして、今回の差分値dFn(n)から前回の差分値dFn(n−N)を減算した値を、モータ周波数Fn(n)の2回微分値d2Fn(n)とする(ステップS23、d2Fn(n)=Fn(n)−2Fn(n−N)+Fn(n−2N))。
d2Fn(n)=dFn(n)−dFn(n−N)
=(Fn(n)−Fn(n−N))−(Fn(n−N)−Fn(n−2N))
=Fn(n)−2Fn(n−N)+Fn(n−2N)
First, a value obtained by subtracting the first-order delay Fn (n−N) of the previous corrected frequency from the first-order delay Fn (n) of the current corrected frequency is set as a current difference value dFn (n). Further, a value obtained by subtracting the first-order lag Fn (n−2N) of the frequency after the previous correction from the first-order lag Fn (n−N) of the previous corrected frequency is referred to as a previous difference value dFn (n−N). To do. Then, a value obtained by subtracting the previous difference value dFn (n−N) from the current difference value dFn (n) is set as a twice-differentiated value d 2 Fn (n) of the motor frequency Fn (n) (step S23, d 2 Fn (n) = Fn (n) -2Fn (n-n) + Fn (n-2N)).
d 2 Fn (n) = dFn (n) −dFn (n−N)
= (Fn (n) -Fn (n-N))-(Fn (n-N) -Fn (n-2N))
= Fn (n) -2Fn (n-N) + Fn (n-2N)
次に、制御部2は、1回微分値算出部2eにより1回微分値算出処理を実行する(図2のステップS6)。なお、この1回微分値算出処理は、ステップS5の2回微分値算出処理の前に行ってもよいし、2回微分値算出処理と同時に行ってもよい。
Next, the
図4は、1回微分値算出処理の詳細を示したフローチャートである。まず、1回微分値算出部2eは、挟み込み判定許可ポイントPbが設定されているか否かを確認する(ステップS31)。挟み込み判定許可ポイントPbとは、挟み込み判定を許可したときの窓ガラス7の移動量を示す値であって、後述する図2のステップS11で設定される。
FIG. 4 is a flowchart showing details of the single differential value calculation process. First, the one-time differential
挟み込み判定許可ポイントPbが未だ設定されていない場合は(図4のステップS31:NO)、1回微分値算出部2eは、0をモータ周波数F(n)の1回微分値dF(n)とする(ステップS33、dF(n)=0)。
When the pinching determination permission point Pb has not yet been set (step S31 in FIG. 4: NO), the one-time differential
一方、後述する図2のステップS11により、挟み込み判定許可ポイントPbが設定された場合は(図4のステップS31:YES)、1回微分値算出部2eは、現在の窓ガラス7の移動量Pを確認する(ステップS32)。
On the other hand, when the pinch determination permission point Pb is set in step S11 of FIG. 2 to be described later (step S31 of FIG. 4: YES), the one-time differential
そして、現在の窓ガラス7の移動量Pが、挟み込み判定許可ポイントPbから1を減算した値以下であるときは(ステップS32:P≦Pb−1、図7のT5区間)、1回微分値算出部2eは、0をモータ周波数F(n)の1回微分値dF(n)とする(ステップS33、dF(n)=0)。
When the current movement amount P of the window glass 7 is equal to or less than the value obtained by subtracting 1 from the pinching determination permission point Pb (step S32: P ≦ Pb−1, T5 section in FIG. 7), a differential value once. The
また、現在の窓ガラス7の移動量Pが、挟み込み判定許可ポイントPb以上でかつ、挟み込み判定許可ポイントPbに所定の挟み込み判定用差分間隔Mを加算した値以下であるときは(ステップS32:Pb≦P≦Pb+M、図7のT6区間)、今回の補正後周波数F(n)から挟み込み判定許可ポイントPbのときの補正後周波数F(Pb)を減算した値を、モータ周波数F(n)の1回微分値dF(n)とする(ステップS34、dF(n)=F(n)−F(Pb))。 Further, when the current movement amount P of the window glass 7 is not less than the pinching determination permission point Pb and not more than a value obtained by adding a predetermined pinching determination difference interval M to the pinching determination permission point Pb (step S32: Pb ≦ P ≦ Pb + M, section T6 in FIG. 7), a value obtained by subtracting the corrected frequency F (Pb) at the time of the pinching determination permission point Pb from the current corrected frequency F (n) is the motor frequency F (n). One-time differential value dF (n) is set (step S34, dF (n) = F (n) −F (Pb)).
ここで、上記のように1回微分値dF(n)を設定するのは、次の理由による。挟み込み判定許可ポイントPb以上の窓ガラス7の移動量Pにおける補正後周波数と、Pから所定の挟み込み判定用差分間隔M離れた移動量P+Mにおける補正後周波数とから1回微分の演算を行う場合、窓ガラス7の移動量PがPa+M以下のときには、1回微分値が計算できない。このため、図7のT6区間においては、1回微分値dF(n)が、今回の補正後周波数F(n)から挟み込み判定許可ポイントPbにおける補正後周波数F(Pb)を減算した値に強制的に設定されている。 Here, the reason for setting the differential value dF (n) once as described above is as follows. When performing a one-time differential operation from the corrected frequency in the movement amount P of the window glass 7 equal to or more than the pinching determination permission point Pb and the corrected frequency in the movement amount P + M away from the predetermined pinching determination difference interval M from P, When the movement amount P of the window glass 7 is Pa + M or less, the differential value cannot be calculated once. Therefore, in the section T6 in FIG. 7, the once-differentiated value dF (n) is forced to a value obtained by subtracting the corrected frequency F (Pb) at the pinching determination permission point Pb from the corrected frequency F (n) of this time. Is set.
さらに、現在の窓ガラス7の移動量Pが、挟み込み判定許可ポイントPbに挟み込み判定用差分間隔Mを加算し、これにさらに1を加算した値以上であるときは(ステップS32:P≧Pb+M+1、図7のT7区間)、今回の補正後周波数F(n)から前回の補正後周波数F(n−M)を減算した値を、モータ周波数F(n)の1回微分値dF(n)とする(ステップS35、dF(n)=F(n)−F(n−M))。 Further, when the current movement amount P of the window glass 7 is equal to or larger than a value obtained by adding the pinching determination difference interval M to the pinching determination permission point Pb and adding 1 to this (Step S32: P ≧ Pb + M + 1, (T7 section in FIG. 7), a value obtained by subtracting the previous corrected frequency F (n−M) from the current corrected frequency F (n) is set as a single differential value dF (n) of the motor frequency F (n). (Step S35, dF (n) = F (n) −F (n−M)).
次に、制御部2は、モータ周波数が不安定であるか否かを確認する(図2のステップS7)。ステップS8の安定判定処理が未だ実行されていない場合、またはステップS8の安定判定処理でモータ周波数が不安定であると判断された場合は、制御部2は、モータ周波数が不安定であると判定し(ステップS7:YES)、安定判定部2dにより安定判定処理を実行する(ステップS8)。
Next, the
図5は、安定判定処理の詳細を示したフローチャートである。まず、安定判定部2dは、現在の窓ガラス7の移動量Pを確認する(ステップS41)。そして、現在の窓ガラス7の移動量Pが、所定の起動マスク値Pa以下であるときは(ステップS41:P≦Pa、図7のT3区間)、安定判定部2dは、安定判定条件として、モータ周波数Fn(n)の2回微分値d2Fn(n)の絶対値が所定の安定閾値Q以下であるか否かを判定する(図5のステップS42)。
FIG. 5 is a flowchart showing details of the stability determination process. First, the
ここで、起動マスク値Paとは、挟み込みの判定を強制的に許可するための、窓ガラス7の移動量を示した値である。図2のステップS8の安定判定処理で、モータ周波数Fn(n)の2回微分値d2Fn(n)に基づいて、モータ周波数が安定か否かを判定した結果、いつまでもモータ周波数Fn(n)が安定していないと判断されると、図2のステップS12の挟み込み判定処理が実行されなくなってしまう。それを回避するために、起動マスク値Paを設定し、窓ガラス7の移動量Pが起動マスク値Paを超えた場合に、強制的に安定判定処理を終了して、挟み込み判定に移行させる。 Here, the activation mask value Pa is a value indicating the amount of movement of the window glass 7 for forcibly permitting the determination of pinching. As a result of determining whether or not the motor frequency is stable based on the twice differential value d 2 Fn (n) of the motor frequency Fn (n) in the stability determination process in step S8 of FIG. 2, the motor frequency Fn (n ) Is not stable, the pinching determination process in step S12 in FIG. 2 is not executed. In order to avoid this, the activation mask value Pa is set, and when the movement amount P of the window glass 7 exceeds the activation mask value Pa, the stability determination process is forcibly terminated and the process is shifted to the pinching determination.
安定閾値Qは、0に近い値に設定されている。たとえば、実験的に求めたモータ周波数の2回微分値のばらつき等を考慮して、安定閾値Qを決定してもよい。 The stability threshold Q is set to a value close to zero. For example, the stability threshold Q may be determined in consideration of the variation of the twice differential value of the motor frequency obtained experimentally.
2回微分値d2Fn(n)の絶対値が安定閾値Q以下でなければ(ステップS42:NO)、安定判定部2dは、モータ周波数が不安定であると判断する(ステップS43)。そして、安定判定部2dは、安定判定条件が連続で成立した回数を数えるための条件成立カウンタ値Cを0に初期化する(ステップS48)。条件成立カウンタ値Cの初期値は0である。
If the absolute value of the twice differentiated value d 2 Fn (n) is not less than or equal to the stability threshold Q (step S42: NO), the
一方、2回微分値d2Fn(n)の絶対値が安定閾値Q以下であれば(ステップS42:YES)、安定判定部2dは、条件成立カウンタ値Cに1を加算する(ステップS44)。そして、安定判定部2dは、条件成立カウンタ値Cが所定値Caと等しいか否かを確認する(ステップS45)。所定値Caは、2以上の整数であり、たとえば図7では、Ca=3に設定している。
On the other hand, if the absolute value of the twice differential value d 2 Fn (n) is equal to or smaller than the stability threshold Q (step S42: YES), the
条件成立カウンタ値Cが所定値Caと異なっていれば(ステップS45:NO)、安定判定部2dは、モータ周波数は不安定であると判断する(ステップS43)。対して、条件成立カウンタ値Cが所定値Caと等しければ(ステップS45:YES)、安定判定部2dは、モータ周波数は安定したと判断する(ステップS46)。このように、モータ周波数の安定・不安定を判断し終えると、安定判定部2dは、条件成立カウンタ値Cを0に初期化する(ステップS48)。
If the condition satisfaction counter value C is different from the predetermined value Ca (step S45: NO), the
また、安定判定部2dは、現在の窓ガラス7の移動量Pが、起動マスク値Paに1を加算した値以上になると(ステップS41:P≧Pa+1、図7のT4区間)、挟み込み判定許可指示を出力する(図5のステップS47)。そして、安定判定部2dは、条件成立カウンタ値Cを0に初期化する(ステップS48)。
Further, when the current movement amount P of the window glass 7 is equal to or larger than the value obtained by adding 1 to the activation mask value Pa (step S41: P ≧ Pa + 1, T4 section in FIG. 7), the
上記の安定判定処理により、モータ周波数が不安定であると判断され(図2のステップS9:NO)、かつ、挟み込み判定許可指示が出力されなかった場合は(ステップS10:NO)、制御部2が、挟み込み判定を許可せず、ステップS3以降の処理を繰り返し実行する。
If it is determined by the above-described stability determination process that the motor frequency is unstable (step S9: NO in FIG. 2) and the pinch determination permission instruction is not output (step S10: NO), the
一方、上記の安定判定処理により、モータ周波数が安定したと判断された場合(ステップS9:YES)、または、挟み込み判定許可指示が出力された場合は(ステップS10:YES)、制御部2が、挟み込み判定を許可する。そして、制御部2は、現在の窓ガラス7の移動量Pに1を加算した値を、挟み込み判定許可ポイントPbとして設定して(ステップS11)、挟み込み判定部2fにより挟み込み判定処理を実行する(ステップS12)。
On the other hand, when it is determined that the motor frequency has been stabilized by the above stability determination process (step S9: YES), or when a pinch determination permission instruction is output (step S10: YES), the
図6は、挟み込み判定処理の詳細を示したフローチャートである。挟み込み判定部2fは、挟み込み判定条件として、モータ周波数F(n)の1回微分値dF(n)が負の値であり(dF(n)<0)、かつ1回微分値dF(n)の絶対値が所定の挟み込み閾値R以上(|dF(n)|≧R)であるか否かを判定する(ステップS51)。
FIG. 6 is a flowchart showing details of the pinching determination process. The
窓6への異物の挟み込みが発生すると、モータ周波数F(n)が減少するため、モータ周波数F(n)の差分(dF(n)=F(n)−F(n−M)は負の値となる。逆に、モータ周波数F(n)が増加した場合は、モータ周波数F(n)の差分は正の値となる。そこで、挟み込みによるモータ周波数F(n)の減少傾向を検出するために、モータ周波数F(n)の1回微分値dF(n)が負の値であることを挟み込み判定条件に加えている。 When foreign matter is caught in the window 6, the motor frequency F (n) decreases, so the difference (dF (n) = F (n) −F (n−M) of the motor frequency F (n) is negative. On the contrary, when the motor frequency F (n) increases, the difference in the motor frequency F (n) becomes a positive value, and therefore, the decreasing tendency of the motor frequency F (n) due to the pinching is detected. For this reason, it is added to the pinching determination condition that the one-time differential value dF (n) of the motor frequency F (n) is a negative value.
ステップS51で、モータ周波数F(n)の1回微分値dF(n)が0や正の値であったり、1回微分値dF(n)の絶対値が挟み込み閾値R未満であったりすれば(ステップS51:NO)、挟み込み判定部2fは、窓6への異物の挟み込みが無いと判断する(ステップS53)。
If the first differential value dF (n) of the motor frequency F (n) is 0 or a positive value or the absolute value of the single differential value dF (n) is less than the sandwiching threshold value R in step S51. (Step S51: NO), the
一方、窓6に異物が挟み込まれると、図7に示したように、モータ周波数F(n)、Fn(n)が単調に減少して行き、モータ周波数F(n)の1回微分値dF(n)が上昇して行く。そして、1回微分値dF(n)が負の値であり、かつ1回微分値dF(n)の絶対値が挟み込み閾値R以上になると(図6のステップS51:YES)、挟み込み判定部2fは、窓6への異物の挟み込みが有ると判断する(ステップS52)。
On the other hand, when a foreign object is caught in the window 6, as shown in FIG. 7, the motor frequencies F (n) and Fn (n) monotonously decrease, and the once differentiated value dF of the motor frequency F (n). (N) goes up. When the once-differentiated value dF (n) is a negative value and the absolute value of the once-differentiated value dF (n) is greater than or equal to the sandwiching threshold value R (step S51 in FIG. 6: YES), the sandwiching
上記の挟み込み判定処理により、挟み込み無しと判断されると(図2のステップS13:NO)、制御部2は、閉動作条件から外れたか否かを判定する(ステップS14)。
If it is determined that there is no pinching by the pinching determination process (step S13: NO in FIG. 2), the
このとき、たとえば、ステップS1で行われたPW操作部3のマニュアル閉操作が、ステップS14まで継続されている場合や、PW操作部3が、ステップS1でオート閉操作されてから、ステップS14に至るまで他の状態に操作されていない場合は、ステップS14でPW操作部3による閉操作が有効になっている。このことに加えて、窓ガラス7の移動量から、窓ガラス7が全閉位置に到達していないことを検出すると、制御部2は、閉動作条件から外れていないと判定する(ステップS14:NO)。そして、制御部2は、窓ガラス7の閉動作を継続し、ステップS3以降の処理を繰り返し実行する。
At this time, for example, when the manual closing operation of the
その場合、制御部2は、ステップS3〜S6を実行した後、ステップS7でモータ周波数が不安定でないと判定して(ステップS7:NO)、次にステップS12の挟み込み判定処理を実行する。
In that case, after executing Steps S3 to S6, the
一方、たとえば、ステップS1で行われたPW操作部3のマニュアル閉操作が、ステップS14で解除されている場合や、PW操作部3が、ステップS1でオート閉操作されてから、ステップS14に至るまでに他の状態に操作された場合は、ステップS14でPW操作部3による閉操作が無効になっている。このため、制御部2は、閉動作条件から外れたと判定する(ステップS14:YES)。また、たとえば、窓ガラス7が全閉位置に到達した場合も、制御部2は、閉動作条件から外れたと判定する(ステップS14:YES)。そして、制御部2は、モータ9の駆動を停止して、窓ガラス7の閉動作を停止する(ステップS15)。
On the other hand, for example, when the manual closing operation of the
また、図6の挟み込み判定処理により、挟み込み有りと判断されると(図2のステップS13:YES)、制御部2は、モータ9の駆動を停止して、窓ガラス7の閉動作を停止した後、モータ9を反転させて、窓ガラス7の開動作を所定量実行する(ステップS16)。他の例として、窓ガラス7の閉動作を停止させるだけでもよい。
Further, when it is determined by the pinching determination process in FIG. 6 that there is pinching (step S13 in FIG. 2: YES), the
上記第1実施形態によると、窓ガラス7の閉動作時に、モータ9の駆動状態を表すモータ周波数(補正後周波数の1次遅れ)Fn(n)の2回微分値d2Fn(n)、すなわちモータ周波数Fn(n)の差分値の差分値と、安定閾値Qとの比較結果に基づいて、モータ周波数Fn(n)が安定しているか否かを判定している。このとき、2回微分値d2Fn(n)が正の値であっても、負の値であっても、その絶対値が安定閾値Q以下である場合に、モータ周波数Fn(n)が安定したと判定している。そして、モータ周波数Fn(n)が安定したと判定された場合に、モータ周波数(補正後周波数)F(n)と挟み込み閾値Rとに基づいて、窓6への異物の挟み込みの有無を判定している。
According to the first embodiment, when the window glass 7 is closed, the second-order differential value d 2 Fn (n) of the motor frequency (first-order lag of the corrected frequency) Fn (n) representing the driving state of the
つまり、モータ周波数Fn(n)、F(n)が安定するまでは、モータ周波数F(n)と挟み込み閾値Rとに基づいて挟み込みの有無を判定しないので、窓ガラス7を閉動作させるためのモータ9の起動直後に、機械的要因によりモータ9の駆動状態が不安定になっても、窓6への異物の挟み込みの誤検出を防止することができる。
That is, until the motor frequencies Fn (n) and F (n) are stabilized, the presence / absence of pinching is not determined based on the motor frequency F (n) and the pinching threshold value R, so that the window glass 7 is closed. Even if the driving state of the
また、上記第1実施形態では、モータ周波数F(n)の1回微分値dF(n)と、挟み込み閾値Rとの比較結果に基づいて、窓6への異物の挟み込みの有無を判定している。つまり、モータ周波数F(n)の差分値と、挟み込み閾値Rとの比較結果に基づいて、挟み込みの有無を判定しているので、挟み込みの検出精度を高めることができる。 Further, in the first embodiment, the presence / absence of foreign matter being caught in the window 6 is determined based on the comparison result between the once differentiated value dF (n) of the motor frequency F (n) and the sandwiching threshold value R. Yes. That is, since the presence / absence of pinching is determined based on the comparison result between the difference value of the motor frequency F (n) and the pinching threshold value R, pinching detection accuracy can be improved.
さらに、上記第1実施形態では、モータ周波数Fn(n)の2回微分値d2Fn(n)の絶対値が、複数回連続で安定閾値Q以下となった場合に、モータ周波数Fn(n)が安定したと判定している。このため、モータ周波数Fn(n)が短い間隔で上下に振動しても、モータ周波数Fn(n)が安定したか否かの判定精度を高めることができる。 Furthermore, in the first embodiment, when the absolute value of the twice-differentiated value d 2 Fn (n) of the motor frequency Fn (n) becomes equal to or less than the stable threshold Q for a plurality of times, the motor frequency Fn (n ) Is determined to be stable. For this reason, even if the motor frequency Fn (n) vibrates up and down at short intervals, it is possible to increase the accuracy of determination as to whether or not the motor frequency Fn (n) is stable.
次に、第2実施形態の構成を、図9を参照しながら説明する。 Next, the configuration of the second embodiment will be described with reference to FIG.
第2実施形態のPW制御システム100’は、自動車に搭載され、PW制御装置1’とその他の構成要素6〜9を含んでいる。
A PW control system 100 ′ according to the second embodiment is mounted on an automobile and includes a
前述した第1実施形態のPW制御装置1では、モータ9の駆動状態を表す物理量としてモータ周波数を検出したが、第2実施形態のPW制御装置1’では、モータ周波数に代えて、モータ9に流れる電流を検出する。PW制御装置1’は、本発明の「開閉体制御装置」の一例である。
In the
PW制御装置1’には、制御部2、PW操作部3、および駆動部4が備わっている。制御部2には、記憶部2b’、2回微分値算出部2c’、安定判定部2d’、1回微分値算出部2e’、および挟み込み判定部2f’が設けられている。駆動部4には、電流検出部4aが設けられている。
The
電流検出部4aは、モータ9に流れる電流を検出するための回路から成る。電流検出部4aで検出された電流値は、モータ9の駆動状態を表す物理量の一例であり、以下では「モータ電流」という。
The
窓ガラス7の閉動作時に、電流検出部4aは、モータ電流を順次検出して、制御部2に出力する。制御部2は、電流検出部4aから出力されるモータ電流を、記憶部2b’に順次記憶させる。電流検出部4aは、本発明の「検出手段」の一例である。
During the closing operation of the window glass 7, the
また、窓ガラス7の閉動作時に、2回微分値算出部2c’は、モータ電流の2回微分値、すなわちモータ電流の差分値の差分値を算出する。安定判定部2d’は、2回微分値算出部2c’により算出された2回微分値と、予め設定された安定閾値とを比較し、その比較結果に基づいて、モータ電流が安定しているか否かを判定する。2回微分値算出部2c’は、本発明の「2回微分値算出手段」の一例である。安定判定部2d’は、本発明の「安定判定手段」の一例である。
In addition, when the window glass 7 is closed, the twice differential
また、窓ガラス7の閉動作時に、1回微分値算出部2e’は、モータ電流の1回微分値、すなわちモータ電流の差分値を算出する。挟み込み判定部2f’は、安定判定部2d’によりモータ電流が安定したと判定された場合に、1回微分値算出部2e’により算出された1回微分値と、予め設定された挟み込み閾値とを比較し、その比較結果に基づいて、窓6への異物の挟み込みの有無を判定する。1回微分値算出部2e’は、本発明の「1回微分値算出手段」の一例である。挟み込み判定部2f’は、本発明の「挟み込み判定手段」の一例である。
Further, when the window glass 7 is closed, the once differential
上記第2実施形態のPW制御装置1’で検出されたモータ電流は、第1実施形態のPW制御装置1で検出されたモータ周波数とは反対の挙動を示す。
The motor current detected by the
すなわち、モータ9にかかる負荷が小さくなると、モータ周波数が大きくなるのに対して、モータ電流は小さくなる。また、モータ9にかかる負荷が大きくなると、モータ周波数が小さくなるのに対して、モータ電流は大きくなる。そして、窓6に異物が挟み込まれると、モータ9にかかる負荷が大きくなるので、モータ周波数が単調に減少するのに対して、モータ電流は単調に上昇する。
That is, when the load applied to the
窓ガラス7を閉じる場合のPW制御装置1’の動作は、PW制御装置1の動作とほぼ同様である。つまり、図2〜図6の各処理において、「モータ周波数」を「モータ電流」に置き換えればよい。
The operation of the
上記第2実施形態によると、窓ガラス7の閉動作時に、モータ9の駆動状態を表すモータ電流の2回微分値と、安定閾値との比較結果に基づいて、モータ電流が安定したか否かを判定する。そして、モータ電流が安定したと判定された場合に、モータ電流と挟み込み閾値とに基づいて、窓6への異物の挟み込みの有無を判定する。つまり、モータ電流が安定するまでは、モータ電流と挟み込み閾値とに基づいて挟み込みの有無を判定しないので、窓6を閉動作させるためのモータ9の起動直後に、機械的要因によりモータ9の駆動状態が不安定になっても、窓6への異物の挟み込みの誤検出を防止することができる。
According to the second embodiment, when the window glass 7 is closed, whether or not the motor current is stabilized based on the comparison result between the twice differential value of the motor current representing the driving state of the
本発明は、上述した以外にも種々の実施形態を採用することができる。たとえば、以上の実施形態では、図2に示したように、モータ周波数を検出した後、モータ周波数の2回微分値と1回微分値を算出してから、安定判定処理や挟み込み判定処理を行う例を示したが、本発明はこれのみに限定するものではない。これ以外に、たとえば、モータ周波数の検出後、安定判定処理を行う前に、モータ周波数の1回微分値を算出せずに、2回微分値だけを算出してもよい。そして、安定判定処理でモータ周波数が安定したと判定された後、挟み込み判定処理を行う前に、モータ周波数の2回微分値を算出せずに、1回微分値だけを算出してもよい。 The present invention can employ various embodiments other than those described above. For example, in the above embodiment, as shown in FIG. 2, after the motor frequency is detected, the second and first differential values of the motor frequency are calculated, and then the stability determination process and the pinch determination process are performed. Although an example is shown, the present invention is not limited to this. In addition to this, for example, after the motor frequency is detected and before the stability determination process is performed, only the second derivative value may be calculated without calculating the first derivative value of the motor frequency. Then, after it is determined that the motor frequency is stable in the stability determination process, the differential value of the motor frequency may be calculated only once instead of calculating the differential value of the motor frequency before performing the pinching determination process.
また、以上の実施形態では、モータ9の駆動状態を表す物理量として、モータ周波数またはモータ電流を検出した例を示したが、本発明はこれのみに限定するものではない。これ以外に、たとえば、モータの回転数、負荷、またはモータに流れる電流に含まれるリップルの周波数などのような、他の物理量を検出してもよい。リップルの周波数については、たとえば、モータに流れる電流を検出する電流検出部から出力される信号を、所定の周波数特性を有するバンドパスフィルターに通過させることによって、リップルの変動分を抽出する。そして、そのリップルの変動分と所定の閾値を比較することによって、リップルの周波数を検出することができる。モータの駆動状態を表す物理量を検出した後は、その物理量と所定の閾値とに基づいて、物理量が安定したことを検出した後、挟み込みの判定を行えばよい。
Moreover, although the example which detected the motor frequency or the motor current was shown as a physical quantity showing the drive state of the
また、以上の実施形態では、モータ周波数またはモータ電流の1回微分値と、挟み込み閾値との比較結果に基づいて、挟み込みの有無を判定した例を示したが、本発明はこれのみに限定するものではない。これ以外に、たとえば、モータ9の駆動状態を表す物理量の補正値や2回微分値などのような、他の演算値を算出した後、該演算値と挟み込み閾値との比較結果に基づいて、挟み込みの有無を判定してもよい。また、安定判定処理と挟み込み判定処理とを、異なる物理量に基づいてそれぞれ行ってもよい。
Moreover, although the above embodiment showed the example which determined the presence or absence of pinching based on the comparison result of the 1st derivative value of a motor frequency or a motor current, and a pinching threshold value, this invention is limited only to this. It is not a thing. In addition to this, for example, after calculating other calculation values such as a correction value of a physical quantity representing a driving state of the
さらに、以上の実施形態では、自動車のPW(パワーウインドウ)制御装置1、1’に本発明を適用した例を挙げたが、これに限るものではない。これ以外の、たとえば電動式開閉ルーフなどのような、車両の開閉体の開閉動作を制御する開閉体制御装置に対しても、本発明を適用することは可能である。
Furthermore, in the above embodiment, although the example which applied this invention to the PW (power window)
1、1’ PW(パワーウインドウ)制御装置
2a 周波数検出部
2c、2c’ 2回微分値算出部
2d、2d’ 安定判定部
2e、2e’ 1回微分値算出部
2f、2f’ 挟み込み判定部
4a 電流検出部
6 窓
7 窓ガラス
9 モータ
10 ロータリエンコーダ
Q 安定閾値
R 挟み込み閾値
DESCRIPTION OF
Claims (7)
前記開閉体の閉動作時における前記モータの駆動状態を表す物理量を順次検出する検出手段と、
前記検出手段が検出した前記物理量の2回微分値を算出する2回微分値算出手段と、
前記2回微分値算出手段が算出した前記2回微分値と予め設定された安定閾値とを比較した結果に基づいて、前記物理量が安定したか否かを判定する安定判定手段と、
前記安定判定手段により前記物理量が安定したと判定された場合に、前記物理量と予め設定された挟み込み閾値とに基づいて、前記開閉体への異物の挟み込みの有無を判定する挟み込み判定手段と、を備えたことを特徴とする開閉体制御装置。 In an opening / closing body control device for controlling driving of a motor for opening / closing an opening / closing body of a vehicle,
Detecting means for sequentially detecting a physical quantity representing a driving state of the motor during the closing operation of the opening and closing body;
A double differential value calculating means for calculating a double differential value of the physical quantity detected by the detecting means;
Stability determination means for determining whether or not the physical quantity is stable based on a result of comparing the twice differential value calculated by the twice differential value calculating means and a preset stability threshold;
Pinching determination means for determining whether foreign matter is caught in the opening / closing body based on the physical quantity and a preset pinching threshold when the stability determination means determines that the physical quantity is stable; An opening / closing body control device comprising:
前記物理量の1回微分値を算出する1回微分値算出手段を、さらに備え、
前記挟み込み判定手段は、前記1回微分値算出手段が算出した前記1回微分値と前記挟み込み閾値とを比較した結果に基づいて、前記開閉体への異物の挟み込みの有無を判定する、ことを特徴とする開閉体制御装置。 In the opening-closing body control apparatus of Claim 1,
A single differential value calculating means for calculating a single differential value of the physical quantity;
The pinching determination means determines whether or not foreign matter is pinched in the opening / closing body based on a result of comparing the single differential value calculated by the single differential value calculation means and the pinching threshold value. An opening / closing body control device.
前記安定判定手段は、前記2回微分値が複数回連続で前記安定閾値以下となった場合に、前記物理量が安定したと判定する、ことを特徴とする開閉体制御装置。 In the opening-closing body control apparatus of Claim 1 or Claim 2,
The open / closed body control device, wherein the stability determining means determines that the physical quantity is stable when the twice-differentiated value is continuously equal to or less than the stability threshold value a plurality of times.
前記安定判定手段により前記物理量が安定したと判定されないまま、前記開閉体の移動量が所定値を超えた場合に、
前記挟み込み判定手段は、前記開閉体への異物の挟み込みの有無を判定する、ことを特徴とする開閉体制御装置。 In the opening-closing body control apparatus in any one of Claim 1 thru | or 3,
When the movement amount of the opening and closing body exceeds a predetermined value without determining that the physical quantity is stable by the stability determination means,
The opening / closing body control device, wherein the pinching determination means determines whether or not a foreign object is caught in the opening / closing body.
前記検出手段は、前記物理量として、前記モータの駆動状態に応じたパルス信号を出力する出力手段から出力された、前記パルス信号の周波数を順次検出する、ことを特徴とする開閉体制御装置。 In the opening-closing-body control apparatus in any one of Claim 1 thru | or 4,
The opening / closing body control apparatus, wherein the detection means sequentially detects the frequency of the pulse signal output from the output means for outputting a pulse signal corresponding to the driving state of the motor as the physical quantity.
前記検出手段は、前記物理量として、前記モータに流れる電流を順次検出する、ことを特徴とする開閉体制御装置。 In the opening-closing-body control apparatus in any one of Claim 1 thru | or 4,
The opening / closing body control device, wherein the detecting means sequentially detects a current flowing through the motor as the physical quantity.
前記検出手段は、前記物理量として、前記モータに流れる電流に含まれるリップルの周波数を順次検出する、ことを特徴とする開閉体制御装置。 In the opening-closing-body control apparatus in any one of Claim 1 thru | or 4,
The opening / closing body control apparatus, wherein the detecting means sequentially detects a frequency of a ripple included in a current flowing through the motor as the physical quantity.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2014020926A JP2015148079A (en) | 2014-02-06 | 2014-02-06 | Opening and closing body control device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2014020926A JP2015148079A (en) | 2014-02-06 | 2014-02-06 | Opening and closing body control device |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JP2015148079A true JP2015148079A (en) | 2015-08-20 |
Family
ID=53891660
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2014020926A Pending JP2015148079A (en) | 2014-02-06 | 2014-02-06 | Opening and closing body control device |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2015148079A (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2021116062A (en) * | 2020-01-24 | 2021-08-10 | 日本信号株式会社 | A method and a measuring device for measuring the operating time of a blocking rod, and a blocking device and a monitoring device using the method and a measuring device. |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2002174075A (en) * | 2000-12-08 | 2002-06-21 | Omron Corp | Opening / closing control device |
| JP2003003744A (en) * | 2001-06-22 | 2003-01-08 | Asmo Co Ltd | Open-close body controller |
| JP2003314141A (en) * | 2002-04-23 | 2003-11-06 | Aisin Seiki Co Ltd | Opening / closing control device for vehicle opening / closing body |
| JP3832959B2 (en) * | 1998-02-27 | 2006-10-11 | 株式会社ミツバ | Opening and closing body drive control method |
| US20100319268A1 (en) * | 2009-06-19 | 2010-12-23 | Paul Bizard | Method for obtaining a criterion for detecting obstacles to the closure of an opening |
-
2014
- 2014-02-06 JP JP2014020926A patent/JP2015148079A/en active Pending
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP3832959B2 (en) * | 1998-02-27 | 2006-10-11 | 株式会社ミツバ | Opening and closing body drive control method |
| JP2002174075A (en) * | 2000-12-08 | 2002-06-21 | Omron Corp | Opening / closing control device |
| JP2003003744A (en) * | 2001-06-22 | 2003-01-08 | Asmo Co Ltd | Open-close body controller |
| JP2003314141A (en) * | 2002-04-23 | 2003-11-06 | Aisin Seiki Co Ltd | Opening / closing control device for vehicle opening / closing body |
| US20100319268A1 (en) * | 2009-06-19 | 2010-12-23 | Paul Bizard | Method for obtaining a criterion for detecting obstacles to the closure of an opening |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2021116062A (en) * | 2020-01-24 | 2021-08-10 | 日本信号株式会社 | A method and a measuring device for measuring the operating time of a blocking rod, and a blocking device and a monitoring device using the method and a measuring device. |
| JP7690292B2 (en) | 2020-01-24 | 2025-06-10 | 日本信号株式会社 | Method and device for measuring the operation time of a barrier rod, and barrier device and monitoring device using the same |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP6161576B2 (en) | Opening and closing body control device | |
| US20180002969A1 (en) | Opening/closing control device | |
| US11970896B2 (en) | Opening/closing control device and opening/closing control method | |
| JP2015085738A (en) | Control device of opening/closing body for vehicle, control method, opening/closing body for vehicle equipped with the control device | |
| JP2007132123A (en) | Opening / closing member control device | |
| US10965228B2 (en) | Motor module, rotation angle detector, and method for detecting failure of rotation angle detector | |
| CN100355642C (en) | Elevator door control device | |
| JP2015148079A (en) | Opening and closing body control device | |
| JP4063094B2 (en) | Opening and closing body pinching detection device | |
| KR101388854B1 (en) | Motor driving device, and method for cotrolling motor | |
| JP6078300B2 (en) | Control device for electric compressor | |
| JP6714775B2 (en) | Motor with rotation angle detector, rotation angle detector for motor, and method for detecting rotation angle of motor with commutator | |
| JP4510409B2 (en) | Window glass clamping presence / absence detection device | |
| JP6183911B2 (en) | Opening and closing body control device | |
| JP2016098601A (en) | Auxiliary control device | |
| JP2018197426A (en) | Open / close control device, open / close operation control method, and program | |
| JP6394900B2 (en) | Vehicle window opening and closing device | |
| JP6776921B2 (en) | Opening and closing member drive device | |
| JP2018197427A (en) | Open / close control device, open / close operation control method, and program | |
| JP7006398B2 (en) | Motor drive | |
| JP2021191098A (en) | Motor control system and motor control method | |
| JP4388517B2 (en) | DC motor rotation state detection device | |
| US12206352B2 (en) | Rotation angle detecting method, recording medium storing rotation angle detecting program, and rotation angle detecting device | |
| JP5596911B2 (en) | Opening / closing member control device | |
| JP6432367B2 (en) | Vehicle window opening and closing device |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20161115 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20170712 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20170719 |
|
| A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20180130 |