JP2000166275A - Servo control device by detecting current ripple - Google Patents

Servo control device by detecting current ripple

Info

Publication number
JP2000166275A
JP2000166275A JP10338153A JP33815398A JP2000166275A JP 2000166275 A JP2000166275 A JP 2000166275A JP 10338153 A JP10338153 A JP 10338153A JP 33815398 A JP33815398 A JP 33815398A JP 2000166275 A JP2000166275 A JP 2000166275A
Authority
JP
Japan
Prior art keywords
motor
movable range
current
movable body
movable
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.)
Withdrawn
Application number
JP10338153A
Other languages
Japanese (ja)
Inventor
Minoru Yoshida
稔 吉田
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.)
Panasonic Electric Works Co Ltd
Original Assignee
Matsushita Electric Works 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 Matsushita Electric Works Ltd filed Critical Matsushita Electric Works Ltd
Priority to JP10338153A priority Critical patent/JP2000166275A/en
Publication of JP2000166275A publication Critical patent/JP2000166275A/en
Withdrawn legal-status Critical Current

Links

Landscapes

  • Stopping Of Electric Motors (AREA)
  • Control Of Direct Current Motors (AREA)

Abstract

PROBLEM TO BE SOLVED: To provide a servo control device by detecting a current ripple that eliminates the need for a limit switch and can detect the locked state of a motor. SOLUTION: A current ripple detection part 20 outputs a pulse signal in synchronization with the rotation of a motor 1. A control part 10 and a motor drive part 11 compose a motor control part for controlling the motor 1 with servo based on a pulse signal from the current ripple detection part 20. The current ripple detection part 20 is provided with an amplifier 21 for amplifying a detection voltage that is proportional to the detection current of a resistor R that is a current detection means. A discrimination means 30 gives an instruction so that the motor to the control part 10 is stopped when the output value of the amplifier 21 is larger than a specific value and a pulse signal from the current ripple detection part 20 is not detected continuously for a specific amount of time.

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【発明の属する技術分野】本発明は、直流モータのモー
タ電流のリプルによりモータの回転を検出してモータを
サーボ制御するようにした電流リプル検出によるサーボ
制御装置に関するものである。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a servo control apparatus for detecting a current ripple of a DC motor and detecting the rotation of the motor to perform servo control of the motor.

【0002】[0002]

【従来の技術】従来より、モータの回転速度や回転位置
を指示値に従って制御するためにサーボ制御装置が広く
用いられている。例えば、モータを用いて灯具を昇降さ
せたり照明方向を変化させたりすることができるように
した可動型の照明装置では、サーボ制御されたモータを
用いることにより照明装置の移動速度や位置を決定して
いる。
2. Description of the Related Art Conventionally, servo controllers have been widely used to control the rotational speed and rotational position of a motor in accordance with designated values. For example, in a movable lighting device that can raise and lower a lamp or change a lighting direction using a motor, a moving speed and a position of the lighting device are determined by using a servo-controlled motor. ing.

【0003】モータのサーボ制御装置としては、図9に
示す構成が考えられている。このサーボ制御装置は、負
荷(図示せず)を駆動するモータ1としてブラシ付きの
直流モータを用いており、モータ1の駆動には4個のス
イッチング素子Q1〜Q4をブリッジ接続した所謂フル
ブリッジ型のブリッジ回路よりなるモータ駆動部11を
用いている。つまり、各一対のスイッチング素子Q1,
Q2、Q3,Q4の直列回路を並列に接続したブリッジ
回路を構成し、ブリッジ回路の各アームを構成するスイ
ッチング素子Q1,Q2、Q3,Q4の接続点を出力端
としてモータ1を接続し、両アームの並列回路の両端間
に直流電源Vccを接続してある。したがって、スイッチ
ング素子Q1〜Q4を適宜に制御することによって、モ
ータ1への通電方向を切り換えるとともに、モータ1へ
の給電量を調節してモータ1の回転速度を調整すること
ができる。モータ1への給電量は、スイッチング素子Q
1〜Q4をパルス幅(PWM)制御することによって調
節され、単位時間当たりのスイッチング素子Q1〜Q4
のオン期間を長くすればモータ1への給電量が増加する
ことになる。
FIG. 9 shows a configuration of a servo control device for a motor. This servo control device uses a brushed DC motor as a motor 1 for driving a load (not shown), and a so-called full bridge type in which four switching elements Q1 to Q4 are bridge-connected to drive the motor 1. The motor drive unit 11 including the bridge circuit is used. That is, each pair of switching elements Q1,
A bridge circuit is formed by connecting the series circuits of Q2, Q3, and Q4 in parallel, and the motor 1 is connected with the connection point of the switching elements Q1, Q2, Q3, and Q4 forming each arm of the bridge circuit as an output terminal. A DC power supply Vcc is connected between both ends of the parallel circuit of the arm. Therefore, by appropriately controlling the switching elements Q1 to Q4, the energizing direction to the motor 1 can be switched, and the amount of power supplied to the motor 1 can be adjusted to adjust the rotation speed of the motor 1. The amount of power supplied to the motor 1 is determined by the switching element Q
The switching elements Q1 to Q4 are adjusted by controlling the pulse width (PWM) of each of the switching elements Q1 to Q4
, The amount of power supply to the motor 1 increases.

【0004】したがって、ブリッジ回路の各スイッチン
グ素子Q1〜Q4は制御部10により生成されたPWM
信号(モータ1への給電量に応じたパルス幅を有するパ
ルス信号)によりオンオフ制御される。モータ1には電
流検出手段たる抵抗Rが直列接続され、ブリッジ回路の
出力端にはこの直列回路が接続される。したがって、抵
抗Rの両端電圧はモータ電流(電機子電流)に比例す
る。
Therefore, each of the switching elements Q1 to Q4 of the bridge circuit is a PWM generated by the control unit 10.
On / off control is performed by a signal (a pulse signal having a pulse width corresponding to the amount of power supplied to the motor 1). A resistor R as a current detecting means is connected in series to the motor 1, and this series circuit is connected to the output terminal of the bridge circuit. Therefore, the voltage across the resistor R is proportional to the motor current (armature current).

【0005】このサーボ制御装置は、モータ電流(通常
は電機子電流)を抵抗Rにより検出し、検出されたモー
タ電流に含まれる電流リプルを電流リプル検出部20で
検出してモータ1の回転に同期した電流リプルパルスを
発生させている。電流リプルパルスは制御部10に入力
され、電流リプルパルスにより検出されたモータ1の各
時点での回転速度および回転位置が制御部10に別に与
えられる目標値に一致するように制御信号が生成され
る。制御信号はモータ駆動部11を介してモータ1を制
御する。つまり、モータ駆動部11は、制御信号により
指示されたモータ1の回転速度や回転量(回転方向を含
む)に応じてモータ1に通電する。
In this servo control device, a motor current (usually an armature current) is detected by a resistor R, and a current ripple included in the detected motor current is detected by a current ripple detecting section 20 to cause the motor 1 to rotate. A synchronized current ripple pulse is generated. The current ripple pulse is input to the control unit 10, and a control signal is generated such that the rotational speed and the rotational position of the motor 1 at each time detected by the current ripple pulse coincide with target values separately given to the control unit 10. The control signal controls the motor 1 via the motor drive unit 11. That is, the motor drive unit 11 energizes the motor 1 in accordance with the rotation speed and the rotation amount (including the rotation direction) of the motor 1 specified by the control signal.

【0006】電流リプル検出部20は、抵抗Rによる検
出電流に比例した検出電圧のノイズをノイズ回路22で
除去してアンプ21で増幅し、アンプ21の出力を微分
回路23で微分し、コンパレータ24で微分回路23の
出力と基準値との大小関係に応じて上記電流リプルパル
スを出力する。つまり、電流リプル検出部20からは、
モータ1の回転に同期したパルス信号たる電流リプルパ
ルスが出力される。したがって、制御部10は、電流リ
プル検出部20からの電流リプルパルスを計数すること
により、モータ1の回転速度や回転位置を検出すること
が可能となるのである。
The current ripple detecting unit 20 removes noise of a detection voltage proportional to the detection current by the resistor R by a noise circuit 22 and amplifies the noise by an amplifier 21. Outputs the current ripple pulse according to the magnitude relationship between the output of the differentiating circuit 23 and the reference value. That is, from the current ripple detection unit 20,
A current ripple pulse, which is a pulse signal synchronized with the rotation of the motor 1, is output. Therefore, the control unit 10 can detect the rotation speed and the rotation position of the motor 1 by counting the current ripple pulses from the current ripple detection unit 20.

