JPS61148504A - ロボツトの制御装置 - Google Patents
ロボツトの制御装置Info
- Publication number
- JPS61148504A JPS61148504A JP27097484A JP27097484A JPS61148504A JP S61148504 A JPS61148504 A JP S61148504A JP 27097484 A JP27097484 A JP 27097484A JP 27097484 A JP27097484 A JP 27097484A JP S61148504 A JPS61148504 A JP S61148504A
- Authority
- JP
- Japan
- Prior art keywords
- robot
- posture
- data
- joint angle
- tip
- 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.)
- Granted
Links
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/182—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 the machine tool function, e.g. thread cutting, cam making, tool direction control
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
(57)【要約】本公報は電子出願前の出願データであるた
め要約のデータは記録されません。
め要約のデータは記録されません。
Description
【発明の詳細な説明】
〔産業上の利用分野〕
この発明は、多関節形のロボットの制御装置に関する。
従来、例えばロボット各軸の関節角の現在値を内界セン
サ（位置センサ）から入力して、その入力した関節角の
現在値に応じてロボット先端の位置及び姿勢データを算
出し、その算出したデータのうちの位置データに移動増
分を加算して、その加算値と先の姿勢データとに基づい
てロボット各軸の目標関節角を求めるようにしたロボッ
トの制御装置が知られている。
サ（位置センサ）から入力して、その入力した関節角の
現在値に応じてロボット先端の位置及び姿勢データを算
出し、その算出したデータのうちの位置データに移動増
分を加算して、その加算値と先の姿勢データとに基づい
てロボット各軸の目標関節角を求めるようにしたロボッ
トの制御装置が知られている。
なお、ここで云うロボット先端の位置及び姿勢データと
は、例えば第４図に示すように位置データが絶対座標系
（カルテシアン座標系）におけるＰ（” ＊ ｙ 、
ｚ ）であり、姿勢データがロボット先端に固定したハ
ンド座標系のｘ′、ｙ′、ｚ′各軸の絶対座標系のｘ、
ｙ、ｚ各軸に対する成分のデータ（オイラー角データ）
である。
は、例えば第４図に示すように位置データが絶対座標系
（カルテシアン座標系）におけるＰ（” ＊ ｙ 、
ｚ ）であり、姿勢データがロボット先端に固定したハ
ンド座標系のｘ′、ｙ′、ｚ′各軸の絶対座標系のｘ、
ｙ、ｚ各軸に対する成分のデータ（オイラー角データ）
である。
しかしながら、このような従来のロボットの制御装置に
あっては、動作を行なう度に関節角の現在値から位置デ
ータと共に、姿勢データをも算出し直す構成となってい
たため、ティーチングを行なう時などでロボット先端姿
勢を一定にして動作を繰り返したい場合、姿勢データ算
出の際の誤差及び目標関節算出の際の誤差が、次の動作
時の姿勢データ算出に影響を及ぼして誤差が蓄積され。
あっては、動作を行なう度に関節角の現在値から位置デ
ータと共に、姿勢データをも算出し直す構成となってい
たため、ティーチングを行なう時などでロボット先端姿
勢を一定にして動作を繰り返したい場合、姿勢データ算
出の際の誤差及び目標関節算出の際の誤差が、次の動作
時の姿勢データ算出に影響を及ぼして誤差が蓄積され。
ロボット先端の姿勢が変化してしまうという問題点があ
った。
った。
この発明は、このような問題点の解決を図ろうとするも
のである。
のである。
そこで、この発明においては、第１図に示すように、ロ
ボット各軸の関節角の現在値に応じて算出したロボット
先端の位置及び姿勢データに基づいて、ロボット各軸の
目標関節角を求めるようにしたロボットの制御部［Ａに
おいて、ロボットの動作モードがロボット先端の姿勢を
変化させない定姿勢動作モードに入ったか否がを判定す
る判定手段Ｂと、この判定手段Ｂによってロボットの動
作モードが定姿勢動作モードに入ったと判定された時に
ロボット各軸の関節角の現在値に応じて算出したロボッ
ト先端の姿勢データを記憶する記憶手段Ｃと、この記憶
手段Ｃに記憶した姿勢データとロボット各軸の関節角の
現在値に応じて算出したロボット先端の位置データとに
基づいて、定姿勢動作モード下でのロボット各軸の目標
関節角を算出する目標値算出手段りとを設けて構成して
いる。
ボット各軸の関節角の現在値に応じて算出したロボット
先端の位置及び姿勢データに基づいて、ロボット各軸の
目標関節角を求めるようにしたロボットの制御部［Ａに
おいて、ロボットの動作モードがロボット先端の姿勢を
変化させない定姿勢動作モードに入ったか否がを判定す
る判定手段Ｂと、この判定手段Ｂによってロボットの動
作モードが定姿勢動作モードに入ったと判定された時に
ロボット各軸の関節角の現在値に応じて算出したロボッ
ト先端の姿勢データを記憶する記憶手段Ｃと、この記憶
手段Ｃに記憶した姿勢データとロボット各軸の関節角の
現在値に応じて算出したロボット先端の位置データとに
基づいて、定姿勢動作モード下でのロボット各軸の目標
関節角を算出する目標値算出手段りとを設けて構成して
いる。
このような構成では、ロボット先端の姿勢が変化しない
動作が繰り返される場合、最初に算出された姿勢データ
が目標関節角の算出に供せられるようになる。
動作が繰り返される場合、最初に算出された姿勢データ
が目標関節角の算出に供せられるようになる。
以下、この発明の実施例を図面の第２図及び第３図を参
照して説明する。
照して説明する。
第２図は、この発明の一実施例を示すブロック図である
。
。
同図において、１，２．・・・、３は図示しない多関節
形′のロボット各種を夫々駆動するモータであり、各々
モータ制御部４，５．・・・、Ｓによって駆動制御され
、そのロボット各軸の関節角の現在値０１〜θｎは、各
モータ１，２．・・・、３の出力軸に取り付けた図示し
ない各エンコーダからの信号に基づいて現在値検出８８
７，８．・・・、９が検出するようになっている・
。
形′のロボット各種を夫々駆動するモータであり、各々
モータ制御部４，５．・・・、Ｓによって駆動制御され
、そのロボット各軸の関節角の現在値０１〜θｎは、各
モータ１，２．・・・、３の出力軸に取り付けた図示し
ない各エンコーダからの信号に基づいて現在値検出８８
７，８．・・・、９が検出するようになっている・
。
１０はマイクロコンピュータ等によってシステム構成し
たロボットの制御装置であり１機能ブロック化して示す
と図示のように関節角現在値入力部１１．第１の変換部
１２２判定／計算部１３゜姿勢データ記憶部１４．第２
の変換部１５．及び目標関節角出力部１６等によって構
成されている。
たロボットの制御装置であり１機能ブロック化して示す
と図示のように関節角現在値入力部１１．第１の変換部
１２２判定／計算部１３゜姿勢データ記憶部１４．第２
の変換部１５．及び目標関節角出力部１６等によって構
成されている。
先ず、関節角現在値入力部１１は、各現在値検出器７，
８．・・・、Ｓからロボット各軸の関節角の現在値０１
〜θｎを読み込む。
８．・・・、Ｓからロボット各軸の関節角の現在値０１
〜θｎを読み込む。
第１の変換部１２は、関節角現在値入力部１１が読み込
んだロボット各軸の関節角の現在値θ■〜θｎに所要の
座標変換ｆ、ｙを施すことによって、ロボット先端の位
置データ（ｘ、ｙ、ｚ）＝ｆ（θ！、θ２．・・・ａｎ
）及び姿勢データ（α。
んだロボット各軸の関節角の現在値θ■〜θｎに所要の
座標変換ｆ、ｙを施すことによって、ロボット先端の位
置データ（ｘ、ｙ、ｚ）＝ｆ（θ！、θ２．・・・ａｎ
）及び姿勢データ（α。
β、γン＝ｙ（０１ｇθ２．・・・、ａｎ）を算出する
。
。
判定／計算部１３は、このロボットの制御装置１０に接
続した図示しないティーチングボックスや制御盤で設定
したロボットの動作モードがロボット先端の姿勢を変化
させない定姿勢動作モード（ｍえばＣＰ動作モード）に
入ったが否かを判定して９、動作モードが定姿勢動作モ
ードでない時には、第１の変換部１２で算出している位
置データ（Ｅ、ｙ、Ｚ）及び姿勢データ（α、β、γ）
における位置データ（ｘ、ｙ、ｚ）にティーチングボッ
クスなどからの動作指示に基づく移動指令（ΔＸ、Δｙ
、Δ２）を加算して、その加算値を目標位置データ（ｃ
ｘ、 ｃｙ、 ｃｚ）＝ （ｚ、ｙ。
続した図示しないティーチングボックスや制御盤で設定
したロボットの動作モードがロボット先端の姿勢を変化
させない定姿勢動作モード（ｍえばＣＰ動作モード）に
入ったが否かを判定して９、動作モードが定姿勢動作モ
ードでない時には、第１の変換部１２で算出している位
置データ（Ｅ、ｙ、Ｚ）及び姿勢データ（α、β、γ）
における位置データ（ｘ、ｙ、ｚ）にティーチングボッ
クスなどからの動作指示に基づく移動指令（ΔＸ、Δｙ
、Δ２）を加算して、その加算値を目標位置データ（ｃ
ｘ、 ｃｙ、 ｃｚ）＝ （ｚ、ｙ。
２）＋（ΔＸ、Δ５．Δ２）として姿勢データ（α、β
、γ）と共に第２の変換部１５に出力する。
、γ）と共に第２の変換部１５に出力する。
また、動作モードが定姿勢動作モードに入った時には、
先ずその時第１の変換部１２が算出している姿勢データ
（α、β、γ）を固定の姿勢データ（Ｃ０，β０．γ０
）として姿勢データ記憶部１４に記憶（ラッチ）すると
共に、目標位置データ（Ｃｘ、Ｃｙ、（ｚ）の方は上記
と同様に計算して、その計算結果（ｃｘ、ｃｙ、ｃｚ）
を姿勢データ記憶部１４に記憶した固定の姿勢データ（
Ｃ０，β０．γ０）と共に第２の変換部１５に出力する
。
先ずその時第１の変換部１２が算出している姿勢データ
（α、β、γ）を固定の姿勢データ（Ｃ０，β０．γ０
）として姿勢データ記憶部１４に記憶（ラッチ）すると
共に、目標位置データ（Ｃｘ、Ｃｙ、（ｚ）の方は上記
と同様に計算して、その計算結果（ｃｘ、ｃｙ、ｃｚ）
を姿勢データ記憶部１４に記憶した固定の姿勢データ（
Ｃ０，β０．γ０）と共に第２の変換部１５に出力する
。
なお、定姿勢動作モードに入ったか否かの判定に供する
データとしては、ティーチングボックスなどからの例え
ばＣＰ動作モードの選択指令の他に、専用のマニュアル
スイッチを設けて、そのマニュアルスイッチの操作入力
を用いるようにすることもできる。
データとしては、ティーチングボックスなどからの例え
ばＣＰ動作モードの選択指令の他に、専用のマニュアル
スイッチを設けて、そのマニュアルスイッチの操作入力
を用いるようにすることもできる。
第２の変換部１５は１判定／計算部１３からのデータ（
。箕、Ｃ５，ｃｚ、α、β、γ）又は（ＣＺｒ ｃｙ、
Ｃｚ、ＣＥ（Ｉ Ｔ β０．γＯ）に所要の座標変換
Ｆを施すことによって、ロボット各軸の目標関節角（Ｃ
６０，Ｃ６０，・・・、Ｃｏ１）＝Ｆ （Ｃ＄、ｃｙ、
ＣＺ、 α、β、ｙ） 、又は＝Ｆ （ｃｚ、 ｃｙ、
ｃｚ、Ｃ０，β０．γ０）を算出する。
。箕、Ｃ５，ｃｚ、α、β、γ）又は（ＣＺｒ ｃｙ、
Ｃｚ、ＣＥ（Ｉ Ｔ β０．γＯ）に所要の座標変換
Ｆを施すことによって、ロボット各軸の目標関節角（Ｃ
６０，Ｃ６０，・・・、Ｃｏ１）＝Ｆ （Ｃ＄、ｃｙ、
ＣＺ、 α、β、ｙ） 、又は＝Ｆ （ｃｚ、 ｃｙ、
ｃｚ、Ｃ０，β０．γ０）を算出する。
そして、目標関節角畠力部１６は、第２の変換部１Ｓで
算出したロボット各軸の目標関節角Ｃθｌ＋ｅθ２．・
・・、Ｃｏ１を各々モータ制御部４、Ｓ、・・・、６に
出力する。
算出したロボット各軸の目標関節角Ｃθｌ＋ｅθ２．・
・・、Ｃｏ１を各々モータ制御部４、Ｓ、・・・、６に
出力する。
次に、この実施例の作用を第３図のフロー図を参照しな
がら説明する。
がら説明する。
なお、以下に述べる説明はロボットをティーチングする
際の動作である。
際の動作である。
先ず、第２図のロボットの制御装置１０を構成する図示
しないマイクロコンピュータのＣＰＵは、やはり図示し
ないティーチングボックスから起動がかかるのを待ち、
起動がかかると各現在値検出器７，８．・・・、Ｓから
ロボット各軸の関節角の現在値θｉ〜Ｏｎを読み込む（
５１１節角現在入力部１１に対応する処理）。
しないマイクロコンピュータのＣＰＵは、やはり図示し
ないティーチングボックスから起動がかかるのを待ち、
起動がかかると各現在値検出器７，８．・・・、Ｓから
ロボット各軸の関節角の現在値θｉ〜Ｏｎを読み込む（
５１１節角現在入力部１１に対応する処理）。
そして、その読み込んだロボット各軸の関節角の現在値
０１〜ｏｎに座標変換ｆ、ｙを施すことによってロボッ
ト先端の位置データ（Ｚ、ｙ、ｚ）＝ｆＣθ！、θ２．
・・・、θｎ）及び姿勢データ（α、β、γ）＝ｇ（θ
１．θ２．・・・、θｎ）を算出する（第１の変換部１
２に対応する処理）。
０１〜ｏｎに座標変換ｆ、ｙを施すことによってロボッ
ト先端の位置データ（Ｚ、ｙ、ｚ）＝ｆＣθ！、θ２．
・・・、θｎ）及び姿勢データ（α、β、γ）＝ｇ（θ
１．θ２．・・・、θｎ）を算出する（第１の変換部１
２に対応する処理）。
次に、ロボットの動作モードが定姿勢動作モードか否か
をティーチングボックスなどからの選択指令によってセ
ットされるモードフラッグをチェックすることによって
判定（この判定処理は図示していない）した後、動作モ
ードがＣＰ動作モードなどの定姿勢動作モードであれば
、ロボットの動作がその定姿勢動作モードに入って最初
の動作か否かをチェックし、最初（−回目）の動作であ
れば上記の処理で算出した姿勢データ（α、β。
をティーチングボックスなどからの選択指令によってセ
ットされるモードフラッグをチェックすることによって
判定（この判定処理は図示していない）した後、動作モ
ードがＣＰ動作モードなどの定姿勢動作モードであれば
、ロボットの動作がその定姿勢動作モードに入って最初
の動作か否かをチェックし、最初（−回目）の動作であ
れば上記の処理で算出した姿勢データ（α、β。
γ）を（Ｃ０，β０．γ０）としてメモリ（姿勢データ
記憶部１４）格納し、二回目以降であれば一回目で記憶
格納した固定の姿勢データ（Ｃ０゜β０．γ０）を読み
出す。
記憶部１４）格納し、二回目以降であれば一回目で記憶
格納した固定の姿勢データ（Ｃ０゜β０．γ０）を読み
出す。
このようにして、動作モードが定姿勢動作モードに入っ
た時点と、入った後との処理の振り分けを行なっている
。なお、図示を省略しているが、動作モードが定姿勢動
作モードでない時には直接後述する増分加算処理に進む
。
た時点と、入った後との処理の振り分けを行なっている
。なお、図示を省略しているが、動作モードが定姿勢動
作モードでない時には直接後述する増分加算処理に進む
。
そして、定姿勢動作モードに入った一回目の動作であれ
ば、記憶格納したばかりの姿勢データ（Ｃ０，β０．γ
０）を、二回目以降であれば一回目で記憶格納した姿勢
データ（Ｃ０，β０゜γ０）を、定姿勢動作モードでな
ければ上記処理で算出した姿勢データ（α、β、γ）を
夫々変換用データとすると共に、上記処理によって算出
した位置データ（ｚ、ｙ、ｚ）にティーチングボックス
などからの動作指示に基づく移動増分（ΔＸ。
ば、記憶格納したばかりの姿勢データ（Ｃ０，β０．γ
０）を、二回目以降であれば一回目で記憶格納した姿勢
データ（Ｃ０，β０゜γ０）を、定姿勢動作モードでな
ければ上記処理で算出した姿勢データ（α、β、γ）を
夫々変換用データとすると共に、上記処理によって算出
した位置データ（ｚ、ｙ、ｚ）にティーチングボックス
などからの動作指示に基づく移動増分（ΔＸ。
Δ３．Δ２）を増加して、その加算結果を変換用の目標
位置データ（ｃｚ、ａｙ、ｃＺ）とする。
位置データ（ｃｚ、ａｙ、ｃＺ）とする。
なお、上記定姿勢動作モードの判定処理から増分加算処
理までが判定／計算部１３に対応する処理である。
理までが判定／計算部１３に対応する処理である。
次に、上記処理によって得た目標位置データ（ｃ２：、
Ｃ！Ｆ＋ ｃｚ）と姿勢データ（α、β、γ）又は（α
０．β０．γ０）とに座標変換Ｆを施すことによってロ
ボット各軸の目標関節角（Ｃ６０゜Ｃｏ２．・・・、Ｃ
ｏ１）を算出する（第２の変換部１５に対応する処理）
。
Ｃ！Ｆ＋ ｃｚ）と姿勢データ（α、β、γ）又は（α
０．β０．γ０）とに座標変換Ｆを施すことによってロ
ボット各軸の目標関節角（Ｃ６０゜Ｃｏ２．・・・、Ｃ
ｏ１）を算出する（第２の変換部１５に対応する処理）
。
そして、そのようにして求めた目標関節角（Ｃθｌ＋ｃ
θ２．・・・、Ｃｏ１）を第２図の各モータ制御部４，
５．・・・、６に出力（目標関節角出力部１６に対応す
る処理）した後、ティーチングボックスからの起動が解
除されたか否かをチェックし、解除されていなければ増
分加算処理に戻って該処理から目標関節角の出力処理ま
での処理を繰り返し、解除されていれば一旦本処理群の
処理を終了する。
θ２．・・・、Ｃｏ１）を第２図の各モータ制御部４，
５．・・・、６に出力（目標関節角出力部１６に対応す
る処理）した後、ティーチングボックスからの起動が解
除されたか否かをチェックし、解除されていなければ増
分加算処理に戻って該処理から目標関節角の出力処理ま
での処理を繰り返し、解除されていれば一旦本処理群の
処理を終了する。
したがって、動作モードが定姿勢動作モードとなってい
れば、ティーチングボックスから起動がかかつている間
は最初に求めた位置データ（” ＋ｙｔ”）に（ΔＸ、
Δｙ、Δ２）が繰り返し加算されて目標位置データ（ｃ
ｚ、 ｃ！１．ｃｚ）が算出されると共に、姿勢データ
は最初にメモリに記憶格納された（α０．β。、γ。）
が利用されるようになるばかりか、一度起動解除がなさ
れても定姿勢動作モードが解除されなければ再度起動が
かかることによってその再起動がかかつている間も繰り
返しくΔＸ、Δｙ、Δ２）が加算されて得られる目標位
置データ（ｃｚ、ｃｙ、ｃｚ）と姿勢データ（α０．β
０．γ。）が利用されるため、それ０等のデータに基づ
いて作動する各モータ制御部４，５．・・・、６の作用
により、ロボット各軸は先端姿勢が一定のまま所要方向
に移動するようになる。
れば、ティーチングボックスから起動がかかつている間
は最初に求めた位置データ（” ＋ｙｔ”）に（ΔＸ、
Δｙ、Δ２）が繰り返し加算されて目標位置データ（ｃ
ｚ、 ｃ！１．ｃｚ）が算出されると共に、姿勢データ
は最初にメモリに記憶格納された（α０．β。、γ。）
が利用されるようになるばかりか、一度起動解除がなさ
れても定姿勢動作モードが解除されなければ再度起動が
かかることによってその再起動がかかつている間も繰り
返しくΔＸ、Δｙ、Δ２）が加算されて得られる目標位
置データ（ｃｚ、ｃｙ、ｃｚ）と姿勢データ（α０．β
０．γ。）が利用されるため、それ０等のデータに基づ
いて作動する各モータ制御部４，５．・・・、６の作用
により、ロボット各軸は先端姿勢が一定のまま所要方向
に移動するようになる。
そして、動作モードが定姿勢動作モードでなければ、起
動がかかつて動作が行なわれる度に算出される姿勢デー
タ（α、β、γ）が利用される。
動がかかつて動作が行なわれる度に算出される姿勢デー
タ（α、β、γ）が利用される。
このように１本実施例によれば定姿勢動作モード下では
、該モードに入った時に最初に求めた姿勢データ（α０
．β０．γ０）が繰り返し利用されるため、動作を繰り
返す毎に演算誤差が蓄積されてロボット先端の姿勢が変
化してしまうことがなくなる。
、該モードに入った時に最初に求めた姿勢データ（α０
．β０．γ０）が繰り返し利用されるため、動作を繰り
返す毎に演算誤差が蓄積されてロボット先端の姿勢が変
化してしまうことがなくなる。
以上説明してきたように、この発明によれば、ティーチ
ングを行なう時などでロボット先端姿勢を一定にして動
作を繰り返したい場合、最初に求めた姿′勢データを繰
り返し使用するようにしたため、姿勢データや目標関節
角の算出誤差が蓄積されることがなくなり、それによっ
てティーチング時等の繰り返し動作時にロボット先端の
姿勢が変化しなくなる。
ングを行なう時などでロボット先端姿勢を一定にして動
作を繰り返したい場合、最初に求めた姿′勢データを繰
り返し使用するようにしたため、姿勢データや目標関節
角の算出誤差が蓄積されることがなくなり、それによっ
てティーチング時等の繰り返し動作時にロボット先端の
姿勢が変化しなくなる。
第１図はこの発明の構成を示すブロック図。
第２図はこの発明の一実施例を示すブロック図。
第３図は第２図の作用説明に供するフロー図。
第４図はロボット先端の位置及び姿勢データの説明に供
する図である。 １．２．・・・、３・・・モータ ４．５．・・・、６・・・モータ制御部７．８．・・・
、９・・・現在値検出器１０・・・ロボットの制御装置 １１・・・関節角現在値入力部 １２・・・第１の変換
部１３・・・判定／計算部 １４・・・姿勢データ記
憶部１Ｓ・・・第２の変換部 １６・・・目標関節角
出力部第１図 Ａ
する図である。 １．２．・・・、３・・・モータ ４．５．・・・、６・・・モータ制御部７．８．・・・
、９・・・現在値検出器１０・・・ロボットの制御装置 １１・・・関節角現在値入力部 １２・・・第１の変換
部１３・・・判定／計算部 １４・・・姿勢データ記
憶部１Ｓ・・・第２の変換部 １６・・・目標関節角
出力部第１図 Ａ
Claims (1)
- 【特許請求の範囲】 １ ロボット各軸の関節角の現在値に応じて算出したロ
ボット先端の位置及び姿勢データに基づいて、前記ロボ
ット各軸の目標関節角を求めるようにしたロボットの制
御装置において、 ロボットの動作モードがロボット先端の姿勢を変化させ
ない定姿勢動作モードに入つたか否かを判定する判定手
段と、 この判定手段によつてロボットの動作モードが前記定姿
勢動作モードに入つたと判定された時に前記ロボット各
軸の関節角の現在値に応じて算出したロボット先端の姿
勢データを記憶する記憶手段と、 この記憶手段に記憶した姿勢データと前記ロボット各軸
の関節角の現在値に応じて算出したロボット先端の位置
データとに基づいて、前記定姿勢動作モード下での前記
ロボット各軸の目標関節角を算出する目標値算出手段と
を設けたことを特徴とするロボットの制御装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP27097484A JPS61148504A (ja) | 1984-12-24 | 1984-12-24 | ロボツトの制御装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP27097484A JPS61148504A (ja) | 1984-12-24 | 1984-12-24 | ロボツトの制御装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPS61148504A true JPS61148504A (ja) | 1986-07-07 |
| JPH0473164B2 JPH0473164B2 (ja) | 1992-11-20 |
Family
ID=17493621
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP27097484A Granted JPS61148504A (ja) | 1984-12-24 | 1984-12-24 | ロボツトの制御装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPS61148504A (ja) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH01173206A (ja) * | 1987-12-28 | 1989-07-07 | Honda Motor Co Ltd | ロボットのティーチング方法 |
| JPH01173207A (ja) * | 1987-12-28 | 1989-07-07 | Honda Motor Co Ltd | ロボットのティーチング方法 |
-
1984
- 1984-12-24 JP JP27097484A patent/JPS61148504A/ja active Granted
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH01173206A (ja) * | 1987-12-28 | 1989-07-07 | Honda Motor Co Ltd | ロボットのティーチング方法 |
| JPH01173207A (ja) * | 1987-12-28 | 1989-07-07 | Honda Motor Co Ltd | ロボットのティーチング方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| JPH0473164B2 (ja) | 1992-11-20 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN108839025A (zh) | 一种移动机械臂的运动规划方法和装置 | |
| JP5458769B2 (ja) | ロボットの制御装置 | |
| WO1992012473A1 (en) | Method of correcting deflection of robot | |
| JP2874238B2 (ja) | 多関節形ロボットの制御方法 | |
| JP2667153B2 (ja) | 複腕装置の直接教示方法 | |
| CN110891741A (zh) | 对机器人单元的控制 | |
| US5222198A (en) | Control method and apparatus for a robot having multi-rotating axes | |
| JPS61148504A (ja) | ロボツトの制御装置 | |
| JP3577124B2 (ja) | 力制御ロボットを用いて嵌合データを取得する方法 | |
| JPH05345291A (ja) | ロボットの動作範囲制限方式 | |
| JPH0693209B2 (ja) | ロボツトの円弧補間姿勢制御装置 | |
| JPS62199383A (ja) | ロボツトの制御方式 | |
| JPS60118478A (ja) | 関節形ロボツトの位置制御装置 | |
| JPH0385608A (ja) | ロボットの制御方法 | |
| JPS6340908A (ja) | ロボツト制御装置 | |
| JP3191341B2 (ja) | ロボット制御装置 | |
| JPS6029288A (ja) | ロボツト装置 | |
| JPH074781B2 (ja) | ロボツトの治具の姿勢再現方法 | |
| JP2993323B2 (ja) | ロボットの原点補正方法 | |
| JPS63256380A (ja) | 多関節型ハンドの制御装置 | |
| JPH02269586A (ja) | マニピュレータ駆動制御装置 | |
| JP2751967B2 (ja) | 倣い制御装置 | |
| JPH01187602A (ja) | ロボット制御方法 | |
| JP2832903B2 (ja) | 倣い制御の座標切替方式 | |
| JPH0630008B2 (ja) | ロボツトの制御方法 |