Dublin Core The Dublin Core metadata element set is common to all Omeka records, including items, files, and collections. For more information see, http://dublincore.org/documents/dces/. Title A name given to the resource note Description An account of the resource 日常のノート note 日常のノートの記録 note テキストの自由記述 <div> <div><span># 運動学・ヤコビ行列と偏微分</span></div> <br /> <div><span>## ロボットアームの運動方程式の各項</span></div> <br /> <div><span>### DΘ' = 粘性摩擦力の項</span></div> <br /> <div><span>-</span><span> </span><span>`Θ'`</span><span>の部分は角速度</span></div> <div><span>-</span><span> </span><span>`D`</span><span>の部分は定数行列</span></div> <div><span>-</span><span> これらの両者の積として粘性摩擦力を示している</span></div> <div><span>-</span><span> これらは速度に比例する</span></div> <br /> <div><span>#### 粘性とは？</span></div> <br /> <div><span>オイル・グリースなどの潤滑油の粘性によって起きる摩擦。</span></div> <div><span>一般的に粘性が高いと必要なトルクは大きくなる。</span></div> <br /> <div><span>例として小麦粉などで作られるダイラント流体などがあるが、これは通常使われないため考慮されていない。</span></div> <div><span>これらの特殊なものを使う場合は、この方程式の項について特殊項を代わりに使うことになる。</span></div> <br /> <div><span>### f(Θ) 動摩擦力の項</span></div> <br /> <div><span>ある物体があるとき：</span></div> <div><span>-</span><span> 動きている時には動摩擦力が発生する</span></div> <div><span>-</span><span> 止まっているとき静止摩擦力が発生する</span></div> <br /> <div><span>静止摩擦力はテーブルを傾けることで推定でき、</span></div> <div><span>静止摩擦力を求めることによって、動摩擦力も実際の動作から逆算することによって推定できる。</span></div> <br /> <div><span>ある物体に垂直抗力Ｎがあるとき：</span></div> <div><span>-</span><span> 水平時は抗力が一般的には最大となる</span></div> <div><span>-</span><span> これがΘだけ傾いたとき、この抗力は上方向のベクトルと地面と水平ベクトルに分解される</span></div> <div><span>-</span><span> 傾いている時には $</span><span>N </span><span>\</span><span>sin </span><span>\</span><span>Theta$</span><span> で表すことができる</span></div> <br /> <div><span>これはアームの角度により変化する関数として考えることができ、</span></div> <div><span>`f(Θ)`</span><span>で表すことができる。</span></div> <div><span>これは1以下の数の積である力を減衰するものとして表せられる。</span></div> <br /> <div><span>### g(Θ) 重力項</span></div> <br /> <div><span>ある機械のパーツがあったとして、その慣性モーメントとして考えた場合に、その角度と場所によってそこにかかる重力によってかかる力は変わる。</span></div> <br /> <div><span>重力によるモーメントは以下の式によって求められる：</span></div> <div><span>$$</span></div> <div><span>\</span><span>tau = m </span><span>\</span><span>cdot l </span><span>\</span><span>cdot g</span></div> <div><span>$$</span></div> <div><span>ここで：</span></div> <div><span>-</span><span> </span><span>`m`</span><span>: 質量</span></div> <div><span>-</span><span> </span><span>`l`</span><span>: 重心までの距離</span></div> <div><span>-</span><span> </span><span>`g`</span><span>: 重力加速度</span></div> <br /> <div><span>これらを行列で表したものがこの重力項の定義だといえる。</span></div> <div><span>（注：重力項は重力が原因であるが、軸と角度がないとモーメントとして表現できないため、角度Θの関数として表現される）</span></div> <br /> <div><span>### 小まとめ</span></div> <br /> <div><span>ロボットアームの姿勢により、各関節に必要となるトルクが変化する。</span></div> <br /><br /> <div><span>**数式で表現できるということは近似的に計算機で計算できるということである。**</span></div> <br /> <div><span>→ 物理エンジンでシミュレーションできる</span></div> <div><span>→ いろいろな力をあらかじめ予想したりできる（制御精度も向上される）</span></div> <br /> <div><span>## 運動学と動力学の違い</span></div> <br /> <div><span>-</span><span> </span><span>**動力学**</span><span>：力、加速度、速度、位置</span></div> <div><span> </span><span>-</span><span> 運動方程式で表現する</span></div> <div><span> </span></div> <div><span>-</span><span> </span><span>**運動学**</span><span>：</span><span>**位置関係のみ**</span></div> <div><span> </span><span>-</span><span> 力や加速度を考慮せず、位置と角度の関係のみを扱う</span></div> <br /><br /> <div><span>## 順運動学の基礎</span></div> <br /> <div><span>### ロボットアームの表現</span></div> <br /> <div><span>| 関節 | 1 | 2 | 3 | 4 | 位置 |</span></div> <div><span>|------|---|---|---|---|------|</span></div> <div><span>| 角度 | Θ_1 | Θ_2 | Θ_3 | Θ_4 | P(x,y,z) |</span></div> <br /> <div><span>### 順運動学</span></div> <br /> <div><span>$$</span></div> <div><span>\</span><span>Theta = (</span><span>\</span><span>Theta_</span><span>1</span><span>, </span><span>\</span><span>Theta_</span><span>2</span><span>, </span><span>\</span><span>Theta_</span><span>3</span><span>) </span><span>\</span><span>rightarrow P = (x_p, y_p, z_p)</span></div> <div><span>$$</span></div> <br /> <div><span>それぞれの角度から場所を計算によって特定する方向。</span></div> <div><span>＊これは解が一つある、その動きの結果から演算するため。</span></div> <br /> <div><span>## 逆運動学の概要</span></div> <br /> <div><span>ある動作をしたいときに各関節の角度の動きをどう動かすか考えることを逆運動学という</span></div> <div><span>この考え方には問題があって</span></div> <br /> <div><span>1.</span><span> 解が１つの場合と</span></div> <div><span>2.</span><span> 解が複数の場合</span></div> <div><span>3.</span><span> 解なし</span></div> <div><span>4.</span><span> 計算不能（計算の数式が不明）</span></div> <br /><br /> <div><span>## 動力学</span></div> <br /> <div><span>### 順動力学</span></div> <br /> <div><span>入力：関節トルク（τ）</span></div> <div><span>出力：手先の</span></div> <div><span>-</span><span> 位置</span></div> <div><span>-</span><span> 速度</span></div> <div><span>-</span><span> 加速度</span></div> <div><span>-</span><span> 力</span></div> <br /> <div><span>＊トルクを与える（トルクとは回転する力τで表せられる。）</span></div> <div><span>＊入力するトルクから運動パラメータを算出する方法。</span></div> <br /> <div><span>### 逆動力学</span></div> <br /> <div><span>入力：手先の</span></div> <div><span>-</span><span> 位置</span></div> <div><span>-</span><span> 速度</span></div> <div><span>-</span><span> 加速度</span></div> <br /> <div><span>出力：関節トルク</span></div> <br /> <div><span>＊運動パラメータから各関節のトルクを算出する。</span></div> <br /> <div><span>## 2自由度アームの順運動学例</span></div> <br /> <div><span>２自由度アーム（独立して動かせる関節が２か所）</span></div> <br /> <div><span>### 図１２自由度アームの順運動学の例</span></div> <br /> <div><span>```</span></div> <div><span> P(X, Y)</span></div> <div><span> *</span></div> <div><span> /|</span></div> <div><span> / |</span></div> <div><span> l2/ |</span></div> <div><span> / |</span></div> <div><span> / |</span></div> <div><span> / |</span></div> <div><span> * 関節2</span></div> <div><span> /|</span></div> <div><span> / |θ2</span></div> <div><span> l1/ |</span></div> <div><span> / |</span></div> <div><span> / |</span></div> <div><span> / |</span></div> <div><span> * 関節1</span></div> <div><span> /|</span></div> <div><span> / |θ1</span></div> <div><span> / |</span></div> <div><span> / |</span></div> <div><span> / |</span></div> <div><span> *-----+--------> X軸（水平線）</span></div> <div><span> O(原点)|</span></div> <div><span> |</span></div> <div><span> v</span></div> <div><span> Y軸</span></div> <div><span>```</span></div> <br /> <div><span>角度の関係:</span></div> <div><span>-</span><span> θ1: 第1リンクの角度（水平軸からの角度）</span></div> <div><span>-</span><span> θ2: 第2リンクの角度（第1リンクからの相対角度）</span></div> <div><span>-</span><span> 第2リンクの絶対角度 = θ1 + θ2（水平軸からの角度）</span></div> <br /> <div><span>-</span><span> 原点Oから始まる2リンクアーム</span></div> <div><span>-</span><span> 第1リンク：長さ</span><span>`l1`</span><span>、角度</span><span>`θ1`</span><span>（水平軸からの角度）</span></div> <div><span>-</span><span> 第2リンク：長さ</span><span>`l2`</span><span>、角度</span><span>`θ2`</span><span>（第1リンクからの相対角度）</span></div> <div><span>-</span><span> 手先位置：</span><span>`P(X, Y)`</span></div> <div><span>-</span><span> 関節1、関節2が各リンクの接続点</span></div> <br /> <div><span>### 順運動学の式</span></div> <br /> <div><span>$$</span></div> <div><span>\</span><span>begin</span><span>{aligned}</span></div> <div><span>X_p &= l_</span><span>1</span><span> </span><span>\</span><span>cos </span><span>\</span><span>theta_</span><span>1</span><span> + l_</span><span>2</span><span> </span><span>\</span><span>cos (</span><span>\</span><span>theta_</span><span>1</span><span> + </span><span>\</span><span>theta_</span><span>2</span><span>) \\</span></div> <div><span>Y_p &= l_</span><span>1</span><span> </span><span>\</span><span>sin </span><span>\</span><span>theta_</span><span>1</span><span> + l_</span><span>2</span><span> </span><span>\</span><span>sin (</span><span>\</span><span>theta_</span><span>1</span><span> + </span><span>\</span><span>theta_</span><span>2</span><span>)</span></div> <div><span>\</span><span>end</span><span>{aligned}</span></div> <div><span>$$</span></div> <br /> <div><span>#### ロボット工学の略記法</span></div> <div><span>$$</span></div> <div><span>\</span><span>begin</span><span>{aligned}</span></div> <div><span>C_</span><span>1</span><span> &= </span><span>\</span><span>cos </span><span>\</span><span>theta_</span><span>1</span><span> \\</span></div> <div><span>S_</span><span>1</span><span> &= </span><span>\</span><span>sin </span><span>\</span><span>theta_</span><span>1</span><span> \\</span></div> <div><span>C_{</span><span>12</span><span>} &= </span><span>\</span><span>cos (</span><span>\</span><span>theta_</span><span>1</span><span> + </span><span>\</span><span>theta_</span><span>2</span><span>) \\</span></div> <div><span>S_{</span><span>12</span><span>} &= </span><span>\</span><span>sin (</span><span>\</span><span>theta_</span><span>1</span><span> + </span><span>\</span><span>theta_</span><span>2</span><span>)</span></div> <div><span>\</span><span>end</span><span>{aligned}</span></div> <div><span>$$</span></div> <br /> <div><span>略記法を使うと：</span></div> <div><span>$$</span></div> <div><span>\</span><span>begin</span><span>{aligned}</span></div> <div><span>X_p &= l_</span><span>1</span><span> C_</span><span>1</span><span> + l_</span><span>2</span><span> C_{</span><span>12</span><span>} \\</span></div> <div><span>Y_p &= l_</span><span>1</span><span> S_</span><span>1</span><span> + l_</span><span>2</span><span> S_{</span><span>12</span><span>}</span></div> <div><span>\</span><span>end</span><span>{aligned}</span></div> <div><span>$$</span></div> <br /> <div><span>### 図２三角関数おさらい</span></div> <br /> <div><span>```</span></div> <div><span> *</span></div> <div><span> /|</span></div> <div><span> / |</span></div> <div><span> c / | a</span></div> <div><span> / |</span></div> <div><span> / θ |</span></div> <div><span> *-----*</span></div> <div><span> b</span></div> <div><span>```</span></div> <br /> <div><span>記号の意味:</span></div> <div><span>-</span><span> θ: 角度</span></div> <div><span>-</span><span> a: 角度θの対辺</span></div> <div><span>-</span><span> b: 角度θの隣辺</span></div> <div><span>-</span><span> c: 斜辺</span></div> <br /> <div><span>直角三角形において：</span></div> <div><span>-</span><span> 斜辺：</span><span>`c`</span></div> <div><span>-</span><span> 角度</span><span>`θ`</span><span>の対辺：</span><span>`a`</span></div> <div><span>-</span><span> 角度</span><span>`θ`</span><span>の隣辺：</span><span>`b`</span></div> <br /> <div><span>$$</span></div> <div><span>\</span><span>begin</span><span>{aligned}</span></div> <div><span>\</span><span>cos </span><span>\</span><span>theta &= </span><span>\</span><span>frac</span><span>{b}{c} \\</span></div> <div><span>\</span><span>sin </span><span>\</span><span>theta &= </span><span>\</span><span>frac</span><span>{a}{c} \\</span></div> <div><span>\</span><span>tan </span><span>\</span><span>theta &= </span><span>\</span><span>frac</span><span>{a}{b}</span></div> <div><span>\</span><span>end</span><span>{aligned}</span></div> <div><span>$$</span></div> <br /> <div><span>### 図３ 1リンクアームの場合</span></div> <br /> <div><span>```</span></div> <div><span> P(Xp, Yp)</span></div> <div><span> *</span></div> <div><span> /|</span></div> <div><span> / |</span></div> <div><span> / | Yp</span></div> <div><span> l / |</span></div> <div><span> / |</span></div> <div><span> / θ |</span></div> <div><span> *------+----> X軸</span></div> <div><span>O(原点) Xp</span></div> <div><span> |</span></div> <div><span> |</span></div> <div><span> v</span></div> <div><span>Y軸</span></div> <div><span>```</span></div> <br /> <div><span>原点Oから長さ</span><span>`l`</span><span>のリンクが角度</span><span>`θ`</span><span>で配置されている場合：</span></div> <br /> <div><span>$$</span></div> <div><span>\</span><span>begin</span><span>{aligned}</span></div> <div><span>\</span><span>cos </span><span>\</span><span>theta &= </span><span>\</span><span>frac</span><span>{X_p}{l} \\</span></div> <div><span>\</span><span>sin </span><span>\</span><span>theta &= </span><span>\</span><span>frac</span><span>{Y_p}{l}</span></div> <div><span>\</span><span>end</span><span>{aligned}</span></div> <div><span>$$</span></div> <br /> <div><span>両辺に</span><span>`l`</span><span>をかけると：</span></div> <div><span>$$</span></div> <div><span>\</span><span>begin</span><span>{aligned}</span></div> <div><span>X_p &= l </span><span>\</span><span>cos </span><span>\</span><span>theta \\</span></div> <div><span>Y_p &= l </span><span>\</span><span>sin </span><span>\</span><span>theta</span></div> <div><span>\</span><span>end</span><span>{aligned}</span></div> <div><span>$$</span></div> <br /> <div><span>### 図４ 2リンクアームの成分分解</span></div> <br /> <div><span>```</span></div> <div><span> P(Xp, Yp)</span></div> <div><span> *</span></div> <div><span> /|</span></div> <div><span> / |</span></div> <div><span> l2/ |</span></div> <div><span> / |</span></div> <div><span> / |</span></div> <div><span> / |</span></div> <div><span> * 関節2</span></div> <div><span> /| |</span></div> <div><span> / | |</span></div> <div><span> l1/ | |</span></div> <div><span> / | |</span></div> <div><span> / | |</span></div> <div><span> / | |</span></div> <div><span> *------+-----+--------> X軸</span></div> <div><span> 関節1 | |</span></div> <div><span> | | |</span></div> <div><span> |② |④ |</span></div> <div><span> | | |</span></div> <div><span> *------+-----+</span></div> <div><span> O(原点) ① ③</span></div> <div><span> |</span></div> <div><span> |</span></div> <div><span> v</span></div> <div><span> Y軸</span></div> <div><span>```</span></div> <br /> <div><span>成分の説明:</span></div> <div><span>①: $</span><span>l_</span><span>1</span><span> </span><span>\</span><span>cos </span><span>\</span><span>theta_</span><span>1</span><span>$</span><span>（第1リンクのX成分）→</span></div> <div><span>②: $</span><span>l_</span><span>1</span><span> </span><span>\</span><span>sin </span><span>\</span><span>theta_</span><span>1</span><span>$</span><span>（第1リンクのY成分）</span></div> <div><span>③: $</span><span>l_</span><span>2</span><span> </span><span>\</span><span>cos (</span><span>\</span><span>theta_</span><span>1</span><span> + </span><span>\</span><span>theta_</span><span>2</span><span>)$</span><span>（第2リンクのX成分）→</span></div> <div><span>④: $</span><span>l_</span><span>2</span><span> </span><span>\</span><span>sin (</span><span>\</span><span>theta_</span><span>1</span><span> + </span><span>\</span><span>theta_</span><span>2</span><span>)$</span><span>（第2リンクのY成分）</span></div> <br /> <div><span>手先位置</span><span>`P(Xp, Yp)`</span><span>はこれらの成分の和：</span></div> <div><span>$$</span></div> <div><span>\</span><span>begin</span><span>{aligned}</span></div> <div><span>X_p &= l_</span><span>1</span><span> </span><span>\</span><span>cos </span><span>\</span><span>theta_</span><span>1</span><span> + l_</span><span>2</span><span> </span><span>\</span><span>cos (</span><span>\</span><span>theta_</span><span>1</span><span> + </span><span>\</span><span>theta_</span><span>2</span><span>) \\</span></div> <div><span>Y_p &= l_</span><span>1</span><span> </span><span>\</span><span>sin </span><span>\</span><span>theta_</span><span>1</span><span> + l_</span><span>2</span><span> </span><span>\</span><span>sin (</span><span>\</span><span>theta_</span><span>1</span><span> + </span><span>\</span><span>theta_</span><span>2</span><span>)</span></div> <div><span>\</span><span>end</span><span>{aligned}</span></div> <div><span>$$</span></div> <br /> <div><span>### 図５角度の関係</span></div> <br /> <div><span>```</span></div> <div><span> |</span></div> <div><span> | θ2 (第2リンクの相対角度)</span></div> <div><span> | /</span></div> <div><span> |/</span></div> <div><span> * 関節2</span></div> <div><span> /|</span></div> <div><span> / |</span></div> <div><span> / | θ1 (第1リンクの角度)</span></div> <div><span> / |</span></div> <div><span>*----+--------> X軸</span></div> <div><span>O θ1+θ2 (第2リンクの絶対角度)</span></div> <div><span>|</span></div> <div><span>v</span></div> <div><span>Y軸</span></div> <div><span>```</span></div> <br /> <div><span>2リンクアームにおける角度の関係：</span></div> <div><span>-</span><span> 第1リンクの角度：</span><span>`θ1`</span><span>（水平軸からの角度）</span></div> <div><span>-</span><span> 第2リンクの角度：</span><span>`θ2`</span><span>（第1リンクからの相対角度）</span></div> <div><span>-</span><span> 第2リンクの絶対角度：</span><span>`θ1 + θ2`</span><span>（水平軸からの角度）</span></div> <br /> <div><span>よって、順運動学の式は：</span></div> <div><span>$$</span></div> <div><span>\</span><span>begin</span><span>{aligned}</span></div> <div><span>X_p &= l_</span><span>1</span><span> </span><span>\</span><span>cos </span><span>\</span><span>theta_</span><span>1</span><span> + l_</span><span>2</span><span> </span><span>\</span><span>cos (</span><span>\</span><span>theta_</span><span>1</span><span> + </span><span>\</span><span>theta_</span><span>2</span><span>) \\</span></div> <div><span>Y_p &= l_</span><span>1</span><span> </span><span>\</span><span>sin </span><span>\</span><span>theta_</span><span>1</span><span> + l_</span><span>2</span><span> </span><span>\</span><span>sin (</span><span>\</span><span>theta_</span><span>1</span><span> + </span><span>\</span><span>theta_</span><span>2</span><span>)</span></div> <div><span>\</span><span>end</span><span>{aligned}</span></div> <div><span>$$</span></div> <br /><br /><br /><br /><br /><br /><br /></div> Dublin Core The Dublin Core metadata element set is common to all Omeka records, including items, files, and collections. For more information see, http://dublincore.org/documents/dces/. Title A name given to the resource ロボット工学１０ Creator An entity primarily responsible for making the resource unjuno Date Created Date of creation of the resource. 2025-11-26 Rights Information about rights held in and over the resource CC BY-NC 4.0 - 非営利目的のみ許可