JP5628728B2 - Motor control device and vehicle seat device - Google Patents

Motor control device and vehicle seat device Download PDF

Info

Publication number
JP5628728B2
JP5628728B2 JP2011077080A JP2011077080A JP5628728B2 JP 5628728 B2 JP5628728 B2 JP 5628728B2 JP 2011077080 A JP2011077080 A JP 2011077080A JP 2011077080 A JP2011077080 A JP 2011077080A JP 5628728 B2 JP5628728 B2 JP 5628728B2
Authority
JP
Japan
Prior art keywords
motor
current
control unit
value
position data
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2011077080A
Other languages
Japanese (ja)
Other versions
JP2012213261A (en
Inventor
聡一郎 田中
聡一郎 田中
耕平 木幡
耕平 木幡
生佳 伊藤
生佳 伊藤
隼人 島崎
隼人 島崎
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
TS Tech Co Ltd
Original Assignee
TS Tech Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by TS Tech Co Ltd filed Critical TS Tech Co Ltd
Priority to JP2011077080A priority Critical patent/JP5628728B2/en
Priority to PCT/JP2012/056362 priority patent/WO2012124674A1/en
Priority to CN201280023259.7A priority patent/CN103688460A/en
Priority to EP12758207.0A priority patent/EP2688197A4/en
Priority to US14/005,004 priority patent/US20140001815A1/en
Publication of JP2012213261A publication Critical patent/JP2012213261A/en
Application granted granted Critical
Publication of JP5628728B2 publication Critical patent/JP5628728B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Direct Current Motors (AREA)

Description

本発明は、モータ制御装置及び車両用シート装置に関する。   The present invention relates to a motor control device and a vehicle seat device.

車両用シート、電動ドアミラー、パワーウィンドウ等には可動部が設けられ、可動部がモータによって駆動される。可動部の位置及び速度を制御装置によって正確に制御するためには、動作中のモータの回転量や位置を検出する必要がある。モータの回転量や位置を検出するべく、センサが用いられる。つまり、センサ(例えば、ホール素子、エンコーダ、リードスイッチセンサ)がモータ等に設けられ、動作中のモータの回転に同期した信号がセンサによって出力され、センサの出力信号が検出回路(例えば、コンパレータやAD変換器)を介して制御装置に入力される。   A movable part is provided in a vehicle seat, an electric door mirror, a power window, and the like, and the movable part is driven by a motor. In order to accurately control the position and speed of the movable part by the control device, it is necessary to detect the rotation amount and position of the motor in operation. A sensor is used to detect the rotation amount and position of the motor. That is, a sensor (for example, a hall element, an encoder, a reed switch sensor) is provided in a motor or the like, a signal synchronized with the rotation of the motor in operation is output by the sensor, and the output signal of the sensor is detected by a detection circuit (for example, a comparator or It is input to the control device via the AD converter.

ところが、センサを用いると、コストアップの要因になってしまう。そこで、センサを用いずに、モータの電流信号を利用して、モータの後段回路によってモータの回転量や位置を検出する技術が提案されている(例えば、特許文献1、特許文献2参照)。モータが動作している際には、モータの電流信号には直流成分、低周波成分及び高周波ノイズ等が含まれており、更に、モータの回転に同期した脈動(以下、リプル(ripple)という。)成分も含まれている。特許文献1、特許文献2に記載の技術では、モータの電流信号を後段回路によって処理することによってリプル成分を抽出する。具体的には、後段回路のフィルタによってモータの電流信号のうち直流成分、低周波成分及び高周波ノイズを除去し、リプル成分を通過させる。モータの電流信号の各成分の周波数が環境変化によって変動するため、後段回路のフィルタには、カットオフ周波数を可変することができるスイッチト・キャパシタ・フィルタを用いる。具体的には、スイッチト・キャパシタ・フィルタを通過した信号が演算回路にフィードバックされ、演算回路がフィードバック信号からカットオフ周波数を演算して、スイッチト・キャパシタ・フィルタのカットオフ周波数を設定する。   However, using a sensor increases the cost. In view of this, a technique has been proposed in which the motor rotation signal and position are detected by a circuit subsequent to the motor using a motor current signal without using a sensor (see, for example, Patent Document 1 and Patent Document 2). When the motor is operating, the current signal of the motor includes a direct current component, a low frequency component, a high frequency noise, and the like, and further, a pulsation synchronized with the rotation of the motor (hereinafter referred to as ripple). ) Ingredients are also included. In the techniques described in Patent Document 1 and Patent Document 2, a ripple component is extracted by processing a current signal of a motor by a subsequent circuit. Specifically, a DC component, a low frequency component, and a high frequency noise are removed from the motor current signal by a filter in the subsequent circuit, and the ripple component is passed. Since the frequency of each component of the motor current signal fluctuates due to environmental changes, a switched capacitor filter capable of varying the cut-off frequency is used as the filter of the subsequent circuit. Specifically, a signal that has passed through the switched capacitor filter is fed back to the arithmetic circuit, and the arithmetic circuit calculates a cutoff frequency from the feedback signal to set the cutoff frequency of the switched capacitor filter.

特許文献1に記載の技術では、リプルパルス整形回路が、スイッチト・キャパシタ・フィルタ(SCF)を通過したリプル成分をパルス化し、カウンタ(CT)が、リプルパルス整形回路の出力信号のパルス数を計数する。カウンタ(CT)によって計数されたパルス数が、モータの回転量に相当するとともに、可動部の移動量に相当する。   In the technique described in Patent Document 1, the ripple pulse shaping circuit pulses the ripple component that has passed through the switched capacitor filter (SCF), and the counter (CT) counts the number of pulses of the output signal of the ripple pulse shaping circuit. . The number of pulses counted by the counter (CT) corresponds to the amount of rotation of the motor and the amount of movement of the movable part.

ところで、可動部には可動範囲が設定されており、可動部が可動範囲の一方の端から他方の端にかけて移動可能である。特許文献3には、モータによって駆動される可動部が可動範囲(A)の端(X)に移動したら、モータを停止させる技術が開示されている。具体的には、可動部の可動範囲(A)の端(X)の内側にロック検出エリア(l11)が設定されている(特許文献3の図7等参照)。そして、モータが回転することで可動部がロック検出エリア(l11)の外からロック検出エリア(l11)内に進入した場合、可動部が可動範囲(A)の端(X)に移動してロックされると、制御部(22)のロック状態判定部(73)がモータの電流によって可動部のロックを検出し、制御部(22)の停止位置情報補正部(84)が制御部(22)に対してモータの出力を停止させる(特許文献3の図8等参照)。その後、制御部(22)の現在位置情報更新部(75)が、現在位置情報演算部(77)によって計算された現在位置情報の値をロック位置情報記憶部(78)に記憶されたロック位置情報の値に更新する。ロック位置情報は、可動部の可動範囲(A)の端(X)を表すものである。 By the way, a movable range is set for the movable portion, and the movable portion can move from one end of the movable range to the other end. Patent Document 3 discloses a technique for stopping a motor when a movable portion driven by the motor moves to the end (X) of the movable range (A). Specifically, the lock detection area (l 11 ) is set inside the end (X) of the movable range (A) of the movable part (see FIG. 7 in Patent Document 3). When the movable part enters the lock detection area (l 11 ) from outside the lock detection area (l 11 ) due to the rotation of the motor, the movable part moves to the end (X) of the movable range (A). The locked state determination unit (73) of the control unit (22) detects the lock of the movable unit by the motor current, and the stop position information correction unit (84) of the control unit (22) 22), the output of the motor is stopped (see FIG. 8 of Patent Document 3). Thereafter, the current position information update unit (75) of the control unit (22) stores the value of the current position information calculated by the current position information calculation unit (77) in the lock position information storage unit (78). Update to information value. The lock position information represents the end (X) of the movable range (A) of the movable part.

特開2003−9585号公報Japanese Patent Laid-Open No. 2003-9585 特開2008−283762号公報JP 2008-283762 A 特表2010−33513号公報Special Table 2010-33513

ところが、モータと可動部の間には歯車といった伝動機構等が設けられ、伝動機構には遊びやがたつき等がある。そのため、可動部が可動範囲の端に移動してロックされても、モータが更に回転することができる。特許文献3の技術は、可動部がロックされて、モータが更に回転することを考慮したものではなく、ロック位置情報の値に更新された現在位置情報は実際の可動部の位置を正確に表したものではない。つまり、可動部が可動範囲の端に移動してモータが停止した後、モータを逆に回転すると、モータの回転直後ではモータだけが回転するが、可動部が移動しないから、その際に演算される現在位置情報は可動部の実際の位置からずれたものとなってしまう。   However, a transmission mechanism such as a gear is provided between the motor and the movable part, and the transmission mechanism includes play and rattling. Therefore, even if the movable part moves to the end of the movable range and is locked, the motor can further rotate. The technique of Patent Document 3 does not consider that the movable part is locked and the motor further rotates, and the current position information updated to the value of the lock position information accurately represents the actual position of the movable part. It was n’t. In other words, after the movable part moves to the end of the movable range and the motor stops, when the motor is rotated in the reverse direction, only the motor rotates immediately after the motor rotates, but the movable part does not move. The current position information is shifted from the actual position of the movable part.

また、可動部が可動範囲の端に移動してロックされて、モータが更に回転しても、モータの回転速度が極低速であるから、リプルのパルスが正確に生成されない。そのため、可動部が可動範囲の端に移動してロックされて、モータが更に回転する場合、モータの位置を正確に求めることができない。   Further, even if the movable part moves to the end of the movable range and is locked and the motor further rotates, the rotation speed of the motor is extremely low, so that the ripple pulse is not generated accurately. Therefore, when the movable part moves to the end of the movable range and is locked and the motor further rotates, the position of the motor cannot be obtained accurately.

そこで、本発明が解決しようとする課題は、可動部が可動範囲の端に移動してロックされて、モータが更に回転するような場合でも、モータの位置を正確に求められるようにすることである。   Therefore, the problem to be solved by the present invention is to make it possible to accurately obtain the position of the motor even when the movable part moves to the end of the movable range and is locked and the motor further rotates. is there.

以上の課題を解決するための請求項1に係る発明によれば、
モータ制御装置が、可動範囲の両端の間を移動可能な可動部を駆動し、動作すると電流信号に周期的なリプルを発生させるモータと、前記モータの前記電流信号からリプル成分を抽出して、そのリプル成分をパルス化したパルス信号を出力する抽出回路と、前記モータの電流を検出する電流検出部と、前記電流検出部によって検出された電流のデータを入力するとともに前記パルス信号を入力し、前記モータを制御する制御部と、前記モータの動作前の初期位置を前記初期位置から所定の原点位置までのパルス数で表した初期位置データと、前記可動部が前記可動範囲内から前記端に移動して前記モータが更に回転することができる前記モータの拘束開始位置を前記拘束開始位置から前記原点位置までのパルス数で表した拘束開始位置データと、前記可動部が前記可動範囲の前記端に位置して前記モータがそれ以上回転できずに拘束される前記モータのロック位置を前記ロック位置から前記原点位置までのパルス数で表したロック位置データと、を記憶した記憶部と、を備え、前記制御部が、前記モータを起動させる起動処理と、前記起動処理後に前記パルス信号のパルスを入力するたびに、前記起動処理後に前記パルス信号に発生したパルス数を計数し、計数したパルス数を前記初期位置データの値に加算し、又は計数したパルス数を前記初期位置データの値から減算する計数処理と、前記起動処理後に前記計数処理において算出した差又は和を前記拘束開始位置データの値と比較することで、前記モータの位置が前記拘束開始位置の間であるか否かを判定する判定処理と、前記モータの位置が前記拘束開始位置の間でないと前記判定処理において判定した場合に、前記電流検出部から入力した電流データが所定値以上になるまで前記モータの回転を継続し、前記電流検出部から入力した電流データが所定値以上になったら前記モータを停止させる停止処理と、前記停止処理後に、前記記憶部に記憶された前記初期位置データを前記ロック位置データの値に書き換える更新処理と、を更に実行する。
According to the invention according to claim 1 for solving the above problems,
The motor controller drives a movable part that can move between both ends of the movable range, and when operated, extracts a ripple component from the current signal of the motor that generates a periodic ripple in the current signal, An extraction circuit that outputs a pulse signal in which the ripple component is pulsed, a current detection unit that detects the current of the motor, and data of the current detected by the current detection unit and the pulse signal are input, A control unit for controlling the motor; initial position data representing an initial position of the motor before operation by a pulse number from the initial position to a predetermined origin position; and the movable unit from the movable range to the end. Constraint start position data representing the constraint start position of the motor that can move and further rotate by the number of pulses from the constraint start position to the origin position Lock position data representing the lock position of the motor, which is restrained without the motor being able to rotate any more, with the movable part positioned at the end of the movable range, in terms of the number of pulses from the lock position to the origin position Each time a pulse of the pulse signal is input after the start-up process, and the control unit generates the pulse signal after the start-up process. Counting the number of pulses counted, adding the counted number of pulses to the value of the initial position data, or subtracting the counted number of pulses from the value of the initial position data, and calculating in the counting process after the start-up process A determination process for determining whether or not the position of the motor is between the constraint start positions by comparing the difference or the sum with the value of the constraint start position data; and When the determination process determines that the position of the motor is not between the constraint start positions, the rotation of the motor is continued until the current data input from the current detection unit exceeds a predetermined value, and the current detection unit A stop process for stopping the motor when the current data input from the input data exceeds a predetermined value, and an update process for rewriting the initial position data stored in the storage unit to the value of the lock position data after the stop process, Is further executed.

請求項2に係る発明によれば、請求項1において、
前記制御部が、前記初期位置データの値が前記ロック位置データの値に等しいか否かを判定する第二判定処理と、前記初期位置データの値が前記ロック位置データの値に等しいと前記第二判定処理において判定した場合に、前記起動処理の実行後に前記計数処理において算出する差又は和が前記拘束開始位置データの値に等しくなるまで、前記モータの停止を禁止する禁止処理と、を更に実行する。
According to the invention of claim 2, in claim 1,
A second determination process for determining whether the value of the initial position data is equal to the value of the lock position data; and the control unit determines whether the value of the initial position data is equal to the value of the lock position data. And a prohibiting process for prohibiting the motor from stopping until the difference or sum calculated in the counting process after execution of the starting process becomes equal to the value of the constraint start position data. Run.

請求項3に係る発明によれば、請求項1又は2において、
前記制御部が、前記モータの位置が前記拘束開始位置の間であると前記判定処理において判定した場合に、前記モータを停止させる第二停止処理を更に実行する。
According to the invention of claim 3, in claim 1 or 2,
The control unit further executes a second stop process for stopping the motor when the determination process determines that the position of the motor is between the constraint start positions.

請求項4に係る発明によれば、請求項2において、
前記制御部が、前記初期位置データの値が前記ロック位置データの値に等しくないと前記第二判定処理において判定した場合に、前記起動処理を実行する。
According to the invention of claim 4, in claim 2,
When the control unit determines in the second determination process that the value of the initial position data is not equal to the value of the lock position data, the activation process is executed.

請求項5に係る発明によれば、請求項1から4の何れか一項において、
前記制御部が、前記起動処理後に所定の停止条件が満たされた時に前記判定処理を実行する。
According to the invention of claim 5, in any one of claims 1 to 4,
The control unit executes the determination process when a predetermined stop condition is satisfied after the activation process.

請求項6に係る発明によれば、
車両用シート装置が、請求項1から5の何れか一項に記載のモータ制御装置と、前記モータによって駆動される前記可動部を有するシート本体と、を備える。
According to the invention of claim 6,
A vehicle seat device includes the motor control device according to any one of claims 1 to 5 and a seat body having the movable portion driven by the motor.

