前回は、ロボットマニピュレータの運動学と位置制御について取り上げました。いよいよ最終回となる今回は、マニピュレータの力制御とインピーダンス制御を解説します。人間とロボットの握手を可能にした技術を学びましょう。
第6回「力制御とインピーダンス制御」を解説していきます。
第6回もくじ
1. 力制御とは
ロボットマニピュレータには、前回解説した位置制御のみでなく、エンドエフェクタに特定の力を発生させる動作も要求されます。エンドエフェクタの力を制御することを、力制御といいます。
エンドエフェクタが壁に接触して静止した状態で、力制御を行う場合を考えてみましょう(図1)。壁面と力の発生する方向が直交しており、力を与えてもエンドエフェクタの位置は変化しません。
マニピュレータの力制御を行う際には、各関節に発生するトルクと、エンドエフェクタに発生する力の関係をあらかじめ計算しておきます。この計算式は、各関節の角度とリンクの長さから幾何学的(図形的)に導き出せます。この式によって、目標の力を実現させるために必要な関節トルクを求めます。動かす際は、算出したトルクを各関節に再現させることで、目標の力を実現させます。
連載2 回目に紹介した、関節駆動に直流モータを用いたマニピュレータの場合、直流モータの発生トルクは、入力電流の大きさに比例します。直流モータのトルクと関節のトルクは、ギア比などから一定の関係があるため、これを逆算して、関節の動作に必要な電流を直流モータに入力することで、エンドエフェクタの力制御を行えます。
しかし、この方法のみで力制御を行うと、実際には摩擦などの影響で、手先の発生力の精度が落ちます。精度の高い力制御を行うには、エンドエフェクタに力センサ(参照:第3 回)を搭載し、計測した手先力をアクチュエータにフィードバックして、発生トルクを制御します。
図1 の例では、エンドエフェクタが壁を押して静止している状態でした。実際には、エンドエフェクタを位置制御しながら、同時に力制御を行う作業が想定されます。このような場合には、位置制御と力制御を組み合わせ、同時に制御します。ただし、位置制御と力制御のそれぞれの成分が、もう一方の制御に影響を与えないように工夫する必要があります。
2. インピーダンス制御とは
全6回で下記の内容を解説しています。
- 第1回 ロボットマニピュレータとは?
- 第2回 ロボットマニピュレータのアクチュエータ
- 第3回 ロボットマニピュレータのセンサ
- 第4回 ロボットマニピュレータの自由度
- 第5回 マニピュレータの運動学
- 第6回 力制御とインピーダンス制御