【0007】なお、ブラシ付きの直流モータに流れるモ
ータ電流に含まれる電流リプルを検出し、直流モータの
回転速度や回転位置を制御するサーボ制御装置は、例え
ば、実開昭56−7496号公報、実開昭57−189
294号公報、特開昭58−54888号公報、特開昭
58−195464号公報、特開昭61−62380号
公報、特開平4−71383号公報、特開平4−172
984号公報(特公平7−73434号)など多数の公
報に開示されている。
[0007] A servo control device for detecting a current ripple included in a motor current flowing in a brushed DC motor and controlling the rotation speed and rotation position of the DC motor is disclosed in, for example, Japanese Utility Model Laid-Open Publication No. 56-7496. 57-189
294, JP-A-58-54888, JP-A-58-195664, JP-A-61-62380, JP-A-4-71383, and JP-A-4-172.
No. 984 (Japanese Patent Publication No. 7-73434).

【0008】上述のように、図9に示すサーボ制御装置
は、モータ電流に含まれる電流リプルに基づいてモータ
1の回転速度や回転位置を検出するものであって、モー
タ1の回転速度や回転位置を検出するためのセンサを別
途に設けていないから、構成が簡単であるという利点を
有している。
As described above, the servo control device shown in FIG. 9 detects the rotation speed and the rotation position of the motor 1 based on the current ripple included in the motor current. Since a sensor for detecting the position is not separately provided, there is an advantage that the configuration is simple.

【0009】ところで、昇降させる照明装置のように規
定の2位置の間で往復移動する可動体を移動させる直流
モータをサーボ制御するサーボ制御装置では、可動体の
可動範囲の両端にそれぞれリミットスイッチを設けるこ
とにより、可動範囲の両端でのモータのロックによるモ
ータやモータ駆動部の焼損を防止し、また、可動範囲内
では、モータの電流値の変化にによって手や指の挟み込
みなどを検出してモータを停止させ危険を防止してい
る。
By the way, in a servo control device that servo-controls a DC motor that moves a movable body that reciprocates between two specified positions, such as a lighting device that moves up and down, limit switches are provided at both ends of the movable range of the movable body. By providing the motor, the motor and the motor drive unit are prevented from being burned due to the lock of the motor at both ends of the movable range. The motor is stopped to prevent danger.

【0010】[0010]

【発明が解決しようとする課題】しかしながら、上述の
ように可動範囲の両端にリミットスイッチを設けると、
コストが高くなるとともに、省スペース化の妨げになる
という不具合があった。
However, if limit switches are provided at both ends of the movable range as described above,
There was a problem that the cost was increased and space saving was hindered.

【0011】そこで、リミットスイッチを設ける代わり
に、上述の電流リプルパルスの検出の有無によりモータ
がロック状態にあるか否かを判別することが考えられ
る。
Therefore, instead of providing a limit switch, it is conceivable to determine whether or not the motor is in a locked state based on whether or not the above-described current ripple pulse is detected.

【0012】直流モータの高速回転時(適正負荷状態)
には電流リプル波形が例えば図10(a)のに示すよ
うになるから、電流リプル波形が判別しやすい。これに
対し、モータがロック状態になる直前には図10(b)
のに示す波形のようにモータの回転速度が極低速(例
えば、回転数が数百rpm以下)になり、モータがロッ
ク状態に至ると電流リプルが検出されなくなり、ノイズ
レベルとの判別が困難になる。また、低速回転で負荷が
軽い場合には、電流リプル波形は図10(a)のに示
すように高速回転時に比べて低周波数成分が多くなると
とともに、波高値が小さくなるので、電流リプルを検出
できない回転速度範囲がある。したがって、電流リプル
の検出だけでは、モータがロック状態にあるのか軽負荷
で低速回転中なのか判別できないという不具合があっ
た。
When the DC motor rotates at high speed (appropriate load condition)
Since the current ripple waveform becomes as shown in FIG. 10A, for example, the current ripple waveform can be easily determined. On the other hand, immediately before the motor enters the locked state, FIG.
As shown in the waveform shown in FIG. 5, when the rotation speed of the motor becomes extremely low (for example, the rotation speed is several hundred rpm or less), and when the motor reaches the lock state, current ripple is not detected, and it is difficult to determine the noise level. Become. In addition, when the load is light at low speed rotation, the current ripple waveform has more low frequency components and a smaller peak value than at high speed rotation as shown in FIG. Some rotation speed ranges are not available. Therefore, there is a problem that it is not possible to determine whether the motor is in the locked state or rotating at a low speed with a light load only by detecting the current ripple.

【0013】本発明は上記事由に鑑みて為されたもので
あり、その目的は、リミットスイッチが不要で且つモー
タのロック状態を検出することができる電流リプル検出
によるサーボ制御装置を提供することにある。
SUMMARY OF THE INVENTION The present invention has been made in view of the above circumstances, and an object of the present invention is to provide a servo control device based on current ripple detection which does not require a limit switch and can detect a locked state of a motor. is there.

【0014】[0014]

【課題を解決するための手段】請求項1の発明は、上記
目的を達成するために、直流モータに流れるモータ電流
を検出する電流検出手段と、モータ電流に含まれる電流
リプルを検出して直流モータの回転に同期したパルス信
号を出力する電流リプル検出部と、電流リプル検出部か
らのパルス信号に基づいて直流モータをサーボ制御する
モータ制御部と、電流検出手段により検出した電流値の
大きさが所定値よりも大きく且つパルス信号が所定時間
連続して検出されない場合にモータ制御部へモータを停
止させるように指示する判別手段とを備えることを特徴
とするものであり、判別手段は電流検出手段により検出
した電流値の大きさが所定値よりも大きく且つパルス信
号が所定時間連続して検出されない場合にモータ制御部
へモータを停止させるように指示するので、リミットス
イッチを設けることなしに、モータがロック状態になっ
たり手や指が挟み込まれた場合にモータが停止され安全
性が高い。
According to the first aspect of the present invention, there is provided an electric vehicle comprising: a current detecting means for detecting a motor current flowing through a DC motor; and a DC current detecting means for detecting a current ripple included in the motor current. A current ripple detection unit that outputs a pulse signal synchronized with the rotation of the motor, a motor control unit that servo-controls the DC motor based on the pulse signal from the current ripple detection unit, and a magnitude of the current value detected by the current detection unit Is larger than a predetermined value, and when the pulse signal is not continuously detected for a predetermined time, the motor control unit is instructed to stop the motor. When the magnitude of the current value detected by the means is larger than a predetermined value and the pulse signal is not continuously detected for a predetermined time, the motor is stopped by the motor control unit. Since instruct so that, without providing the limit switch, the motor is a motor that is highly safe is stopped when the hand or fingers or a locked state sandwiched.

【0015】請求項2の発明は、請求項1の発明におい
て、上記直流モータは、規定の2位置の間で可動体を往
復移動させ、モータ制御部には、初期設定を行うために
可動体を往復移動させたときにパルス信号をカウントす
ることによりモータの停止位置に対応するカウント値を
検出する計数手段と、計数手段により検出された上記停
止位置に対応する各カウント値に応じて可動体の可動範
囲両端それぞれのリミット位置を設定するリミットパル
ス値を記憶する可動範囲設定手段と、電流リプル検出部
からのパルス信号のカウント値が上記可動範囲設定手段
に記憶されたリミットパルス値に達した場合にモータ制
御部へモータを停止させるように指示する位置制御手段
とが付加されているので、初期設定時において計数手段
により検出された停止位置に対応する各カウント値に応
じて可動体の可動範囲両端それぞれのリミット位置を設
定するリミットパルス値が可動範囲設定手段へ自動的に
記憶され、初期設定終了後は電流リプルパルス検出部か
らのパルス信号のカウント値が上記リミットパルス値に
達した場合に位置制御手段からモータ制御部へモータを
停止させるように指示されるから、リミットスイッチを
設けることなしに、可動体の可動範囲を規制することが
可能となる。
According to a second aspect of the present invention, in the first aspect of the present invention, the DC motor reciprocates the movable body between two prescribed positions, and the motor control unit includes a movable body for performing initialization. Counting means for detecting a count value corresponding to the stop position of the motor by counting the pulse signal when reciprocating the movable member, and a movable body corresponding to each count value corresponding to the stop position detected by the count means. Movable range setting means for storing limit pulse values for setting respective limit positions of both ends of the movable range, and the count value of the pulse signal from the current ripple detecting section has reached the limit pulse value stored in the movable range setting means. In this case, the position control means for instructing the motor control unit to stop the motor is added. The limit pulse value for setting each limit position at both ends of the movable range of the movable body according to each count value corresponding to the stop position is automatically stored in the movable range setting means. When the count value of the pulse signal reaches the limit pulse value, the position control unit instructs the motor control unit to stop the motor, so that the movable range of the movable body is regulated without providing a limit switch. It becomes possible.

