JPS63209481A - Controlling circuit of oscillatory wave motor - Google Patents
Controlling circuit of oscillatory wave motorInfo
- Publication number
- JPS63209481A JPS63209481A JP62041861A JP4186187A JPS63209481A JP S63209481 A JPS63209481 A JP S63209481A JP 62041861 A JP62041861 A JP 62041861A JP 4186187 A JP4186187 A JP 4186187A JP S63209481 A JPS63209481 A JP S63209481A
- Authority
- JP
- Japan
- Prior art keywords
- frequency
- motor
- output
- rotation
- input
- 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.)
- Expired - Lifetime
Links
- 230000003534 oscillatory effect Effects 0.000 title abstract 2
- 238000006243 chemical reaction Methods 0.000 claims abstract description 8
- 230000000750 progressive effect Effects 0.000 claims description 4
- 238000001514 detection method Methods 0.000 claims 4
- 230000002441 reversible effect Effects 0.000 abstract description 3
- 238000000034 method Methods 0.000 description 23
- 230000008569 process Effects 0.000 description 20
- 230000007423 decrease Effects 0.000 description 8
- 238000010586 diagram Methods 0.000 description 7
- 230000003247 decreasing effect Effects 0.000 description 6
- 102100038023 DNA fragmentation factor subunit beta Human genes 0.000 description 4
- 101100277639 Homo sapiens DFFB gene Proteins 0.000 description 4
- 238000013459 approach Methods 0.000 description 4
- 230000008859 change Effects 0.000 description 3
- 238000004891 communication Methods 0.000 description 3
- 239000013256 coordination polymer Substances 0.000 description 3
- 239000003990 capacitor Substances 0.000 description 2
- 230000010287 polarization Effects 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 230000000717 retained effect Effects 0.000 description 2
- 101100322581 Caenorhabditis elegans add-1 gene Proteins 0.000 description 1
- 102100038026 DNA fragmentation factor subunit alpha Human genes 0.000 description 1
- 101000950906 Homo sapiens DNA fragmentation factor subunit alpha Proteins 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 239000004744 fabric Substances 0.000 description 1
- 230000000670 limiting effect Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000002829 reductive effect Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02N—ELECTRIC MACHINES NOT OTHERWISE PROVIDED FOR
- H02N2/00—Electric machines in general using piezoelectric effect, electrostriction or magnetostriction
- H02N2/10—Electric machines in general using piezoelectric effect, electrostriction or magnetostriction producing rotary motion, e.g. rotary motors
- H02N2/14—Drive circuits; Control arrangements or methods
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02N—ELECTRIC MACHINES NOT OTHERWISE PROVIDED FOR
- H02N2/00—Electric machines in general using piezoelectric effect, electrostriction or magnetostriction
- H02N2/10—Electric machines in general using piezoelectric effect, electrostriction or magnetostriction producing rotary motion, e.g. rotary motors
- H02N2/14—Drive circuits; Control arrangements or methods
- H02N2/142—Small signal circuits; Means for controlling position or derived quantities, e.g. speed, torque, starting, stopping, reversing
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02N—ELECTRIC MACHINES NOT OTHERWISE PROVIDED FOR
- H02N2/00—Electric machines in general using piezoelectric effect, electrostriction or magnetostriction
- H02N2/10—Electric machines in general using piezoelectric effect, electrostriction or magnetostriction producing rotary motion, e.g. rotary motors
- H02N2/16—Electric machines in general using piezoelectric effect, electrostriction or magnetostriction producing rotary motion, e.g. rotary motors using travelling waves, i.e. Rayleigh surface waves
- H02N2/163—Motors with ring stator
Landscapes
- General Electrical Machinery Utilizing Piezoelectricity, Electrostriction Or Magnetostriction (AREA)
Abstract
Description
【発明の詳細な説明】
(産業上の利用分野)
本発明は電歪素子、圧電素子等の電気−機械エネルギー
変換素子に周波電圧を印加することにて振動体表面に進
行性振動波を発生させ、該振動波にて移動体を駆動する
振動波モーターの制御回路に関する。[Detailed Description of the Invention] (Field of Industrial Application) The present invention generates progressive vibration waves on the surface of a vibrating body by applying a frequency voltage to an electro-mechanical energy conversion element such as an electrostrictive element or a piezoelectric element. The present invention relates to a control circuit for a vibration wave motor that drives a moving object using the vibration waves.
(従来技術)
該型式のモーターの速度を調定するに際して、上記周波
電圧の周波数を変化させる方法が知られている。(Prior Art) A method is known in which the frequency of the frequency voltage is varied in adjusting the speed of this type of motor.
該方法にてモーターを所望の速度に設定する場合には、
所望の速度に対応する周波数を選んで上記電気−機械エ
ネルギー変換素子に印加すれば良いが、該方法によると
モーターは急激に回動を開始することとなり、モーター
を滑らかに回動させることが出来ない。When setting the motor to the desired speed using this method,
It is sufficient to select a frequency corresponding to the desired speed and apply it to the electro-mechanical energy conversion element, but with this method, the motor starts rotating suddenly, and it is not possible to rotate the motor smoothly. do not have.
上記の問題を解消するために、′モーターを起動するに
際して高周波数から徐々に駆動周波数を低下させ、所望
の速度に応じた周波数へ8行させれば良い。In order to solve the above problem, 'when starting the motor, the driving frequency may be gradually lowered from a high frequency to a frequency corresponding to the desired speed in 8 lines.
この際の起動時の高周波数としては、モーターが実際に
回転を開始する周波数に設定し、この設定周波数から徐
々に周波数を低下させればモーターを所望速度まで短時
間かつ滑らかに駆動することが出来るものの、上記モー
ターの特性は一定ではなく温度等の環境変化に影響され
、起動開始時の周波数を固定すると温度時の変化が起き
た場合対応が出来なくなり、上記急激な回転や起動開始
時までの時間が長くなる等の不都合が生じる。In this case, the high frequency at startup is set to the frequency at which the motor actually starts rotating, and if the frequency is gradually lowered from this set frequency, the motor can be smoothly driven to the desired speed in a short time. However, the characteristics of the motor mentioned above are not constant and are affected by environmental changes such as temperature, so if the frequency at the start of startup is fixed, it will not be able to cope with changes in temperature, and the characteristics of the above motor will not be constant until the sudden rotation or the start of startup. This causes inconveniences such as a longer time.
本発明は上記事項に鑑みなされたもので、モーターを起
動するに際し、モーターへ印加する周波数を所定の高周
波数から徐々に所望の速度に応じた周波数へ低下させる
と共に、その起動時の所定の高周波数を前回モーターの
起動に際し、実際にモーターが回動を開始した時点の周
波数に設定することにて、モーターを滑らかに、かつモ
ーターを短時間で起動可能ならしめんとするものである
。The present invention has been made in view of the above-mentioned problems, and when starting the motor, the frequency applied to the motor is gradually lowered from a predetermined high frequency to a frequency corresponding to the desired speed, and the frequency applied to the motor is By setting the frequency to the frequency at which the motor actually started rotating the last time the motor was started, it is possible to start the motor smoothly and in a short time.
第1図は本発明に係る振動波モーターの制御回路の一実
施例を示す回路図である。FIG. 1 is a circuit diagram showing an embodiment of a control circuit for a vibration wave motor according to the present invention.
図において、CPUはマイクロコンピュータ−を示して
いる。In the figure, CPU indicates a microcomputer.
該コンピューターCPυにおいて、PAO〜P A t
は出力ポートでミ該ボートからは駆動周波数を決定する
情報が出力される。又、出力ポートPB+からはモータ
ー駆動停止信号を送出し、出力ポートPB2からはモー
ターの正逆回転を決定する方向信号が送出される。PC
O〜PC3は共振周波数情報を出力する出力ポート、P
Doはロック信号を入力する入力ポート、PEGはエン
コーダーENCからのパルスを入力するボートである。In the computer CPυ, PAO~P A t
is an output port, and information for determining the drive frequency is output from the port. Further, a motor drive stop signal is sent from the output port PB+, and a direction signal that determines forward/reverse rotation of the motor is sent from the output port PB2. PC
O~PC3 are output ports that output resonance frequency information, P
Do is an input port for inputting a lock signal, and PEG is a port for inputting pulses from the encoder ENC.
DAは上記cpuの出力ポートP A o〜PA7と、
接続し、該ボートから出力される情報をDA変換するデ
ィジタル−アナログ(DA)変換回路である。op、、
op、及びTR,、TR2はそれぞれオペアンプ及びト
ランジスターで、OP、、Tr、にて上記DA変換回路
出力に応じた電流を形成し、トランジスタTrs 、T
r4から成るカレントミラー回路に該電流を形成させる
。又、上記OP2.Tr2はオフセット用の回路で、該
回路にてオフセット用電流が形成され、その結果として
カレントミラー回路を構成する上記トランジスターTr
4に上記DA変換回路出力に応じた電流に対して、上記
オフセット電流を加えた電流が形成される。DA is the output port P A o ~ PA7 of the above CPU,
This is a digital-to-analog (DA) conversion circuit that connects the board and performs DA conversion of information output from the board. op...
OP, TR, and TR2 are operational amplifiers and transistors, respectively, and OP, and Tr form a current according to the output of the DA conversion circuit, and the transistors Trs and T
The current is formed in a current mirror circuit consisting of r4. Also, the above OP2. Tr2 is an offset circuit in which an offset current is generated, and as a result, the transistor Tr2 forming a current mirror circuit
4, a current is formed by adding the offset current to the current corresponding to the output of the DA converter circuit.
C1は上記トランジスターTr4の出力電流にて充電さ
れるコンデンサー、CP、はコンパレーター、Trsは
トランジスターで、コンデンサーCIが所定電圧Vcま
で充電されると、コンパレーターCPIは出力をハイレ
ベル(以下1と称す。)となし、トランジスターTr5
をオンとなす。従ってコンパレーターCP1からは上記
トランジスターTr4の電流値に応じた周波数のパルス
を出力する。DFFlはクロック端子を上記コンパレー
ターCPsの出力端に接続するDフリップフロップで、
該フリップフロップは上記コンパレーターCP1からパ
ルスに同期して作動し、上記コンパレーターCPIの出
力パルスをデユーティ50%のパルスに変換する。C1 is a capacitor charged by the output current of the transistor Tr4, CP is a comparator, and Trs is a transistor. When the capacitor CI is charged to a predetermined voltage Vc, the comparator CPI sets the output to a high level (hereinafter referred to as 1). ) and transistor Tr5
Turn on. Therefore, the comparator CP1 outputs a pulse having a frequency corresponding to the current value of the transistor Tr4. DFFl is a D flip-flop whose clock terminal is connected to the output terminal of the comparator CPs,
The flip-flop operates in synchronization with the pulse from the comparator CP1, and converts the output pulse of the comparator CPI into a pulse with a duty of 50%.
Pctはフェーズコンパレーターで入力R及びSへの入
力パルスの位相が一致している時、出力をオーブンとな
し、その入力パルス位相の一致度が例えばR入力端への
パルスに対してS入力端のパルスが遅れればその遅れ分
だけ出力をハイレベル(以下1と称す。)となし、逆に
R入力端へのパルスに対してS入力端のパルスが進めば
その分だけ出力をロウレベル(以下0と称す。)となす
、LPF、はローパルスフィルターで、例えばP C+
の出力が1となることにて出力レベルを増大させ、逆に
0となることにて出力レベルを減少させ、オーブンの時
その出力レベルを維持する。VCOIは電圧制御発振器
で、その出力周波数は上記LPF、の出力が大となる程
高周波数となる様構成されている。FR,はVCO,の
出力を32分周する分周回路である。上記構成(PC+
、LPF+ 、VCO+ 。Pct is a phase comparator, and when the phases of the input pulses to the inputs R and S match, the output is set as an oven, and the degree of coincidence of the input pulse phases is, for example, different from the pulse to the R input terminal to the S input terminal If the pulse at the S input terminal is delayed, the output will be set to a high level (hereinafter referred to as 1) by the amount of delay, and conversely, if the pulse at the S input terminal advances with respect to the pulse to the R input terminal, the output will be set to a low level (hereinafter referred to as 1) by that amount. 0), LPF is a low pulse filter, for example, P C+
When the output becomes 1, the output level is increased, and when it becomes 0, the output level is decreased, and when the oven is used, the output level is maintained. The VCOI is a voltage controlled oscillator, and its output frequency is configured such that the larger the output of the LPF, the higher the frequency. FR is a frequency dividing circuit that divides the output of the VCO by 32. The above configuration (PC+
, LPF+, VCO+.
FBI )にてフェーズロックドループを構成し1、コ
ンパレーターPc1のS及びR入力が同一パルスとなる
種制御され、その結果VCO□の出力はDFF、のパル
ス周波数f、に対して32倍の32f1なるパルスを出
力する。FBI) configures a phase-locked loop 1, and controls the S and R inputs of comparator Pc1 to be the same pulse, and as a result, the output of VCO□ is 32f1, which is 32 times the pulse frequency f of DFF. Outputs a pulse of
SR,は8ビツトのシフトレジスターで、該レジスター
のD入力は上記DFF1のQ出力と接続し、又クロック
入力は上記VCO,の出力に接続している。SR is an 8-bit shift register whose D input is connected to the Q output of the DFF1, and its clock input is connected to the output of the VCO.
この様に構成しているので、シフトレジスターSR,は
、その出力QをD入力へのパルスに対して90°位相を
づらしたパルスとなす。With this configuration, the shift register SR outputs a pulse whose phase is shifted by 90 degrees with respect to the pulse to the D input.
ex、はエスクスルシブオアゲートで、該ゲートは上記
レジスターSR,のQ出力及び前記CPUの出力ポート
PBzからの方向信号DIRを人力しており、出力ポー
トPB2からの信号が0の時にはレジスターSR,のQ
出力をそのまま出力させ、又1の時にはレジスターSK
、のQ出力を反転させて出力させる。これにてゲートe
Xlの出力パルスを前記フリップフロップOFF、に対
して±90@づれなパルスとなし、モーターの回転方向
切換えを行う。AN、、AN2はアンドゲートで、該ゲ
ートはそれぞれ上記DFFIの出力及びゲートex、の
出力をアンプAP、。ex is an S-OR gate, which inputs the Q output of the register SR and the direction signal DIR from the output port PBz of the CPU, and when the signal from the output port PB2 is 0, the gate outputs the Q output of the register SR. Q of ,
The output is output as is, and when it is 1, register SK
The Q output of , is inverted and output. With this, gate e
The output pulse of Xl is set to be a pulse offset by ±90@ with respect to the flip-flop OFF, and the rotation direction of the motor is switched. AN, , AN2 are AND gates, and these gates respectively input the output of the DFFI and the output of the gate ex to the amplifier AP.
AP2に伝える。BIは電歪素子が配される振動体であ
る。該振動体は例えばリング形状をしており、その表面
に電歪素子が配されている。又、該振動体の表面には振
動体と同一形状の移動体が摩擦接触しており、振動体に
発生する進行性振動波にて駆動される。Tell AP2. BI is a vibrating body in which an electrostrictive element is arranged. The vibrating body has, for example, a ring shape, and an electrostrictive element is arranged on the surface of the vibrating body. Further, a moving body having the same shape as the vibrating body is in frictional contact with the surface of the vibrating body, and is driven by progressive vibration waves generated in the vibrating body.
第2図は上記振動体BIの表面上に配される電歪素子の
配設状態を示す説明図である。第2図中のAI及びB、
はそれぞれ図示の位相及び分極関係に振動体Bl上に配
される第1と第2の電歪素子群である。又S1は第1の
電歪素子群B1に対して45°位相がづれた位相に配さ
れるセンサー用の電歪素子である。これらの各電歪素子
は、それぞれ単独のものを振動体に附しても良いし、又
一体的に分極処理にて形成しても良い。FIG. 2 is an explanatory diagram showing the arrangement of electrostrictive elements arranged on the surface of the vibrating body BI. AI and B in Figure 2,
are first and second electrostrictive element groups arranged on the vibrating body Bl in the illustrated phase and polarization relationships, respectively. Further, S1 is an electrostrictive element for a sensor arranged at a phase shifted by 45 degrees with respect to the first electrostrictive element group B1. Each of these electrostrictive elements may be attached to the vibrating body individually, or may be formed integrally by polarization treatment.
第1図に戻り、A、B、Sはそれぞれ第1.第2の電歪
素子群及びセンサー用電歪素子Stに対する駆動電極及
びセンサー電極を示し、電極Aに対して上記アンプAP
Iを介した周波電圧が印加されると共に、電極Bに上記
AP、を介した周波電圧が印加されることにて振動体B
I衣表面進行性の振動波が形成される。又、振動体に上
記振動波が形成されると、この振動波の状態に応じてセ
ンサー用電歪素子Sが出力(周波電圧)を出力し、セン
サー電極S1にて、これが検出される。Returning to FIG. 1, A, B, and S are respectively 1. A drive electrode and a sensor electrode are shown for the second electrostrictive element group and the sensor electrostrictive element St, and the amplifier AP is connected to the electrode A.
A frequency voltage is applied to the electrode B via the AP, and a frequency voltage via the AP is applied to the electrode B.
A progressive vibration wave is formed on the surface of the cloth. Further, when the vibration wave is formed in the vibrating body, the sensor electrostrictive element S outputs an output (frequency voltage) according to the state of the vibration wave, and this is detected by the sensor electrode S1.
尚、振動波モーターは共振状態では、A電極への駆動電
圧とセンサー電極からの出力電圧との位相関係が特定の
関係を示す特性を有しており、電極Aにて周波信号が印
加される第1の電歪素子群AI とセンサー用電歪素子
Sどの位相関係にて決定され、本実施例の場合は正転状
態では電極A、Sとの信号波形の位相が135°づれた
時に共振状態を示し、又逆転の時には45°づれた時に
共振状態を示すものとし、共振からづれるほと上記位相
差関係がづれるものとする。CP2゜CP、はそれぞれ
電極A及びSの出力波形をパルス形状に整形するコンパ
レーターを示す。In addition, in a resonant state, the vibration wave motor has a characteristic that the phase relationship between the drive voltage to the A electrode and the output voltage from the sensor electrode is a specific relationship, and a frequency signal is applied at the electrode A. The phase relationship between the first electrostrictive element group AI and the sensor electrostrictive element S is determined, and in the case of this embodiment, resonance occurs when the signal waveforms of the electrodes A and S are out of phase by 135 degrees in the normal rotation state. In addition, in the case of reversal, a resonance state is indicated when the angle shifts by 45 degrees, and the further the shift from resonance, the more the above-mentioned phase difference relationship shifts. CP2°CP represents a comparator that shapes the output waveforms of the electrodes A and S into a pulse shape, respectively.
FR,は上記コンパレーターCP2の出力をD入力とし
、クロック入力を上記VCOIの出力に接続する4ビツ
トのシフトレジスターで、該構成にてシフトレジスター
FR,はコンパレーターCP2の出力パルス即ち電極A
の周波信号を45°シフトさせる。FR3はそのD入力
を上記シフトレジスターFR2のQ出力と接続し、クロ
ック入力を上記VCO,の出力と接続する8ビツトのシ
フトレジスターで、シフトレジスターFR2の出力を更
に90°シフトし、全体でコンパレーターCP2の出力
を135°シフトする。SEL、はシフトレジスターF
R,又はFR,の出力を選択するデーターセレクターで
ある。該セレクターは出力ポートPB2の信号DIRが
正転を表わしている時、入力Bを選択し逆転を表わして
いる時入力Aを選択する。FR is a 4-bit shift register whose D input is the output of the comparator CP2 and whose clock input is connected to the output of the VCOI.
Shifts the frequency signal by 45 degrees. FR3 is an 8-bit shift register whose D input is connected to the Q output of the shift register FR2, and whose clock input is connected to the output of the VCO.The output of the shift register FR2 is further shifted by 90 degrees, and the entire comparator is Shift the output of the controller CP2 by 135°. SEL is shift register F
This is a data selector that selects the output of R or FR. The selector selects input B when the signal DIR at the output port PB2 indicates normal rotation, and selects input A when it indicates reverse rotation.
PC2はフェーズコンパレーターで、第3図の如く入力
S、Rへの入力パルスの位相関係を検知し、その位相差
が大な程出力Σ下から1の出力されるデユーティが小さ
な信号を出力する。PC2 is a phase comparator that detects the phase relationship of the input pulses to inputs S and R as shown in Figure 3, and the larger the phase difference, the smaller the output duty of 1 from the bottom of the output Σ is output. .
11はインバーター、C0UIはカウンター、AN3は
アンドゲートで、上記カウンターはリセット入力RES
ETへの信号が0の時リセットされる。又、上記アンド
ゲートAN3はインバーター1.の出力が1の時、上記
VCOIからのパルスをカウンターCOU 1へ伝える
。11 is an inverter, C0UI is a counter, AN3 is an AND gate, and the above counter is a reset input RES.
It is reset when the signal to ET is 0. Further, the AND gate AN3 is connected to the inverter 1. When the output of COU1 is 1, the pulse from the VCOI is transmitted to the counter COU1.
上記の構成にてカウンターCOU +はコンパレーター
PC2の出力が0の期間VCOIからのパルスをカウン
トし、モーターが共振状態に近づくにつれてカウンター
C0UIのカウント値が減少する。MCIは入力(AO
〜A3)と(B。In the above configuration, the counter COU + counts pulses from VCOI while the output of the comparator PC2 is 0, and as the motor approaches a resonance state, the count value of the counter C0UI decreases. MCI is input (AO
~A3) and (B.
〜BS)の値を比較し、A<Bの時1を出力するマクニ
チュードコンパレーターで、該コンパレーターMCIの
出力はD型フリップフロップDFF2のD入力と接続し
ている。該フリップフロップDFFzのクロック入力は
、上記コンパレーターPC2の出力PDと接続され、ク
ロック入力へのパルスの立上りに同期してD入力の状態
を検知する。~BS) and outputs 1 when A<B. The output of the comparator MCI is connected to the D input of the D-type flip-flop DFF2. The clock input of the flip-flop DFFz is connected to the output PD of the comparator PC2, and detects the state of the D input in synchronization with the rise of the pulse to the clock input.
LPF、はローパスフィルター、C20はコンパレータ
ーで、上記フリップフロップDFF2のQ出力1に応答
して、CPUの入力ボートPDφへ1信号を伝える。LPF is a low-pass filter, and C20 is a comparator, which transmits a 1 signal to the input port PDφ of the CPU in response to the Q output 1 of the flip-flop DFF2.
ENCはモーターの移動体に連動して回動する例えばパ
ルス板等のコード板で、モーターの回転速度に応じた周
波数のパルスを形成する。The ENC is a code plate, such as a pulse plate, which rotates in conjunction with the moving body of the motor, and forms pulses with a frequency corresponding to the rotational speed of the motor.
RAMはランダムアクセスメモリーで、CPUとデータ
ーの通信を行う。該RAMはバックアップ用電源BT、
から常時給電されると共に、メインスイッチSW、を介
して電源BT2から給電される。又、該電源BT2にて
アンプAP、。RAM is a random access memory that communicates data with the CPU. The RAM is a backup power supply BT,
Power is constantly supplied from the main switch SW, and power is also supplied from the power supply BT2 via the main switch SW. Moreover, the amplifier AP is connected to the power supply BT2.
AP2をのぞく各回路部への給電がなされる。Power is supplied to each circuit section except AP2.
S W 2は上記スイッチSW1に連動してオンとなる
スイッチで、該スイッチSW2を介して高電圧電源BT
Sの出力が上記アンプAP、。SW2 is a switch that is turned on in conjunction with the switch SW1, and the high voltage power supply BT is connected via the switch SW2.
The output of S is the amplifier AP.
A P xに供給される。SW、はメモリーRAMの内
容をリセットするリセットスイッチである。A P x is supplied. SW is a reset switch that resets the contents of the memory RAM.
第4図は第1図のコンピューターCPUに内蔵されるR
OMにプログラムされているプログラムフローを示すプ
ログラム図であり、コンピューターCPUは該プログラ
ムフローに従って制御動作を実行する。Figure 4 shows the R built in the computer CPU in Figure 1.
FIG. 2 is a program diagram showing a program flow programmed in the OM, and the computer CPU executes control operations according to the program flow.
次いで第1図実施例の動作を説明する。Next, the operation of the embodiment shown in FIG. 1 will be explained.
今メインスイッチSW、をオンとすると、電源BT2の
出力が各回路に印加される。これにてコンピューターC
PUが作動を開始する。When the main switch SW is now turned on, the output of the power supply BT2 is applied to each circuit. Now computer C
PU starts operating.
コンピューターCPUが作動を開始すると、まずステッ
プ1が実行される。以下各ステップの動作を説明する。When the computer CPU starts operating, step 1 is executed first. The operation of each step will be explained below.
ステップ1:出力ポートPBoからOを、又PB、から
0を出力する。出力ポートPC0〜PC,から所定の設
定値$3を出力する。Step 1: Output O from output port PBo and 0 from PB. A predetermined set value $3 is output from output ports PC0 to PC.
ステップ2 : RAMの有効ビットデーターを人力す
る。Step 2: Enter valid bit data in RAM manually.
ステップ3:上記データーがOの時、変数FMAX=$
FFとし、1の時はRAMに記憶されている前回最高周
波数を読み出し、FMAX=前回最高周波数とする。Step 3: When the above data is O, variable FMAX=$
FF, and when it is 1, the previous highest frequency stored in the RAM is read out, and FMAX=previous highest frequency.
初回のモーター駆動に際しては上記有効ビットデーター
はOとなっており変数FMAX=$FFに設定される。When the motor is driven for the first time, the valid bit data is O, and the variable FMAX is set to $FF.
ステップ4:出力ポートPAO〜PA、から上記変数F
MAXを出力する。該ボートからの変数FMAX情報は
DA変換器DAにてアナログ電圧に変換され、アンプo
p、、OP2及びトランジスターTrINTRr4の作
用にて上記変数FMAXに応じた電流値がトランジスタ
ーTr< に流れる。Step 4: From the output ports PAO to PA, the above variable F
Output MAX. The variable FMAX information from the boat is converted into an analog voltage by the DA converter DA, and the amplifier o
A current value corresponding to the variable FMAX flows through the transistor Tr< by the action of p, , OP2 and the transistor TrINTRr4.
ステップ4′ :内部メモリーFに上記変数FMAXを
記憶させる。Step 4': Store the variable FMAX in the internal memory F.
ステップ5:出力ポートP B oから1を出力させる
。該ボートPBoから0は所謂ビジィ信号として作用し
ており、これにてビジィが解除され、コンピューターC
PUに接続される不図示の回路に対してコンピューター
CPUとの通信が許容状態となることを示す。Step 5: Output 1 from output port P B o. 0 from the boat PBo acts as a so-called busy signal, and the busy state is canceled and the computer C
This indicates that communication with the computer CPU is permitted for a circuit (not shown) connected to the PU.
ステップ6:不図示の回路からコンピューターの人力ボ
ートSDIに入力されるデーターを検知し、不図示の回
路からデーターとして駆動命令信号が人力されるか否か
の判定を行い、駆動命令信号が入力されるまでステップ
5.6を繰り返し、駆動命令信号が入力されるとステッ
プ7へ進む。尚、上記駆動命令信号は不図示の回路に設
けられたマニュアル操作の始動スイッチがオンとなるこ
とにて形成され、上記人力ボートSDIへ入力されるも
のとし、始動スイッチが操作されることにてステップ7
へ移行スる。Step 6: Detect data input from a circuit (not shown) to the human power boat SDI of the computer, determine whether or not a drive command signal is input manually as data from the circuit (not shown), and determine whether the drive command signal is input. Steps 5 and 6 are repeated until the drive command signal is input, and the process proceeds to step 7. The drive command signal is generated when a manually operated starting switch provided in a circuit (not shown) is turned on, and is input to the human-powered boat SDI, and is generated when the starting switch is operated. Step 7
Transition to.
上記ステップ5が実行されると、上述の如く不図示の回
路との通信が許容され、この間に不図示の回路にて設定
されたモーターの回転速度情報1回転量情報2回転方向
情報等のデーターがコンピューターの入力ボートSDI
に入力される。When step 5 is executed, communication with the circuit (not shown) is allowed as described above, and during this time, data such as motor rotation speed information 1 rotation amount information 2 rotation direction information set in the circuit (not shown) is transmitted. is the computer input boat SDI
is input.
ステップ7:出力ボートPB0を0となし、不図示の回
路とコンピューターCPU間の通信を禁止し、上記設定
された回転量情報を指定パルス数としてメモリーC0U
NTに記憶させ、設定された回転速度情報を指定速度と
してVELに記憶させる。又、設定された回転方向情報
に基づいて出力ボートPB2か61又はOを出力する。Step 7: Set the output boat PB0 to 0, prohibit communication between the unillustrated circuit and the computer CPU, and store the rotation amount information set above as the specified number of pulses in the memory C0U.
The set rotational speed information is stored in the VEL as a designated speed. Further, the output boat PB2, PB61, or O is output based on the set rotational direction information.
又、入力ボートPEOからの情報1又はOをメモリーP
LEVELに入力する。入力ボートPEOはエンコーダ
ーENCと接続しており、エンコーダーENCはコード
板(パルス板)等にて構成され、モーターの回動にてパ
ルス即ち1.0信号の繰り返しを形成する。よってモー
ターが回転を開始する以前のエンコーダーENCの出力
はコード板の初期位置に応じてO又は1を出力しており
、このコード板の初期状態がメモリーPLEVELに記
憶される。Also, information 1 or O from the input boat PEO is stored in the memory P.
Enter LEVEL. The input boat PEO is connected to an encoder ENC, which is composed of a code plate (pulse plate), etc., and forms a pulse, that is, a repetition of a 1.0 signal by rotation of the motor. Therefore, the output of the encoder ENC before the motor starts rotating is O or 1 depending on the initial position of the code plate, and this initial state of the code plate is stored in the memory PLEVEL.
ステップ8:出力ボートFBIから1を出力する。これ
にてアンドゲートANI 、AN2’が開状態となり、
フリップフロップDFFIの出力及びエクスクルシブオ
アゲート8Xlの出力をアンプAPI 、AP2に伝え
る。Step 8: Output 1 from the output port FBI. This opens AND gates ANI and AN2',
The output of the flip-flop DFFI and the output of the exclusive OR gate 8Xl are transmitted to the amplifiers API and AP2.
上述の如く、トランジスターTr4には変数FMAX=
$FFに応じた電流が流れており、上述の如くフリップ
フロップOFF、は該電流値に応じた周波数のパルスを
出力し、又エクスクルシブオアゲートexIからは、上
述の如くフリップフロップDFF、の出力パルスに対し
て90℃位相のづれたパルスが出力されるため、モータ
ーの電極A、Bには90℃位相のづれた周波数$FFの
周波電圧が印加され、モーターは回転動作を開始する。As mentioned above, the transistor Tr4 has the variable FMAX=
A current corresponding to $FF is flowing, and the flip-flop OFF outputs a pulse with a frequency corresponding to the current value as described above, and the exclusive OR gate exI outputs the output of the flip-flop DFF as described above. Since a pulse with a phase difference of 90 degrees with respect to the pulse is output, a frequency voltage of a frequency $FF with a phase difference of 90 degrees is applied to electrodes A and B of the motor, and the motor starts rotating.
ステップ9:内部タイマーをリセットし、その後リセッ
トを解除する。これにてタイマーの計時が開始される。Step 9: Reset the internal timer and then release the reset. The timer now starts counting.
ステップ10:タイマーの計時が所定時間計時したか否
かを検知し、タイマーの計時時間が経過していない時に
はステップ11へ、又タイマーの計時時間が経過してい
ればステップ13へ移行する。Step 10: It is detected whether or not the timer has counted a predetermined period of time. If the timer has not elapsed, the process proceeds to step 11; if the timer has elapsed, the process proceeds to step 13.
ステップ11:入力ボートPEoからの入力信号とメモ
リーPLEVELの信号とが同一であるか否かを検知し
、同一の時には再度ステップ10へ移行し、同一でない
時にはステップ12へ移行する。Step 11: It is detected whether the input signal from the input boat PEo and the signal in the memory PLEVEL are the same. If they are the same, the process goes to step 10 again, and if they are not the same, the process goes to step 12.
上記メモリーPLEVELには、モーター起動前のエン
コーダーENCの信号がメモリーされており、その状態
からモーターが回動するとエンコーダーENCの出力信
号が変化するので、メモリーPLEVELにメモリーさ
れた信号と不一致となる。よって、このステップではエ
ンコーダーENCの信号変化を検知し、モーターが実際
に回転を開始したか否かを検知し、モーターが回動した
時にステップ12へ移行する。The memory PLEVEL stores the signal of the encoder ENC before starting the motor, and when the motor rotates from that state, the output signal of the encoder ENC changes, so it becomes inconsistent with the signal stored in the memory PLEVEL. Therefore, in this step, a change in the signal of the encoder ENC is detected to detect whether or not the motor has actually started rotating, and when the motor has started rotating, the process moves to step 12.
今モーターが上記タイマーの計時時間内に回転を開始し
ないとすると、上記ステップ10.11が繰り返され、
タイマーアップにてステップ13へ移行する。Now if the motor does not start rotating within the time counted by the timer, steps 10.11 above are repeated;
When the timer is up, the process moves to step 13.
ステップ13:変数FMAXに対して−1を行いFMA
X−1を新たな変数FMAXとする。Step 13: Add -1 to the variable FMAX and use FMA
Let X-1 be a new variable FMAX.
ステップ14:該新たな変数を前回最高周波数としてR
AMに人力する。Step 14: R with the new variable as the previous highest frequency
Manpower for AM.
ステップ15 : RAMの有効ピットデーターを1に
設定する。Step 15: Set valid pit data in RAM to 1.
ステップ16:ステップ13で求めた新たなFMAXを
出力ポートP A o 〜P A 7から出力させ、上
述の如くして電極A、Bへの駆動周波数を更新させると
共に、該FMAXをメモリーFに入力し、再度ステップ
9へ移行する。該ステップ13〜16までの処理がなさ
れることにてFMAXが−1となり、設定周波数が減少
(低下)することとなる。よってステップ8にてモータ
ーの駆動が開始されているにもかかわらず、実際にモー
ターが回動を開始しない時には所定時間ごとに設定周波
数を一定量づつ減少(低下)させる。これにてモーター
に対する駆動周波数が徐々に低下して行き、モーターに
対する駆動周波数の走査がなされる。Step 16: Output the new FMAX obtained in Step 13 from the output ports P A o to P A 7, update the driving frequency to electrodes A and B as described above, and input the FMAX to the memory F. Then, proceed to step 9 again. By performing the processing in steps 13 to 16, FMAX becomes -1, and the set frequency decreases (lowers). Therefore, even though the motor has started to be driven in step 8, if the motor does not actually start rotating, the set frequency is decreased (lowered) by a fixed amount at predetermined time intervals. As a result, the driving frequency for the motor gradually decreases, and the driving frequency for the motor is scanned.
又、上記の如くして駆動周波数の走査がなされている過
程で、モーターが回動すると上記の如くしてステップは
12へ移行する。従ってRAMにはモーターが実際に回
動を開始した周波数が記憶されることとなる。Further, when the motor rotates while the drive frequency is being scanned as described above, the step shifts to step 12 as described above. Therefore, the frequency at which the motor actually starts rotating is stored in the RAM.
以上の如くして、電極A、Bへの周波電圧の周波数が更
新(減少して行き)され、モーターが回動を開始すると
ステップ12が実行される。As described above, the frequency of the frequency voltage applied to the electrodes A and B is updated (decreased), and when the motor starts rotating, step 12 is executed.
ステップ12:入力ボートREOへ入力するエンコーダ
ーからのパルス間隔時間を計測し、モーターの回転速度
を求める。このパルス間隔1fllJfはエンコーダー
ENCから連続して入力される2つのパルス間隔時間を
測定する。Step 12: Measure the pulse interval time from the encoder input to the input boat REO to determine the rotational speed of the motor. This pulse interval 1fllJf measures the interval time between two pulses that are continuously input from the encoder ENC.
ステップ17:ステップ12で求めた検出回転速度とメ
モリーVELに記憶された指定回転速度を比較し、検出
回転速度く指定回転速度の時はステップ19へ移行し、
検出回転速度〉指定回転速度の時はステップ18へ移行
し、検出回転速度−指定回転速度の時はステップ20へ
移行する。Step 17: Compare the detected rotation speed obtained in step 12 with the specified rotation speed stored in the memory VEL, and if the detected rotation speed is less than the specified rotation speed, proceed to step 19,
Detected rotation speed> When the specified rotation speed is reached, the process moves to step 18, and when the detected rotation speed - the specified rotation speed, the process moves to step 20.
モーターは駆動周波数が低い程高速回転すると共に、上
記の如くモーターの駆動周波数は$FFから徐々に低下
させて行き、モーターを回転状態へ移行させているので
、通常モーター回転開始時では検出回転速度<VELの
関係があり、ステップ19へ移行する。The lower the driving frequency, the faster the motor rotates, and as mentioned above, the driving frequency of the motor is gradually lowered from $FF to move the motor into a rotating state, so normally when the motor starts rotating, the detected rotational speed is There is a relationship of <VEL, and the process moves to step 19.
ステップ19:メモリーFの内容、即ちモーターの回転
始動時のFMAXに対して−1を行い、FMAX−1を
メモリーFに入力する。Step 19: Subtract -1 from the contents of memory F, ie, FMAX at the time the motor starts rotating, and input FMAX-1 to memory F.
ステップ20:上記メモリーFの内容に入力ボートP
D oの値を加算する0通常入力ボートPDOには0が
入力されているため、通常はこの演算ではメモリーFの
内容は変化しない。Step 20: Input the contents of the memory F above into the board P.
Since 0 is input to the 0 normal input port PDO to which the value of Do is added, normally the contents of the memory F do not change in this operation.
ステップ21:出力ポートPAO〜PA?から上記メモ
リーFの内容を出力する。これにてモーターに対する駆
動周波数はモーター回転開始時の周波数FMAXよりも
一定値減少し、モーターは回転速度を高くする。Step 21: Output port PAO~PA? The contents of the memory F are output from. As a result, the driving frequency for the motor is reduced by a certain value from the frequency FMAX at the start of motor rotation, and the motor rotates at a higher speed.
ステップ22ニメモリーC0UNTに設定されたモータ
ーの回転数を表わすパルス数に対して−1を行う。Step 22 -1 is applied to the number of pulses representing the rotational speed of the motor set in memory C0UNT.
即ち、上記ステップ12のパルス間隔時間測定処理は、
エンコーダーENCから1パルス入力するごとに行われ
るので、ステップ上記ステップが実行されることにてモ
ーターは1パルス分駆動されたこととなり、上記の−1
を行い、残千−ター回転量を求めメモリーC0UNT
1に入力する。That is, the pulse interval time measurement process in step 12 is as follows:
This is done every time one pulse is input from the encoder ENC, so by executing the above step, the motor is driven by one pulse, and the -1 above is executed.
, calculate the remaining rotation amount and store it in the memory C0UNT.
Enter 1.
ステップ23:メモリーC0UNT=Oか否かを検知し
、C0UNT=O時は再度ステップ12へ移行し、C0
UNT=Oの時にはステップ24へ移行する。Step 23: Detect whether memory C0UNT=O or not. If C0UNT=O, go to step 12 again and C0
When UNT=O, the process moves to step 24.
即ちモーターの回転にて残モーター回転量がゼロとなっ
ていない時には再度ステップ12へ移行し、上記の動作
を繰り返す。That is, when the remaining motor rotation amount is not zero due to the rotation of the motor, the process moves to step 12 again and the above operation is repeated.
以上のステップ12,17.19〜23の動作を繰り返
すごとにモーターの駆動周波数は徐々に低下して行き、
モーターの回転速度が徐々に増加することとなる。Each time the above steps 12, 17, and 19 to 23 are repeated, the motor drive frequency gradually decreases.
The rotational speed of the motor will gradually increase.
上記ステップの繰り返しにてモーターの回転速度が指定
速度に達した場合にはステップ17にてこれが検知され
、上記ステップ19を介さずステップ20へ移行する。If the rotational speed of the motor reaches the designated speed by repeating the above steps, this is detected in step 17, and the process proceeds to step 20 without going through step 19.
よってモーターの回転数が指定回転数に達することにて
メモリーFの内容に対する−1が中止され、そ−ターは
その時点での駆動周波数で駆動され、回転速度も指定速
度となる。Therefore, when the number of rotations of the motor reaches the specified number of rotations, the -1 operation on the contents of the memory F is stopped, the motor is driven at the driving frequency at that time, and the rotational speed also becomes the specified speed.
この様にモーターが指定速度が回転している状態で、何
らかの原因にてモーターの速度か指定駆動を越えた場合
について説明する。A case will be explained in which the motor speed exceeds the specified drive for some reason while the motor is rotating at the specified speed.
この場合には、ステップ17にて回転速度>VELが検
知されるのでステップは18へ移行する。In this case, since the rotational speed>VEL is detected in step 17, the process moves to step 18.
ステップ18:メモリーFの内容とRAMに記憶された
FMAXとを比較し、F≦FMAXの時にはステップ2
5へ、又F>FMAXの時はステップ26へ移行する。Step 18: Compare the contents of memory F and FMAX stored in RAM, and if F≦FMAX, step 2
5, or if F>FMAX, proceed to step 26.
今、上記のステップにてメモリーFの内容がモーター駆
動時の内容、即ちRAMに記憶されたFMAXよりも小
さいものとする。この場合はステップ25へ移行する。Now, in the above step, it is assumed that the contents of the memory F are smaller than the contents when the motor is driven, that is, FMAX stored in the RAM. In this case, the process moves to step 25.
ステップ25:メモリーFの内容に対して+1を行い、
F+1をメモリーFに入力し、ステップ20へ移行し、
以後回転速度>V E L。Step 25: Add +1 to the contents of memory F,
Input F+1 into memory F, move to step 20,
Thereafter, rotation speed>VEL.
F≦FMAXの限りステップ12→17→18→25叫
20→21→22−23を繰り返す。As long as F≦FMAX, repeat steps 12→17→18→25 and steps 20→21→22-23.
従って回転速度が指定速度よりも高速となった場合には
、徐々に駆動周波数が増大して行き回転速度が低下する
。Therefore, when the rotational speed becomes higher than the designated speed, the driving frequency gradually increases and the rotational speed decreases.
以上説明した各ステップにて通常はモーターの回転速度
が指定速度にサーボ制御されるのであるが、上記減速動
作中に何らかの原因でメモリーFの内容をFMAXより
も大としても、指定速度まで減速出来ない場合にづいて
説明する。In each step explained above, the rotation speed of the motor is normally servo-controlled to the specified speed, but even if the contents of memory F are larger than FMAX for some reason during the deceleration operation, the speed cannot be decelerated to the specified speed. The case where there is no such information will be explained.
この様な状態()”)FMAX)がステップ18にて検
知されるとステップ26へ移行する。When such a state ()")FMAX) is detected in step 18, the process moves to step 26.
ステップ26:メモリーFの内容を変数FMAXとする
。これによりモーターの回転開始時RAMに記憶された
FMAXに対して、より高周波数のFMAXが形成され
る。Step 26: Set the contents of memory F as variable FMAX. As a result, a higher frequency FMAX is formed with respect to the FMAX stored in the RAM when the motor starts rotating.
ステップ27:RAMに上記ステップ26で形成された
FMAXを、新たな前回最高周波数として設定する。Step 27: Set FMAX formed in step 26 above in the RAM as the new previous highest frequency.
ステップ28:メモリーFの内容に+1をして、F+1
をメモリーFに入力する。Step 28: Add +1 to the contents of memory F, F+1
is input into memory F.
ステップ28’ :RAMの有効ビットデーターを1
にし、ステップ20へ移行し、以後回転速度>VEL、
F>FMAXの限りステップ12 → 17 → 18
→ 26 → 27 → 28 → 20→21→2
2−23を繰り返す。Step 28': Set the valid bit data of RAM to 1
and move to step 20, after which rotation speed>VEL,
As long as F>FMAX, step 12 → 17 → 18
→ 26 → 27 → 28 → 20 → 21 → 2
Repeat 2-23.
上記の動作にてF>FMAXとなってもモーターの回転
速度が指定速度よりも高速の時には、メモリーFの内容
を+1づつ増大させ、駆動周波数を徐々に増加させると
共に、RAMの前回最高周波数も同様に更新(増大)さ
せて行き、モーターの回転速度が徐々に減少し、モータ
ーの回転速度が指定速度となる様制御される。Even if F > FMAX in the above operation, if the motor rotation speed is higher than the specified speed, the contents of memory F are increased by +1, the drive frequency is gradually increased, and the previous highest frequency of RAM is also increased. The rotational speed of the motor is updated (increased) in the same way, and the rotational speed of the motor is gradually decreased, and the rotational speed of the motor is controlled to become the specified speed.
以上のステップ12,17〜23.25〜28までにて
モーターが指定速度となる様制御されると共に、その際
のモーター駆動周波数がモーター起動時にRAMに設定
された周波数FMAXよりも高周波数を示した時には、
その周波数がRAMに記憶され、モーター駆動に際して
の実際の最高周波数がRAMに格納される。In steps 12, 17 to 23, and 25 to 28 above, the motor is controlled to the specified speed, and the motor drive frequency at that time is higher than the frequency FMAX set in the RAM when the motor is started. At times,
The frequency is stored in RAM, and the actual highest frequency at which the motor is driven is stored in RAM.
又、上記のモーターの速度制御に際して増速駆動がなさ
れ、徐々に駆動周波数が減少させている過程で、その駆
動周波数がモーターの共振周波数となった時又はその近
傍の周波数となった際に、上記周波数をそれ以下に低下
させない様なされている。In addition, in the process of increasing the speed of the motor when controlling the speed of the motor and gradually decreasing the driving frequency, when the driving frequency becomes the resonant frequency of the motor or a frequency near it, The above-mentioned frequency is not lowered below that level.
即ち、前述の如く第1図のカウンターCOU。That is, the counter COU of FIG. 1 as described above.
は、コンパレーターPC2の出力PDから0が出力され
ている期間VCO,からのパルスを計数する様構成され
ている。又、上記コンパレータPCzは入力R,Sのパ
ルスの位相差に応じて、その位相差がゼロになる程、短
時間出力PDからOを出力する様なされ、かつモーター
が共振状態に近づけば近づく程、上記コンパレーターP
C2の入力R,Sへのパルス位相がゼロに近づく様構成
されている。従って上記カウンターC0UIのカウント
値は、共振状態に近づけば近づく程カウント値を減少さ
せ、該カウント値がモーターの共振状態又はその近傍と
なった時には所定値$3以下になる。この状態はコンパ
レーターMCI にて検知され、モーターが共振又は共
振近傍となった時にはコンパレータMCIの出力は1と
なり、これがフリッププロップDFF、にて検知され、
DFF2の出力Qが1となる。又このDFF2のQ出力
1に応答してコンパレータCP 4も1を出力し、これ
がコンピューターCPUの入力ボートPDOに入力する
。is configured to count pulses from VCO during a period in which 0 is output from output PD of comparator PC2. In addition, the comparator PCz is configured to output O from the output PD for a short time according to the phase difference between the pulses of the inputs R and S, as the phase difference becomes zero, and as the motor approaches the resonance state, , the above comparator P
The configuration is such that the pulse phase to the inputs R and S of C2 approaches zero. Therefore, the count value of the counter C0UI decreases as the motor approaches the resonance state, and when the count value reaches or is close to the resonance state of the motor, it becomes less than the predetermined value $3. This state is detected by the comparator MCI, and when the motor resonates or near resonance, the output of the comparator MCI becomes 1, which is detected by the flip-flop DFF.
The output Q of DFF2 becomes 1. In addition, in response to the Q output 1 of the DFF2, the comparator CP4 also outputs 1, which is input to the input port PDO of the computer CPU.
従ってモーターが共振状態又はその近傍となつた時に入
力ボートPDOには1が伝わっており、上記モーターの
増速制御過程にて、ステップ20にてF ” F +
P D o = F = F + 1がなされる。従っ
て増速制御にて、ステップ19にてF=F−1を行い、
周波数を減少させた後に共振状態又はその近傍の周波数
となった時にはステップ20にてFに対して+1がなさ
れ、その結果F=F−1+1=Fとなり、上記ステップ
19による周波数の減少はステップ20にてキャンセル
され、その周波数が共振周波数又はその近傍となった時
には、たとえモーターの回転速度が指定速度に達してい
なくても、それ以上低周波数となることが防止され、結
局モーターの駆動周波数は共振又はその近傍の周波数以
下には低下しない。この様にモーターの周波数を減少さ
せている際に、その周波数を制限する理由は、第5図の
如くモーターは共振周波数f1をすぎて共振周波数より
も周波数が低下すると急激に回転速度が低下するためで
あり、この様な現象が生じることを上記の周波数制限に
て防止している。Therefore, when the motor is in a resonance state or in the vicinity thereof, 1 is transmitted to the input port PDO, and in step 20 during the motor speed increase control process, F '' F +
P Do = F = F + 1 is made. Therefore, with speed increase control, F=F-1 is performed in step 19,
When the frequency reaches a resonance state or its vicinity after the frequency is decreased, +1 is added to F in step 20, and as a result, F=F-1+1=F, and the frequency decrease in step 19 is performed in step 20. When the frequency becomes at or near the resonant frequency, even if the motor rotation speed has not reached the specified speed, the frequency will be prevented from becoming any lower, and the motor drive frequency will eventually become It does not drop below the frequency at or near resonance. The reason for limiting the frequency when reducing the motor frequency in this way is that as shown in Figure 5, when the motor passes the resonant frequency f1 and the frequency drops below the resonant frequency, the rotation speed decreases rapidly. This is because such a phenomenon is prevented from occurring by the above-mentioned frequency restriction.
又、上記の如くモーターの速度制御がなされている過程
にてモーターが指定回転量駆動されると、メモリーC0
UNTの内容が0となる。Also, when the motor is driven by a specified rotation amount during the speed control of the motor as described above, the memory C0
The contents of UNT become 0.
よって、この場合はステップ24へ移行する。Therefore, in this case, the process moves to step 24.
ステップ24:出カポ−)−FBIからOを出力する。Step 24: Output O from FBI.
これにてゲートAN、、AN、が閉じ、電極A、Bへの
周波電圧の印加が禁止され、モーターは停止し、初回の
モーター駆動が終了する。As a result, the gates AN, , AN are closed, the application of the frequency voltage to the electrodes A and B is prohibited, the motor is stopped, and the first motor drive is completed.
この後ステップは上記ステップ2へ移行する。After this, the step shifts to step 2 above.
今、初回のモーター駆動に際してステップ13〜16、
又はステップ27〜28′が実行され、RAMの最高周
波数が$FFから変化している時にはRAMの有効ビッ
トが1に設定されている。Now, when driving the motor for the first time, steps 13 to 16,
Alternatively, steps 27-28' are executed and the valid bit of the RAM is set to 1 when the highest frequency of the RAM is changing from $FF.
従って初回のモーター駆動に際してモーターが実際に駆
動された最高周波数が、初回のモーター駆動作ステップ
2.3にてRAMから読み出され、出力ポートPAO〜
PA、から該前回最高周波数が出力されると共にメモリ
ーFに入力され、次回のモーター駆動に際して、モータ
ー起動時の駆動周波数が前回実際にモーターを駆動出来
た最高周波数となる様指定準備される。Therefore, the highest frequency at which the motor was actually driven during the first motor drive is read out from the RAM in step 2.3 of the first motor drive, and output ports PAO~
The highest frequency from the previous time is outputted from the PA and inputted to the memory F, so that when the next time the motor is driven, the drive frequency at the time of starting the motor is designated and prepared to be the highest frequency at which the motor could actually be driven last time.
従って次回のモーター駆動に際し不図示の凹路にて始動
スイッチがオンとなされ、上記ステップ7以後の各ステ
ップの実行によるモーター制御が行われる時点では、そ
の駆動周波数としては上記前回の最高周波数からスター
トする。Therefore, when the next time the motor is driven, the start switch is turned on at a concave path (not shown) and the motor is controlled by executing each step after step 7, the drive frequency will start from the previous highest frequency. do.
又、通常直前にモーターを駆動した際の実際にモーター
を駆動出来た最高周波数を次回のモーターの駆動周波数
とした場合、モーターはその周波数が回動することが出
来、これにて駆動周波数を$FFから走査する必要なく
直ちにモーターは回動を開始することとなる。Also, if the highest frequency that was actually able to drive the motor when the motor was driven immediately before is set as the driving frequency of the next motor, the motor will be able to rotate at that frequency, and this will change the driving frequency to $ The motor starts rotating immediately without the need for scanning from the FF.
又、初回のモーター駆動後メインスイッチSWIをオフ
としてもRAMの内容は保持されており、再度メインス
イッチSWIがオンとなってプログラムがステップ1か
ら実行された場合でも、同様に前回の最高周波数から駆
動が開始されることとなる。Furthermore, even if the main switch SWI is turned off after the first motor drive, the contents of the RAM are retained, and even if the main switch SWI is turned on again and the program is executed from step 1, the contents of the RAM will be retained from the previous highest frequency. Driving will begin.
以上の如く本発明にあっては、前回振動波モーターを駆
動した際に、モーターが実際に回動を始めた周波数を次
回のモーター駆動の起動周波数として設定し、この周波
数から所望の速度に対応する低周波数方向へ周波数を移
行させているので、直前のモーター使用時に起動を開始
した周波数から徐々にその周波数を所望速度を示す周波
数方向へ移行させることが出来、モーターを滑らかに、
かつ短時間で起動させることが可能となるものである。As described above, in the present invention, the frequency at which the motor actually started rotating when the vibration wave motor was driven last time is set as the starting frequency for the next motor drive, and the desired speed is adjusted from this frequency. Since the frequency is shifted to the lower frequency direction, it is possible to gradually shift the frequency from the frequency that started the motor when it was used just before to the frequency direction that indicates the desired speed, and the motor runs smoothly.
Moreover, it can be started up in a short time.
尚、実施例では電気−機械エネルギー変換素子として電
歪素子を示しているが、これに代えて圧電素子を用いて
も良いものである。In addition, although an electrostrictive element is shown as an electro-mechanical energy conversion element in the embodiment, a piezoelectric element may be used instead.
又、実施例にあってはモーターの回転開始時の周波数を
記憶し、これを次回の起動時の初期値として設定してい
るが、モーターの回転開始時の周波数に対して前後、所
定範囲内の周波数を記憶させたり、又は演算にて求め、
これを次回の初期値として設定しても良いものである。In addition, in the embodiment, the frequency at the time the motor starts rotating is memorized and this is set as the initial value for the next startup, but the frequency at the time the motor starts rotating is within a predetermined range. Memorize the frequency of or find it by calculation,
This may be set as the next initial value.
第1図は本発明に係る振動波モーターの制御回路の一実
施例を示す回路図、第2図は本発明に用いる振動波モー
ターの振動体上に配された電歪素子を示す構成図、第3
図は第1図示のコンパレーターPC2の動作を説明する
ための波形図、第4図(a)(b)は第1図のコンピュ
ーターCPUに内蔵されるプログラムフローを示す説明
図、第5図は本発明の振動波モーターの回転制御動作を
説明する説明図である。FIG. 1 is a circuit diagram showing an embodiment of a control circuit for a vibration wave motor according to the present invention, and FIG. 2 is a configuration diagram showing an electrostrictive element arranged on a vibrating body of a vibration wave motor used in the present invention. Third
The figure is a waveform diagram for explaining the operation of the comparator PC2 shown in Figure 1, Figures 4(a) and (b) are explanatory diagrams showing the program flow built in the computer CPU of Figure 1, and Figure 5 is an explanatory diagram showing the program flow built in the computer CPU of Figure 1. It is an explanatory view explaining rotation control operation of a vibration wave motor of the present invention.
Claims (1)
に周波信号を印加し、振動体に進行性振動波を形成し、
該振動波にて移動体を駆動する振動波モーターの制御回
路において、モーターの起動時に前記周波信号を所定の
周波数から低周波数方向へ徐々に変化させる周波数調定
手段と、該モーターの回転を検出する回転検出手段と、
前記周波数調定手段により周波数の変更がなされている
際に前記回転検出手段にてモーターの回転の開始が検出
された時の周波数に応じた周波数情報を検知する周波数
検知手段を設け、該検知手段に検知された周波数情報に
基づき次回のモーター起動時において前記周波数調定手
段にて変更される周波数の初期値を設定したことを特徴
とする振動波モーターの制御回路。(1) Applying a frequency signal to an electric-mechanical energy conversion element arranged on the vibrating body to form a progressive vibration wave in the vibrating body,
A control circuit for a vibration wave motor that drives a moving object using the vibration waves includes a frequency adjusting means for gradually changing the frequency signal from a predetermined frequency toward a lower frequency when the motor is started, and detecting rotation of the motor. rotation detection means for
A frequency detection means is provided for detecting frequency information corresponding to a frequency when the start of rotation of the motor is detected by the rotation detection means when the frequency is being changed by the frequency adjustment means, the detection means A control circuit for a vibration wave motor, characterized in that an initial value of a frequency to be changed by the frequency adjustment means at the next time the motor is started is set based on frequency information detected by the vibration wave motor.
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP62041861A JPS63209481A (en) | 1987-02-24 | 1987-02-24 | Controlling circuit of oscillatory wave motor |
US07/718,926 US5159253A (en) | 1987-02-24 | 1991-06-25 | Control device for a vibration wave motor |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP62041861A JPS63209481A (en) | 1987-02-24 | 1987-02-24 | Controlling circuit of oscillatory wave motor |
Publications (1)
Publication Number | Publication Date |
---|---|
JPS63209481A true JPS63209481A (en) | 1988-08-31 |
Family
ID=12620028
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP62041861A Expired - Lifetime JPS63209481A (en) | 1987-02-24 | 1987-02-24 | Controlling circuit of oscillatory wave motor |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPS63209481A (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5493163A (en) * | 1992-03-12 | 1996-02-20 | Canon Kabushiki Kaisha | Lens driving device employing vibration motor with backlash compensation |
US6084334A (en) * | 1997-10-29 | 2000-07-04 | Canon Kabushiki Kaisha | Driving apparatus for driving plurality of vibration type motors |
JP2007330100A (en) * | 2001-01-09 | 2007-12-20 | Pentax Corp | Ultrasonic-motor drive control device |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS59156168A (en) * | 1983-02-23 | 1984-09-05 | Canon Inc | Controller for vibration wave motor |
JPS59156169A (en) * | 1983-02-23 | 1984-09-05 | Canon Inc | Controller for vibration wave motor |
JPS61124276A (en) * | 1984-11-19 | 1986-06-12 | Marcon Electronics Co Ltd | Piezoelectric supersonic wave linear motor |
JPS61221585A (en) * | 1985-03-26 | 1986-10-01 | Canon Inc | Drive circuit of vibration wave motor |
-
1987
- 1987-02-24 JP JP62041861A patent/JPS63209481A/en not_active Expired - Lifetime
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS59156168A (en) * | 1983-02-23 | 1984-09-05 | Canon Inc | Controller for vibration wave motor |
JPS59156169A (en) * | 1983-02-23 | 1984-09-05 | Canon Inc | Controller for vibration wave motor |
JPS61124276A (en) * | 1984-11-19 | 1986-06-12 | Marcon Electronics Co Ltd | Piezoelectric supersonic wave linear motor |
JPS61221585A (en) * | 1985-03-26 | 1986-10-01 | Canon Inc | Drive circuit of vibration wave motor |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5493163A (en) * | 1992-03-12 | 1996-02-20 | Canon Kabushiki Kaisha | Lens driving device employing vibration motor with backlash compensation |
US6084334A (en) * | 1997-10-29 | 2000-07-04 | Canon Kabushiki Kaisha | Driving apparatus for driving plurality of vibration type motors |
JP2007330100A (en) * | 2001-01-09 | 2007-12-20 | Pentax Corp | Ultrasonic-motor drive control device |
JP4612662B2 (en) * | 2001-01-09 | 2011-01-12 | Hoya株式会社 | Ultrasonic motor drive controller |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US5159253A (en) | Control device for a vibration wave motor | |
US4926084A (en) | Driving apparatus for a vibration wave motor | |
US4413217A (en) | Power factor controller | |
US4492909A (en) | Device for controlling the drive of a stepping motor, to adjust the lateral stitch bight and/or the feed length of a sewing machine | |
JPH0710189B2 (en) | Vibration wave motor drive circuit | |
JPH074078B2 (en) | Control method of motor for blower of air conditioner | |
US3946293A (en) | Thyristor control system | |
JPS63209481A (en) | Controlling circuit of oscillatory wave motor | |
JPS63209482A (en) | Controlling circuit of oscillatory wave motor | |
US3952237A (en) | Rotary body control apparatus | |
JP2683196B2 (en) | Vibration drive controller | |
JP4123808B2 (en) | Control device for vibration actuator | |
JP2543679B2 (en) | Unbalanced point positioning method and apparatus used for the method | |
JP2819437B2 (en) | Ultrasonic motor drive controller | |
JPS60106380A (en) | Speed constant error correcting device for motor | |
JPH0441325B2 (en) | ||
JPS62181696A (en) | Control circuit for stepping motor | |
JPS58107094A (en) | Controller for pulse motor | |
JP2735671B2 (en) | Acceleration / deceleration servo circuit | |
JPH09187578A (en) | Servo motor controller | |
SU1381682A1 (en) | Device for controlling step motor | |
JPH0199495A (en) | Driving device of stepping motor | |
JPH087837Y2 (en) | Motor control device | |
JPH0719434B2 (en) | Rotating body drive | |
JPS59123493A (en) | Pulse generator circuit for driving motor |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
EXPY | Cancellation because of completion of term |