請求項1に係る発明によれば、初期位置、拘束開始位置及びロック位置がモータの位置を表す座標系で規定され、初期位置データ、拘束開始位置データ及びロック位置データがモータの位置をパルス数で表現するから、制御部がモータの位置を表現する座標系を利用して処理を行うことができる。従って、制御部が計数処理において算出した差や和は実際のモータの位置を正確に表すとともに、判定処理でも、モータの位置が拘束開始位置の間であるか否かを正確に判定することができる。
モータの位置が拘束開始位置の間でないと制御部が判定した場合、可動部が可動範囲の端に移動してロックされており、その後も制御部がモータの回転を継続する。そして、モータと可動部の間の伝動機構等の遊びやがたつき等が締められると、モータに対する負荷が大きくなって、モータの電流が増加する。その際、電流検出部から入力した電流データが所定値以上になったら制御部がモータを停止させるから、モータがロック位置でロックされた状態で停止する。その後、初期位置データが、ロック位置を表すロック位置データの値であるパルス数に書き換えられるから、初期位置データがモータの実際のロック位置を正確に表現する。そのため、可動部が可動範囲の端に移動してロックされて、モータが更に回転するような場合でも、モータの位置が正確に算出される。
可動部が可動範囲の端に移動してロックされて、モータが更に回転しても、リプルのパルスが正確に生成されない場合でも、停止処理後に、初期位置データがロック位置を表すロック位置データの値に書き換えられるから、その後のモータの動作の際でもモータの位置が正確に算出される。つまり、制御部が算出したモータの位置に累積的な誤差が発生しても、その誤差が解消される。
According to the first aspect of the present invention, the initial position, the constraint start position, and the lock position are defined by the coordinate system representing the motor position, and the initial position data, the constraint start position data, and the lock position data indicate the motor position as the number of pulses. Therefore, the processing can be performed using a coordinate system in which the control unit expresses the position of the motor. Therefore, the difference or sum calculated by the control unit in the counting process accurately represents the actual motor position, and the determination process can accurately determine whether the motor position is between the constraint start positions. it can.
When the control unit determines that the position of the motor is not between the restraint start positions, the movable unit is moved and locked to the end of the movable range, and the control unit continues to rotate the motor thereafter. When the play or rattling of the transmission mechanism between the motor and the movable portion is tightened, the load on the motor increases and the motor current increases. At this time, since the control unit stops the motor when the current data input from the current detection unit exceeds a predetermined value, the motor is stopped in a locked state at the lock position. Thereafter, since the initial position data is rewritten to the number of pulses that is the value of the lock position data representing the lock position, the initial position data accurately represents the actual lock position of the motor. Therefore, even when the movable part moves to the end of the movable range and is locked and the motor further rotates, the position of the motor is accurately calculated.
Even if the movable part moves to the end of the movable range and is locked, and the motor further rotates, even if the ripple pulse is not generated accurately, the initial position data is the lock position data indicating the lock position after the stop process. Since the value is rewritten, the position of the motor is accurately calculated even during the subsequent operation of the motor. That is, even if a cumulative error occurs in the motor position calculated by the control unit, the error is eliminated.

請求項2に係る発明によれば、初期位置データの値がロック位置データの値に等しいと制御部が第二判定処理において判定した場合、モータの動作前の初期位置がロック位置である。その場合、制御部が計数処理において算出する差又は和が拘束開始位置データの値に等しくなるまで、モータの停止を禁止しているから、モータがロック位置と拘束開始位置の間で停止することがない。そのため、制御部が算出するモータの位置は、実際のモータの位置を正確に表す。よって、モータの位置を正確に制御することができる。   According to the invention of claim 2, when the control unit determines in the second determination process that the value of the initial position data is equal to the value of the lock position data, the initial position before the operation of the motor is the lock position. In that case, since the motor is prohibited to stop until the difference or sum calculated in the counting process is equal to the value of the constraint start position data, the motor must stop between the lock position and the constraint start position. There is no. Therefore, the motor position calculated by the control unit accurately represents the actual motor position. Therefore, the position of the motor can be accurately controlled.

請求項3に係る発明によれば、制御部によって算出されたモータの位置が拘束開始位置の間であると制御部が判定した場合に、制御部がモータを停止させるから、モータの停止位置が拘束開始位置の間である。そのため、その後制御部がモータを起動する際に制御部が算出するモータの位置は、実際のモータの位置を正確に表す。よって、モータの位置を正確に制御することができる。   According to the invention of claim 3, when the control unit determines that the position of the motor calculated by the control unit is between the constraint start positions, the control unit stops the motor. Between the restraint start positions. Therefore, the position of the motor calculated by the control unit when the control unit subsequently starts up the motor accurately represents the actual position of the motor. Therefore, the position of the motor can be accurately controlled.

請求項5に係る発明によれば、所定の停止条件が満たされても、制御部が判定処理を実行し、その判定の結果、制御部が停止処理を実行すれば、モータが継続して回転した後に、モータが停止する。つまり、モータの位置が拘束開始位置からロック位置の間にとなる際に、所定の停止条件が満たされても、モータがすぐに停止せずにロック位置で停止する。   According to the invention of claim 5, even if a predetermined stop condition is satisfied, the control unit executes the determination process, and if the control unit executes the stop process as a result of the determination, the motor continues to rotate. After that, the motor stops. That is, when the position of the motor is between the restraint start position and the lock position, even if a predetermined stop condition is satisfied, the motor does not stop immediately but stops at the lock position.

本発明を適用した実施形態に係るモータ制御装置を示したブロック図である。It is the block diagram which showed the motor control apparatus which concerns on embodiment to which this invention is applied. モータの位置を表現する座標系と可動部の位置を表現する座標系を示した図である。It is the figure which showed the coordinate system expressing the position of a motor, and the coordinate system expressing the position of a movable part. モータの電流信号の波形を示したタイミングチャートである。It is a timing chart showing a waveform of a motor current signal. モータの電流信号の波形を示したタイミングチャートである。It is a timing chart showing a waveform of a motor current signal. 電流電圧変換器、ハイパスフィルタ、バンドパスフィルタ、フィルタと差動増幅器、増幅器及び波形整形部の入力信号及び出力信号の波形を示した図である。It is the figure which showed the waveform of the input signal and output signal of a current-voltage converter, a high pass filter, a band pass filter, a filter and a differential amplifier, an amplifier, and a waveform shaping part. フィルタの周波数特性を示したグラフである。It is the graph which showed the frequency characteristic of the filter. フィルタと差動増幅器を示した回路図である。It is a circuit diagram showing a filter and a differential amplifier. フィルタと差動増幅器の入力信号及び出力信号の波形を示したタイミングチャートである。It is the timing chart which showed the waveform of the input signal and output signal of a filter and a differential amplifier. モータを起動させる処理の流れを示したフローチャートである。It is the flowchart which showed the flow of the process which starts a motor. モータの動作中にパルス信号のパルス数を計数する処理の流れを示したフローチャートである。It is the flowchart which showed the flow of the process which counts the pulse number of a pulse signal during operation | movement of a motor. モータを停止させる処理の流れを示したフローチャートである。It is the flowchart which showed the flow of the process which stops a motor. 車両用シート装置のシート本体を示した側面図である。It is the side view which showed the seat main body of the vehicle seat apparatus. フィルタの周波数特性を示したグラフである。It is the graph which showed the frequency characteristic of the filter. フィルタの周波数特性を示したグラフである。It is the graph which showed the frequency characteristic of the filter.

以下に、本発明を実施するための形態について図面を用いて説明する。但し、以下に述べる実施形態には、本発明を実施するために技術的に好ましい種々の限定が付されているが、本発明の範囲を以下の実施形態及び図示例に限定するものではない。   EMBODIMENT OF THE INVENTION Below, the form for implementing this invention is demonstrated using drawing. However, the embodiments described below are given various technically preferable limitations for carrying out the present invention, but the scope of the present invention is not limited to the following embodiments and illustrated examples.

図1は、モータ制御装置1のブロック図である。
モータ制御装置1は、モータ2、抽出回路3、制御部4、記憶部5、モータドライバ6、A/Dコンバータ7、A/Dコンバータ8及び入力部9c等を備える。
FIG. 1 is a block diagram of the motor control device 1.
The motor control device 1 includes a motor 2, an extraction circuit 3, a control unit 4, a storage unit 5, a motor driver 6, an A / D converter 7, an A / D converter 8, an input unit 9c, and the like.

モータ2と可動部の間に伝動機構が設けられ、モータ2が伝動機構に連結され、伝動機構が可動部に連結されている。モータ2が回転すると、モータ2の動力が伝動機構によって可動部に伝達され、モータ2が可動部を移動させる。図2は、モータ2の位置を表現する座標系と可動部99の位置を表現する座標系を示した図である。可動部99の可動範囲の両端にストッパ98,98がそれぞれ設けられ、可動部99の可動範囲がこれらストッパ98,98の間に設定されている。モータ2が正転して可動部99が一方のストッパ98に当接すると、可動部99が可動範囲の外に移動できないが、モータ2は伝動機構等の遊び、弾性変形及びがたつき等の分だけ正転することができる。一方、モータ2が正転して可動部99が他方のストッパ98に当接すると、可動部99が可動範囲の外に移動できないが、モータ2は伝動機構等の遊び、弾性変形及びがたつき等の分だけ逆転することができる。つまり、モータ2の可動範囲は可動部99の可動範囲よりも広い。   A transmission mechanism is provided between the motor 2 and the movable part, the motor 2 is coupled to the transmission mechanism, and the transmission mechanism is coupled to the movable part. When the motor 2 rotates, the power of the motor 2 is transmitted to the movable part by the transmission mechanism, and the motor 2 moves the movable part. FIG. 2 is a diagram showing a coordinate system expressing the position of the motor 2 and a coordinate system expressing the position of the movable part 99. Stoppers 98 and 98 are respectively provided at both ends of the movable range of the movable portion 99, and the movable range of the movable portion 99 is set between these stoppers 98 and 98. When the motor 2 rotates forward and the movable part 99 comes into contact with one of the stoppers 98, the movable part 99 cannot move out of the movable range, but the motor 2 is free from play of the transmission mechanism, elastic deformation, rattling, etc. You can rotate forward by the minute. On the other hand, when the motor 2 rotates forward and the movable part 99 comes into contact with the other stopper 98, the movable part 99 cannot move out of the movable range, but the motor 2 is free from play, elastic deformation and rattling of the transmission mechanism. It can be reversed by the same amount. That is, the movable range of the motor 2 is wider than the movable range of the movable portion 99.

可動部99が可動範囲内からストッパ98に当接するまで移動し、モータ2の更なる回転によって伝動機構等の遊び等が締められ始める位置を拘束開始位置という。つまり、モータ2の位置が拘束開始位置であれば、可動部99が可動範囲の端に位置してストッパ98に当接して可動部99が拘束されるが、可動部99がそのストッパ98に向かう向きにモータ2が更に回転することができる。   The position where the movable portion 99 moves from the movable range until it abuts against the stopper 98 and the play of the transmission mechanism or the like starts to be tightened by the further rotation of the motor 2 is referred to as a constraint start position. That is, if the position of the motor 2 is the restraint start position, the movable part 99 is positioned at the end of the movable range and abuts against the stopper 98 to restrain the movable part 99, but the movable part 99 moves toward the stopper 98. The motor 2 can further rotate in the direction.

可動部99がストッパ98に当接した状態で伝動機構等の遊び等が締められてモータ2がそれ以上回転できずに拘束された位置をロック位置という。モータ2の可動範囲の両端の位置がロック位置となる。つまり、モータ2の位置がロック位置であれば、可動部99が可動範囲の端に位置してストッパ98に当接して、伝動機構等の遊び等がなく、可動部99がそのストッパ98に向かう向きにモータ2が回転することができない。   A position where the play of the transmission mechanism or the like is tightened while the movable portion 99 is in contact with the stopper 98 and the motor 2 cannot be rotated any more and is restrained is called a lock position. The positions at both ends of the movable range of the motor 2 are the lock positions. That is, if the position of the motor 2 is the lock position, the movable portion 99 is positioned at the end of the movable range and abuts against the stopper 98, there is no play or the like of the transmission mechanism, and the movable portion 99 faces the stopper 98. The motor 2 cannot rotate in the direction.

拘束開始位置からロック位置にかけての範囲を拘束範囲といい、一方の拘束開始位置から他方の拘束開始位置にかけての範囲を非拘束範囲という。また、所定の原点位置が両方の拘束開始位置の間に予め設定され、モータ2の位置は原点位置を基準と定められる。なお、原点位置がロック位置に設定されてもよい。   A range from the constraint start position to the lock position is referred to as a constraint range, and a range from one constraint start position to the other constraint start position is referred to as a non-constraint range. Further, a predetermined origin position is set in advance between both of the constraint start positions, and the position of the motor 2 is determined with the origin position as a reference. The origin position may be set as the lock position.

モータ2は、直流モータである。電流がモータ2に流れると、モータ2が回転するとともに、モータ2が周期的なリプル(ripple)を電流に発生させる。モータ2の電流信号について図3及び図4を参照して説明する。図4は、モータ2が可動範囲内の或る位置からロック位置まで駆動される際にモータ2に流れる電流のレベルの変化を示したチャートである。図4は、図3に示されたA部における時間及び電流のスケールを大きくして示したチャートである。   The motor 2 is a direct current motor. When a current flows through the motor 2, the motor 2 rotates and the motor 2 generates a periodic ripple in the current. The current signal of the motor 2 will be described with reference to FIGS. FIG. 4 is a chart showing changes in the level of current flowing through the motor 2 when the motor 2 is driven from a certain position within the movable range to the locked position. FIG. 4 is a chart showing an enlarged time and current scale in the A part shown in FIG.

図3において、時刻T1はモータ2が起動したタイミングであり、時刻T2はモータ2が安定的に動作し始めるタイミングである。時刻T3は、モータ2によって駆動される可動部99がストッパ98に当接して、モータ2の動力を可動部99に伝える伝動機構が締められ始めるタイミングである。時刻T3は、モータ2が拘束開始位置に位置するタイミングでもある。時刻T4は、モータ2の位置がロック位置になってモータ2が停止するタイミングである。   In FIG. 3, time T1 is timing when the motor 2 is started, and time T2 is timing when the motor 2 starts to operate stably. Time T3 is a timing when the movable portion 99 driven by the motor 2 comes into contact with the stopper 98 and the transmission mechanism that transmits the power of the motor 2 to the movable portion 99 starts to be tightened. Time T3 is also the timing at which the motor 2 is positioned at the restraint start position. Time T4 is a timing at which the motor 2 stops when the position of the motor 2 becomes the locked position.

図3及び図4に示すように、モータ2の電流信号は直流成分、リプル成分及び一又は複数の周波成分(交流成分)を含み、周波成分及びリプル成分が直流成分に重畳している。モータ2の電流信号のうち、電流のレベルが急激に変化した高周波成分はノイズである(例えば、符号n参照)。なお、図4は、高周波ノイズ成分がないものとして図示されている。   As shown in FIGS. 3 and 4, the current signal of the motor 2 includes a DC component, a ripple component, and one or more frequency components (AC component), and the frequency component and the ripple component are superimposed on the DC component. Of the current signal of the motor 2, the high frequency component in which the current level has changed abruptly is noise (see, for example, symbol n). Note that FIG. 4 is illustrated as having no high frequency noise component.

時刻T1から時刻T2までの期間P1では、リプル成分r1と、リプル成分r1よりも周波数が低い低周波成分とが直流成分に重畳している。期間P1のうちモータ2の起動直後では、慣性力の影響により低周波成分の電流レベルが大きく、その後、低周波成分の電流レベルが時間の経過に伴って緩やかに減少する。また、モータ2の起動直後では、低周波成分よりも周波数が高いリプル成分r1の振幅が大きく、その後、リプル成分r1の周波数が時間の経過に伴って漸増するとともに、リプル成分r1の振幅が時間の経過に伴って漸減する。   In a period P1 from time T1 to time T2, the ripple component r1 and a low frequency component having a frequency lower than the ripple component r1 are superimposed on the direct current component. Immediately after the start of the motor 2 in the period P1, the current level of the low frequency component is large due to the influence of the inertial force, and then the current level of the low frequency component gradually decreases with time. Immediately after the start of the motor 2, the amplitude of the ripple component r1 having a higher frequency than the low frequency component is large, and thereafter, the frequency of the ripple component r1 gradually increases with time, and the amplitude of the ripple component r1 is increased over time. It gradually decreases with the progress of.

時刻T2から時刻T3までの期間P2では、リプル成分r2と、リプル成分r2よりも周波数が低い低周波成分とが直流成分に重畳し、直流成分がほぼ一定で安定し、低周波成分の周波数及び振幅が安定し、リプル成分r2の周波数及び振幅が安定している。リプル成分r2の周波数が低周波成分の周波数よりも高くなるのは、モータ2に内蔵された複数のコイルが巻き線抵抗に差を有するためである。   In the period P2 from time T2 to time T3, the ripple component r2 and the low frequency component having a frequency lower than the ripple component r2 are superimposed on the DC component, the DC component is substantially constant and stable, and the frequency of the low frequency component and The amplitude is stable, and the frequency and amplitude of the ripple component r2 are stable. The reason why the frequency of the ripple component r2 is higher than the frequency of the low frequency component is that a plurality of coils built in the motor 2 have a difference in winding resistance.

時刻T3から時刻T4までの期間P3では、モータ2の電流信号のうち低周波成分の周波数が低くなり、低周波成分の電流レベルが時間の経過とともに漸増する。期間P3では、モータ2の電流信号のうちリプル成分r3の周波数が時間の経過に伴って漸減し、リプル成分r3の振幅が時間の経過に伴って漸増する。期間P3では、可動部99がストッパ98に当接しているため、モータ2が極低速で回転する。   In a period P3 from time T3 to time T4, the frequency of the low frequency component of the current signal of the motor 2 decreases, and the current level of the low frequency component gradually increases with time. In the period P3, the frequency of the ripple component r3 in the current signal of the motor 2 gradually decreases with time, and the amplitude of the ripple component r3 gradually increases with time. In the period P3, since the movable part 99 is in contact with the stopper 98, the motor 2 rotates at an extremely low speed.