【0016】請求項3の発明は、請求項1の発明におい
て、上記直流モータは、規定の2位置の間で可動体を往
復移動させ、モータ制御部には、初期設定を行うために
可動体を往復移動させたときにパルス信号をカウントす
ることによりモータの停止位置に対応するカウント値を
検出する計数手段と、計数手段により検出された上記停
止位置に対応する各カウント値に応じて可動体の可動範
囲両端それぞれのリミット位置を設定するリミットパル
ス値を記憶する可動範囲設定手段とが付加され、可動範
囲設定手段に上記リミットパルス値が記憶された後は可
動範囲設定手段の記憶内容に基づいて可動体が可動範囲
にあるか否かを判定し可動範囲内にあるときに判別手段
からモータを停止させるように指示があると過負荷状態
であると認識するので、初期設定時において計数手段に
より検出された停止位置に対応する各カウント値に応じ
て可動体の可動範囲両端それぞれのリミット位置を設定
するリミットパルス値が可動範囲設定手段へ自動的に記
憶され、初期設定終了後は可動範囲内で判別手段からモ
ータを停止させる指示がモータ制御部にあると、モータ
制御部は可動体の可動範囲内で手や指あるいは障害物が
挟まれてモータが過負荷状態にあることを認識すること
ができる。
According to a third aspect of the present invention, in the first aspect of the present invention, the DC motor reciprocates the movable body between two prescribed positions, and the motor control unit includes a movable body for performing initial setting. Counting means for detecting a count value corresponding to the stop position of the motor by counting the pulse signal when reciprocating the movable member, and a movable body corresponding to each count value corresponding to the stop position detected by the count means. And a movable range setting means for storing limit pulse values for setting respective limit positions of both ends of the movable range. After the limit pulse value is stored in the movable range setting means, based on the stored contents of the movable range setting means. To determine whether or not the movable body is in the movable range. If the movable body is within the movable range, an instruction to stop the motor is given by the determination means, and the overload state is recognized. At the time of the initial setting, the limit pulse value for setting the respective limit positions at both ends of the movable range of the movable body in accordance with each count value corresponding to the stop position detected by the counting means is automatically stored in the movable range setting means. However, after the initialization, if the motor control unit issues an instruction to stop the motor within the movable range from the determination unit, the motor control unit may cause a hand, finger, or obstacle to be caught in the movable range of the movable body, causing the motor to overrun. It is possible to recognize that there is a load.

【0017】請求項4の発明は、請求項1の発明におい
て、上記直流モータは、規定の2位置の間で可動体を往
復移動させ、モータ制御部には、初期設定を行うために
可動体を往復移動させたときにパルス信号をカウントす
ることによりモータの停止位置に対応するカウント値を
検出する計数手段と、計数手段により検出された上記停
止位置に対応する各カウント値に応じて可動体の可動範
囲両端それぞれの停止位置を記憶する可動範囲設定手段
と、可動範囲設定手段に上記カウント値が記憶された後
に上記2位置間の相対的な位置制御を行う位置制御手段
とが付加されているので、初期設定時において計数手段
により検出された停止位置に対応する各カウント値に応
じて可動体の可動範囲両端それぞれの停止位置が可動範
囲設定手段へ自動的に記憶され、初期設定終了後は位置
制御手段により上記停止位置間の相対的な位置制御が行
われるから、可動体の可動範囲をあらかじめ知っておく
必要がなく、可動体の可動範囲が異なる場合にも対応す
ることができる。
According to a fourth aspect of the present invention, in the first aspect of the present invention, the DC motor reciprocates the movable body between two specified positions, and the motor control unit includes a movable body for performing initialization. Counting means for detecting a count value corresponding to the stop position of the motor by counting the pulse signal when reciprocating the movable member, and a movable body corresponding to each count value corresponding to the stop position detected by the count means. Movable range setting means for storing stop positions at both ends of the movable range, and position control means for performing relative position control between the two positions after the count value is stored in the movable range setting means. Therefore, the stop positions at both ends of the movable range of the movable body are automatically transmitted to the movable range setting means in accordance with each count value corresponding to the stop position detected by the counting means at the time of the initial setting. Since the relative position control between the stop positions is performed by the position control means after the initial setting is completed, it is not necessary to know the movable range of the movable body in advance, and when the movable range of the movable body is different. Can also be accommodated.

【0018】[0018]

【発明の実施の形態】(実施形態1)本実施形態の基本
構成は、図9に示した従来構成と略同じであって、図1
に示すように、電流検出手段たる抵抗Rの検出電流に比
例した検出電圧値が所定値よりも大きく且つパルス信号
が所定時間連続して検出されない場合に制御部10へモ
ータを停止させるように指示する判別手段30を設けた
点に特徴がある。なお、図9に示した従来構成と同様の
構成要素には同一の符号を付して説明を省略する。ま
た、制御部10とモータ駆動部11とで、電流リプル検
出部20からのパルス信号に基づいてモータ1をサーボ
制御するモータ制御部を構成している。
(Embodiment 1) The basic configuration of this embodiment is substantially the same as the conventional configuration shown in FIG.
As shown in (5), when the detection voltage value proportional to the detection current of the resistor R as the current detection means is larger than a predetermined value and the pulse signal is not continuously detected for a predetermined time, the control unit 10 is instructed to stop the motor. It is characterized in that a discriminating means 30 is provided. Note that the same components as those of the conventional configuration shown in FIG. 9 are denoted by the same reference numerals, and description thereof will be omitted. Further, the control unit 10 and the motor drive unit 11 constitute a motor control unit that servo-controls the motor 1 based on a pulse signal from the current ripple detection unit 20.

【0019】本実施形態において、モータ1は、規定の
2位置の間で移動可能な可動体を上記2位置あるいは2
位置間の適宜位置に往復移動させるものである。
In this embodiment, the motor 1 moves the movable body movable between two specified positions to the above two positions or two positions.
It reciprocates to an appropriate position between the positions.

【0020】判別手段30は、図2に示すように、電流
リプル検出部20から出力された電流リプルパルスを積
算する周期カウンタ31と、電流リプル検出部20のア
ンプ21の出力をA/D変換するA/D変換部32とを
備えている。また、判別手段30は、周期カウンタ31
の積算値が規定値以下であり且つA/D変換部32によ
りA/D変換されたデジタル値の上位の特定ビットが1
のときに出力が0から1に変化する論理ゲート33を備
えている。なお、電流リプルパルスの発生個数はモータ
1の回転量に対応し、電流リプルパルスの発生間隔はモ
ータ1の回転速度に対応する。
As shown in FIG. 2, the discriminating means 30 performs A / D conversion on the cycle counter 31 for accumulating the current ripple pulse output from the current ripple detecting section 20 and the output of the amplifier 21 of the current ripple detecting section 20. And an A / D converter 32. Further, the determination means 30 includes a period counter 31
Of the digital value A / D converted by the A / D conversion unit 32 is 1
A logic gate 33 whose output changes from 0 to 1 at the time. The number of current ripple pulses generated corresponds to the rotation amount of the motor 1, and the generation interval of the current ripple pulses corresponds to the rotation speed of the motor 1.

