想定読者: ロボットアームの動かし方を「数式とコードの両方」で理解したい方／ROSや実機を持っていなくても、Python（NumPy・Matplotlib）だけでロボット工学の基礎を一周したい初学者〜中級者の方
この記事で分かること
- 2軸ロボットアームを題材に、順運動学・逆運動学・軌道生成・経路生成・特異点対応を純Pythonでどう実装するか
- どの記事を・どの順番で読めばロボット工学の基礎を最短で一周できるか（全7記事の地図）
- ROSも実機もPyBulletも使わず、PC1台で完結する学び方
迷ったら、まず下の「シリーズ全体のロードマップ」と「読者レベル別おすすめスタート地点」を見れば、自分の入口がすぐ分かります。
はじめに
「ロボットアームを動かす」と聞くと、ROS（Robot Operating System：ロボット開発用のミドルウェア）や高価な実機が必要に思えるかもしれません。ですが、順運動学・逆運動学・軌道生成・経路生成・特異点対応といったロボット工学の基礎は、すべて純粋なPython（NumPyとMatplotlibだけ）で実装して理解できます。
この記事は、私が書いてきた 「2軸ロボットアーム」シリーズ（全5記事＋関連2記事） を1つにまとめました。最もシンプルな2軸（関節が2つだけ）のアームを題材に、ロボットを動かすために必要な数学とアルゴリズムを、図とコードで一歩ずつ追えるように構成しています。
用語メモ
- 順運動学（じゅんうんどうがく / Forward Kinematics）：各関節の角度から、手先（アームの先端）が空間のどこに来るかを求める計算。
- 逆運動学（ぎゃくうんどうがく / Inverse Kinematics）：逆に「手先をここに置きたい」という目標から、必要な関節角度を求める計算。
- 特異点（とくいてん / Singularity）：アームが伸びきった姿勢などで逆運動学の計算が不安定になる「苦手な姿勢」のこと。
このシリーズで学べること
- ロボットアームの位置を数式で表す 順運動学（同次変換行列）の実装
- 「手先を目標位置へ動かす」ための 逆運動学 の実装
- なめらかに動かすための 軌道生成（trajectory generation）
- 障害物を避けて経路を作る RRT（Rapidly-exploring Random Trees：ランダムに探索木を広げて経路を見つけるアルゴリズム） と干渉判定の組み込み
- 計算が不安定になる 特異点 の正体と、その近傍を安定して扱う 微分逆運動学＋レーベンバーグ・マルカート法 による対応
読み終えると、「ロボットアームがなぜその姿勢を取れるのか／なぜ取れないのか」を、自分のコードで説明できるようになります。
前提：使う道具は NumPy と Matplotlib だけ
本シリーズのコードは、数値計算ライブラリ NumPy と描画ライブラリ Matplotlib だけで動きます。特別なロボット用ライブラリは使いません。
「行列やベクトルの扱いがあやしい」「グラフ描画に慣れていない」という方は、先に道具の基礎をさらっておくと、以降の数式とコードがぐっと読みやすくなります。
- NumPy入門シリーズのまとめ ─ 配列操作・線形代数・三角関数など、本シリーズで使う計算の基礎
- Matplotlibで学ぶデータ可視化 全11記事まとめ ─ アームの姿勢やアニメーションを描くための描画の基礎
シリーズ全体のロードマップ
[土台] 同次変換行列による順運動学
│
▼
Part1 順運動学 ─→ Part2 逆運動学 ─→ Part3 軌道生成 ─→ Part4 経路生成(RRT+干渉判定) ─→ Part5 微分逆運動学
│
▼
[発展] 微分逆運動学の特異点近傍への対応(LM法)
「位置を求める（Part1）→ 目標から角度を求める（Part2）→ なめらかに動かす（Part3）→ 障害物を避ける（Part4）→ より実用的な逆運動学へ（Part5）→ 苦手な姿勢に対処する（発展）」という、ロボットを動かすうえで自然な順序になっています。
各記事の内容まとめ
| タイトル | こんな疑問に答えます | 主な内容 | リンク | |
|---|---|---|---|---|
| 0 | 同時変換行列による順運動学 | 回転と移動をどう1つの行列でまとめる？ | 座標変換の土台。回転と並進を1つの行列で扱う同次変換行列の考え方 | 記事へ |
| 1 | 2軸ロボットアーム Part1（順運動学） | 関節角度を決めたら手先はどこに来る？ | 関節角度から手先位置を求める。シリーズの出発点 | 記事へ |
| 2 | 2軸ロボットアーム Part2（逆運動学） | 手先を置きたい位置から角度を逆算するには？ | 目標の手先位置から関節角度を逆算する | 記事へ |
| 3 | 2軸ロボットアーム Part3（軌道生成） | カクカクせず、なめらかに動かすには？ | 始点から終点までをなめらかに補間して動かす | 記事へ |
| 4 | 2軸ロボットアーム Part4（経路生成：RRT＋python-fcl） | 障害物をぶつからず避ける経路をどう作る？ | 障害物を避ける経路をRRTで探索し、干渉判定ライブラリと組み合わせる | 記事へ |
| 5 | 2軸ロボットアーム Part5（微分逆運動学） | 解が複数ある逆運動学を実用的に解くには？ | ヤコビアンを使った微分逆運動学。より実用的な逆運動学へ | 記事へ |
| 発展 | ロボットの微分逆運動学の特異点近傍への対応（レーベンバーグ・マルカート法） | 特定の姿勢で計算が暴れるのを止めるには？ | 特異点で計算が暴れる問題を、減衰項を入れたLM法で安定化する | 記事へ |
レーベンバーグ・マルカート法（Levenberg–Marquardt法）：最小二乗問題を解く手法のひとつ。逆運動学では、特異点近傍で計算が不安定になるのを「減衰項」で抑え、安定して解を求めるために使います。
読者レベル別おすすめスタート地点
プログラミング・数学にこれから慣れる初心者の方
→ 「同時変換行列による順運動学」→ Part1 の順でお読みください。座標変換という土台から始めると、Part2以降の数式が一気に読みやすくなります。
行列・線形代数は分かるが、ロボットの実装は初めての方
→ Part1（順運動学）から Part5 まで順番に通読するのがおすすめです。各Partが前のPartの上に積み上がる設計なので、飛ばさず進むと理解が深まります。
逆運動学までは知っていて、実用上の「つまずき」を解決したい方
→ Part5（微分逆運動学）→ 発展（特異点対応） から読んでください。実機やシミュレーションで逆運動学が不安定になる原因と対処が分かります。
シリーズを通じて作れるもの
このシリーズを完走すると、2軸ロボットアームが「目標位置を指定されると、障害物を避けながら、なめらかに、特異点でも破綻せずに手先を動かす」 という一連のシミュレーションを、すべて自分のPythonコード（NumPy・Matplotlib）で再現できるようになります。ROSも実機もPyBulletも不要で、PC1台で完結します。
次のステップ：シミュレーションと強化学習へ
純Pythonで基礎を固めたあとは、物理シミュレーターや機械学習へ展開できます（こちらも2軸アームを題材にしています）。
PyBulletで動かす（物理シミュレーション）
PyBullet（パイブレット：物理エンジンBulletをPythonから手軽に使えるロボットシミュレータ） で、同じ2軸アームを物理シミュレーション上で動かし、物体把持やカメラによる位置認識まで発展させます。
- PyBulletで2軸ロボットアームを動かす Part1（関節角度を自由に設定）
- Part2（手先位置を自由に設定）
- Part3（干渉物環境下での経路生成）
- Part4（物体把持）
- Part5（干渉物を避けて物体把持）
- Part6（単一カメラで物体位置を把握）
- Part7（複数カメラで物体位置を把握）
強化学習で動かす
強化学習（Reinforcement Learning：試行錯誤を通じてエージェントが最適な行動を学習する機械学習手法）
参考・関連シリーズ
- ロボットの自作記事まとめ ─ 2軸・3軸・6軸アームを純Pythonで実装したシリーズ全体のまとめ
- 経路生成手法の自作記事まとめ ─ RRT・RRT*・RRT-Connectなど経路生成アルゴリズムの自作まとめ
さいごに
2軸という最小構成だからこそ、ロボット工学の本質（順運動学・逆運動学・軌道生成・経路生成・特異点）を、数式とコードの両面から「腹落ち」しやすくなっています。ここで身につけた考え方は、3軸・6軸の多自由度アームでもそのまま通用します。