JPH0365088A - Controller of motor - Google Patents

Controller of motor

Info

Publication number
JPH0365088A
JPH0365088A JP1201996A JP20199689A JPH0365088A JP H0365088 A JPH0365088 A JP H0365088A JP 1201996 A JP1201996 A JP 1201996A JP 20199689 A JP20199689 A JP 20199689A JP H0365088 A JPH0365088 A JP H0365088A
Authority
JP
Japan
Prior art keywords
motor
counter
contents
integrator
pulse encoder
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
JP1201996A
Other languages
Japanese (ja)
Inventor
Takeshi Miwa
猛 三輪
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.)
Sanyo Electric Co Ltd
Original Assignee
Sanyo Electric 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 Sanyo Electric Co Ltd filed Critical Sanyo Electric Co Ltd
Priority to JP1201996A priority Critical patent/JPH0365088A/en
Publication of JPH0365088A publication Critical patent/JPH0365088A/en
Pending legal-status Critical Current

Links

Landscapes

  • Manipulator (AREA)
  • Control Of Electric Motors In General (AREA)

Abstract

PURPOSE:To shorten the initial set time by providing it with a control means, which performs the rotation control of a motor, an integrator, which mechanically counts the number of revolutions of the motor, and a setting means, which sets counter contents, and then setting the counter contents within the range of one rotation of the motor. CONSTITUTION:Since an integrator (i) holds the number of revolutions of a motor c, even if it is let alone in the conditions that a switch (m) is turned off and power supply is inhibited, it mechanically holds the number of revolutions of the motor (c). On the other hand, at the time of restart of the motor (c), the switch (m) is made, whereby power is supplied to a controller (a), a counter (k), a pulse encoder (b), and the motor (c). According to this power supply, the controller 2 gives a signal to the motor (c) so as to make it do low-speed rotation. And when it receives an origin signal from the pulse encoder (b), it sets the contents of the counter (k) according to the contents held in the integrator (i).

Description

【発明の詳細な説明】 イ)産業上の利用分野 本発明は初期設定機能を有したモータの制御装置に関す
る。
DETAILED DESCRIPTION OF THE INVENTION A) Field of Industrial Application The present invention relates to a motor control device having an initial setting function.

口〉 従来の技術 逗子、多関節型ロボット等のアーム制御等に関し、モー
タの正確な制御が行なわれるようになって来ている。第
3図に従来技術による、インクリメンタル型パルスエン
コーダ(以下PE)を用いた。モータ制御系の構成国を
示す。同図に示す従来技術では、原点位置決めを行うた
めに、まず制御装置Z(a )より予じめ決められた方
向に、回転体(e)が低速回転を行うための速度指令信
号をモータ(c)に出力し、第4図に示した様に、リミ
ットスイッチ(g)の出力がHi’ でかつ、PE(b
)の原点出力信号が“Hi”の点まで回転体(e)を低
速回転させ、原点出力信号が“H4”になった時点で、
カウンタ(k)を初期設定していた。このときのモータ
(c)の回転位置とPE(b)の原点信号及びリミット
スイッチ(g)の出力の関係を第4図に示す。ところで
この方式では、初期時、回転体(e)がリミットスイッ
チ(g)と反対位置にあった場合、回転体(e)をほぼ
回転可動範囲全職分、低速回転させる必要があり、特に
多関節型ロボットの様に、軸数の多いモータ制御系の場
合、全軸に対5て上記の処理を行う必要があり、全軸の
初期設定を終了するまでに、かなりの時間を要しtこ。
2. Description of the Related Art Regarding the arm control of tweezers, multi-jointed robots, etc., accurate control of motors has become possible. In FIG. 3, a conventional incremental pulse encoder (hereinafter referred to as PE) is used. Indicates the country where the motor control system is comprised. In the conventional technology shown in the figure, in order to perform origin positioning, first, the control device Z(a) sends a speed command signal to the motor (e) to cause the rotating body (e) to rotate at a low speed in a predetermined direction. c), and as shown in Figure 4, the output of the limit switch (g) is Hi' and PE(b).
) rotate the rotating body (e) at low speed until the origin output signal becomes "Hi", and when the origin output signal becomes "H4",
The counter (k) was initialized. FIG. 4 shows the relationship between the rotational position of the motor (c), the origin signal of the PE (b), and the output of the limit switch (g) at this time. By the way, with this method, if the rotating body (e) is initially in the opposite position to the limit switch (g), it is necessary to rotate the rotating body (e) at low speed through almost the entire range of rotational movement, especially for multi-joints. In the case of a motor control system with a large number of axes, such as a type robot, the above process must be performed for all axes, and it may take a considerable amount of time to complete the initial settings for all axes. .

