ロボット関節の障害物回避経路

多関節の関節角空間における障害物回避経路候補の探索と離散衝突判定。

固定根元(0,0)の2次元リンクと静止障害物を扱います。計算はブラウザ内で完結し、実機へ指令しません。

項目を入力・選択してから「計算する」を押してください。

選択内容に応じて、残りの入力項目を案内します。

計算する内容

同じ単位でリンク長・半径・障害物の位置と寸法を入力してください。数値の単位変換はしません。

関節とリンク(根元から順に入力)必須
行関節IDリンク長リンク半径最小角(°)最大角(°)開始角(°)目標角(°)操作
1
2

7列を左端の欄へタブ区切りで貼り付けられます。6行まで。

各行は回転関節とその先のリンク。相対角は反時計回り正。リンクは半径をもつカプセルとして扱い、隣接リンクの共有関節は自己衝突から除きます。

固定障害物(なくても可)任意
行障害物ID形状中心X中心Y円半径 任意矩形幅 任意矩形高 任意操作
1

7列を左端の欄へタブ区切りで貼り付けられます。12行まで。

円は半径、軸に平行な長方形は幅・高さのみ記入。使わない寸法欄は空欄。障害物・リンクの接触も衝突扱いです。

各関節の角度差の最大値をこの刻み以下へ分割して全補間点を検査。小さくすると検査点は増えますが、連続的な安全証明にはなりません。


計算結果

値を入力して計算してください。

お気に入り一覧

計算方法・適用範囲・出典

計算方法

関節iの絶対向きはαᵢ=Σⱼ₌₁ⁱθⱼ、各リンク端点は(xᵢ,yᵢ)=(xᵢ₋₁+Lᵢcosαᵢ,yᵢ₋₁+Lᵢsinαᵢ)。各姿勢で関節上下限、各リンク(中心線+半径)と円/軸平行長方形、非隣接リンク同士の最短距離を照合します。辺はθ(t)=(1−t)θ₀+tθ₁(0≦t≦1)の全離散補間点を検査し、最大関節角変化/刻みから点数を決定。RRTは一様関節角sample・15%のgoal bias・最近傍への伸長、PRMは有効sampleを近傍接続しDijkstraで距離最小のグラフ経路を探索。経路長は各辺の関節角ベクトルのユークリッド距離の和。seedと探索上限は固定し、3つのseedで検出感度を比較します。

経路候補の関節角一覧、頂点数、関節角空間の経路長、最小離散クリアランス、seedによる検出感度。

計算例(架空の数値)

長さ1、1の2リンク、半径0、各関節角度−180°〜180°、開始(0°,0°)、目標(0°,90°)、障害物なしなら関節角経路長90°、開始と目標の2点で直接接続できます。

適用対象と限界

原点固定・平面直列回転関節1〜6軸。角度は親リンクからの相対角(°)、長さは全要素で共通の選択単位。。3D、移動ベース、分岐、関節連動、動的障害物、回転矩形、連続衝突保証、最適性・到達可能性の証明、ロボットへの制御命令は対象外。。

採用した方式

  • RRT(custom-planar-rrt-v1):対象範囲 固定根元・平面回転関節の有限ランダムツリー探索/適用地域 地域制限なし
  • PRM(custom-planar-prm-v1):対象範囲 固定根元・平面回転関節の有限ロードマップ探索/適用地域 地域制限なし

方法と出典

方法:custom-planar-rrt-prm-v1(OMPL State Validity Checking設計概念参照・OMPLライブラリ非使用)。データ記録日:2026-11-15。