モータ2の電流信号のうち低周波成分及びリプル成分の周波数及び振幅は、様々な環境(例えば、モータ2に対する負荷、環境温度、モータ2の電源電圧等)の影響を受ける。そのため、環境が変化すれば、低周波成分及びリプル成分の周波数及び振幅が変化する。   The frequency and amplitude of the low frequency component and the ripple component of the current signal of the motor 2 are affected by various environments (for example, load on the motor 2, environmental temperature, power supply voltage of the motor 2, etc.). Therefore, when the environment changes, the frequency and amplitude of the low frequency component and the ripple component change.

抽出回路3は、以上のようなモータ2の電流信号からリプル成分を抽出して、リプル成分をパルス化し、リプル成分がパルス化されてなるパルス信号を制御部4に出力する。抽出回路3及び抽出回路3を用いたリプル抽出方法について具体的に説明する。   The extraction circuit 3 extracts a ripple component from the current signal of the motor 2 as described above, pulses the ripple component, and outputs a pulse signal obtained by pulsing the ripple component to the control unit 4. The ripple extraction method using the extraction circuit 3 and the extraction circuit 3 will be specifically described.

図1に示すように、抽出回路3は、電流電圧変換器10、ハイパスフィルタ(High-pass Filter)20、バンドパスフィルタ(Band-pass Filter)30、フィルタ40、差動増幅器50、増幅器60及び波形整形部70を備える。図5は、電流電圧変換器10、ハイパスフィルタ20、バンドパスフィルタ30、フィルタ40と差動増幅器50、増幅器60及び波形整形部70の入力信号及び出力信号を説明するための図である。図5において、電流電圧変換器10、ハイパスフィルタ20及びバンドパスフィルタ30の入力信号と出力信号が示されている期間は、図3における時刻T1から期間P2の初期にかけてである。フィルタ40と差動増幅器50、増幅器60及び波形整形部70の入力信号及び出力信号が示されている期間は、図3における期間P2の一部である。   As shown in FIG. 1, the extraction circuit 3 includes a current-voltage converter 10, a high-pass filter 20, a band-pass filter 30, a filter 40, a differential amplifier 50, an amplifier 60, and A waveform shaping unit 70 is provided. FIG. 5 is a diagram for explaining input signals and output signals of the current-voltage converter 10, the high-pass filter 20, the band-pass filter 30, the filter 40 and the differential amplifier 50, the amplifier 60, and the waveform shaping unit 70. In FIG. 5, the period in which the input signals and output signals of the current-voltage converter 10, the high-pass filter 20, and the band-pass filter 30 are shown is from time T1 to the beginning of the period P2 in FIG. A period in which the input signals and output signals of the filter 40, the differential amplifier 50, the amplifier 60, and the waveform shaping unit 70 are shown is a part of the period P2 in FIG.

電流電圧変換器10は、モータ2の電流信号を入力する。電流電圧変換器10は、入力したモータ2の電流信号を電圧信号に変換する。具体的には、電流電圧変換器10が抵抗器11を有し、抵抗器11がグランドとモータ2の間に接続され、モータ2の電流信号が抵抗器11とモータ2の間における電圧信号に変換される。電流電圧変換器10は、変換した電圧信号をハイパスフィルタ20及びバンドパスフィルタ30を介してフィルタ40及び差動増幅器50に出力する。なお、電流電圧変換器10は、オペアンプを用いたもの(例えば、負帰還型電流電圧変換器)でもよい。   The current / voltage converter 10 inputs a current signal of the motor 2. The current-voltage converter 10 converts the input current signal of the motor 2 into a voltage signal. Specifically, the current-voltage converter 10 includes a resistor 11, the resistor 11 is connected between the ground and the motor 2, and the current signal of the motor 2 is converted into a voltage signal between the resistor 11 and the motor 2. Converted. The current-voltage converter 10 outputs the converted voltage signal to the filter 40 and the differential amplifier 50 via the high-pass filter 20 and the band-pass filter 30. The current-voltage converter 10 may be one using an operational amplifier (for example, a negative feedback current-voltage converter).

ハイパスフィルタ20は、電流電圧変換器10によって変換された電圧信号(電流電圧変換器10の出力信号)を入力する。ハイパスフィルタ20は、電流電圧変換器10によって変換された電圧信号(電流電圧変換器10の出力信号)のうち高周波成分を通過させ、低周波成分を減衰させる。つまり、ハイパスフィルタ20は、電流電圧変換器10によって変換された電圧信号のうち直流成分を除去する。ハイパスフィルタ20は、バンドパスフィルタ30を介して、低周波成分が減衰した信号をフィルタ40及び差動増幅器50に出力する。
ハイパスフィルタ20は、オペアンプを用いたもの(例えば、負帰還型ハイパスフィルタ、正帰還型ハイパスフィルタ)又は抵抗器・キャパシタを用いたもの(例えば、CRハイパスフィルタ)である。
The high-pass filter 20 receives the voltage signal converted by the current-voltage converter 10 (output signal of the current-voltage converter 10). The high-pass filter 20 passes a high-frequency component of the voltage signal converted by the current-voltage converter 10 (an output signal of the current-voltage converter 10) and attenuates a low-frequency component. That is, the high pass filter 20 removes a DC component from the voltage signal converted by the current-voltage converter 10. The high pass filter 20 outputs a signal with the low frequency component attenuated to the filter 40 and the differential amplifier 50 via the band pass filter 30.
The high-pass filter 20 is one using an operational amplifier (for example, a negative feedback high-pass filter or a positive feedback high-pass filter) or one using a resistor / capacitor (for example, a CR high-pass filter).

バンドパスフィルタ30は、電流電圧変換器10によって変換された電圧信号をハイパスフィルタ20を介して入力する。バンドパスフィルタ30は、電流電圧変換器10によって変換された電圧信号(ハイパスフィルタ20の出力信号)のうち所定周波数帯域の成分を通過させ、その所定周波数帯域外の成分を減衰させる。つまり、バンドパスフィルタ30は、電流電圧変換器10によって変換された電圧信号(ハイパスフィルタ20の出力信号)のうち高周波ノイズ成分を除去するとともに、ハイパスフィルタ20によって除去しきれなかった低周波成分を除去する。バンドパスフィルタ30は、所定周波数帯域外の成分を減衰させた信号をフィルタ40及び差動増幅器50に出力する。
バンドパスフィルタ30は、オペアンプを用いたもの(例えば、多重負帰還型バンドパスフィルタ、多重正帰還型バンドパスフィルタ)又は抵抗器・キャパシタを用いたものである。
The bandpass filter 30 inputs the voltage signal converted by the current-voltage converter 10 via the highpass filter 20. The band-pass filter 30 passes a component in a predetermined frequency band of the voltage signal (the output signal of the high-pass filter 20) converted by the current-voltage converter 10, and attenuates a component outside the predetermined frequency band. That is, the band-pass filter 30 removes high-frequency noise components from the voltage signal (output signal of the high-pass filter 20) converted by the current-voltage converter 10, and removes low-frequency components that could not be removed by the high-pass filter 20. Remove. The bandpass filter 30 outputs a signal obtained by attenuating a component outside a predetermined frequency band to the filter 40 and the differential amplifier 50.
The band pass filter 30 uses an operational amplifier (for example, a multiple negative feedback type band pass filter, a multiple positive feedback type band pass filter) or a resistor / capacitor.

なお、バンドパスフィルタ30がハイパスフィルタ20の後段に設けられているが、バンドパスフィルタ30が電流電圧変換器10の後段であってハイパスフィルタ20の前段に設けられてもよい。   Although the band pass filter 30 is provided in the subsequent stage of the high pass filter 20, the band pass filter 30 may be provided in the subsequent stage of the current-voltage converter 10 and in front of the high pass filter 20.

フィルタ40は、電流電圧変換器10によって変換された電圧信号をハイパスフィルタ20及びバンドパスフィルタ30を介して入力し、その信号を濾波する。フィルタ40は、濾波した信号を差動増幅器50に出力する。   The filter 40 receives the voltage signal converted by the current-voltage converter 10 through the high-pass filter 20 and the band-pass filter 30, and filters the signal. The filter 40 outputs the filtered signal to the differential amplifier 50.

図6は、フィルタ40の周波数特性を示したグラフである。
図6に示すように、フィルタ40は、バンドパスフィルタである。フィルタ40は、電流電圧変換器10によって変換された電圧信号(バンドパスフィルタ30の出力信号)のうち、低カットオフ周波数fc1から高カットオフ周波数fc2までの間の中間周波数帯域の成分を通過させる。低カットオフ周波数fc1はフィルタ40のハイパスフィルタ部のカットオフ周波数であり、高カットオフ周波数fc2はフィルタ40のローパスフィルタ部のカットオフ周波数であり、低カットオフ周波数fc1<高カットオフ周波数fc2である。なお、カットオフ周波数とは、出力電力が入力電力の1/2となる周波数を指す。つまり、ゲインGが−3dbとなる周波数がカットオフ周波数である。
FIG. 6 is a graph showing the frequency characteristics of the filter 40.
As shown in FIG. 6, the filter 40 is a bandpass filter. The filter 40 passes the component in the intermediate frequency band between the low cutoff frequency fc1 and the high cutoff frequency fc2 in the voltage signal (the output signal of the bandpass filter 30) converted by the current-voltage converter 10. . The low cut-off frequency fc1 is the cut-off frequency of the high-pass filter portion of the filter 40, and the high cut-off frequency fc2 is the cut-off frequency of the low-pass filter portion of the filter 40, and the low cut-off frequency fc1 <the high cut-off frequency fc2. is there. The cut-off frequency refers to a frequency at which the output power is 1/2 of the input power. That is, the frequency at which the gain G is −3 db is the cutoff frequency.

また、フィルタ40は、電流電圧変換器10によって変換された電圧信号(バンドパスフィルタ30の出力信号)のうち、低カットオフ周波数fc1を下回る低周波域の成分を減衰させる。具体的には、低カットオフ周波数fc1を下回る低周波域において、フィルタ40は、電流電圧変換器10によって変換された電圧信号(バンドパスフィルタ30の出力信号)に含まれる成分の周波数が低いほど減衰率がより高くなるように、電流電圧変換器10によって変換された電圧信号(バンドパスフィルタ30の出力信号)の低周波域成分を減衰させる。   Further, the filter 40 attenuates a component in a low frequency range lower than the low cutoff frequency fc1 in the voltage signal (the output signal of the bandpass filter 30) converted by the current-voltage converter 10. Specifically, in the low frequency range lower than the low cut-off frequency fc1, the filter 40 has a lower component frequency included in the voltage signal (the output signal of the bandpass filter 30) converted by the current-voltage converter 10. The low frequency band component of the voltage signal (the output signal of the band pass filter 30) converted by the current-voltage converter 10 is attenuated so that the attenuation rate becomes higher.

また、フィルタ40は、電流電圧変換器10によって変換された電圧信号(バンドパスフィルタ30の出力信号)のうち、高カットオフ周波数fc2を超える高周波域の成分を減衰させる。具体的には、高カットオフ周波数fc2を超える高周波域において、フィルタ40は、電流電圧変換器10によって変換された電圧信号(バンドパスフィルタ30の出力信号)に含まれる成分の周波数が低いほど減衰率がより低くなるように、電流電圧変換器10によって変換された電圧信号(バンドパスフィルタ30の出力信号)の高周波域成分を減衰させる。   Further, the filter 40 attenuates a component in a high frequency region exceeding the high cut-off frequency fc2 in the voltage signal (the output signal of the bandpass filter 30) converted by the current-voltage converter 10. Specifically, in a high frequency region exceeding the high cut-off frequency fc2, the filter 40 attenuates as the frequency of the component included in the voltage signal (the output signal of the bandpass filter 30) converted by the current-voltage converter 10 decreases. The high frequency component of the voltage signal (the output signal of the bandpass filter 30) converted by the current-voltage converter 10 is attenuated so that the rate becomes lower.

図3及び図4に示したように、モータ2の電流信号は、リプル成分と、そのリプル成分よりも周波数が低い低周波成分とを重畳したものである。リプル成分の周波数は実験・測定等によって予め調べられ、フィルタ40の回路設計において、温度変化によるリプル成分の周波数の変動も考慮しつつ、フィルタ40の高カットオフ周波数fc2がリプル成分の周波数(例えば、常温時の周波数)よりも低く設定されている。従って、フィルタ40は、電流電圧変換器10によって変換された電圧信号(バンドパスフィルタ30の出力信号)のうちリプル成分を低周波成分(低周波成分はリプル成分よりも周波数が低い。)よりも高い減衰率で減衰させる。つまり、フィルタ40は、リプル成分を低周波成分よりも効率的に除去する。従って、フィルタ40は、リプル成分を除去した信号を差動増幅器50に出力する。   As shown in FIGS. 3 and 4, the current signal of the motor 2 is obtained by superimposing a ripple component and a low-frequency component having a frequency lower than that of the ripple component. The frequency of the ripple component is checked in advance by experiments, measurements, etc., and in the circuit design of the filter 40, the high cutoff frequency fc2 of the filter 40 is set to the frequency of the ripple component (for example, the frequency of the ripple component due to temperature change). , The frequency at room temperature). Therefore, the filter 40 has a ripple component in the voltage signal (the output signal of the band pass filter 30) converted by the current-voltage converter 10 that is lower in frequency than the low frequency component (the frequency of the low frequency component is lower than that of the ripple component). Attenuate with high attenuation factor. That is, the filter 40 removes the ripple component more efficiently than the low frequency component. Therefore, the filter 40 outputs a signal from which the ripple component has been removed to the differential amplifier 50.

差動増幅器50は、電流電圧変換器10によって変換された電圧信号をハイパスフィルタ20及びバンドパスフィルタ30を介して入力するとともに、フィルタ40の出力信号を入力する。差動増幅器50は、入力したフィルタ40の出力信号と、電流電圧変換器10によって変換された電圧信号(バンドパスフィルタ30の出力信号)の差分を取って、その差分を増幅する。差動増幅器50は、その差分を表す差分信号を増幅器60に出力する。   The differential amplifier 50 inputs the voltage signal converted by the current-voltage converter 10 via the high-pass filter 20 and the band-pass filter 30 and also receives the output signal of the filter 40. The differential amplifier 50 takes the difference between the input output signal of the filter 40 and the voltage signal converted by the current-voltage converter 10 (the output signal of the bandpass filter 30), and amplifies the difference. The differential amplifier 50 outputs a differential signal representing the difference to the amplifier 60.

図7は、フィルタ40と差動増幅器50の一例を示した回路図である。図8(a)は図7に示されたA部における電圧信号の波形を示したタイミングチャートであり、図8(b)は図7に示されたB部における電圧信号の波形を示したタイミングチャートであり、図8(c)は図7に示されたC部における電圧信号の波形を示したタイミングチャートである。   FIG. 7 is a circuit diagram illustrating an example of the filter 40 and the differential amplifier 50. FIG. 8A is a timing chart showing the waveform of the voltage signal in the portion A shown in FIG. 7, and FIG. 8B is a timing showing the waveform of the voltage signal in the portion B shown in FIG. FIG. 8C is a timing chart showing the waveform of the voltage signal in the portion C shown in FIG.

図7に示すように、フィルタ40は、ハイパスフィルタ41、ローパスフィルタ42及びハイパスフィルタ43を有する。バンドパスフィルタ30の出力がハイパスフィルタ41の入力に接続され、ハイパスフィルタ41の出力がローパスフィルタ42の入力に接続され、ローパスフィルタ42の出力がハイパスフィルタ43の入力に接続される。   As shown in FIG. 7, the filter 40 includes a high-pass filter 41, a low-pass filter 42, and a high-pass filter 43. The output of the band pass filter 30 is connected to the input of the high pass filter 41, the output of the high pass filter 41 is connected to the input of the low pass filter 42, and the output of the low pass filter 42 is connected to the input of the high pass filter 43.

ハイパスフィルタ41は、二次のCRハイパスフィルタである。つまり、ハイパスフィルタ41は、キャパシタ41a、抵抗器41b、キャパシタ41c及び抵抗器41dを有する。なお、ハイパスフィルタ41が一つのキャパシタ及び抵抗器からなる一次のCRハイパスフィルタであってもよい。また、ハイパスフィルタ41が三次以上のCRハイパスフィルタでもよい。   The high pass filter 41 is a secondary CR high pass filter. That is, the high pass filter 41 includes a capacitor 41a, a resistor 41b, a capacitor 41c, and a resistor 41d. Note that the high-pass filter 41 may be a primary CR high-pass filter including one capacitor and a resistor. Further, the high-pass filter 41 may be a third-order or higher CR high-pass filter.

