JPH01185196A - ステッピングモータ制御装置 - Google Patents
ステッピングモータ制御装置Info
- Publication number
- JPH01185196A JPH01185196A JP402588A JP402588A JPH01185196A JP H01185196 A JPH01185196 A JP H01185196A JP 402588 A JP402588 A JP 402588A JP 402588 A JP402588 A JP 402588A JP H01185196 A JPH01185196 A JP H01185196A
- Authority
- JP
- Japan
- Prior art keywords
- stepping motor
- position sensor
- origin
- moving object
- origin position
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000001514 detection method Methods 0.000 claims description 11
- 238000010586 diagram Methods 0.000 description 11
- 239000004065 semiconductor Substances 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000000034 method Methods 0.000 description 1
Landscapes
- Control Of Stepping Motors (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
[概要]
ステッピングモータにより移動対象の位置決めを行うス
テッピングモータ副′a装置の原点I N M制御に関
し、 比較的簡単な構成でコストパフォーマンスの高いステッ
ピングモータ制御装置を提供することを目的とし、 ステッピングモータの駆動に関連した−1御命令を出力
するコマンド発生部と、近原点位置に配置され移初対蒙
の到達を検出する近原点位置センサと、原点位置に配置
され移動対象の到達を検出する原点位置センサと、前記
コマンド発生部から加えられる−1御命令、前記近原点
位置センサの検出信号及び原点位置センサの検出信号に
従ってステッピングモータを駆動するための制御シーケ
ンスを実行するシーケンス制御部と、該シーケンス制御
部か弓加えられる制御信号に従ってステッピング七−夕
を駆動するための所定のパルスを出力する駆動パルス発
生部と、該駆動パルス発生部から出力されるパルスに従
ってステッピングモータを駆動するステッピングモータ
駆動部とを具備し、前記シーケンス制御部が前記コマン
ド発生部から加えられる制−命令を解析して原点復帰処
理シーケンスを実行するように構成する。
テッピングモータ副′a装置の原点I N M制御に関
し、 比較的簡単な構成でコストパフォーマンスの高いステッ
ピングモータ制御装置を提供することを目的とし、 ステッピングモータの駆動に関連した−1御命令を出力
するコマンド発生部と、近原点位置に配置され移初対蒙
の到達を検出する近原点位置センサと、原点位置に配置
され移動対象の到達を検出する原点位置センサと、前記
コマンド発生部から加えられる−1御命令、前記近原点
位置センサの検出信号及び原点位置センサの検出信号に
従ってステッピングモータを駆動するための制御シーケ
ンスを実行するシーケンス制御部と、該シーケンス制御
部か弓加えられる制御信号に従ってステッピング七−夕
を駆動するための所定のパルスを出力する駆動パルス発
生部と、該駆動パルス発生部から出力されるパルスに従
ってステッピングモータを駆動するステッピングモータ
駆動部とを具備し、前記シーケンス制御部が前記コマン
ド発生部から加えられる制−命令を解析して原点復帰処
理シーケンスを実行するように構成する。
[産業上の利用分野]
本発明は、ステッピングモータ制御装置に関するもので
あり、更に詳しくは、ステッピングモータにより移動対
象の位置決めを行うステッピングモータ制御装置の原点
復帰制御に関する。
あり、更に詳しくは、ステッピングモータにより移動対
象の位置決めを行うステッピングモータ制御装置の原点
復帰制御に関する。
ステッピングモータを用いて移動対象の位置決めを行う
のにあたっては、移動量に比例した数の駆動パルスをス
テッピングモータに与える必要がある。また、ステッピ
ングモータの起動時や停止時には、脱調を生じないよう
に駆動パルスの周波数を制御する必要がある。
のにあたっては、移動量に比例した数の駆動パルスをス
テッピングモータに与える必要がある。また、ステッピ
ングモータの起動時や停止時には、脱調を生じないよう
に駆動パルスの周波数を制御する必要がある。
ところで、ステッピングモータを用いた移動対象の移1
■としては、駆動パルスの数に応じた目的位置への移動
と移動開始原点に復帰するための移動があり、それぞれ
の移動動作に応じた制御が必要になる。
■としては、駆動パルスの数に応じた目的位置への移動
と移動開始原点に復帰するための移動があり、それぞれ
の移動動作に応じた制御が必要になる。
[従来の技術]
このようなステッピングモータの制御に用いられる制御
装置の一種に、目的位置への移動制御機能と移動開始原
点への原点復帰機能とがワンパッケージの半導体集積回
路として組み込まれたものがある。
装置の一種に、目的位置への移動制御機能と移動開始原
点への原点復帰機能とがワンパッケージの半導体集積回
路として組み込まれたものがある。
[発明が解決しようとする問題点]
しかしながら、このような半導体集積回路は簡単に実装
できて汎用性には富むものの、一部の機能しか使用しな
い用途の場合には結果的には過剰機能になってコストパ
フォーマンスの悪いものになってしまう。
できて汎用性には富むものの、一部の機能しか使用しな
い用途の場合には結果的には過剰機能になってコストパ
フォーマンスの悪いものになってしまう。
本発明は、このような点に鑑みてなされたものであり、
比較的簡単な構成でコストパフォーマンスの高いステッ
ピングモータ制m+装置を提供することを目的としてい
る。
比較的簡単な構成でコストパフォーマンスの高いステッ
ピングモータ制m+装置を提供することを目的としてい
る。
[問題点を解決するための手段]
第1図は本発明のステッピングモータ制御装置の原理ブ
ロック図である。図において、1はステッピングモータ
5の駆動に関連した制御!I全命令シーケンス制御部2
に出力するコマンド発生部である。シーケンス制御部2
はステッピングモータ5を駆動するための制御シーケン
スの実行に必要な制御信号を駆動パルス発生部3に出力
する。該駆動パルス発生部3はシーケンス制御部2から
加えられる制御信号に従ってステッピングモータ5を駆
動するための所定のパルスをステッピングモータ駆ti
J部4に出力する。このような駆動パルス発生部3とし
ては、例えば一定計のパルスを出力するINOモード、
連続的にパルスを出力する5CANモード及び1個だけ
パルスを出力するJOGモードの3つの動作モードを有
し、INDモードまたは5CANモ一ド動作時にはスロ
ーダウン(SLOW DOWN)信号に従って減速停
止(S−8TOP)L、緊急時にはいずれの動作モード
であってもリヒット信号に従ってパルスの送出を緊急停
止させる機能を有するものを用いる。
ロック図である。図において、1はステッピングモータ
5の駆動に関連した制御!I全命令シーケンス制御部2
に出力するコマンド発生部である。シーケンス制御部2
はステッピングモータ5を駆動するための制御シーケン
スの実行に必要な制御信号を駆動パルス発生部3に出力
する。該駆動パルス発生部3はシーケンス制御部2から
加えられる制御信号に従ってステッピングモータ5を駆
動するための所定のパルスをステッピングモータ駆ti
J部4に出力する。このような駆動パルス発生部3とし
ては、例えば一定計のパルスを出力するINOモード、
連続的にパルスを出力する5CANモード及び1個だけ
パルスを出力するJOGモードの3つの動作モードを有
し、INDモードまたは5CANモ一ド動作時にはスロ
ーダウン(SLOW DOWN)信号に従って減速停
止(S−8TOP)L、緊急時にはいずれの動作モード
であってもリヒット信号に従ってパルスの送出を緊急停
止させる機能を有するものを用いる。
ステッピングモータ駆動部4は駆動パルス発生部3から
出力されるパルスに従ってステッピングモータ5を駆動
する。ステッピングモータ5はその回転方向に従ってテ
ーブルなどの移動対客6を所定の方向に移動させる。7
は近原点位置に配置された近原点位置センサであり、移
動対象6の到達を検出して検出信号をシーケンス制御部
2に出力する。8は原点位置に配置された原点位置セン
サであり、移動対象6の到達を検出して検出信号をシー
ケンス制御部2に出力する。なお、これら各センサ7.
8としては、例えばフォトセンサを用いる。
出力されるパルスに従ってステッピングモータ5を駆動
する。ステッピングモータ5はその回転方向に従ってテ
ーブルなどの移動対客6を所定の方向に移動させる。7
は近原点位置に配置された近原点位置センサであり、移
動対象6の到達を検出して検出信号をシーケンス制御部
2に出力する。8は原点位置に配置された原点位置セン
サであり、移動対象6の到達を検出して検出信号をシー
ケンス制御部2に出力する。なお、これら各センサ7.
8としては、例えばフォトセンサを用いる。
[作用1
コマンド発生部1は−1御命令の一つとして原点復帰命
令をシーケンス制御部2に出力する。シーケンス制御部
2はコマンド発生部1から加えられる−1御命令を解析
して原点復帰シーケンス−1御命令であることを識別す
ることにより、近県点位置センサ7の検出信号及び原点
位置センサ8の検出信号に従って原点復帰処理シーケン
スを実行する。
令をシーケンス制御部2に出力する。シーケンス制御部
2はコマンド発生部1から加えられる−1御命令を解析
して原点復帰シーケンス−1御命令であることを識別す
ることにより、近県点位置センサ7の検出信号及び原点
位置センサ8の検出信号に従って原点復帰処理シーケン
スを実行する。
[実施例]
以下、図面を参照して、本発明の実施例を詳細に表明す
る。
る。
第2図は本発明の一実施例の概略を示す構成図であり、
第1図と同一のものには同一の符号を付して示している
。図では、?!2数N系統のステッピングモータ5を共
通のシーケンス制御部2で時分割制御する例を示してい
るが各系統の移動対象。
第1図と同一のものには同一の符号を付して示している
。図では、?!2数N系統のステッピングモータ5を共
通のシーケンス制御部2で時分割制御する例を示してい
るが各系統の移動対象。
近県点位置センサ及び原点位置センサは図示しない。シ
ーケンス制御部2は、コマンド発生部1から加えられる
−1御命令を解析して原点復帰シーケンス−1御命令を
識別する。また、シーケンス制御部2はステッピングモ
ータ5の系統識別も行い、それぞれの系統の近県点位置
センサ7の検出信号及び原点位置センサ8の検出信号に
従って各系統について原点復帰処理シーケンスを実行す
る。
ーケンス制御部2は、コマンド発生部1から加えられる
−1御命令を解析して原点復帰シーケンス−1御命令を
識別する。また、シーケンス制御部2はステッピングモ
ータ5の系統識別も行い、それぞれの系統の近県点位置
センサ7の検出信号及び原点位置センサ8の検出信号に
従って各系統について原点復帰処理シーケンスを実行す
る。
原点復帰の形態としては、移動対象の位置に応じて、第
3図の相対位置関係説明図に示すように、移動対象6が
近原点り、原点C,プラス側のオーバートラベル(OT
)Aまたはマイナス側のOTB上に位置している場合(
a)とそれ以外に位置している場合(b)の2つがある
。なお、近原点りの位置には近県点位置センナ7が配置
され、原点Cの位置には原点位置センサ8が配置され、
OTA及びOTBの位置にもそれぞれOT位置センサが
配置されている。
3図の相対位置関係説明図に示すように、移動対象6が
近原点り、原点C,プラス側のオーバートラベル(OT
)Aまたはマイナス側のOTB上に位置している場合(
a)とそれ以外に位置している場合(b)の2つがある
。なお、近原点りの位置には近県点位置センナ7が配置
され、原点Cの位置には原点位置センサ8が配置され、
OTA及びOTBの位置にもそれぞれOT位置センサが
配置されている。
まず、(a)の場合には、第4図の原点復帰動作説明図
(1)に示すように近県点位置センサ7が移動対象6を
検出しなくなる位置まで原点Cから離れるように矢印の
方向に5CANモードで移動対象6を移動させる。そし
て、近県点位置センサ7が移動対象6を検出しなくなっ
たら(2)に示すようにS−8TOP信号により移動対
象6を減速停止させる。その後、(3)に示すように(
1)とは逆の原点Cに向かう矢印の方向にSC△Nモー
ドで移動対象6を移動させ、近県点位置センサ7が移動
対象6を検出したら(4)に示すようにS−8TOP信
号により移動対象6を一〇減速停止させる。その後さら
に、(5)に示すように原点Cに向かう矢印の方向に5
CANモードで移動対@!6を移動させ、原点位置セン
サ8が移動対象6を検出したら(6)に示すようにS−
8TOP信号により移動対象6を減速停止させる。
(1)に示すように近県点位置センサ7が移動対象6を
検出しなくなる位置まで原点Cから離れるように矢印の
方向に5CANモードで移動対象6を移動させる。そし
て、近県点位置センサ7が移動対象6を検出しなくなっ
たら(2)に示すようにS−8TOP信号により移動対
象6を減速停止させる。その後、(3)に示すように(
1)とは逆の原点Cに向かう矢印の方向にSC△Nモー
ドで移動対象6を移動させ、近県点位置センサ7が移動
対象6を検出したら(4)に示すようにS−8TOP信
号により移動対象6を一〇減速停止させる。その後さら
に、(5)に示すように原点Cに向かう矢印の方向に5
CANモードで移動対@!6を移動させ、原点位置セン
サ8が移動対象6を検出したら(6)に示すようにS−
8TOP信号により移動対象6を減速停止させる。
このようなシーケンスにより、移動対象6は原点Cの位
置に復帰することになる。
置に復帰することになる。
一方、(b)の場合には、上述(a)の場合の(3)以
降〈6)までの一連の動作を実行する。
降〈6)までの一連の動作を実行する。
このように、(a)、(b)いずれの場合にも、5CA
NモードとS−8TOP信号の組み合わせで原点復帰処
理シーケンスを実行することができる。
NモードとS−8TOP信号の組み合わせで原点復帰処
理シーケンスを実行することができる。
第5図はこのような原点復帰処理の動作の流れを示すフ
ローチャートである。
ローチャートである。
まず、スピードセットを行う(ステップ■)。
ここで、スピードセットとは、ステッピングモータ5の
回転駆動にあたって必要な第6図のスピード特性図に示
すような各種のスピードパラメータの設定をいう。なお
、第6図において、LSPDは低速(LOW 5PE
ED>を示し、HS P Dは高速(ト11GH5PE
ED>を示し、RATEは加減速の時定数を示し、5S
PDはスキャンスピード(SCAN 5PEED)を
示している。
回転駆動にあたって必要な第6図のスピード特性図に示
すような各種のスピードパラメータの設定をいう。なお
、第6図において、LSPDは低速(LOW 5PE
ED>を示し、HS P Dは高速(ト11GH5PE
ED>を示し、RATEは加減速の時定数を示し、5S
PDはスキャンスピード(SCAN 5PEED)を
示している。
続いて、原点情報を読み取る(スラブ■)。そして、近
県点位置センサ7の検出信号から移動対象6の位置を確
認する〈ステップ■)。近県点位置センサ7が移動対象
6を検出している場合にはCCW方向にステッピングモ
ータ5を回転させて近原点位置センサ7が移動対栄6を
検出しないようにする(ステップ■〜■)。
県点位置センサ7の検出信号から移動対象6の位置を確
認する〈ステップ■)。近県点位置センサ7が移動対象
6を検出している場合にはCCW方向にステッピングモ
ータ5を回転させて近原点位置センサ7が移動対栄6を
検出しないようにする(ステップ■〜■)。
次に近県点位置センサ7が移動対象6を検出していない
状態でCW(時計)方向にステッピングモータ5を回転
させ、近県点位置センサ7で移動対象6を検出させる(
ステップ■〜■)。その後再びスピードセットを行う(
ステップの)。この場合のスピードセットは、原点位置
が近いことから低速で移動対象6を移動させて高精度で
位置決めを行うためのものである。移動対象6はこのよ
うにして改めて設定されたスピードで原点位置センサ8
で検出されるまで移動しくステップ■〜O)、原点位l
センサ8が移動対象6を検出することによりS−8TO
P信号に従って減速停止する(ステップ■)。
状態でCW(時計)方向にステッピングモータ5を回転
させ、近県点位置センサ7で移動対象6を検出させる(
ステップ■〜■)。その後再びスピードセットを行う(
ステップの)。この場合のスピードセットは、原点位置
が近いことから低速で移動対象6を移動させて高精度で
位置決めを行うためのものである。移動対象6はこのよ
うにして改めて設定されたスピードで原点位置センサ8
で検出されるまで移動しくステップ■〜O)、原点位l
センサ8が移動対象6を検出することによりS−8TO
P信号に従って減速停止する(ステップ■)。
なお、各ステッピングモータの原点復帰処理シーケンス
はこのようなフローチャートの流れに従って同様に実行
される。
はこのようなフローチャートの流れに従って同様に実行
される。
このように構成することにより、原点復帰処理シーケン
スが必要な場合に選択的に機能を付加することができ、
用途に応じた適切な機能を持つコストパフォーマンスの
優れた制御装置が構成できる。
スが必要な場合に選択的に機能を付加することができ、
用途に応じた適切な機能を持つコストパフォーマンスの
優れた制御装置が構成できる。
なお、各位置センサはフォトセンナに限るものではなく
磁気センサや救械的な接点センサであってもよい。
磁気センサや救械的な接点センサであってもよい。
また、移動対象はテーブルに限るものではなく°、ステ
ッピングモータで移動できるものであれIfよい。
ッピングモータで移動できるものであれIfよい。
[発明の効果]
以上詳細に説明したように、本発明によれば、比較的簡
単な構成でコストパフォーマンスの高(1ステツピング
モータ制御1]装置を提供することができる。
単な構成でコストパフォーマンスの高(1ステツピング
モータ制御1]装置を提供することができる。
第1図は本発明の原理ブロック図、
第2図は本発明の一実施例を示す構成図、第3図は相対
位置関係説明図、 第4図は原点復帰動作説明図、 第5図は原点復帰処理動作の流れを示すフローチャート
、 第6図はスピード特性図である。 第1図、第2図において、 1はコマンド発生部、 2はシーケンス制御部、 3は駆動パルス発生部、 4はステッピングモータ駆動部、 5はステッピングモータ、 6は移動対象、 7は近県点位置センサ、 8は原点位置センサである。 ロコー〇− 第4図 第5 図 ゛、 ゝ茗急停止 テ しSPD (L) H5PD(H) スピード待比圓 第6図
位置関係説明図、 第4図は原点復帰動作説明図、 第5図は原点復帰処理動作の流れを示すフローチャート
、 第6図はスピード特性図である。 第1図、第2図において、 1はコマンド発生部、 2はシーケンス制御部、 3は駆動パルス発生部、 4はステッピングモータ駆動部、 5はステッピングモータ、 6は移動対象、 7は近県点位置センサ、 8は原点位置センサである。 ロコー〇− 第4図 第5 図 ゛、 ゝ茗急停止 テ しSPD (L) H5PD(H) スピード待比圓 第6図
Claims (1)
- 【特許請求の範囲】 ステッピングモータ(5)により移動対象(6)の位置
決めを行うステツピングモータ制御装置において、 ステッピングモータ(5)の駆動に関連した制御命令を
出力するコマンド発生部(1)と、近原点位置に配置さ
れ、移動対象(6)の到達を検出する近原点位置センサ
(7)と、 原点位置に配置され、移動対象(6)の到達を検出する
原点位置センサ(8)と、 前記コマンド発生部(1)から加えられる制御命令,前
記近原点位置センサ(7)の検出信号及び原点位置セン
サ(8)の検出信号に従ってステッピングモータ(5)
を駆動するための制御シーケンスを実行するシーケンス
制御部(2)と、該シーケンス制御部(2)から加えら
れる制御信号に従つてステッピングモータ(5)を駆動
するための所定のパルスを出力する駆動パルス発生部(
3)と、 該駆動パルス発生部(3)から出力されるパルスに従つ
てステツピングモータ(5)を駆動するステッピングモ
ータ駆動部(4)とを具備し、前記シーケンス制御部(
2)は前記コマンド発生部(1)から加えられる−1御
命令を解析して原点復帰処理シーケンスを実行すること
を特徴とするステッピングモータ制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP402588A JPH01185196A (ja) | 1988-01-12 | 1988-01-12 | ステッピングモータ制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP402588A JPH01185196A (ja) | 1988-01-12 | 1988-01-12 | ステッピングモータ制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH01185196A true JPH01185196A (ja) | 1989-07-24 |
Family
ID=11573422
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP402588A Pending JPH01185196A (ja) | 1988-01-12 | 1988-01-12 | ステッピングモータ制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH01185196A (ja) |
-
1988
- 1988-01-12 JP JP402588A patent/JPH01185196A/ja active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US6212444B1 (en) | Method of avoiding interference of industrial robot | |
JPH01185196A (ja) | ステッピングモータ制御装置 | |
JPH0869326A (ja) | 位置決め制御器 | |
JPS6368390A (ja) | 産業用ロボツト制御装置 | |
JPS6068408A (ja) | 位置決め制御装置 | |
JPH08132369A (ja) | ロボット制御装置 | |
JP2647986B2 (ja) | 原点復帰方法 | |
WO2024116803A1 (en) | Mobile robot | |
JPS6022212A (ja) | ロボツト制御装置 | |
JP2004282972A (ja) | モータ制御用パルス発生ic | |
JPH0239208A (ja) | 原点復帰方法 | |
SU911459A1 (ru) | Цифровое устройство дл управлени позиционным приводом | |
JPH0611193B2 (ja) | モ−トルの位置制御方法 | |
JPS6263302A (ja) | 多関節ロボツトの機械原点位置検出方法 | |
JPS6240073A (ja) | エンコ−ダモ−トルの停止方法 | |
JPH01214041A (ja) | 板状物の位置合わせ方法及び装置 | |
JPS6144555A (ja) | 数値制御装置の原点検出方式 | |
JPS62239881A (ja) | 直流モ−トルの制御方法 | |
JPH01204112A (ja) | 速度制御装置 | |
JP2002325474A (ja) | モータ制御装置 | |
JPH0553621A (ja) | 原点復帰方式 | |
JPS62160085A (ja) | モ−タの所定角度停止方法 | |
JPS59105115A (ja) | 電動機の運転制御方法 | |
JPH01197812A (ja) | 定位置停止制御装置 | |
JPH0619696B2 (ja) | 移動テ−ブル制御装置 |