JP2011088225A5 - - Google Patents

Claims (15)

1. ロボットのエンドエフェクタに設けた力センサ情報を基に構成されたインピーダンス制御系の慣性パラメータと粘性パラメータの調整を行うロボット制御システムであって、
   パラメータ調整時に設定する前記慣性パラメータと前記粘性パラメータの初期値を算出するパラメータの初期値算出部と、
   前記インピーダンス制御系へステップ状の力指令を繰り返し与えることで、前記エンドエフェクタが把持したワークを対象ワークに繰り返し押し当てる力指令印加部と、
   押し当ての度に前記力センサからの力フィードバックの時間応答を記録するとともに、前記力フィードバックの時間応答のオーバシュート量と整定時間と振動回数を自動計測する評価基準計測部と、
   許容できる前記オーバシュート量の最大値であるオーバシュート量許容値と、許容できる前記整定時間の最大値である整定時間許容値を設定する許容値設定部と、
   前記慣性パラメータを固定し、繰り返し押し当てを実行して前記整定時間が最小になるような粘性パラメータを探索する粘性パラメータ探索部と、
   前記粘性パラメータ探索部による粘性パラメータ探索の結果、前記評価基準計測部から得られる前記オーバシュート量と前記整定時間を、それぞれの前記許容値と比較することによって探索処理を終了するか、継続するかを判断する終了判断部と、
   前記終了判断部がパラメータ調整処理を継続すると判断した場合に、前記慣性パラメータを増減するか、前記オーバシュート量許容値と前記整定時間許容値の少なくとも一方を緩和した後、前記粘性パラメータ探索を再実行する慣性パラメータ調整部と、
   を備えたロボット制御システム。
2. 前記慣性パラメータ調整部は、前記オーバシュート量が前記オーバシュート量許容値以下でかつ前記整定時間が前記整定時間許容値より大きい場合、前記慣性パラメータを減少させて粘性パラメータ探索を再実行し、
   前記オーバシュート量が前記オーバシュート量許容値より大きく、かつ前記整定時間が前記整定時間許容値以下の場合、前記慣性パラメータを増加させて粘性パラメータ探索を再実行し、
   前記オーバシュート量が前記オーバシュート量許容値より大きく、かつ前記整定時間が前記整定時間許容値より大きい場合、前記オーバシュート量許容値あるいは整定時間許容値の少なくとも一方を緩和して粘性パラメータ探索を再実行する、
   ことを特徴とする請求項１に記載のロボット制御システム。
3. 前記粘性パラメータ探索部は、前記振動回数が予め設定した第１の閾値を上回る場合に前記粘性パラメータを増加させ、予め設定した第２の閾値を下回る場合に前記粘性パラメータを減少させることを特徴とする請求項１または２に記載のロボット制御システム。
4. 前記粘性パラメータ探索部は、前記振動回数が前記第２の閾値以上で前記第１の閾値以下であるとき、前記整定時間が前回に比べて増加した場合に、前記粘性パラメータの探索方向を反転させるとともに、探索幅を予め設定した比率で減少させ、前記整定時間の前回からの減少量が予め設定した閾値以下になったときに探索処理を終了することを特徴とする請求項３に記載のロボット制御システム。
5. 前記パラメータ初期値算出部は、前記エンドエフェクタと把持ワークの重さ、前記ロボットの位置制御系の帯域を設定することで、パラメータ調整時に設定する前記慣性パラメータと前記粘性パラメータの初期値を算出することを特徴とする請求項１に記載のロボット制御システム。
6. 前記評価基準計測部は、前記ステップ状の力指令値を中心に上限および下限を指定した整定範囲に前記力フィードバック応答が収束した時間でもって前記整定時間とすることを特徴とする請求項１に記載のロボット制御システム。
7. 前記評価基準計測部は、前記力フィードバック応答が前記整定範囲を上回った回数と下回った回数を交互に計測し、その回数の和でもって前記振動回数とすることを特徴とする請求項６に記載のロボット制御システム。
8. 前記終了判断部は、前記オーバシュート量が前記オーバシュート量許容値以下でかつ前記整定時間が前記整定時間許容値以下の場合のみ探索処理を終了すると判断し、それ以外の場合は探索処理を継続すると判断することを特徴とする請求項１に記載のロボット制御システム。
9. ロボットのエンドエフェクタに設けた力センサ情報を基に構成されたインピーダンス制御系の慣性パラメータと粘性パラメータを、前記力センサからの力フィードバックの時間応答を繰り返し測定することによって調整するロボット制御方法であって、
   （ｅ）パラメータ調整時に設定する前記慣性パラメータと前記粘性パラメータの初期値算出ステップと、
   （ａ）前記力フィードバックの時間応答に関するオーバシュート量許容値（上限）と整定時間許容値（上限）を設定する許容値設定ステップと、
   （ｂ）前記慣性パラメータを固定して、前記エンドエフェクタが把持したワークを対象ワークに繰り返し押し当て、前記整定時間が最小になるような前記粘性パラメータを探索する粘性パラメータ探索ステップと
   （ｃ）前記粘性パラメータ探索ステップの実行結果によって得られるオーバシュート量と整定時間をそれぞれの前記許容値と比較することによって、探索処理を終了するか、継続するかを判断する終了判断ステップと、
   （ｄ）前記終了判断ステップが探索処理を継続すると判断した場合に、慣性パラメータを増減するか、オーバシュート量許容値と整定時間許容値のいずれか一方を緩和した後、前記粘性パラメータ探索ステップを再実行する慣性パラメータ調整ステップと、
   を実行するロボットシステムの制御方法。
