JP4302830B2 - ロボットのキャリブレーション方法及び装置 - Google Patents
ロボットのキャリブレーション方法及び装置 Download PDFInfo
- Publication number
- JP4302830B2 JP4302830B2 JP22495899A JP22495899A JP4302830B2 JP 4302830 B2 JP4302830 B2 JP 4302830B2 JP 22495899 A JP22495899 A JP 22495899A JP 22495899 A JP22495899 A JP 22495899A JP 4302830 B2 JP4302830 B2 JP 4302830B2
- Authority
- JP
- Japan
- Prior art keywords
- robot
- tip
- measuring machine
- calibration
- posture
- 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
【０００１】
【発明の属する技術分野】
本発明は、産業用の多関節ロボットの絶対精度を向上させることができるキャリブレーション方法及び装置に関するものである。
【０００２】
【従来の技術】
産業用ロボットをＮＣ装置として使用しようとしたとき、ロボットの据付け誤差、ロボット自体の剛性や製作精度に起因する誤差などで絶対精度が低下するため、キャリブレーションにより絶対精度の向上を図ることが行われる。キャリブレーションを行うためにはロボット手先の３次元位置を高精度に実測する必要がある。
【０００３】
【発明が解決しようとする課題】
ロボット手先の３次元位置を計測するために、カメラ、超音波、レーザを用いる方法等が提案されているが、分解能の点で広範囲に計測しようとすれば精度が低下するという問題がある。また、機械式の３次元測定機を用いる方法は、他の方式と比較して精度は保証されるが、自動計測には向かないという問題がある。
従来の機械式の３次元測定機を用いる方法は、計測点に１点ずつ目視で精度良く照準をあわせるのに時間がかかり、かつ、計測の個人差が誤差要因となる。また、これを自動で行う場合、測定機の軸構成や姿勢等により、方向によって動きやすさに差があり、測定機に過大な負荷がかかるなどの問題で、使用範囲（測定範囲）や使用方法に制約が生じることが予想される。
【０００４】
本発明は上記の諸点に鑑みなされたもので、本発明の目的は、先端部に力を加えて動かすことにより、該先端部を任意の位置・姿勢に位置決めすることができる、各関節部に位置検出器を設けた６以上の自由度を有する３次元測定機を用意し、この３次元測定機の先端部分と校正したい多関節ロボットの手先を結合して、ロボット先端部の位置・姿勢を計測できる構成とすることにより、高精度、かつ、自動でロボットのキャリブレーションを行うことができる方法及び装置を提供することにある。
また、本発明の目的は、ロボットがキャリブレーションに必要な空間上の複数の教示点間を移動する際に、３次元測定機の動きやすさを考慮し、それに基づきロボットの移動経路を補正することにより、測定機に過大な負荷がかかる等の問題がなくなり、使用範囲（測定範囲）や使用方法に制約が発生しないロボットのキャリブレーション方法及び装置を提供することにある。
【０００５】
【課題を解決するための手段】
上記の目的を達成するために、本発明のロボットのキャリブレーション方法は、アームの先端部に力を加えて動かすことにより、該先端部を任意の位置・姿勢に位置決めすることができるように、６以上の自由度を有するアームを備え、アームの関節部の各軸に位置検出器を設けて、各軸の位置検出器の信号から先端部の位置・姿勢を計測することができる３次元測定機を用い、この３次元測定機の先端部と校正したい多関節ロボットの先端部にある手先を結合して、ロボット先端部の位置・姿勢を計測し、ロボットの位置・姿勢を変えて複数の教示点を計測することによりロボットの機構パラメータを求めてキャリブレーションを行うように構成されている（図１、図２参照）。
【０００６】
上記の本発明の方法において、ロボットがキャリブレーションに必要な空間上の複数の教示点間を移動する際に、３次元測定機の動きやすさを評価して、測定機が動きにくい場合に、その教示点から次の動作点までの間に経由点を発生させてロボットの移動経路を補正することが好ましい（図３、図４、図５参照）。
【０００７】
本発明のロボットのキャリブレーション装置は、アームの先端部に力を加えて動かすことにより、該先端部を任意の位置・姿勢に位置決めすることができるように、６以上の自由度を有するアームを備え、アームの関節部の各軸に位置検出器を設けて、各軸の位置検出器の信号から先端部の位置・姿勢を計測することができる３次元測定機と、先端部に設けられた手先が３次元測定機の先端部に結合された多関節ロボットと、３次元測定機の各軸の位置検出器からの信号を入力して座標変換を行うことにより、ロボット先端部の位置・姿勢を演算する位置・姿勢演算装置と、ロボットの位置・姿勢を変えて演算した複数の計測値からロボットの機構パラメータを求めてキャリブレーションを行う、ロボット制御装置に接続されたキャリブレーション演算装置と、前記多関節ロボットに連結されたロボット制御装置とを備えたことを特徴としている（図１、図２参照）。
【０００８】
上記の本発明の装置において、ロボットがキャリブレーションに必要な空間上の複数の教示点間を移動する際に、３次元測定機の動きやすさを評価する値を算出し、測定機が動きにくい場合に、その教示点から次の動作点までの間に経由点を発生させる操作性演算装置を設け、この操作性演算装置をロボット制御装置に接続して、３次元測定機の動きやすさを考慮してロボットの移動経路を補正できるような構成とすることが好ましい（図３、図４、図５参照）。
【０００９】
【発明の実施の形態】
以下、本発明の実施の形態について説明するが、本発明は下記の実施の形態に何ら限定されるものではなく、適宜変更して実施することが可能なものである。
図１は、本発明の実施の第１形態によるロボットのキャリブレーション装置を示している。図２は、本実施形態でロボットの手先の３次元位置計測に用いる測定機の一例を示している。
図２に示すように、３次元測定機１０は、剛性の高い６以上の自由度を有するアーム１２と、各関節部に高精度の位置検出器１４（例えば、エンコーダ）を有する垂直多関節の測定機であり、先端部１６に力を加えて動かすことにより、先端部１６を動作範囲内の任意の位置・姿勢に位置決めすることができ、このときの測定機各軸の位置検出器１４からの信号を入力し、これに座標変換行列を乗じることにより、先端部１６の位置・姿勢を高精度で計測するものである。
【００１０】
上記の３次元測定機１０の先端部１６とキャリブレーションしたい多関節ロボットの手先を既定の位置で結合することにより、図１に示すような、ロボットの手先の３次元位置・姿勢を計測することができる構成とする。こうした機械的に結合された測定機を使う方式は、非接触で三角測量で計測する方式に比べ、直接ロボットの手先の３次元位置を計測するので、精度良く計測することが可能である。
また、図１に示すように、３次元測定機１０の先端部１６とロボット１８の手先２０とは、例えば、レーザセンサ２２を設けた結合治具２４で結合されている。結合治具２４のロボット１８側にはスポット光のレーザセンサ２２が高精度に取り付けられている。３次元測定機１０側に予め定められた基準点２６をマーキングし、レーザセンサ２２のスポット光がこの基準点２６に当たるように３次元測定機１０の位置を手動で調整した状態で、計測するロボット１８と３次元測定機１０とを結合治具２４で結合固定する。この調整は最初の１回だけでよい。この治具構成では、ロボットと測定機の間隔方向については、レーザセンサの計測値を利用できるので、厳密に調整する必要はない。なお、図１では図示していないが、さらに上記のレーザセンサ２２に替えて、ロボット１８側にＬＥＤなどの投光器を高精度に取り付け、結合治具２４の測定機１０側にＣＣＤカメラを取り付けて、ＬＥＤ等の投光器の２次元位置を計測する構成とすれば、最初にＬＥＤやカメラの取付け精度のみを厳密に管理するだけでよく、結合のための調整は全く必要なくなる。
【００１１】
つぎに、ロボット手先の３次元位置・姿勢を計測して、ロボットのキャリブレーションを行う手法について説明する。
図１に示すように、３次元測定機１０の位置検出器１４からの各軸位置データが入力装置２８に入力され、これらのデータが位置・姿勢演算装置３０で座標変換されてロボット手先の位置・姿勢が演算される。ロボットのある位置・姿勢での基準点のロボット座標系での値をＰｒ、このときの３次元測定機で計測した基準点の測定機座標系での値をＰｆ、測定機座標とロボット座標との変換行列をＲとする。これらの値はレーザセンサ等のセンサの計測値、ロボットとセンサの取付け関係、測定機とロボットの設置関係、測定機と結合治具の取付け関係、ロボット及び測定機の関節角度情報があれば、容易に求めることができる。ただし、Ｐｆは高精度で求めることができるが、ＰｒとＲには、ロボットの剛性やロボットの据付けに起因する誤差が含まれている。キャリブレーションのアルゴリズム自体は従来の手法が利用できる。すなわち、ロボット１８の位置・姿勢を変えて複数の点を計測し、位置・姿勢演算装置３０で演算した複数の計測値から、キャリブレーション演算装置３２でロボットの機構パラメータが求められる。ロボットの機構モデルに含まれる未知パラメータの同定には、例えば、特異値分解法などの非線形推定手法が用いられる。キャリブレーション演算装置３２で求められたロボットの機構モデルを用いて、ロボット１８の絶対精度を改善し、さらにその検証を行うようにする。３４は、ロボット１８を制御するロボット制御装置である。
【００１２】
図３は、本発明の実施の第２形態によるロボットのキャリブレーション装置を示している。３次元測定機１０の先端部１６とロボット１８の手先２０とを既定の位置で結合することにより、図３に示すような、ロボットの手先の３次元位置・姿勢を計測することができる構成とする。なお、図３では、結合治具等の詳細な構成は省略しているが、実施の第１形態と同様の構成が採用される。
図３に示すように、３次元測定機１０の位置検出器１４からの各軸位置データが入力装置２８に入力され、これらのデータが位置・姿勢演算装置３０で座標変換されてロボット手先の位置・姿勢が演算される。ロボットのある位置・姿勢での基準点のロボット座標系での値をＰｒ、このときの３次元測定機で計測した基準点の測定機座標系での値をＰｆ、測定機座標とロボット座標との変換行列をＲとする。これらの値はレーザセンサ等のセンサの計測値、ロボットとセンサの取付け関係、測定機とロボットの設置関係、測定機と結合治具の取付け関係、ロボット及び測定機の関節角度情報があれば、容易に求めることができる。ただし、Ｐｆは高精度で求めることができるが、ＰｒとＲには、ロボットの剛性やロボットの据付けに起因する誤差が含まれている。キャリブレーションのアルゴリズム自体は従来の手法が利用できる。すなわち、ロボット１８の位置・姿勢を変えて複数の点を計測し、位置・姿勢演算装置３０で演算した複数の計測値から、キャリブレーション演算装置３２でロボットの機構パラメータが求められる。
他の構成及び作用は、実施の第１形態の場合と同様である。
【００１３】
つぎに、これらの複数の計測点（教示点）間をロボット１８が移動する際に、３次元測定機１０が機械的に拘束されているために、測定機１０の位置・姿勢によっては、測定機１０に大きな負荷がかかる動作方向があり、このためにキャリブレーションを行える領域（測定範囲）や使用方法に制約が発生することが考えられる。この要因としては、
（１） 教示点間の移動で測定機の各関節角度を大きく変えないと移動できない点があり、ロボットの動作速度に測定機が追従できない。
（２） 測定機の各関節の摩擦力に大小があり、摩擦力の大きな関節を動かそうとすると、摩擦力の小さい関節の拘束方向に力がかかる。
などが挙げられる。
【００１４】
本実施形態では、こうした問題に対応するために、３次元測定機１０の先端部１６の位置・姿勢に基づき逆変換を行うことにより、測定機１０の各関節角度を求め、それに基づき測定機１０の動きやすさを評価する操作性演算装置３６を設けている。測定機１０の動きやすさを考慮し、それに基づきロボット１８の移動経路を補正する具体的な手段は、以下の通りである。
（１） キャリブレーションのための教示点をＰ（ｉ）とする。すべての教示点について逆変換を行い、関節角度θk（ｉ）（ｋ＝１，２，…，６）（６自由度の場合）を求める。
（２） 各教示点に対して、次の動作点までの関節角度の変位量を演算し、以下の評価値Ｈを算出する。
Ｈ＝（Ｑ1Δθ1＋……＋Ｑ6Δθ6）
ここに、Ｑkは各関節の動きにくさを表す重み係数であり、予め測定した摩擦力等を考慮して、動きにくい関節ほど大きい値を持たせる。Ｈの値を評価することにより、次の動作点まで移動したときの測定機にかかる負荷を判断することができる。
【００１５】
（３） Ｈが予め既定した値Ｈ0よりも大きいときは負荷が大きいと予測されるので、次の動作点までの間に経由点を発生させる。このとき、その教示点から経由点までと経由点から次の教示点までのＨは既定値Ｈ0以下になるようにする。
（４） すべての教示点について（２）、（３）の操作を繰り返す。
以上の操作性演算装置３６での処理ステップを示したのが、図４のフローチャートである。また、図５に示すように、例えば、教示点Ｐ（１）からＰ（２）まで測定機を動かそうとするときのＨを算出し、ＨがＨ0以下であれば経由点を発生させる必要はなく、Ｐ（４）からＰ（５）までのＨを算出して、ＨがＨ0を超えていたら、測定機が動きやすくなるように経由点を発生させて、ロボットの移動経路を補正する。
なお、ここで述べた測定機の動きやすさに関する評価値は一例であり、他にも例えば、最も動きにくい関節の変位量や、あるいはすべての関節の中での最大変位量で制限をかける方法などを用いることが可能である。
【００１６】
【発明の効果】
本発明は上記のように構成されているので、つぎのような効果を奏する。
（１） 本発明における機械式の３次元測定機を用い、この３次元測定機の先端部分と校正したい多関節ロボットの手先を結合して、ロボット先端部の位置・姿勢を計測できる構成とすることにより、高精度、かつ、自動でロボットのキャリブレーションを行うことができる。
（２） ロボットがキャリブレーションに必要な空間上の複数の教示点間を移動する際に、３次元測定機の動きやすさを考慮し、それに基づきロボットの移動経路を補正する場合は、測定機に過大な負荷がかかる等の問題がなくなり、キャリブレーションを行える領域（測定範囲）や使用方法に制約が生じない。
（３） 産業用ロボットの絶対精度向上による適用分野の拡大を図ることが可能となる。
【図面の簡単な説明】
【図１】本発明の実施の第１形態によるロボットのキャリブレーション装置を示す概略構成図である。
【図２】本発明の実施の第１形態における３次元測定機の一例を示す概略構成図である。
【図３】本発明の実施の第２形態によるロボットのキャリブレーション装置を示す概略構成図である。
【図４】本発明の実施の第２形態における測定機の動きやすさを評価してロボットの移動経路を補正する装置の処理ステップを示すフローチャートである。
【図５】本発明の実施の第２形態における経由点の発生例を示す模式図である。
【符号の説明】
１０ ３次元測定機
１２ アーム
１４ 位置検出器
１６ 先端部
１８ ロボット
２０ ロボットの手先
２２ レーザセンサ
２４ 結合治具
２６ 基準点
２８ 入力装置
３０ 位置・姿勢演算装置
３２ キャリブレーション演算装置
３４ ロボット制御装置
３６ 操作性演算装置
【発明の属する技術分野】
本発明は、産業用の多関節ロボットの絶対精度を向上させることができるキャリブレーション方法及び装置に関するものである。
【０００２】
【従来の技術】
産業用ロボットをＮＣ装置として使用しようとしたとき、ロボットの据付け誤差、ロボット自体の剛性や製作精度に起因する誤差などで絶対精度が低下するため、キャリブレーションにより絶対精度の向上を図ることが行われる。キャリブレーションを行うためにはロボット手先の３次元位置を高精度に実測する必要がある。
【０００３】
【発明が解決しようとする課題】
ロボット手先の３次元位置を計測するために、カメラ、超音波、レーザを用いる方法等が提案されているが、分解能の点で広範囲に計測しようとすれば精度が低下するという問題がある。また、機械式の３次元測定機を用いる方法は、他の方式と比較して精度は保証されるが、自動計測には向かないという問題がある。
従来の機械式の３次元測定機を用いる方法は、計測点に１点ずつ目視で精度良く照準をあわせるのに時間がかかり、かつ、計測の個人差が誤差要因となる。また、これを自動で行う場合、測定機の軸構成や姿勢等により、方向によって動きやすさに差があり、測定機に過大な負荷がかかるなどの問題で、使用範囲（測定範囲）や使用方法に制約が生じることが予想される。
【０００４】
本発明は上記の諸点に鑑みなされたもので、本発明の目的は、先端部に力を加えて動かすことにより、該先端部を任意の位置・姿勢に位置決めすることができる、各関節部に位置検出器を設けた６以上の自由度を有する３次元測定機を用意し、この３次元測定機の先端部分と校正したい多関節ロボットの手先を結合して、ロボット先端部の位置・姿勢を計測できる構成とすることにより、高精度、かつ、自動でロボットのキャリブレーションを行うことができる方法及び装置を提供することにある。
また、本発明の目的は、ロボットがキャリブレーションに必要な空間上の複数の教示点間を移動する際に、３次元測定機の動きやすさを考慮し、それに基づきロボットの移動経路を補正することにより、測定機に過大な負荷がかかる等の問題がなくなり、使用範囲（測定範囲）や使用方法に制約が発生しないロボットのキャリブレーション方法及び装置を提供することにある。
【０００５】
【課題を解決するための手段】
上記の目的を達成するために、本発明のロボットのキャリブレーション方法は、アームの先端部に力を加えて動かすことにより、該先端部を任意の位置・姿勢に位置決めすることができるように、６以上の自由度を有するアームを備え、アームの関節部の各軸に位置検出器を設けて、各軸の位置検出器の信号から先端部の位置・姿勢を計測することができる３次元測定機を用い、この３次元測定機の先端部と校正したい多関節ロボットの先端部にある手先を結合して、ロボット先端部の位置・姿勢を計測し、ロボットの位置・姿勢を変えて複数の教示点を計測することによりロボットの機構パラメータを求めてキャリブレーションを行うように構成されている（図１、図２参照）。
【０００６】
上記の本発明の方法において、ロボットがキャリブレーションに必要な空間上の複数の教示点間を移動する際に、３次元測定機の動きやすさを評価して、測定機が動きにくい場合に、その教示点から次の動作点までの間に経由点を発生させてロボットの移動経路を補正することが好ましい（図３、図４、図５参照）。
【０００７】
本発明のロボットのキャリブレーション装置は、アームの先端部に力を加えて動かすことにより、該先端部を任意の位置・姿勢に位置決めすることができるように、６以上の自由度を有するアームを備え、アームの関節部の各軸に位置検出器を設けて、各軸の位置検出器の信号から先端部の位置・姿勢を計測することができる３次元測定機と、先端部に設けられた手先が３次元測定機の先端部に結合された多関節ロボットと、３次元測定機の各軸の位置検出器からの信号を入力して座標変換を行うことにより、ロボット先端部の位置・姿勢を演算する位置・姿勢演算装置と、ロボットの位置・姿勢を変えて演算した複数の計測値からロボットの機構パラメータを求めてキャリブレーションを行う、ロボット制御装置に接続されたキャリブレーション演算装置と、前記多関節ロボットに連結されたロボット制御装置とを備えたことを特徴としている（図１、図２参照）。
【０００８】
上記の本発明の装置において、ロボットがキャリブレーションに必要な空間上の複数の教示点間を移動する際に、３次元測定機の動きやすさを評価する値を算出し、測定機が動きにくい場合に、その教示点から次の動作点までの間に経由点を発生させる操作性演算装置を設け、この操作性演算装置をロボット制御装置に接続して、３次元測定機の動きやすさを考慮してロボットの移動経路を補正できるような構成とすることが好ましい（図３、図４、図５参照）。
【０００９】
【発明の実施の形態】
以下、本発明の実施の形態について説明するが、本発明は下記の実施の形態に何ら限定されるものではなく、適宜変更して実施することが可能なものである。
図１は、本発明の実施の第１形態によるロボットのキャリブレーション装置を示している。図２は、本実施形態でロボットの手先の３次元位置計測に用いる測定機の一例を示している。
図２に示すように、３次元測定機１０は、剛性の高い６以上の自由度を有するアーム１２と、各関節部に高精度の位置検出器１４（例えば、エンコーダ）を有する垂直多関節の測定機であり、先端部１６に力を加えて動かすことにより、先端部１６を動作範囲内の任意の位置・姿勢に位置決めすることができ、このときの測定機各軸の位置検出器１４からの信号を入力し、これに座標変換行列を乗じることにより、先端部１６の位置・姿勢を高精度で計測するものである。
【００１０】
上記の３次元測定機１０の先端部１６とキャリブレーションしたい多関節ロボットの手先を既定の位置で結合することにより、図１に示すような、ロボットの手先の３次元位置・姿勢を計測することができる構成とする。こうした機械的に結合された測定機を使う方式は、非接触で三角測量で計測する方式に比べ、直接ロボットの手先の３次元位置を計測するので、精度良く計測することが可能である。
また、図１に示すように、３次元測定機１０の先端部１６とロボット１８の手先２０とは、例えば、レーザセンサ２２を設けた結合治具２４で結合されている。結合治具２４のロボット１８側にはスポット光のレーザセンサ２２が高精度に取り付けられている。３次元測定機１０側に予め定められた基準点２６をマーキングし、レーザセンサ２２のスポット光がこの基準点２６に当たるように３次元測定機１０の位置を手動で調整した状態で、計測するロボット１８と３次元測定機１０とを結合治具２４で結合固定する。この調整は最初の１回だけでよい。この治具構成では、ロボットと測定機の間隔方向については、レーザセンサの計測値を利用できるので、厳密に調整する必要はない。なお、図１では図示していないが、さらに上記のレーザセンサ２２に替えて、ロボット１８側にＬＥＤなどの投光器を高精度に取り付け、結合治具２４の測定機１０側にＣＣＤカメラを取り付けて、ＬＥＤ等の投光器の２次元位置を計測する構成とすれば、最初にＬＥＤやカメラの取付け精度のみを厳密に管理するだけでよく、結合のための調整は全く必要なくなる。
【００１１】
つぎに、ロボット手先の３次元位置・姿勢を計測して、ロボットのキャリブレーションを行う手法について説明する。
図１に示すように、３次元測定機１０の位置検出器１４からの各軸位置データが入力装置２８に入力され、これらのデータが位置・姿勢演算装置３０で座標変換されてロボット手先の位置・姿勢が演算される。ロボットのある位置・姿勢での基準点のロボット座標系での値をＰｒ、このときの３次元測定機で計測した基準点の測定機座標系での値をＰｆ、測定機座標とロボット座標との変換行列をＲとする。これらの値はレーザセンサ等のセンサの計測値、ロボットとセンサの取付け関係、測定機とロボットの設置関係、測定機と結合治具の取付け関係、ロボット及び測定機の関節角度情報があれば、容易に求めることができる。ただし、Ｐｆは高精度で求めることができるが、ＰｒとＲには、ロボットの剛性やロボットの据付けに起因する誤差が含まれている。キャリブレーションのアルゴリズム自体は従来の手法が利用できる。すなわち、ロボット１８の位置・姿勢を変えて複数の点を計測し、位置・姿勢演算装置３０で演算した複数の計測値から、キャリブレーション演算装置３２でロボットの機構パラメータが求められる。ロボットの機構モデルに含まれる未知パラメータの同定には、例えば、特異値分解法などの非線形推定手法が用いられる。キャリブレーション演算装置３２で求められたロボットの機構モデルを用いて、ロボット１８の絶対精度を改善し、さらにその検証を行うようにする。３４は、ロボット１８を制御するロボット制御装置である。
【００１２】
図３は、本発明の実施の第２形態によるロボットのキャリブレーション装置を示している。３次元測定機１０の先端部１６とロボット１８の手先２０とを既定の位置で結合することにより、図３に示すような、ロボットの手先の３次元位置・姿勢を計測することができる構成とする。なお、図３では、結合治具等の詳細な構成は省略しているが、実施の第１形態と同様の構成が採用される。
図３に示すように、３次元測定機１０の位置検出器１４からの各軸位置データが入力装置２８に入力され、これらのデータが位置・姿勢演算装置３０で座標変換されてロボット手先の位置・姿勢が演算される。ロボットのある位置・姿勢での基準点のロボット座標系での値をＰｒ、このときの３次元測定機で計測した基準点の測定機座標系での値をＰｆ、測定機座標とロボット座標との変換行列をＲとする。これらの値はレーザセンサ等のセンサの計測値、ロボットとセンサの取付け関係、測定機とロボットの設置関係、測定機と結合治具の取付け関係、ロボット及び測定機の関節角度情報があれば、容易に求めることができる。ただし、Ｐｆは高精度で求めることができるが、ＰｒとＲには、ロボットの剛性やロボットの据付けに起因する誤差が含まれている。キャリブレーションのアルゴリズム自体は従来の手法が利用できる。すなわち、ロボット１８の位置・姿勢を変えて複数の点を計測し、位置・姿勢演算装置３０で演算した複数の計測値から、キャリブレーション演算装置３２でロボットの機構パラメータが求められる。
他の構成及び作用は、実施の第１形態の場合と同様である。
【００１３】
つぎに、これらの複数の計測点（教示点）間をロボット１８が移動する際に、３次元測定機１０が機械的に拘束されているために、測定機１０の位置・姿勢によっては、測定機１０に大きな負荷がかかる動作方向があり、このためにキャリブレーションを行える領域（測定範囲）や使用方法に制約が発生することが考えられる。この要因としては、
（１） 教示点間の移動で測定機の各関節角度を大きく変えないと移動できない点があり、ロボットの動作速度に測定機が追従できない。
（２） 測定機の各関節の摩擦力に大小があり、摩擦力の大きな関節を動かそうとすると、摩擦力の小さい関節の拘束方向に力がかかる。
などが挙げられる。
【００１４】
本実施形態では、こうした問題に対応するために、３次元測定機１０の先端部１６の位置・姿勢に基づき逆変換を行うことにより、測定機１０の各関節角度を求め、それに基づき測定機１０の動きやすさを評価する操作性演算装置３６を設けている。測定機１０の動きやすさを考慮し、それに基づきロボット１８の移動経路を補正する具体的な手段は、以下の通りである。
（１） キャリブレーションのための教示点をＰ（ｉ）とする。すべての教示点について逆変換を行い、関節角度θk（ｉ）（ｋ＝１，２，…，６）（６自由度の場合）を求める。
（２） 各教示点に対して、次の動作点までの関節角度の変位量を演算し、以下の評価値Ｈを算出する。
Ｈ＝（Ｑ1Δθ1＋……＋Ｑ6Δθ6）
ここに、Ｑkは各関節の動きにくさを表す重み係数であり、予め測定した摩擦力等を考慮して、動きにくい関節ほど大きい値を持たせる。Ｈの値を評価することにより、次の動作点まで移動したときの測定機にかかる負荷を判断することができる。
【００１５】
（３） Ｈが予め既定した値Ｈ0よりも大きいときは負荷が大きいと予測されるので、次の動作点までの間に経由点を発生させる。このとき、その教示点から経由点までと経由点から次の教示点までのＨは既定値Ｈ0以下になるようにする。
（４） すべての教示点について（２）、（３）の操作を繰り返す。
以上の操作性演算装置３６での処理ステップを示したのが、図４のフローチャートである。また、図５に示すように、例えば、教示点Ｐ（１）からＰ（２）まで測定機を動かそうとするときのＨを算出し、ＨがＨ0以下であれば経由点を発生させる必要はなく、Ｐ（４）からＰ（５）までのＨを算出して、ＨがＨ0を超えていたら、測定機が動きやすくなるように経由点を発生させて、ロボットの移動経路を補正する。
なお、ここで述べた測定機の動きやすさに関する評価値は一例であり、他にも例えば、最も動きにくい関節の変位量や、あるいはすべての関節の中での最大変位量で制限をかける方法などを用いることが可能である。
【００１６】
【発明の効果】
本発明は上記のように構成されているので、つぎのような効果を奏する。
（１） 本発明における機械式の３次元測定機を用い、この３次元測定機の先端部分と校正したい多関節ロボットの手先を結合して、ロボット先端部の位置・姿勢を計測できる構成とすることにより、高精度、かつ、自動でロボットのキャリブレーションを行うことができる。
（２） ロボットがキャリブレーションに必要な空間上の複数の教示点間を移動する際に、３次元測定機の動きやすさを考慮し、それに基づきロボットの移動経路を補正する場合は、測定機に過大な負荷がかかる等の問題がなくなり、キャリブレーションを行える領域（測定範囲）や使用方法に制約が生じない。
（３） 産業用ロボットの絶対精度向上による適用分野の拡大を図ることが可能となる。
【図面の簡単な説明】
【図１】本発明の実施の第１形態によるロボットのキャリブレーション装置を示す概略構成図である。
【図２】本発明の実施の第１形態における３次元測定機の一例を示す概略構成図である。
【図３】本発明の実施の第２形態によるロボットのキャリブレーション装置を示す概略構成図である。
【図４】本発明の実施の第２形態における測定機の動きやすさを評価してロボットの移動経路を補正する装置の処理ステップを示すフローチャートである。
【図５】本発明の実施の第２形態における経由点の発生例を示す模式図である。
【符号の説明】
１０ ３次元測定機
１２ アーム
１４ 位置検出器
１６ 先端部
１８ ロボット
２０ ロボットの手先
２２ レーザセンサ
２４ 結合治具
２６ 基準点
２８ 入力装置
３０ 位置・姿勢演算装置
３２ キャリブレーション演算装置
３４ ロボット制御装置
３６ 操作性演算装置
Claims (2)
- アームの先端部に力を加えて動かすことにより、該先端部を任意の位置・姿勢に位置決めすることができるように、６以上の自由度を有するアームを備え、アームの関節部の各軸に位置検出器を設けて、各軸の位置検出器の信号から先端部の位置・姿勢を計測することができる３次元測定機を用い、この３次元測定機の先端部と校正したい多関節ロボットの先端部にある手先を結合して、ロボット先端部の位置・姿勢を計測し、ロボットの位置・姿勢を変えて複数の教示点を計測することによりロボットの機構パラメータを求めてキャリブレーションを行い、ロボットがキャリブレーションに必要な空間上の複数の教示点間を移動する際に、前記３次元測定機の動きやすさを評価して、前記測定機が動きにくい場合に、その教示点から次の動作点までの間に経由点を発生させてロボットの移動経路を補正することを特徴とするロボットのキャリブレーション方法。
- アームの先端部に力を加えて動かすことにより、該先端部を任意の位置・姿勢に位置決めすることができるように、６以上の自由度を有するアームを備え、アームの関節部の各軸に位置検出器を設けて、各軸の位置検出器の信号から先端部の位置・姿勢を計測することができる３次元測定機と、
先端部に設けられた手先が３次元測定機の先端部に結合された多関節ロボットと、
３次元測定機の各軸の位置検出器からの信号を入力して座標変換を行うことにより、ロボット先端部の位置・姿勢を演算する位置・姿勢演算装置と、
ロボットの位置・姿勢を変えて演算した複数の計測値からロボットの機構パラメータを求めてキャリブレーションを行う、ロボット制御装置に接続されたキャリブレーション演算装置と、
前記多関節ロボットに連結されたロボット制御装置と、
を備え、
ロボットがキャリブレーションに必要な空間上の複数の教示点間を移動する際に、前記３次元測定機の動きやすさを評価する値を算出し、前記測定機が動きにくい場合に、その教示点から次の動作点までの間に経由点を発生させる操作性演算装置を設け、この操作性演算装置を前記ロボット制御装置に接続して、前記３次元測定機の動きやすさを考慮してロボットの移動経路を補正できるようにしたことを特徴とするロボットのキャリブレーション装置。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP22495899A JP4302830B2 (ja) | 1999-08-09 | 1999-08-09 | ロボットのキャリブレーション方法及び装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP22495899A JP4302830B2 (ja) | 1999-08-09 | 1999-08-09 | ロボットのキャリブレーション方法及び装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2001050741A JP2001050741A (ja) | 2001-02-23 |
| JP4302830B2 true JP4302830B2 (ja) | 2009-07-29 |
Family
ID=16821873
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP22495899A Expired - Fee Related JP4302830B2 (ja) | 1999-08-09 | 1999-08-09 | ロボットのキャリブレーション方法及び装置 |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP4302830B2 (ja) |
Families Citing this family (21)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP3905771B2 (ja) * | 2001-03-02 | 2007-04-18 | 株式会社ミツトヨ | 測定機の校正方法及び装置 |
| GB0309662D0 (en) * | 2003-04-28 | 2003-06-04 | Crampton Stephen | Robot CMM arm |
| CN100363707C (zh) * | 2006-03-17 | 2008-01-23 | 哈尔滨工业大学 | 空间机械臂位姿精度测试系统 |
| EP2453325A1 (en) | 2010-11-16 | 2012-05-16 | Universal Robots ApS | Method and means for controlling a robot |
| JPWO2013027250A1 (ja) * | 2011-08-19 | 2015-03-05 | 株式会社安川電機 | ロボットシステム、ロボット及びロボット制御装置 |
| BR112014007077A2 (pt) | 2011-09-28 | 2017-04-11 | Universal Robots As | "método para calibração de robôs e método para converter um programa de trabalho" |
| JP2013184236A (ja) | 2012-03-06 | 2013-09-19 | Jtekt Corp | ロボットのキャリブレーション方法及びキャリブレーション装置 |
| JP5938954B2 (ja) | 2012-03-06 | 2016-06-22 | 株式会社ジェイテクト | ロボットのキャリブレーション方法及びキャリブレーション装置 |
| JP6015400B2 (ja) * | 2012-12-06 | 2016-10-26 | 株式会社Ihi | 溶接部材の溶接位置決め方法及び該溶接位置決め方法に用いる溶接部材調整装置並びに溶接部材の溶接位置決め装置 |
| JP6286113B2 (ja) * | 2013-06-17 | 2018-02-28 | 川崎重工業株式会社 | 作業動作調整システムおよび方法 |
| CN103630096B (zh) * | 2013-11-08 | 2016-03-16 | 沈阳黎明航空发动机(集团)有限责任公司 | 一种关节臂式坐标测量机的零位标定方法 |
| WO2015131904A1 (en) | 2014-03-04 | 2015-09-11 | Universal Robots A/S | Safety system for industrial robot |
| WO2016049301A1 (en) | 2014-09-26 | 2016-03-31 | Teradyne, Inc. | Grasping gripper |
| JP2017007082A (ja) * | 2015-06-23 | 2017-01-12 | 株式会社安川電機 | ロボットシステムおよびロボット制御方法 |
| EP3319761A4 (en) | 2015-07-08 | 2019-03-06 | Universal Robots A/S | METHOD FOR EXTENDING END USER PROGRAMMING OF AN INDUSTRIAL ROBOT WITH THIRD PARTY CONTRIBUTIONS |
| TWI805545B (zh) | 2016-04-12 | 2023-06-21 | 丹麥商環球機器人公司 | 用於藉由示範來程式化機器人之方法和電腦程式產品 |
| CN105911938B (zh) * | 2016-05-04 | 2018-09-18 | 首钢京唐钢铁联合有限责任公司 | 一种位置标定方法、系统及自动监控方法 |
| JP6622772B2 (ja) | 2017-09-26 | 2019-12-18 | ファナック株式会社 | 計測システム |
| EP3663054A1 (de) * | 2018-12-05 | 2020-06-10 | Siemens Aktiengesellschaft | Gelenkarmroboter |
| JP7249242B2 (ja) * | 2019-08-22 | 2023-03-30 | 川崎重工業株式会社 | シーリングロボット |
| WO2024057764A1 (ja) * | 2022-09-16 | 2024-03-21 | パナソニックＩｐマネジメント株式会社 | ロボットシステム |
-
1999
- 1999-08-09 JP JP22495899A patent/JP4302830B2/ja not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| JP2001050741A (ja) | 2001-02-23 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP4302830B2 (ja) | ロボットのキャリブレーション方法及び装置 | |
| JP6335460B2 (ja) | ロボットシステムの制御装置及び指令値生成方法、並びにロボットシステムの制御方法 | |
| US9517560B2 (en) | Robot system and calibration method of the robot system | |
| JP5083194B2 (ja) | ロボットのキャリブレーション方法及びロボットの制御装置 | |
| JP5321532B2 (ja) | ロボットキャリブレーション装置及びキャリブレーション方法 | |
| Lee et al. | Industrial robot calibration method using denavit—Hatenberg parameters | |
| JP2012200805A (ja) | ロボット制御装置、ロボット制御方法、プログラム及び記録媒体 | |
| EP2543482A1 (en) | Information processing apparatus and information processing method | |
| JPWO2006022201A1 (ja) | ロボットの評価システム及び評価方法 | |
| JP2015066603A5 (ja) | ||
| JP2005201824A (ja) | 計測装置 | |
| JPWO2018092243A1 (ja) | 作業位置補正方法および作業ロボット | |
| JP7109161B2 (ja) | 多関節ロボットの機構モデルパラメータ推定方法 | |
| JP6922204B2 (ja) | 制御装置、ロボットおよびロボットシステム | |
| JP2004195621A (ja) | ３次元計測装置 | |
| WO2018043524A1 (ja) | ロボットシステム、ロボットシステム制御装置、およびロボットシステム制御方法 | |
| JP7258516B2 (ja) | キャリブレーション方法および把持システム | |
| CN111136661A (zh) | 机器人位置标定方法、装置、系统及机器人系统 | |
| JP2640339B2 (ja) | ロボット定数の自動補正方法 | |
| JPH0727408B2 (ja) | 固定３次元視覚併用ロボットハンドリング装置 | |
| JP2023502722A (ja) | ロボットマニピュレータのインピーダンス制御の較正 | |
| JP3104839B2 (ja) | ロボット診断方法 | |
| WO2020184575A1 (ja) | 計測システム及び計測方法 | |
| JPH012104A (ja) | ロボットの位置決め誤差補正方法 | |
| JP3671694B2 (ja) | ロボットのティーチング方法およびその装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20060628 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20090128 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20090203 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090326 |
|
| 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: 20090421 |
|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20090423 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120501 Year of fee payment: 3 |
|
| R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
| S111 | Request for change of ownership or part of ownership |
Free format text: JAPANESE INTERMEDIATE CODE: R313117 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120501 Year of fee payment: 3 |
|
| R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120501 Year of fee payment: 3 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130501 Year of fee payment: 4 |
|
| LAPS | Cancellation because of no payment of annual fees |