ハ)発明が解決しようとする課題 本発明は、このような点に鑑みて為されたものであって
、モータの制御装置において、初期設定時間の短縮化を
図ろうとするものである。
C) Problems to be Solved by the Invention The present invention has been made in view of the above points, and is intended to shorten the initial setting time in a motor control device.

二)  課題を解決するための手段 本発明では、モータの回転力を減速機を介して回転体に
伝えるモータの制御系において、モータの回転角の変化
に応じてパルス出力をするパルスエンコーダとパルスエ
ンコーダからのパルス出力に応じてカウントアツプ又は
カウントダウンするカウンタと、このカウンタ内容を参
照しながらモータの回転制御を行う制御手段と、上記モ
ータの回転数を機械的に計数する積算器と、上記パルス
エンコーダからの原点信号を受けたどき、上記積算器の
内容を用いて上記カウンタ内容を設定する設定手段と、
を有している。
2) Means for Solving the Problems In the present invention, in a motor control system that transmits the rotational force of the motor to a rotating body via a reducer, a pulse encoder and a pulse encoder that output pulses according to changes in the rotation angle of the motor are used. a counter that counts up or down in accordance with the pulse output from the encoder; a control means that controls the rotation of the motor while referring to the contents of the counter; an integrator that mechanically counts the number of rotations of the motor; Setting means for setting the contents of the counter using the contents of the integrator upon receiving the origin signal from the encoder;
have.

ホ)作 用 モータの1回転範囲内でカウンタ内容の設定が行なえる
ので、初期設定の時間が短かくなる。
E) Function Since the counter contents can be set within the range of one revolution of the motor, the initial setting time is shortened.

へ)実施例 第1図に本発明による、モータ制御系の構成図そ、第2
図に本発明による積算器の出力信号とPEの原点出力信
号の回転体の回転位置との関係を示す。また、第1図に
おいて、第3図と同一部分5二は同一符号を付しである
。同図において、(i)j!モータ(C)の出力軸(h
)に設けられた突起によって、モータの各回転毎にその
スイッチ(j)が押される積算器であって、スイッチ(
j)の押される方向に応じて加算もしくは減算を行ない
、モータの回転数が機械的に行なわれる。(k)は上記
パルスエンコーダ(b)からのパルス及びモータ(C)
の回転方向信号を受けてカウントアツプ、又はカウント
ダウンをするカウンタであり、上記制御装置(a)へそ
の内容を伝えるとともに制御装置(a)から内容のリセ
ット信号が送られる。また、上記パルスエンコーダ(b
)はモータ(C)の1回転中に、1000パルスを出力
し、1回の原点信号を出力する。この原点信号は制御装
置(a)へ伝えられる。(1ンは電源装置を示し、スイ
ッチ(M)を介して上記制御装置(a)、カウンタ(k
)、パルスエンコーダ(b)及びモータ(C)へ与えら
れる。
f) Embodiment Fig. 1 is a configuration diagram of a motor control system according to the present invention.
The figure shows the relationship between the output signal of the integrator according to the present invention and the origin output signal of the PE with the rotational position of the rotating body. Further, in FIG. 1, the same parts 52 as in FIG. 3 are given the same reference numerals. In the figure, (i)j! Output shaft (h) of motor (C)
) is an integrator whose switch (j) is pressed each time the motor rotates by a protrusion provided on the switch (
Addition or subtraction is performed depending on the direction in which j) is pressed, and the number of rotations of the motor is determined mechanically. (k) is the pulse from the above pulse encoder (b) and the motor (C)
This is a counter that counts up or counts down in response to a rotational direction signal, and transmits the contents to the control device (a) and also sends a reset signal for the contents from the control device (a). In addition, the pulse encoder (b
) outputs 1000 pulses and one origin signal during one rotation of the motor (C). This origin signal is transmitted to the control device (a). (Number 1 indicates a power supply device, which connects the control device (a) and counter (k) via a switch (M).
), the pulse encoder (b) and the motor (C).

