JP3562535B2 - 数値制御装置 - Google Patents
数値制御装置 Download PDFInfo
- 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
Links
Images
Description
【産業上の利用分野】
本発明は、加速度条件を満足するようにサーボシステムの速度を制御できる数値制御装置に関する。
【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]2 −Fe[n]2 ≦2*α2 *L[n]
である。
この演算処理は、先読みしたブロック情報の先頭ブロックから現在補間中のブロックの一つ前のブロックまでの全てのブロックに対して行い、第mブロックでブロック内加速度条件を満たさない場合には、
Fe[m−1]=squrt(2*α2 *L[m] +Fe[m]2 )
を満足するように修正を行う。この修正演算で得られた各修正ブロック終了速度は、空間的にブロック内加速度条件を満たす。
補間演算手段25は、サンプリングによる補間を行う。iサンプル時の送り速度は、現在の送り速度Fi 、補間の残り接線距離Lrem 、指令送り速度Fc 、ブロック終了速度Fe とする時、
Fi2−Fe2≧2*α2 *Lrem
であれば
Fi =squrt(2*α2 *Lrem +Fe2)
とする。また
Fi2−Fe2<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を越えないというブロック間加速度条件を満たすようにブロック終了速度を演算するブロック終了速度演算手段と、各ブロック終了速度が、前記ブロック間加速度の上限値とは別に指定された、ブロック内の加減速時に発生する加減速加速度であるブロック内加速度の上限値α2を超えないというブロック内加速度条件を満たすように修正ブロック終了速度を演算するブロック終了速度修正演算手段と、前記ブロック内加速度の上限値、前記修正ブロック終了速度および指令速度に基づいて補間演算を行う補間演算手段と、前記補間演算されたデータに基づいてサーボシステムの駆動を行うサーボシステム駆動手段とを備えたことを特徴とする数値制御装置。
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)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH11210616A (ja) * | 1998-01-27 | 1999-08-03 | Ebara Corp | アキシアルピストン型ポンプ |
-
1994
- 1994-11-16 JP JP30833794A patent/JP3562535B2/ja not_active Expired - Fee Related
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 |