JP2687639B2 - Motor control device - Google Patents

Motor control device

Info

Publication number
JP2687639B2
JP2687639B2 JP1335202A JP33520289A JP2687639B2 JP 2687639 B2 JP2687639 B2 JP 2687639B2 JP 1335202 A JP1335202 A JP 1335202A JP 33520289 A JP33520289 A JP 33520289A JP 2687639 B2 JP2687639 B2 JP 2687639B2
Authority
JP
Japan
Prior art keywords
angle
rotation angle
output shaft
motor
current
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 - Fee Related
Application number
JP1335202A
Other languages
Japanese (ja)
Other versions
JPH03196314A (en
Inventor
剛 榎田
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nissan Motor Co Ltd
Original Assignee
Nissan Motor Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Nissan Motor Co Ltd filed Critical Nissan Motor Co Ltd
Priority to JP1335202A priority Critical patent/JP2687639B2/en
Publication of JPH03196314A publication Critical patent/JPH03196314A/en
Application granted granted Critical
Publication of JP2687639B2 publication Critical patent/JP2687639B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Landscapes

  • Length Measuring Devices With Unspecified Measuring Means (AREA)
  • Machine Tool Positioning Apparatuses (AREA)
  • Control Of Position Or Direction (AREA)

Description

【発明の詳細な説明】 (産業上の利用分野) 本発明は、モータをフィードバック制御する制御装置
に係り、特にモータの出力軸を一定方向に回転させ、多
数回の位置決め制御を長時間正確に行ない得るようにし
たモータの制御装置に関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a control device for feedback controlling a motor, and more particularly, to rotate a motor output shaft in a fixed direction to accurately perform positioning control a number of times for a long time. The present invention relates to a control device for a motor that can be performed.

(従来の技術) 一般に、工作機械等に設けられた各種移動機構は、サ
ーボモータ等の制御モータによって駆動されるようにな
っている。このような制御モータは、いわゆるフィード
バック制御がなされ、その移動機構を加工工程に合せて
正確に作動させるようになっている。
(Prior Art) Generally, various moving mechanisms provided in a machine tool or the like are driven by a control motor such as a servo motor. The control motor is subjected to so-called feedback control so that its moving mechanism can be operated accurately in accordance with the machining process.

従来、このような移動機構のうち、例えば加工工具を
自動的に切り換えるNCタレットと呼ばれる機構にもこの
ような制御モータが使用されており、第5図に示すよう
な制御装置によって制御されているものがある。
Conventionally, among such moving mechanisms, such a control motor is also used for a mechanism called an NC turret that automatically switches a machining tool, for example, and is controlled by a control device as shown in FIG. There is something.

図示するように、各種加工工具1が取付けられたタレ
ット2は、サーボモータ3によって駆動され、夫々の加
工工具1を図示省略するワークに対して位置決めするよ
うになっている。
As shown in the drawing, the turret 2 to which various processing tools 1 are attached is driven by a servo motor 3 to position each processing tool 1 with respect to a work (not shown).

サーボモータ3の出力軸は、減速器4を介してタレッ
ト2の回転軸に接続されており、この回転軸がサーボモ
ータ3によって回転するとタレット2本体が回転し、こ
れに取付けられた加工工具1は、所定の加工位置に位置
決めされるようになっている。
The output shaft of the servomotor 3 is connected to the rotary shaft of the turret 2 via a decelerator 4, and when the rotary shaft is rotated by the servomotor 3, the turret 2 main body rotates, and the machining tool 1 attached thereto Are positioned at predetermined processing positions.

タレット2は、通常、加工工程順に合わせて加工工具
1が取付けられており、タレット2が一方向に回転する
ことによって、夫々の加工工具1はワークに対して順次
所定の加工を行なうようになっている。
The turret 2 is usually attached with the processing tools 1 in accordance with the order of the processing steps, and when the turret 2 rotates in one direction, the respective processing tools 1 sequentially perform predetermined processing on the workpiece. ing.

そして、このようにタレット2を一方向に回転させる
サーボモータ3は、例えば図示する制御装置5によって
制御されるようになっている。
The servo motor 3 for rotating the turret 2 in one direction in this way is controlled by, for example, the control device 5 shown in the figure.

サーボモータ3は、出力軸の回転に応じて所定周期の
パルス信号を出力するパルスジェネレータ(以下にPGと
いう。)6が取付けられている。
The servo motor 3 is provided with a pulse generator (hereinafter referred to as PG) 6 that outputs a pulse signal of a predetermined cycle according to the rotation of the output shaft.

そして、このサーボモータ3を制御する制御装置5に
は、そのPG6が出力するパルス信号を入力する現在角度
カウンタ7が具えられており、この現在角度カウンタ7
は、そのパルス信号を累積してカウントし、出力軸を位
置決めするための所定の基準角度からの現在の出力軸の
回転角度を減算器9に出力するようになっている。
The control device 5 for controlling the servo motor 3 is provided with a current angle counter 7 for inputting the pulse signal output from the PG 6 thereof.
Is configured to accumulate and count the pulse signals and output the current rotation angle of the output shaft from a predetermined reference angle for positioning the output shaft to the subtractor 9.

又、この制御装置5には、タレット2を位置決めする
ための出力軸の目標回転角度を記憶した目標角度メモリ
8が備えられている。この目標角度メモリ8には、サー
ボモータ3の出力軸を回転させる目標値となる上記基準
角度からの目標角度が記憶されており、目標角度メモリ
8は、順次この目標角度を減算器9に出力するようにな
っている。
Further, the control device 5 is provided with a target angle memory 8 that stores a target rotation angle of the output shaft for positioning the turret 2. The target angle memory 8 stores a target angle from the reference angle, which is a target value for rotating the output shaft of the servomotor 3, and the target angle memory 8 sequentially outputs the target angle to the subtractor 9. It is supposed to do.

これらの現在の回転角度及び目標角度を入力する減算
器9は、目標角度から現在の回転角度を減算して移動角
度量を算出し、これを制御部10に出力するようになって
いる。つまり、制御部10には、現在の回転角度から目標
角度に出力軸を移動させるために算出した移動角度量が
入力される。この移動角度量は、出力軸の回転角度がそ
の目標角度に近づくにつれて小さくなり、目標角度にな
ると出力されなくなる。
The subtractor 9 that inputs the current rotation angle and the target angle calculates the movement angle amount by subtracting the current rotation angle from the target angle, and outputs this to the control unit 10. That is, the control unit 10 receives the movement angle amount calculated for moving the output shaft from the current rotation angle to the target angle. This movement angle amount becomes smaller as the rotation angle of the output shaft approaches the target angle, and is not output at the target angle.

そして、この移動角度量を入力する制御部10は、この
移動角度量に従ってサーボモータ3を駆動させる駆動信
号を駆動部11に出力し、駆動部11は、この駆動信号に応
じて減算器9が算出した移動角度量だけ出力軸を回転さ
せる駆動電力をサーボモータ3に供給するようになって
いる。
Then, the control unit 10 which inputs this movement angle amount outputs a drive signal for driving the servo motor 3 in accordance with this movement angle amount to the drive unit 11, and the drive unit 11 causes the subtractor 9 to operate in response to this drive signal. Driving power for rotating the output shaft by the calculated movement angle amount is supplied to the servo motor 3.

したがって、制御装置5は、目標角度メモリ8に記憶
された目標角度と、現在角度カウンタ7が検出した現在
の出力軸の回転角度との偏差分だけサーボモータ3を駆
動し、その目標角度にサーボモータ3の出力軸を回転さ
せ、タレット2の位置決めを行なうようになっている。
Therefore, the control device 5 drives the servo motor 3 by the deviation amount between the target angle stored in the target angle memory 8 and the current rotation angle of the output shaft detected by the current angle counter 7, and servos to the target angle. The turret 2 is positioned by rotating the output shaft of the motor 3.

(発明が解決しようとする課題) しかしながら、このような従来の制御装置にあって
は、現在角度カウンタがPGから出力されるパルス信号を
カウントすることによって、出力軸の現在の回転角度を
求めるようになっているので、このカウンタの容量を越
えるまで出力軸が回転した場合、つまりタレットを一方
向に多数回転させる長時間に亙る加工を行なった場合に
は、現在角度カウンタにいわゆるオーバーフローが生
じ、これが生じた時点で現在角度カウンタはリセットさ
れてしまうために、制御部に入力する移動角度量が実際
に必要な移動角度量と相違してしまい、タレットを間違
った位置に位置決めしてしまうという問題が生じる。例
えば、現在角度カウンタがカウントすることができるパ
ルス数が800パルスである場合に、PGが出力したパルス
数がこの800パルス以上となるまで出力軸が回転する
と、現在角度カウンタは入力したパルス数が800になっ
た時点でリセットされてしまい、減算器が入力する現在
の回転角度が0となる。これにより減算器は、目標回転
角度からこの現在の回転角度を減算することにより、制
御部に出力する移動角度量が実際に必要な移動角度量よ
り過大な移動角度量となってしまい、タレットは間違っ
た位置に位置決めされてしまう。
(Problems to be Solved by the Invention) However, in such a conventional control device, the current angle counter counts the pulse signals output from the PG to obtain the current rotation angle of the output shaft. Therefore, if the output shaft rotates until it exceeds the capacity of this counter, that is, if processing is performed for a long time to rotate the turret a large number of times in one direction, so-called overflow occurs in the current angle counter, When this happens, the current angle counter is reset, so the amount of movement angle input to the control unit differs from the actually required amount of movement angle, and the turret is positioned at the wrong position. Occurs. For example, if the number of pulses that the current angle counter can count is 800, if the output shaft rotates until the number of pulses output by the PG exceeds this 800 pulses, the current angle counter will display the number of input pulses. It will be reset when it reaches 800, and the current rotation angle input to the subtractor will be zero. As a result, the subtractor subtracts this current rotation angle from the target rotation angle, so that the movement angle amount output to the control unit becomes an excessive movement angle amount than the actually required movement angle amount, and the turret It will be positioned in the wrong position.

したがって、このような制御装置によって制御される
タレットが設けられた工作機械では、タレットを多数回
連続的に位置決めして行なうような長時間に亙る加工を
行なうことができず、生産性を向上させることができな
い等の問題があった。
Therefore, in a machine tool provided with a turret controlled by such a control device, it is not possible to perform machining for a long period of time, which is performed by continuously positioning the turret many times, thereby improving productivity. There was a problem such as not being able to do it.

本発明は、このような従来の問題点を解決するために
成されたものであり、モータの出力軸を一定方向にみ回
転させ、多数回の位置決め制御を長時間亙り正確に行な
い得るモータの制御装置を提供することを目的とする。
The present invention has been made in order to solve such a conventional problem, and a motor capable of accurately performing a large number of positioning controls for a long time by rotating the output shaft of the motor in a fixed direction. An object is to provide a control device.

(課題を解決するための手段) 前記目的を達成するための本発明は、モータの出力軸
を一定方向にのみ回転させて、複数回の位置決めを行う
モータの制御装置であって、モータの出力軸が、所定角
度回転するごとにパルス信号を出力するパルスジェネレ
ータと、パルスジェネレータから出力されるパルス信号
の数を累積カウントし、前記モータの出力軸に定められ
た基準位置からの、モータの出力軸の回転角度を検出す
る回転角度検出手段と、前記回転角度検出手段によって
検出された前回の位置決め終了時の回転角度を記憶する
前角度記憶手段と、前記回転角度検出手段が検出した回
転角度および前記前角度記憶手段が記憶している回転角
度に基づいて、前記モータの出力軸の現在の回転角度を
算出する現在角度算出手段と、今回の位置決めで、前記
モータの出力軸を回転させるべき目標回転角度を記憶す
る目標角度記憶手段と、 前記現在角度算出手段が算出した回転角度および当該
目標角度記憶手段が記憶している回転角度に基づいて、
今回の位置決めにおける前記出力軸の回転角度量を決定
する回転角度制御手段と、回転角度制御手段が決定した
回転角度に基づいて、モータを駆動する駆動制御手段と
を有してなり、前記回転角度制御手段は、前記回転角度
検出手段が検出した回転角度を記憶し、この回転角度
が、単位回転角度に達するたびに前記前角度記憶手段お
よび前記回転角度検出手段の回転角度をリセットし、ま
た前記リセットの回数を記憶することを特徴とする。
(Means for Solving the Problem) The present invention for achieving the above-mentioned object is a motor control device that rotates an output shaft of a motor only in a fixed direction to perform positioning a plurality of times. A pulse generator that outputs a pulse signal each time the shaft rotates by a predetermined angle, and the number of pulse signals output from the pulse generator are cumulatively counted, and the motor output from a reference position defined on the output shaft of the motor Rotation angle detection means for detecting the rotation angle of the shaft, front angle storage means for storing the rotation angle at the end of the previous positioning detected by the rotation angle detection means, rotation angle detected by the rotation angle detection means, and A current angle calculation unit that calculates a current rotation angle of the output shaft of the motor based on the rotation angle stored in the front angle storage unit, and a current position calculation unit. Therefore, based on the target angle storage means for storing the target rotation angle for rotating the output shaft of the motor, the rotation angle calculated by the current angle calculation means and the rotation angle stored by the target angle storage means,
The rotation angle control means for determining the rotation angle amount of the output shaft in the current positioning, and the drive control means for driving the motor based on the rotation angle determined by the rotation angle control means are provided. The control means stores the rotation angle detected by the rotation angle detection means, resets the rotation angles of the front angle storage means and the rotation angle detection means each time the rotation angle reaches a unit rotation angle, and It is characterized in that the number of resets is stored.

(作用) 上記のように構成された本発明は、以下のように作用
する。
(Operation) The present invention configured as described above operates as follows.

モータの出力軸が回転するとパルスジェネレータから
パルス信号が出力される。このパルス信号は、モータの
出力軸が所定角度(たとえば0.2度)回転するごとに1
パルス出力される。回転角度検出手段は、このパルス信
号を入力するごとにカウント数を1ずつインクリメント
する。この回転角度検出手段は、モータの出力軸の単位
回転相当のパルス信号をカウントすることができるもの
である。たとえばモータの出力軸が0.2度回転するごと
にパルス信号を出力するエンコーダの場合には、1800カ
ウント(単位回転が1回転の場合)できるカウンターで
ある。
When the output shaft of the motor rotates, the pulse signal is output from the pulse generator. This pulse signal is 1 every time the output shaft of the motor rotates a predetermined angle (for example, 0.2 degrees).
Pulse output. The rotation angle detecting means increments the count number by 1 each time the pulse signal is input. The rotation angle detecting means can count the pulse signals corresponding to the unit rotation of the output shaft of the motor. For example, in the case of an encoder that outputs a pulse signal every time the output shaft of the motor rotates 0.2 degrees, the counter is capable of counting 1800 (when the unit rotation is 1 rotation).

回転角度検出手段のカウント数は角度制御手段によっ
て記憶され、このカウント数がモータの出力軸の単位回
転分のカウント数に達したときには、そのカウント数が
角度制御手段によって0にリセットされる。したがっ
て、回転角度検出手段のカウント数と角度制御手段に記
憶される回転角度検出手段のカウント数は、常にモータ
の出力軸の単位回転分以内のカウント数となる。
The count number of the rotation angle detection means is stored by the angle control means, and when the count number reaches the count number for the unit rotation of the output shaft of the motor, the count number is reset to 0 by the angle control means. Therefore, the count number of the rotation angle detection unit and the count number of the rotation angle detection unit stored in the angle control unit are always within the unit rotation of the output shaft of the motor.

一方、前角度記憶手段にはモータの出力軸が目標角度
まで回転したときの回転角度検出手段のカウント数が記
憶されるが、このカウント数も回転角度検出手段のリセ
ットと同時に0にリセットされる。したがって、前角度
記憶手段のカウント数も常にモータの出力軸の単位回転
分以外のカウント数となる。
On the other hand, the front angle storage means stores the count number of the rotation angle detection means when the output shaft of the motor rotates to the target angle. This count number is also reset to 0 at the same time as the rotation angle detection means is reset. . Therefore, the count number of the front angle storage means is always a count number other than the unit rotation of the output shaft of the motor.

現在角度算出手段は、回転角度検出手段のカウント数
と前角度記憶手段のカウント数とからモータの出力軸が
基準位置からどの程度の角度回転したかを算出する。こ
の現在角度検出手段によって算出される回転角度も常に
モータの出力軸の単位回転分以内の角度となる。
The current angle calculation means calculates how much the output shaft of the motor has rotated from the reference position based on the count number of the rotation angle detection means and the count number of the previous angle storage means. The rotation angle calculated by the present angle detection means is always within the unit rotation of the output shaft of the motor.

目標角度記憶手段には、モータの出力軸に定められた
基準位置からの目標角度(単位回転以内の角度とは限ら
ない)が記憶されているが、移動量算出手段では、この
目標角度記憶手段に記憶されている基準位置からの目標
角度と角度制御手段に記憶されている回転角度検出手段
のカウント数およびリセット回数とから当該目標角度ま
での移動量(単位回転以内の移動量とは限らない)を算
出する。
The target angle storage means stores a target angle (not necessarily an angle within a unit rotation) from a reference position defined on the output shaft of the motor, but the movement amount calculation means uses the target angle storage means. From the reference angle stored in the reference position and the count number and reset number of the rotation angle detection unit stored in the angle control unit to the target angle (not necessarily the movement amount within a unit rotation) ) Is calculated.