【0021】ここにおいて、周期カウンタ31の積算値
が例えば0のときは電流リプルパルスが周期カウンタ3
1により決まる所定時間連続して検出されないことを意
味するから、この場合、モータ1は、ロック状態にある
か、あるいは、軽負荷で低速回転している可能性が高
い。一方、A/D変換部32により変換されたデジタル
値の上位の特定ビットが1になるには、アンプ21の出
力が比較的大きくなる必要がある。つまり、抵抗Rの検
出電流の電流値が所定値よりも大きくなることを意味す
るから、上位の特定ビットが1の場合にはモータ1がロ
ック状態にある可能性が高い。これに対し、モータ1が
軽負荷で低速回転している場合には、図10(a)の
に示したように電流リプルのレベルは小さいので、上述
の上位の特定ビットは0になる。なお、抵抗Rの検出電
流の電流値としては、検出電流の平均値、ピーク値など
が用いられる。
Here, when the integrated value of the cycle counter 31 is, for example, 0, the current ripple pulse is output to the cycle counter 3
In this case, it is highly likely that the motor 1 is in the locked state or is rotating at a low speed with a light load. On the other hand, in order for the higher-order specific bit of the digital value converted by the A / D converter 32 to become 1, the output of the amplifier 21 needs to be relatively large. That is, it means that the current value of the detection current of the resistor R becomes larger than the predetermined value. Therefore, when the upper specific bit is 1, the possibility that the motor 1 is in the locked state is high. On the other hand, when the motor 1 is rotating at a low speed with a light load, the level of the current ripple is small as shown in FIG. Note that as the current value of the detection current of the resistor R, an average value, a peak value, or the like of the detection current is used.

【0022】したがって、判別手段30は、抵抗Rの検
出電流に比例した検出電圧値が所定値よりも大きく且つ
パルス信号が所定時間連続して検出されない場合には論
理ゲート33の出力が0から1に変化する。
Accordingly, when the detection voltage value proportional to the detection current of the resistor R is larger than the predetermined value and the pulse signal is not continuously detected for a predetermined time, the output of the logic gate 33 changes from 0 to 1 Changes to

【0023】論理ゲート33の出力は制御部10に入力
されるようになっており、論理ゲート33の出力が1に
なると、制御部10は判別手段30からモータ1を停止
するように指示されたものとみなすようになっている。
The output of the logic gate 33 is input to the control unit 10. When the output of the logic gate 33 becomes 1, the control unit 10 is instructed by the determination means 30 to stop the motor 1. It is supposed to be considered.

【0024】しかして、本実施形態では、電流検出手段
たる抵抗Rの検出電流の平均値またはピーク値が所定値
よりも大きく且つ電流リプルパルスたるパルス信号が所
定時間連続して検出されない場合には、判別手段30が
制御部10へモータ1を停止させるように指示するか
ら、モータ1が停止される。要するに、本実施形態で
は、リミットスイッチを設けることなしに、モータ1が
ロック状態になったり手や指が挟み込まれた場合にモー
タ1を確実に停止させることができるのである。
According to the present embodiment, when the average value or peak value of the detection current of the resistor R as the current detection means is larger than a predetermined value and a pulse signal as a current ripple pulse is not continuously detected for a predetermined time, Since the determination means 30 instructs the control unit 10 to stop the motor 1, the motor 1 is stopped. In short, in the present embodiment, the motor 1 can be reliably stopped when the motor 1 is locked or a hand or finger is caught without providing a limit switch.

【0025】(実施形態2)本実施形態の基本構成は実
施形態1と略同じであり、図3に示すように、制御部1
0へ位置制御に関する指示を与える位置制御手段40を
付加した点に特徴がある。なお、実施形態1と同様の構
成要素には同一の符号を付して説明を省略する。
(Embodiment 2) The basic configuration of this embodiment is substantially the same as that of Embodiment 1, and as shown in FIG.
It is characterized in that a position control means 40 for giving an instruction regarding position control to 0 is added. Note that the same components as those in the first embodiment are denoted by the same reference numerals, and description thereof will be omitted.

【0026】ここにおいて、位置制御手段40は、図4
に示すように、電流リプル検出部20から入力される電
流リプルパルスをカウントするプリセット・アップダウ
ンカウンタ41を備えている。なお、実施形態1で説明
したように、電流リプルパルスの発生個数はモータ1の
回転量に対応し、電流リプルパルスの発生間隔はモータ
1の回転速度に対応する。
Here, the position control means 40 is provided as shown in FIG.
As shown in (1), a preset up / down counter 41 for counting the current ripple pulse input from the current ripple detection unit 20 is provided. As described in the first embodiment, the number of generated current ripple pulses corresponds to the rotation amount of the motor 1, and the generation interval of the current ripple pulse corresponds to the rotation speed of the motor 1.

【0027】また、位置制御手段40は、モータ1の回
転方向に応じて電流リプル検出部20の出力を入力する
プリセット・アップダウンカウンタ41の入力端子U
C,DCを切り替える切替スイッチSWを備えており、
切替スイッチSWが入力端子UC側に接続された場合に
は電流リプルパルスがアップカウント(+1)され、入
力端子DC側に接続された場合には電流リプルパルスが
ダウンカウント(−1)される。切替スイッチSWは、
モータ駆動部11によるモータ1の回転方向の切換に連
動して切り替えられ、例えば、モータ1が時計方向に回
転するときには電流リプルパルスをアップカウントし、
反時計方向に回転するときには電流リプルパルスをダウ
ンカウントする。
The position control means 40 has an input terminal U of a preset up / down counter 41 for inputting the output of the current ripple detecting section 20 in accordance with the rotation direction of the motor 1.
A switch SW for switching between C and DC is provided.
When the switch SW is connected to the input terminal UC, the current ripple pulse is counted up (+1), and when the switch SW is connected to the input terminal DC, the current ripple pulse is counted down (-1). The changeover switch SW is
Switching is performed in conjunction with the switching of the rotation direction of the motor 1 by the motor drive unit 11. For example, when the motor 1 rotates clockwise, the current ripple pulse is counted up,
When rotating in the counterclockwise direction, the current ripple pulse is counted down.

【0028】位置制御手段40は、上位システムから可
動体の制御位置の目標値がプリセット・アップダウンカ
ウンタ41のプリセット端子PRESETにプリセット
パルスとして与えられ、カウント値がプリセットされた
値に一致するまで制御部10へモータ1を駆動するよう
に指令する。
The position control means 40 supplies a target value of the control position of the movable body from the host system to the preset terminal PRESET of the preset up / down counter 41 as a preset pulse, and controls the count value until the count value matches the preset value. It instructs the unit 10 to drive the motor 1.

【0029】さらに、位置制御手段40は、プリセット
・アップダウンカウンタ41の出力値(カウント値)と
可動範囲設定手段たるリミットパルス値保持手段50を
構成するメモリに記憶されているリミットパルス値とを
比較する比較器42を備えており、プリセット・アップ
ダウンカウンタ41のカウント値がリミットパルス値を
オーバーフロー、あるいはアンダーフローした場合に、
図示しないスイッチをオフして、制御部10へのモータ
を駆動する指令を中断する。しかして、制御部10は、
位置制御手段40からの指令が中断されると、モータ1
が停止するようにモータ駆動部11を制御する。なお、
規定量だけ逆回転させてもよい。
Further, the position control means 40 compares the output value (count value) of the preset up / down counter 41 with the limit pulse value stored in the memory constituting the limit pulse value holding means 50 as the movable range setting means. A comparator 42 for comparison is provided, and when the count value of the preset up / down counter 41 overflows or underflows the limit pulse value,
A switch (not shown) is turned off, and a command to drive the motor to the control unit 10 is interrupted. Thus, the control unit 10
When the command from the position control means 40 is interrupted, the motor 1
The motor drive unit 11 is controlled so as to stop. In addition,
Reverse rotation may be performed by a specified amount.

【0030】つまり、位置制御手段40は、電流リプル
検出部20からのパルス信号たる電流リプルパルスが入
力されるようになっており、電流リプルパルスのパルス
数がリミットパルス値保持手段50に保持されているリ
ミットパルス値に達すると、制御部10へモータ1を停
止させるように指示するのである。
That is, the position control means 40 receives a current ripple pulse as a pulse signal from the current ripple detection unit 20, and the number of current ripple pulses is held in the limit pulse value holding means 50. When the limit pulse value is reached, the control unit 10 is instructed to stop the motor 1.

