JPH08237983A - Drive circuit - Google Patents
Drive circuitInfo
- Publication number
- JPH08237983A JPH08237983A JP7035647A JP3564795A JPH08237983A JP H08237983 A JPH08237983 A JP H08237983A JP 7035647 A JP7035647 A JP 7035647A JP 3564795 A JP3564795 A JP 3564795A JP H08237983 A JPH08237983 A JP H08237983A
- Authority
- JP
- Japan
- Prior art keywords
- circuit
- speed
- data
- servo motor
- detection
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000001514 detection method Methods 0.000 claims abstract description 85
- 230000002159 abnormal effect Effects 0.000 claims abstract description 49
- 230000005856 abnormality Effects 0.000 claims description 7
- 230000003111 delayed effect Effects 0.000 claims description 5
- 230000001934 delay Effects 0.000 claims description 2
- 230000001681 protective effect Effects 0.000 abstract 1
- 101100013419 Neurospora crassa (strain ATCC 24698 / 74-OR23-1A / CBS 708.71 / DSM 1257 / FGSC 987) fpp gene Proteins 0.000 description 12
- 230000001133 acceleration Effects 0.000 description 8
- 238000006243 chemical reaction Methods 0.000 description 6
- 238000000034 method Methods 0.000 description 4
- 230000007423 decrease Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 239000003990 capacitor Substances 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000003708 edge detection Methods 0.000 description 1
- 230000000630 rising effect Effects 0.000 description 1
Landscapes
- Control Of Direct Current Motors (AREA)
Abstract
Description
【0001】[0001]
【産業上の利用分野】本発明は駆動回路に関し、更に詳
しく言えば、プリンタや複写機などに用いられるサーボ
モーターをディジタル制御する駆動回路の改善を目的と
する。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a drive circuit, and more specifically, it is an object of the present invention to improve a drive circuit for digitally controlling a servo motor used in a printer or a copying machine.
【0002】[0002]
【従来の技術】以下で、従来例に係る駆動回路について
図面を参照しながら説明する。この回路は、図3に示す
ようにCPU[Central Processing Unit :中央演算処
理装置](1),偏差カウンタ(2),アップダウンカ
ウンタ[以下U/Dカウンタと称する](3),ディジ
タル/アナログ変換器[以下D/A変換器と称する]
(4),モータ制御部(5),コンパレータ(6),波
形逓倍回路(7)及びエンコーダ(E)を有し、プリン
タや複写機などに用いられるDCサーボモータ(M)を
駆動する回路であって、DCサーボモータ(M)の実際
の回転速度が予め設定された目標速度に追従するように
DCサーボモータ(M)を制御する回路である。2. Description of the Related Art A drive circuit according to a conventional example will be described below with reference to the drawings. As shown in FIG. 3, this circuit includes a CPU [Central Processing Unit] (1), a deviation counter (2), an up / down counter [hereinafter referred to as a U / D counter] (3), a digital / analog. Converter [hereinafter referred to as D / A converter]
(4) A circuit for driving a DC servo motor (M) used in a printer, a copying machine or the like, which has a motor control section (5), a comparator (6), a waveform multiplication circuit (7) and an encoder (E). It is a circuit that controls the DC servo motor (M) so that the actual rotation speed of the DC servo motor (M) follows a preset target speed.
【0003】当該回路によれば、まずCPU(1)に動
作命令が入力され、この動作命令に基づいてCPU
(1)から、駆動クロック(fpps )が偏差カウンタ
(2)に入力される。この駆動クロック(fpps )の周
波数が、駆動対象であるDCサーボモータ(M)の目標
速度を示しており、目標速度が高速な場合には駆動クロ
ック(fpps )の周波数が高くなる。According to this circuit, an operation command is first input to the CPU (1), and the CPU is based on this operation command.
From (1), the drive clock (fpps) is input to the deviation counter (2). The frequency of the drive clock (fpps) indicates the target speed of the DC servo motor (M) to be driven. When the target speed is high, the frequency of the drive clock (fpps) becomes high.
【0004】すると、偏差カウンタ(2)によって駆動
クロック(fpps )と波形逓倍回路(7)の出力である
状態信号(JS)とが比較処理され、駆動クロック(f
pps)が状態信号(JS)よりも大きい場合にはモータ
の加速を指示する加速信号(+)がU/Dカウンタ
(3)に出力され、逆に駆動クロック(fpps )が状態
信号(JS)よりも小さい場合にはモータの減速を指示
する減速信号(−)がU/Dカウンタ(3)に出力され
る。Then, the deviation counter (2) compares the drive clock (fpps) with the status signal (JS) which is the output of the waveform multiplication circuit (7), and the drive clock (f
If the pps) is larger than the status signal (JS), the acceleration signal (+) that instructs the acceleration of the motor is output to the U / D counter (3), and conversely the drive clock (fpps) is the status signal (JS) If it is smaller than this, a deceleration signal (-) instructing deceleration of the motor is output to the U / D counter (3).
【0005】当該回路の起動直後はDCサーボモータ
(M)の回転数は0なので、偏差カウンタ(2)の出力
信号は加速信号(+)になる。次いで、U/Dカウンタ
(3)によって偏差カウンタ(2)の出力信号がアップ
カウントされてそのカウント結果がD/A変換器(4)
に入力され、このカウント結果がD/A変換されてアナ
ログ信号(AD)がモータ制御部(5)に出力される。Immediately after the circuit is started, the number of revolutions of the DC servo motor (M) is 0, so the output signal of the deviation counter (2) becomes the acceleration signal (+). Next, the output signal of the deviation counter (2) is up-counted by the U / D counter (3), and the count result is D / A converter (4).
Is input to the motor control section (5), and the count result is D / A converted and an analog signal (AD) is output to the motor control section (5).
【0006】このアナログ信号(AD)に応じてモータ
制御部(5)から、サーボモータ(M)に接続され、ブ
リッジ回路を構成するスイッチングトランジスタ(S1
〜S4)に信号が出力され、スイッチングトランジスタ
(S1〜S4)がON/OFFすることで電流がDCサ
ーボモータ(M)に供給されてこれが回転する。このD
Cサーボモータ(M)の回転速度は随時ロータリエンコ
ーダ(E)によって検出されており、その検出結果が検
出クロック(KC)として波形逓倍回路(7)に入力さ
れ、波形逓倍回路(7)によって検出クロック(KC)
が整数倍されて駆動クロック(fpps )と同じ形式のシ
リアル信号である状態信号(JS)が生成され、偏差カ
ウンタ(2)に入力される。A switching transistor (S1) which is connected to the servomotor (M) from the motor control section (5) and constitutes a bridge circuit according to the analog signal (AD) is formed.
To S4), the switching transistors (S1 to S4) are turned on / off to supply a current to the DC servo motor (M), which rotates. This D
The rotation speed of the C servo motor (M) is detected by the rotary encoder (E) at any time, and the detection result is input to the waveform multiplication circuit (7) as a detection clock (KC) and detected by the waveform multiplication circuit (7). Clock (KC)
Is multiplied by an integer to generate a status signal (JS) which is a serial signal of the same format as the driving clock (fpps) and is input to the deviation counter (2).
【0007】すると、再び偏差カウンタ(2)によって
駆動クロック(fpps )と状態信号(JS)とが比較処
理され、駆動クロック(fpps )が状態信号(JS)よ
りも大きい場合には加速信号(+)がU/Dカウンタ
(3)に出力され、サーボモータ(M)は加速される。
このようにして、サーボモータ(M)の実際の回転速度
が目標速度に達するまで、言い換えると状態信号(J
S)が駆動クロック(fpps )に達するまでサーボモー
タ(M)は加速される。Then, the deviation counter (2) again compares the driving clock (fpps) with the status signal (JS), and when the driving clock (fpps) is larger than the status signal (JS), the acceleration signal (+ ) Is output to the U / D counter (3), and the servomotor (M) is accelerated.
In this way, until the actual rotation speed of the servo motor (M) reaches the target speed, in other words, the status signal (J
The servomotor (M) is accelerated until (S) reaches the drive clock (fpps).
【0008】やがて状態信号(JS)が駆動クロック
(fpps )に達すると、偏差カウンタ(2)からは加速
信号(+)も減速信号(−)も全く出力されない状態に
なるのでU/Dカウンタ(3)の出力は0になり、当然
D/A変換器(4)からのアナログ信号(AD)も出力
されないのでサーボモータ(M)への電流供給が停止し
て加速動作は停止し、サーボモータ(M)は惰性で回転
を続け、一定時間目標速度で定速回転する。When the status signal (JS) reaches the driving clock (fpps), the deviation counter (2) outputs neither the acceleration signal (+) nor the deceleration signal (-) at all, so that the U / D counter ( The output of 3) becomes 0, and naturally the analog signal (AD) from the D / A converter (4) is not output either, so the current supply to the servo motor (M) is stopped and the acceleration operation is stopped. (M) continues to rotate by inertia and rotates at a constant speed at a target speed for a certain period of time.
【0009】その後、惰性で回転していたサーボモータ
(M)は摩擦などによって回転速度が低下するので、再
び目標速度を下回り、状態信号(JS)が駆動クロック
(fpps )を下回る。すると再び偏差カウンタ(2)か
ら加速信号(+)が出力されるので、再びサーボモータ
(M)は目標速度に達成するまで加速される。上記の動
作を繰り返すことで、このサーボモータ(M)は、駆動
クロック(fpps )によって予め設定された目標速度に
追従するように動作する。After that, since the rotation speed of the servo motor (M) which has been rotating by inertia decreases due to friction or the like, it falls below the target speed again, and the status signal (JS) falls below the drive clock (fpps). Then, since the acceleration signal (+) is output again from the deviation counter (2), the servo motor (M) is accelerated again until the target speed is reached. By repeating the above operation, the servo motor (M) operates so as to follow the target speed preset by the drive clock (fpps).
【0010】なお、上記回路にはサーボモータ(M)に
流れる電流(Is)を常時検出し、所定の許容量を超え
た過電流が流れたときには当該回路の動作を停止させる
過電流保護回路(PC)が設けられている。サーボモー
タ(M)に流れる電流(Is)は電圧変換され、フィル
タ回路(FC)によってノイズが除去されたのちに、抵
抗(R1)と電解コンデンサ(C1)から構成される遅
延回路(CC)によって遅延されてコンパレータ(6)
の非反転入力(+)に入力される。The current (Is) flowing in the servo motor (M) is constantly detected in the circuit, and an overcurrent protection circuit (stops the operation of the circuit when an overcurrent exceeding a predetermined allowable amount flows) ( PC) is provided. The current (Is) flowing in the servo motor (M) is converted into a voltage, and after noise is removed by the filter circuit (FC), it is converted by the delay circuit (CC) including the resistor (R1) and the electrolytic capacitor (C1). Delayed comparator (6)
Is input to the non-inverting input (+) of.
【0011】一方コンパレータ(6)の反転入力(−)
には、抵抗(R2,R3)のブリーダー比で決定される
基準電圧(Vref )が入力されている。何らかの原因で
サーボモータ(M)に過電流が流れて、コンパレータ
(6)の非反転入力(+)の電位がこの基準電圧(Vre
f )を上回るとコンパレータ(6)の出力がハイレベル
(以下でこれを“H”と称する)となり、これがCPU
(1)に出力されることで過電流が流れたことが検出さ
れ、当該回路の動作が停止する。On the other hand, the inverting input (-) of the comparator (6)
A reference voltage (Vref) determined by the bleeder ratio of the resistors (R2, R3) is input to the. For some reason, an overcurrent flows in the servo motor (M), and the potential of the non-inverting input (+) of the comparator (6) becomes the reference voltage (Vre
When it exceeds f), the output of the comparator (6) becomes high level (hereinafter referred to as “H”), which is the CPU.
The output to (1) detects that an overcurrent has flowed, and the operation of the circuit is stopped.
【0012】過電流が流れて異常が発生したとされる時
間(この時間を過電流通電時間と称する)は、遅延回路
(CC)を構成する抵抗(R1)と電解コンデンサ(C
1)の時定数によって設定されている。The time when it is considered that an abnormality has occurred due to the flow of an overcurrent (this time is referred to as the overcurrent conduction time) is the resistance (R1) and the electrolytic capacitor (C) that constitute the delay circuit (CC).
It is set by the time constant of 1).
【0013】[0013]
【発明が解決しようとする課題】しかしながら、図3に
示すような上記従来の駆動回路によると、モータを起動
してから目標速度に達するはずの時間(以下でこれを起
動時間と称する)を経過した後に、モータ(M)の内部
に異物が混入したり、モータ(M)の回転軸に異物がひ
っかかったりしてモータ(M)の回転が妨害され、図4
に示すようにその回転速度が目標速度に比して低くなり
(以下でこの状態を異常回転と称する)、ひどいときに
はモータ(M)が完全に停止してしまうといった事態が
生じることが有る。However, according to the above-mentioned conventional drive circuit as shown in FIG. 3, the time (hereinafter referred to as the start time) at which the target speed should be reached after the motor is started elapses. After that, foreign matter is mixed into the motor (M) or foreign matter is caught on the rotating shaft of the motor (M), which hinders the rotation of the motor (M).
As shown in, the rotation speed becomes lower than the target speed (hereinafter, this state is referred to as abnormal rotation), and in severe cases, the motor (M) may stop completely.
【0014】異常回転によってモータ(M)が完全に停
止してしまった場合には、モータ(M)に過電流が流れ
るので上記回路に設けられている過電流保護回路(P
C)でモータ(M)の駆動を停止させることができる
が、この時間検出精度は低かった。また異常回転が生じ
てもなお過電流が検出されないような場合には、モータ
やドライバの定格を超えた電流が常時流れることにな
り、そのまま放置するとモータが焼損したり、ドライバ
が破壊するなどの問題が生じていた。When the motor (M) is completely stopped due to abnormal rotation, an overcurrent flows through the motor (M), so that an overcurrent protection circuit (P) provided in the above circuit is provided.
Although the drive of the motor (M) can be stopped by C), the time detection accuracy was low. If an overcurrent is still not detected even if abnormal rotation occurs, a current exceeding the motor or driver rating will always flow, and if left unattended, the motor will burn out or the driver will be damaged. There was a problem.
【0015】[0015]
【課題を解決するための手段】本発明は上記従来の欠点
に鑑みて成されたもので、図1に示すように、サーボモ
ータの実際の回転速度を検出して、その検出結果を示す
ディジタルデータである速度検出データを生成する速度
検出部と、前記サーボモータの目標回転速度を示すディ
ジタルデータである目標速度データと、前記速度検出デ
ータとを比較し、該比較結果に基づいて前記サーボモー
タの実際の回転速度が前記目標回転速度に追従するよう
に前記サーボモータをディジタル制御する駆動制御部
と、前記速度検出データと前記目標速度データとの差が
一定値を超えて異常が生じたときに前記サーボモータの
駆動を停止させる異常回転保護回路を有することによ
り、モータの異常回転を確実に検出し、異常回転による
モータなどの損壊を極力抑止することが可能になる駆動
回路の提供を目的とするものである。The present invention has been made in view of the above-mentioned drawbacks of the prior art. As shown in FIG. 1, a digital signal indicating the detection result of the actual rotation speed of the servomotor is detected. The speed detection unit that generates speed detection data that is data, the target speed data that is digital data indicating the target rotation speed of the servo motor, and the speed detection data are compared, and the servo motor is based on the comparison result. When the difference between the speed detection data and the target speed data exceeds a certain value and an abnormality occurs, the drive control unit digitally controls the servo motor so that the actual rotation speed of the device follows the target rotation speed. The abnormal rotation protection circuit that stops the drive of the servo motor is reliably provided to detect the abnormal rotation of the motor and to prevent damage to the motor due to the abnormal rotation. It is an object to provide a drive circuit which makes it possible to suppress.
【0016】[0016]
【作 用】本発明によれば、図1に示すように、サーボ
モータの実際の回転速度を検出して、その検出結果を示
すディジタルデータである速度検出データを生成する速
度検出部と、サーボモータの目標回転速度を示すディジ
タルデータである目標速度データと、速度検出データと
を比較し、その比較結果に基づいてサーボモータの実際
の回転速度が目標回転速度に追従するようにサーボモー
タをディジタル制御する駆動制御部と、速度検出データ
と目標速度データとの差が一定値を超えて異常が生じた
ときにサーボモータの駆動を停止させる異常回転保護回
路を有する。[Operation] According to the present invention, as shown in FIG. 1, a speed detection unit that detects the actual rotation speed of the servo motor and generates speed detection data that is digital data indicating the detection result; The target speed data, which is the digital data indicating the target rotation speed of the motor, is compared with the speed detection data, and the servo motor is digitally adjusted so that the actual rotation speed of the servo motor follows the target rotation speed based on the comparison result. It has a drive control unit for controlling, and an abnormal rotation protection circuit for stopping the drive of the servo motor when the difference between the speed detection data and the target speed data exceeds a certain value and an abnormality occurs.
【0017】このため、異常回転保護回路によって速度
検出データと目標速度データとの差を常時算出し、これ
が一定値を超えて異常回転が生じた場合にサーボモータ
の駆動を停止させているので、過電流を検出するという
検出精度の低い方法によってモータの異常回転を検出し
ていた従来に比して、異常回転を確実に検出することが
可能となる。Therefore, since the difference between the speed detection data and the target speed data is constantly calculated by the abnormal rotation protection circuit, and the servo motor is stopped when the rotation exceeds the predetermined value and abnormal rotation occurs, The abnormal rotation can be detected more reliably than in the conventional case where the abnormal rotation of the motor is detected by a method with low detection accuracy of detecting overcurrent.
【0018】これにより、従来のように異常回転を確実
に検出できず、これを放置することによってモータなど
の焼損が生じることを極力抑止することが可能となる。This makes it possible to prevent abnormal rotation from being reliably detected as in the conventional case, and to prevent burning of a motor or the like if left unattended.
【0019】[0019]
【実施例】以下で本発明の実施例に係る駆動回路につい
て図面を参照しながら説明する。本実施例に係る駆動回
路は、プリンタや複写機などのOA機器に用いられるD
Cサーボモータを駆動制御するための駆動回路である。
この駆動回路は、図1に示すように、駆動制御部(2
0),速度検出部(21),異常回転保護回路(22)
及び過電流保護回路(30)を有し、予め設定された回
転目標状態に追従するようにサーボモータ(M)を駆動
する回路である。DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENT A drive circuit according to an embodiment of the present invention will be described below with reference to the drawings. The drive circuit according to the present embodiment is used in an OA device such as a printer or a copying machine.
It is a drive circuit for driving and controlling the C servo motor.
This drive circuit, as shown in FIG.
0), speed detector (21), abnormal rotation protection circuit (22)
And a circuit for driving the servo motor (M) so as to follow a preset target rotation state, which has an overcurrent protection circuit (30).
【0020】駆動制御部(20)はラッチ回路(11
A,11B),コンパレータ(12),アップダウンパ
ルス発生回路(13),アップダウンカウンタ(1
4),PWM(Pulse Width Modulation:パルス幅変
調)回路(15),プリドライバ(16)及びスイッチ
ングトランジスタ(S11〜S14)を有し、目標速度
データ(DD)と検出速度データ(KD)を比較して検
出速度データ(KD)が目標速度データ(DD)に追従
するようにサーボモータ(M)を制御する回路である。The drive control section (20) includes a latch circuit (11
A, 11B), comparator (12), up-down pulse generation circuit (13), up-down counter (1
4), having a PWM (Pulse Width Modulation) circuit (15), a pre-driver (16) and switching transistors (S11-S14), comparing target speed data (DD) and detected speed data (KD) Then, the servo motor (M) is controlled so that the detected speed data (KD) follows the target speed data (DD).
【0021】速度検出部(21)はロータリエンコーダ
(E),逓倍回路(17)及びシリアル/パラレル変換
回路(18)を有し、ロータリエンコーダ(E)が検出
するサーボモータ(M)の回転速度を検出して、検出速
度データ(KD)を生成する回路である。異常回転保護
回路(22)は、ロック検出回路(23),遅延回路
(24),保護回路(25),クロック生成回路(2
6)及び時定数回路(27)を有する回路であって、目
標速度データ(DD)と検出速度データ(KD)との差
を算出し、この差が一定値を超えて異常回転が生じたと
きにサーボモータ(M)の駆動を強制的に停止させる保
護回路である。The speed detecting section (21) has a rotary encoder (E), a multiplication circuit (17) and a serial / parallel conversion circuit (18), and the rotational speed of the servomotor (M) detected by the rotary encoder (E). Is a circuit for detecting detected speed data and generating detected speed data (KD). The abnormal rotation protection circuit (22) includes a lock detection circuit (23), a delay circuit (24), a protection circuit (25), and a clock generation circuit (2).
6) and a time constant circuit (27), which calculates a difference between the target speed data (DD) and the detected speed data (KD), and when the difference exceeds a certain value and abnormal rotation occurs. Is a protection circuit for forcibly stopping the drive of the servo motor (M).
【0022】過電流保護回路(30)は、コンパレータ
(29A),遅延回路(29B)を有し、サーボモータ
(M)に過電流が流れたときに、サーボモータ(M)の
回転を強制的に停止させる保護回路である。駆動制御部
(20)においてラッチ回路(11A)は、不図示のC
PUから出力される目標速度データ(DD)をラッチし
てコンパレータ(12)に出力するものであって、ラッ
チ回路(11B)は、検出速度データ(KD)をラッチ
してコンパレータ(12)に出力するものである。The overcurrent protection circuit (30) has a comparator (29A) and a delay circuit (29B), and forcibly rotates the servomotor (M) when an overcurrent flows through the servomotor (M). It is a protection circuit to stop. In the drive control unit (20), the latch circuit (11A) has a C (not shown).
The target speed data (DD) output from PU is latched and output to the comparator (12), and the latch circuit (11B) latches the detected speed data (KD) and outputs to the comparator (12). To do.
【0023】また、コンパレータ(12)は目標速度デ
ータ(DD)と、後述の6ビットの速度検出データ(K
D)とを比較処理して、その比較結果をアップダウンパ
ルス発生回路[以下U/Dパルス発生回路と称する]
(13)に出力する回路である。具体的には、目標速度
データ(DD)が速度検出データ(KD)よりも大きい
ときにはハイレベル(以下“H”と称する)の信号を出
力し、逆に目標速度データ(DD)が速度検出データ
(KD)よりも小さいときにはローレベル(以下“L”
と称する)の信号を出力する。Further, the comparator (12) has a target speed data (DD) and 6-bit speed detection data (K
D) and the comparison result, and the comparison result is an up / down pulse generation circuit [hereinafter referred to as U / D pulse generation circuit].
It is a circuit for outputting to (13). Specifically, when the target speed data (DD) is larger than the speed detection data (KD), a high level (hereinafter referred to as “H”) signal is output, and conversely, the target speed data (DD) is the speed detection data. When it is smaller than (KD), it is low level (hereinafter "L").
Signal) is output.
【0024】U/Dパルス発生回路(13)は、コンパ
レータ(12)の出力信号に基づいて所定のU/Dパル
ス信号(UP)を生成してアップダウンカウンタ[以下
U/Dカウンタと称する](14)に出力する回路であ
る。具体的には、コンパレータ(12)の出力信号が
“H”のときに、時間単位あたり最大2の6乗=63個
のシリアルなパルス信号であるU/Dパルス信号(U
P)を出力している。The U / D pulse generation circuit (13) generates a predetermined U / D pulse signal (UP) based on the output signal of the comparator (12) and an up / down counter [hereinafter referred to as U / D counter]. This is a circuit for outputting to (14). Specifically, when the output signal of the comparator (12) is "H", a maximum of 2 6 = 63 serial pulse signals per unit of time U / D pulse signal (U
P) is output.
【0025】U/Dカウンタ(14)は、U/Dパルス
発生回路(13)から入力されるU/Dパルス信号(U
P)のパルス数をカウントし、このカウント数に応じて
6ビットのパラレルデータに変換してPWM回路(1
5)に出力する。PWM回路(15)は、U/Dカウン
タ(14)から出力される6ビットのパラレルデータを
順次取り込み、PWM変調することによりサーボモータ
(M)を駆動するための駆動パルス(PP)のデューテ
ィ比を設定するPWMパルス(PW)を出力するもので
ある。The U / D counter (14) has a U / D pulse signal (U) input from the U / D pulse generation circuit (13).
The pulse number of P) is counted, converted into 6-bit parallel data according to the counted number, and the PWM circuit (1
Output to 5). The PWM circuit (15) sequentially takes in 6-bit parallel data output from the U / D counter (14) and PWM-modulates the duty ratio of a drive pulse (PP) for driving the servo motor (M). The PWM pulse (PW) for setting is output.
【0026】例えばU/Dカウンタからのデータが3F
つまり63であれば、デューティ比100%、0であれ
ばデューティ比0%のPWMパルス(PW)を生成して
出力する。プリドライバ(16)は、後述の保護回路
(25)を介して出力されるPWMパルス(PW)に基
づいてMOSトランジスタであるスイッチングトランジ
スタ(S11〜S14)に駆動パルス(PP)を供給す
る回路である。For example, if the data from the U / D counter is 3F
In other words, if it is 63, a PWM pulse (PW) with a duty ratio of 100%, and if it is 0, a PWM pulse (PW) is generated and output. The pre-driver (16) is a circuit that supplies a drive pulse (PP) to the switching transistors (S11 to S14) that are MOS transistors based on a PWM pulse (PW) output via a protection circuit (25) described later. is there.
【0027】これら4つのスイッチングトランジスタ
(S11〜S14)はブリッジ回路を構成しており、こ
れらがON/OFF動作をしてサーボモータ(M)に電
流が供給/非供給されることでサーボモータ(M)が回
転し、所望の正転動作、逆転動作、停止動作のいずれか
ができるようにサーボモータ(M)を駆動制御される。
速度検出部(21)において、エンコーダ(E)はサー
ボモータ(M)の回転速度や、位置などを随時検出し、
それらの検出結果をディジタルデータにして逓倍回路
(18)に出力するロータリエンコーダである。本実施
例では分解能が100パルス/rev のロータリエンコー
ダを用いている。These four switching transistors (S11 to S14) constitute a bridge circuit, and these ON / OFF operations are performed to supply / non-supply current to the servo motor (M), whereby the servo motor ( M) rotates, and the servomotor (M) is drive-controlled so as to perform any one of a forward rotation operation, a reverse rotation operation, and a desired stop operation.
In the speed detection unit (21), the encoder (E) detects the rotation speed and position of the servo motor (M) at any time,
The rotary encoder outputs the detection results as digital data to the multiplication circuit (18). In this embodiment, a rotary encoder having a resolution of 100 pulses / rev is used.
【0028】逓倍回路(17)はエンコーダ(E)の出
力である検出結果を整数倍してシリアル/パラレル変換
回路(18)に出力する回路である。シリアル/パラレ
ル変換回路(18)は逓倍回路(17)の出力をシリア
ル/パラレル変換して、速度検出データ(KD)を生成
する回路である。異常回転保護回路(22)において、
ロック検出回路(23)は異常回転検出回路の一例であ
って、ラッチ回路(11A,11B)から出力される目
標速度データ(DD)と速度検出データ(KD)との差
を算出し、この差が予め設定している一定値を超えたと
きに、“H”の異常回転検出信号(RS)を出力する回
路である。The multiplication circuit (17) is a circuit for multiplying the detection result output from the encoder (E) by an integer and outputting the result to the serial / parallel conversion circuit (18). The serial / parallel conversion circuit (18) is a circuit that performs serial / parallel conversion on the output of the multiplication circuit (17) to generate speed detection data (KD). In the abnormal rotation protection circuit (22),
The lock detection circuit (23) is an example of an abnormal rotation detection circuit, and calculates the difference between the target speed data (DD) and the speed detection data (KD) output from the latch circuits (11A, 11B), and calculates the difference. Is a circuit that outputs an abnormal rotation detection signal (RS) of "H" when exceeds a preset constant value.
【0029】遅延回路(24)は、後述の時定数回路
(27)から出力される分周クロックに基づいて設定さ
れる一定時間である遅延時間だけ異常回転検出信号(R
S)を遅延させて保護回路(25)に出力する回路であ
る。保護回路(25)は、遅延回路(24)によって遅
延された“H”の異常回転検出信号(RS)が入力され
ると、プリドライバ(16)の動作を強制的に停止させ
て、サーボモータ(M)の駆動を停止させる回路であ
る。The delay circuit (24) has an abnormal rotation detection signal (R) for a delay time which is a constant time set based on a divided clock output from a time constant circuit (27) described later.
It is a circuit for delaying S) and outputting it to the protection circuit (25). When the abnormal rotation detection signal (RS) of "H" delayed by the delay circuit (24) is input, the protection circuit (25) forcibly stops the operation of the pre-driver (16) and the servo motor (25). This is a circuit for stopping the driving of (M).
【0030】クロック生成回路(26)は、時定数回路
(27)に基準クロック(CK)を出力する回路であっ
て、時定数回路(27)は、自身に入力される2ビット
の遅延時間設定データ(t0,t1)によって規定され
る分周比で基準クロック(CK)を分周し、遅延回路
(24)に出力する回路である。過電流保護回路(3
0)において、コンパレータ(29A)は、電圧変換さ
れたのちにフィルタ回路(FL)によってノイズが除去
された、サーボモータ(M)に流れる電流と、抵抗(R
11,R12)のブリーダー比で決定される基準電圧
(Vref )とを比較して、これが基準電圧(Vref )を
上回ったときに、ハイレベル(以下“H”と称する)の
過電流検出信号(KK)を遅延回路(24)に出力する
回路である。The clock generation circuit (26) is a circuit for outputting the reference clock (CK) to the time constant circuit (27), and the time constant circuit (27) sets a 2-bit delay time input to itself. It is a circuit that divides the reference clock (CK) with a division ratio defined by the data (t0, t1) and outputs the divided frequency to the delay circuit (24). Overcurrent protection circuit (3
0), the comparator (29A) converts the voltage, and then the noise is removed by the filter circuit (FL), the current flowing through the servo motor (M) and the resistance (R).
11, R12) is compared with a reference voltage (Vref) determined by a bleeder ratio, and when this exceeds a reference voltage (Vref), a high level (hereinafter referred to as “H”) overcurrent detection signal (hereinafter referred to as “H”) KK) is output to the delay circuit (24).
【0031】遅延回路(29B)は、時定数回路(2
7)から出力される分周クロックに基づいて設定される
一定時間である遅延時間だけ過電流検出信号(KK)を
遅延させて保護回路(25)に出力する回路である。以
下で、上記回路の動作について説明する。まずCPU
(11)に動作指令が入力されると、その動作指令に応
じた目標速度データ(DD)がCPU(11)から出力
される。The delay circuit (29B) is a time constant circuit (2
This circuit delays the overcurrent detection signal (KK) by a delay time which is a constant time set based on the divided clock output from 7) and outputs the overcurrent detection signal (KK) to the protection circuit (25). The operation of the above circuit will be described below. First CPU
When the operation command is input to (11), the target speed data (DD) corresponding to the operation command is output from the CPU (11).
【0032】なお、この目標速度データ(DD)は、サ
ーボモータ(M)の目標速度を示す6ビットのディジタ
ルデータである。本実施例では目標速度データ(DD)
は6ビットのディジタルデータとしているので、“00
0000”すなわち0から、“111111”すなわち
63までの値を設定することができる。また本実施例で
はエンコーダ回路(E)の分解能が100パルス/rev
であるとしているため、この目標速度データ(DD)の
1ビットを100rpm と設定することで、100rpm き
ざみで0rpm から6300rpm までの目標速度の設定を
することが可能になる。ここではCPU(11)から
“111111”が出力され、目標速度は6300rpm
に設定されたとする。The target speed data (DD) is 6-bit digital data indicating the target speed of the servo motor (M). In this embodiment, target speed data (DD)
Is 6-bit digital data, so "00"
It is possible to set a value from "0000", that is, 0 to "111111", that is, 63. In this embodiment, the resolution of the encoder circuit (E) is 100 pulses / rev.
Therefore, by setting 1 bit of this target speed data (DD) to 100 rpm, it becomes possible to set the target speed from 0 rpm to 6300 rpm in steps of 100 rpm. Here, "111111" is output from the CPU (11) and the target speed is 6300 rpm.
Is set to.
【0033】次に、コンパレータ(12)によって目標
速度データ(DD)と速度検出データ(KD)との比較
処理がなされる。回路の起動直後はサーボモータ(M)
の回転速度は0なので速度検出データ(KD)は“00
0000”となり、“111111”である目標速度デ
ータ(DD)の方が大きいためコンパレータ(12)の
出力は“H”になる。Next, the comparator (12) compares the target speed data (DD) with the speed detection data (KD). Immediately after starting the circuit, the servo motor (M)
Since the rotation speed of is 0, the speed detection data (KD) is "00".
Since the target speed data (DD) which is "111111" is larger, the output of the comparator (12) becomes "H".
【0034】コンパレータ(12)から“H”が出力さ
れると、U/Dパルス発生回路(13)が、時間単位
(本実施例では50ms)あたり最大2の6乗=63個の
パルス信号であるU/Dパルス信号(UP)を出力す
る。次いでU/Dカウンタ(14)によってU/Dパル
ス信号(UP)がカウントされ、カウント数に応じて6
ビットのパラレルデータ(この場合は“11111
1”)に変換されてPWM回路(15)に出力される。When "H" is output from the comparator (12), the U / D pulse generator (13) outputs a maximum of 2 6 = 63 pulse signals per time unit (50 ms in this embodiment). It outputs a certain U / D pulse signal (UP). Next, the U / D pulse signal (UP) is counted by the U / D counter (14), and 6 is counted according to the count number.
Bit parallel data (in this case, "11111"
1 ") and output to the PWM circuit (15).
【0035】次にU/Dカウンタ(14)のカウント結
果である6ビットのパラレルデータがPWM回路(1
5)によってPWM変調され、モータを駆動するための
PWMパルス(PW)のデューティ比が設定される。こ
のデューティ比は、U/Dカウンタ(14)から出力さ
れる6ビットのパラレルデータの大小によって増減し、
例えばこのデータが3Fつまり63であれば、デューテ
ィ比100%、0であればデューティ比0%のPWMパ
ルス(PW)を出力する。Next, the 6-bit parallel data as the count result of the U / D counter (14) is converted into the PWM circuit (1
PWM modulation is performed by 5), and the duty ratio of the PWM pulse (PW) for driving the motor is set. This duty ratio increases or decreases depending on the size of the 6-bit parallel data output from the U / D counter (14),
For example, if this data is 3F, that is, 63, the duty ratio is 100%, and if it is 0, the PWM pulse (PW) with the duty ratio of 0% is output.
【0036】その後、PWM回路(15)から出力され
るPWMパルスのデューティ比に従う駆動パルス(P
P)がプリドライバ(16)からMOS型のスイッチン
グトランジスタ(S11〜S14)に出力され、これら
のスイッチングトランジスタ(S11〜S14)がPW
M回路(15)によって設定されたデューティ比によっ
てON/OFF動作をし、サーボモータ(M)が所定の
回転をする。After that, the drive pulse (P) according to the duty ratio of the PWM pulse output from the PWM circuit (15) is generated.
P) is output from the pre-driver (16) to the MOS type switching transistors (S11 to S14), and these switching transistors (S11 to S14) are PW.
The servo motor (M) performs a predetermined rotation by performing ON / OFF operation according to the duty ratio set by the M circuit (15).
【0037】すなわちモータを正転するような場合に
は、スイッチングトランジスタのうちスイッチングトラ
ンジスタ(S12,S13)を常時OFFさせ、PWM
回路(15)によって設定されたデューティ比の駆動パ
ルス(PP)でスイッチングトランジスタ(S11,S
14)を、ON/OFFさせてサーボモータ(M)に電
流を供給し、これを正転させている。That is, when the motor is normally rotated, the switching transistors (S12, S13) among the switching transistors are always turned off, and the PWM
The drive pulse (PP) having the duty ratio set by the circuit (15) is used to switch the switching transistors (S11, S).
14) is turned on / off to supply a current to the servo motor (M) to rotate it forward.
【0038】このサーボモータ(M)の実際の回転速度
は、エンコーダ回路(E)によって随時検出されてお
り、この検出結果が逓倍回路(17)に出力される。逓
倍回路(17)によってこの検出結果が整数倍され、そ
の後シリアル/パラレル変換回路(18)によってシリ
アル/パラレル変換されることで、サーボモータ(M)
の実際の回転速度の検出結果を示し、パラレルな6ビッ
トのディジタルデータである速度検出データ(KD)が
生成されてコンパレータ(12)に出力される。The actual rotation speed of the servomotor (M) is constantly detected by the encoder circuit (E), and the detection result is output to the multiplication circuit (17). The detection result is multiplied by an integer by the multiplication circuit (17), and then serial / parallel converted by the serial / parallel conversion circuit (18), so that the servo motor (M)
Shows the actual detection result of the rotation speed, and speed detection data (KD) which is parallel 6-bit digital data is generated and output to the comparator (12).
【0039】すると、再びコンパレータ(12)によっ
て目標速度データ(DD)と速度検出データ(KD)と
が比較処理される。サーボモータ(M)の加速回転につ
れて、回転速度は上昇し、速度検出データ(KD)も増
加するが、まだ目標速度データ(DD)が速度検出デー
タ(KD)よりも大きい場合には“H”が出力される。Then, the comparator 12 again compares the target speed data (DD) with the speed detection data (KD). The rotational speed increases and the speed detection data (KD) increases as the servo motor (M) accelerates, but if the target speed data (DD) is still larger than the speed detection data (KD), "H". Is output.
【0040】このようにして、サーボモータ(M)の実
際の回転速度が6300rpm という目標速度に達するま
で、言い換えると速度検出データ(KD)が“1111
11”なる目標速度データ(DD)に達するまでサーボ
モータ(M)は加速される。やがて速度検出データ(K
D)が目標速度データ(DD)に達すると、コンパレー
タ(12)からは“L”が出力されるので、U/Dパル
ス発生回路(13)はU/Dパルス信号(UP)の生成
を中止し、従ってU/Dカウンタ(14)の出力は0に
なる。In this way, until the actual rotation speed of the servo motor (M) reaches the target speed of 6300 rpm, in other words, the speed detection data (KD) is "1111".
The servo motor (M) is accelerated until the target speed data (DD) of 11 "is reached.
When D) reaches the target speed data (DD), "L" is output from the comparator (12), so the U / D pulse generation circuit (13) stops the generation of the U / D pulse signal (UP). Therefore, the output of the U / D counter (14) becomes zero.
【0041】よってPWM回路(15)にはカウント結
果が出力されず、デューティ比が0のPWMパルスが生
成されるので、サーボモータ(M)への電流供給が停止
して加速動作は停止し、サーボモータ(M)は惰性で回
転を続け、一定時間目標速度で定速回転する。その後、
惰性で回転していたサーボモータ(M)は摩擦などによ
って回転速度が低下するので、再び目標速度である63
00rpm を下回り、速度検出データ(KD)が目標速度
データ(DD)を下回る。すると再びコンパレータ(1
2)の出力が“H”になるので、上述の動作を繰り返し
て再びサーボモータ(M)は目標速度に達成するまで加
速される。上記の動作を繰り返すことで、このサーボモ
ータ(M)は、目標速度データ(DD)によって予め設
定された目標速度である6300rpm に追従するように
動作する。Therefore, since the count result is not output to the PWM circuit (15) and the PWM pulse having the duty ratio of 0 is generated, the current supply to the servo motor (M) is stopped and the acceleration operation is stopped. The servomotor (M) continues to rotate by inertia and rotates at a constant speed at a target speed for a certain period of time. afterwards,
Since the rotation speed of the servo motor (M) that was rotating by inertia decreases due to friction or the like, the target speed is 63% again.
Below 00 rpm, the speed detection data (KD) falls below the target speed data (DD). Then again comparator (1
Since the output of 2) becomes "H", the above operation is repeated and the servomotor (M) is accelerated again until the target speed is reached. By repeating the above operation, the servo motor (M) operates so as to follow the target speed of 6300 rpm preset by the target speed data (DD).
【0042】以下で、本発明の駆動回路の特徴的な動作
である、モータ内に異物が混入するなどの何らかの異常
によりモータ(M)の回転が妨害され、回転速度が目標
速度に比して低くなるという異常回転が生じた場合につ
いて以下で説明する。上記回路では、常時ラッチ回路
(11A,11B)から目標速度データ(DD)と速度
検出データ(KD)がそれぞれロック検出回路(23)
に入力される。In the following, the rotation of the motor (M) is interrupted by some abnormality such as foreign matter mixed in the motor, which is a characteristic operation of the drive circuit of the present invention, and the rotation speed is lower than the target speed. The case where the abnormal rotation of becoming low occurs will be described below. In the above circuit, the target speed data (DD) and the speed detection data (KD) are constantly output from the latch circuit (11A, 11B) to the lock detection circuit (23).
Is input to
【0043】ロック検出回路(23)は常時目標速度デ
ータ(DD)と速度検出データ(KD)との差を算出し
ており、この差が、予め設定している一定値を超えたと
きに、サーボモータ(M)が異常回転していると判断
し、“H”の異常回転検出信号(RS)を遅延回路(2
4)に出力する。次いで、以下で説明する遅延時間だけ
遅延された異常回転検出信号(RS)が遅延回路(2
4)から保護回路(25)に出力されると、保護回路
(25)がプリドライバ(16)の動作を強制的に停止
させ、サーボモータ(M)の駆動を停止させることがで
きる。The lock detection circuit (23) constantly calculates the difference between the target speed data (DD) and the speed detection data (KD), and when this difference exceeds a preset constant value, It is judged that the servo motor (M) is abnormally rotating, and the "H" abnormal rotation detection signal (RS) is output to the delay circuit (2).
Output to 4). Then, the abnormal rotation detection signal (RS) delayed by the delay time described below is transmitted to the delay circuit (2
When output from 4) to the protection circuit (25), the protection circuit (25) can forcibly stop the operation of the pre-driver (16) and stop the driving of the servo motor (M).
【0044】以下で、上述の遅延時間の設定方法につい
て説明する。まず、クロック生成回路(26)から時定
数回路(27)に基準クロック(CK)が入力される。
時定数回路(27)には、同時に2ビットのディジタル
データである遅延時間規定データ(t0,t1)が入力
されており、その遅延時間規定データ(t0,t1)に
よって設定される分周比で、基準クロック(CK)が分
周されて遅延回路(24)に出力される。The method of setting the above-mentioned delay time will be described below. First, the reference clock (CK) is input from the clock generation circuit (26) to the time constant circuit (27).
The delay time defining data (t0, t1), which is 2-bit digital data, is simultaneously input to the time constant circuit (27), and the delay time defining data (t0, t1) has a frequency division ratio set by the division ratio. The reference clock (CK) is divided and output to the delay circuit (24).
【0045】遅延時間規定データ(t0,t1)は2ビ
ットのディジタルデータであるので、(t0,t1)の
組み合わせによって図2のタイミングチャートに示すよ
うに、2の2乗すなわち4種類の異なる分周比のクロッ
ク(CK1〜CK4)を生成することができる。例えば
遅延時間規定データ(t0,t1)がそれぞれ“1”,
“0”のときには設定時間が(t0,t1)の“1”,
“0”を基準として分周比が1/2の分周クロック(C
K2)が生成され、遅延時間規定データ(t0,t1)
がそれぞれ“1”,“1”のときには分周比が1/8の
分周クロック(CK4)が出力される。Since the delay time defining data (t0, t1) is 2-bit digital data, as shown in the timing chart of FIG. 2, depending on the combination of (t0, t1), 2 squared, that is, four different types of data. It is possible to generate clocks (CK1 to CK4) having a frequency ratio. For example, the delay time definition data (t0, t1) is "1",
When it is "0", the set time is "1" of (t0, t1),
A division clock (C with a division ratio of 1/2 based on "0")
K2) is generated and delay time specification data (t0, t1)
Are "1" and "1", respectively, the divided clock (CK4) having a dividing ratio of 1/8 is output.
【0046】これらの4種類の分周クロック(CK1〜
CK4)のうち遅延時間規定データ(t0,t1)によ
って規定されたいずれかの分周クロックが遅延回路(2
4)に出力される。次いで遅延回路(24)によって、
時定数回路(27)から出力される分周クロック(CK
1〜CK4)の立ち上がりが検出されて、この検出時
(tt1〜tt4)にロック検出回路(23)の出力で
ある異常回転検出信号(RS)が保護回路(25)に出
力される。例えば遅延時間規定データ(t0,t1)が
それぞれ“1”,“1”の場合には分周クロック(CK
4)の立ち上がり検出時(tt4)に異常回転検出信号
(RS)が保護回路(25)に出力される。These four types of divided clocks (CK1 to CK1
One of the divided clocks specified by the delay time specification data (t0, t1) in CK4) is the delay circuit (2
It is output to 4). Then, by the delay circuit (24),
The divided clock (CK) output from the time constant circuit (27)
1 to CK4), the abnormal rotation detection signal (RS) output from the lock detection circuit (23) is output to the protection circuit (25) at the time of this detection (tt1 to tt4). For example, when the delay time defining data (t0, t1) are "1" and "1", respectively, the divided clock (CK
An abnormal rotation detection signal (RS) is output to the protection circuit (25) at the time of rising edge detection (tt4) in 4).
【0047】以上より、遅延時間規定データ(t0,t
1)によって以下の表1に示すような遅延時間が設定さ
れる。From the above, the delay time defining data (t0, t
The delay time as shown in Table 1 below is set by 1).
【0048】[0048]
【表1】 [Table 1]
【0049】例えば、上の表1より、遅延時間規定デー
タ(t0,t1)がそれぞれ“0”,“0”のときには
遅延時間が50msecとなり、“1”,“1”のときには
遅延時間が400msecとなる。一例として、遅延時間規
定データ(t0,t1)がそれぞれ“0”,“0”であ
って、目標速度データ(DD)が“111111”であ
るにも関らず、検出速度データ(KD)が“00011
1”であるような場合を挙げる。このときには、ロック
検出回路(23)によってそれらの差である“1110
00”が算出される。この値は非常に大きいので異常回
転検出信号(RS)がロック検出回路(23)から出力
され、これが遅延回路(24)に出力されたのちに、表
1に示す遅延時間規定データ(t0,t1)によって規
定された遅延時間である50msecだけ遅延されて保護回
路(25)に出力され、保護回路(25)によってプリ
ドライバ(16)の動作が強制的に停止されてサーボモ
ータ(M)の駆動制御が停止する。For example, from Table 1 above, when the delay time defining data (t0, t1) is "0" and "0", the delay time is 50 msec, and when it is "1" and "1", the delay time is 400 msec. Becomes As an example, although the delay time defining data (t0, t1) are "0" and "0", respectively, and the target speed data (DD) is "111111", the detected speed data (KD) is "00011
In this case, the lock detection circuit (23) determines the difference "1110".
00 "is calculated. Since this value is very large, the abnormal rotation detection signal (RS) is output from the lock detection circuit (23), and this is output to the delay circuit (24). It is delayed by 50 msec which is a delay time defined by the time definition data (t0, t1) and output to the protection circuit (25), and the protection circuit (25) forcibly stops the operation of the pre-driver (16). The drive control of the servo motor (M) stops.
【0050】以上説明したように、本実施例に係る駆動
回路によれば、速度検出データ(KD)と目標速度デー
タ(DD)との差が一定値を超えて異常が生じたときに
サーボモータ(M)の駆動を強制的に停止させる異常回
転保護回路(22)を有する。このため、速度検出デー
タ(KD)と目標速度データ(DD)とを常時比較し、
これらの差が一定値を超えたときに異常回転検出信号
(RS)を保護回路(25)に出力してサーボモータの
駆動を停止させているので、過電流を検出するという検
出精度の低い方法でサーボモータ(M)の異常回転を検
出していた従来に比して、異常回転を確実に検出するこ
とが可能となる。As described above, according to the drive circuit of this embodiment, when the difference between the speed detection data (KD) and the target speed data (DD) exceeds a certain value and an abnormality occurs, the servo motor It has an abnormal rotation protection circuit (22) for forcibly stopping the driving of (M). Therefore, the speed detection data (KD) and the target speed data (DD) are constantly compared,
When the difference exceeds a certain value, the abnormal rotation detection signal (RS) is output to the protection circuit (25) to stop the driving of the servo motor, so that a method with low detection accuracy of detecting an overcurrent. Thus, it becomes possible to reliably detect the abnormal rotation as compared with the conventional case in which the abnormal rotation of the servo motor (M) is detected.
【0051】これにより、従来のようにサーボモータ
(M)の異常回転を確実に検出できず、これを放置する
ことによってサーボモータの焼損などの破壊が生じるこ
とを極力抑止することが可能となる。また、異常回転の
程度がひどく、モータが完全に停止してしまった場合に
も同様の効果を奏するのは勿論である。さらに、本実施
例に係る駆動回路には、異常回転保護回路(22)と同
様に、過電流を検出してから遅延時間だけ遅延した後に
当該回路の動作を強制的に停止させる過電流保護回路
(30)が設けられているが、この遅延時間は異常回転
保護回路(22)に設けられているクロック生成回路
(26)と時定数回路(27)を用いて、遅延時間規定
データ(t0,t1)によって設定し、同じ遅延時間で
起動させているので、2種類の保護回路のそれぞれにつ
いて遅延時間を設定する回路を設ける必要がなく、別個
にこれを設けたような場合に比して回路に要するコスト
の削減が可能になる。As a result, it is possible to prevent abnormal rotation of the servo motor (M) from being reliably detected as in the conventional case, and to prevent the servo motor (M) from being damaged by burning or the like if left unattended. . Further, it is of course possible to obtain the same effect even when the motor is completely stopped due to a large degree of abnormal rotation. Further, in the drive circuit according to the present embodiment, like the abnormal rotation protection circuit (22), an overcurrent protection circuit that forcibly stops the operation of the circuit after delaying the delay time after detecting the overcurrent. (30) is provided, but this delay time is calculated by using the clock generation circuit (26) and the time constant circuit (27) provided in the abnormal rotation protection circuit (22). Since it is set by t1) and activated with the same delay time, it is not necessary to provide a circuit for setting the delay time for each of the two types of protection circuits, and a circuit is provided as compared with the case where this is provided separately. It is possible to reduce the cost required for.
【0052】なお、本実施例では目標速度データ(D
D)を6ビットのディジタルデータにしているが本発明
はこれに限らず、例えば4ビット、10ビットなど、サ
ーボモータの用途に合わせてどのように設定しても、同
様の効果を奏する。また、遅延時間は2ビットのディジ
タルデータで設定して50,100,150,200ms
ecの4種類の時間を設定しているが、本発明はこれに限
らず、例えば3ビットのデータを用いて8種類の時間を
設定しても、同様の効果を奏する。In this embodiment, the target speed data (D
Although D) is 6-bit digital data, the present invention is not limited to this, and the same effect can be obtained regardless of how it is set to 4 bits, 10 bits or the like according to the application of the servo motor. Also, the delay time can be set with 2-bit digital data and is 50, 100, 150, 200 ms.
Although four types of time ec are set, the present invention is not limited to this, and the same effect can be obtained even if eight types of time are set using, for example, 3-bit data.
【0053】[0053]
【発明の効果】以上説明したように本発明に係る駆動回
路によれば、速度検出データと目標速度データとの差が
一定値を超えて異常が生じたときにサーボモータの駆動
を停止させる異常回転保護回路を有する。このため、速
度検出データと目標速度データの差が一定値を超えたと
きに異常回転を検出してサーボモータの駆動を停止させ
ているので、検出精度の低い過電流を検出するという検
出精度の低い方法によってモータの異常回転を検出して
いた従来に比して、異常回転を確実に検出することが可
能となる。As described above, according to the drive circuit of the present invention, when the difference between the speed detection data and the target speed data exceeds a certain value and the abnormality occurs, the drive of the servo motor is stopped. Has a rotation protection circuit. For this reason, when the difference between the speed detection data and the target speed data exceeds a certain value, the abnormal rotation is detected and the servomotor drive is stopped. The abnormal rotation can be detected more reliably than in the conventional case where the abnormal rotation of the motor is detected by the low method.
【0054】これにより、従来のように異常回転を確実
に検出できず、これを放置することによってモータなど
の焼損が生じることを極力抑止することが可能となる。As a result, it is possible to prevent abnormal rotation from being reliably detected as in the conventional case, and to prevent burning of the motor or the like if left unattended.
【図1】本発明の実施例に係る駆動回路の回路図であ
る。FIG. 1 is a circuit diagram of a drive circuit according to an embodiment of the present invention.
【図2】本発明の実施例に係る時定数回路及び遅延回路
の動作を説明するタイミングチャートである。FIG. 2 is a timing chart illustrating the operation of the time constant circuit and the delay circuit according to the exemplary embodiment of the present invention.
【図3】従来例に係る駆動回路の回路図である。FIG. 3 is a circuit diagram of a drive circuit according to a conventional example.
【図4】サーボモータの異常回転を説明するグラフであ
る。FIG. 4 is a graph illustrating abnormal rotation of a servo motor.
(11) CPU (12) コンパレータ (13) U/Dパルス発生回路 (14) U/Dカウンタ (15) PWM回路 (16) プリドライバ (17) 逓倍回路 (18) シリアル/パラレル変換回路 (20) 駆動制御部 (21) 速度検出部 (22) 異常回転保護回路 (23) ロック検出回路(異常回転検出回路) (24) 遅延回路 (25) 保護回路 (26) クロック生成回路 (27) 時定数回路 (28) 回転方向検出回路 (29A) コンパレータ (29B) 遅延回路 (30) 過電流検出回路 (M) サーボモータ (S11〜S14)スイッチングトランジスタ (DD) 目標速度データ (KD) 速度検出データ (RS) 異常回転検出信号 (KK) 過電流検出信号 (t0,t1)遅延時間規定データ (11) CPU (12) Comparator (13) U / D pulse generation circuit (14) U / D counter (15) PWM circuit (16) Pre-driver (17) Multiplication circuit (18) Serial / parallel conversion circuit (20) Drive control unit (21) Speed detection unit (22) Abnormal rotation protection circuit (23) Lock detection circuit (abnormal rotation detection circuit) (24) Delay circuit (25) Protection circuit (26) Clock generation circuit (27) Time constant circuit (28) Rotation direction detection circuit (29A) Comparator (29B) Delay circuit (30) Overcurrent detection circuit (M) Servo motor (S11 to S14) Switching transistor (DD) Target speed data (KD) Speed detection data (RS) Abnormal rotation detection signal (KK) Overcurrent detection signal (t0, t1) Delay time specification data
Claims (2)
て、その検出結果を示すディジタルデータである速度検
出データを生成する速度検出部と、 前記サーボモータの目標回転速度を示すディジタルデー
タである目標速度データと、前記速度検出データとを比
較し、該比較結果に基づいて前記サーボモータの実際の
回転速度が前記目標回転速度に追従するように前記サー
ボモータをディジタル制御する駆動制御部と、 前記速度検出データと前記目標速度データとの差が一定
値を超えて異常が生じた場合に前記サーボモータの駆動
を停止させる異常回転保護回路を有することを特徴とす
る駆動回路。1. A speed detection unit that detects an actual rotation speed of a servo motor and generates speed detection data that is digital data indicating the detection result, and digital data that indicates a target rotation speed of the servo motor. A drive control unit that compares the target speed data with the speed detection data and digitally controls the servo motor so that the actual rotation speed of the servo motor follows the target rotation speed based on the comparison result. A drive circuit having an abnormal rotation protection circuit for stopping the drive of the servo motor when the difference between the speed detection data and the target speed data exceeds a certain value and an abnormality occurs.
データと前記目標速度データとの差が一定値を超えたと
きに異常回転検出信号を出力する異常回転検出回路と、 前記異常回転検出信号の遅延時間を生成する時定数回路
と、 前記遅延時間だけ異常回転検出信号を遅延させる遅延回
路と、 遅延された異常回転検出信号に基づいて当該回路の動作
を停止させる保護回路とを有することを特徴とする請求
項1記載の駆動回路。2. The abnormal rotation detection circuit, which outputs an abnormal rotation detection signal when the difference between the speed detection data and the target speed data exceeds a certain value, and the abnormal rotation detection signal. A time constant circuit that generates a delay time, a delay circuit that delays the abnormal rotation detection signal by the delay time, and a protection circuit that stops the operation of the circuit based on the delayed abnormal rotation detection signal. The drive circuit according to claim 1, wherein the drive circuit is a drive circuit.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP7035647A JPH08237983A (en) | 1995-02-23 | 1995-02-23 | Drive circuit |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP7035647A JPH08237983A (en) | 1995-02-23 | 1995-02-23 | Drive circuit |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH08237983A true JPH08237983A (en) | 1996-09-13 |
Family
ID=12447677
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP7035647A Pending JPH08237983A (en) | 1995-02-23 | 1995-02-23 | Drive circuit |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH08237983A (en) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011188673A (en) * | 2010-03-10 | 2011-09-22 | Canon Inc | Motor drive, motor drive control method, motor drive control program, and recording medium |
CN116849789A (en) * | 2023-07-24 | 2023-10-10 | 广州爱锘德医疗器械有限公司 | Bone cement injection equipment and out-of-control prevention device, control method and controller |
-
1995
- 1995-02-23 JP JP7035647A patent/JPH08237983A/en active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011188673A (en) * | 2010-03-10 | 2011-09-22 | Canon Inc | Motor drive, motor drive control method, motor drive control program, and recording medium |
CN116849789A (en) * | 2023-07-24 | 2023-10-10 | 广州爱锘德医疗器械有限公司 | Bone cement injection equipment and out-of-control prevention device, control method and controller |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
TWI552511B (en) | Motor driving circuit, cooling device using the same, and electronic device | |
JP6622249B2 (en) | Motor drive control device and motor drive control method | |
JPWO2005055410A1 (en) | DC motor drive device | |
JPH08237983A (en) | Drive circuit | |
JP4086102B2 (en) | Stepping motor control device | |
JPH05104454A (en) | Power tool | |
JP2014042440A (en) | Motor driving device and motor control method | |
JP2004228860A (en) | Semiconductor integrated circuit device | |
JP3235742B2 (en) | Motor control drive circuit | |
JPH08237984A (en) | Drive circuit | |
JP3251827B2 (en) | Positioning device | |
US7061193B2 (en) | Motor drive apparatus | |
WO2018123426A1 (en) | Device and method for acquiring information on rotation of brushed dc motor | |
JP3263556B2 (en) | Drive circuit | |
JPH11187687A (en) | Servo controller with current ripple detection | |
JP6934394B2 (en) | DC motor drive circuit, drive method and electronic equipment using it | |
JPH01148099A (en) | Malfunction detector for pulse motor | |
JP7311957B2 (en) | DC motor drive circuit and electronic equipment using the same | |
JP2002010689A (en) | Pulse motor control method | |
JPH08214579A (en) | Driving circuit | |
JP3672674B2 (en) | Motor control device | |
JP7012507B2 (en) | DC motor drive circuit, drive method and electronic equipment using it | |
JP2925813B2 (en) | Motor drive | |
JP4388517B2 (en) | DC motor rotation state detection device | |
JP2810568B2 (en) | Motor malfunction prevention circuit |