駆動制御手段は、この移動量に基づいモータを駆動す
る。
The drive control means drives the motor based on this movement amount.

(実施例) 以下に、本発明に係るモータの制御装置を図面に基づ
いて詳細に説明する。
(Embodiment) Hereinafter, a motor control device according to the present invention will be described in detail with reference to the drawings.

第1図は、本発明に係るモータの制御装置の概略構成
図であり、第2図は、そのモータの制御装置の動作を示
すフローチャートである。又、第3図は、その制御装置
によりモータを制御する際に第1図に示すA〜Fにおい
て出力される角度データを例示した図であり、第4図に
は、他の実施例としての本発明に係るモータの制御装置
の概略構成図が示されている。尚、第1図及び第4図に
は、従来の技術で説明した部材と同一部材には同一符号
が付してあり、これらの詳細な説明は省略する。
FIG. 1 is a schematic configuration diagram of a motor control device according to the present invention, and FIG. 2 is a flowchart showing an operation of the motor control device. Further, FIG. 3 is a view exemplifying the angle data output in A to F shown in FIG. 1 when the motor is controlled by the control device, and FIG. 4 shows another embodiment. The schematic block diagram of the control apparatus of the motor which concerns on this invention is shown. In FIGS. 1 and 4, the same members as those described in the related art are designated by the same reference numerals, and detailed description thereof will be omitted.