10. 前記慣性パラメータ調整ステップ（ｄ）は、
    （ｄ１）慣性パラメータＭの初期値と探索幅ΔＭ、探索方向係数βおよび探索幅ΔＭの減少率εを初期設定するステップと、
    （ｄ２）前記粘性パラメータ探索ステップを実行するステップと、
    （ｄ３−１）前記オーバシュート量が前記オーバシュート量許容値以下でかつ前記整定時間調整値が整定時間許容値より大きい場合、前記探索方向係数βを−１にし、
    （ｄ３−２）前記オーバシュート量が前記オーバシュート量許容値より大きく、かつ前記整定時間が整定時間許容値以下の場合、前記探索方向係数βを１にし、
    （ｄ３−３）前記探索係数βの符号が反転した場合は前記探索幅ΔＭに減少率εをかけて値を更新した後、前記慣性パラメータをＭ＝Ｍ＋β×ΔＭにより更新して（ｄ２）に戻るステップと、
    （ｄ３−４）前記オーバシュート量が前記オーバシュート量許容値より大きく、かつ前記整定時間が前記整定時間許容値より大きい場合、前記オーバシュート量許容値あるいは前記整定時間許容値の少なくとも一方を再設定して（ｄ２）に戻るステップと、
    を実行することを特徴とする請求項９に記載のロボットシステムの制御方法。
11. 前記粘性パラメータ探索ステップ（ｂ）は、
    （ｂ１）粘性パラメータＤの初期値、粘性パラメータＤの探索幅ΔＤと探索方向係数α、探索幅の減少率γ、整定時間の変化量に関する閾値δＴを初期設定するステップと、
    （ｂ２）前記インピーダンス制御系へステップ状の力指令を入り切りすることで、前記エンドエフェクタが把持した前記ワークを前記対象ワークに押し当てて戻すステップと、
    （ｂ３）前記押し当て時に前記力フィードバックの時間応答を計測して保存するステップと、
    （ｂ４）前記力フィードバックの時間応答の評価値として、時間応答の前記整定時間と前記オーバシュート量および振動回数を計測・保存するステップと、
    （ｂ５）前記振動回数が第１の閾値より大きい場合に前記探索方向係数αを１とし、前記振動回数が第２の閾値より小さい場合に前記探索方向係数αを−１とするステップと、
    （ｂ６）前記振動回数が第２の閾値以上でかつ第１の閾値以下であり、整定時間が前回に比べて増加した場合、前記探索方向係数αの符号を反転させるとともに、前記探索幅ΔＤに減少率γをかけて探索幅ΔＤを更新するステップと、
    （ｂ７）整定時間の前回からの変化量ΔＴが前記閾値δＴより大きい場合、粘性パラメータＤを、Ｄ＝Ｄ＋α×ΔＤにより更新して（ｂ２）に戻るステップと、
    （ｂ８）前記ΔＴが前記δＴ以下の場合は、処理を終了するステップと、
    を実行することを特徴とする請求項９または１０に記載のロボットシステムの制御方法。
12. 前記初期値算出ステップ（ｅ）は、
    （ｅ１）エンドエフェクタと把持ワークの重さを設定することで調整時の慣性パラメータＭの初期値とするステップと、
    （ｅ２）前記ロボットの位置制御系の帯域ωｃを設定するステップと、
    （ｅ３）剛性パラメータＫを前記慣性パラメータＭと前記帯域ωｃから算出するステップと、
    （ｅ４）前記インピーダンス制御系の減衰係数ζを設定するステップと、
    （ｅ５）粘性パラメータＤを前記慣性パラメータＭと前記剛性パラメータＫと前記減衰係数ζから算出し、調整時の粘性パラメータＤの初期値とするステップと、
    を実行することを特徴とする請求項９に記載のロボットシステムの制御方法。
13. 前記ステップ（ｂ４）において、前記ステップ状の力指令値を中心に上限および下限を指定した整定範囲に前記力フィードバック応答が収束した時間でもって前記整定時間とすることを特徴とする請求項１０に記載のロボットシステムの制御方法。
14. 前記ステップ（ｂ４）において、前記力フィードバック応答が前記整定範囲を上回った回数と下回った回数を交互に計測し、その回数の和でもって前記振動回数とすることを特徴とする請求項１３に記載のロボットシステムの制御方法。
15. 前記終了判断ステップ（ｃ）は、前記オーバシュート量が前記オーバシュート量許容値以下でかつ前記整定時間が前記整定時間許容値以下の場合のみ探索処理を終了すると判断し、それ以外の場合は探索処理を継続すると判断することを特徴とする請求項９に記載のロボットシステムの制御方法。