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
Application number
JP402588A
Other languages
English (en)
Inventor
Kenji Fuji
藤 憲二
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.)
Fujitsu Ltd
Original Assignee
Fujitsu 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 Fujitsu Ltd filed Critical Fujitsu Ltd
Priority to JP402588A priority Critical patent/JPH01185196A/ja
Publication of JPH01185196A publication Critical patent/JPH01185196A/ja
Pending legal-status Critical Current

Links

Landscapes

  • Control Of Stepping Motors (AREA)

Abstract

(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。

Description

【発明の詳細な説明】 [概要] ステッピングモータにより移動対象の位置決めを行うス
テッピングモータ副′a装置の原点I N M制御に関
し、 比較的簡単な構成でコストパフォーマンスの高いステッ
ピングモータ制御装置を提供することを目的とし、 ステッピングモータの駆動に関連した−1御命令を出力
するコマンド発生部と、近原点位置に配置され移初対蒙
の到達を検出する近原点位置センサと、原点位置に配置
され移動対象の到達を検出する原点位置センサと、前記
コマンド発生部から加えられる−1御命令、前記近原点
位置センサの検出信号及び原点位置センサの検出信号に
従ってステッピングモータを駆動するための制御シーケ
ンスを実行するシーケンス制御部と、該シーケンス制御
部か弓加えられる制御信号に従ってステッピング七−夕
を駆動するための所定のパルスを出力する駆動パルス発
生部と、該駆動パルス発生部から出力されるパルスに従
ってステッピングモータを駆動するステッピングモータ
駆動部とを具備し、前記シーケンス制御部が前記コマン
ド発生部から加えられる制−命令を解析して原点復帰処
理シーケンスを実行するように構成する。
[産業上の利用分野] 本発明は、ステッピングモータ制御装置に関するもので
あり、更に詳しくは、ステッピングモータにより移動対
象の位置決めを行うステッピングモータ制御装置の原点
復帰制御に関する。
ステッピングモータを用いて移動対象の位置決めを行う
のにあたっては、移動量に比例した数の駆動パルスをス
テッピングモータに与える必要がある。また、ステッピ
ングモータの起動時や停止時には、脱調を生じないよう
に駆動パルスの周波数を制御する必要がある。
ところで、ステッピングモータを用いた移動対象の移1
■としては、駆動パルスの数に応じた目的位置への移動
と移動開始原点に復帰するための移動があり、それぞれ
の移動動作に応じた制御が必要になる。
[従来の技術] このようなステッピングモータの制御に用いられる制御
装置の一種に、目的位置への移動制御機能と移動開始原
点への原点復帰機能とがワンパッケージの半導体集積回
路として組み込まれたものがある。
[発明が解決しようとする問題点] しかしながら、このような半導体集積回路は簡単に実装
できて汎用性には富むものの、一部の機能しか使用しな
い用途の場合には結果的には過剰機能になってコストパ
フォーマンスの悪いものになってしまう。
本発明は、このような点に鑑みてなされたものであり、
比較的簡単な構成でコストパフォーマンスの高いステッ
ピングモータ制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、緊急時にはいずれの動作モード
であってもリヒット信号に従ってパルスの送出を緊急停
止させる機能を有するものを用いる。
ステッピングモータ駆動部4は駆動パルス発生部3から
出力されるパルスに従ってステッピングモータ5を駆動
する。ステッピングモータ5はその回転方向に従ってテ
ーブルなどの移動対客6を所定の方向に移動させる。7
は近原点位置に配置された近原点位置センサであり、移
動対象6の到達を検出して検出信号をシーケンス制御部
2に出力する。8は原点位置に配置された原点位置セン
サであり、移動対象6の到達を検出して検出信号をシー
ケンス制御部2に出力する。なお、これら各センサ7.
8としては、例えばフォトセンサを用いる。
[作用1 コマンド発生部1は−1御命令の一つとして原点復帰命
令をシーケンス制御部2に出力する。シーケンス制御部
2はコマンド発生部1から加えられる−1御命令を解析
して原点復帰シーケンス−1御命令であることを識別す
ることにより、近県点位置センサ7の検出信号及び原点
位置センサ8の検出信号に従って原点復帰処理シーケン
スを実行する。
[実施例] 以下、図面を参照して、本発明の実施例を詳細に表明す
る。
第2図は本発明の一実施例の概略を示す構成図であり、
第1図と同一のものには同一の符号を付して示している
。図では、?!2数N系統のステッピングモータ5を共
通のシーケンス制御部2で時分割制御する例を示してい
るが各系統の移動対象。
近県点位置センサ及び原点位置センサは図示しない。シ
ーケンス制御部2は、コマンド発生部1から加えられる
−1御命令を解析して原点復帰シーケンス−1御命令を
識別する。また、シーケンス制御部2はステッピングモ
ータ5の系統識別も行い、それぞれの系統の近県点位置
センサ7の検出信号及び原点位置センサ8の検出信号に
従って各系統について原点復帰処理シーケンスを実行す
る。
原点復帰の形態としては、移動対象の位置に応じて、第
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を減速停止させる。
このようなシーケンスにより、移動対象6は原点Cの位
置に復帰することになる。
一方、(b)の場合には、上述(a)の場合の(3)以
降〈6)までの一連の動作を実行する。
このように、(a)、(b)いずれの場合にも、5CA
NモードとS−8TOP信号の組み合わせで原点復帰処
理シーケンスを実行することができる。
第5図はこのような原点復帰処理の動作の流れを示すフ
ローチャートである。
まず、スピードセットを行う(ステップ■)。
ここで、スピードセットとは、ステッピングモータ5の
回転駆動にあたって必要な第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を検出していない
状態でCW(時計)方向にステッピングモータ5を回転
させ、近県点位置センサ7で移動対象6を検出させる(
ステップ■〜■)。その後再びスピードセットを行う(
ステップの)。この場合のスピードセットは、原点位置
が近いことから低速で移動対象6を移動させて高精度で
位置決めを行うためのものである。移動対象6はこのよ
うにして改めて設定されたスピードで原点位置センサ8
で検出されるまで移動しくステップ■〜O)、原点位l
センサ8が移動対象6を検出することによりS−8TO
P信号に従って減速停止する(ステップ■)。
なお、各ステッピングモータの原点復帰処理シーケンス
はこのようなフローチャートの流れに従って同様に実行
される。
このように構成することにより、原点復帰処理シーケン
スが必要な場合に選択的に機能を付加することができ、
用途に応じた適切な機能を持つコストパフォーマンスの
優れた制御装置が構成できる。
なお、各位置センサはフォトセンナに限るものではなく
磁気センサや救械的な接点センサであってもよい。
また、移動対象はテーブルに限るものではなく°、ステ
ッピングモータで移動できるものであれIfよい。
[発明の効果] 以上詳細に説明したように、本発明によれば、比較的簡
単な構成でコストパフォーマンスの高(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図

Claims (1)

  1. 【特許請求の範囲】 ステッピングモータ(5)により移動対象(6)の位置
    決めを行うステツピングモータ制御装置において、 ステッピングモータ(5)の駆動に関連した制御命令を
    出力するコマンド発生部(1)と、近原点位置に配置さ
    れ、移動対象(6)の到達を検出する近原点位置センサ
    (7)と、 原点位置に配置され、移動対象(6)の到達を検出する
    原点位置センサ(8)と、 前記コマンド発生部(1)から加えられる制御命令,前
    記近原点位置センサ(7)の検出信号及び原点位置セン
    サ(8)の検出信号に従ってステッピングモータ(5)
    を駆動するための制御シーケンスを実行するシーケンス
    制御部(2)と、該シーケンス制御部(2)から加えら
    れる制御信号に従つてステッピングモータ(5)を駆動
    するための所定のパルスを出力する駆動パルス発生部(
    3)と、 該駆動パルス発生部(3)から出力されるパルスに従つ
    てステツピングモータ(5)を駆動するステッピングモ
    ータ駆動部(4)とを具備し、前記シーケンス制御部(
    2)は前記コマンド発生部(1)から加えられる−1御
    命令を解析して原点復帰処理シーケンスを実行すること
    を特徴とするステッピングモータ制御装置。
JP402588A 1988-01-12 1988-01-12 ステッピングモータ制御装置 Pending JPH01185196A (ja)

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)

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) 移動テ−ブル制御装置