第1図に示すように、本発明に係るモータの制御装置
20は、従来の制御装置と同様に目標角度メモリ8に記憶
された目標角度に出力軸が回転するまでサーボモータ3
を駆動させるようになっている。
As shown in FIG. 1, a motor control device according to the present invention.
20 is the servo motor 3 until the output shaft rotates to the target angle stored in the target angle memory 8 as in the conventional control device.
Is driven.

この制御スイッチ20には、前記回転角度検出手段を構
成するPG6、現在角度カウンタ7、減算器9及び前角度
メモリ21が備えられている。
The control switch 20 is provided with a PG 6, which constitutes the rotation angle detecting means, a current angle counter 7, a subtractor 9 and a front angle memory 21.

現在角度カウンタ7は、従来ものと同一であり、PG6
が出力するパルス信号を入力することによって、出力軸
を位置決めするための所定の基準角度からの現在の出力
軸の回転角度を減算器9に出力するようになっている。
The current angle counter 7 is the same as the conventional one and the PG6
By inputting the pulse signal output from the output shaft, the current rotation angle of the output shaft from the predetermined reference angle for positioning the output shaft is output to the subtractor 9.

そして、これらの回転角度を入力する減算器9は、現
在カウンタ7から入力した回転角度から前角度メモリ21
から入力した回転角度を減算している。前角度メモリ21
は、連続して複数回行われる位置決めのうち、前回に行
われた位置決め時にサーボモータ3から停止したときの
現在角度カウンタ7から出力される出力軸の回転角度を
記憶するメモリである。したがって、この減算器9によ
って行われる減算は、今回行われた位置決めによっての
み出力軸が回転した回転移動量(以下に移動角度量とい
う。)を算出する処理である。
Then, the subtractor 9 for inputting these rotation angles uses the front angle memory 21 based on the rotation angles currently input from the counter 7.
The input rotation angle is subtracted from. Front angle memory 21
Is a memory for storing the rotation angle of the output shaft output from the current angle counter 7 when the servo motor 3 is stopped at the time of the previously performed positioning among a plurality of consecutively performed positionings. Therefore, the subtraction performed by the subtractor 9 is a process of calculating the rotational movement amount (hereinafter referred to as the movement angle amount) in which the output shaft is rotated only by the positioning performed this time.