ローパスフィルタ42は、二次のRCローパスフィルタである。つまり、ローパスフィルタ42は、抵抗器42a、キャパシタ42b、抵抗器42c及びキャパシタ42dを有する。なお、ローパスフィルタ42が一つの抵抗器及びキャパシタからなる一次のRCローパスフィルタであってもよい。また、ローパスフィルタ42が三次以上のRCローパスフィルタでもよい。
ハイパスフィルタ43は、キャパシタ43aからなる。
The low pass filter 42 is a secondary RC low pass filter. That is, the low-pass filter 42 includes a resistor 42a, a capacitor 42b, a resistor 42c, and a capacitor 42d. The low-pass filter 42 may be a primary RC low-pass filter including one resistor and a capacitor. Further, the low-pass filter 42 may be a third-order or higher RC low-pass filter.
The high pass filter 43 includes a capacitor 43a.

差動増幅器50は抵抗器51,52、オペアンプ53、カップリングコンデンサ54及びバイアス回路55等を有する。オペアンプ53の出力端子が抵抗器52を介してオペアンプ53の反転入力端子に接続され、負帰還がオペアンプ53にかけられている。フィルタ40の出力信号(ハイパスフィルタ43の出力信号)が抵抗器51を介してオペアンプ53の反転入力端子に入力され、バンドパスフィルタ30の出力信号がカップリングコンデンサ54及びバイアス回路55を介してオペアンプ53の非反転入力端子に入力される。カップリングコンデンサ54は、バンドパスフィルタ30の出力信号の直流成分を除去する。バイアス回路55は、電源電圧とグランドの間に直列された抵抗器56,57を有する。バイアス回路55は、カップリングコンデンサ54によって直流成分が除去されたバンドパスフィルタ30の出力信号にバイアス電圧をかけて、バンドパスフィルタ30の出力信号の基準レベルを引き上げる。なお、カップリングコンデンサ54及びバイアス回路55を省略してもよい。   The differential amplifier 50 includes resistors 51 and 52, an operational amplifier 53, a coupling capacitor 54, a bias circuit 55, and the like. The output terminal of the operational amplifier 53 is connected to the inverting input terminal of the operational amplifier 53 via the resistor 52, and negative feedback is applied to the operational amplifier 53. The output signal of the filter 40 (the output signal of the high pass filter 43) is input to the inverting input terminal of the operational amplifier 53 via the resistor 51, and the output signal of the band pass filter 30 is supplied to the operational amplifier via the coupling capacitor 54 and the bias circuit 55. 53 is input to the non-inverting input terminal. The coupling capacitor 54 removes a direct current component of the output signal of the band pass filter 30. The bias circuit 55 includes resistors 56 and 57 connected in series between the power supply voltage and the ground. The bias circuit 55 applies a bias voltage to the output signal of the bandpass filter 30 from which the DC component has been removed by the coupling capacitor 54, and raises the reference level of the output signal of the bandpass filter 30. Note that the coupling capacitor 54 and the bias circuit 55 may be omitted.

差動増幅器50によって出力された差分信号は、電流電圧変換器10によって変換された電圧信号のうちリプル成分である。差動増幅器50によって出力された差分信号が、バンドパスフィルタ30の出力信号とフィルタ40の出力信号との差分を表すからこそ、モータ2の電流信号の各成分の周波数が環境変化によって変化しても、モータ2の電流信号に含まれるリプルを高精度に検出することができる。   The differential signal output by the differential amplifier 50 is a ripple component of the voltage signal converted by the current-voltage converter 10. Because the difference signal output by the differential amplifier 50 represents the difference between the output signal of the bandpass filter 30 and the output signal of the filter 40, the frequency of each component of the current signal of the motor 2 changes due to environmental changes. In addition, ripples included in the current signal of the motor 2 can be detected with high accuracy.

図1、図7に示すように、増幅器60は、差動増幅器50によって出力された差分信号(オペアンプ53の出力信号)を入力する。増幅器60は、差動増幅器50によって出力された差分信号を増幅して、それを波形整形部70に出力する。増幅器60は、例えば負帰還型増幅器である。   As shown in FIGS. 1 and 7, the amplifier 60 inputs the differential signal (the output signal of the operational amplifier 53) output by the differential amplifier 50. The amplifier 60 amplifies the differential signal output by the differential amplifier 50 and outputs it to the waveform shaping unit 70. The amplifier 60 is, for example, a negative feedback amplifier.

波形整形部70は、差動増幅器50によって出力された差分信号(オペアンプ53の出力信号)を増幅器60を介して入力する。波形整形部70は、差動増幅器50によって出力された差分信号(増幅器60の出力信号)の波形を矩形波に整形する。具体的には、波形整形部70がコンパレータを有し、該コンパレータが、差動増幅器50によって出力された差分信号(増幅器60の出力信号)を基準電圧と比較することによって、差動増幅器50によって出力された差分信号(増幅器60の出力信号)をパルス信号に変換する。波形整形部70は、矩形波に整形されたパルス信号を制御部4に出力する。制御部4は、波形整形部70によって出力されたパルス信号を入力する。   The waveform shaping unit 70 inputs the differential signal (the output signal of the operational amplifier 53) output from the differential amplifier 50 via the amplifier 60. The waveform shaping unit 70 shapes the waveform of the differential signal (the output signal of the amplifier 60) output by the differential amplifier 50 into a rectangular wave. Specifically, the waveform shaping unit 70 has a comparator, and the comparator compares the differential signal (the output signal of the amplifier 60) output by the differential amplifier 50 with a reference voltage, thereby allowing the differential amplifier 50 to The output differential signal (the output signal of the amplifier 60) is converted into a pulse signal. The waveform shaping unit 70 outputs a pulse signal shaped into a rectangular wave to the control unit 4. The control unit 4 receives the pulse signal output from the waveform shaping unit 70.

モータドライバ6は、制御部4からの指令に従ってモータ2を駆動する。つまり、モータドライバ6は、制御部4から起動指令及び回転向き指令を受けたら、モータ2をその回転向きに起動させる。モータドライバ6は、制御部4から停止指令を受けたら、モータ2を停止する。   The motor driver 6 drives the motor 2 in accordance with a command from the control unit 4. That is, when the motor driver 6 receives the start command and the rotation direction command from the control unit 4, the motor driver 6 starts the motor 2 in the rotation direction. When the motor driver 6 receives a stop command from the control unit 4, the motor driver 6 stops the motor 2.

A/Dコンバータ7は、電圧検出部である。つまり、A/Dコンバータ7は、モータ2の電源電圧を検出して、その電圧信号をデジタル信号に変換して、デジタル化した電圧データを制御部4に出力する。制御部4は、A/Dコンバータ7によって出力される電圧データを入力する。   The A / D converter 7 is a voltage detection unit. That is, the A / D converter 7 detects the power supply voltage of the motor 2, converts the voltage signal into a digital signal, and outputs the digitized voltage data to the control unit 4. The control unit 4 inputs voltage data output by the A / D converter 7.

A/Dコンバータ8は、電流検出部である。つまり、A/Dコンバータ8は、モータ2の電流値を検出して、その電流信号をデジタル信号に変換して、デジタル化した電流データを制御部4に出力する。ここで、電流電圧変換器10の出力信号がモータ2の電流を表すので、A/Dコンバータ8は電流電圧変換器10の出力信号をデジタル信号に変換して、それを制御部4に出力する。制御部4は、A/Dコンバータ8によって出力される電流データを入力する。   The A / D converter 8 is a current detection unit. That is, the A / D converter 8 detects the current value of the motor 2, converts the current signal into a digital signal, and outputs the digitized current data to the control unit 4. Here, since the output signal of the current-voltage converter 10 represents the current of the motor 2, the A / D converter 8 converts the output signal of the current-voltage converter 10 into a digital signal and outputs it to the control unit 4. . The control unit 4 inputs current data output by the A / D converter 8.

制御部4は、CPU4a及びRAM4b等を有するコンピュータである。CPU4aは、数値計算、情報処理、機器制御等の各種処理を行う。RAM4bは、一時記憶領域としての作業領域をCPU4aに提供する。   The control unit 4 is a computer having a CPU 4a, a RAM 4b, and the like. The CPU 4a performs various processes such as numerical calculation, information processing, and device control. The RAM 4b provides a work area as a temporary storage area to the CPU 4a.

入力部9cが制御部4に接続されている。入力部9cは、複数のスイッチ等を有する。入力部9cがユーザ等によって操作された場合に、入力部9cが操作内容に応じた信号を制御部4に出力し、制御部4がその信号を入力するとともにその信号に応じた指令をモータドライバ6に出力する。   An input unit 9 c is connected to the control unit 4. The input unit 9c has a plurality of switches and the like. When the input unit 9c is operated by a user or the like, the input unit 9c outputs a signal corresponding to the operation content to the control unit 4, and the control unit 4 inputs the signal and sends a command corresponding to the signal to the motor driver. 6 is output.

記憶部5は、制御部4に接続されている。記憶部5は、不揮発性メモリ、ハードディスクといった読み書き可能な記憶媒体である。記憶部5は、一つの記憶媒体からなるものでもよいし、複数の記憶媒体を組み合わせたものでもよい。記憶部5が複数の記憶媒体を組み合わせたものである場合、何れかの記憶媒体がROMであってもよい。   The storage unit 5 is connected to the control unit 4. The storage unit 5 is a readable / writable storage medium such as a nonvolatile memory or a hard disk. The storage unit 5 may be a single storage medium or a combination of a plurality of storage media. When the storage unit 5 is a combination of a plurality of storage media, any one of the storage media may be a ROM.

記憶部5には、初期位置データ5Aが格納されている。初期位置データ5Aは、モータ2が動作する前のモータ2の初期位置を示す。具体的には、初期位置データ5Aは図2に示す座標系の座標で表されており、モータ2の位置を表す座標がパルス数で表現されている。従って、初期位置データ5Aは、仮に図2に示すようにモータ2が初期位置から所定の原点位置まで回転した場合、その間に抽出回路3によって出力されたパルス信号のパルス数で表現されている。初期位置データ5Aは、予め設定されたデフォルト値であるか、又は以前にモータ2が動作した際に書き込まれた値である。仮にモータ2の初期位置が原点位置であれば、初期位置データ5Aを表すパルス数はゼロである。初期位置データ5Aは、モータ2が停止する度に更新される。初期位置データ5Aの値が非拘束範囲内の値やロック位置の値になることはあるが、初期位置データ5Aの値が拘束範囲内(但し、ロック位置及び拘束開始位置を除く。)の値になることはない。   The storage unit 5 stores initial position data 5A. The initial position data 5A indicates the initial position of the motor 2 before the motor 2 operates. Specifically, the initial position data 5A is represented by coordinates in the coordinate system shown in FIG. 2, and the coordinates representing the position of the motor 2 are represented by the number of pulses. Therefore, the initial position data 5A is expressed by the number of pulses of the pulse signal output by the extraction circuit 3 during the rotation of the motor 2 from the initial position to a predetermined origin position as shown in FIG. The initial position data 5A is a preset default value or a value written when the motor 2 has been operated before. If the initial position of the motor 2 is the origin position, the number of pulses representing the initial position data 5A is zero. The initial position data 5A is updated every time the motor 2 stops. Although the value of the initial position data 5A may be a value within the non-restraint range or the value of the lock position, the value of the initial position data 5A is within the constraint range (however, excluding the lock position and the constraint start position). Never become.

記憶部5には、拘束開始位置データ5Bが格納されている。拘束開始位置データ5Bは、図2に示す座標系における拘束開始位置の座標を表す。従って、拘束開始位置データ5Bは、仮に図2に示すようにモータ2が拘束開始位置から所定の原点位置まで回転した場合、その間に抽出回路3によって出力されたパルス信号のパルス数で表される。   The storage unit 5 stores constraint start position data 5B. The constraint start position data 5B represents the coordinates of the constraint start position in the coordinate system shown in FIG. Therefore, the constraint start position data 5B is represented by the number of pulses of the pulse signal output by the extraction circuit 3 during the rotation of the motor 2 from the constraint start position to a predetermined origin position as shown in FIG. .

記憶部5には、ロック位置データ5Cが格納されている。ロック位置データ5Cは、図2に示す座標系におけるロック位置の座標を表す。従って、ロック位置データ5Cは、仮に図2に示すようにモータ2がロック位置から所定の原点位置まで回転した場合、その間に抽出回路3によって出力されたパルス信号のパルス数で表される。   The storage unit 5 stores lock position data 5C. The lock position data 5C represents the coordinates of the lock position in the coordinate system shown in FIG. Therefore, the lock position data 5C is represented by the number of pulses of the pulse signal output by the extraction circuit 3 during the rotation of the motor 2 from the lock position to a predetermined origin position as shown in FIG.

拘束開始位置データ5B及びロック位置データ5Cの値は、予め実験・測定等によって調査した値である。   The values of the constraint start position data 5B and the lock position data 5C are values previously investigated through experiments and measurements.

記憶部5には、制御部4にとって読み取り可能なプログラム5Zが格納されている。制御部4は、プログラム5Zを読み込んでそのプログラム5Zに従った処理を行ったり、そのプログラム5Zによって各種機能を実現したりする。拘束開始位置データ5B及びロック位置データ5Cはプログラム5Zとは別に記憶部5に格納されていてもよいし、プログラム5Zに組み込まれていてもよい。なお、記憶部5が複数の記憶媒体を組み合わせたものである場合、プログラム5Zが記憶部5のROMに格納されていてもよい。   The storage unit 5 stores a program 5Z that can be read by the control unit 4. The control unit 4 reads the program 5Z and performs processing according to the program 5Z, or implements various functions by the program 5Z. The constraint start position data 5B and the lock position data 5C may be stored in the storage unit 5 separately from the program 5Z, or may be incorporated in the program 5Z. When the storage unit 5 is a combination of a plurality of storage media, the program 5Z may be stored in the ROM of the storage unit 5.

プログラム5Zに基づく制御部4の処理の流れについて説明するとともに、制御部4の処理に伴うモータ制御装置1の動作について説明する。   The flow of processing of the control unit 4 based on the program 5Z will be described, and the operation of the motor control device 1 accompanying the processing of the control unit 4 will be described.

所定の起動条件が満たされると、制御部4がモータ2の起動処理(図9参照)を実行する。所定の起動条件が満たされるとは、例えば、ユーザが入力部9cの起動スイッチをオンにすること、起動センサがオンになること、制御部4によって実行されている処理(例えば、シーケンス処理)で所定の条件が満たされること等である。   When a predetermined activation condition is satisfied, the control unit 4 executes the activation process of the motor 2 (see FIG. 9). The predetermined activation condition is satisfied when, for example, the user turns on the activation switch of the input unit 9c, the activation sensor is turned on, or the processing (for example, sequence processing) executed by the control unit 4. For example, a predetermined condition is satisfied.

まず、制御部4は、モータ2の回転の向き(正回転か逆回転)を決定し、その回転の向きをRAM又は記憶部5に書き込む(ステップS11)。モータ2の回転の向きは、制御部4によって実行されている処理によって決められたり、ユーザによる入力部9cの操作によって決められたりする。例えば、ユーザが入力部9cの正転起動スイッチをオンにすれば、制御部4がモータ2の回転の向きを正転に決定し、ユーザが入力部9cの逆転起動スイッチをオンにすれば、制御部4がモータ2の回転の向きを逆転に決定する。   First, the control unit 4 determines the rotation direction (forward rotation or reverse rotation) of the motor 2, and writes the rotation direction in the RAM or the storage unit 5 (step S11). The direction of rotation of the motor 2 is determined by a process executed by the control unit 4 or determined by an operation of the input unit 9c by the user. For example, if the user turns on the forward rotation start switch of the input unit 9c, the control unit 4 determines the rotation direction of the motor 2 to be forward rotation, and if the user turns on the reverse rotation start switch of the input unit 9c, The control unit 4 determines the direction of rotation of the motor 2 to be reverse.

次に、制御部4が、記憶部5に記憶された初期位置データ5Aを読み込む。そして、制御部4は、読み込んだ初期位置データ5Aの値がロック位置データ5Cの値に等しいか否か判定する(ステップS12)。   Next, the control unit 4 reads the initial position data 5 </ b> A stored in the storage unit 5. Then, the control unit 4 determines whether or not the value of the read initial position data 5A is equal to the value of the lock position data 5C (step S12).

