JP3562535B2 - 数値制御装置 - Google Patents

数値制御装置 Download PDF

Info

Publication number
JP3562535B2
JP3562535B2 JP30833794A JP30833794A JP3562535B2 JP 3562535 B2 JP3562535 B2 JP 3562535B2 JP 30833794 A JP30833794 A JP 30833794A JP 30833794 A JP30833794 A JP 30833794A JP 3562535 B2 JP3562535 B2 JP 3562535B2
Authority
JP
Japan
Prior art keywords
block
acceleration
speed
upper limit
blocks
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.)
Expired - Fee Related
Application number
JP30833794A
Other languages
English (en)
Other versions
JPH08147021A (ja
Inventor
明子 飯田
利文 竹内
範男 宮原
秀典 大場
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.)
Yaskawa Electric Corp
Original Assignee
Yaskawa Electric Corp
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 Yaskawa Electric Corp filed Critical Yaskawa Electric Corp
Priority to JP30833794A priority Critical patent/JP3562535B2/ja
Publication of JPH08147021A publication Critical patent/JPH08147021A/ja
Application granted granted Critical
Publication of JP3562535B2 publication Critical patent/JP3562535B2/ja
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Images

Description

【0001】
【産業上の利用分野】
本発明は、加速度条件を満足するようにサーボシステムの速度を制御できる数値制御装置に関する。
【0002】
【従来の技術】
数値制御装置では、加工プログラムによって指令された軌跡上を指令された速度で工具を移動させることによってワークを所望の形状に加工している。このような加工を効率よく、かつ高精度に行うためには、加工プログラムによって指定された軌跡のコーナ部分において加工形状や機械へのショック等を考慮して加工中に発生する加速度の上限値を制限することが必要である。
従来、この問題を解決するため、特開平6−83430号公報に見られるように、複数のブロック各々に指定された位置および速度情報を先読みし、ブロックとブロックの間に発生するブロック間加速度およびブロック内の加減速時に発生するブロック内加速度が、指定された共通の加速度上限値を越えないように、ブロック終了点での速度(以下ブロック終了速度という)および補間データを演算する方法をとっていた。
【0003】
【発明が解決しようとする課題】
しかし、特開平6−83430号公報の例では、ブロックとブロックの間に発生する加速度(以下ブロック間加速度という)の上限値、およびブロック内の加減速時に発生する加減速加速度(以下ブロック内加速度という)の上限値が同一の値であったため、図8に示すようなN1〜N3の移動指令の軌跡に対し、加速度の上限値αcを小さくすれば、図9に示すようにブロックとブロックの結合点における速度制限値(ブロック終了速度)が低くなり、また、ブロック内加速度も低くなるので加減速に要する時間が長くなり、加工時間が長くなる。
逆に、図10に示すように、加速度の上限値αcを大きくすれば、ブロック結合点における速度制限値(ブロック終了速度)が高くなり、加工時間は短くなるが、ブロック内加速度も大きくなるため、機械へのショックが大きくなるという問題があった。
そこで本発明は、加工時間の短縮と機械へのショックの減少を同時に実現する数値制御装置を提供することを目的とする。
【0004】
【課題を解決するための手段】
上記問題を解決するため、本発明は、サーボシステムの速度を加工プログラムに従って制御する数値制御装置において、前記加工プログラムの各ブロックに指定された位置及び速度情報を、複数ブロックについて先読みするブロック情報先読み手段と、先読みした前記複数ブロックの各終了点における速度が、各ブロック間に発生する送り方向の変化によりブロックとブロックの間に発生するブロック間加速度の指定された上限値α1を越えないというブロック間加速度条件を満たすようにブロック終了速度を演算するブロック終了速度演算手段と、ブロック終了速度が、前記ブロック間加速度の上限値とは別に指定された、ブロック内の加減速時に発生する加減速加速度であるブロック内加速度の上限値α2を超えないというブロック内加速度条件を満たすように修正ブロック終了速度を演算するブロック終了速度修正演算手段と、前記ブロック内加速度の上限値、前記修正ブロック終了速度および指令速度に基づいて補間演算を行う補間演算手段と、前記補間演算されたデータに基づいてサーボシステムの駆動を行うサーボシステム駆動手段とを備えたことを特徴としている。
【0005】
【作用】
上記手段により、ブロック間加速度の上限値をα1、ブロック内加速度の上限値をα2として別々に指定可能とし、さらに、ブロック間加速度の上限値を大きく指定することにより、図11に示すようにブロック結合点における速度制限値(ブロック終了速度)が高くなり、ブロック内加速度の上限値を小さく指定することで、図11に示すようにブロック内における加減速時の加速度が小さくなるので、加工時間の短縮と機械へのショックの減少が同時に実現できる。
【0006】
【実施例】
以下、本発明の実施例を図に基づいて説明する。
図1は本発明に係る数値制御装置の原理を示すブロック図である。1は加工プログラムの各ブロックに指定された位置および速度情報を複数ブロック分先読みするブロック情報先読み手段、2は先読みした前記複数ブロックの各終了点における速度が、指定されたブロック間加速度の上限値α1を超えないというブロック間加速度条件を満たすようにブロック終了速度を演算するブロック終了速度演算手段、3は前記ブロック終了速度が、前記ブロック間加速度の上限値とは別に指定されたブロック内加速度の上限値を超えないというブロック内加速度条件を満足するように修正ブロック終了速度を演算するブロック終了速度修正演算手段、4は指定されたブロック内加速度の上限値、前記修正ブロック終了速度、指令速度の条件を満足するように補間演算を行う補間演算手段、5は前記補間演算された補間データに基づいてサーボシステムの駆動を行うサーボシステム駆動手段である。
図2は、本発明を実施するための数値制御装置の構成を示したブロック図で、簡単のため2軸仕様の例を示す。図において、NCプログラム21から各軸の移動量を示す位置データと接線方向速度が指令される。ブロック先読み手段22はそれらの情報を複数のブロック先読みする。ブロック終了速度演算手段23は、各ブロック間に発生する送り方向の変化によりブロック間に発生する加速度が指定されたブロック間加速度の上限値α1 以下となる最大速度を求め、これをブロック終了速度Fe とする。ブロック間の送り方向の変化がサンプリング時間Ts だけかかるとすれば、Fe は次式によって求められる。
α1 =Fe *(1−cosθ)/Ts
より、
Fe =α1 *Ts /(1−cosθ)
ここで、θはブロック間角度で、図3〜図6に示すように、ブロックnとn+1の接点に引いた2本の接線の成す角度である。また、ブロック間加速度α1の算出根拠は図7に示されている。
ブロック終了速度修正演算手段24は、ブロック終了速度演算手段23で演算されたブロック終了速度Feを、ブロック内加速度条件を満たすよう修正する。ここでブロック内加速度条件とは、第nブロックの接線方向移動距離をL[n] 、前記ブロック間加速度上限値とは別に指定されたブロック内加速度の上限値をα2 とする時、
Fe[n−1]−Fe[n]≦2*α2 *L[n]
である。
この演算処理は、先読みしたブロック情報の先頭ブロックから現在補間中のブロックの一つ前のブロックまでの全てのブロックに対して行い、第mブロックでブロック内加速度条件を満たさない場合には、
Fe[m−1]=squrt(2*α2 *L[m] +Fe[m]
を満足するように修正を行う。この修正演算で得られた各修正ブロック終了速度は、空間的にブロック内加速度条件を満たす。
補間演算手段25は、サンプリングによる補間を行う。iサンプル時の送り速度は、現在の送り速度Fi 、補間の残り接線距離Lrem 、指令送り速度Fc 、ブロック終了速度Fe とする時、
Fi−Fe≧2*α2 *Lrem
であれば
Fi =squrt(2*α2 *Lrem +Fe
とする。また
Fi−Fe<2*α2 *Lrem
である場合には、
Fi ≧Fc ならば Fi =Fi +ΔF
Fi <Fc ならば Fi =Fi −ΔF
とする。このときΔFは
0≦ΔF≦α2 *Ts
の範囲でFc にFi が最も近くなる値を選ぶ。そして、決定された送り速度Fi で補間演算を行い、軸移動データを作成する。軸制御装置26x、26yは、軸移動データに基づきサーボアンプ27x、27yを介してサーボモータ28x、28yを駆動する。
これによってサーボシステムに発生する加速度は、ブロックとブロックの間ではブロック間加速度の上限値α1 、ブロック内ではブロック内加速度の上限値α2 に制限される。
【0007】
【発明の効果】
以上説明したように、本発明によれば、加工プログラムの指令形状に応じ、指定されたブロック間加速度条件を守りながら、適正なブロック終了速度を決定し、指令速度、ブロック終了速度条件および指定されたブロック内加速度条件を守りながら補間を行うため、機械的ショックが緩和され、さらに加工時間が短縮されるので効率良く精度の良い加工を行うことができる。
【図面の簡単な説明】
【図1】本発明に係る数値制御装置の原理を示すブロック図
【図2】本発明を実施するための数値制御装置の構成を示すブロック図
【図3】直線ブロックから直線ブロックへのブロック間角度を示す図
【図4】曲線ブロックから直線ブロックへのブロック間角度を示す図
【図5】直線ブロックから曲線ブロックへのブロック間角度を示す図
【図6】曲線ブロックから曲線ブロックへのブロック間角度を示す図
【図7】接線方向の速度変化を示す図
【図8】指令軌跡を示す図
【図9】従来技術で、ブロック間加速度上限値およびブロック内加速度上限値が小さいときの速度変化を示す図
【図10】従来技術で、ブロック間加速度上限値およびブロック内加速度上限値が大きいときの速度変化を示す図
【図11】本発明の数値制御装置において、ブロック間加速度上限値α1が大きく、ブロック内加速度上限値α2が小さいときの速度変化を示す図
【符号の説明】
1、22 ブロック情報先読み手段
2、23 ブロック終了速度演算手段
3、24 ブロック終了速度修正演算手段
4、25 補間演算手段
5 サーボシステム駆動手段
21 NCプログラム
26x X軸制御装置
26y Y軸制御装置
27x X軸サーボアンプ
27y Y軸サーボアンプ
28x X軸サーボモータ
28y Y軸サーボモータ

Claims (1)

  1. サーボシステムの速度を加工プログラムに従って制御する数値制御装置において、前記加工プログラムの各ブロックに指定された位置及び速度情報を、複数ブロックについて先読みするブロック情報先読み手段と、先読みした前記複数ブロックの各終了点における速度が、各ブロック間に発生する送り方向の変化によりブロックとブロックの間に発生するブロック間加速度の指定された上限値α1を越えないというブロック間加速度条件を満たすようにブロック終了速度を演算するブロック終了速度演算手段と、ブロック終了速度が、前記ブロック間加速度の上限値とは別に指定された、ブロック内の加減速時に発生する加減速加速度であるブロック内加速度の上限値α2を超えないというブロック内加速度条件を満たすように修正ブロック終了速度を演算するブロック終了速度修正演算手段と、前記ブロック内加速度の上限値、前記修正ブロック終了速度および指令速度に基づいて補間演算を行う補間演算手段と、前記補間演算されたデータに基づいてサーボシステムの駆動を行うサーボシステム駆動手段とを備えたことを特徴とする数値制御装置。
JP30833794A 1994-11-16 1994-11-16 数値制御装置 Expired - Fee Related JP3562535B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP30833794A JP3562535B2 (ja) 1994-11-16 1994-11-16 数値制御装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP30833794A JP3562535B2 (ja) 1994-11-16 1994-11-16 数値制御装置

Publications (2)

Publication Number Publication Date
JPH08147021A JPH08147021A (ja) 1996-06-07
JP3562535B2 true JP3562535B2 (ja) 2004-09-08

Family

ID=17979851

Family Applications (1)

Application Number Title Priority Date Filing Date
JP30833794A Expired - Fee Related JP3562535B2 (ja) 1994-11-16 1994-11-16 数値制御装置

Country Status (1)

Country Link
JP (1) JP3562535B2 (ja)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH11210616A (ja) * 1998-01-27 1999-08-03 Ebara Corp アキシアルピストン型ポンプ

Also Published As

Publication number Publication date
JPH08147021A (ja) 1996-06-07

Similar Documents

Publication Publication Date Title
KR100914349B1 (ko) 서보모터의 제어방법
JP3169838B2 (ja) サーボモータの制御方法
WO1989006066A1 (en) Method of speed control for servomotor
WO2018066048A1 (ja) 数値制御装置
JP3562535B2 (ja) 数値制御装置
JP3214516B2 (ja) 数値制御装置
JP3765710B2 (ja) 工作機械のサーボモータの制御装置
JPH02205489A (ja) マニピュレータのインピーダンス制御方式
JPH07210225A (ja) 数値制御装置
JP3440996B2 (ja) 数値制御装置
JPH11194813A (ja) 産業用機械の動作指令作成方法
JPH1158285A (ja) ハンド機構の力制御システム
JPH0825260A (ja) 産業用ロボットの撓み補正方法
JPH0639066B2 (ja) 産業用ロボツトの制御方法
JPH1190758A (ja) 送りネジ機構の制御方法
WO2024042618A1 (ja) 制御装置及びコンピュータ読み取り可能な記録媒体
JPH0760341B2 (ja) 数値制御方法
JPS6228803A (ja) フイ−ドフオワ−ド補償付サ−ボ制御装置
JPS61226254A (ja) ばり取りロボツトの制御装置
JP3457019B2 (ja) ならい制御方法
JP2728987B2 (ja) 移動体の移動制御装置
JP2734258B2 (ja) ロボットの軌跡補正装置
JPH06161560A (ja) サーボ装置
JP3507938B2 (ja) リニアモータ駆動方法
JPH083739B2 (ja) ロボットの速度プログラム決定方法

Legal Events

Date Code Title Description
A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20040130

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20040329

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20040512

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20040525

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20080611

Year of fee payment: 4

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090611

Year of fee payment: 5

LAPS Cancellation because of no payment of annual fees