JPS59170902A - 制御装置 - Google Patents
制御装置Info
- Publication number
- JPS59170902A JPS59170902A JP58044951A JP4495183A JPS59170902A JP S59170902 A JPS59170902 A JP S59170902A JP 58044951 A JP58044951 A JP 58044951A JP 4495183 A JP4495183 A JP 4495183A JP S59170902 A JPS59170902 A JP S59170902A
- Authority
- JP
- Japan
- Prior art keywords
- range
- motion
- movable
- axis
- machine
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Program-control systems
- G05B19/02—Program-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form
- G05B19/19—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
- G05B19/21—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device
- G05B19/23—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for point-to-point control
- G05B19/231—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of program data in numerical form characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path using an incremental digital measuring device for point-to-point control the positional error is used to control continuously the servomotor according to its magnitude
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/37—Measurements
- G05B2219/37313—Derive speed from position
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Safety Devices In Control Systems (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
産業上の利用分野
本発明は機械の可動部の可動範囲を制限する制御装置近
ンて関するものである。
ンて関するものである。
従来例の構成とその問題点
一般に機械のoJ動部の周辺に(徒他の装置が設置さ扛
るために可動部が他の装置に衝突する可能性かある。こ
扛を防ぐためには機械の可動部のiiJ動範囲を設ける
必要かある。従来は可動部力に’pJ動範囲の境界を越
えたことを検出するのにリミットスイッチを用いてbだ
。このリミットスイッチを用いた可動範囲を・制限する
制御装置を、xy’y−プルをもつ2軸ロボットを例(
/Cとり訣、明する。
るために可動部が他の装置に衝突する可能性かある。こ
扛を防ぐためには機械の可動部のiiJ動範囲を設ける
必要かある。従来は可動部力に’pJ動範囲の境界を越
えたことを検出するのにリミットスイッチを用いてbだ
。このリミットスイッチを用いた可動範囲を・制限する
制御装置を、xy’y−プルをもつ2軸ロボットを例(
/Cとり訣、明する。
xyデチールを・もつ2軸口承り)(d第1図(・′C
示ずように、Xデープル1をX軸−モータ2の回転によ
って移動するものである。従来のxyテーブルをもつ2
軸ロボットの可動範囲全制限する制モ14]装置は、リ
ミットスイッチ7.8に、■二ってXラー−フ゛ル1か
可動範囲の境界に移動し、たこと全検出し−CXC玉軸
タ2の回転を停止上さぜ、リミットスイッチ6.6によ
ってyテーブル3が町11カ範囲の境界に移動したこと
を検出してy軸モータ4の回転を停止させるものであっ
た。このような構成で(・」、[jJ動範囲の変更には
りミツトスイッチ5,6,7゜8の設定位置の変更が必
要となり、操作が繁雑であった。寸だ、リミットスイッ
チ5.6.γ、8を他の部品に隣接して設定する場合、
リミノトスィノチ5,6,7.8自体の大きさのため(
・【設定できない範囲ができてし11/′X、その11
ではす、?7ノトスイノチ5,6.’7.8か使えない
場合か牛しった5、 さも(ハ)二、一度すミノ[・スイッチ6.6.了、8
を設定してし丑えは、位16”検出の繰返し精度は得ら
7Lるか、利用者か望むf装置(/こリミットスイッチ
5.6,7.8を精度よく設定することは簡単な5〜装
置ではきわめて回連であった2、 発明の目的 本発明は前H1,,+従来の欠点を解消−すると共して
、部品点数を減少−するものである。
示ずように、Xデープル1をX軸−モータ2の回転によ
って移動するものである。従来のxyテーブルをもつ2
軸ロボットの可動範囲全制限する制モ14]装置は、リ
ミットスイッチ7.8に、■二ってXラー−フ゛ル1か
可動範囲の境界に移動し、たこと全検出し−CXC玉軸
タ2の回転を停止上さぜ、リミットスイッチ6.6によ
ってyテーブル3が町11カ範囲の境界に移動したこと
を検出してy軸モータ4の回転を停止させるものであっ
た。このような構成で(・」、[jJ動範囲の変更には
りミツトスイッチ5,6,7゜8の設定位置の変更が必
要となり、操作が繁雑であった。寸だ、リミットスイッ
チ5.6.γ、8を他の部品に隣接して設定する場合、
リミノトスィノチ5,6,7.8自体の大きさのため(
・【設定できない範囲ができてし11/′X、その11
ではす、?7ノトスイノチ5,6.’7.8か使えない
場合か牛しった5、 さも(ハ)二、一度すミノ[・スイッチ6.6.了、8
を設定してし丑えは、位16”検出の繰返し精度は得ら
7Lるか、利用者か望むf装置(/こリミットスイッチ
5.6,7.8を精度よく設定することは簡単な5〜装
置ではきわめて回連であった2、 発明の目的 本発明は前H1,,+従来の欠点を解消−すると共して
、部品点数を減少−するものである。
発明の、構成
イ\発明は機械の可動部の動作位置を測定−する動作位
[む111定装置と、機械可動部の可u1範囲を制限ず
ろデータを入力するiiJ動範囲人カ装置と、前記b1
動範囲入力装置より人力した[11動範囲と前記動作位
置d411定装置によって1lil定した機械用動部の
動作位置を比較(7て可動範囲内で動作し2ているかを
判定する動作判定手段と、前記動作YIJ定手段か判定
1〜だ結果に基づき、可動部の駆動装置に対して制御信
号を出すする5駆動制御装置とからなり、t+J動範囲
の設定操作を大幅v′c11ij単化し、利用者が望む
位置(・て可動範囲を容易に精度よく設定することがU
fJ能である1゜ 実施例・Hi) B’l l力 以下に、本発明の一実施′l+llを第2〜3図に基し
)で説明する、 第2図はxyXデープルもつ24QI+ロボツトの駆動
制御およ己h i)J動範囲を・制限゛づる制御装置の
構成の−・例を示す、 9 (r;↓マイクロコンピー
タ−夕で、CPU(中央処理装置、以下CPUと略す。
[む111定装置と、機械可動部の可u1範囲を制限ず
ろデータを入力するiiJ動範囲人カ装置と、前記b1
動範囲入力装置より人力した[11動範囲と前記動作位
置d411定装置によって1lil定した機械用動部の
動作位置を比較(7て可動範囲内で動作し2ているかを
判定する動作判定手段と、前記動作YIJ定手段か判定
1〜だ結果に基づき、可動部の駆動装置に対して制御信
号を出すする5駆動制御装置とからなり、t+J動範囲
の設定操作を大幅v′c11ij単化し、利用者が望む
位置(・て可動範囲を容易に精度よく設定することがU
fJ能である1゜ 実施例・Hi) B’l l力 以下に、本発明の一実施′l+llを第2〜3図に基し
)で説明する、 第2図はxyXデープルもつ24QI+ロボツトの駆動
制御およ己h i)J動範囲を・制限゛づる制御装置の
構成の−・例を示す、 9 (r;↓マイクロコンピー
タ−夕で、CPU(中央処理装置、以下CPUと略す。
)、ROM(リードオンリーメモリ、以FROMと略す
。)、RAM(ランダノ・アクセスメモリ、以]・RA
Mと略す。)および人出カポ−1・舌から構成さnでい
る。10け入力操作部、11();i指令パルス発生回
路、12は偏差カウンタ、13はD/A変換器(デジタ
ル−アナ0グ変換器、以T” D/A変換器と略す。)
、14はサーボアンプ、15は直流サーボモータ、16
−:パルスジエネレータ、17i、iF7′V 変換
器(周波N数−ポ1」−:変換器、以下F/” 変’a
器と略す1、)、1sr;を現在位置カウンタである
。11〜18はX軸出とy軸用が必要であるか5図では
y軸出CDものを略[7ているっ前記入力操作部10よ
りあらかじめ−r4クロコンピユータ9のRAM内′V
1−人力されプこプログラムの手順に従って、Xテーブ
ル1−ひよひXデープル3の動作か行なわれる。前記マ
・イクL]コンピュータからはXデープルのX軸方向の
移動111と移動速度に対応したプ5−夕が指令パルス
発生回路11(・こ送出さ)しろ。
。)、RAM(ランダノ・アクセスメモリ、以]・RA
Mと略す。)および人出カポ−1・舌から構成さnでい
る。10け入力操作部、11();i指令パルス発生回
路、12は偏差カウンタ、13はD/A変換器(デジタ
ル−アナ0グ変換器、以T” D/A変換器と略す。)
、14はサーボアンプ、15は直流サーボモータ、16
−:パルスジエネレータ、17i、iF7′V 変換
器(周波N数−ポ1」−:変換器、以下F/” 変’a
器と略す1、)、1sr;を現在位置カウンタである
。11〜18はX軸出とy軸用が必要であるか5図では
y軸出CDものを略[7ているっ前記入力操作部10よ
りあらかじめ−r4クロコンピユータ9のRAM内′V
1−人力されプこプログラムの手順に従って、Xテーブ
ル1−ひよひXデープル3の動作か行なわれる。前記マ
・イクL]コンピュータからはXデープルのX軸方向の
移動111と移動速度に対応したプ5−夕が指令パルス
発生回路11(・こ送出さ)しろ。
一力、前記直流サーボモータ15の回転数を・ζルスジ
ュネレータ16によって検出し、Xテーブル1の移動量
および移動速度(/て応じプこパルスを発生する。
ュネレータ16によって検出し、Xテーブル1の移動量
および移動速度(/て応じプこパルスを発生する。
前記偏差カウンタ12では、指令パルス発生回路11の
出力とパルスジ、ネレータ16の出jlのパルス故の偏
差をD/’A変換器13およびサーボアンプ14を通し
直流サーボ七−夕15に出力する。
出力とパルスジ、ネレータ16の出jlのパルス故の偏
差をD/’A変換器13およびサーボアンプ14を通し
直流サーボ七−夕15に出力する。
前記F、/V 変換器17(・づパルスジJ−ネレータ
16の出カバ)+スの周波数を電圧に変換し、サーボ”
アンプ14し′で出力J゛る。
16の出カバ)+スの周波数を電圧に変換し、サーボ”
アンプ14し′で出力J゛る。
i?iJ記現在位置カウンタ18は、パルスジェネレー
タ16の出力パルスをカランl−して、Xテーブル1の
原点からの移動量を4111定−する1、前記マイクロ
コンピュータ9(d、この原点からの移動針とあらかじ
め入力操作部10(・′ζより入力しておいた可動4屯
囲を示す値からXテーブル1の原点からの移動量が可動
部IL(1内−′Cあるかを測定し2、ご、の結果(・
(7基Z)いて10−流サーボモータ15IVてえ1し
て制gl・1八弓を出力し回転を停上する。、y 1t
Qb方向’Icついても同様に構成する。
タ16の出力パルスをカランl−して、Xテーブル1の
原点からの移動量を4111定−する1、前記マイクロ
コンピュータ9(d、この原点からの移動針とあらかじ
め入力操作部10(・′ζより入力しておいた可動4屯
囲を示す値からXテーブル1の原点からの移動量が可動
部IL(1内−′Cあるかを測定し2、ご、の結果(・
(7基Z)いて10−流サーボモータ15IVてえ1し
て制gl・1八弓を出力し回転を停上する。、y 1t
Qb方向’Icついても同様に構成する。
次に上記のように構成したxyXデープルもつ2軸ロボ
ツトの可動範囲を制限する制御装置の動作を説明する。
ツトの可動範囲を制限する制御装置の動作を説明する。
っ
入力操作部10よりXテーブル1およびXデープル3の
動作のシーケンスを示すグログラノ、と、可動範囲を決
定するデータを入力後、前記マイクロコンピュータ9の
RAMに記憶された第3図のフローチャー1・に示す動
作プログラムを実行する。
動作のシーケンスを示すグログラノ、と、可動範囲を決
定するデータを入力後、前記マイクロコンピュータ9の
RAMに記憶された第3図のフローチャー1・に示す動
作プログラムを実行する。
1ず、第3図のノロ−チャー1・(/C示1゛よう((
。
。
Xテーブル1およびXテーブル3の移動量と移動速度を
示す移動命令をマイクロコンビコータ9のRAMより読
み込み(ステップ1)、ステップ2で命令か停止命令て
ないかを調へ、停止命令ならばスデ、ノブ13てX軸、
y g(hの直流サーボモータ15の回転を停止−す
る。停止命令でなけ扛ば、ステップ3でX軸、y軸に対
する指令パルス発生回路11C・ζそ汎ぞハの移動層と
移動速度のデータを送る。ステップ4て画商表示などの
他の処理を行なった後、ステ、プ5でX軸の現在位置カ
ウンタ18の値を読み込み、ステップ6でその値が可動
範囲内であるかを調べる。可動範囲外であれば。
示す移動命令をマイクロコンビコータ9のRAMより読
み込み(ステップ1)、ステップ2で命令か停止命令て
ないかを調へ、停止命令ならばスデ、ノブ13てX軸、
y g(hの直流サーボモータ15の回転を停止−す
る。停止命令でなけ扛ば、ステップ3でX軸、y軸に対
する指令パルス発生回路11C・ζそ汎ぞハの移動層と
移動速度のデータを送る。ステップ4て画商表示などの
他の処理を行なった後、ステ、プ5でX軸の現在位置カ
ウンタ18の値を読み込み、ステップ6でその値が可動
範囲内であるかを調べる。可動範囲外であれば。
ステップ11でxIIIi]、y軸の直流サーボモータ
15の回転を停止する。可動範囲内であ才1は、ステッ
プ7でy軸の併存位置カウンタ18の値を読み込み、ス
テップ8てその値が11動範囲内であるかを調べる。可
動範囲外であわば、ステップ12でX軸 +r軸の直流
サーボモータ15の回転を停止する。可動範囲内であれ
はステップ9でXチー・プル1が目棒位置に達したかを
調べ、寸だ目標位置に達していなければステップ4から
の処理を繰返す。
15の回転を停止する。可動範囲内であ才1は、ステッ
プ7でy軸の併存位置カウンタ18の値を読み込み、ス
テップ8てその値が11動範囲内であるかを調べる。可
動範囲外であわば、ステップ12でX軸 +r軸の直流
サーボモータ15の回転を停止する。可動範囲内であれ
はステップ9でXチー・プル1が目棒位置に達したかを
調べ、寸だ目標位置に達していなければステップ4から
の処理を繰返す。
Xデープル1しが目標位置に達17ていなげれは、ステ
ップ1QでXテーブル3に対してXテーブル1に対する
処理と同様・η)処理を行なうOyデ・−プル3か目標
位置に達していればステップ1に房り5次の移動命令を
RAMより読み込む、。
ップ1QでXテーブル3に対してXテーブル1に対する
処理と同様・η)処理を行なうOyデ・−プル3か目標
位置に達していればステップ1に房り5次の移動命令を
RAMより読み込む、。
以−にの動作に、Lっで、Xテーブル1およびXテーブ
ル3の原点からの移動層′が可動範囲内であるかを判定
1.、可動範囲内であれば停止」−することができる。
ル3の原点からの移動層′が可動範囲内であるかを判定
1.、可動範囲内であれば停止」−することができる。
可動範囲の設定変更も入力操作部10よりデータを入れ
変えることによって容易に行なえるO なお、本実施例において、可動範囲を長方形に限定しな
くても、プログラムによって円、三角形等にすることか
可能である。
変えることによって容易に行なえるO なお、本実施例において、可動範囲を長方形に限定しな
くても、プログラムによって円、三角形等にすることか
可能である。
1だ、本実施例において機械の可動部は2軸のxyテー
ブルを用いだが、側軸のものに対しても同様に可動範囲
を設定することか可能である。
ブルを用いだが、側軸のものに対しても同様に可動範囲
を設定することか可能である。
発明の効果
以上のよう114本発明は機械の可動部の可動範囲をソ
フトウェアで制限することによって、リミットスイッチ
着の部品の移動を行なわなくとも、マイク丁ココンピ=
−タのRAMにデータを入れ換えるだけで可動範囲の変
更が、行なえ、操作がきわめて容易になる。
フトウェアで制限することによって、リミットスイッチ
着の部品の移動を行なわなくとも、マイク丁ココンピ=
−タのRAMにデータを入れ換えるだけで可動範囲の変
更が、行なえ、操作がきわめて容易になる。
壕だ、可動範囲をマイクロコンビコータにデータとして
bえるので、リミットスイッチの大きさの/こめに可動
範囲を設定することかできない位置が生じるという欠点
を解消できる。
bえるので、リミットスイッチの大きさの/こめに可動
範囲を設定することかできない位置が生じるという欠点
を解消できる。
さらに、利用者の望む位置に簡単に精、1B′よく可動
範囲を設定できる。
範囲を設定できる。
第1図は従来の可動範囲を制限する制御装置を用い′k
xyテーブルの斜視図、第2図は本発明の一実施例にお
ける可動範囲を制限する制御装置の構成を示すブロック
図、第3図は可動範囲を制限する処理のプ1ズグジムの
ノロ−チャー1・図である。 5.6・・・・・・y軸出すミントスイソチ、7,8・
・・・ X軸出すミントスイッチ、9・・・・・マイク
ロコンピュータ、10・・・・入力操作部、11・・・
・・・指令パルス発生回路、15・・・直流サーボモー
タ、16・・・・・・パルスジェネレータ、18・・・
・・現在位置カウンタ。
xyテーブルの斜視図、第2図は本発明の一実施例にお
ける可動範囲を制限する制御装置の構成を示すブロック
図、第3図は可動範囲を制限する処理のプ1ズグジムの
ノロ−チャー1・図である。 5.6・・・・・・y軸出すミントスイソチ、7,8・
・・・ X軸出すミントスイッチ、9・・・・・マイク
ロコンピュータ、10・・・・入力操作部、11・・・
・・・指令パルス発生回路、15・・・直流サーボモー
タ、16・・・・・・パルスジェネレータ、18・・・
・・現在位置カウンタ。
Claims (1)
- 機械の可動部の動作位lべをd11]定する動作で1’
f、置測定装置と、機械可動部の可動範囲を制限するテ
ークを人力する目■動範囲入力装置と、前記可動範囲人
力装置より入力した可動範囲とrifll記動作荀装置
4111定装置によって6111定177”c機1$、
可動部の動作位置を比較して可動範囲内で動作しでいる
かを判定する動作判定手段と、前記動作判定手段が判定
した結果に基づき、可動部の噺動装置3て対して制御イ
計弓6・出力する駆動側f11装置とからなる制御装置
。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP58044951A JPS59170902A (ja) | 1983-03-17 | 1983-03-17 | 制御装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP58044951A JPS59170902A (ja) | 1983-03-17 | 1983-03-17 | 制御装置 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| JPS59170902A true JPS59170902A (ja) | 1984-09-27 |
Family
ID=12705791
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP58044951A Pending JPS59170902A (ja) | 1983-03-17 | 1983-03-17 | 制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPS59170902A (ja) |
Citations (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS5038861A (ja) * | 1973-08-11 | 1975-04-10 |
-
1983
- 1983-03-17 JP JP58044951A patent/JPS59170902A/ja active Pending
Patent Citations (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS5038861A (ja) * | 1973-08-11 | 1975-04-10 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JPS6069615A (ja) | 運動の制御装置 | |
| JPS5850362B2 (ja) | 位置決め方式 | |
| JPS6314363B2 (ja) | ||
| JPH074739B2 (ja) | デジタイジング方法 | |
| US20200052622A1 (en) | Simulation device, simulation method, and simulation program | |
| JPS59170902A (ja) | 制御装置 | |
| JP7479571B2 (ja) | パラメータ調整装置、工作機械システムおよびパラメータ調整方法 | |
| CN106017535B (zh) | 一种电机驱动阀位置传感器标定装置和方法 | |
| CN106441705B (zh) | 一种转台在线转动惯量测试方法 | |
| JPS58208612A (ja) | 測定方法および測定装置 | |
| CN110053042B (zh) | 机器人控制装置 | |
| CN108123645A (zh) | 一种无编码器的无刷电机控制方法及系统 | |
| JPS61184606A (ja) | 機械位置検出装置 | |
| JP2001336997A (ja) | 摩擦力計測装置及び摩擦力計測方法 | |
| JP2021081951A (ja) | プログラム解析装置 | |
| Lee et al. | Development of two-axis arm motion generator using active impedance | |
| JPS59195714A (ja) | 可動体の位置決め制御装置 | |
| US3418548A (en) | Contour tracing and tracking system | |
| JPH081564A (ja) | ロボット制御装置 | |
| RU54049U1 (ru) | Устройство для пропуска шва ткани на многосекционной стригальной машине | |
| Jiang et al. | A method of test sinusoids generation for high-power electromechanical servo system | |
| JPS63253407A (ja) | ロボツトの振動制御方法 | |
| JPS62184504A (ja) | 数値制御装置 | |
| RU2232381C2 (ru) | Система управления многофункциональным программируемым испытательным комплексом | |
| JPH0375515A (ja) | 駆動装置 |