モータ2の初期位置がロック位置でない場合、初期位置データ5Aの値がロック位置データ5Cの値と異なる。その場合、制御部4は、初期位置データ5Aの値がロック位置データ5Cの値に等しくないと判定する(ステップS12:NO)。そして、制御部4は、ステップS11で決定した向きにモータ2を起動させる(ステップS16)。つまり、制御部4は、ステップS11で決定した向きに従った回転向き指令をモータドライバ6に出力するとともに、起動指令をそのモータドライバ6に出力する。回転向き指令及び起動指令を受けたモータドライバ6がモータ2に通電して、モータ2をその回転向きに駆動する。これにより、モータ2が回転し、モータ2によって可動部が駆動される。制御部4がモータ2を起動させたら、起動処理が終了する。なお、モータ2の起動後、制御部4は、抽出回路3から入力したパルス信号に基づいてパルス信号のパルス数の計数、モータ2の回転量の算出及びモータ2の位置(現在位置)の算出を行う。詳細については後述する(図10参照)。   When the initial position of the motor 2 is not the lock position, the value of the initial position data 5A is different from the value of the lock position data 5C. In that case, the control unit 4 determines that the value of the initial position data 5A is not equal to the value of the lock position data 5C (step S12: NO). And the control part 4 starts the motor 2 in the direction determined by step S11 (step S16). That is, the control unit 4 outputs a rotation direction command according to the direction determined in step S <b> 11 to the motor driver 6 and outputs a start command to the motor driver 6. Upon receiving the rotation direction command and the start command, the motor driver 6 energizes the motor 2 to drive the motor 2 in the rotation direction. Thereby, the motor 2 rotates and the movable part is driven by the motor 2. If the control part 4 starts the motor 2, a starting process will be complete | finished. After starting the motor 2, the control unit 4 counts the number of pulses of the pulse signal based on the pulse signal input from the extraction circuit 3, calculates the rotation amount of the motor 2, and calculates the position (current position) of the motor 2. I do. Details will be described later (see FIG. 10).

モータ2の初期位置が可動範囲の両端のロック位置のどちらか一方である場合、初期位置データ5Aの値がロック位置データ5Cの値に相当する。その場合、制御部4は、初期位置データ5Aの値がロック位置データ5Cの値に等しいと判定する(ステップS12:YES)。そして、制御部4の処理がステップS13に移行する。ステップS13では、制御部4は、ステップS11で決定した向きがロック位置から拘束開始位置に向かう向きであるか否かを判定する(ステップS13)。   When the initial position of the motor 2 is one of the lock positions at both ends of the movable range, the value of the initial position data 5A corresponds to the value of the lock position data 5C. In that case, the control unit 4 determines that the value of the initial position data 5A is equal to the value of the lock position data 5C (step S12: YES). And the process of the control part 4 transfers to step S13. In step S13, the control unit 4 determines whether or not the direction determined in step S11 is a direction from the lock position toward the constraint start position (step S13).

ステップS11で決定した向きがロック位置から拘束開始位置に向かう向きでないと制御部4が判定した場合(ステップS13:NO)、制御部4がモータ2を起動させずに(ステップS18)、起動処理が終了する。ステップS11で決定した向きがロック位置から拘束開始位置に向かう向きでない場合には、モータ2の回転向きが拘束開始位置からモータ2の初期位置となるロック位置に向かう向きになってしまい、伝動機構の遊び等が締められているから、たとえモータ2に電流が通電しても、モータ2が回転せず、モータ2に過電流等が発生してしまう虞がある。ところが、制御部4がモータ2を起動させないから(ステップS17)、そのような過電流等の発生を抑えることができる。   When the control unit 4 determines that the direction determined in step S11 is not the direction from the lock position to the constraint start position (step S13: NO), the control unit 4 does not start the motor 2 (step S18), and the startup process Ends. If the direction determined in step S11 is not the direction from the lock position to the restraint start position, the rotation direction of the motor 2 becomes the direction from the restraint start position to the lock position that is the initial position of the motor 2, and the transmission mechanism. Therefore, even if an electric current is supplied to the motor 2, the motor 2 does not rotate, and an overcurrent or the like may occur in the motor 2. However, since the control part 4 does not start the motor 2 (step S17), generation | occurrence | production of such an overcurrent etc. can be suppressed.

ステップS11で決定した向きがロック位置から拘束開始位置に向かう向きであると制御部4が判定した場合(ステップS13:YES)、制御部4は、ステップS11で決定した向きにモータ2を起動させる(ステップS14)。つまり、制御部4は、ステップS11で決定した向きに従った回転向き指令をモータドライバ6に出力するとともに、起動指令をそのモータドライバ6に出力する。回転向き指令及び起動指令を受けたモータドライバ6がモータ2に通電して、モータ2をその回転向きに駆動する。これにより、モータ2が回転し、モータ2によって可動部が駆動される。   When the control unit 4 determines that the direction determined in step S11 is the direction from the lock position toward the constraint start position (step S13: YES), the control unit 4 activates the motor 2 in the direction determined in step S11. (Step S14). That is, the control unit 4 outputs a rotation direction command according to the direction determined in step S <b> 11 to the motor driver 6 and outputs a start command to the motor driver 6. Upon receiving the rotation direction command and the start command, the motor driver 6 energizes the motor 2 to drive the motor 2 in the rotation direction. Thereby, the motor 2 rotates and the movable part is driven by the motor 2.

モータ2の起動後、制御部4は、抽出回路3から入力したパルス信号に基づいてパルス信号のパルス数の計数、モータ2の回転量の算出及びモータ2の位置(現在位置)の算出を行うとともに(図10参照)、算出したモータ2の位置を監視する(ステップS15)。そして、制御部4は、算出したモータ2の位置の値が拘束開始位置データ5Bの値に等しくなるまで(ステップS15:YES)、モータ2を停止させずに(ステップS15:NO、ステップS18)、モータ2を継続して動作させる(ステップS14)。制御部4によって算出されるモータ2の位置の値が拘束開始位置データ5Bの値に等しくなるまでの間にたとえユーザが入力部9cの起動スイッチをオフにしたり、入力部9cの停止スイッチをオンにしたりしても、制御部4がその操作を無効にして、モータ2を停止させずに(ステップS18)、モータ2を継続して動作させる(ステップS14)。   After starting the motor 2, the control unit 4 counts the number of pulses of the pulse signal, calculates the rotation amount of the motor 2, and calculates the position (current position) of the motor 2 based on the pulse signal input from the extraction circuit 3. At the same time (see FIG. 10), the calculated position of the motor 2 is monitored (step S15). The controller 4 does not stop the motor 2 (step S15: NO, step S18) until the calculated position value of the motor 2 becomes equal to the value of the constraint start position data 5B (step S15: YES). The motor 2 is continuously operated (step S14). The user turns off the start switch of the input unit 9c or turns on the stop switch of the input unit 9c until the position value of the motor 2 calculated by the control unit 4 becomes equal to the value of the constraint start position data 5B. Even if the control unit 4 is used, the control unit 4 invalidates the operation and does not stop the motor 2 (step S18), and continues to operate the motor 2 (step S14).

制御部4によって算出されるモータ2の位置の値が拘束開始位置データ5Bに相当する値になったら(ステップS15:YES)、制御部4は起動処理を終了する。なお、制御部4がモータ2を起動させた後に(ステップS14、ステップS16)、制御部4が起動処理を終了しても、制御部4がモータ2を停止させない限り、モータ2が継続して回転する。   When the value of the position of the motor 2 calculated by the control unit 4 becomes a value corresponding to the constraint start position data 5B (step S15: YES), the control unit 4 ends the activation process. In addition, after the control part 4 starts the motor 2 (step S14, step S16), even if the control part 4 complete | finishes a starting process, unless the control part 4 stops the motor 2, the motor 2 continues. Rotate.

モータ2の動作中は、抽出回路3がモータ2の電流信号からリプル成分を抽出(検出)して、リプル成分をパルス化する。そして、抽出回路3は、リプル成分がパルス化されてなるパルス信号を制御部4に出力する。   During operation of the motor 2, the extraction circuit 3 extracts (detects) a ripple component from the current signal of the motor 2, and pulses the ripple component. Then, the extraction circuit 3 outputs a pulse signal obtained by pulsing the ripple component to the control unit 4.

モータ2が起動すると、制御部4は、抽出回路3から入力したパルス信号に基づいて、パルス信号のパルス数の計数、モータ2の回転量の算出及びモータ2の位置の算出を行う。より具体的には、制御部4が図10に示す処理を実行することによってパルス信号のパルス数の計数、モータ2の回転量の算出及びモータ2の位置の算出を行う。   When the motor 2 is started, the control unit 4 counts the number of pulses of the pulse signal, calculates the rotation amount of the motor 2 and calculates the position of the motor 2 based on the pulse signal input from the extraction circuit 3. More specifically, the control unit 4 performs the processing shown in FIG. 10 to count the number of pulses of the pulse signal, calculate the rotation amount of the motor 2, and calculate the position of the motor 2.

図10に示す処理について具体的に説明する。
制御部4は、A/Dコンバータ7から入力した電圧データを監視して、電圧データを所定の閾値と比較する(ステップS21)。上述のように制御部4がモータ2を起動させると(ステップS16又はステップS14)、モータ2に電流が通電するから、制御部4は電圧データが所定の閾値を上回ったと判定して、モータ2の通電・起動を検出する(ステップS21:Yes)。そして、制御部4が記憶部5から初期位置データ5Aを読み込んで、制御部4の処理がステップS22に移行する。なお、制御部4がA/Dコンバータ8から入力した電流データを監視して、制御部4が電流データを所定の閾値と比較してもよい(ステップS21)。この場合、モータ2に電流が通電した場合、制御部4は電流データが所定の閾値を上回ったと判定して、モータ2の通電・起動を検出する(ステップS21:Yes)。
The process shown in FIG. 10 will be specifically described.
The control unit 4 monitors the voltage data input from the A / D converter 7 and compares the voltage data with a predetermined threshold value (step S21). As described above, when the control unit 4 starts the motor 2 (step S16 or step S14), a current is passed through the motor 2. Therefore, the control unit 4 determines that the voltage data exceeds a predetermined threshold, and the motor 2 Is detected (step S21: Yes). And the control part 4 reads the initial position data 5A from the memory | storage part 5, and the process of the control part 4 transfers to step S22. The control unit 4 may monitor the current data input from the A / D converter 8, and the control unit 4 may compare the current data with a predetermined threshold (step S21). In this case, when a current is supplied to the motor 2, the control unit 4 determines that the current data has exceeded a predetermined threshold value, and detects energization / startup of the motor 2 (step S21: Yes).

電流がモータ2に通電すると、制御部4は抽出回路3によって出力されたパルス信号のパルス数を計数するとともに、モータ2の回転量及び位置を算出する(ステップS22,S23,S24、S25)。具体的には、まず、制御部4は、計数値Nをゼロにリセットする(ステップS22)。その後、制御部4は、抽出回路3によって出力されたパルス信号のパルスを入力するごとに(ステップS23:Yes)、計数値Nに1を加算して得られた値に計数値Nを更新するとともに(ステップS24)、読み込んだ初期位置データ5Aの値に更新後の計数値Nを加算するか、又は読み込んだ初期位置データ5Aの値から更新後の計数値Nを減算する(ステップS25)。制御部4は、ステップS25の演算をステップS11で決定した向きに従って決定する。例えば、ステップS11で決定した回転の向きが正回転である場合には、制御部4がステップS25で加算を行い、ステップS11で決定した回転の向きが逆回転である場合には、制御部4がステップS25で減算を行う。勿論、回転の向きと演算の関係が逆であってもよい。   When the current is supplied to the motor 2, the control unit 4 counts the number of pulses of the pulse signal output by the extraction circuit 3, and calculates the rotation amount and position of the motor 2 (steps S22, S23, S24, S25). Specifically, first, the control unit 4 resets the count value N to zero (step S22). Thereafter, each time the pulse of the pulse signal output by the extraction circuit 3 is input (step S23: Yes), the control unit 4 updates the count value N to a value obtained by adding 1 to the count value N. At the same time (step S24), the updated count value N is added to the value of the read initial position data 5A, or the updated count value N is subtracted from the value of the read initial position data 5A (step S25). The control unit 4 determines the calculation in step S25 according to the direction determined in step S11. For example, when the rotation direction determined in step S11 is forward rotation, the control unit 4 performs addition in step S25, and when the rotation direction determined in step S11 is reverse rotation, the control unit 4 Subtracts in step S25. Of course, the relationship between the direction of rotation and the calculation may be reversed.

ステップS24において更新された計数値Nが、制御部4によって計数されたパルス数である。制御部4によって計数されたパルス数(計数値N)は、モータ2の座標系(図2参照)における初期位置から現在位置までの回転量を表す。ステップS25において求められた差や和が、パルスを入力した時点におけるモータ2の現在位置を表す。上述のように、制御部4がステップS25で算出した差や和が拘束開始位置データ5Bに相当する値であれば(ステップS15:YES)、制御部4が起動処理を終了し、制御部4がステップS25で算出した差や和が拘束開始位置データ5Bに相当する値でなければ(ステップS15:NO)、制御部4が起動処理を継続して、モータ2の停止を禁止する(ステップS18)。   The count value N updated in step S24 is the number of pulses counted by the control unit 4. The number of pulses (count value N) counted by the control unit 4 represents the amount of rotation from the initial position to the current position in the coordinate system of the motor 2 (see FIG. 2). The difference or sum obtained in step S25 represents the current position of the motor 2 at the time when the pulse is input. As described above, if the difference or sum calculated by the control unit 4 in step S25 is a value corresponding to the constraint start position data 5B (step S15: YES), the control unit 4 ends the activation process, and the control unit 4 If the difference or sum calculated in step S25 is not a value corresponding to the constraint start position data 5B (step S15: NO), the control unit 4 continues the starting process and prohibits the motor 2 from stopping (step S18). ).

制御部4は、モータ2の電流の遮断を検出するまでステップS23〜ステップS26の処理を繰り返す(ステップS26:No)。具体的には、制御部4は、ステップS25の処理の後に、A/Dコンバータ7から入力した電圧データを所定の閾値と比較する(ステップS26)。そして、モータ2の電流が遮断されなかったら、制御部4は電圧データが所定の閾値を上回っていると判定して(ステップS26:No)、制御部4の処理がステップS23に戻り、制御部4がステップS23〜ステップS25の処理を再度行う。なお、ステップS26では、制御部4がA/Dコンバータ8から入力した電流データを所定の閾値と比較してもよい(ステップS26)。この場合、モータ2の電流が遮断されなかったら、制御部4は電流データが所定の閾値を上回ったと判定して(ステップS26:No)、制御部4がステップS23〜ステップS25の処理を再度行う。   The control part 4 repeats the process of step S23-step S26 until it detects the interruption | blocking of the electric current of the motor 2 (step S26: No). Specifically, the control unit 4 compares the voltage data input from the A / D converter 7 with a predetermined threshold after the process of step S25 (step S26). If the current of the motor 2 is not interrupted, the control unit 4 determines that the voltage data exceeds a predetermined threshold (step S26: No), the process of the control unit 4 returns to step S23, and the control unit 4 4 performs the processing of step S23 to step S25 again. In step S26, the control unit 4 may compare the current data input from the A / D converter 8 with a predetermined threshold (step S26). In this case, if the current of the motor 2 is not interrupted, the control unit 4 determines that the current data has exceeded a predetermined threshold (step S26: No), and the control unit 4 performs the processing of step S23 to step S25 again. .

制御部4が図10に示す処理を実行している時に所定の停止条件が満たされると、制御部4がモータ2の停止処理(図11参照)を実行する。所定の停止条件とは、例えば、ユーザが入力部9cの停止スイッチをオンにすること、ユーザが入力部9cの起動スイッチをオフにすること、制御部4によって実行された処理(例えば、シーケンス処理)で所定の条件が満たされること、上述のステップS25において求めた差又は和が所定の値になること等である。   If a predetermined stop condition is satisfied while the control unit 4 is executing the process shown in FIG. 10, the control unit 4 executes a stop process (see FIG. 11) of the motor 2. The predetermined stop condition is, for example, that a user turns on a stop switch of the input unit 9c, a user turns off a start switch of the input unit 9c, or a process executed by the control unit 4 (for example, a sequence process). ), A predetermined condition is satisfied, and the difference or sum obtained in step S25 is a predetermined value.

まず、制御部4は、停止処理開始直後にステップS25で算出した差や和(モータ2の位置)が非拘束範囲内に収まっているか否かを判定する(ステップS31)。具体的には、制御部4が、ステップS25で算出した差や和を拘束開始位置データ5Bの値と比較する(ステップS31)。   First, the control unit 4 determines whether or not the difference or the sum (position of the motor 2) calculated in step S25 is within the unconstrained range immediately after the stop process is started (step S31). Specifically, the control unit 4 compares the difference or sum calculated in step S25 with the value of the constraint start position data 5B (step S31).

