ロボット関節経路の時間割当

固定された多関節経路に動力学制約を適用して速度プロファイルと所要時間の候補を求める。

予め決定した経路を時間化します。衝突しない経路の作成や実機の運転許可を行う計算ではありません。

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

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

計算する内容
経路点・動力学モデル(2関節)必須
行経路s(無次元)角度 q1(rad)角度 q2(rad)一次微分 q_s1(rad/経路s)一次微分 q_s2(rad/経路s)二次微分 q_ss1(rad/経路s²)二次微分 q_ss2(rad/経路s²)質量M11(N·m·s²)質量M12(N·m·s²)質量M21(N·m·s²)質量M22(N·m·s²)C(q,q_s)11(N·m·s²)C(q,q_s)12(N·m·s²)C(q,q_s)21(N·m·s²)C(q,q_s)22(N·m·s²)重力 g1(N·m)重力 g2(N·m)操作
1
2
3

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

sは無次元で始点0・終点1。各点のq、q_s、q_ss、M(q)、C(q,q_s)、g(q)を入力します。Cはsdot=1/sの関節速度で評価した行列。TSV貼付け可。

関節別制約(上から関節1・2)必須
行角速度下限(rad/s)角速度上限(rad/s)角加速度下限(rad/s²)角加速度上限(rad/s²)駆動トルク下限(N·m)駆動トルク上限(N·m)操作
1
2

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

下限と上限は符号付き値で入力。0は無制約を意味しません。


計算結果

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

お気に入り一覧

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

計算方法

q̇=q_s ṡ、q̈=q_ss ṡ²+q_s s̈、τ=M(q)q̈+C(q,q̇)q̇+g(q)。C(q,q̇)=ṡ C(q,q_s)を仮定。x=ṡ²≥0、u=s̈と置くと各制約はa(s)u+b(s)x+g(s)の上下限になり、x_{i+1}=x_i+2Δs u_i。後退伝播した可到達速度区間と前進最大加速選択から時間候補を得ます。

経路速度・加速度、s(t)、q(t)、関節速度・加速度・トルク、制約精査ギャップ、所要時間の候補と有効な制約。

計算例(架空の数値)

手計算例:q=(s,2s) rad、M=diag(1,2)、C=0、g=0、開始・終了経路速度0、経路加速度上限1/s²、関節加速度・トルクがこれを許す場合、等間隔3点(0,0.5,1)で前半u=+1、後半u=-1、ṡは0→1→0で所要時間2秒。

適用対象と限界

予め経路と動力学係数が取得できる2~3軸の回転関節ロボット。経路生成、衝突判定、摩擦・飽和遅れ、関節弾性、特異なM、Cが速度に一次同次でないモデル、実機認証や安全速度の決定は含みません。。

採用した方式

  • 区分一定u/線形補間係数の到達可能区間法(v1.0.0):対象範囲 2~3回転関節・s∈[0,1]・既知の滑らかな経路とM/C/g、制御入力の区分一定近似/適用地域 global

方法と出典

方法:sampled-reachability-semi-infinite-cuts-v1.0.0 (2026-11-15)。データ記録日:2026-11-15。