【0031】ところで、上記リミットパルス値は次のよ
うにして設定される。最初に電源が投入された時にモー
タ制御部が初期設定を行うために、可動体を往復移動さ
せてモータがロックしたときの判別手段30の出力に基
づいて可動体の停止位置を検出し、上記停止位置それぞ
れが検出された時の電流リプルパルスの各カウント値に
応じて、可動体の可動範囲両端それぞれのリミット位置
を設定するリミットパルス値をリミットパルス値保持手
段50へ記憶させる。なお、本実施形態では、判別手段
30が、初期設定を行うために可動体を往復移動させた
ときにパルス信号をカウントすることによりモータ1の
停止位置に対応するカウント値を検出する計数手段を兼
ねている。
The limit pulse value is set as follows. When the power is turned on for the first time, the motor control unit performs the initial setting, so that the movable body is reciprocated and the stop position of the movable body is detected based on the output of the determination unit 30 when the motor is locked. The limit pulse value for setting the limit positions at both ends of the movable range of the movable body is stored in the limit pulse value holding means 50 according to each count value of the current ripple pulse when each stop position is detected. In the present embodiment, the discriminating means 30 includes a counting means for detecting a count value corresponding to the stop position of the motor 1 by counting a pulse signal when the movable body is reciprocated for performing initial setting. Also serves as.

【0032】しかして、本実施形態では、最初に電源が
投入された時に可動体が往復移動され判別手段30の出
力に基づいて上記停止位置が検出されて可動範囲両端の
リミット位置に対応する各リミットパルス値が自動的に
記憶され、以後(初期設定終了後)はプリセット・アッ
プダウンカウンタ41の出力が上記リミットパルス値に
達した場合に位置制御手段40から制御部10へモータ
1を停止させるように指示されるから、リミットスイッ
チを設けることなしに、可動体の可動範囲を規制するこ
とができる。
In the present embodiment, when the power is first turned on, the movable body reciprocates and the stop position is detected based on the output of the discriminating means 30, and each of the movable positions corresponds to the limit position at both ends of the movable range. The limit pulse value is automatically stored, and thereafter (after completion of the initial setting), when the output of the preset up / down counter 41 reaches the limit pulse value, the position control means 40 causes the control unit 10 to stop the motor 1. Thus, the movable range of the movable body can be regulated without providing a limit switch.

【0033】(実施形態3)本実施形態の基本構成は実
施形態2と略同じであって、図5に示すように、位置制
御手段40の出力と可動範囲設定手段たる可動範囲パル
ス値保持手段60に保持された可動範囲パルス値とを比
較する可動範囲内比較手段70を備え、判別手段30
が、可動範囲内比較手段70により可動体が可動範囲内
にあると判定している状態でモータ1のロック状態を検
出したときにモータ1が過負荷状態にあると認識する点
に特徴がある。なお、実施形態2と同様の構成要素には
同一の符号を付して説明を省略する。
(Embodiment 3) The basic configuration of this embodiment is substantially the same as that of Embodiment 2, and as shown in FIG. 5, an output of the position control means 40 and a movable range pulse value holding means as a movable range setting means. A movable range comparing means for comparing the movable range pulse value held in the movable range;
However, it is characterized in that when the locked state of the motor 1 is detected while the movable body is determined to be within the movable range by the movable range comparison means 70, the motor 1 is recognized as being in an overload state. . Note that the same components as those in the second embodiment are denoted by the same reference numerals, and description thereof is omitted.

【0034】可動範囲内比較手段70は、図6に示すよ
うに比較器により構成され、位置制御手段40のプリセ
ット・アップダウンカウンタ41の出力値(カウント
値)と可動範囲パルス値保持手段60を構成するメモリ
に書き込まれた可動範囲パルス値とを比較して可動体が
可動範囲内にあるか否かを判別手段30に伝える。判別
手段30は、実施形態1で説明した周期カウンタ31、
A/D変換部32、論理ゲート33からなるロック検出
手段によるロック状態の判別結果と合わせて、可動範囲
内での障害物を検出する。すなわち、ロック検出手段に
よりモータ1のロック状態が検出され且つ可動範囲内比
較手段70により可動体が可動範囲内にあると認識され
た場合には、可動範囲内で障害物が挟まっているとみな
すようになっている。
The in-movable range comparing means 70 is constituted by a comparator as shown in FIG. 6, and outputs the output value (count value) of the preset up / down counter 41 of the position control means 40 and the movable range pulse value holding means 60. A comparison is made with a movable range pulse value written in a memory constituting the memory to inform the determination means 30 whether or not the movable body is within the movable range. The determination unit 30 includes the period counter 31 described in the first embodiment,
An obstacle within the movable range is detected together with the result of the determination of the lock state by the lock detection means including the A / D converter 32 and the logic gate 33. In other words, when the lock state of the motor 1 is detected by the lock detection unit and the movable unit is recognized as being within the movable range by the movable range comparison unit 70, it is determined that an obstacle is sandwiched within the movable range. It has become.

【0035】ところで、上記リミットパルス値は次のよ
うにして設定される。最初に電源が投入された時にモー
タ制御部が初期設定を行うために、可動体を往復移動さ
せてモータがロックしたときの判別手段30の出力に基
づいて可動体の停止位置を検出し、上記停止位置それぞ
れが検出された時の電流リプルパルスの各カウント値に
応じて、可動体の可動範囲両端それぞれのリミット位置
を設定するリミットパルス値をリミットパルス値保持手
段50へ記憶させる。なお、本実施形態では、判別手段
30が、初期設定を行うために可動体を往復移動させた
ときにパルス信号をカウントすることによりモータ1の
停止位置に対応するカウント値を検出する計数手段を兼
ねている。
The limit pulse value is set as follows. When the power is turned on for the first time, the motor control unit performs the initial setting, so that the movable body is reciprocated and the stop position of the movable body is detected based on the output of the determination unit 30 when the motor is locked. The limit pulse value for setting the limit positions at both ends of the movable range of the movable body is stored in the limit pulse value holding means 50 according to each count value of the current ripple pulse when each stop position is detected. In the present embodiment, the discriminating means 30 includes a counting means for detecting a count value corresponding to the stop position of the motor 1 by counting a pulse signal when the movable body is reciprocated for performing initial setting. Also serves as.

【0036】しかして、本実施形態では、最初に電源が
投入された時に可動体が往復移動され判別手段30の出
力に基づいて上記停止位置が検出されて可動範囲両端の
リミット位置に対応する各リミットパルス値が自動的に
記憶され、以後(初期設定終了後)は可動範囲内で判別
手段30からの指示が制御部10にあると、制御部10
は移動体の可動範囲内で手や指あるいは障害物が挟まれ
てモータが過負荷状態にあることを認識することができ
る。
In this embodiment, when the power is turned on for the first time, the movable body is reciprocated and the stop position is detected based on the output of the discriminating means 30, and each of the movable positions corresponds to the limit position at both ends of the movable range. The limit pulse value is automatically stored, and thereafter (after the end of the initial setting), if the control unit 10 receives an instruction from the determination unit 30 within the movable range, the control unit 10
Can recognize that the hand, finger or obstacle is sandwiched within the movable range of the moving body and the motor is overloaded.

【0037】(実施形態4)本実施形態の基本構成は実
施形態2と略同じであって、図7に示すように、上位シ
ステム(図示せず)からの上位指令を位置制御パルスに
変換して位置制御手段40へ伝える指令変換手段80を
付加した点に特徴がある。なお、実施形態2と同様の構
成要素には同一の符号を付して説明を省略する。
(Embodiment 4) The basic configuration of this embodiment is substantially the same as that of Embodiment 2, and as shown in FIG. 7, an upper command from an upper system (not shown) is converted into a position control pulse. This is characterized in that a command conversion means 80 for transmitting the command to the position control means 40 is added. Note that the same components as those in the second embodiment are denoted by the same reference numerals, and description thereof is omitted.

