articles:inverse_kinematics

差分

このページの2つのバージョン間の差分を表示します。

この比較画面へのリンク

両方とも前のリビジョン 前のリビジョン
次のリビジョン
前のリビジョン
articles:inverse_kinematics [2022/03/26 16:37] – [解の存在範囲] Takashi Suehiroarticles:inverse_kinematics [2022/03/26 22:21] (現在) – [3自由度アームの逆運動学のまとめ] Takashi Suehiro
行 167: 行 167:
 解の存在範囲は式(7)から以下のように制限される. 解の存在範囲は式(7)から以下のように制限される.
 $$  $$ 
-1 \ge \mathrm{cos}\, \theta_2 \ge -1+1 \ge \mathrm{cos}\, \theta_3 \ge -1
 $$ $$
 すなわち すなわち
行 175: 行 175:
 これは,$\Sigma_1$の原点を中心とした半径$l_2+l_3$の球の内側で半径$|l_2-l_3|$の球の外側の範囲である. これは,$\Sigma_1$の原点を中心とした半径$l_2+l_3$の球の内側で半径$|l_2-l_3|$の球の外側の範囲である.
  
-等号の場合,すなわちそれぞれの球面上であり,それぞれ腕が伸び切った状態($\theta_2=0$),縮みきった状態($\theta_2=\pi/2$)となっている.+等号の場合,すなわちそれぞれの球面上であり,それぞれ腕が伸び切った状態($\theta_3=0$),縮みきった状態($\theta_3=\pi$)となっている.
 この場合は,式(8)の2つのが縮退して1つになる. この場合は,式(8)の2つのが縮退して1つになる.
 +
 +ただし,縮みきった状態に関しては,関節の可動域を考えた場合,$\theta_3=-\pi$も解とな得る.
  
 実際には関節角度の制限や自身および環境との干渉があるために解の存在範囲や解の数はさらに制限される. 実際には関節角度の制限や自身および環境との干渉があるために解の存在範囲や解の数はさらに制限される.
行 224: 行 226:
 \\ \\
 ただし,前述のように$\theta_3$が$0$もしくは$\pi$になる場合はそれぞれアームが伸びきった状態,縮みきった状態となり2つの解が1つに縮退し, ただし,前述のように$\theta_3$が$0$もしくは$\pi$になる場合はそれぞれアームが伸びきった状態,縮みきった状態となり2つの解が1つに縮退し,
-解の数が合計2つとなる特異姿勢になっている.+解の数が合計2つとなる特異姿勢になっている 
 +(縮みきった状態に関しては,関節の可動域を考えた場合,$\theta_3=-\pi$も解とな得る)
 \\ \\
 \\ \\
行 242: 行 245:
 \\ \\
 \\ \\
-いずれの場合も,$\mathrm{cos}^{-1}$の引数が$[-1,1]$の範囲でなければ解が存在しない. 
-これは三角不等式(縮退した等号部分も含む)の条件になっている. 
- 
  
 ==== おまけのまとめ ==== ==== おまけのまとめ ====
  • articles/inverse_kinematics.1648280273.txt.gz
  • 最終更新: 2022/03/26 16:37
  • by Takashi Suehiro