JP2996445B2 - 複数軸駆動装置 - Google Patents
複数軸駆動装置Info
- Publication number
- JP2996445B2 JP2996445B2 JP2126382A JP12638290A JP2996445B2 JP 2996445 B2 JP2996445 B2 JP 2996445B2 JP 2126382 A JP2126382 A JP 2126382A JP 12638290 A JP12638290 A JP 12638290A JP 2996445 B2 JP2996445 B2 JP 2996445B2
- Authority
- JP
- Japan
- Prior art keywords
- speed
- axis
- axes
- constant
- input
- 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 - Lifetime
Links
Landscapes
- Numerical Control (AREA)
Description
する。
ハードウェア構成を示すブロック図である。同図におい
て、位置決め装置(1)はマイクロプロセッサ(11)
と、直線補間データとしての各軸の移動目標位置および
合成速度を記憶するデータメモリ(12)と、各軸の速度
基準等を記憶する制御メモリ(13)と、インタフェース
(14),(15),(16X),(16Y)〜(16N)とを備
え、これらが相互に接続されている。そして、動作を開
始するための指令を与える外部指令装置(2)がインタ
フェース(14)に、直線補間データを入力するための入
力手段、例えば周辺装置(3)がインタフェース(15)
にそれぞれ接続されている。また、モータドライブ装置
(4X),(4Y)〜(4N)がインタフェース(16X),(1
6Y)〜(16N)にそれぞれ接続され、これらのモータド
ライブ装置(4X),(4Y)〜(4N)が各軸のモータ(5
X),(5Y)〜(5N)を駆動するようになっている。
図のフローチャートに従って、第7図の入力データ例お
よび第8図の説明図をも参照して以下に説明する。
数)軸の直線補間に必要な各軸の移動目標位置および合
成速度を入力すると、これらの直線補間データが、イン
タフェース(15)を介して、マイクロプロセッサ(11)
に取込まれ、マイクロプロセッサ(11)はこれをデータ
メモリ(12)に記憶させる(ステップ111)。
めの指令を与えると、この指令がインタフェース(14)
を介して、マイクロプロセッサ(11)に入力される(ス
テップ(112)。そこで、マイクロプロセッサ(11)は
データメモリ(12)に記憶された各軸の移動目標位置お
よび合成速度に基いて軸毎の速度・基準を演算して制御
メモリ(13)に記憶させる(ステップ113)。
見合った動作指令を、それぞれインタフェース(16
X),(16Y)〜(16N)を介して、駆動手段、例えば、
モータドライブ装置(4X),(4Y)〜(4N)に与え、こ
れによって各軸のモータ(5X),(5Y)〜(5N)は一斉
に駆動される(ステップ114)。また、マイクロプロセ
ッサ(11)はこれらの動作指令の出力処理を一定時間毎
に実行する(ステップ115)。
下、単に移動位置ともいう)に対応した回数だけ動作指
令を出力したか否かを判定し、出力しておれば直線補間
動作を終了する(ステップ116)。
タは、第7図(a)に示すように、運転動作、合成速度
および各軸の移動位置からなっている。
線補間データを入力したとき、移動位置がP1(x1,y1)
である場合と、P2(x2,y2)である場合の各動作軌跡を
示した図である。ここで、移動位置P1が(x1,y1)であ
れば現在位置0と移動位置P1との間の合成速度vが一定
になるようにx軸の速度基準vx1と、y軸の速度基準vy1
とが決定される。また、移動位置P2が(x2,y2)であっ
ても、やはり合成速度vが一定になるようにx軸の速度
基準vx2と、y軸の速度基準vy2とが決定される。
合成速度vを一定にしたことにより、vx1≠vx2、vy1≠v
y2となり、各軸の速度基準は移動位置の変化に応じてそ
の度毎に変化する。
外の種々の分野に応用される。このうち、工作機械に応
用した場合には、上述した直線補間動作を途中で停止す
ることなく、連続的に実行したとしても、合成速度が常
に一定であることから工作状態を一定に維持できる。
成速度を一定にするよりも、基準軸に対して速度一定制
御をする必要性が高い。しかるに、上述した従来の直線
補間を採用した複数軸駆動装置にあっては、新たな移動
位置に対応した直線補間動作毎に各軸の速度が変化し、
コンベアに適用したときに基準軸の速度を一定に保持す
ることができないという問題点があった。
ので、基準軸速度を一定に保持することのできる複数軸
駆動装置を得ることを目的とする。
動目標位置と、速度値と、定義情報と、が入力される入
力手段と、この入力手段により入力された入力内容にも
とづき、速度値および定義情報により示される速度条件
が満足されるとともに、複数軸の各々の軸について速度
が移動目標位置までの距離に比例する大きさになるよう
に、各々の軸の速度を算出する軸毎速度演算手段と、軸
毎速度演算手段により算出された各々の軸の速度にもと
づき複数軸を駆動する駆動手段と、を備え、定義情報に
より速度値が複数軸のうちのいずれかの軸の速度値であ
ると定義可能であるとともに、速度値が各々の軸の速度
の合成速度値であるとも定義可能にしたものである。
動目標位置と、速度値と、定義情報と、が入力手段によ
り入力され、この入力手段により入力された入力内容に
もとづき、速度値および定義情報により示される速度条
件が満足されるとともに、各々の軸について速度が移動
目標位置までの距離に比例する大きさになるように、軸
毎速度演算手段が各々の軸の速度を算出し、軸毎速度演
算手段により算出された各々の軸の速度にもとづき駆動
手段が複数軸を駆動し、 定義情報により速度値が複数軸のうちのいずれかの軸
の速度値であると定義可能であるとともに、速度値が各
々の軸の速度の合成速度値であるとも定義可能である。
であり、外部から直線補間データを入力する補間データ
入力手段(101)と、入力された補間データを記憶する
補間データ記憶手段(102)と、外部から補間動作指令
を与える動作指令手段(103)と、補間動作指令が与え
られたとき、補間データ記憶手段(102)の補間データ
に基いて複数軸の速度基準をそれぞれ演算する軸毎速度
・演算手段(105)と、演算された速度基準を記憶する
速度データ記憶手段(106)と、記憶された速度基準に
従った動作指令をモータドライブ装置(5X)〜(5N)に
与える動作指令出力手段(106)とで構成されている。
一定にする指令および基準軸の速度を一定にする指令の
うちいずれか一方を随時選択して入力すると、軸毎速度
演算手段(104)はこの指令に応じて各軸の速度基準を
合成速度の成分に一致させたり、基準軸の速度基準を一
定にし、他の軸の速度基準を移動量に比例させたりす
る。
図に示したハードウェア(H/W)構成をそのまま採用す
ることができ、そのソフトウェアを変更することによっ
て実現できる。
フローチャートに従って具体的動作を以下に説明する。
(3)にて各軸の目標位置と、合成速度を一定にするか
あるいは基準軸速度を一定にするかの動作内容を入力す
ると、マイクロプロセッサ(11)はこれらの補間データ
および動作内容をデータメモリ(12)に記憶させる(ス
テップ121)。
(2)によって動作開始指令を入力すると、この指令が
マイクロプロセッサ(11)に加えられる(ステップ12
2)。
けたとき、データメモリ(12)の補間データに基いて各
軸の移動量を演算する(ステップ123)。
成速度一定か基準軸速度一定かを判定し(ステップ12
4)、合成速度一定の場合には前述したように直線速度
成分に対応する各軸の速度基準を演算して制御メモリ
(13)に記憶させ(ステップ125)、反対に、基準軸速
度一定の場合には基準軸の速度基準を一定とし、他の軸
の速度基準を移動量に比例させたものとして制御メモリ
(13)に記憶させる(ステップ126)。
見合った動作指令をモータドライブ装置(4X),(4Y)
〜(4N)に与え、これによって各軸のモータ(5X),
(5Y)〜(5N)は一斉に動作を開始する(ステップ12
7)。また、マイクロプロセッサ(11)はこれらの動作
指令の出力処理を一定時間毎に実行する(ステップ12
8)。
応した回数だけ動作指令を出力したか否かを判定し、出
力しておれば直線補間動作を終了する(ステップ12
9)。
定する場合には、第7図(b)に示すデータが周辺装置
(3)から位置決め装置(1)に入力される。なお、第
7図(a)および第7図(b)において、「123456mm/m
in」とあるのは速度値である。また、第7図(a)にお
いて「合成速度」、第7図(b)において「X軸速度」
とあるのは、それぞれ、速度値がいずれの速度を示すか
を定義する定義情報である。
線補間動作をさせる際、X軸の速度が一定になるように
動作内容を指定すると共に、移動位置がP1(x1,y1)で
ある場合と、P2(x2,y2)である場合の移動軌跡を示し
た図である。
準はvx1はv(=一定)となり、Y軸の速度基準vy1は のように決定される。また、移動位置P2(x2,y2)に対
してX軸の速度基準vx2はv(=一定)に、Y軸の速度
基準vy2は のように決定される。
速度を一定にしたことにより、v1≠V2(合成速度)、v
x1=vx2=v、vy1≠vy2となる。
を一定にする指令を入力すれば、合成速度一定の連続制
御ができ、基準軸の速度を一定にする指令を入力すれば
基準軸速度一定の連続制御ができる。
軸に対して補間して動かす必要のある軸の動作軌跡の直
線性を必要とするコンベアの制御において、基準軸速度
一定の指令を与える制御方法が極めて有効である。
令を与えて連続制御したとき、および基準軸の速度を一
定にする指令を与えて連続制御したときの軸速度の変化
を示した図である。
とし、この第1軸の速度を一定にしようとしても、合成
速度一定制御においては、同図(a)に示すように、A
点からB点に向かうとき第1軸のみが駆動され、B点か
ら他の点に向かうときに第2軸も駆動されたとすれば、
第1軸の速度はB点の前後で変化する。すなわち、第2
軸が駆動された時点で第1軸の速度が変化しないように
合成速度を設定しなおさなければならず、プログラムの
作成に手間がかかるとともに、この設定変更により加工
精度の低下が起きやすい。一方、基準軸速度一定制御に
おいては、同図(b)に示すように、B点から他の点に
向かうときに第2軸が駆動されても第1軸の速度は変化
しない。
は駆動系統に対して所望のスタート条件を実現できるこ
とになり、さらに、一定速度を保ちながら動作して最終
目的位置に到達させるというストップ条件の実現も可能
となる。
速度を基準速度とすれば、平面上に限って見れば常に同
一の速度で動くn軸補間制御が実現できる。
の移動目標位置と、速度値と、定義情報と、が入力手段
により入力され、この入力手段により入力された入力内
容にもとづき、速度値および定義情報により示される速
度条件が満足されるとともに、各々の軸について速度が
移動目標位置までの距離に比例する大きさになるよう
に、軸毎速度演算手段が各々の軸の速度を算出し、軸毎
速度演算手段により算出された各々の軸の速度にもとづ
き駆動手段が複数軸を駆動するようにし、定義情報によ
り速度値が複数軸のうちのいずれかの軸の速度値である
と定義可能であるとともに、速度値が各々の軸の速度の
合成速度値であるとも定義可能にしたので、 所定の軸の速度を他の軸とは独立に所望の速度に設定
することが容易にできるとともに、各々の軸の速度の合
成速度を所望の速度に設定することも容易にでき、例え
ば、これを用いてベルトコンベア上の加工対象を加工す
る場合に、定義情報により速度値をベルトコンベアを駆
動する軸の速度と定義し、他の軸によりベルトコンベア
上の加工対象を加工するようにすれば、ベルトコンベア
の速度を容易に一定にすることができ加工精度の低下を
防止できる効果がある。
させて加工対象を加工する場合に、定義情報により速度
値を各軸の速度の合成速度と定義すれば、工具の速度を
容易に一定にすることができ、加工精度の不均一を防止
できる効果がある。
第2図は同実施例の主要な機能をマイクロプロセッサに
持たせた場合の処理手順を示すフローチャート、第3図
(a),(b)は同実施例の動作を説明するために、移
動位置に応じた移動軌跡を示した図、第4図(a),
(b)は同実施例の動作を説明するために、合成速度一
定の指令と基準軸速度一定の指令を入力した場合の軸速
度変化の説明図、第5図は位置決め装置の一般的なハー
ドウェア構成を示すブロック図、第6図は従来の位置決
め装置の動作を説明するためのフローチャート、第7図
(a),(b)は第5図に示した装置の主要素の入力デ
ータ例を示す図、第8図(a),(b)は従来の位置決
め装置の動作を説明するために、移動位置に応じた移動
軌跡を示した図である。 (1)……位置決め装置、(2)……外部指令装置、
(3)……周辺装置、(4X)〜(4N)……モータドライ
ブ装置、(5X)〜(5N)……モータ、(101)……補間
データ入力手段、(102)……補間データ記憶手段、(1
03)……動作指令手段、(104)……軸毎速度演算手
段、(105)……速度データ記憶手段、(106)……動作
指令出力手段。
Claims (1)
- 【請求項1】複数軸の各々の移動目標位置と、速度値
と、定義情報と、が入力される入力手段と、 上記入力手段により入力された入力内容にもとづき、上
記速度値および上記定義情報により示される速度条件が
満足されるとともに、上記複数軸の各々の軸について速
度が上記移動目標位置までの距離に比例する大きさにな
るように、上記各々の軸の速度を算出する軸毎速度演算
手段と、 上記軸毎速度演算手段により算出された上記各々の軸の
速度にもとづき上記複数軸を駆動する駆動手段と、を備
え、 上記定義情報により上記速度値が上記複数軸のうちのい
ずれかの軸の速度値であると定義可能であるとともに、
上記速度値が上記各々の軸の速度の合成速度値であると
も定義可能なことを特徴とする複数軸駆動装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2126382A JP2996445B2 (ja) | 1990-05-16 | 1990-05-16 | 複数軸駆動装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2126382A JP2996445B2 (ja) | 1990-05-16 | 1990-05-16 | 複数軸駆動装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH0421104A JPH0421104A (ja) | 1992-01-24 |
JP2996445B2 true JP2996445B2 (ja) | 1999-12-27 |
Family
ID=14933773
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2126382A Expired - Lifetime JP2996445B2 (ja) | 1990-05-16 | 1990-05-16 | 複数軸駆動装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2996445B2 (ja) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100374872B1 (ko) | 1997-07-18 | 2003-03-04 | 히다찌 가세이 고오교 가부시끼가이샤 | 구멍을 갖는 반도체용 접착테이프, 접착테이프가 부착된 리드프레임의 제조방법, 접착테이프가 부착된 리드프레임 및 이를 사용한 반도체장치 |
JP4508969B2 (ja) * | 2005-07-28 | 2010-07-21 | 日本電産シンポ株式会社 | 駆動制御装置における直線補間方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5566003A (en) * | 1978-11-11 | 1980-05-19 | Nec Corp | Numerical control unit for slow taper face working |
JPS5714907A (en) * | 1980-06-30 | 1982-01-26 | Mitsubishi Electric Corp | Numerical value control device |
JPS59209741A (ja) * | 1983-05-16 | 1984-11-28 | Fanuc Ltd | 任意方向倣い制御方式 |
JP2664896B2 (ja) * | 1986-11-28 | 1997-10-22 | 日本電気株式会社 | 数値制御装置の補間器 |
JP2793804B2 (ja) * | 1987-02-23 | 1998-09-03 | 株式会社東芝 | パルス分配方法 |
-
1990
- 1990-05-16 JP JP2126382A patent/JP2996445B2/ja not_active Expired - Lifetime
Also Published As
Publication number | Publication date |
---|---|
JPH0421104A (ja) | 1992-01-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2003303005A (ja) | 数値制御装置 | |
JP3476287B2 (ja) | ロボットの接続動作時に速度制御を行なうための曲線補間方法 | |
JPH01164280A (ja) | 加減速制御方式 | |
JP2996445B2 (ja) | 複数軸駆動装置 | |
US4914363A (en) | Method for controlling the motion of a machine element | |
CN111331577B (zh) | 机器人的控制装置及控制方法 | |
EP0483756B1 (en) | Robot controlling method and apparatus | |
JP3346847B2 (ja) | 子局同時起動方法 | |
JPH0695294B2 (ja) | 産業用ロボットの軌跡補間方法 | |
JP2003015715A (ja) | 指令値生成方法、指令値生成システムおよびプログラム作成装置 | |
KR100540588B1 (ko) | 모션 제어의 실시간 응답을 위한 궤적발생방법 및 시스템 | |
JPH07111647B2 (ja) | ロボットアームの制御方法 | |
JP3189650B2 (ja) | ロボット制御装置 | |
JP2516589B2 (ja) | ロボツト用制御装置 | |
JP2741430B2 (ja) | 制御装置 | |
CN113383285B (zh) | 控制数据创建装置、控制数据创建方法及控制数据创建程序 | |
JP2001154719A (ja) | 自由曲線補間方法 | |
JPH0247702A (ja) | ロボットの高速動作制御方法 | |
JPH0820893B2 (ja) | 産業用多関節ロボットの最適移動制御方式 | |
JPH1063329A (ja) | 加減速制御方法 | |
JPH04155405A (ja) | 制御装置 | |
JPS61161517A (ja) | 補間装置 | |
JPH01258006A (ja) | モータの速度制御方法 | |
JP2001306119A (ja) | 多軸機械の動作指令生成方法とその装置 | |
JPH03296107A (ja) | ロボット制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20071029 Year of fee payment: 8 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20081029 Year of fee payment: 9 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091029 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20091029 Year of fee payment: 10 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101029 Year of fee payment: 11 |
|
EXPY | Cancellation because of completion of term | ||
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20101029 Year of fee payment: 11 |