フレネ・セレの公式
フレネ・セレの公式 (ふれねせれのこうしき、英: Frenet–Serret formulas) は、3次元 ユークリッド空間内 R3 内の連続で微分可能な曲線上を動く粒子の運動学的性質、あるいは、曲線自身の幾何学的性質を記述するベクトル解析の概念の一つである。
公式
[編集 ]この公式は、曲線に対する接線方向 (tangent)・主法線方向 (normal)・従法線方向 (binormal)を指す3つの単位ベクトルの組{T, N, B }からなるフレネ・セレ標構とその微分との間の線形関係について記述したものであり、二人のフランス人数学者ジャン・フレデリック・フルネ (英語版) (Jean Frédéric Frenet, 1847) とジョゼフ・アルフレッド・セレ (英語版) (Joseph Alfred Serret, 1851) によって独立に発見された。
フレネ・セレ基底を構成する単位接ベクトル T ・単位主法線ベクトル N ・単位従法線ベクトル B は次のように定義される。
フレネ・セレの公式は
- {\displaystyle {\begin{matrix}\displaystyle {\frac {\mathrm {d} {\boldsymbol {T}}}{\mathrm {d} s}}&=&&\kappa {\boldsymbol {N}}&\\&&&&\\\displaystyle {\frac {\mathrm {d} {\boldsymbol {N}}}{\mathrm {d} s}}&=&-\kappa {\boldsymbol {T}}&&+,円\tau {\boldsymbol {B}}\\&&&&\\\displaystyle {\frac {\mathrm {d} {\boldsymbol {B}}}{\mathrm {d} s}}&=&&-\tau {\boldsymbol {N}}&\end{matrix}}}
あるいは
- {\displaystyle \displaystyle {\frac {\mathrm {d} }{\mathrm {d} s}}{\begin{pmatrix}{\boldsymbol {T}}\\{\boldsymbol {N}}\\{\boldsymbol {B}}\end{pmatrix}}={\begin{pmatrix}0&\kappa &0\\-\kappa &0&\tau \0円&-\tau &0\end{pmatrix}}{\begin{pmatrix}{\boldsymbol {T}}\\{\boldsymbol {N}}\\{\boldsymbol {B}}\end{pmatrix}}}
と表される。
ここで、d/ds は、弧長についての微分を表し、κ, τ はそれぞれ曲線の曲率、捩率を表す。
導出
[編集 ]前提
[編集 ]ユークリッド空間内を運動する粒子の時刻 t における位置ベクトルを r (t) とする。関数 r (t) のグラフは粒子の軌道を表す曲線である。 ただし、 r (t) は滑らかな関数であり、 軌道は曲がっている (r "(t)×ばつr '(t)≠0) と仮定する。
弧長パラメータ
[編集 ]s (t) を弧長、すなわち、粒子が時刻 t までに曲線上を動いた距離
- {\displaystyle s(t)=\int _{0}^{t}\|{\boldsymbol {r}}'(\sigma )\|\mathrm {d} \sigma .}
とする。r '≠0 を仮定しているので、t を s の関数として表せ、よって、r をs の関数として r(s)=r(t(s)) と表せる。このように、曲線を弧長でパラメータ表示できる。なお、微分は
- {\displaystyle {\frac {\mathrm {d} }{\mathrm {d} s}}={\frac {1}{\|{\boldsymbol {r}}'(t)\|}}{\frac {\mathrm {d} }{\mathrm {d} t}}}
と変換できる。
互いに直交する単位ベクトルの微分
[編集 ]曲線上の各点 r (s) で定義された正規直交基底 { e1(s), e2(s), e3(s) } (動標構 (英語版))を考える。それぞれのベクトルは s について微分可能とする。
微分したベクトル { de1(s)/ds , de2(s)/ds , de3(s )/ds }は、 あるスカラー関数 ω1(s), ω2(s), ω3(s) を使って
- {\displaystyle {\frac {\mathrm {d} }{\mathrm {d} s}}{\begin{pmatrix}{\boldsymbol {e}}_{1}(s)\\{\boldsymbol {e}}_{2}(s)\\{\boldsymbol {e}}_{3}(s)\\\end{pmatrix}}={\begin{pmatrix}0&\omega _{3}&-\omega _{2}\\-\omega _{3}&0&\omega _{1}\\\omega _{2}&-\omega _{1}&0\end{pmatrix}}{\begin{pmatrix}{\boldsymbol {e}}_{1}(s)\\{\boldsymbol {e}}_{2}(s)\\{\boldsymbol {e}}_{3}(s)\\\end{pmatrix}}} ...(0)
と表せる。
基底の縦表示
- {\displaystyle Q={\begin{pmatrix}{\boldsymbol {e}}_{1}(s)\\{\boldsymbol {e}}_{2}(s)\\{\boldsymbol {e}}_{3}(s)\end{pmatrix}}}
を考える。これらの要素のベクトルは基底をなすから任意のベクトルを線形和で表示できる。 よって自身の微分に対しても
- {\displaystyle {\frac {\mathrm {d} Q}{\mathrm {d} s}}={\it {\Omega }},円Q} ...(p1)
となる行列 Ω が存在する。 よって、証明すべきことはこの行列が反対称性 (ΩT=-Ω) を持つことである。
さて、 { e1(s), e2(s), e3(s) } は正規直交基底なので
- {\displaystyle {\begin{aligned}Q\cdot Q^{\mathrm {T} }&={\begin{pmatrix}{\boldsymbol {e}}_{1}(s)\\{\boldsymbol {e}}_{2}(s)\\{\boldsymbol {e}}_{3}(s)\end{pmatrix}}\cdot {\begin{pmatrix}{\boldsymbol {e}}_{1}(s)&{\boldsymbol {e}}_{2}(s)&{\boldsymbol {e}}_{3}(s)\end{pmatrix}}\\&={\begin{pmatrix}1&0&0\0円&1&0\0円&0&1\end{pmatrix}}\\\therefore Q\cdot Q^{\mathrm {T} }&=I\end{aligned}}}
となる。
これを式(p1)に適用すると
- {\displaystyle {\it {\Omega }}={\frac {\mathrm {d} Q}{\mathrm {d} s}}\cdot Q^{\mathrm {T} }}
が得られる。
また、I =Q ・QT の両辺を微分すると、
- {\displaystyle {\begin{aligned}0&=\displaystyle {\frac {\mathrm {d} Q}{\mathrm {d} s}}\cdot Q^{\mathrm {T} }+Q\cdot {\frac {\mathrm {d} Q^{\mathrm {T} }}{\mathrm {d} s}}\\&=\displaystyle {\frac {\mathrm {d} Q}{\mathrm {d} s}}\cdot Q^{\mathrm {T} }+\left({\frac {\mathrm {d} Q}{\mathrm {d} s}}\cdot Q^{\mathrm {T} }\right)^{\mathrm {T} }&={\it {\Omega }}+{\it {\Omega }}^{\mathrm {T} }\end{aligned}}}
が導かれる。これより、Ω が反対称性
- {\displaystyle {\it {\Omega }}={\begin{pmatrix}0&\omega _{3}&-\omega _{2}\\-\omega _{3}&0&\omega _{1}\\\omega _{2}&-\omega _{1}&0\end{pmatrix}}}
を持つことが示せた。
反対称行列は3個のパラメータで表せるが、以下に示すように、正規直交基底を適切に選ぶと反対称行列の成分を2個のパラメータで表すことができる。
フレネ・セレ標構
[編集 ]曲線上の各点 r (s) において、3組のベクトル {T, N, B} を以下のように定義する:
- {\displaystyle {\begin{aligned}{\boldsymbol {T}}&\equiv {\frac {\mathrm {d} {\boldsymbol {r}}}{\mathrm {d} s}}\\&={\frac {{\boldsymbol {r}}'(t)}{\left\|{\boldsymbol {r}}'(t)\right\|}}&(1)\\[1.0em]{\boldsymbol {N}}&\equiv {\frac {{\mathrm {d} {\boldsymbol {T}}}/{\mathrm {d} s}}{\left\|{\mathrm {d} {\boldsymbol {T}}}/{\mathrm {d} s}\right\|}}\\&={\frac {{\boldsymbol {r}}'(t)\times ({\boldsymbol {r}}''(t)\times {\boldsymbol {r}}'(t))}{\left\|{\boldsymbol {r}}'(t)\times ({\boldsymbol {r}}''(t)\times {\boldsymbol {r}}'(t))\right\|}}&(2)\\[1.0em]{\boldsymbol {B}}&\equiv {\boldsymbol {T}}\times {\boldsymbol {N}}\\&={\frac {{\boldsymbol {r}}'(t)\times {\boldsymbol {r}}''(t)}{\left\|{\boldsymbol {r}}'(t)\times {\boldsymbol {r}}''(t)\right\|}}&(3)\end{aligned}}}
これらは正規直交基底であり、この順に右手系をなすことがわかる。{T, N, B} をフレネ・セレ標構とよぶ。
フレネ・セレの公式
[編集 ]フレネ・セレ標構に対して、動標構の微分の関係式(0)を適用すると、フレネ・セレ標構の定義(2)からω2=0となる。 ω3=κ,ω1=τと置き換えるとフレネ・セレの公式:
- {\displaystyle {\frac {\mathrm {d} }{\mathrm {d} s}}{\begin{pmatrix}{\boldsymbol {T}}\\{\boldsymbol {N}}\\{\boldsymbol {B}}\end{pmatrix}}={\begin{pmatrix}0&\kappa &0\\-\kappa &0&\tau \0円&-\tau &0\\\end{pmatrix}}{\begin{pmatrix}{\boldsymbol {T}}\\{\boldsymbol {N}}\\{\boldsymbol {B}}\end{pmatrix}}}
が得られる。
κ,τはそれぞれ曲線の曲率、捩率を表し、公式より、
- {\displaystyle {\begin{aligned}\kappa &={\mathrm {d} {\boldsymbol {T}} \over \mathrm {d} s}\cdot {\boldsymbol {N}}\\&={\left\|{\boldsymbol {r}}'(t)\times {\boldsymbol {r}}''(t)\right\| \over \left\|{\boldsymbol {r}}'(t)\right\|^{3}}\\\tau &=-{\mathrm {d} {\boldsymbol {B}} \over \mathrm {d} s}\cdot {\boldsymbol {N}}\\&={{\boldsymbol {r}}'(t)\cdot ({\boldsymbol {r}}''(t)\times {\boldsymbol {r}}'''(t)) \over \left\|{\boldsymbol {r}}'(t)\times {\boldsymbol {r}}''(t)\right\|^{2}}\end{aligned}}}
と与えられる。定義により κ >0 である。
具体例
[編集 ]半径 r (>0)、間隔 2π h 、角速度ω(>0)の螺旋上の運動
- {\displaystyle {\begin{aligned}x(t)&=r\cos(\omega t)\\y(t)&=r\sin(\omega t)\\z(t)&=h\omega t\end{aligned}}}
を考える。弧長は
- {\displaystyle s(t)={\sqrt {r^{2}+h^{2}}},円\omega t}
で与えられる。
フレネ・セレ標構は
- {\displaystyle {\begin{aligned}{\boldsymbol {T}}(s)&={\frac {1}{\sqrt {r^{2}+h^{2}}}}{\begin{pmatrix}-r\sin(\omega t),&r\cos(\omega t),&h\end{pmatrix}}\\{\boldsymbol {N}}(s)&={\begin{pmatrix}-\cos(\omega t),&-\sin(\omega t),&0\end{pmatrix}}\\{\boldsymbol {B}}(s)&={\frac {1}{\sqrt {r^{2}+h^{2}}}}{\begin{pmatrix}h\sin(\omega t),&-h\cos(\omega t),&r\end{pmatrix}}\end{aligned}}}
であり、曲率・捩率は
- {\displaystyle {\begin{aligned}\kappa &={\frac {r}{r^{2}+h^{2}}}\\\tau &={\frac {h}{r^{2}+h^{2}}}\end{aligned}}}
となる。
h =0 のとき、軌道は xy 面内の半径 r の円周になり、曲率は κ=1/r 、 捩率は τ =0 となる。|h| が大きくなるにつれ、曲率はκ→0、捩率は τ →1/h となる。
応用例
[編集 ]ロボットマニピュレータの姿勢とその軌道を記述したり[1] [2] 、蛇型ロボットや多関節ロボットを連続曲線で近似して表現[3] [4] する際に用いられる。
脚注
[編集 ]- ^ 精密工学会誌 2012, p. 605-610.
- ^ Jorge Angeles 2003, p. 363-424.
- ^ 山田浩也 & 広瀬茂男 2008.
- ^ 山田浩也 2008.
参考文献
[編集 ]- 小林昭七『曲線と曲面の微分幾何』裳華房〈基礎数学選書17〉、1977年。http://www.shokabo.co.jp/series/211_kisosuu.html 。
- 小林昭七『曲線と曲面の微分幾何(改訂版)』裳華房、1995年。ISBN 978-4-7853-1091-2 。http://www.shokabo.co.jp/mybooks/ISBN978-4-7853-1091-2.htm 。
- 蘭豊礼、玉井博文、三浦憲二郎、牧野洋「リニアな曲率・捩率を持つセグメントによる軌道生成」『精密工学会誌』第78巻第7号、2012年、605-610頁。
- Jorge Angeles (2003) (PDF). Fundamentals of Robotic Mechanical Systems. Theory, Methods, Algorithms, second Edition. Mechanical Engineering Series. Springer, New York. ISBN 0-387-95368-X . http://www.robotee.com/Ebooks/Fundamentals_of_Robotic_Mechanical_Systems.pdf 2014年7月9日閲覧。 (TLFeBOOK)
- Jorge Angeles (2014). Fundamentals of Robotic Mechanical Systems. Theory, Methods, Algorithms, Fourth Edition. Mechanical Engineering Series. Springer, New York. ISBN 978-3-319-01850-8 . http://www.springer.com/engineering/mechanical+engineering/book/978-3-319-01850-8 (first edition published in 1997)
- 山田浩也、広瀬茂男「索状能動体の研究―多関節体幹による連続曲線近似法―」『日本ロボット学会誌』第26巻第1号、2008年、110-120頁。
- 山田浩也『索状能動体の3次元運動解析に基づく機構と制御の研究』東京工業大学〈博士論文(甲第7192号)〉、2008年3月26日。http://tdl.libra.titech.ac.jp/hkshi/recordID/dissertation.bib/TT00008875?hit=-1&caller=xc-search 。