算出された移動角度量は、データ拡張器22を介して前
記現在角度算出手段としての加算器23に出力するように
なっている。
The calculated movement angle amount is output to the adder 23 as the current angle calculation means via the data expander 22.

このデータ拡張器22は、減算器9が出力する回転角度
量を示す16ビットの角度データを加算器23が演算する32
ビットのデータに拡張変換するものであり、減算器9を
従来のものを利用し、加算器23には処理速度の速いもの
を使用したため、1データを表わすビット数を整合させ
ために備えられているが、減算器9が出力する角度デー
タと加算器23が演算するデータとの整合がなされていれ
ば不要となる。
In the data extender 22, the adder 23 calculates 16-bit angle data indicating the rotation angle amount output by the subtractor 32 32
This is for performing extended conversion into bit data, and the conventional subtractor 9 is used and the adder 23 having a high processing speed is used, so that it is provided for matching the number of bits representing one data. However, if the angle data output by the subtractor 9 and the data calculated by the adder 23 are matched, it is unnecessary.

そして、このように減算器9が算出した移動角度量を
入力する加算器23は、前角度メモリ27に記憶されている
回転角度とその移動角度量とを加算する。
Then, the adder 23, which inputs the movement angle amount calculated by the subtractor 9 in this way, adds the rotation angle stored in the front angle memory 27 and the movement angle amount.

この前角度メモリ27は、前述した前角度メモリ21と同
様に、前回に行われた位置決め時にサーボモータ3が停
止したときに現在角度カウンタ7から出力される出力軸
の回転角度(前角度)を記憶するメモリであって、この
前角度を加算器23に出力するようになっている。
The front angle memory 27 stores the rotation angle (front angle) of the output shaft output from the current angle counter 7 when the servo motor 3 is stopped at the time of the positioning performed last time, similarly to the front angle memory 21 described above. It is a memory for storing and outputs the front angle to the adder 23.

そして、加算器23は、これらの移動角度量と前角度と
を加算して基準角度からの現在の出力軸の回転角度(以
下に現在角度という。)を算出し、これを現在角度メモ
リ24に記憶させるようになっている。
Then, the adder 23 calculates the current rotation angle of the output shaft from the reference angle (hereinafter referred to as the current angle) by adding the movement angle amount and the previous angle, and stores this in the current angle memory 24. It is designed to be remembered.

また、このような現在の出力軸の回転角度は、出力軸
の位置決めが終了するたびに、角度制御部25によって現
在角度メモリ24から前角度メモリ21、27に出力される。
前角度メモリ21、27に出力された回転角度は、ここで記
憶されて、次回の位置決め時に用いられる前回の出力軸
の回転角度のデータとなる。
The current rotation angle of the output shaft is output from the current angle memory 24 to the front angle memories 21 and 27 by the angle control unit 25 every time the positioning of the output shaft is completed.
The rotation angle output to the front angle memories 21 and 27 is stored here and becomes the data of the previous rotation angle of the output shaft used at the next positioning.

この現在角度メモリ24に記憶された現在角度は、前記
角度制御手段としての角度制御部25によって基準角度か
ら1回転未満の角度となるように演算されるようになっ
ている。
The present angle stored in the present angle memory 24 is calculated by the angle control unit 25 as the angle control means so that the present angle is less than one rotation from the reference angle.

この角度制御部25は、現在角度メモリ24が記憶した現
在角度の絶対値が360度以上となった場合には、この絶
対値から360度を減算した値を減算器26に出力させるよ
うになっている。つまり、現在角度メモリ24からは、常
に出力軸の基準角度から1回転未満となった現在角度が
減算器26に出力されるようになっている。
When the absolute value of the current angle stored in the current angle memory 24 becomes 360 degrees or more, the angle control section 25 outputs a value obtained by subtracting 360 degrees from this absolute value to the subtractor 26. ing. That is, the current angle memory 24 always outputs to the subtractor 26 the current angle which is less than one rotation from the reference angle of the output shaft.

又、角度制御部25は、従来と同一の目標角度メモリ8
に記憶された目標角度についても上記現在角度に対応さ
せるために、基準角度に対して1回転未満の角度となる
ように演算する。
Further, the angle control unit 25 uses the same target angle memory 8 as the conventional one.
In order to correspond to the above-mentioned current angle, the target angle stored in 1 is also calculated so as to be less than one rotation with respect to the reference angle.

角度制御部25は、現在角度メモリ24が記憶した現在角
度の絶対値が360度以上となった回数を記憶し、目標角
度メモリ8の目標角度の絶対値からこの回数分の回転角
度を減算した目標角度を減算器26に出力させるようにな
っている。つまり、目標角度メモリ8からは、現在角度
メモリ24と同様に、常に出力軸の基準角度に対して1回
転未満分の目標角度が減算器26に出力されるようになっ
ている。
The angle control unit 25 stores the number of times that the absolute value of the current angle stored in the current angle memory 24 becomes 360 degrees or more, and subtracts the rotation angle for this number of times from the absolute value of the target angle in the target angle memory 8. The target angle is output to the subtractor 26. That is, like the current angle memory 24, the target angle memory 8 always outputs the target angle for less than one rotation to the subtractor 26 with respect to the reference angle of the output shaft.

さらに、角度制御部25は、現在角度メモリ24が記憶し
た現在角度の絶対値が360度以上となった場合には、現
在角度カウンタ7及び前角度メモリ21をリセットし、減
算器9により新たに移動角度量が求められるようにする
と同時に、前角度メモリ27もリセットし、現在角度メモ
リ24に新たに現在角度を記憶させることができるように
する。
Further, when the absolute value of the current angle stored in the current angle memory 24 becomes 360 degrees or more, the angle control unit 25 resets the current angle counter 7 and the previous angle memory 21, and the subtractor 9 newly adds the new value. At the same time that the amount of movement angle is obtained, the front angle memory 27 is also reset so that the current angle memory 24 can store a new current angle.

そして、このように基準角度に対して1回転未満の角
度となった現在角度と目標角度とを入力する減算器26
は、従来の減算器と同様に目標角度から現在角度を減算
して移動角度量を算出し、これを制御部10に出力するよ
うになっている。
Then, the subtractor 26 for inputting the current angle and the target angle which have become less than one rotation with respect to the reference angle in this way.
Like the conventional subtractor, subtracts the current angle from the target angle to calculate the movement angle amount, and outputs it to the control unit 10.

制御部10は、入力した移動量に従ってサーボモータ3
を駆動させる駆動信号を駆動部11に出力し、駆動部11
は、この駆動信号に応じて減算器26が算出した移動角度
量だけ出力軸を回転させる駆動電力をサーボモータ3に
供給するようになっている。
The control unit 10 controls the servo motor 3 according to the input movement amount.
The drive signal for driving the
Supplies to the servomotor 3 drive power for rotating the output shaft by the movement angle amount calculated by the subtractor 26 according to the drive signal.

このように構成された本発明のモータの制御装置20
は、第2図に示すフローチャートに基づいて動作する。
The motor control device 20 of the present invention configured as described above
Operates based on the flowchart shown in FIG.