比較の結果、停止処理開始直後にステップS25で算出した差や和(モータ2の位置)が非拘束範囲内に収まっていると制御部4が判定した場合(ステップS31:YES)、制御部4がモータドライバ6に停止指令を出力する(ステップS41)。そうすると、停止指令を受けたモータドライバ6がモータ2の通電を遮断し、モータ2が停止する。モータ2の停止位置は、一方の拘束開始位置から他方の拘束開始位置までの間である。モータ2の電流がモータドライバ6によって遮断されるので、制御部4はA/Dコンバータ7から入力した電圧データが所定の閾値を下回ったと判定して(ステップS26:Yes)、制御部4は図10に示す処理を終了する。なお、制御部4がA/Dコンバータ8から入力した電流データを所定の閾値と比較する場合(ステップS26)、モータ2の電流が遮断されたら、制御部4は電流データが所定の閾値を下回ったと判定して(ステップS26:Yes)、制御部4は図90に示す処理を終了する。   As a result of the comparison, when the control unit 4 determines that the difference or the sum (position of the motor 2) calculated in step S25 is within the unconstrained range immediately after the start of the stop process (step S31: YES), the control unit 4 Outputs a stop command to the motor driver 6 (step S41). If it does so, the motor driver 6 which received the stop command will interrupt | block the electricity supply of the motor 2, and the motor 2 will stop. The stop position of the motor 2 is between one restraint start position and the other restraint start position. Since the current of the motor 2 is interrupted by the motor driver 6, the control unit 4 determines that the voltage data input from the A / D converter 7 has fallen below a predetermined threshold (step S26: Yes). The process shown in FIG. When the control unit 4 compares the current data input from the A / D converter 8 with a predetermined threshold (step S26), when the current of the motor 2 is interrupted, the control unit 4 causes the current data to fall below the predetermined threshold. 90 (step S26: Yes), the control unit 4 ends the process shown in FIG.

次に、制御部4は、停止処理開始直後にステップS25で算出した差や和を記憶部5に書き込む(ステップS42)。具体的には、制御部4は、記憶部5に記憶された初期位置データ5Aの値を停止処理開始直後のステップS25において求めた差又は和に書き換える(ステップS42)。その後、制御部4は停止処理を終了する。   Next, the control unit 4 writes the difference or sum calculated in step S25 immediately after the stop process is started in the storage unit 5 (step S42). Specifically, the control unit 4 rewrites the value of the initial position data 5A stored in the storage unit 5 with the difference or sum obtained in step S25 immediately after the start of the stop process (step S42). Thereafter, the control unit 4 ends the stop process.

ステップS31の比較の結果、ステップS25で算出した差や和(モータ2の位置)が非拘束範囲内に収まっていないと制御部4が判定した場合(ステップS31:NO
)、制御部4の処理がステップS32に移行する。ステップ32では、制御部4は、ステップS11で決定した向きがロック位置から拘束開始位置に向かう向きであるか否かを判定する(ステップS32)。
As a result of the comparison in step S31, when the control unit 4 determines that the difference or sum (position of the motor 2) calculated in step S25 is not within the unconstrained range (step S31: NO)
), The process of the control unit 4 proceeds to step S32. In step 32, the control unit 4 determines whether or not the direction determined in step S11 is a direction from the lock position toward the constraint start position (step S32).

ステップS11で決定した向きがロック位置から拘束開始位置に向かう向きであると制御部4が判定した場合(ステップS32:YES)、制御部4がモータ2を停止させずに(ステップS37)、モータ2を継続して動作させる。なお、モータ2が起動する前の初期位置データ5Aの値がロック位置データ5Cの値に等しい場合にモータ2が回転していれば(図9に示すステップS12(YES)、ステップS13(YES)、ステップS14参照)、制御部4の処理はステップS32からステップS37に移行する。   When the control unit 4 determines that the direction determined in step S11 is the direction from the lock position toward the constraint start position (step S32: YES), the control unit 4 does not stop the motor 2 (step S37), and the motor 2 is operated continuously. If the motor 2 is rotating when the value of the initial position data 5A before the motor 2 is started is equal to the value of the lock position data 5C (step S12 (YES), step S13 (YES) shown in FIG. 9). , See step S14), the process of the control unit 4 proceeds from step S32 to step S37.

モータ2が継続して回転するから(ステップS37参照)、制御部4が図10に示すステップS23〜ステップS26の処理を繰り返し実行する。そのため、制御部4は、抽出回路3によって出力されたパルス信号のパルスを入力する度に、モータ2の位置を算出する(ステップS25)。そして、制御部4は、ステップS25で算出したモータ2の位置の値が拘束開始位置データ5Bの値に等しくなるまで(ステップS38:YES)、モータ2を停止させずに(ステップS38:NO、ステップS37)、モータ2を継続して動作させる。   Since the motor 2 continues to rotate (see step S37), the control unit 4 repeatedly executes the processes in steps S23 to S26 shown in FIG. Therefore, the control unit 4 calculates the position of the motor 2 every time the pulse of the pulse signal output by the extraction circuit 3 is input (step S25). Then, the control unit 4 does not stop the motor 2 (step S38: NO, until the value of the position of the motor 2 calculated in step S25 becomes equal to the value of the constraint start position data 5B (step S38: YES). Step S37), the motor 2 is continuously operated.

モータ2の回転が継続している際に、制御部4によって算出されるモータ2の位置の値が拘束開始位置データ5Bの値に等しくなったら(ステップS38:YES)、制御部4がモータドライバ6に停止指令を出力する(ステップS39)。そうすると、停止指令を受けたモータドライバ6がモータ2の通電を遮断し、モータ2が停止する。モータ2の停止位置は、拘束開始位置である。モータ2の電流がモータドライバ6によって遮断されるので、制御部4はA/Dコンバータ7から入力した電圧データが所定の閾値を下回ったと判定して(ステップS26:Yes)、制御部4は図10に示す処理を終了する。   When the rotation of the motor 2 continues, if the position value of the motor 2 calculated by the control unit 4 becomes equal to the value of the constraint start position data 5B (step S38: YES), the control unit 4 determines that the motor driver A stop command is output to 6 (step S39). If it does so, the motor driver 6 which received the stop command will interrupt | block the electricity supply of the motor 2, and the motor 2 will stop. The stop position of the motor 2 is a restraint start position. Since the current of the motor 2 is interrupted by the motor driver 6, the control unit 4 determines that the voltage data input from the A / D converter 7 has fallen below a predetermined threshold (step S26: Yes). The process shown in FIG.

次に、制御部4は、図9に示すステップS23〜ステップS26の処理を繰り返している際に最後のステップS25において求めた差又は和を記憶部5に書き込む(ステップS40)。具体的には、制御部4は、記憶部5に記憶された初期位置データ5Aの値を最後のステップS25において求めた差又は和に書き換える(ステップS40)。書き換えられた初期位置データ5Aの値は、拘束開始位置データ5Bの値に等しいか、拘束開始位置データ5Bの値に近似している。その後、制御部4は停止処理を終了する。なお、ステップS40において、制御部4は、記憶部5に記憶された初期位置データ5Aの値を拘束開始位置データ5Bの値に書き換えてもよい。   Next, the control part 4 writes the difference or sum calculated | required in the last step S25 in the memory | storage part 5 when repeating the process of step S23-step S26 shown in FIG. 9 (step S40). Specifically, the control unit 4 rewrites the value of the initial position data 5A stored in the storage unit 5 to the difference or sum obtained in the last step S25 (step S40). The rewritten value of the initial position data 5A is equal to the value of the constraint start position data 5B or approximate to the value of the constraint start position data 5B. Thereafter, the control unit 4 ends the stop process. In step S40, the control unit 4 may rewrite the value of the initial position data 5A stored in the storage unit 5 to the value of the constraint start position data 5B.

ステップS32の判定において、ステップS11で決定した向きがロック位置から拘束開始位置に向かう向きでないと制御部4が判定した場合(ステップS32:NO)、制御部4の処理がステップS33に移行する。モータ2の位置が非拘束範囲から拘束開始位置を超えて拘束範囲に移ると、制御部4の処理がステップS33に移行することになる。   In the determination of step S32, when the control unit 4 determines that the direction determined in step S11 is not the direction from the lock position toward the constraint start position (step S32: NO), the process of the control unit 4 proceeds to step S33. When the position of the motor 2 moves from the unconstrained range to the restrained range beyond the restraint start position, the process of the control unit 4 proceeds to step S33.

ステップS33では、制御部4が、A/Dコンバータ8から入力した電流データを監視して、電流データを所定値と比較する(ステップS33)。所定値は、モータ2を拘束してモータ2に一定の電圧を印加することでそのモータ2に流れる電流を実験等によって予め測定したものである。つまり、所定値は、モータ2が拘束状態であるか否かを判別するための基準となる電流値である。   In step S33, the control unit 4 monitors the current data input from the A / D converter 8, and compares the current data with a predetermined value (step S33). The predetermined value is obtained by preliminarily measuring the current flowing through the motor 2 by applying a constant voltage to the motor 2 while restraining the motor 2. That is, the predetermined value is a current value serving as a reference for determining whether or not the motor 2 is in a restrained state.

モータ2が拘束範囲内において拘束開始位置からロック位置に向けて回転していると、モータ2が拘束されていないから、モータ2に流れる電流が所定値以上にならないので、制御部4は、A/Dコンバータ8から入力した電流データが所定値未満である判定する(ステップS33:NO)。その場合、制御部4は、モータ2を停止させずに(ステップS34)モータ2を継続して動作させるとともに、A/Dコンバータ8から入力した電流データの監視も継続する(ステップS33)。   If the motor 2 is rotating from the restraint start position toward the lock position within the restraint range, the motor 2 is not restrained, so the current flowing through the motor 2 does not exceed a predetermined value. It is determined that the current data input from the / D converter 8 is less than a predetermined value (step S33: NO). In that case, the control unit 4 continues to operate the motor 2 without stopping the motor 2 (step S34), and also continues to monitor the current data input from the A / D converter 8 (step S33).

モータ2の回転が継続して、伝動機構等の遊び等が締められると、モータ2がロック位置で拘束される。そうすると、モータ2に流れる電流が所定閾値以上になる。そのため、制御部4は、A/Dコンバータ8から入力した電流データが所定値以上である判定する(ステップS33:NO)。制御部4がモータドライバ6に停止指令を出力する(ステップS35)。そうすると、停止指令を受けたモータドライバ6がモータ2の通電を遮断し、モータ2が停止する。モータ2の停止位置はロック位置となる。   When the rotation of the motor 2 continues and the play or the like of the transmission mechanism is tightened, the motor 2 is restrained at the lock position. If it does so, the electric current which flows into the motor 2 will become more than a predetermined threshold value. Therefore, the control unit 4 determines that the current data input from the A / D converter 8 is greater than or equal to a predetermined value (step S33: NO). The control unit 4 outputs a stop command to the motor driver 6 (step S35). If it does so, the motor driver 6 which received the stop command will interrupt | block the electricity supply of the motor 2, and the motor 2 will stop. The stop position of the motor 2 is the lock position.

モータ2の停止後、制御部4は、記憶部5に記憶された初期位置データ5Aの値をロック位置データ5Cの値に書き換える(ステップS36)。その後、制御部4は停止処理を終了する。   After stopping the motor 2, the control unit 4 rewrites the value of the initial position data 5A stored in the storage unit 5 to the value of the lock position data 5C (step S36). Thereafter, the control unit 4 ends the stop process.

以上に述べたことがモータ制御装置1の動作の説明である。図1に示されたモータ制御装置1は、例えば車両用シート装置に用いられる。その車両用シート装置は、図1に示されたモータ制御装置1と、図12に示されたシート本体90とを備え、シート本体90の可動部がモータ2によって駆動される。   What has been described above is the description of the operation of the motor control device 1. The motor control device 1 shown in FIG. 1 is used for a vehicle seat device, for example. The vehicle seat device includes the motor control device 1 shown in FIG. 1 and the seat body 90 shown in FIG. 12, and the movable portion of the seat body 90 is driven by the motor 2.

シート本体90の可動部の数とモータ2の数が同数であることが好ましく、モータ2の数が複数である場合、モータドライバ6及び抽出回路3がモータ2ごとに設けられ、制御部4及び記憶部5が全てのモータ2に共通している。また、モータ2の数が複数である場合、モータ2ごとに初期位置データ5A、拘束開始位置データ5B及びロック位置データ5Cが記憶部5に格納されている。なお、モータ2の数が複数である場合、モータドライバ6及び抽出回路3の数がそれぞれ1であってもよい。その場合、リレー回路が設けられ、リレー回路が制御部4からの指令に従って複数のモータ2のうちの何れか一つを選択する。そして、そのリレー回路が選択したモータ2を抽出回路3及びモータドライバ6に接続するとともに、他を抽出回路3及びモータドライバ6から遮断する。   The number of movable parts of the seat body 90 and the number of motors 2 are preferably the same. When there are a plurality of motors 2, a motor driver 6 and an extraction circuit 3 are provided for each motor 2, and the control unit 4 and The storage unit 5 is common to all the motors 2. When there are a plurality of motors 2, initial position data 5 </ b> A, constraint start position data 5 </ b> B, and lock position data 5 </ b> C are stored in the storage unit 5 for each motor 2. When the number of motors 2 is plural, the number of motor drivers 6 and extraction circuits 3 may be one. In that case, a relay circuit is provided, and the relay circuit selects any one of the plurality of motors 2 in accordance with a command from the control unit 4. The motor 2 selected by the relay circuit is connected to the extraction circuit 3 and the motor driver 6, and the others are disconnected from the extraction circuit 3 and the motor driver 6.

シート本体90について具体的に説明する。シート本体90はレール91、シートボトム92、バックレスト93、ヘッドレスト94、アームレスト95及びレッグレスト96等を備える。   The sheet body 90 will be specifically described. The seat body 90 includes a rail 91, a seat bottom 92, a backrest 93, a headrest 94, an armrest 95, a legrest 96, and the like.

シートボトム92がレール91の上に搭載され、シートボトム92がレール91よって前後方向に移動可能に設けられており、モータ2がシートボトム92を前後方向に駆動する。シートボトム92の前部が昇降可能に設けられ、別のモータ2がシートボトム92の前部を上下方向に駆動する。シートボトム92の後部が昇降可能に設けられ、別のモータ2がシートボトム92の後部を上下方向に駆動する。バックレスト93がリクライニング機構によってシートボトム92の後端部に回転可能に連結され、別のモータ2がバックレスト93をシートボトム92に対して起伏させる。ヘッドレスト94がバックレスト93の上端部に昇降可能・回転可能に連結され、別のモータ2がヘッドレスト94を上下方向に駆動し、更に別のモータ2がヘッドレスト94を前後に起伏させる。アームレスト95がバックレスト93の側面に回転可能に連結され、別のモータ2がアームレスト95を水平状態から垂直状態に及びその逆に駆動する。レッグレスト96がシートボトム92の前端部に回転可能に連結され、別のモータ2がレッグレスト96を跳ね上げ状態から垂下状態に又はその逆に駆動する。   The seat bottom 92 is mounted on the rail 91, the seat bottom 92 is provided so as to be movable in the front-rear direction by the rail 91, and the motor 2 drives the seat bottom 92 in the front-rear direction. The front part of the seat bottom 92 is provided to be movable up and down, and another motor 2 drives the front part of the seat bottom 92 in the vertical direction. The rear part of the seat bottom 92 is provided so as to be movable up and down, and another motor 2 drives the rear part of the seat bottom 92 in the vertical direction. The backrest 93 is rotatably connected to the rear end portion of the seat bottom 92 by a reclining mechanism, and another motor 2 raises and lowers the backrest 93 with respect to the seat bottom 92. The headrest 94 is connected to the upper end of the backrest 93 so as to be able to move up and down and rotate, and another motor 2 drives the headrest 94 in the vertical direction, and another motor 2 undulates the headrest 94 back and forth. The armrest 95 is rotatably connected to the side surface of the backrest 93, and another motor 2 drives the armrest 95 from the horizontal state to the vertical state and vice versa. A legrest 96 is rotatably connected to the front end portion of the seat bottom 92, and another motor 2 drives the legrest 96 from a flipped state to a suspended state or vice versa.

シート本体90の何れの可動部にも可動範囲が設定され、可動範囲の両端にストッパが設けられている。   A movable range is set in any movable part of the sheet main body 90, and stoppers are provided at both ends of the movable range.

