JPH01142805A - 数値制御装置 - Google Patents

Abstract

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

Description

【発明の詳細な説明】 〈産業上の利用分野〉 この発明は、例えばサーボモータを駆動源とする可動体
の動作を制御するための数値制御装置に関する。

〈従来の技術〉 従来のこの種数値制御装置において、可動体を原点に復
帰させるのに原点復帰速度Ｖ、が予めパラメータとして
設定しである。この原点復帰動作に際し、可動体が前記
原点復帰速度Ｖ。

で移動して原点減速ドグをオンしたとき、第３図に示す
如く、その原点減速ドグ長りの間で可動体の速度を原点
復帰速度Ｖ、より原点減速速度ＶＨＩＩまで減速させる
。しかる後、サーボモータに一体化されたロークリエン
コーダより基準位置信号としてのＺ相信号を入力したと
き可動体を停止させて原点復帰させるものである。なお
第３図中、１．は可動体が原点減速ドグをオンした時点
を、またｔ２は数値制御装置がＺ相信号を入力した時点
を、それぞれ示している。

〈発明が解決しようとする問題点〉 ところが前記の原点減速速度Ｖ。が大き過ぎると、第４
図に示す如く、Ｚ相信号の入力後、可動体を停止させる
に至るまでの処理遅れ時間ｔ８の間に、可動体は前記ロ
ータリエンコーダのＡ相またはＢ相信号で１パルス分以
上に相当する位置ずれ（同図中、斜線で示す）が発生す
る。

また原点減速ドグ長りが短か過ぎるときや、原点復帰速
度Ｖ、が大き過ぎるときも、第５図に示す如く、原点減
速ドグ長りの間では可動体の速度は原点減速速度ＶＨＤ
まで落ちず、Ｚ相信号の入力後、可動体を停止させるま
での処理遅れ時間ｔ２の間に、前記と同様の位置ずれが
発生する。

この発明は、上記問題に着目してなされたもので、パラ
メータとして原点減速ドグ長を設定し、このパラメータ
を用いて自動的に原点復帰速度の最適値を計算すること
により、高精度の原点復帰を確実に実現する数値制御装
置を提案することを目的とする。

〈問題点を解決するための手段〉 上記目的を達成するため、この発明では、可動体が原点
復帰速度で移動して原点減速ドグをオンさせたとき、そ
の原点減速ドグ長の間で可動体の速度を原点減速速度ま
で減速させた後、可動体の駆動源より所定の基準位置信
号を入力したとき可動体を停止させて原点復帰させるた
めの数値制御装置であって、前記原点減速ドグ長をパラ
メータとして設定するためのパラメータ設定手段と、前
記基準位置信号の入力後、可動体が停止するまでの処理
遅れ時間の間に可動体を規定値以上に位置ずれさせない
ような原点減速速度の最大値を算出する第１の演算手段
と、原点復帰速度から原点減速速度へ減速するまでの可
動体の移動距離が前記パラメータで設定された原点減速
ドグ長より小さくなるよう原点復帰速度の最大値を算出
する第２の演算手段とを具備させることにした。

く作用〉 パラメータ設定手段により原点減速ドグ長をパラメータ
として予め設定しておくと、可動体の原点復帰動作に先
立ち、数値制御装置では、第１．第２の演算手段が前記
パラメータを用いて自動的に原点復帰速度の最適値を計
算する。

その結果、可動体がこの最適な原点復帰速度で移動して
原点減速ドグをオンさせたとき、その原点減速ドグ長の
間で可動体の速度は原点減速速度まで減速する。しかる
後に可動体の駆動源より所定の基準位置信号を入力した
とき、可動体は規定値以上の位置ずれを生じさせずに、
確実に停止して原点復帰する。

〈実施例〉 第１図は、この発明の一実施例にかかる数値制御装置が
導入された制御システムの概略構成を示している。

図示例のものは、サーボモータ１にボールねじ２を連結
し、このボールネジ２上にワーク固定台３を配備して、
ボールねじ２の回転でワーク固定台３を往復動作させる
ものである。このワーク固定台３の通過路沿いには、原
点減速ドグ４が配備してあり、ワーク固定台３が原点復
帰動作に際して原点減速ドグ４を通過するとき、この原
点減速ドグ４がオンされる。なおボールねじ２の両端位
置には極限リミットスイッチ５゜６が配備してあり、こ
れによりワーク固定台３の移動範囲が規制されるように
なっている。

前記サーボモータ１は、器体内にモータ本体７と、これ
に機械結合されたロータリエンコーダ８とが配備された
もので、このロータリエンコーダ８はＡ相およびＢ相の
各信号や基準位置信号としてのＺ相信号を出力する。