まず、減算器9によって算出された移動回転量が加算
器23に入力すると、加算器23は、この移動回転量と前角
度メモリ27に記憶された前角度とを加算して現在角度を
算出し、これを現在角度メモリ24に記憶させる。そし
て、角度制御部25は、現在角度メモリ24に記憶されてい
る現在角度θ1を入力し(ステップ1)、この現在角度
θ1の絶対値が360度以上となっているか否か判断す
る。現在角度θ1の絶対値が360度以上となっていなか
った場合には、角度制御部25は入力した目標角度θ1を
そのまま減算器26に出力させる(ステップ2)。
First, when the movement rotation amount calculated by the subtractor 9 is input to the adder 23, the adder 23 adds the movement rotation amount and the front angle stored in the front angle memory 27 to calculate the current angle. , This is stored in the current angle memory 24. Then, the angle control unit 25 inputs the current angle θ1 stored in the current angle memory 24 (step 1) and determines whether the absolute value of the current angle θ1 is 360 degrees or more. If the absolute value of the current angle θ1 is not equal to or greater than 360 degrees, the angle control unit 25 outputs the input target angle θ1 as it is to the subtractor 26 (step 2).

一方、角度制御部25は、入力した現在角度θ1の絶対
値が360度以上となっている場合には、フラグnに現在
角度θ1の絶対値が360度以上となった回数を記憶し
(ステップ3)、目標角度θ1の絶対値から360度を減
算した値を減算器26に出力させる。又、このとき角度制
御部25は、現在角度カウンタ7、前角度メモリ21及び前
角度メモリ27をリセットし、減算器9により新たに基準
角度からの出力軸の移動角度量が求められるようにする
と共に、現在角度メモリ24に新たに基準角度からの出力
軸の現在角度を記憶させることができるようにする(ス
テップ4)。
On the other hand, when the absolute value of the input current angle θ1 is 360 degrees or more, the angle control unit 25 stores the number of times the absolute value of the current angle θ1 is 360 degrees or more in the flag n (step 3) The value obtained by subtracting 360 degrees from the absolute value of the target angle θ1 is output to the subtractor 26. Further, at this time, the angle control unit 25 resets the current angle counter 7, the front angle memory 21, and the front angle memory 27 so that the subtracter 9 can newly obtain the moving angle amount of the output shaft from the reference angle. At the same time, the current angle of the output shaft from the reference angle can be newly stored in the current angle memory 24 (step 4).

次に、角度制御部25は、目標角度メモリ8に記憶され
ている目標角度θ2を入力する(ステップ5)。
Next, the angle control unit 25 inputs the target angle θ2 stored in the target angle memory 8 (step 5).

そして、角度制御部25は、目標角度θ2の絶対値が、
現在角度θ1の絶対値が360度以上となった回数と同一
回転数分の角度以上となっているか否か、つまりステッ
プ3においてフラグnに記憶した回数と同一回転数分の
角度以上となっているか否かを判断し、目標角度θ2の
絶対値がその角度以上でない場合には入力した目標角度
θ2をそのまま減算器26に出力させる(ステップ6)。
Then, the angle control unit 25 determines that the absolute value of the target angle θ2 is
Whether or not the absolute value of the present angle θ1 is equal to or greater than the number of rotations equal to the number of rotations of 360 degrees or more, that is, the number of rotations equal to or greater than the number of rotations stored in the flag n in step 3 If the absolute value of the target angle θ2 is not equal to or more than that angle, the input target angle θ2 is directly output to the subtractor 26 (step 6).

一方、目標角度θ2の絶対値がその角度以上となって
いた場合には、角度制御部25は、この目標角度θ2の絶
対値からこの回数と同一回転数分の角度を減算し、これ
を減算器26に出力させる(ステップ7)。
On the other hand, when the absolute value of the target angle θ2 is equal to or greater than that angle, the angle control unit 25 subtracts the number of rotations equal to this number of times from the absolute value of the target angle θ2, and subtracts this. It is output to the container 26 (step 7).

これにより減算器26は、このように出力軸の基準角度
に対して常に1回転未満の角度となった目標角度及び現
在角度を入力することによって、目標角度から現在角度
を減算して移動量を算出し、これを制御部10に出力す
る。そして、制御部10は、入力した移動量に従ってサー
ボモータ3を駆動させる駆動信号を駆動部11に出力し、
駆動制御部11は、この駆動信号に応じて減算器26が算出
した移動量だけ出力軸を回転させる駆動電力をサーボモ
ータ3に供給する。
As a result, the subtractor 26 subtracts the current angle from the target angle to calculate the movement amount by inputting the target angle and the current angle which are always less than one rotation with respect to the reference angle of the output shaft. It is calculated and output to the control unit 10. Then, the control unit 10 outputs a drive signal for driving the servo motor 3 according to the input movement amount to the drive unit 11,
The drive controller 11 supplies the servomotor 3 with drive power for rotating the output shaft by the amount of movement calculated by the subtractor 26 in response to the drive signal.

したがって、サーボモータ3は、減算器26が算出した
移動量、つまり現在角度と目標角度との差分だけサーボ
モータ3を駆動し、目標角度に出力軸を回転させ、タレ
ット2の位置決めを行なうことができる。
Therefore, the servomotor 3 drives the servomotor 3 by the amount of movement calculated by the subtractor 26, that is, the difference between the current angle and the target angle, rotates the output shaft to the target angle, and positions the turret 2. it can.

ここで、さらにこの制御装置20によってサーボモータ
3が制御される具体的な様子を第3図に基づいて説明す
る。第3図には、サーボモータ3の出力軸の状態に応じ
て第1図に示すA〜Fにおいて出力される角度量が示さ
れている。尚、ここではサーボモータ3は、出力軸が基
準角度になっている初期状態から制御されるものとし、
又、目標角度メモリ8には、第3図に示す通り、90,32
0,430,830の目標角度が予め記憶されているものとす
る。
Here, a specific manner in which the servomotor 3 is controlled by the control device 20 will be described with reference to FIG. FIG. 3 shows the angle amounts output in A to F shown in FIG. 1 according to the state of the output shaft of the servomotor 3. Incidentally, here, the servo motor 3 is assumed to be controlled from the initial state in which the output shaft is at the reference angle,
In addition, as shown in FIG.
It is assumed that the target angles of 0,430,830 are stored in advance.

まず、制御装置20が作動すると、角度制御部25は、前
述したように、現在角度メモリ24に記憶されている現在
角度を入力し、この現在角度の絶対値が360度以上とな
っているか否か判断する。起動時は出力軸が回転してい
ないので、出力軸の角度は0度であり、C,D,E,Fは0度
となっている。
First, when the control device 20 operates, the angle control unit 25 inputs the current angle stored in the current angle memory 24, as described above, and determines whether the absolute value of this current angle is 360 degrees or more. To determine. Since the output shaft does not rotate at startup, the angle of the output shaft is 0 degree and C, D, E, F are 0 degree.

次に、角度制御部25は、目標角度メモリ8に記憶され
ている目標角度を入力し、この目標角度の絶対値が、現
在角度の絶対値が360度以上となった回数と同一の回転
数分の角度以上となっているか否か判断するが、ここで
は同様にまだ出力軸が回転していないので、Aには目標
角度である90度が出力される。
Next, the angle control unit 25 inputs the target angle stored in the target angle memory 8, and the absolute value of this target angle is the same as the number of rotations when the absolute value of the current angle becomes 360 degrees or more. Although it is determined whether the angle is equal to or greater than the minute angle, the output shaft has not yet rotated in the same manner, so that the target angle of 90 degrees is output to A.

