ロボットの幾何キャリブレーション実践：関節誤差・工具座標・カメラ座標をどう校正するか

Wed, 30 Sep 2026 14:21:31 +0900

ロボットの位置ずれは、単一の補正値だけでは説明できないことが多い点が気になります。

先に結論

ロボットの位置決め精度を改善するには、最初にベース、関節、フランジ、工具、カメラ、対象物の座標系と変換方向を定義する。そのうえで、関節オフセット、リンク幾何、工具先端点（TCP）、カメラ内部パラメータ、ハンドアイ変換を別々の誤差源として校正する。推定には十分な姿勢分布と外部計測器を用い、校正に使っていない姿勢で位置決め精度と繰返し精度を検証することが基本である。

校正後の性能は、平均誤差だけで判断してはならない。最大誤差、試行間のばらつき、位置と姿勢の誤差、温度・荷重・速度、計測不確かさを併記し、対象工程の許容差と照合する必要がある。

なぜ誤差を分解するのか

指令した工具位置と実際の位置がずれる原因には、関節のゼロオフセット、リンク長・ねじれ・関節配置、フランジから工具先端までのTCP、カメラの内部パラメータ、ロボットとカメラの外部関係などがある。これらは異なる座標変換や観測量に関係するため、一つの補正値にまとめると別の姿勢で誤差が再び現れやすい。

たとえばTCPの誤差をリンクパラメータへ吸収すると、校正に使った姿勢では残差が小さくても、工具の向きを変えたときにずれが現れる可能性がある。カメラのレンズ歪みをハンドアイ変換で補正する場合も、誤差源の管理が不明確になる。誤差の種類ごとに推定・保存・検証することが再利用の前提となる。

座標系と運動学モデル

まず、各座標系の名称、親子関係、単位、変換行列の向きを記録する。ベースから関節列、フランジ、TCPへ至る関係に加え、カメラがフランジに取り付くeye-in-handか、作業空間に固定されるeye-to-handかも明示する。対象物やワールド座標系についても、どの座標からどの座標へ変換するかを定義する。

運動学モデルには標準DH、修正DH、指数積形式などがある。同じ「リンク長」や「ねじれ」という名称でも、モデルが違えばパラメータの意味や符号は一致しない。したがって、数値だけを別のコントローラやソフトウェアへ移植してはならない。座標系規約、DH規約、単位、カメラ内外部パラメータの定義、コントローラとソフトウェアのバージョンを一緒に管理する。

内部の仕組み：モデルと実測の差を推定する

幾何キャリブレーションでは、関節角から順運動学モデルが予測する工具位置と、外部計測器が測定した実位置との差を残差として扱う。複数の姿勢について残差を集め、関節ゼロオフセットやリンク幾何などの未知パラメータを含むモデルを、最小二乗推定などで調整する。

姿勢が似ていたり、狭い作業範囲に偏っていたりすると、関節オフセットとリンク幾何誤差が相互に代償する。校正データ上の残差が小さくても、未使用の姿勢で誤差が増えることがある。推定したいパラメータが観測に現れるよう、作業領域全体から姿勢を分布させることが必要だ。

カメラ内部校正はロボット運動学とは分けて行う。焦点距離、主点、レンズ歪みは、平面パターンを複数の姿勢から撮影して推定できる。次に、フランジ装着カメラとロボットの関係、または固定カメラとロボットベースの関係をハンドアイ校正で求める。これは相対運動から剛体変換を推定するAX=XB型の問題として表せるが、eye-in-handとeye-to-handでは行列の定義と変換方向が異なる。式を流用せず、座標系の定義に合わせて確認する。

TCPはフランジ座標系から工具座標系への変換として扱う。リンク幾何やカメラ外部パラメータへ混ぜず、工具姿勢を変えても同じTCPが対象点を表すかを独立に確認する。

flowchart LR
  B["ベース座標系"] -->|"順運動学"| J1["関節1"]
  J1 --> J2["関節2 … 関節列"]
  J2 --> F["フランジ座標系"]
  F -->|"T_フランジ→TCP"| TCP["工具座標系（TCP）"]

  F -->|"取り付け関係・ハンドアイ変換"| CEH["カメラ座標系\neye-in-hand"]
  B -->|"ベース→カメラ外部変換"| CETH["カメラ座標系\neye-to-hand"]

  W["ワールド座標系"] -->|"対象物の配置"| T["対象物座標系"]
  CEH -->|"画像観測"| T
  CETH -->|"画像観測"| T

  K["カメラ内部パラメータ\n焦点距離・主点・歪み"] --> CEH
  K --> CETH
  N["各変換の向き・単位・規約を文書化"] -.-> B
  N -.-> TCP
  N -.-> CEH
  N -.-> CETH

ロボットの幾何キャリブレーションでは、関節列からTCPまでの運動学、カメラ内部パラメータ、カメラ外部変換、対象物との関係を分けて管理し、各変換の向きと単位を明示する。

校正対象と確認方法の比較

対象	推定・管理するもの	主な観測・計測	検証時の着眼点
関節オフセット	関節角の基準ずれ	外部計測した複数姿勢	姿勢に依存する系統ずれ
リンク幾何	長さ、ねじれ、配置	外部計測器と運動学モデル	作業領域全体の残差傾向
TCP	フランジから工具先端への変換	工具姿勢を変えた先端位置	姿勢変更時の先端ずれ
カメラ内部	焦点距離、主点、歪み	複数姿勢の平面パターン画像	画像位置の系統誤差
ハンドアイ外部	カメラとフランジまたはベースの変換	相対運動とカメラ観測	構成と変換方向の整合
非幾何要因	たわみ、温度、バックラッシなど	条件を変えた独立計測	姿勢・方向・時間への依存

実務での校正手順

切り分けを重視するなら、次の順序が扱いやすい。