本発明の実施の形態は、以下のような効果を奏する。
(1) モータ2の動作中にモータ2の位置が拘束範囲内に収まっている際に(ステップS31(NO)参照)、所定の停止条件が満たされても、モータ2が停止せずに、モータ2が回転しづける(ステップS34参照)。その後、モータ2がロック位置に移動して、モータ2の電流が上昇すると(ステップS33(YES)参照)、モータ2が停止する。そのため、モータ2は拘束範囲内で停止せずに、ロック位置で停止する。そして、制御部4が初期位置データ5Aの値をロック位置データ5Cの値に更新するから(ステップS36参照)、制御部4が算出するモータ2の位置に累積的な誤差が発生した場合でも、その誤差が解消される。
(2) モータ2の位置が拘束範囲内であって、モータ2の回転向きが拘束開始位置からロック位置に向かう向きであると、モータ2が極低速で回転するから、抽出回路3から出力されるパルス信号にパルスが正確に生成されない。そのような場合でも、モータ2が拘束範囲内で停止せずにロック位置で停止し(ステップS35参照)、更に制御部4が算出するモータ2の位置がリセットされて、初期位置データ5Aの値がロック位置データ5Cの値に更新される。よって、抽出回路3から出力されるパルス信号にパルスが正確に生成されなくても、制御部4がモータ2の位置を正確に算出することができる。
(3) モータ2がロック位置で停止した後、モータ2が再度起動すると(ステップS14参照)、制御部4が算出するモータ2の位置の値が拘束開始位置データ5Bの値に等しくなるまで、モータ2の停止が禁止される(ステップS14、ステップS15、ステップS18、ステップS38、ステップS37参照)。よって、モータ2が拘束範囲内で停止することがない。
(4) 初期位置、拘束開始位置及びロック位置がモータ2の位置を表す座標系で規定され(図2参照)、初期位置データ、拘束開始位置データ及びロック位置データがモータ2の位置をパルス数で表現する。従って、制御部4が可動部99の位置を表現する座標系を基準としてモータ2の制御を行っているのではなく、モータ2の位置を表現する座標系を基準としてモータ2の制御を行っている(図2参照)。よって、可動部99がストッパ98に当接して可動部99が拘束された場合、更にモータ2が回転することも考慮して、モータ2の位置制御が行われる。
(5) フィルタ40の回路設計においてフィルタ40の高カットオフ周波数fc2がリプル成分の周波数よりも低く設定されているから、フィルタ40によってリプル成分を除去することができる。
(6) 差動増幅器50が、バンドパスフィルタ30の出力信号(電流電圧変換器10によって変換された電圧信号のうち直流成分及び高周波ノイズ成分等が除去されたもの)と、フィルタ40の出力信号(電流電圧変換器10によって変換された電圧信号のうち直流成分、高周波ノイズ成分及びリプル成分等が除去されたもの)の差分を取って、それを差分信号として出力する。そのため、差動増幅器50の出力信号は、電流電圧変換器10によって変換された電圧信号のうちリプル成分である。差動増幅器50の出力信号が差分信号であるからこそ、モータ2の電流信号の各成分の周波数が環境変化によって変動しても、リプル成分が正確に抽出されて、モータ2の電流信号中のリプルを高精度に検出することができる。
(7) 図5に示す周波数特性のうち、高カットオフ周波数fc2よりも高い領域の傾斜部分を利用したからこそ、リプル成分の周波数が温度変化により変動したものとしても、差動増幅器50の出力信号がリプル成分として正確に抽出される。
(8) フィルタ40の周波数特性を利用して、フィルタ40と差動増幅器50によってリプル成分を抽出したから、フィルタ40にカットオフ周波数可変型フィルタを用いなくても済む。そのため、フィルタ40のコストを削減することができる。
(9) 抽出回路3がフィードバック制御回路のような閉ループ回路でないから、モータ2の電流信号の各成分の周波数が過渡的に又は急激に変化したものとしても、リプルを正確に検出することができる。
(10) フィルタ40が抵抗器41b,41d,41a,41c及びキャパシタ41a,41c,41b,41d,43aからなるフィルタであるから、フィルタ40の構成がシンプルであり、フィルタ40のコストアップを抑えることができる。
(11) フィルタ40の周波数特性を利用して、フィルタ40と差動増幅器50によってリプル成分を抽出したから、ハイパスフィルタ20やバンドパスフィルタ30にカットオフ周波数可変型フィルタを用いなくても済む。そのため、ハイパスフィルタ20やバンドパスフィルタ30のコストアップを抑えることができる。
(12) 電流電圧変換器10によって変換された電圧信号のうち直流成分がハイパスフィルタ20によって除去されるから、そのハイパスフィルタ20の後段のバンドパスフィルタ30、フィルタ40及び差動増幅器50の処理が正確に行われる。
(13) 電流電圧変換器10によって変換された電圧信号のうち所定周波数帯域外の成分がバンドパスフィルタ30によって減衰するから、そのバンドパスフィルタ30の後段のフィルタ40や差動増幅器50の処理が正確に行われる。
The embodiment of the present invention has the following effects.
(1) When the position of the motor 2 is within the constraint range during the operation of the motor 2 (see step S31 (NO)), the motor 2 does not stop even if a predetermined stop condition is satisfied. The motor 2 continues to rotate (see step S34). Thereafter, when the motor 2 moves to the lock position and the current of the motor 2 increases (see step S33 (YES)), the motor 2 stops. Therefore, the motor 2 does not stop within the restraint range but stops at the lock position. Since the control unit 4 updates the value of the initial position data 5A to the value of the lock position data 5C (see step S36), even when a cumulative error occurs in the position of the motor 2 calculated by the control unit 4, The error is eliminated.
(2) If the position of the motor 2 is within the restraint range and the rotation direction of the motor 2 is from the restraint start position toward the lock position, the motor 2 rotates at an extremely low speed. The pulse is not generated accurately in the pulse signal. Even in such a case, the motor 2 does not stop within the restraint range but stops at the lock position (see step S35), and the position of the motor 2 calculated by the control unit 4 is further reset, and the value of the initial position data 5A Is updated to the value of the lock position data 5C. Therefore, the controller 4 can accurately calculate the position of the motor 2 even if a pulse is not accurately generated in the pulse signal output from the extraction circuit 3.
(3) When the motor 2 is restarted after the motor 2 is stopped at the lock position (see step S14), the value of the position of the motor 2 calculated by the control unit 4 is equal to the value of the constraint start position data 5B. Stopping the motor 2 is prohibited (see Step S14, Step S15, Step S18, Step S38, Step S37). Therefore, the motor 2 does not stop within the restricted range.
(4) The initial position, the constraint start position and the lock position are defined by a coordinate system representing the position of the motor 2 (see FIG. 2), and the initial position data, the constraint start position data and the lock position data indicate the number of pulses of the motor 2 position. It expresses with. Therefore, the control unit 4 does not control the motor 2 based on the coordinate system expressing the position of the movable unit 99 but controls the motor 2 based on the coordinate system expressing the position of the motor 2. (See FIG. 2). Therefore, when the movable part 99 abuts against the stopper 98 and the movable part 99 is restrained, the position control of the motor 2 is performed in consideration of further rotation of the motor 2.
(5) Since the high cut-off frequency fc2 of the filter 40 is set lower than the frequency of the ripple component in the circuit design of the filter 40, the ripple component can be removed by the filter 40.
(6) The differential amplifier 50 outputs the output signal of the bandpass filter 30 (the voltage signal converted by the current-voltage converter 10 from which the DC component and the high-frequency noise component are removed) and the output signal of the filter 40. The difference between the voltage signals converted by the current-voltage converter 10 from which the DC component, the high-frequency noise component, the ripple component, etc. are removed is taken and output as a difference signal. Therefore, the output signal of the differential amplifier 50 is a ripple component in the voltage signal converted by the current-voltage converter 10. Because the output signal of the differential amplifier 50 is a differential signal, even if the frequency of each component of the current signal of the motor 2 fluctuates due to environmental changes, the ripple component is accurately extracted, Ripple can be detected with high accuracy.
(7) Of the frequency characteristics shown in FIG. 5, the output of the differential amplifier 50 can be obtained even if the frequency of the ripple component fluctuates due to temperature change because the slope portion in the region higher than the high cutoff frequency fc2 is used. The signal is accurately extracted as a ripple component.
(8) Since the ripple component is extracted by the filter 40 and the differential amplifier 50 using the frequency characteristics of the filter 40, it is not necessary to use a variable cutoff frequency filter for the filter 40. Therefore, the cost of the filter 40 can be reduced.
(9) Since the extraction circuit 3 is not a closed loop circuit such as a feedback control circuit, it is possible to accurately detect ripples even if the frequency of each component of the current signal of the motor 2 changes transiently or rapidly. .
(10) Since the filter 40 is a filter including resistors 41b, 41d, 41a, and 41c and capacitors 41a, 41c, 41b, 41d, and 43a, the configuration of the filter 40 is simple, and the cost increase of the filter 40 is suppressed. Can do.
(11) Since the ripple component is extracted by the filter 40 and the differential amplifier 50 using the frequency characteristics of the filter 40, it is not necessary to use a variable cutoff frequency filter for the high-pass filter 20 or the band-pass filter 30. Therefore, the cost increase of the high pass filter 20 and the band pass filter 30 can be suppressed.
(12) Since the DC component of the voltage signal converted by the current-voltage converter 10 is removed by the high-pass filter 20, the processing of the band-pass filter 30, the filter 40 and the differential amplifier 50 subsequent to the high-pass filter 20 is performed. Exactly done.
(13) Since the component outside the predetermined frequency band of the voltage signal converted by the current-voltage converter 10 is attenuated by the band-pass filter 30, the processing of the filter 40 and the differential amplifier 50 subsequent to the band-pass filter 30 is performed. Exactly done.

〔変形例〕
なお、本発明を適用可能な実施形態は、上述した実施形態に限定されることなく、本発明の趣旨を逸脱しない範囲で適宜変更可能である。以下、変形例について説明する。以下に挙げる変形例は可能な限り組み合わせてもよい。
[Modification]
The embodiments to which the present invention can be applied are not limited to the above-described embodiments, and can be appropriately changed without departing from the spirit of the present invention. Hereinafter, modified examples will be described. The following modifications may be combined as much as possible.

〔変形例1〕
上述のステップS22において、制御部4は、計数値Nをゼロにリセットするのではなく、計数値Nを初期位置データ5Aに設定してもよい。この場合、ステップS25における処理が省略される。更に、ステップS24においては、制御部4が、抽出回路3によって出力されたパルス信号のパルスを入力するごとに、計数値Nに1を加算し又は減算することで計数値Nを更新する。制御部4は、ステップS24及びステップS49の演算をステップS11で決定した向きに従って決定する。例えば、ステップS11で決定した回転の向きが正回転である場合には、制御部4がステップS24で加算を行い、ステップS11で決定した回転の向きが逆回転である場合には、制御部4がステップS24で減算を行う。勿論、回転の向きと演算の関係が逆であってもよい。
[Modification 1]
In step S22 described above, the control unit 4 may set the count value N in the initial position data 5A instead of resetting the count value N to zero. In this case, the process in step S25 is omitted. Further, in step S24, the control unit 4 updates the count value N by adding or subtracting 1 to the count value N every time the pulse of the pulse signal output by the extraction circuit 3 is input. The control unit 4 determines the calculations in step S24 and step S49 according to the direction determined in step S11. For example, when the rotation direction determined in step S11 is normal rotation, the control unit 4 performs addition in step S24, and when the rotation direction determined in step S11 is reverse rotation, the control unit 4 Performs subtraction in step S24. Of course, the relationship between the direction of rotation and the calculation may be reversed.

ステップS24で更新した計数値Nは、モータ2の現在位置を表すとともに、原点位置を基準としてその原点位置からの現在位置までの距離をパルス数で表す。   The count value N updated in step S24 represents the current position of the motor 2, and represents the distance from the origin position to the current position with the origin position as a reference in the number of pulses.

〔変形例2〕
抽出回路3は一例であり、上述の実施形態の回路に限るものではない。例えば、フィルタ40及び差動増幅器50を省略してもよい。その場合、リプル成分の周波数が変化しても、リプル成分を正確に抽出できるようにするために、スイッチト・キャパシタ・フィルタをバンドパスフィルタ30の後段であって増幅器60の前段に設けることが好ましい。スイッチト・キャパシタ・フィルタのカットオフ周波数が可変であり、リプル成分や低周波成分の周波数が変化した場合でも、スイッチト・キャパシタ・フィルタは、低周波成分を減衰させ、リプル成分を通過させる。
[Modification 2]
The extraction circuit 3 is an example, and is not limited to the circuit of the above-described embodiment. For example, the filter 40 and the differential amplifier 50 may be omitted. In this case, a switched capacitor filter is provided after the band-pass filter 30 and before the amplifier 60 so that the ripple component can be accurately extracted even if the frequency of the ripple component changes. preferable. Even when the cutoff frequency of the switched capacitor filter is variable and the frequency of the ripple component or the low frequency component changes, the switched capacitor filter attenuates the low frequency component and passes the ripple component.

〔変形例3〕
フィルタ40の回路設計において、温度変化によるリプル成分の周波数の変動も考慮しつつ、図6に示すフィルタ40の低カットオフ周波数fc1がリプル成分の周波数(例えば、常温時の周波数)よりも高く設定されている。従って、フィルタ40は、電流電圧変換器10によって変換された電圧信号(バンドパスフィルタ30の出力信号)のうちリプル成分を高周波成分(高周波成分はリプル成分よりも周波数が高い。)よりも高い減衰率で減衰させる。つまり、フィルタ40は、リプル成分を高周波成分よりも効率的に除去する。従って、フィルタ40は、リプル成分を除去した信号を差動増幅器50に出力する。
この場合、モータ2の電流信号やフィルタ40及び差動増幅器50の入力信号は、リプル成分と、そのリプル成分よりも周波数が高い高周波成分とを重畳したものである。
[Modification 3]
In the circuit design of the filter 40, the low cut-off frequency fc1 of the filter 40 shown in FIG. 6 is set to be higher than the frequency of the ripple component (for example, the frequency at normal temperature) while taking into account the fluctuation of the frequency of the ripple component due to temperature change. Has been. Therefore, the filter 40 attenuates the ripple component of the voltage signal (the output signal of the bandpass filter 30) converted by the current-voltage converter 10 higher than the high-frequency component (the high-frequency component has a higher frequency than the ripple component). Decay at a rate. That is, the filter 40 removes the ripple component more efficiently than the high frequency component. Therefore, the filter 40 outputs a signal from which the ripple component has been removed to the differential amplifier 50.
In this case, the current signal of the motor 2 and the input signals of the filter 40 and the differential amplifier 50 are obtained by superimposing a ripple component and a high frequency component having a higher frequency than the ripple component.

〔変形例4〕
フィルタ40がバンドパスフィルタではなく、図13に示すような周波数特性を有したローパスフィルタであってもよい。フィルタ40は、電流電圧変換器10によって変換された電圧信号(バンドパスフィルタ30の出力信号)のうちカットオフ周波数fc3以下の成分を通過させ、カットオフ周波数fc3を超える成分を減衰させる。具体的には、カットオフ周波数fc3を超える高周波域において、フィルタ40は、電流電圧変換器10によって変換された電圧信号(バンドパスフィルタ30の出力信号)に含まれる成分の周波数が低いほど減衰率がより低くなるように、電流電圧変換器10によって変換された電圧信号(バンドパスフィルタ30の出力信号)を減衰させる。
[Modification 4]
The filter 40 may be a low-pass filter having frequency characteristics as shown in FIG. 13 instead of the band-pass filter. The filter 40 passes the component below the cutoff frequency fc3 among the voltage signal (the output signal of the bandpass filter 30) converted by the current-voltage converter 10, and attenuates the component exceeding the cutoff frequency fc3. Specifically, in a high frequency region exceeding the cut-off frequency fc3, the filter 40 decreases the attenuation rate as the frequency of the component included in the voltage signal (the output signal of the bandpass filter 30) converted by the current-voltage converter 10 decreases. Is attenuated so that the voltage signal converted by the current-voltage converter 10 (the output signal of the bandpass filter 30) is attenuated.

フィルタ40の回路設計において、温度変化によるリプル成分の周波数の変動も考慮しつつ、図13に示すフィルタ40のカットオフ周波数fc3がリプル成分の周波数(例えば、常温時の周波数)よりも低く設定されている。従って、フィルタ40は、電流電圧変換器10によって変換された電圧信号(バンドパスフィルタ30の出力信号)のうちリプル成分を低周波成分(低周波成分はリプル成分よりも周波数が低い。)よりも高い減衰率で減衰させる。つまり、フィルタ40は、リプル成分を低周波成分よりも効率的に除去する。従って、フィルタ40は、リプル成分を除去した信号を差動増幅器50に出力する。   In the circuit design of the filter 40, the cut-off frequency fc3 of the filter 40 shown in FIG. 13 is set to be lower than the frequency of the ripple component (for example, the frequency at normal temperature) while taking into account fluctuations in the frequency of the ripple component due to temperature changes. ing. Therefore, the filter 40 has a ripple component in the voltage signal (the output signal of the band pass filter 30) converted by the current-voltage converter 10 that is lower in frequency than the low frequency component (the frequency of the low frequency component is lower than that of the ripple component). Attenuate with high attenuation factor. That is, the filter 40 removes the ripple component more efficiently than the low frequency component. Therefore, the filter 40 outputs a signal from which the ripple component has been removed to the differential amplifier 50.