すると、Bには90度が出力され、サーボモータ3は出
力軸が90度になるまで駆動される。
Then, 90 degrees is output to B, and the servo motor 3 is driven until the output shaft reaches 90 degrees.

そして、出力軸が90度になると、Cは90度となり、D,
Eは0度であるので、減算器9及び加算器23によって算
出され、現在角度メモリ24に記憶される現在角度は90度
となる。
Then, when the output axis becomes 90 degrees, C becomes 90 degrees, and D,
Since E is 0 degree, the current angle calculated by the subtractor 9 and the adder 23 and stored in the current angle memory 24 is 90 degrees.

次に、位置決めがなされると、現在角度メモリ24に記
憶された現在角度は90度であるので、角度制御部25はこ
の90度をそのまま減算器26に出力させ、Fは90度とな
る。又、次の目標角度320度もそのまま減算器26に出力
され、Aは320度となる。
Next, when the positioning is performed, the current angle stored in the current angle memory 24 is 90 degrees, so the angle control unit 25 outputs the 90 degrees as it is to the subtractor 26, and F becomes 90 degrees. The next target angle of 320 degrees is also output to the subtractor 26 as it is, and A becomes 320 degrees.

すると、Bでは320−90=230度となり、制御部10は出
力軸を230度回転させる。
Then, in B, 320-90 = 230 degrees, and the control unit 10 rotates the output shaft by 230 degrees.

出力軸が230度回転すると、現在カウンタ7が基準角
度から現在までの角度量を記憶しているので、Cは320
度となる。又、前メモリ21には前に位置決めされた角度
(90度)が記憶されているので、Dは90度となる。
When the output shaft rotates by 230 degrees, the counter 7 currently stores the angle amount from the reference angle to the present, so C is 320.
Degree. Further, since the angle (90 degrees) that was previously positioned is stored in the front memory 21, D becomes 90 degrees.

そして、現在角度メモリ24には、減算器9によって算
出された320−90=230度に、前角度メモリ27に記憶され
た90度(E)が加算器23によって加算され、230+90=3
20度の現在角度が記憶される。
Then, in the current angle memory 24, the 90 degrees (E) stored in the previous angle memory 27 is added to the 320-90 = 230 degrees calculated by the subtractor 9 by the adder 23, and 230 + 90 = 3 degrees.
The current angle of 20 degrees is stored.

さらに続けて位置決めが行われると、現在角度メモリ
24に記憶された現在角度は320度であるので、角度制御
部25はこの320度をそのまま減算器26に出力させ、Fは3
20度となる。又、次の目標角度430度もそのまま減算器2
6に出力され、Aは430度となる。
When positioning is further continued, the current angle memory
Since the current angle stored in 24 is 320 degrees, the angle control unit 25 outputs the 320 degrees as it is to the subtractor 26, and F is 3
It will be 20 degrees. The next target angle of 430 degrees is also subtracted by the subtractor 2
It is output to 6 and A becomes 430 degrees.

すると、Bでは430−320=110度となり、制御部10は
出力軸を110度回転させる。
Then, in B, 430−320 = 110 degrees, and the control unit 10 rotates the output shaft by 110 degrees.

そして、これにより出力軸がその110度のうちの40度
回転すると、現在カウンタ7が出力する角度Cは360度
となる。又、前メモリ21には前に位置決めされた角度
(320度)が記憶されているので、Dは320度となる。こ
れにより現在角度メモリ24には、前角度メモリ27(E)
が320度であるので、360−320+320=360度が記憶され
る。
As a result, when the output shaft rotates 40 degrees out of 110 degrees, the angle C currently output by the counter 7 becomes 360 degrees. Further, since the angle (320 degrees) that was previously positioned is stored in the front memory 21, D becomes 320 degrees. As a result, the current angle memory 24 is stored in the previous angle memory 27 (E).
Is 320 degrees, 360-320 + 320 = 360 degrees is stored.

すると、角度制御部25は、この現在角度メモリ24に記
憶された現在角度が360度となったので、減算器26には3
60−360=0度を出力させる。又、角度制御部25は、目
標角度(430度)を430−360=70度にして減算器26に出
力させる。これにより、Fは0度、Aは70度となり、B
は残りの角度分の70度となり、制御部10は出力軸を残り
の70度回転させる。
Then, the angle control unit 25 determines that the current angle stored in the current angle memory 24 is 360 degrees, and therefore the subtractor 26 sets the current angle to 3 degrees.
60-360 = 0 degree is output. Further, the angle control unit 25 sets the target angle (430 degrees) to 430-360 = 70 degrees and outputs it to the subtractor 26. As a result, F becomes 0 degrees, A becomes 70 degrees, and B
Becomes 70 degrees corresponding to the remaining angle, and the control unit 10 rotates the output shaft by the remaining 70 degrees.

さらに、角度制御部25は、現在角度メモリ24に記憶さ
れた現在角度が360度になったので、現在角度カウンタ
7、前角度メモリ21及び前角度メモリ27をリセットし、
その残りの70度までの移動角度量を減算器9により算出
させると共に、現在角度メモリ24に新たに基準角度から
の現在角度を記憶させるようにする。
Furthermore, since the current angle stored in the current angle memory 24 has reached 360 degrees, the angle control unit 25 resets the current angle counter 7, the front angle memory 21, and the front angle memory 27,
The remaining angle of movement up to 70 degrees is calculated by the subtracter 9, and the current angle from the reference angle is newly stored in the current angle memory 24.

そして、出力軸がその70度回転し終ると、Cは70度、
Dは0度、Eは0度であり、現在角度メモリ24には、70
−0+0=70度が記憶される。
And when the output shaft finishes rotating by 70 degrees, C becomes 70 degrees,
D is 0 degree, E is 0 degree, and the current angle memory 24 has 70
−0 + 0 = 70 degrees is stored.

同様に次に位置決めが行なわれると、現在角度メモリ
24に記憶された現在角度は70度であるので、E及びFは
70度となる。
Similarly, when the next positioning is performed, the current angle memory
Since the current angle stored in 24 is 70 degrees, E and F are
It will be 70 degrees.

ここで、角度制御部25は、フラグnがすでに1になっ
ているので、目標角度830度を830−360×1=470度とし
て減算器26に出力する。(Aは470度となる。) すると、Bは470−70=400度となり、制御部10は出力
軸を400度回転させる。
Here, since the flag n has already been set to 1, the angle control unit 25 outputs the target angle 830 degrees to the subtractor 26 as 830−360 × 1 = 470 degrees. (A becomes 470 degrees.) Then, B becomes 470−70 = 400 degrees, and the control unit 10 rotates the output shaft by 400 degrees.