このサーボモータ１の動作はサーボドライバ９を介して
数値制御装置１０により制御されるもので、特にこの数
値制御装置１０は、ワーク固定台３を機械原点へ復帰さ
せるに際して、ワ−り固定台３が原点復帰速度Ｖ、で移
動して原点減速ドグ５をオンさせたとき、その原点減速
ドグ長りの間でワーク固定台３の速度を原点減速速度ｖ
）ｌＤまで減速させた後、サーボモータ１のロータリエ
ンコーダ８より最初のＺ相信号を入力したときワーク固
定台３を停止させて原点復帰させる。

上記の復帰動作を確実に実現するために、この数値制御
装置ＩＯは、第１．第２の演算手段１３．１４を含む制
御本体１１に、パラメータ設定部１２を接続して構成し
である。

このパラメータ設定部１２は前記原点減速ドグ４のドグ
長りをパラメータとして設定するためのもので、例えば
パーソナルコンピュータなどで構成される。

前記制御本体１１における第１の演算手段１３は、前記
ロータリエンコーダ８の２相信号の入力後、ワーク固定
台３が停止するまでの処理遅れ時間ｔ８の間にワーク固
定台３がロークリエンコーダ８のＡ相またはＢ相信号で
１パルス分以上に相当する位置ずれを生じないような原
点減速速度ＶＯＩＤの最大値を算出する。また第２の演
算手段１４は、原点復帰速度Ｖ、から原点減速速度ＶＨ
Ｄへ減速するまでのワーク固定台３の移動距離Ｓが前記
パラメータで設定された原点減速ドグ長りより小さくな
るよう原点復帰速度Ｖ、の最大値を算出する。

しかしてパラメータ設定部１２により原点減速ドグ長り
をパラメータとして予め設定しておくと、制御本体１１
では、ワーク固定台３の原点復帰動作に先立ち、前記パ
ラメータを用いて自動的に原点復帰速度Ｖ、の最適値を
計算することになる。

第２図は、この場合の制御本体１１による原点復帰速度
Ｖ、の算出手順を示すもので、まず同図のステップ１　
（図中、ｒｓＴＩＪで示す）で第１の演算手段１３が’
　ＶＩＩＩＩＸ　ｔ　、　＜　ｌパルスＪを満たす原点
減速速度■。を決定した後、つぎのステップ２で第２の
演算手段１４がＳくＤを満たす原点復帰速度Ｖ、を決定
する。

その結果、ワーク固定台３が機械原点へ復帰動作する際
、制御本体１１はサーボドライバ９を介してサーボモー
タ１の動作を制御し、ワーク固定台３を上記演算で算出
された原点復帰速度Ｖ３をもってボールねじ２上を移動
させる。

かくてワーク固定台３が原点減速ドグ４をオンして、そ
の信号が制御本体１１に取り込まれると、制御本体１１
は原点減速ドグ長りの間でワーク固定台３の速度を原点
減速速度ｖＨＤまで減速させる。そして原点減速ドグ５
がオフした後、サーボモータ１のロークリエンコーダ８
より制御本体１１に最初のＺ相信号が入力されたとき、
制御本体１１はサーボモータ１を停止させてワーク固定
台３の移動を止め、これによりワーク固定台３を機械原
点に復帰させる。。

〈発明の効果〉 この発明は上記の如く、パラメータとして原点減速ドグ
長を設定し、このパラメータを用いて自動的に原点復帰
速度の最適値を計算することにしたから、可動体を規定
値以上の位置ずれを生じさせずに、高精度の原点復帰を
確実に実現するなど、発明目的を達成した顕著な効果を
奏する。

【図面の簡単な説明】

第１図はこの発明の一実施例にかかる数値制御Ｉ装置が
導入された制御システムの概略構成を示す説明図、第２
図は数値制御装置の演算手順を示す流れ図、第３図〜第
５図は可動体の原点復帰動作を示す説明図である。 １・・・・サーボモータ　　３・・・・ワーク固定台１
０・・・・数値制御装置　　１１・・・・制御本体１２
・・・・パラメータ設定部 １３・・・・第１の演算手段 １４・・・・第２の演算手段

Claims (1)

1. 【特許請求の範囲】 ［１］可動体が原点復帰速度で移動して原点減速ドグを
   オンさせたとき、その原点減速ドグ長の間で可動体の速
   度を原点減速速度まで減速させた後、可動体の駆動源よ
   り所定の基準位置信号を入力したとき可動体を停止させ
   て原点復帰させるための数値制御装置であって、前記原
   点減速ドグ長をパラメータとして設 定するためのパラメータ設定手段と、 前記基準位置信号の入力後、可動体が停止 するまでの処理遅れ時間の間に可動体を規定値以上に位
   置ずれさせないような原点減速速度の最大値を算出する
   第１の演算手段と、 原点復帰速度から原点減速速度へ減速する までの可動体の移動距離が前記パラメータで設定された
   原点減速ドグ長より小さくなるよう原点復帰速度の最大
   値を算出する第２の演算手段とを具備して成る数値制御
   装置。 ［２］パラメータ設定手段は、パーソナルコンピュータ
   である特許請求の範囲第１項記載の数値制御装置。