JP3748454B2 - 産業用ロボットの制御装置 - Google Patents
産業用ロボットの制御装置 Download PDFInfo
- Publication number
- JP3748454B2 JP3748454B2 JP13680493A JP13680493A JP3748454B2 JP 3748454 B2 JP3748454 B2 JP 3748454B2 JP 13680493 A JP13680493 A JP 13680493A JP 13680493 A JP13680493 A JP 13680493A JP 3748454 B2 JP3748454 B2 JP 3748454B2
- Authority
- JP
- Japan
- Prior art keywords
- joint
- movement
- coefficient
- speed
- sampling period
- 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
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/416—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control of velocity, acceleration or deceleration
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1651—Programme controls characterised by the control loop acceleration, rate control
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/39—Robotics, robotics to robotics hand
- G05B2219/39257—Switch from task space to joint space controller when close to singularity
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/40—Robotics, robotics mapping to robotics vision
- G05B2219/40333—Singularity, at least one movement not possible, kinematic redundancy
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/43—Speed, acceleration, deceleration control ADC
- G05B2219/43203—Limitation of speed, permissible, allowable, maximum speed
Description
【産業上の利用分野】
本発明は、産業用ロボットの制御装置に関するもので、さらに詳しく言えば、特異点を通過できる補間演算制御機能を有する産業用ロボットの制御装置に関するものである。
【0002】
【従来の技術】
多くの多関節ロボットは、各関節が回転機構で構成される。この場合、各関節角の回転だけで所定の位置から所定の位置へと直線や円弧等の補間動作を姿勢を含めて制御することは図2に示すように行われる。
すなわち、教示データ記憶部1に記憶されている関節座標系の教示位置を順変換部2で直交座標系に座標変換(順変換)し、補間演算部3で直交座標系で直線や円弧等の軌跡となるように動作速度を考慮しサンプリング周期毎の目標となる位置と姿勢を演算し、逆変換部4で目標となる直交座標系での位置と姿勢を関節座標系に座標変換(逆変換)し、最後にセグメントデータ作成出力部5で前回の目標位置に対する関節座標データと差分(セグメントデータと称す)を作成して、サーボ駆動系6に出力することで補間動作を実現している。
補間演算の基本式を式(1)に示す。
P(k) =Ps +(k/N)*(Pe −Ps ) …(1)
ただし、Ps は始点位置を表すベクトル、Pe は終点位置を表すベクトル、P(k) はPs からPe 間の任意の位置を表すベクトル、NはPs からPe まで指定された動作速度で移動させる場合に必要なサンプリング回数であり、動作速度、サンプリング周期および移動距離から求められる。k は整数であり、サンプリング周期毎にkを0からNまで1づつ加算させることによって、つまり、サンプリング周期毎に(1/N)*(Pe −Ps )を出力することにより、P(k) が始点Ps から終点Pe までの間を指定された動作速度で変化することになる。
【0003】
ところで、多自由度多関節ロボットにおいては逆変換時に複数の解があることが知られている。補間動作を行う場合に、適宜に解を選択して移動させると、途中で特異点、およびその近傍を通過する場合があり、指定された動作速度で補間演算を行うと、図3のBに示すように各軸の関節速度が最大速度を超えて動作不可能になってしまう場合(以下、セグメントオーバと称す)がある。
これを解決するための手段として、従来は、特異点を検出し、特異点およびその近傍で演算アルゴリズムを切り換えることで通過させる方法で回避していた(例えば、特開昭62−189504号公報参照)。
【0004】
【発明が解決しようとする課題】
ところが、従来の方法では、特異点を検出するとアルゴリズムを変更し、特殊処理が必要となる。また、特異点近傍で動作可能か否かは、そのときの動作速度やロボットの位置等で条件が変わるので確実に各軸が動作可能か否かを判定するのは困難である。さらに、例えばアームが座標原点に近い場所で補間動作を行う場合のように、特異点以外にも同様に各軸の関節速度が最大速度を超えて動作不可能になる場合があるが、これを回避するためにはまた別のアルゴリズムが必要となる。
本発明の目的は、直線、円弧等の補間演算での特異点近傍やその他の位置で発生する可能性のある最大速度を超えて動作不可能になる場合を、簡単に、かつ統一的な手法で回避できるロボットの制御方法を提供することである。
【0005】
【課題を解決するための手段】
本発明は、ロボットを直交座標系で直線動作あるいは円弧動作のためにサンプリング周期ごとに移動係数の加算を行い目標位置を求める補間演算部と、該目標位置に対応する関節座標系での関節座標データに変換する逆変換部と、前記サンプリング周期ごとの関節座標データとの差分である関節移動データを各軸について求め出力する関節移動データ作成出力部であって、既出力された前記関節移動データの推移に基づいて次回に出力する関節移動速度を各軸について推測する手段を有する産業用ロボットの制御装置において、前記推測した速度が各軸関節ごとに予め設定した所定値を超える場合はその所定値を前記推測速度で除して補正係数を求める手段を備え、前記補間演算部は、次回サンプリング周期の補間演算時には前記移動係数に前記補正係数を乗じた補正移動係数の加算を行い前記目標位置を求め、前記ロボットが終点位置に到達する最終回のサンプリング周期の移動係数あるいは補正移動係数の加算時に、加算結果が最終値となるように補正を行なうこと特徴とするものである。
また、前記補正係数を求める場合に前記推測速度が各軸関節ごとに前記所定値を最も大きく超える軸関節についての補正係数を求めることを特徴とするものである。
【0006】
【作用】
これにより、推測されたセグメントデータが最大値を越える場合は、前記補正係数が乗算されるので次回演算時では最大値内におさまる。
【0007】
【実施例】
図1に、本発明の実施例を示して説明する。
本発明は補間演算部3を改良し、セグメントデータ記憶部7、セグメントオーバ推測部8、および補正係数演算部9を追加したものである。
補間動作を開始すると、順変換部2から、補間演算部3、逆変換部4、セグメントデータ作成出力部5を経て補間演算を行いセグメントデータと作成する。次にセグメントデータ記憶部7によって、セグメントデータ作成出力部5で作成したセグメントデータを記憶する。次にセグメントオーバ推測部8によって、セグメントデータ記憶部7で記憶した過去に出力したセグメントデータを利用して次回に出力するセグメントデータを推測する。補正係数演算部9では、前記推測データが予め設定した値を超える場合は、その所定値を前記推測データで除して補正係数を求めるその係数を計算する。次回演算周期では、補間演算部3によって補正係数演算部9で求めた係数を用いて、最も動作速度の大きい軸の関節速度がセグメントオーバとならないように補間動作速度を推測した係数を乗じて補間演算する。
【0008】
直線補間の場合は、順変換部2により始点および終点をあらかじめ順変換しておき、式(1)で直交座標でのP(k) を求め、それを逆変換部4で逆変換することによってP(k) の位置に相当する関節座標値を得る。また、セグメントデータ作成出力部5で前回求められたP(k-1) に相当する関節座標値との差によってセグメントデータが得られる。
セグメントデータ記憶部7では、セグメントデータ作成出力部5で求められたセグメントデータをサンプリング周期毎に記憶する。記憶するステップ数は任意ステップが可能である。また、記憶方法については、リングバッファ等の手段がある。
【0009】
セグメントオーバ推測部8では、セグメントデータ記憶部7で記憶したセグメントデータを利用して次回の補間演算でのセグメントデータを推測する。ここでは説明を簡単にするため、具体例として過去2回分の1軸のみのセグメントデータを用いて、推測する方法の一例を述べる。
最大関節速度に相当するセグメントデータを100、前回のセグメントデータが60、今回のセグメントデータが90であったとする。前回と今回の差分が30であることから、次回は90+30=120が出力されるものと推測する。
推測データ120が最大値100を越えたため、補正係数演算部7では、次回補間演算で100を超えないような補正係数Aを以下のように求める。
A=100/120=0.833 …(2)
この補正係数Aとは、従来例でK を整数とし、0からNまで1ずつ加算していたが、その「1」に相当するものである。つまり、本発明では、次回指令が最大値を超える場合は、K は整数にはならず、1ではなくAを加算するのである。なお、1ではなくAを加算するから、このままでは最終値(合計)がNにならないので、最終回の演算で補正を行えばよい。
以上の動作により、図3のAに示すように、最大値を超えることなく動作するようになる。
【0010】
上記説明では補正係数Aを説明のため過去2回分のセグメントデータを用いて変化量が一定つまり直線的に変化するものとして求めたが、より多くの過去のセグメントデータを用いて、種々の関数を用いて推測することも可能である。また複数軸の場合は、最大関節速度を最も超えるものを選択すればよい。
サンプリング周期毎において、式(1)で補間演算するが、前述のkを0からNまで補正係数Aを加算することでセグメントオーバとなることなく最大関節速度で前述の特異点近傍等を通過することができる。
また、直線補間に限らず種々の補間にも適用できることは勿論である。
【0011】
【発明の効果】
以上説明したように本発明は、過去に演算した各関節のセグメントデータを直接的に用いて推測するため、特異点近傍のみならず全ての動作範囲において補間動作時のセグメントオーバによる動作不能状態を回避することができる。また、特異点の位置などを事前に検出しておく必要もなくなる。
【図面の簡単な説明】
【図1】本発明の実施例を示す図
【図2】従来例を示す図
【図3】本発明と従来の動作例を説明する図
【符号の説明】
2…順変換部、3…補間演算部、4…逆変換部、5…セグメントデータ作成出力部、7…セグメントデータ記憶部、8…セグメントオーバ推測部、9…補正係数演算部
Claims (2)
- ロボットを直交座標系で直線動作あるいは円弧動作のためにサンプリング周期ごとに移動係数の加算を行い目標位置を求める補間演算部と、
該目標位置に対応する関節座標系での関節座標データに変換する逆変換部と、
前記サンプリング周期ごとの関節座標データとの差分である関節移動データを各軸について求め出力する関節移動データ作成出力部であって、既出力された前記関節移動データの推移に基づいて次回に出力する関節移動速度を各軸について推測する手段を有する産業用ロボットの制御装置において、
前記推測した速度が各軸関節ごとに予め設定した所定値を超える場合はその所定値を前記推測速度で除して補正係数を求める手段を備え、
前記補間演算部は、次回サンプリング周期の補間演算時には前記移動係数に前記補正係数を乗じた補正移動係数の加算を行い前記目標位置を求め、前記ロボットが終点位置に到達する最終回のサンプリング周期の移動係数あるいは補正移動係数の加算時に、加算結果が最終値となるように補正を行なうこと特徴とする産業用ロボットの制御装置。 - 前記補正係数を求める場合に前記推測速度が各軸関節ごとに前記所定値を最も大きく超える軸関節についての補正係数を求めることを特徴とする請求項1記載の産業用ロボットの制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP13680493A JP3748454B2 (ja) | 1993-05-14 | 1993-05-14 | 産業用ロボットの制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP13680493A JP3748454B2 (ja) | 1993-05-14 | 1993-05-14 | 産業用ロボットの制御装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JPH06324730A JPH06324730A (ja) | 1994-11-25 |
JP3748454B2 true JP3748454B2 (ja) | 2006-02-22 |
Family
ID=15183907
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP13680493A Expired - Fee Related JP3748454B2 (ja) | 1993-05-14 | 1993-05-14 | 産業用ロボットの制御装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP3748454B2 (ja) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4060393B2 (ja) * | 1996-01-24 | 2008-03-12 | 三菱電機株式会社 | ロボットの速度演算装置、およびロボットの速度演算方法 |
JP5231935B2 (ja) * | 2008-10-21 | 2013-07-10 | 株式会社東芝 | ロボット制御装置 |
JP5433304B2 (ja) * | 2009-05-22 | 2014-03-05 | 川崎重工業株式会社 | ロボット制御装置及び方法 |
JP5726052B2 (ja) | 2011-03-08 | 2015-05-27 | 株式会社神戸製鋼所 | 多関節型ロボットの制御装置,制御方法及び制御プログラム |
CN109623825B (zh) * | 2018-12-30 | 2021-11-16 | 深圳市越疆科技有限公司 | 一种移动轨迹规划方法、装置、设备和存储介质 |
-
1993
- 1993-05-14 JP JP13680493A patent/JP3748454B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JPH06324730A (ja) | 1994-11-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US20070030271A1 (en) | Robot controller and robot control method using spline interpolation | |
JP4896276B2 (ja) | ロボット、ロボットの制御装置、制御方法、及び制御プログラム | |
US20060195228A1 (en) | Robot locus control method and apparatus and program of robot locus control method | |
JP4060393B2 (ja) | ロボットの速度演算装置、およびロボットの速度演算方法 | |
JP3748454B2 (ja) | 産業用ロボットの制御装置 | |
KR19980086498A (ko) | 한 평면내 다자유도 스카라형 로봇의 궤적 제어장치 및 궤적 제어방법 및 한 평면내 다자유도 스카라형 로봇의 궤적 제어 프로그램을 기록한 컴퓨터 판독 가능한 기록매체 | |
JP4189445B2 (ja) | ロボットの制御方法および制御装置 | |
US6684131B2 (en) | Device and method for controlling robot | |
JPH06312392A (ja) | 多関節ロボットの制御装置 | |
JP4049956B2 (ja) | ロボット制御装置 | |
JP3206765B2 (ja) | マスタスレーブマニピュレータの制御方法 | |
JP3930956B2 (ja) | 一平面内多自由度スカラ型ロボットの軌跡制御装置および軌跡制御方法、並びに、一平面内多自由度スカラ型ロボットの軌跡制御プログラムを記録したコンピュータ読み取り可能な記録媒体 | |
JPH1142575A (ja) | ロボットの制御方法および装置 | |
JPH11198072A (ja) | ロボットの最短時間速度制御装置 | |
JP3402378B2 (ja) | 7軸マニピュレータの制御方法 | |
JP2014159066A (ja) | ロボット制御装置及びロボットの制御方法 | |
JPS63289606A (ja) | 冗長自由度形ロボット | |
JP2676721B2 (ja) | 多関節型ロボットの制御装置 | |
JP2680210B2 (ja) | ロボットの制御方法 | |
JP3864237B2 (ja) | ロボットの制御方法および制御装置 | |
KR20040034167A (ko) | 6축 수직다관절 매니퓰레이터의 직선이동 제어방법 | |
JP3030565B2 (ja) | ロボットの駆動制御装置 | |
JP7053941B2 (ja) | ロボット制御装置 | |
JP4992702B2 (ja) | ロボットの動作制御装置及びその動作制御方法 | |
JP2007136564A (ja) | マニピュレータ制御方法および装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20040225 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20040310 |
|
A911 | Transfer of reconsideration by examiner before appeal (zenchi) |
Free format text: JAPANESE INTERMEDIATE CODE: A911 Effective date: 20040317 |
|
A912 | Removal of reconsideration by examiner before appeal (zenchi) |
Free format text: JAPANESE INTERMEDIATE CODE: A912 Effective date: 20040604 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20051128 |
|
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: 20091209 Year of fee payment: 4 |
|
LAPS | Cancellation because of no payment of annual fees |