そして、これにより出力軸がその400度のうちの310度
回転すると、現在カウンタ7が出力する角度Cは360度
となる。又、前メモリ21には前に位置決めされた角度
(70)が記憶されているので、Dは70度となる。
As a result, when the output shaft rotates 310 degrees out of the 400 degrees, the angle C currently output by the counter 7 becomes 360 degrees. Further, since the angle (70) positioned in the front is stored in the front memory 21, D becomes 70 degrees.

そして、前角度メモリ27には70度が記憶されているの
で、現在角度メモリ24には、360−70+70=360度が記憶
される。すると、角度制御部25は、この現在角度メモリ
24に菊された現在角度が再び360度となっているので、
減算器26には360−360=0度の現在角度を出力させる。
又、角度制御部25は、目標角度(470度)を470−360=1
10度にして減算器26に出力させる。これにより、Fは0
度、Aは110となり、Bは残りの角度分の110度となり、
制御部10は出力軸を残り110度回転させる。同時に、角
度制御部25は、現在角度メモリ24に記憶された現在角度
が360度になったので、現在角度カウンタ7、前角度メ
モリ21及び前角度メモリ27をリセットし、その残りの11
0度までの移動角度量を減算器9により算出させると共
に、現在角度メモリ24に新たに基準角度からの現在角度
を記憶させるようにする。
Since the front angle memory 27 stores 70 degrees, the current angle memory 24 stores 360-70 + 70 = 360 degrees. Then, the angle control unit 25 displays the current angle memory.
Since the current angle that was chrysanthemum on 24 is 360 degrees again,
The subtracter 26 outputs the current angle of 360-360 = 0 degree.
Further, the angle control unit 25 sets the target angle (470 degrees) to 470-360 = 1.
It is set to 10 degrees and output to the subtractor 26. As a result, F is 0
Degrees, A becomes 110, B becomes 110 degrees for the remaining angles,
The control unit 10 rotates the output shaft by 110 degrees remaining. At the same time, the angle control unit 25 resets the current angle counter 7, the front angle memory 21, and the front angle memory 27 because the current angle stored in the current angle memory 24 becomes 360 degrees, and the remaining 11
The moving angle amount up to 0 degrees is calculated by the subtracter 9, and the current angle from the reference angle is newly stored in the current angle memory 24.

そして、出力軸がその110度回転し終ると、Cは110
度、Dは0度、Eは0度となり、現在角度メモリ24に
は、110−0+0=110度の現在角度が記憶される。
Then, when the output shaft has finished rotating 110 degrees, C becomes 110
The degree, D is 0 degree, and E is 0 degree, and the present angle memory 24 stores the present angle of 110-0 + 0 = 110 degrees.

したがって、このように加算器23によって算出された
現在角度は、角度制御部25により、常に基準角度に対し
て1回転未満の角度となるので、従来のように現在の回
転角度を正確に検出できない状態が起らず、モータの出
力軸を一方向に多数回転させる長時間に亙る位置決め制
御が可能となる。
Therefore, the current angle thus calculated by the adder 23 is always less than one rotation with respect to the reference angle by the angle control unit 25, and thus the current rotation angle cannot be accurately detected as in the conventional case. The state does not occur, and it becomes possible to perform positioning control over a long period of time by rotating the output shaft of the motor a large number in one direction.

又、上記実施例の他に第4図に示すように、現在角度
カウンタ7が出力する基準角度から現在の回転角度まで
の回転角度を加算器23に直接入力するように構成し、こ
の現在角度カウンタ7を減算器26によって、目標角度と
現在角度との角度差が0度となった場合、又は角度制御
部25によって、現在角度の絶対値が360度となった場合
に夫々リセットさせるようにしても良い。このようにす
ることによって、現在角度カウンタ7からは、前に位置
決めされた回転角度からの現在までの移動角度が出力さ
れるので、加算器23は、上記実施例と同様にこの移動角
度量及び前回転角度を加算して現在角度を算出し、この
現在角度を現在角度メモリ24に記憶させることができ、
角度制御部25がこの現在角度を常に基準角度に対して1
回転未満の角度にして減算器26に出力することによっ
て、上記実施例と同様にモータの出力軸を一方向に多数
回転させる長時間に亙る位置決め制御を行なえるように
なる。
In addition to the above embodiment, as shown in FIG. 4, the rotation angle from the reference angle output by the current angle counter 7 to the current rotation angle is directly input to the adder 23. The counter 7 is reset by the subtracter 26 when the angle difference between the target angle and the current angle becomes 0 degrees, or when the absolute value of the current angle becomes 360 degrees by the angle control unit 25, respectively. May be. By doing so, the current angle counter 7 outputs the movement angle up to the present from the previously positioned rotation angle, so that the adder 23 determines this movement angle amount and The current angle can be calculated by adding the previous rotation angle, and this current angle can be stored in the current angle memory 24.
The angle control unit 25 always sets the present angle to 1 with respect to the reference angle.
By making the angle less than the rotation and outputting the angle to the subtractor 26, it becomes possible to perform the positioning control for a long time in which the output shaft of the motor is rotated many times in one direction as in the above embodiment.

(発明の効果) 以上の説明により明らかなように、本発明にあっては
以下のような効果を奏す。
(Effects of the Invention) As is clear from the above description, the present invention has the following effects.

回転角度検出手段のカウント数が常にモータの出力軸
の単位回転分以内のカウント数となるようにして、出力
軸を目標回転角度まで回転させることができる構成にし
たので、従来のように、限られたカウント数しかカウン
トできない回転角度検出手段を用いた場合であっても、
回転角度検出手段のカウントのオーバーフローによって
回転角度が正確に検出することができなくなってしまう
ような事態を回避でき、モータの出力軸を一方向に多数
回転させる位置決め制御を高精度でできるようになる。
Since the count number of the rotation angle detecting means is always within the unit rotation amount of the output shaft of the motor, and the output shaft can be rotated to the target rotation angle, the conventional limit Even when using a rotation angle detection means that can count only the counted number,
It is possible to avoid a situation in which the rotation angle cannot be accurately detected due to the overflow of the count of the rotation angle detection means, and it is possible to perform highly accurate positioning control for rotating the output shaft of the motor in one direction. .

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

第1図は本発明に係るモータの制御装置の概略構成図、
第2図はそのモータの制御装置の動作を示すフローチャ
ート、第3図はその制御装置によりモータを制御する際
に第1図に示すA〜Fにおいて出力される角度データに
例示した図、第4図は他の実施例としての本発明に係る
モータの制御装置の概略構成図、第5図は従来のモータ
の制御装置の説明図である。 3……サーボモータ、6……PG(回転角度検出手段)、
7……現在角度カウンタ(回転角度検出手段)、8……
目標角度メモリ(目標角度記憶手段)、9……減算器
(回転角度検出手段)、10……制御部(駆動制御手
段)、11……駆動部(駆動制御手段)、21……前角度メ
モリ(回転角度検出手段)、23……加算器(現在角度算
出手段)、24……現在角度メモリ(現在角度算出手
段)、25……角度制御部(角度制御手段)、26……減算
器(駆動制御手段)、27……前角度メモリ(前角度記憶
手段)。
FIG. 1 is a schematic configuration diagram of a motor control device according to the present invention,
FIG. 2 is a flow chart showing the operation of the motor control device, and FIG. 3 is a diagram exemplifying the angle data output in A to F shown in FIG. 1 when the motor is controlled by the control device. FIG. 5 is a schematic configuration diagram of a motor control device according to another embodiment of the present invention, and FIG. 5 is an explanatory diagram of a conventional motor control device. 3 ... Servo motor, 6 ... PG (rotation angle detecting means),
7 ... Current angle counter (rotation angle detecting means), 8 ...
Target angle memory (target angle storage means), 9 ... subtractor (rotation angle detection means), 10 ... control section (drive control means), 11 ... drive section (drive control means), 21 ... front angle memory (Rotation angle detection means), 23 ... adder (current angle calculation means), 24 ... current angle memory (current angle calculation means), 25 ... angle control unit (angle control means), 26 ... subtractor ( Drive control means), 27 ... Front angle memory (front angle storage means).