【0038】位置指令変換手段80は、図8に示すよう
に、上位指令を解釈(コマンドの意味を解析)する解釈
手段81と、解釈手段81の出力と可動範囲パルス値保
持手段60たるメモリに記憶されている可動範囲の位置
に対応したリプルパルス値とに基づいて所定の演算を行
い位置制御パルスを生成しプリセット・アップダウンカ
ウンタ41へのプリセットパルスとして出力する演算手
段82とで構成される。
As shown in FIG. 8, the position command conversion means 80 includes an interpretation means 81 for interpreting an upper command (analyzing the meaning of the command), and an output of the interpretation means 81 and a memory serving as a movable range pulse value holding means 60. A calculating means 82 performs a predetermined calculation based on the stored ripple pulse value corresponding to the position of the movable range, generates a position control pulse, and outputs it as a preset pulse to the preset up / down counter 41.

【0039】なお、演算手段82は、可動範囲パルス保
持手段60に記憶されたリプルパルス値との比例計算な
どによって、上位指令を位置制御パルスに変換するもの
である。
The calculating means 82 converts a higher-order command into a position control pulse by, for example, proportional calculation with the ripple pulse value stored in the movable range pulse holding means 60.

【0040】本実施形態では、最初に電源が投入された
時に初期設定を行うために可動体が往復移動されモータ
1がロックしたときの判別手段30の出力に基づいて可
動体の停止位置が検出されて可動範囲両端の停止位置に
対応する各カウント値が自動的に記憶される。ここにお
いて、上記2つの停止位置の一方におけるリプルパルス
のカウント値を原点のリプルパルス値として記憶する。
In this embodiment, the stop position of the movable body is detected based on the output of the determination means 30 when the movable body is reciprocated and the motor 1 is locked in order to perform the initial setting when the power is first turned on. Then, each count value corresponding to the stop position at both ends of the movable range is automatically stored. Here, the count value of the ripple pulse at one of the two stop positions is stored as the ripple pulse value at the origin.

【0041】ところで、上位システムは、位置指令を可
動範囲の「中央」とか、「原点側に近い1/3地点」な
どの人間の認識しやすいコマンド(物理的上位概念であ
るコマンド)として定義して出力する。これに対し、位
置指令変換手段80は、解釈手段81によりコマンドを
解釈し、演算手段82により位置指令に対応した位置の
リプルパルス値を求めプリセット・アップダウンカウン
タ41へのプリセットパルスとして出力する。
By the way, the host system defines the position command as a command easily recognized by humans (a command that is a physical host concept) such as "center" of the movable range or "one-third point near the origin". Output. On the other hand, the position command converting means 80 interprets the command by the interpreting means 81, obtains a ripple pulse value at a position corresponding to the position command by the calculating means 82, and outputs it as a preset pulse to the preset up / down counter 41.

【0042】しかして、本実施形態では、最初に電源が
投入された時に初期設定を行うために可動体が往復移動
されモータ1がロックしたときの判別手段30の出力に
基づいて上記停止位置が検出されて可動範囲両端の停止
位置に対応する各カウント値が自動的に記憶され、以後
(初期設定終了後)は位置制御手段40により上記停止
位置間の相対的な位置制御が行われるから、可動体の可
動範囲をあらかじめ知っておく必要がなく、可動体の可
動範囲が異なる場合にも対応することができる。
In the present embodiment, when the power is first turned on, the stop position is set based on the output of the determination means 30 when the movable body is reciprocated and the motor 1 is locked to perform the initial setting. The count values corresponding to the detected stop positions at both ends of the movable range are automatically stored, and thereafter (after the end of the initial setting), the relative position control between the stop positions is performed by the position control means 40. It is not necessary to know the movable range of the movable body in advance, and it is possible to cope with the case where the movable range of the movable body is different.

【0043】また、上位システムからの位置指令をパル
ス数によって与える代わりに、上述のコマンドで与える
ことができるので、モータにより駆動による機構におい
て、各機構の可動範囲をあらかじめ知っておく必要がな
く、さらに各機構の可動構成や範囲の異なる機構に対し
ても、上位システムは物理的上位概念で指示できるか
ら、各機構ごとの可動範囲の違いや機構の違いがあって
も、個別に指令するパルスを替えるなどの必要性を省く
ことができる。
Further, since the position command from the host system can be given by the above-mentioned command instead of giving by the number of pulses, it is not necessary to know in advance the movable range of each mechanism in the mechanism driven by the motor. In addition, the higher-level system can be instructed in terms of the physical upper concept even for mechanisms with different movable configurations and ranges of each mechanism. It is possible to eliminate the necessity of changing the data.

【0044】[0044]

【発明の効果】請求項1の発明は、直流モータに流れる
モータ電流を検出する電流検出手段と、モータ電流に含
まれる電流リプルを検出して直流モータの回転に同期し
たパルス信号を出力する電流リプル検出部と、電流リプ
ル検出部からのパルス信号に基づいて直流モータをサー
ボ制御するモータ制御部と、電流検出手段により検出し
た電流値の大きさが所定値よりも大きく且つパルス信号
が所定時間連続して検出されない場合にモータ制御部へ
モータを停止させるように指示する判別手段とを備える
ので、電流検出手段により検出した電流値の大きさが所
定値よりも大きく且つパルス信号が所定時間連続して検
出されない場合に判別手段からモータ制御部へモータを
停止させるように指示されるから、リミットスイッチを
設けることなしに、モータがロック状態になったり手や
指が挟み込まれた場合にモータが停止され安全性が高い
という効果がある。
According to the first aspect of the present invention, there is provided a current detecting means for detecting a motor current flowing through a DC motor, and a current for detecting a current ripple included in the motor current and outputting a pulse signal synchronized with the rotation of the DC motor. A ripple detection unit, a motor control unit that servo-controls the DC motor based on the pulse signal from the current ripple detection unit, and a magnitude of the current value detected by the current detection unit is larger than a predetermined value and the pulse signal is generated for a predetermined time. A determination unit that instructs the motor control unit to stop the motor when the detection is not performed continuously, so that the magnitude of the current value detected by the current detection unit is larger than a predetermined value and the pulse signal is continuously generated for a predetermined time. If it is not detected, the discriminating means instructs the motor control unit to stop the motor. Motor motor there is an effect that high safety is stopped when a hand or finger or in a locked state sandwiched.

【0045】請求項2の発明は、請求項1の発明におい
て、上記直流モータは、規定の2位置の間で可動体を往
復移動させ、モータ制御部には、初期設定を行うために
可動体を往復移動させたときにパルス信号をカウントす
ることによりモータの停止位置に対応するカウント値を
検出する計数手段と、計数手段により検出された上記停
止位置に対応する各カウント値に応じて可動体の可動範
囲両端それぞれのリミット位置を設定するリミットパル
ス値を記憶する可動範囲設定手段と、電流リプル検出部
からのパルス信号のカウント値が上記可動範囲設定手段
に記憶されたリミットパルス値に達した場合にモータ制
御部へモータを停止させるように指示する位置制御手段
とが付加されているので、初期設定時において計数手段
により検出された停止位置に対応する各カウント値に応
じて可動体の可動範囲両端それぞれのリミット位置を設
定するリミットパルス値が可動範囲設定手段へ自動的に
記憶され、初期設定終了後は電流リプルパルス検出部か
らのパルス信号のカウント値が上記リミットパルス値に
達した場合に位置制御手段からモータ制御部へモータを
停止させるように指示されるから、リミットスイッチを
設けることなしに、可動体の可動範囲を規制することが
可能となるという効果がある。
According to a second aspect of the present invention, in the first aspect of the present invention, the DC motor reciprocates the movable body between two specified positions, and the motor control unit includes a movable body for performing initial setting. Counting means for detecting a count value corresponding to the stop position of the motor by counting the pulse signal when reciprocating the movable member, and a movable body corresponding to each count value corresponding to the stop position detected by the count means. Movable range setting means for storing limit pulse values for setting respective limit positions of both ends of the movable range, and the count value of the pulse signal from the current ripple detecting section has reached the limit pulse value stored in the movable range setting means. In this case, the position control means for instructing the motor control unit to stop the motor is added. The limit pulse value for setting each limit position at both ends of the movable range of the movable body according to each count value corresponding to the stop position is automatically stored in the movable range setting means. When the count value of the pulse signal reaches the limit pulse value, the position control unit instructs the motor control unit to stop the motor, so that the movable range of the movable body is regulated without providing a limit switch. There is an effect that it becomes possible.