二のようなモータの制御装置において、積算器(i)は
機械的にモータ(c)の回転数を保持しているので、ス
イッチ(M)を切って、電源供給を禁止5た状態で放置
しても、積算!(i )は機械的にモータ(C)の回転
数を保持する。一方、モータ(c)の動作の再開に際し
て、スイッチ(M)を投入して制御−装置(a)、カウ
ンタ(k)、パルスエンコーダ(b)及びモータ(c)
にt源供給が為される。この電力供給に応じて制御装置
(a)はモータ(c)に信号を与えて低速回転を行なわ
しめる。そしてパルスエンコーダ(b)から原点信号を
受けると、積算器(i)の保持内容に応じて、カウンタ
(k)の内容を設定する。積算!(i)の保持内容を(
N)この設定方法としては、モータ(c)1回転したと
きのパルスエンコーダ(b)の出力パルス数をpとする
と、カウンタ(k)の内容をNXpとすると良い。こう
してカウンタ(k)の内容が設定されfS後、制御装置
(a)はカウンタ(k)内容でモータ(り)の回転状態
を検出しながら、所定のプログラムに沿ってモータ(c
)の回転を制御する。
In a motor control device like the one in 2, the integrator (i) mechanically maintains the rotation speed of the motor (c), so turn off the switch (M) and leave it in a state where the power supply is prohibited. Even so, it's cumulative! (i) mechanically maintains the rotational speed of the motor (C). On the other hand, when restarting the operation of the motor (c), the switch (M) is turned on and the controller (a), counter (k), pulse encoder (b) and motor (c)
A t source is supplied to the In response to this power supply, the control device (a) gives a signal to the motor (c) to cause it to rotate at a low speed. When the origin signal is received from the pulse encoder (b), the contents of the counter (k) are set according to the contents held in the integrator (i). addition! The retained contents of (i) are (
N) As for this setting method, if the number of output pulses of the pulse encoder (b) when the motor (c) rotates once is p, then the content of the counter (k) is preferably NXp. In this way, the contents of the counter (k) are set, and after fS, the control device (a) detects the rotational state of the motor (ri) based on the contents of the counter (k), and controls the motor (c) according to a predetermined program.
) to control the rotation.

従って、このようなモータの制御装置において回転体(
e)がΔθ=2π/R(R:減速比)回転するまでにカ
ウンタ(k)の内容を設定出来る。
Therefore, in such a motor control device, the rotating body (
The contents of the counter (k) can be set until e) rotates Δθ=2π/R (R: reduction ratio).

ト)発明の効果 以」−1述べた如く本発明モータの制御装置は、モータ
の回転角の変化に応じてパルス出力をするパルスエンコ
ーダとパルスエンコーダからのパルス出力に応じてカウ
ントアツプ又はカウントダウンするカウンタと、このカ
ウンタ内容を参照しながらモータの回転制御を行う制御
手段と、上記モータの回転数を機械的に計数する積算器
と、上記パルスエンコーダからの原点信号を受けたとき
、上記積″KWの内容を用いて上記カウンタ内容を設定
する設定手段と、を有しているので、少いモータ河転量
で、モータ制御のための初期設定が行なわれ、例えばマ
ニュピユレータ動作等の初期設定に要する時間が短縮さ
れ、初期設定の効率化が図れる。
g) Effects of the Invention -1 As stated above, the motor control device of the present invention has a pulse encoder that outputs pulses according to changes in the rotation angle of the motor, and a pulse encoder that counts up or counts down according to the pulse output from the pulse encoder. a counter; a control means for controlling the rotation of the motor while referring to the contents of the counter; an integrator for mechanically counting the number of revolutions of the motor; and a setting means for setting the contents of the counter using the contents of KW, the initial settings for motor control can be performed with a small amount of motor rotation, and can be used, for example, for initial settings of manipulator operation, etc. The time required is shortened and initial settings can be made more efficient.

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