Claims (1)

(57)【特許請求の範囲】(57) [Claims] 【請求項1】モータ(3)の出力軸を一定方向にのみ回
転させて、複数回の位置決めを行うモータ(3)の制御
装置であって、 当該モータ(3)の出力軸が、所定角度回転するごとに
パルス信号を出力するパルスジェネレータ(6)と、 当該パルスジェネレータ(6)から出力されるパルス信
号の数を累積カウントし、前記モータ(3)の出力軸に
定められた基準位置からの、モータ(3)の出力軸の回
転角度を検出する回転角度検出手段(7)と、 前記回転角度検出手段(7)によって検出された、前回
の位置決め終了時の回転角度を記憶する前角度記憶手段
(21,27)と、 前記回転角度検出手段(7)が検出した回転角度および
前記前角度記憶手段(21,27)が記憶している回転角度
に基づいて、現在の前記モータ(3)の出力軸の回転角
度を算出する現在角度算出手段(23)と、 前記モータ(3)の出力軸を回転させるべき目標回転角
度を記憶する目標角度記憶手段(8)と、 前記現在角度算出手段(23)が算出した回転角度および
当該目標角度記憶手段(8)が記憶している回転角度に
基づいて、前記モータ(3)の出力軸の回転角度量を決
定する回転角度制御手段(24,25,26)と、 当該回転角度制御手段(24,25,26)が決定した回転角度
に基づいて、モータ(3)を駆動する駆動制御手段(1
0,11)とを有してなり、 前記回転角度制御手段(24,25,26)は、前記回転角度検
出手段(7)が検出した回転角度を記憶し、この回転角
度が、単位回転角度に達するたびに前記前角度記憶手段
(21,27)および前記回転角度検出手段(7)の回転角
度をリセットし、また前記リセットの回数を記憶するこ
とを特徴とするモータの制御装置。
1. A control device for a motor (3) that performs positioning a plurality of times by rotating the output shaft of the motor (3) only in a fixed direction, wherein the output shaft of the motor (3) has a predetermined angle. A pulse generator (6) that outputs a pulse signal each time it rotates, and cumulatively counts the number of pulse signals that are output from the pulse generator (6), from the reference position defined on the output shaft of the motor (3). A rotation angle detecting means (7) for detecting the rotation angle of the output shaft of the motor (3), and a previous angle for storing the rotation angle at the end of the previous positioning detected by the rotation angle detecting means (7). Based on the storage means (21, 27), the rotation angle detected by the rotation angle detection means (7) and the rotation angle stored by the front angle storage means (21, 27), the current motor (3 ) Output shaft rotation angle A current angle calculation means (23), a target angle storage means (8) that stores a target rotation angle for rotating the output shaft of the motor (3), and a current angle calculation means (23). Rotation angle control means (24, 25, 26) for determining the rotation angle amount of the output shaft of the motor (3) based on the rotation angle and the rotation angle stored in the target angle storage means (8), Drive control means (1) for driving the motor (3) based on the rotation angle determined by the rotation angle control means (24, 25, 26).
0, 11) and the rotation angle control means (24, 25, 26) stores the rotation angle detected by the rotation angle detection means (7), and this rotation angle is a unit rotation angle. The motor control device is characterized in that the rotation angles of the front angle storage means (21, 27) and the rotation angle detection means (7) are reset each time the above-mentioned is reached, and the number of resets is stored.
JP1335202A 1989-12-26 1989-12-26 Motor control device Expired - Fee Related JP2687639B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP1335202A JP2687639B2 (en) 1989-12-26 1989-12-26 Motor control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP1335202A JP2687639B2 (en) 1989-12-26 1989-12-26 Motor control device

Publications (2)

Publication Number Publication Date
JPH03196314A JPH03196314A (en) 1991-08-27
JP2687639B2 true JP2687639B2 (en) 1997-12-08

Family

ID=18285903

Family Applications (1)

Application Number Title Priority Date Filing Date
JP1335202A Expired - Fee Related JP2687639B2 (en) 1989-12-26 1989-12-26 Motor control device

Country Status (1)

Country Link
JP (1) JP2687639B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113970312A (en) * 2021-09-17 2022-01-25 深圳市恒天伟焱科技股份有限公司 Angle detection method, angle detection device, computer program product and storage medium

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5990551U (en) * 1982-12-10 1984-06-19 津田駒工業株式会社 Origin return device for NC indexing
JPH0731546B2 (en) * 1986-06-30 1995-04-10 豊田工機株式会社 Positioning device for rotating body

Also Published As

Publication number Publication date
JPH03196314A (en) 1991-08-27

Similar Documents

Publication Publication Date Title
US6701212B2 (en) Lost motion correction system and lost motion correction method for numerical control machine tool
US5153490A (en) Numerical control apparatus of machines
EP0232305B1 (en) Machine tool control systems
KR910006499B1 (en) Numerical controller
JPH0239303A (en) Numerical controller containing detecting function for follow-up error
CN116820034B (en) Shaft mode switching method and device and related equipment
JP2687639B2 (en) Motor control device
WO1999040493A1 (en) Method for controlling feeding motion of numerical controlled machine and numerically controlled machine
JPH03288908A (en) Gear pitch error correcting system for numerical controller
JPS63156639A (en) Position control method and device for motor drive element of nc and cnc machine tool
JPS6332608A (en) Numerical controller
JPH0772913A (en) Error correcting system for machine tool
JPH04213707A (en) Angular positioning device
US20020193906A1 (en) Method for setting a moving position in a machine tool
JPS61184606A (en) Machine's position detector
JPS6377638A (en) Numerically controlled machine tool
JP2813352B2 (en) Positioning device
JPH05100723A (en) Tool length correcting system for machine tool
JP2703096B2 (en) Teaching method of robot system with conveyor
JP3433817B2 (en) Feed control device
KR890002434B1 (en) Numerical control apparatus
WO1981000073A1 (en) Method of constantly controlling peripheral speed
JPH02212905A (en) Nc program route profiling device and semi-automatic manipulator
JPS6352207A (en) Numerical controller
JPS6125501B2 (en)

Legal Events

Date Code Title Description
FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20080822

Year of fee payment: 11

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20080822

Year of fee payment: 11

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090822

Year of fee payment: 12

LAPS Cancellation because of no payment of annual fees