【0046】請求項3の発明は、請求項1の発明におい
て、上記直流モータは、規定の2位置の間で可動体を往
復移動させ、モータ制御部には、初期設定を行うために
可動体を往復移動させたときにパルス信号をカウントす
ることによりモータの停止位置に対応するカウント値を
検出する計数手段と、計数手段により検出された上記停
止位置に対応する各カウント値に応じて可動体の可動範
囲両端それぞれのリミット位置を設定するリミットパル
ス値を記憶する可動範囲設定手段とが付加され、可動範
囲設定手段に上記リミットパルス値が記憶された後は可
動範囲設定手段の記憶内容に基づいて可動体が可動範囲
にあるか否かを判定し可動範囲内にあるときに判別手段
からモータを停止させるように指示があると過負荷状態
であると認識するので、初期設定時において計数手段に
より検出された停止位置に対応する各カウント値に応じ
て可動体の可動範囲両端それぞれのリミット位置を設定
するリミットパルス値が可動範囲設定手段へ自動的に記
憶され、初期設定終了後は可動範囲内で判別手段からモ
ータを停止させる指示がモータ制御部にあると、モータ
制御部は可動体の可動範囲内で手や指あるいは障害物が
挟まれてモータが過負荷状態にあることを認識すること
ができるという効果がある。
According to a third aspect of the present invention, in the first aspect of the present invention, the DC motor reciprocates the movable body between two prescribed positions, and the motor control unit includes a movable body for performing initial setting. Counting means for detecting a count value corresponding to the stop position of the motor by counting the pulse signal when reciprocating the movable member, and a movable body corresponding to each count value corresponding to the stop position detected by the count means. And a movable range setting means for storing limit pulse values for setting respective limit positions of both ends of the movable range. After the limit pulse value is stored in the movable range setting means, based on the stored contents of the movable range setting means. To determine whether or not the movable body is in the movable range. If the movable body is within the movable range, an instruction to stop the motor is given by the determination means, and the overload state is recognized. At the time of the initial setting, the limit pulse value for setting the respective limit positions at both ends of the movable range of the movable body in accordance with each count value corresponding to the stop position detected by the counting means is automatically stored in the movable range setting means. However, after the initialization, if the motor control unit issues an instruction to stop the motor within the movable range from the determination unit, the motor control unit may cause a hand, finger, or obstacle to be caught in the movable range of the movable body, causing the motor to overrun. There is an effect that it is possible to recognize that the vehicle is in the load state.

【0047】請求項4の発明は、請求項1の発明におい
て、上記直流モータは、規定の2位置の間で可動体を往
復移動させ、モータ制御部には、初期設定を行うために
可動体を往復移動させたときにパルス信号をカウントす
ることによりモータの停止位置に対応するカウント値を
検出する計数手段と、計数手段により検出された上記停
止位置に対応する各カウント値に応じて可動体の可動範
囲両端それぞれの停止位置を記憶する可動範囲設定手段
と、可動範囲設定手段に上記カウント値が記憶された後
に上記2位置間の相対的な位置制御を行う位置制御手段
とが付加されているので、初期設定時において計数手段
により検出された停止位置に対応する各カウント値に応
じて可動体の可動範囲両端それぞれの停止位置が可動範
囲設定手段へ自動的に記憶され、初期設定終了後は位置
制御手段により上記停止位置間の相対的な位置制御が行
われるから、可動体の可動範囲をあらかじめ知っておく
必要がなく、可動体の可動範囲が異なる場合にも対応す
ることができるという効果がある。
According to a fourth aspect of the present invention, in the first aspect of the present invention, the DC motor reciprocates the movable body between two prescribed positions, and the motor control unit includes a movable body for performing initial setting. Counting means for detecting a count value corresponding to the stop position of the motor by counting the pulse signal when reciprocating the movable member, and a movable body corresponding to each count value corresponding to the stop position detected by the count means. Movable range setting means for storing stop positions at both ends of the movable range, and position control means for performing relative position control between the two positions after the count value is stored in the movable range setting means. Therefore, the stop positions at both ends of the movable range of the movable body are automatically transmitted to the movable range setting means in accordance with each count value corresponding to the stop position detected by the counting means at the time of the initial setting. Since the relative position control between the stop positions is performed by the position control means after the initial setting is completed, it is not necessary to know the movable range of the movable body in advance, and when the movable range of the movable body is different. There is an effect that it can respond to.

【図面の簡単な説明】[Brief description of the drawings]

【図1】実施形態1を示す概略回路ブロック図である。FIG. 1 is a schematic circuit block diagram illustrating a first embodiment.

【図2】同上の回路図である。FIG. 2 is a circuit diagram of the same.

【図3】実施形態2を示す概略回路ブロック図である。FIG. 3 is a schematic circuit block diagram showing a second embodiment.

【図4】同上の回路図である。FIG. 4 is a circuit diagram of the same.

【図5】実施形態3を示す概略回路ブロック図である。FIG. 5 is a schematic circuit block diagram showing a third embodiment.

【図6】同上の回路図である。FIG. 6 is a circuit diagram of the same.

【図7】実施形態4を示す概略回路ブロック図である。FIG. 7 is a schematic circuit block diagram showing a fourth embodiment.

【図8】同上の回路図である。FIG. 8 is a circuit diagram of the same.

【図9】従来例を示す概略回路ブロック図である。FIG. 9 is a schematic circuit block diagram showing a conventional example.

【図10】同上の動作説明図である。FIG. 10 is an operation explanatory view of the above.

【符号の説明】[Explanation of symbols]

1 モータ 10 制御部 11 モータ駆動部 20 電流リプル検出部 21 アンプ 30 判別手段 R 抵抗 Reference Signs List 1 motor 10 control unit 11 motor drive unit 20 current ripple detection unit 21 amplifier 30 determination means R resistance

───────────────────────────────────────────────────── フロントページの続き Fターム(参考) 5H530 AA12 BB40 CC14 CC20 CC22 CC23 CD03 CD10 CD19 CD21 CD33 CD36 CE30 CF03 DD05 EF01 5H571 AA20 BB05 BB07 BB10 EE02 EE09 FF06 FF07 FF09 GG01 GG02 GG04 GG07 HA01 HA04 HA08 JJ02 JJ13 JJ16 JJ18 JJ23 KK06 LL14 LL22 LL31 MM04  ──────────────────────────────────────────────────続 き Continued on the front page F-term (reference) JJ23 KK06 LL14 LL22 LL31 MM04

Claims (4)