この場合、モータ2の電流信号やフィルタ40及び差動増幅器50の入力信号は、リプル成分と、そのリプル成分よりも周波数が低い低周波成分とを重畳したものである。
フィルタ40がローパスフィルタである場合、図7に示すハイパスフィルタ41,43が省略され、バンドパスフィルタ30の出力がローパスフィルタ42の入力に接続され、ローパスフィルタ42の出力が抵抗器51を介してオペアンプ53の反転入力端子に接続される。
In this case, the current signal of the motor 2 and the input signal of the filter 40 and the differential amplifier 50 are obtained by superimposing a ripple component and a low frequency component having a frequency lower than that of the ripple component.
When the filter 40 is a low-pass filter, the high-pass filters 41 and 43 shown in FIG. 7 are omitted, the output of the band-pass filter 30 is connected to the input of the low-pass filter 42, and the output of the low-pass filter 42 is connected via the resistor 51. The inverting input terminal of the operational amplifier 53 is connected.

〔変形例5〕
フィルタ40がバンドパスフィルタではなく、図14に示すような周波数特性を有したハイパスフィルタであってもよい。フィルタ40は、電流電圧変換器10によって変換された電圧信号(バンドパスフィルタ30の出力信号)のうちカットオフ周波数fc4以上の成分を通過させ、カットオフ周波数fc4を下回る成分を減衰させる。具体的には、カットオフ周波数fc4を下回る低周波域において、フィルタ40は、電流電圧変換器10によって変換された電圧信号(バンドパスフィルタ30の出力信号)に含まれる成分の周波数が低いほど減衰率がより高くなるように、電流電圧変換器10によって変換された電圧信号(バンドパスフィルタ30の出力信号)を減衰させる。
[Modification 5]
The filter 40 may be a high-pass filter having a frequency characteristic as shown in FIG. 14 instead of the band-pass filter. The filter 40 passes a component having a cutoff frequency fc4 or higher in the voltage signal (the output signal of the bandpass filter 30) converted by the current-voltage converter 10, and attenuates a component lower than the cutoff frequency fc4. Specifically, in the low frequency region below the cut-off frequency fc4, the filter 40 attenuates as the frequency of the component included in the voltage signal (the output signal of the bandpass filter 30) converted by the current-voltage converter 10 decreases. The voltage signal (the output signal of the bandpass filter 30) converted by the current-voltage converter 10 is attenuated so that the rate becomes higher.

フィルタ40の回路設計において、温度変化によるリプル成分の周波数の変動も考慮しつつ、図14に示すフィルタ40のカットオフ周波数fc4がリプル成分の周波数(例えば、常温時の周波数)よりも高く設定されている。従って、フィルタ40は、電流電圧変換器10によって変換された電圧信号(バンドパスフィルタ30の出力信号)のうちリプル成分を高周波成分(高周波成分はリプル成分よりも周波数が高い。)よりも高い減衰率で減衰させる。つまり、フィルタ40は、リプル成分を高周波成分よりも効率的に除去する。従って、フィルタ40は、リプル成分を除去した信号を差動増幅器50に出力する。
フィルタ40がハイパスフィルタである場合、図7に示すローパスフィルタ42が省略され、バンドパスフィルタ30の出力がハイパスフィルタ41の入力に接続されている。
In the circuit design of the filter 40, the cut-off frequency fc4 of the filter 40 shown in FIG. 14 is set to be higher than the frequency of the ripple component (for example, the frequency at normal temperature) while taking into account fluctuations in the frequency of the ripple component due to temperature changes. ing. Therefore, the filter 40 attenuates the ripple component of the voltage signal (the output signal of the bandpass filter 30) converted by the current-voltage converter 10 higher than the high-frequency component (the high-frequency component has a higher frequency than the ripple component). Decay at a rate. That is, the filter 40 removes the ripple component more efficiently than the high frequency component. Therefore, the filter 40 outputs a signal from which the ripple component has been removed to the differential amplifier 50.
When the filter 40 is a high pass filter, the low pass filter 42 shown in FIG. 7 is omitted, and the output of the band pass filter 30 is connected to the input of the high pass filter 41.

〔変形例6〕
フィルタ40がバンドパスフィルタではなく、バンドストップフィルタであってもよい。
[Modification 6]
The filter 40 may be a band stop filter instead of a band pass filter.

〔変形例7〕
ハイパスフィルタ20とバンドパスフィルタ30の一方又は両方を省略してもよい。ハイパスフィルタ20を省略した場合には、電流電圧変換器10の出力がバンドパスフィルタ30の入力に接続される。バンドパスフィルタ30を省略した場合には、ハイパスフィルタ20の出力がフィルタ40の入力及び差動増幅器50の入力に接続される。ハイパスフィルタ20とバンドパスフィルタ30の両方が省略されている場合には、電流電圧変換器10の出力がフィルタ40の入力及び差動増幅器50の入力に接続される。
[Modification 7]
One or both of the high pass filter 20 and the band pass filter 30 may be omitted. When the high-pass filter 20 is omitted, the output of the current-voltage converter 10 is connected to the input of the band-pass filter 30. When the band pass filter 30 is omitted, the output of the high pass filter 20 is connected to the input of the filter 40 and the input of the differential amplifier 50. When both the high-pass filter 20 and the band-pass filter 30 are omitted, the output of the current-voltage converter 10 is connected to the input of the filter 40 and the input of the differential amplifier 50.

〔変形例8〕
モータ制御装置1が電動ドアミラー装置に組み込まれ、電動ドアミラー装置の可動部(例えば、ドアに対してミラーハウジングの格納及び展開をする格納機構、ミラーハウジングに対してミラーを上下に振るチルト機構、ミラーハウジングに対してミラーを左右に振るパン機構)がモータ制御装置1のモータ2によって駆動されてもよい。モータ制御装置1がパワーウィンドウ装置に組み込まれ、パワーウィンドウ装置の可動部(例えば、ウィンドウレギュレター)がモータ2によって駆動されてもよい。
[Modification 8]
The motor control device 1 is incorporated in an electric door mirror device, and a movable part of the electric door mirror device (for example, a storage mechanism that stores and unfolds the mirror housing with respect to the door, a tilt mechanism that swings the mirror up and down with respect to the mirror housing, a mirror) A pan mechanism that swings the mirror to the left and right with respect to the housing may be driven by the motor 2 of the motor control device 1. The motor control device 1 may be incorporated in the power window device, and the movable portion (for example, window regulator) of the power window device may be driven by the motor 2.

〔変形例9〕
フィルタ40がオペアンプを用いたもの(例えば、負帰還型ローパスフィルタ、正帰還型ローパスフィルタ、多重負帰還型バンドパスフィルタ、多重正帰還型バンドパスフィルタ)でもよい。
[Modification 9]
The filter 40 may use an operational amplifier (for example, a negative feedback low-pass filter, a positive feedback low-pass filter, a multiple negative feedback band-pass filter, or a multiple positive feedback band-pass filter).

1 モータ制御装置
2 モータ
3 抽出回路
4 制御部
5 記憶部
5A 初期位置データ
5B 拘束開始位置データ
5C ロック位置データ
8 A/Dコンバータ(電流検出部)
98 ストッパ
99 可動部
DESCRIPTION OF SYMBOLS 1 Motor control apparatus 2 Motor 3 Extraction circuit 4 Control part 5 Memory | storage part 5A Initial position data 5B Restriction start position data 5C Lock position data 8 A / D converter (current detection part)
98 Stopper 99 Movable part

Claims (6)

可動範囲の両端の間を移動可能な可動部を駆動し、動作すると電流信号に周期的なリプルを発生させるモータと、
前記モータの前記電流信号からリプル成分を抽出して、そのリプル成分をパルス化したパルス信号を出力する抽出回路と、
前記モータの電流を検出する電流検出部と、
前記電流検出部によって検出された電流のデータを入力するとともに前記パルス信号を入力し、前記モータを制御する制御部と、
前記モータの動作前の初期位置を前記初期位置から所定の原点位置までのパルス数で表した初期位置データと、前記可動部が前記可動範囲内から前記端に移動して前記モータが更に回転することができる前記モータの拘束開始位置を前記拘束開始位置から前記原点位置までのパルス数で表した拘束開始位置データと、前記可動部が前記可動範囲の前記端に位置して前記モータがそれ以上回転できずに拘束される前記モータのロック位置を前記ロック位置から前記原点位置までのパルス数で表したロック位置データと、を記憶した記憶部と、を備え、
前記制御部が、
前記モータを起動させる起動処理と、
前記起動処理後に前記パルス信号のパルスを入力するたびに、前記起動処理後に前記パルス信号に発生したパルス数を計数し、計数したパルス数を前記初期位置データの値に加算し、又は計数したパルス数を前記初期位置データの値から減算する計数処理と、
前記起動処理後に前記計数処理において算出した差又は和を前記拘束開始位置データの値と比較することで、前記モータの位置が前記拘束開始位置の間であるか否かを判定する判定処理と、
前記モータの位置が前記拘束開始位置の間でないと前記判定処理において判定した場合に、前記電流検出部から入力した電流データが所定値以上になるまで前記モータの回転を継続し、前記電流検出部から入力した電流データが所定値以上になったら前記モータを停止させる停止処理と、
前記停止処理後に、前記記憶部に記憶された前記初期位置データを前記ロック位置データの値に書き換える更新処理と、を更に実行する、モータ制御装置。
A motor that drives a movable part movable between both ends of the movable range and generates a periodic ripple in the current signal when operated;
An extraction circuit that extracts a ripple component from the current signal of the motor and outputs a pulse signal obtained by pulsing the ripple component;
A current detector for detecting the current of the motor;
A controller that controls the motor by inputting the data of the current detected by the current detector and the pulse signal.
Initial position data representing the initial position before operation of the motor by the number of pulses from the initial position to a predetermined origin position, and the movable part moves from the movable range to the end and the motor further rotates. Restriction start position data representing the restriction start position of the motor in terms of the number of pulses from the restriction start position to the origin position, and the movable part is positioned at the end of the movable range and the motor is more than that A storage unit that stores lock position data in which the lock position of the motor that is restrained without being rotated is represented by the number of pulses from the lock position to the origin position; and
The control unit is
A starting process for starting the motor;
Each time a pulse of the pulse signal is input after the start-up process, the number of pulses generated in the pulse signal after the start-up process is counted, and the counted number of pulses is added to the value of the initial position data, or the counted pulse A counting process for subtracting a number from the value of the initial position data;
A determination process for determining whether or not the position of the motor is between the constraint start positions by comparing the difference or sum calculated in the counting process after the activation process with the value of the constraint start position data;
When it is determined in the determination process that the position of the motor is not between the restraint start positions, the rotation of the motor is continued until the current data input from the current detection unit becomes a predetermined value or more, and the current detection unit A stop process for stopping the motor when the current data input from is over a predetermined value;
A motor control device further executing, after the stop process, an update process for rewriting the initial position data stored in the storage unit to a value of the lock position data.
前記制御部が、
前記初期位置データの値が前記ロック位置データの値に等しいか否かを判定する第二判定処理と、
前記初期位置データの値が前記ロック位置データの値に等しいと前記第二判定処理において判定した場合に、前記起動処理の実行後に前記計数処理において算出する差又は和が前記拘束開始位置データの値に等しくなるまで、前記モータの停止を禁止する禁止処理と、を更に実行する、請求項1に記載のモータ制御装置。
The control unit is
A second determination process for determining whether the value of the initial position data is equal to the value of the lock position data;
When it is determined in the second determination process that the value of the initial position data is equal to the value of the lock position data, the difference or sum calculated in the counting process after execution of the activation process is the value of the constraint start position data The motor control device according to claim 1, further comprising: a prohibiting process that prohibits the motor from being stopped until equal to.
前記制御部が、前記モータの位置が前記拘束開始位置の間であると前記判定処理において判定した場合に、前記モータを停止させる第二停止処理を更に実行する、請求項1又は2に記載のモータ制御装置。   The said control part further performs the 2nd stop process which stops the said motor, when it determines in the said determination process that the position of the said motor is between the said restraint start positions. Motor control device. 前記制御部が、前記初期位置データの値が前記ロック位置データの値に等しくないと前記第二判定処理において判定した場合に、前記起動処理を実行する、請求項2に記載のモータ制御装置。   3. The motor control device according to claim 2, wherein when the control unit determines in the second determination process that the value of the initial position data is not equal to the value of the lock position data, the motor control device according to claim 2. 前記制御部が、前記起動処理後に所定の停止条件が満たされた時に前記判定処理を実行する、請求項1から4の何れか一項に記載のモータ制御装置。   5. The motor control device according to claim 1, wherein the control unit executes the determination process when a predetermined stop condition is satisfied after the start process. 6. 請求項1から5の何れか一項に記載のモータ制御装置と、
前記モータによって駆動される前記可動部を有するシート本体と、を備える車両用シート装置。
A motor control device according to any one of claims 1 to 5;
A vehicle seat device comprising: a seat body having the movable portion driven by the motor.
JP2011077080A 2011-03-14 2011-03-31 Motor control device and vehicle seat device Active JP5628728B2 (en)

Priority Applications (5)

Application Number Priority Date Filing Date Title
JP2011077080A JP5628728B2 (en) 2011-03-31 2011-03-31 Motor control device and vehicle seat device
PCT/JP2012/056362 WO2012124674A1 (en) 2011-03-14 2012-03-13 Ripple extraction device, motor control apparatus, vehicle seat, and ripple extraction method
CN201280023259.7A CN103688460A (en) 2011-03-14 2012-03-13 Ripple extraction device, motor control apparatus, vehicle seat, and ripple extraction method
EP12758207.0A EP2688197A4 (en) 2011-03-14 2012-03-13 Ripple extraction device, motor control apparatus, vehicle seat, and ripple extraction method
US14/005,004 US20140001815A1 (en) 2011-03-14 2012-03-13 Ripple extraction device, motor control apparatus, vehicle seat and ripple extraction method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2011077080A JP5628728B2 (en) 2011-03-31 2011-03-31 Motor control device and vehicle seat device

Publications (2)

Publication Number Publication Date
JP2012213261A JP2012213261A (en) 2012-11-01
JP5628728B2 true JP5628728B2 (en) 2014-11-19

Family

ID=47266761

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2011077080A Active JP5628728B2 (en) 2011-03-14 2011-03-31 Motor control device and vehicle seat device

Country Status (1)

Country Link
JP (1) JP5628728B2 (en)

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4193739B2 (en) * 2004-03-24 2008-12-10 株式会社デンソー Seat belt device
JP2008086104A (en) * 2006-09-27 2008-04-10 Keihin Corp Air conditioner for vehicle
JP4939298B2 (en) * 2007-05-09 2012-05-23 アイシン精機株式会社 DC motor ripple detection device, motor rotational position detection device, and ripple detection method
JP5270119B2 (en) * 2007-07-12 2013-08-21 トヨタ自動車株式会社 Motor ripple detector
JP2009247080A (en) * 2008-03-31 2009-10-22 Ts Tech Co Ltd Vehicle seat device

Also Published As

Publication number Publication date
JP2012213261A (en) 2012-11-01

Similar Documents

Publication Publication Date Title
US20140001815A1 (en) Ripple extraction device, motor control apparatus, vehicle seat and ripple extraction method
US7843159B2 (en) Motor controller
JP4655400B2 (en) Motor rotation pulse generation circuit for DC motor
JP5628729B2 (en) Motor control device and vehicle seat device
JP2007060779A (en) Motor control device
JP7178327B2 (en) NOTCH FILTER ADJUSTMENT DEVICE AND MOTOR CONTROL DEVICE INCLUDING THE SAME
JP2009022116A (en) Motor ripple detector
JP6118988B2 (en) Motor drive device
JP5710321B2 (en) Ripple extraction device, control device, vehicle seat and ripple extraction method
JP5628728B2 (en) Motor control device and vehicle seat device
JP4244412B2 (en) Motor rotation pulse generation circuit for DC motor and pinching detection device using the circuit
JP5628724B2 (en) Motor control device
JP2005180924A (en) Gear damage detector and gear damage detection method
JP5749527B2 (en) Motor control device
JP2009291011A (en) State storage controller
JP5749529B2 (en) Motor control device
JP5261070B2 (en) DC motor rotation state detection device and DC motor control device
JP5662218B2 (en) Motor control device
JP6789444B1 (en) Motor shaft state detection method, motor control method, motor shaft state detection device, motor control device, vehicle height adjustment device, saddle-mounted vehicle
JP5489667B2 (en) DC motor ripple detection device, ripple detection method, and ripple detection program
JP7006398B2 (en) Motor drive
JP4956238B2 (en) DC motor ripple detection device, rotation state detection device, ripple detection method and rotation state detection method
US6538406B1 (en) System and method for improving transient speed response of electric motors
JP4976873B2 (en) Signal detection device
JP4388517B2 (en) DC motor rotation state detection device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20140311

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20140902

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20141002

R150 Certificate of patent or registration of utility model

Ref document number: 5628728

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250