第1図は本発明モータ、!I+御装置のブロック図、第
2図はその動作を説明するタイミング図、第3図は従来
のモータ制御装置のプロ7り図、第4図はその動作を説
明するタイミング図である。 a・・・制御装置、b・・・パルスエンコーダ、C・・
・モータ、d・・・減速機、e・・・回転体、k・・・
カウンタ、1・・・電源装置。 第1図
Figure 1 shows the motor of the present invention! FIG. 2 is a block diagram of the I+ control device, FIG. 2 is a timing diagram explaining its operation, FIG. 3 is a schematic diagram of a conventional motor control device, and FIG. 4 is a timing diagram explaining its operation. a...control device, b...pulse encoder, C...
・Motor, d...Reducer, e...Rotating body, k...
Counter, 1...Power supply device. Figure 1

Claims (1)

【特許請求の範囲】[Claims] 1)モータの回転力を減速機を介して回転体に伝えるモ
ータの制御系において、モータの回転角の変化に応じて
パルス出力をするパルスエンコーダとパルスエンコーダ
からのパルス出力に応じてカウントアップ又はカウント
ダウンするカウンタと、このカウンタ内容を参照しなが
らモータの回転制御を行う制御手段と、上記モータの回
転数を機械的に計数する積算器と、上記パルスエンコー
ダからの原点信号を受けたとき、上記積算器の内容を用
いて上記カウンタ内容を設定する設定手段と、を有して
成るモータの制御装置。
1) In the motor control system that transmits the rotational force of the motor to the rotating body via the reducer, there is a pulse encoder that outputs pulses according to changes in the rotation angle of the motor, and a pulse encoder that outputs pulses depending on the pulse output from the pulse encoder. a counter that counts down; a control means that controls the rotation of the motor while referring to the contents of the counter; an integrator that mechanically counts the number of revolutions of the motor; A motor control device comprising: setting means for setting the contents of the counter using the contents of the integrator.
JP1201996A 1989-08-02 1989-08-02 Controller of motor Pending JPH0365088A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP1201996A JPH0365088A (en) 1989-08-02 1989-08-02 Controller of motor

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP1201996A JPH0365088A (en) 1989-08-02 1989-08-02 Controller of motor

Publications (1)

Publication Number Publication Date
JPH0365088A true JPH0365088A (en) 1991-03-20

Family

ID=16450212

Family Applications (1)

Application Number Title Priority Date Filing Date
JP1201996A Pending JPH0365088A (en) 1989-08-02 1989-08-02 Controller of motor

Country Status (1)

Country Link
JP (1) JPH0365088A (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5758905A (en) * 1994-12-28 1998-06-02 Kabushiki Kaisha Nihon Pisco Tube joint

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5758905A (en) * 1994-12-28 1998-06-02 Kabushiki Kaisha Nihon Pisco Tube joint

Similar Documents

Publication Publication Date Title
JPH0365088A (en) Controller of motor
JP6565752B2 (en) Robot control apparatus and robot control method
JPH0623681A (en) Origin return device for robot
JP3013998B2 (en) Rotary axis zero return method in numerical controller
JP2516975B2 (en) Angular acceleration control method
JPH0431603Y2 (en)
JP3565617B2 (en) Automatic crane turning control method
JPS5932260B2 (en) Kamukensakuuchi
JPS6380303A (en) Speed control method for industrial robot
JPS63219010A (en) Control device for motor
JPS61156406A (en) Control method of industrial robot
JP3250326B2 (en) Control device and control method for stepping motor
JP2537469Y2 (en) Control device for industrial robot with rotating external axis
JPS63240386A (en) Controlling method for speed of motor power device
JPH01233603A (en) Orientation stopping controller
JPS61273603A (en) Turning device of articurated robot
JPH04326104A (en) Controller for robot
JPH01321192A (en) Working aera limiter for robot
JPS6224304A (en) Method for resetting to original point for robot
CN114274132A (en) Method for managing accuracy of power-on joint of multi-joint robot
JPS63206197A (en) Control mechanism of motor for controlling arm movement
JPH04294406A (en) Rotational position detecting device for robot
JPH02139607A (en) Position controller for moving body
JPH06320452A (en) Control method for industrial robot
JPH0624886U (en) Industrial robot