【特許請求の範囲】[Claims] 【請求項1】 直流モータに流れるモータ電流を検出す
る電流検出手段と、モータ電流に含まれる電流リプルを
検出して直流モータの回転に同期したパルス信号を出力
する電流リプル検出部と、電流リプル検出部からのパル
ス信号に基づいて直流モータをサーボ制御するモータ制
御部と、電流検出手段により検出した電流値の大きさが
所定値よりも大きく且つパルス信号が所定時間連続して
検出されない場合にモータ制御部へモータを停止させる
ように指示する判別手段とを備えることを特徴とする電
流リプル検出によるサーボ制御装置。
A current detecting means for detecting a motor current flowing in the DC motor; a current ripple detecting section for detecting a current ripple included in the motor current and outputting a pulse signal synchronized with the rotation of the DC motor; A motor control unit that servo-controls the DC motor based on a pulse signal from the detection unit; and a control unit that controls when the magnitude of the current value detected by the current detection unit is larger than a predetermined value and the pulse signal is not continuously detected for a predetermined time. A determination unit that instructs the motor control unit to stop the motor.
【請求項2】 上記直流モータは、規定の2位置の間で
可動体を往復移動させ、モータ制御部には、初期設定を
行うために可動体を往復移動させたときにパルス信号を
カウントすることによりモータの停止位置に対応するカ
ウント値を検出する計数手段と、計数手段により検出さ
れた上記停止位置に対応する各カウント値に応じて可動
体の可動範囲両端それぞれのリミット位置を設定するリ
ミットパルス値を記憶する可動範囲設定手段と、電流リ
プル検出部からのパルス信号のカウント値が上記可動範
囲設定手段に記憶されたリミットパルス値に達した場合
にモータ制御部へモータを停止させるように指示する位
置制御手段とが付加されていることを特徴とする請求項
1記載の電流リプル検出によるサーボ制御装置。
2. The DC motor reciprocates a movable body between two prescribed positions, and a motor control unit counts a pulse signal when the movable body reciprocates for initial setting. Counting means for detecting a count value corresponding to the stop position of the motor, and a limit for setting limit positions at both ends of the movable range of the movable body in accordance with each count value corresponding to the stop position detected by the counting means. A movable range setting means for storing a pulse value, and a motor control section for stopping a motor when a count value of a pulse signal from the current ripple detecting section reaches a limit pulse value stored in the movable range setting means. 2. The servo control device according to claim 1, further comprising a position control means for indicating.
【請求項3】 上記直流モータは、規定の2位置の間で
可動体を往復移動させ、モータ制御部には、初期設定を
行うために可動体を往復移動させたときにパルス信号を
カウントすることによりモータの停止位置に対応するカ
ウント値を検出する計数手段と、計数手段により検出さ
れた上記停止位置に対応する各カウント値に応じて可動
体の可動範囲両端それぞれのリミット位置を設定するリ
ミットパルス値を記憶する可動範囲設定手段とが付加さ
れ、可動範囲設定手段に上記リミットパルス値が記憶さ
れた後は可動範囲設定手段の記憶内容に基づいて可動体
が可動範囲にあるか否かを判定し可動範囲内にあるとき
に判別手段からモータを停止させるように指示があると
過負荷状態であると認識することを特徴とする請求項1
記載の電流リプル検出によるサーボ制御装置。
3. The DC motor causes the movable body to reciprocate between two specified positions, and the motor control unit counts a pulse signal when the movable body is reciprocated for initial setting. Counting means for detecting a count value corresponding to the stop position of the motor, and a limit for setting limit positions at both ends of the movable range of the movable body in accordance with each count value corresponding to the stop position detected by the counting means. A movable range setting means for storing a pulse value is added, and after the limit pulse value is stored in the movable range setting means, it is determined whether or not the movable body is in the movable range based on the stored contents of the movable range setting means. 2. The system according to claim 1, wherein when it is determined that the motor is within the movable range, an instruction to stop the motor is issued from the determining means to recognize that the motor is overloaded.
A servo controller based on current ripple detection as described.
【請求項4】 上記直流モータは、規定の2位置の間で
可動体を往復移動させ、モータ制御部には、初期設定を
行うために可動体を往復移動させたときにパルス信号を
カウントすることによりモータの停止位置に対応するカ
ウント値を検出する計数手段と、計数手段により検出さ
れた上記停止位置に対応する各カウント値に応じて可動
体の可動範囲両端それぞれの停止位置を記憶する可動範
囲設定手段と、可動範囲設定手段に上記カウント値が記
憶された後に上記2位置間の相対的な位置制御を行う位
置制御手段とが付加されていることを特徴とする請求項
1記載の電流リプル検出によるサーボ制御装置。
4. The DC motor causes a movable body to reciprocate between two prescribed positions, and a motor control unit counts a pulse signal when the movable body is reciprocated for initial setting. Counting means for detecting a count value corresponding to the stop position of the motor, and movable means for storing stop positions at both ends of the movable range of the movable body in accordance with each count value corresponding to the stop position detected by the count means. 2. The current according to claim 1, further comprising a range setting means and a position control means for performing relative position control between the two positions after the count value is stored in the movable range setting means. Servo control device by ripple detection.
JP10338153A 1998-11-27 1998-11-27 Servo control device by detecting current ripple Withdrawn JP2000166275A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP10338153A JP2000166275A (en) 1998-11-27 1998-11-27 Servo control device by detecting current ripple

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP10338153A JP2000166275A (en) 1998-11-27 1998-11-27 Servo control device by detecting current ripple

Publications (1)

Publication Number Publication Date
JP2000166275A true JP2000166275A (en) 2000-06-16

Family

ID=18315421

Family Applications (1)

Application Number Title Priority Date Filing Date
JP10338153A Withdrawn JP2000166275A (en) 1998-11-27 1998-11-27 Servo control device by detecting current ripple

Country Status (1)

Country Link
JP (1) JP2000166275A (en)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007124873A (en) * 2005-10-31 2007-05-17 Sato Corp Motor drive unit
JP2009291011A (en) * 2008-05-29 2009-12-10 Aisin Seiki Co Ltd State storage controller
JP2010033515A (en) * 2008-07-31 2010-02-12 Aisin Seiki Co Ltd Position control device
JP2010033514A (en) * 2008-07-31 2010-02-12 Aisin Seiki Co Ltd Position control device
JP2010033513A (en) * 2008-07-31 2010-02-12 Aisin Seiki Co Ltd Position control device
JP2014064424A (en) * 2012-09-24 2014-04-10 Omron Automotive Electronics Co Ltd Dc motor controller
US9425724B2 (en) 2013-12-17 2016-08-23 Denso Corporation Motor abnormality detection apparatus
JP2017147790A (en) * 2016-02-15 2017-08-24 オムロン株式会社 Drive device controller
WO2017141549A1 (en) * 2016-02-15 2017-08-24 オムロン株式会社 Driving-device control apparatus and game machine

Cited By (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007124873A (en) * 2005-10-31 2007-05-17 Sato Corp Motor drive unit
JP2009291011A (en) * 2008-05-29 2009-12-10 Aisin Seiki Co Ltd State storage controller
JP2010033515A (en) * 2008-07-31 2010-02-12 Aisin Seiki Co Ltd Position control device
JP2010033514A (en) * 2008-07-31 2010-02-12 Aisin Seiki Co Ltd Position control device
JP2010033513A (en) * 2008-07-31 2010-02-12 Aisin Seiki Co Ltd Position control device
JP2014064424A (en) * 2012-09-24 2014-04-10 Omron Automotive Electronics Co Ltd Dc motor controller
US9425724B2 (en) 2013-12-17 2016-08-23 Denso Corporation Motor abnormality detection apparatus
JP2017147790A (en) * 2016-02-15 2017-08-24 オムロン株式会社 Drive device controller
WO2017141549A1 (en) * 2016-02-15 2017-08-24 オムロン株式会社 Driving-device control apparatus and game machine
US10614654B2 (en) 2016-02-15 2020-04-07 Omron Corporation Driving-device control apparatus for driving moving body back and forth and game machine including driving-device control apparatus

Similar Documents

Publication Publication Date Title
US7038421B2 (en) Method and system for multiple servo motor control
EP1772954A2 (en) Position detection and external driver multiplexing system for DC motors
JP2000166275A (en) Servo control device by detecting current ripple
JPH08182366A (en) Drive controller for servo motor
EP1772956A2 (en) Oscillator with voltage-dependent frequency for rotor position detection
EP1772957A2 (en) Method of brake pulse rejection in commutation pulse detection circuits
JP4086102B2 (en) Stepping motor control device
CN112350624B (en) Motor driving system and method
JPH0431808A (en) Zoom lens controller
CA2104980A1 (en) Motor drive circuit
JP2002223584A (en) Controller for dc motor
JPH08157168A (en) Door control device of elevator
JP3408956B2 (en) Drive control device for servo motor
JP2005151780A (en) Synchronous rectification control circuit, low-voltage motor drive circuit, and synchronous rectification control method
JPH06105589A (en) Drive controller for dc brushless motor
JPH04310396A (en) Robot control device
KR200167708Y1 (en) Motor drive apparatus with interfacing circuit
JPH05333933A (en) Drive controller for stepping motor
JPH02106592A (en) Door control device for elevator
JP6943542B2 (en) Step-out detector for multi-phase pulse motor
KR19990030355U (en) Hybrid current controller of motor
JP2000175497A (en) Device and method for controlling pulse motor and recording medium with pulse motor control program recorded therein
JPH07163043A (en) Motor controller
JP2003061376A (en) Motor control apparatus
JP2006146377A (en) Programmable controller

Legal Events

Date Code Title Description
A300 Withdrawal of application because of no request for examination

Free format text: JAPANESE INTERMEDIATE CODE: A300

Effective date: 20060207