JP2771458B2 - 産業用ロボットの撓み補正方法 - Google Patents
産業用ロボットの撓み補正方法Info
- Publication number
- JP2771458B2 JP2771458B2 JP6187910A JP18791094A JP2771458B2 JP 2771458 B2 JP2771458 B2 JP 2771458B2 JP 6187910 A JP6187910 A JP 6187910A JP 18791094 A JP18791094 A JP 18791094A JP 2771458 B2 JP2771458 B2 JP 2771458B2
- Authority
- JP
- Japan
- Prior art keywords
- arm
- joint
- deflection
- industrial robot
- robot
- 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
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Description
【０００１】
【産業上の利用分野】本発明は、産業用ロボット（以下
「ロボット」と記す）を用いてバリ取り等の作業を行う
場合の、ロボットアームの撓み補正方法に関するもので
ある。
「ロボット」と記す）を用いてバリ取り等の作業を行う
場合の、ロボットアームの撓み補正方法に関するもので
ある。
【０００２】
【従来の技術】一般に、複数の工作機械より構成された
生産ラインではバリ取り専用機を切削加工機の後ろに配
設したり、トランスファマシンでは切削ユニットの後に
バリ取りユニットを設けたりしている。これらの生産設
備のほとんどは少品種大量生産用のものであるため、こ
れに使用されるバリ取り専用機やバリ取りユニットも比
較的単純な機構の装置で対応できる。しかし、近年、生
産ラインのフレキシブル化の推進による多品種生産に対
応するため、ロボットにバリ取り工具を持たせてバリ取
り作業を行う方法が導入され始めている。
生産ラインではバリ取り専用機を切削加工機の後ろに配
設したり、トランスファマシンでは切削ユニットの後に
バリ取りユニットを設けたりしている。これらの生産設
備のほとんどは少品種大量生産用のものであるため、こ
れに使用されるバリ取り専用機やバリ取りユニットも比
較的単純な機構の装置で対応できる。しかし、近年、生
産ラインのフレキシブル化の推進による多品種生産に対
応するため、ロボットにバリ取り工具を持たせてバリ取
り作業を行う方法が導入され始めている。
【０００３】ロボットにバリ取り作業を行わせる利点
は、プログラミング手段により多品種生産への対応が容
易なこと、工作機械と比較してロボット本体の大きさに
対する可動範囲が大きいため本体の設置面積が小さくて
済むこと、バリ取り専用機と比較して一般に安価である
こと等がある。しかし、一般にロボットは関節の駆動部
に使用される減速機（以下「減速機」と記す）の剛性が
低いので、バリ取り工具を被加工物に対して強い力で押
し付けると、反力によりロボットのアームの関節が撓ん
でしまい（以下、このロボットのアームの関節の撓みを
「アームの撓み」と記す）、またアーム先端に取り付け
られているバリ取り工具やこれを把持するチャックの重
量によっても同様にアームが撓んでしまう。このためバ
リ取り工具の位置決め精度が悪くなり、高精度が要求さ
れる加工では使用できず、精度が比較的ラフな使用に用
途が限定されていた。
は、プログラミング手段により多品種生産への対応が容
易なこと、工作機械と比較してロボット本体の大きさに
対する可動範囲が大きいため本体の設置面積が小さくて
済むこと、バリ取り専用機と比較して一般に安価である
こと等がある。しかし、一般にロボットは関節の駆動部
に使用される減速機（以下「減速機」と記す）の剛性が
低いので、バリ取り工具を被加工物に対して強い力で押
し付けると、反力によりロボットのアームの関節が撓ん
でしまい（以下、このロボットのアームの関節の撓みを
「アームの撓み」と記す）、またアーム先端に取り付け
られているバリ取り工具やこれを把持するチャックの重
量によっても同様にアームが撓んでしまう。このためバ
リ取り工具の位置決め精度が悪くなり、高精度が要求さ
れる加工では使用できず、精度が比較的ラフな使用に用
途が限定されていた。
【０００４】アームの剛性を上げるためには、アームの
機構を関節型ではなく直交座標型とすることが考えられ
るが、これでは可動範囲が小さくなり工作機械のバリ取
り専用機と大差がなくなる。また、高剛性の減速機の使
用はロボット本体の大型化とコストの上昇を招くことに
なる。
機構を関節型ではなく直交座標型とすることが考えられ
るが、これでは可動範囲が小さくなり工作機械のバリ取
り専用機と大差がなくなる。また、高剛性の減速機の使
用はロボット本体の大型化とコストの上昇を招くことに
なる。
【０００５】そこで、アームの撓みを補正する方法とし
て、特開平４−２３３６０２号公報では、アームの先端
位置（工具先端位置）の指令値に対応するロボットの姿
勢からロボットの各軸にかかる関節トルクを求め、この
関節トルクより各軸の撓み量として撓み角を求め、この
各軸の撓み角より各軸に対する指令値の補正量を求める
方法が開示されている。
て、特開平４−２３３６０２号公報では、アームの先端
位置（工具先端位置）の指令値に対応するロボットの姿
勢からロボットの各軸にかかる関節トルクを求め、この
関節トルクより各軸の撓み量として撓み角を求め、この
各軸の撓み角より各軸に対する指令値の補正量を求める
方法が開示されている。
【０００６】
【発明が解決しようとする課題】しかし、この方法は、
ロボットの姿勢から関節トルクを求めているため、アー
ムが静止している状態即ち静的状態における重力の影響
によるアームの撓みしか考慮されておらず、アームが動
いている状態や被加工物にアームを押し付けている状
態、即ち動的状態でのアームの撓みを考慮したものでは
ない。したがって、この方法は、アームの重量が軽く、
かつ、アームの移動速度が遅く、しかもアーム先端にか
かる荷重が小さい、例えばスポット溶接等の用途におい
ては有効であるが、バリ取り作業のように長時間アーム
の先端に荷重がかかり、かつ、高精度が要求される作業
には適用できないという問題があった。
ロボットの姿勢から関節トルクを求めているため、アー
ムが静止している状態即ち静的状態における重力の影響
によるアームの撓みしか考慮されておらず、アームが動
いている状態や被加工物にアームを押し付けている状
態、即ち動的状態でのアームの撓みを考慮したものでは
ない。したがって、この方法は、アームの重量が軽く、
かつ、アームの移動速度が遅く、しかもアーム先端にか
かる荷重が小さい、例えばスポット溶接等の用途におい
ては有効であるが、バリ取り作業のように長時間アーム
の先端に荷重がかかり、かつ、高精度が要求される作業
には適用できないという問題があった。
【０００７】本発明の目的は、特にアームの先端に大き
な荷重がかかるバリ取り作業等に使用する産業用ロボッ
トの位置決めを高精度に行わせることにある。
な荷重がかかるバリ取り作業等に使用する産業用ロボッ
トの位置決めを高精度に行わせることにある。
【０００８】
【課題を解決するための手段】このため本発明は、上述
した従来技術の課題を解決するために、アームの先端に
取り付けられた工具により被加工物に対して所定の加工
を行う多関節型の産業用ロボットのアームの撓みを補正
する方法であって、制御装置により制御される産業用ロ
ボットの複数の関節のそれぞれについて、関節を駆動す
るモータに流れる電流値と、アームの動作状態により予
め設定された補正係数とにより、ロボットの各動作状態
におけるモータに接続された減速機にかかるトルクを算
出する手段と、この算出された減速機のトルクと減速機
のバネ定数よりアームの各関節の撓み量を算出する手段
と、を備え、この算出されたアームの各関節の撓み量よ
り、制御装置により指令される各関節の指令角度を補正
するようにした産業用ロボットの撓み補正方法におい
て、次の２つの発明を提供するものである。
した従来技術の課題を解決するために、アームの先端に
取り付けられた工具により被加工物に対して所定の加工
を行う多関節型の産業用ロボットのアームの撓みを補正
する方法であって、制御装置により制御される産業用ロ
ボットの複数の関節のそれぞれについて、関節を駆動す
るモータに流れる電流値と、アームの動作状態により予
め設定された補正係数とにより、ロボットの各動作状態
におけるモータに接続された減速機にかかるトルクを算
出する手段と、この算出された減速機のトルクと減速機
のバネ定数よりアームの各関節の撓み量を算出する手段
と、を備え、この算出されたアームの各関節の撓み量よ
り、制御装置により指令される各関節の指令角度を補正
するようにした産業用ロボットの撓み補正方法におい
て、次の２つの発明を提供するものである。
【０００９】まず、請求項１に係る発明では、アームの
各動作状態による各モータ毎の補正係数はそれぞれ、ア
ームの動作中は１．００、アームを下から上へ上げて停
止保持した場合はアームの動作中のモータ電流値を１．
００としたときのアームを下から上へ上げて停止保持し
た場合の電流値の比、アームを上から下へ降ろして停止
保持した場合はアームの動作中のモータ電流値を１．０
０としたときのアームを上から下へ降ろして停止保持し
た場合の電流値の比、とした。
各動作状態による各モータ毎の補正係数はそれぞれ、ア
ームの動作中は１．００、アームを下から上へ上げて停
止保持した場合はアームの動作中のモータ電流値を１．
００としたときのアームを下から上へ上げて停止保持し
た場合の電流値の比、アームを上から下へ降ろして停止
保持した場合はアームの動作中のモータ電流値を１．０
０としたときのアームを上から下へ降ろして停止保持し
た場合の電流値の比、とした。
【００１０】また、請求項２に係る発明では、ティーチ
ングプレイバック方式により各関節の指令角度を設定す
る場合は、算出されたアームの各関節の撓み量を補正し
た関節角度を制御装置のメモリーに記録するようにし
た。
ングプレイバック方式により各関節の指令角度を設定す
る場合は、算出されたアームの各関節の撓み量を補正し
た関節角度を制御装置のメモリーに記録するようにし
た。
【００１１】
【作用】本発明における産業用ロボットの撓み補正方法
によれば、一般の産業用ロボットを使用し高精度の加工
を行う場合でも、ロボットの各関節を駆動するモータに
流れる電流値をそれぞれ検出し、その電流値から各減速
機にかかるトルクを計算する際に、ロボットの動作状態
によってトルクの計算値を補正し、この補正されたトル
クの計算値と減速機のバネ定数からアームの撓み量が求
められるので、アームの撓み量を補正した工具先端位置
をロボットへ指令することが可能となり、２つの発明の
それぞれにおいて以下の作用を奏する。
によれば、一般の産業用ロボットを使用し高精度の加工
を行う場合でも、ロボットの各関節を駆動するモータに
流れる電流値をそれぞれ検出し、その電流値から各減速
機にかかるトルクを計算する際に、ロボットの動作状態
によってトルクの計算値を補正し、この補正されたトル
クの計算値と減速機のバネ定数からアームの撓み量が求
められるので、アームの撓み量を補正した工具先端位置
をロボットへ指令することが可能となり、２つの発明の
それぞれにおいて以下の作用を奏する。
【００１２】まず、請求項１に係る発明においては、予
め各モータ毎に実際のアーム動作により算出した補正係
数を検出された各モータの電流値に乗じるようにしたの
で、アームの動作状態により異なる各減速機にかかるト
ルクを正確に算出することが可能となる。
め各モータ毎に実際のアーム動作により算出した補正係
数を検出された各モータの電流値に乗じるようにしたの
で、アームの動作状態により異なる各減速機にかかるト
ルクを正確に算出することが可能となる。
【００１３】また、請求項２に係る発明においては、テ
ィーチングプレイバック方式により各関節の指令角度を
設定する場合は、算出されたアームの各関節の撓み量を
補正した関節角度を制御装置のメモリーに記録するよう
にしたので、ティーチングされたプログラムの再現時の
位置決め精度の向上を図ることもできる。
ィーチングプレイバック方式により各関節の指令角度を
設定する場合は、算出されたアームの各関節の撓み量を
補正した関節角度を制御装置のメモリーに記録するよう
にしたので、ティーチングされたプログラムの再現時の
位置決め精度の向上を図ることもできる。
【００１４】
【実施例】以下、本発明の一実施例を図面に基づいて説
明する。図１は、制御装置４により制御されるロボット
のアーム１の先端にバリ取り工具（以下「工具」と記
す）２を取り付けて、被加工物３に対してバリ取りを行
うシステムの概略を示している。
明する。図１は、制御装置４により制御されるロボット
のアーム１の先端にバリ取り工具（以下「工具」と記
す）２を取り付けて、被加工物３に対してバリ取りを行
うシステムの概略を示している。
【００１５】図２は本発明の構成を示すブロック図であ
る。ロボット制御装置４はＣＰＵ５によって制御され、
ＣＰＵ５はメモリー６からプログラムデータや撓み補正
に必要な各種データを読みとり位置制御部７へ指令す
る。位置制御部７は、モータ１０に接続されたエンコー
ダ１１により検出されたロボットの現在の関節角度とし
ての位置フィードバックと、電流検出器９により検出さ
れたモータ１０に流れる電流値としての電流フィードバ
ックと、ＣＰＵ５からの位置指令より、アーム１の撓み
量を算出し、撓み補正を行った後の速度指令を速度・電
流制御部８へ指令する。速度・電流制御部８は位置制御
部７から伝達された速度指令とエンコーダ１１からの位
置フィードバックと電流検出器９からの電流フィードバ
ックよりモータ１０に流す駆動電流を算出し、モータ１
０へ指令する。モータ１０は速度・電流制御部８から伝
達された駆動電流に基づき駆動され、減速機１２を介し
てアーム１を駆動する。
る。ロボット制御装置４はＣＰＵ５によって制御され、
ＣＰＵ５はメモリー６からプログラムデータや撓み補正
に必要な各種データを読みとり位置制御部７へ指令す
る。位置制御部７は、モータ１０に接続されたエンコー
ダ１１により検出されたロボットの現在の関節角度とし
ての位置フィードバックと、電流検出器９により検出さ
れたモータ１０に流れる電流値としての電流フィードバ
ックと、ＣＰＵ５からの位置指令より、アーム１の撓み
量を算出し、撓み補正を行った後の速度指令を速度・電
流制御部８へ指令する。速度・電流制御部８は位置制御
部７から伝達された速度指令とエンコーダ１１からの位
置フィードバックと電流検出器９からの電流フィードバ
ックよりモータ１０に流す駆動電流を算出し、モータ１
０へ指令する。モータ１０は速度・電流制御部８から伝
達された駆動電流に基づき駆動され、減速機１２を介し
てアーム１を駆動する。
【００１６】なお、図２はロボット制御装置４により制
御される関節が１つの場合を示しているが、制御される
関節が複数の場合はモータ、エンコーダ、及び減速機の
数も関節の数だけ増えることになる。
御される関節が１つの場合を示しているが、制御される
関節が複数の場合はモータ、エンコーダ、及び減速機の
数も関節の数だけ増えることになる。
【００１７】さて、撓み補正を行わない従来技術では図
８及び図９に示すように、位置制御部７では、エンコー
ダ１１により検出された位置フィードバックとＣＰＵ５
からの位置指令より算出された速度指令が速度・電流制
御部８へ指令するようにされている。しかし、本発明で
は図３に示すように、補正量計算部１３が電流検出器９
からの電流フィードバックよりアームの撓み角を補正量
として算出し、この補正量がＣＰＵ５からの位置指令に
加算され、この値とエンコーダ１１からの位置フィード
バックとの差が速度指令として速度・電流制御部８へ出
力するようにされている。よって、電流検出器９からの
電流フィードバックより算出されたアームの撓み角が速
度・電流制御部８へ指令する速度指令に補正量として加
算されるようになるので、速度・電流制御部８はアーム
の撓みを考慮した駆動電流をモータ１０へ指令できるよ
うになる。
８及び図９に示すように、位置制御部７では、エンコー
ダ１１により検出された位置フィードバックとＣＰＵ５
からの位置指令より算出された速度指令が速度・電流制
御部８へ指令するようにされている。しかし、本発明で
は図３に示すように、補正量計算部１３が電流検出器９
からの電流フィードバックよりアームの撓み角を補正量
として算出し、この補正量がＣＰＵ５からの位置指令に
加算され、この値とエンコーダ１１からの位置フィード
バックとの差が速度指令として速度・電流制御部８へ出
力するようにされている。よって、電流検出器９からの
電流フィードバックより算出されたアームの撓み角が速
度・電流制御部８へ指令する速度指令に補正量として加
算されるようになるので、速度・電流制御部８はアーム
の撓みを考慮した駆動電流をモータ１０へ指令できるよ
うになる。
【００１８】次に、補正量計算部１３において行われる
本発明の撓み補正量の算出方法について述べる。被加工
物３をバリ取りする座標位置が座標値を直接入力して設
定される場合、その座標値にロボットの位置を実現する
ための関節角度をＨｎとし、関節角度Ｈｎに関節を移動
するように指令すると、重力と被加工物３からの加工反
力が減速機１２にかかり、ΔＨｎの角度だけアーム１が
撓んでしまう。この時のモータ１０に流れる電流値を検
出すれば減速機１２にかかるトルクを近似的に計算でき
るが、機械系の摩擦の影響により、モータ１０に流れる
電流値は図６に示すように、アーム１を上から下へ降ろ
して停止保持した場合と、図７に示すようにアーム１を
下から上へ上げて停止保持した場合とでは、保持電流が
大きく異なり、一般にはアーム１を下から上へ上げて停
止保持した場合の方が保持電流が大きくなる。
本発明の撓み補正量の算出方法について述べる。被加工
物３をバリ取りする座標位置が座標値を直接入力して設
定される場合、その座標値にロボットの位置を実現する
ための関節角度をＨｎとし、関節角度Ｈｎに関節を移動
するように指令すると、重力と被加工物３からの加工反
力が減速機１２にかかり、ΔＨｎの角度だけアーム１が
撓んでしまう。この時のモータ１０に流れる電流値を検
出すれば減速機１２にかかるトルクを近似的に計算でき
るが、機械系の摩擦の影響により、モータ１０に流れる
電流値は図６に示すように、アーム１を上から下へ降ろ
して停止保持した場合と、図７に示すようにアーム１を
下から上へ上げて停止保持した場合とでは、保持電流が
大きく異なり、一般にはアーム１を下から上へ上げて停
止保持した場合の方が保持電流が大きくなる。
【００１９】そこで、式（１）に示すように電流検出器
９により検出された電流値Ｉに補正係数Ｋａを掛け、モ
ータ電流Ｉａを算出する。補正係数Ｋａの値はアーム１
の動作中は１．００とするが、アーム１を下から上へ上
げて停止保持した場合はＫｂとし、アーム１を上から下
へ降ろして停止保持した場合はＫｃとする。このＫｂ、
Ｋｃはそれぞれアーム１の動作中のモータ電流値を１．
００としたときの、アーム１を下から上へ上げて停止保
持した場合の電流値の比、アーム１を上から下へ降ろし
て停止保持した場合の電流値の比であり、また、各関節
により固有の数値であるため、予め実際のアーム動作に
より求めておく必要がある。
９により検出された電流値Ｉに補正係数Ｋａを掛け、モ
ータ電流Ｉａを算出する。補正係数Ｋａの値はアーム１
の動作中は１．００とするが、アーム１を下から上へ上
げて停止保持した場合はＫｂとし、アーム１を上から下
へ降ろして停止保持した場合はＫｃとする。このＫｂ、
Ｋｃはそれぞれアーム１の動作中のモータ電流値を１．
００としたときの、アーム１を下から上へ上げて停止保
持した場合の電流値の比、アーム１を上から下へ降ろし
て停止保持した場合の電流値の比であり、また、各関節
により固有の数値であるため、予め実際のアーム動作に
より求めておく必要がある。
【００２０】
【数１】
【００２１】このとき減速機１２にかかるトルクＴは式
（１）より求められたモータ電流Ｉａと、モータ１０の
トルク定数Ｋｔ、減速機１２の減速比Ｒ、及び減速機１
２の効率ηから、式（２）に示すようになる。
（１）より求められたモータ電流Ｉａと、モータ１０の
トルク定数Ｋｔ、減速機１２の減速比Ｒ、及び減速機１
２の効率ηから、式（２）に示すようになる。
【００２２】
【数２】
【００２３】したがって、アーム１の撓み量としての撓
み角ΔＨｎは減速機１２のバネ定数をＫとすると式
（３）に示すようになる。
み角ΔＨｎは減速機１２のバネ定数をＫとすると式
（３）に示すようになる。
【００２４】
【数３】
【００２５】よって、図４及び式（４）に示すように、
ＣＰＵ５から指令される関節角度Ｈｎに式（３）より求
められた撓み角ΔＨｎだけ補正した関節角度Ｈｎ′を位
置制御部７から指令することにより、ＣＰＵ５から指令
される関節角度Ｈｎを実際のアーム動作において実現す
ることができるようになる。
ＣＰＵ５から指令される関節角度Ｈｎに式（３）より求
められた撓み角ΔＨｎだけ補正した関節角度Ｈｎ′を位
置制御部７から指令することにより、ＣＰＵ５から指令
される関節角度Ｈｎを実際のアーム動作において実現す
ることができるようになる。
【００２６】
【数４】
【００２７】次に、ロボットの位置を実際にロボットを
動かして教示するティーチングプレイバック方式におけ
る撓み補正方法について説明する。図５に示すように、
ロボットを教示位置として関節角度Ｈａまで動かした場
合、実際にはアームの撓みがあるので、モータ１０は関
節角度Ｈａ′で保持していることになる。エンコーダ１
１からは関節角度Ｈａ′が位置制御部４に出力されてい
るので、このままではメモリー６には関節角度Ｈａ′が
記録されてしまう。そこで前述と同様に、式（１）乃至
式（３）を用いて撓み角ΔＨａを算出し、式（５）に示
すように、エンコーダ１１で検出された関節角度Ｈａ′
と算出された撓み角ΔＨａの差より求められた関節角度
Ｈａを教示位置としてメモリー６に記録するようにす
る。
動かして教示するティーチングプレイバック方式におけ
る撓み補正方法について説明する。図５に示すように、
ロボットを教示位置として関節角度Ｈａまで動かした場
合、実際にはアームの撓みがあるので、モータ１０は関
節角度Ｈａ′で保持していることになる。エンコーダ１
１からは関節角度Ｈａ′が位置制御部４に出力されてい
るので、このままではメモリー６には関節角度Ｈａ′が
記録されてしまう。そこで前述と同様に、式（１）乃至
式（３）を用いて撓み角ΔＨａを算出し、式（５）に示
すように、エンコーダ１１で検出された関節角度Ｈａ′
と算出された撓み角ΔＨａの差より求められた関節角度
Ｈａを教示位置としてメモリー６に記録するようにす
る。
【００２８】
【数５】
【００２９】これによって、メモリー６にはアーム１の
撓みに影響されない関節角度が記録されるので、アーム
動作の再生時には再び式（１）乃至式（４）を用いた同
様の補正を行うことにより、ティーチングした位置を再
現することができるようになる。
撓みに影響されない関節角度が記録されるので、アーム
動作の再生時には再び式（１）乃至式（４）を用いた同
様の補正を行うことにより、ティーチングした位置を再
現することができるようになる。
【００３０】
【発明の効果】本発明によれば、ロボットの各関節を駆
動するモータに流れる電流値をそれぞれ検出し、その電
流値から各減速機にかかるトルクを計算する際に、ロボ
ットの動作状態によってトルクの計算値を補正し、この
補正されたトルクの計算値と減速機のバネ定数からアー
ムの撓み量を求め、アームの撓み量を補正した工具先端
位置をロボットへ指令することが可能となったので、バ
リ取り等の大きな荷重がかかる作業にロボットを使用す
る場合でも、減速機の剛性を特に高めることなく高精度
の位置決めを行わせることができるようになった。
動するモータに流れる電流値をそれぞれ検出し、その電
流値から各減速機にかかるトルクを計算する際に、ロボ
ットの動作状態によってトルクの計算値を補正し、この
補正されたトルクの計算値と減速機のバネ定数からアー
ムの撓み量を求め、アームの撓み量を補正した工具先端
位置をロボットへ指令することが可能となったので、バ
リ取り等の大きな荷重がかかる作業にロボットを使用す
る場合でも、減速機の剛性を特に高めることなく高精度
の位置決めを行わせることができるようになった。
【００３１】また、ティーチングプレイバック方式によ
り各関節の指令角度を設定する場合は、算出されたアー
ムの各関節の撓み量を補正した関節角度を制御装置のメ
モリーに記録するようにしたので、ティーチングされた
プログラムの再現時の位置決め精度も向上することにな
った。
り各関節の指令角度を設定する場合は、算出されたアー
ムの各関節の撓み量を補正した関節角度を制御装置のメ
モリーに記録するようにしたので、ティーチングされた
プログラムの再現時の位置決め精度も向上することにな
った。
【００３２】さらに、本発明の構成では本発明の目的を
達成するための新たな外部機器は付加されていないの
で、コストアップすることなしに、現状の制御装置のわ
ずかな改良のみでアームの撓み補正が可能となった。
達成するための新たな外部機器は付加されていないの
で、コストアップすることなしに、現状の制御装置のわ
ずかな改良のみでアームの撓み補正が可能となった。
【図１】本発明の一実施例であるバリ取りを行うシステ
ムの概略を示す図である。
ムの概略を示す図である。
【図２】本発明の制御装置の構成を示すブロック図であ
る。
る。
【図３】本発明の制御装置内の位置制御部の構成を示す
ブロック図である。
ブロック図である。
【図４】ＣＰＵ５から指令された関節角度Ｈｎ、算出さ
れた撓み角ΔＨｎ、及び補正された関節角度Ｈｎ′の関
係を表す図である。
れた撓み角ΔＨｎ、及び補正された関節角度Ｈｎ′の関
係を表す図である。
【図５】エンコーダ１１において検出された関節角度Ｈ
ａ′、算出された撓み角ΔＨａ、及び教示位置として記
録された関節角度Ｈａの関係を表す図である。
ａ′、算出された撓み角ΔＨａ、及び教示位置として記
録された関節角度Ｈａの関係を表す図である。
【図６】アーム１を上から下へ降ろして停止保持した状
態を示す図である。
態を示す図である。
【図７】アーム１を下から上へ上げて停止保持した状態
を示す図である。
を示す図である。
【図８】従来の制御装置の構成を示すブロック図であ
る。
る。
【図９】従来の制御装置内の位置制御部の構成を示すブ
ロック図である。
ロック図である。
【図１０】本発明のアームの撓み量の算出方法を示すフ
ローチャートである。
ローチャートである。
１ ロボットのアーム ２ 工具 ３ 被加工物 ４ 制御装置 ６ メモリー 11 モータ 12 減速機
Claims (2)
- 【請求項１】アームの先端に取り付けられた工具により
被加工物に対して所定の加工を行う多関節型の産業用ロ
ボットのアームの撓みを補正する方法であって、制御装
置により制御される前記産業用ロボットの複数の関節の
それぞれについて、該関節を駆動するモータに流れる電
流値とアームの動作状態により予め設定された補正係数
とによりロボットの各動作状態における前記モータに接
続された減速機にかかるトルクを算出する手段と、該算
出された減速機にかかるトルクと該減速機のバネ定数よ
りアームの各関節の撓み量を算出する手段と、を備え、
該算出されたアームの各関節の撓み量より前記制御装置
により指令される各関節の指令角度を補正するようにし
た産業用ロボットの撓み補正方法において、 前記補正係数は、アームの動作中は１．００、アームを
下から上へ上げて停止保持した場合はアームの動作中の
モータ電流値を１．００としたときのアームを下から上
へ上げて停止保持した場合の電流値の比、アームを上か
ら下へ降ろして停止保持した場合はアームの動作中のモ
ータ電流値を１．００としたときのアームを上から下へ
降ろして停止保持した場合の電流値の比、とすることを
特徴とする産業用ロボットの撓み補正方法。 - 【請求項２】アームの先端に取り付けられた工具により
被加工物に対して所定の加工を行う多関節型の産業用ロ
ボットのアームの撓みを補正する方法であって、制御装
置により制御される前記産業用ロボットの複数の関節の
それぞれについて、該関節を駆動するモータに流れる電
流値とアームの動作状態により予め設定された補正係数
とによりロボットの各動作状態における前記モータに接
続された減速機にかかるトルクを算出する手段と、該算
出された減速機にかかるトルクと該減速機のバネ定数よ
りアームの各関節の撓み量を算出する手段と、を備え、
該算出されたアームの各関節の撓み量より前記制御装置
により指令される各関節の指令角度を補正するようにし
た産業用ロボットの撓み補正方法において、 ティーチングプレイバック方式により前記各関節の指令
角度を設定する場合は、前記算出されたアームの各関節
の撓み量を補正した関節角度が前記制御装置の メモリー
に記録されることを特徴とする産業用ロボットの撓み補
正方法。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP6187910A JP2771458B2 (ja) | 1994-07-19 | 1994-07-19 | 産業用ロボットの撓み補正方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP6187910A JP2771458B2 (ja) | 1994-07-19 | 1994-07-19 | 産業用ロボットの撓み補正方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH0825260A JPH0825260A (ja) | 1996-01-30 |
| JP2771458B2 true JP2771458B2 (ja) | 1998-07-02 |
Family
ID=16214350
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP6187910A Expired - Fee Related JP2771458B2 (ja) | 1994-07-19 | 1994-07-19 | 産業用ロボットの撓み補正方法 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP2771458B2 (ja) |
Families Citing this family (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP4498061B2 (ja) * | 2004-08-18 | 2010-07-07 | 株式会社ダイヘン | 溶接ロボット制御装置 |
| JP5426443B2 (ja) * | 2010-03-24 | 2014-02-26 | 本田技研工業株式会社 | 摩擦撹拌溶接方法および摩擦撹拌溶接装置 |
| JP6576824B2 (ja) * | 2015-12-25 | 2019-09-18 | 株式会社ダイヘン | ロボット制御装置 |
| JP6998514B2 (ja) * | 2017-07-11 | 2022-01-18 | パナソニックＩｐマネジメント株式会社 | ロボット制御装置 |
| US11141855B2 (en) | 2018-01-15 | 2021-10-12 | Canon Kabushiki Kaisha | Robot system, method of controlling robot arm, recording medium, and method of manufacturing an article |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS59129682A (ja) * | 1983-01-18 | 1984-07-26 | 株式会社日立製作所 | 電動式ロボツトの位置決め方法 |
-
1994
- 1994-07-19 JP JP6187910A patent/JP2771458B2/ja not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JPH0825260A (ja) | 1996-01-30 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US9156164B2 (en) | Method for adjusting parameters of impedance control | |
| JP5236596B2 (ja) | 加工ロボットシステム | |
| JP5144035B2 (ja) | 産業用ロボットのツールの位置・姿勢制御方法及び制御システム | |
| JP5452788B1 (ja) | 数値制御装置 | |
| WO2012101789A1 (ja) | 数値制御装置 | |
| US11298781B2 (en) | Workpiece rotating appartus and robot system | |
| JP2010231575A (ja) | ロボットのオフライン教示装置、ロボットのオフライン教示方法、及びロボットシステム | |
| JP2005066819A (ja) | 多関節型ロボット | |
| WO2014123054A1 (ja) | ロボット制御装置及びロボット制御方法 | |
| US11141855B2 (en) | Robot system, method of controlling robot arm, recording medium, and method of manufacturing an article | |
| JP2771458B2 (ja) | 産業用ロボットの撓み補正方法 | |
| JPH05108123A (ja) | ツール先端位置補正方法 | |
| JP4392251B2 (ja) | 送り駆動系の制御装置 | |
| JP4825614B2 (ja) | 多関節リンク機構の軌跡制御装置 | |
| JP2004025387A (ja) | 多関節ロボットの負荷重量及び負荷重心位置の自動算出方法 | |
| Pan et al. | Robotic machining from programming to process control | |
| WO2021241512A1 (ja) | ワークに対する作業をロボットに実行させる制御装置、ロボットシステム、及び制御方法 | |
| JP2020097101A (ja) | ロボット装置、ロボットシステム、ロボット装置の制御方法、ロボット装置を用いた物品の製造方法、制御プログラム及び記録媒体 | |
| JP2512473B2 (ja) | 産業用ロボツトの補間方式 | |
| JPS61159390A (ja) | 産業用ロボツトの制御方法 | |
| JPH06289923A (ja) | ロボットの自動教示法 | |
| JPH0839465A (ja) | 産業用ロボットの撓み補正方法 | |
| US20230142821A1 (en) | Method for Precise, Intuitive Positioning of Robotic Welding Machine | |
| JPH01175004A (ja) | ロボット制御装置 | |
| JP2020023013A (ja) | ロボット制御方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 19980407 |
|
| LAPS | Cancellation because of no payment of annual fees |