第 6 章 結論 42
6.2 今後の予定
謝辞
本研究にあたり,熱心に指導していただいた浅野文彦准教授に心より深謝致します.ロ ボティクスの観点から鋭いご指摘を頂いた丁洛榮准教授に感謝致します.浅野文彦研究 室のメンバーであり,討論,論文作成,実験において貴重な意見・助言を頂いた肖軒氏,
安田芳樹氏,阿久津行裕氏,田村和希氏に感謝致します.学会活動中に鋭いご指摘を頂い た,東京工業大学山北昌毅准教授および広島大学原田祐志助教に心より感謝致します.学 外の研究室にかかわらず,数多くのご質問に回答してくださった東京工業大学山北研究室 の花澤雄太氏に心より感謝致します.また,円滑に研究活動を行えるよう数多くのサポー トをしてくださった吉高研究室の板宮吉宏氏に心より感謝致します.最後に,ここまで自 分を健康に育て支えてくれた両親に深く感謝致します.
参考文献
[1] T. McGeer:“Passive dynamic walking,” Int. J. of Robotics Research, vol. 9, no. 2, pp. 62–82, 1990.
[2] T. McGeer:“Passive walking with knees,” Proc. of the IEEE Int. Conf. on Robotics and Automation, vol. 3, pp. 1640–1645, 1990.
[3] A. Goswami, B. Thuilot and B. Espiau: “Compass-like biped robot Part I: Stability and bifurcation of passive gaits,” Technical report, INRIA, No. 2996, Oct 1996.
[4] H. Geyer and A. Seyfarth and R. Blickhan:“Compliant leg behaviour explains basic dynamics of walking and running,” Proc. of the Royal Society B, Vol. 273, No. 1603, pp. 2861–2867, 2006.
[5] F. Asano and J. Kawamoto, ”Passive dynamic walking of viscoelastic-legged rimless wheel,” Proc. of the 2012 IEEE International Conference on Robotics and Automa-tion, pp. 2331–2336, May 16, 2012.
[6] J. M. Font-Llagunes and J. Kovecses: “Dynamics and energetics of a class of bipedal walking systems,” Mechanism and Machine Theory Vol. 44, pp. 1999–2019, 2009.
[7] J. M. Bourgeot, C. Canudas-de-Wit and B. Brogliato: “Impactt shaping for double support walk: from the rocking block to the biped robot,” Proc. of the Int. Cof. on Climbing and walking Robots, pp. 509–516, 2005.
[8] F. Asano and Z.W. Luo:“Energy-efficient and high-speed dynamic biped locomotion based on principle of parametric excitation,” IEEE Trans. on Robotics, Vol. 24, No.
6, pp. 1289–1301, 2008.
[9] F. Asano:“Stability analysis of passive compass gait using linearized model,” Proc.
of the IEEE Int. Conf. on Robotics and Automation, pp. 557–562, 2011.
[10] J. C. Wall, D. B. Hogan, G.I. Turnbull and R. A. Fox:“The kinematics of idiopathic gait diisorder: A comparison with healthy young and elderly females,” Scand. J.
Med., Vol. 23, pp159–164, 1991.
[11] Y. Barak, R. C. Wagenaar and K. G. Holt:“Gait characteristics of elderly people with a history of falls: a dynamic approach,” Physical Therapy, Vol. 86, pp. 1501–1510, 2006.
[12] 山崎昌廣,佐藤陽彦:“ヒトの歩行–歩幅,歩調,速度,およびエネルギー代謝の観点 から–”,人類学雑誌,Vol. 98,No. 4,pp. 385–401,1990.
[13] 山海嘉之,鍋嶌厚太,河本浩明:“ロボットスーツHALの安全技術”, 日本ロボット 学会誌, Vol. 29,No. 9, pp. 780–782,2011.
付 録 A 運動方程式の詳細
第2章式(2.1)における行列M(q),h(q,q)˙ の詳細な項について述べる.
M(q)について,
M(q) =
M11 M12 M13 M14 M15 M22 M23 M24 M25 M33 M34 M35 M44 M45
Sym. M55
(A.1)
とおいたとき,各項の詳細は以下通りである.
M11 = 8m+mH M12 = 0
M13 = (am+L1(7m+mH)) cosθ1+L2(7m+mH) cos(θ1+θ2)−m(L2cos(θ1+θ2+α) +bcos(θ1+θ2+θ3 +α) + 2(cos(α/2) + cos(3α/2) + cos(5α/2))(L2cos(θ1+θ2 +9α/2) +bcos(θ1+θ2+ 9α/2 +β))
M14 = L2(7m+mH) cos(θ1 +θ2)−m(L2cos(θ1+θ2+α) +bcos(θ1+θ2+θ3+α) +2(cos(α/2) + cos(3α/2) + cos(5α/2))(L2cos(θ1+θ2+ 9α/2) +bcos(θ1+θ2 +9α/2 +β)))
M15 = −bmcos(θ1+θ2+θ3+α) M22 = 8m+mH
M23 = −(am+L1(7m+mH)) sinθ1 −L2(7m+mH) sin(θ1+θ2) +m(L2sin(θ1+θ2+α) +bsin(θ1+θ2+θ3+α) + 2 cos(α/2 + cos(3α/2) + cos(5α/2))(L2sin(θ1+θ2+α/2) +bsin(θ1+θ2+α/2 +β))
M24 = −L2(7m+mH) sin(θ1 +θ2) +m(L2sin(θ1+θ2+α) +bsin(θ1+θ2+θ3+α) +2(cos(α/2) + cos(3α/2) + cos(5α/2)))(L2sin(θ1+θ2+ 9α/2) +bsin(θ1+θ2 +9α/2 +β))
M25 = bmsin(θ1 +θ2+θ3+α)
M33 = (a2+ 7(b2+L21+ 2L22))m+ (L21+L22)mH + 2L1L2(7m+mH) cosθ2+ 2bL2mcosθ3
−2m(L22cosα+L22cos 2α+L22cos 3α+L22cos 4α+L22cos 5α+L22cos 6α
+L22cos 7α+L1L2cos(θ2+α) +bL2cos(θ3+α) +bL1cos(θ2 +θ3+α) +L1L2cos(θ2 +2α) +L1L2cos(θ2+ 3α) +L1L2cos(θ2+ 4α) +L1L2cos(θ2+ 5α) +L1L2cos(θ2 +6α) +L1L2cos(θ2+ 7α)−6bL2cosβ+bL2cos(2α+β) +bL1cos(θ2+ 2α+β) +bL2
×cos(3α+β) +bL1cos(θ2+ 3α+β) +bL2cos(4α+β) +bL1cos(θ2+ 4α+β) +bL2
×cos(5α+β) +bL1cos(θ2+ 5α+β) +bL2cos(6α+β) +bL1cos(θ2+ 6α+β) +bL2
×cos(7α+β) +bL1cos(θ2+ 7α+β))
M34 = 7b2m+L22(14m+mH) +L1L2(7m+mH) cosθ2−m(−2bL2cosθ3 + 2L22cosα+ 2L22
×cos 2α+ 2L22cos 3α+ 2L22cos 4α+ 2L22cos 5α+ 2L22cos 6α+ 2L22cos 7α+L1L2
×cos(θ2+α) + 2bL2cos(θ3+α) +bL1cos(θ2+θ3+α) +L1L2cos(θ2+ 2α) +L1L2
×cos(θ2+ 3α) +L1L2cos(θ2+ 4α) +L1L2cos(θ2+ 5α) +L1L2cos(θ2+ 6α) +L1L2
×cos(θ2+ 7α)−12bL2cosβ+ 2bL2cos(2α+β) +bL1cos(θ2+ 2α+β) + 2bL2cos(3α +β) +bL1cos(θ2+ 3α+β) + 2bL2cos(4α+β) +bL1cos(θ2+ 4α+β) + 2bL2cos(5α +β) +bL1cos(θ2+ 5α+β) + 2bL2cos(6α+β) +bL1cos(θ2+ 6α+β) + 2bL2cos(7α +β) +bL1cos(θ2+ 7α+β))
M35 = bm(b+L2cosθ3−L2cos(θ3+α)−L1cos(θ2+θ3+α))
M44 = 7b2m+L22(14m+mH)−2L2m(L2(cosα+ cos 2α+ cos 3α+ cos 4α+ cos 5α+ cos 6α + cos 7α) +b(−cosθ3+ cos(θ3+α)−6 cosβ))−4bL2m(cos(α/2) + cos(3α/2)
+ cos(5α/2)) cos(9α/2 +β) M45 = bm(b+L2cosθ3−L2cos(θ3+α)) M55 = b2m
h(q,q)˙ についても,
h(q,q) =˙
h1 h2 h3
h4 h5
(A.2)
とおいたとき,各項の詳細は以下通りである.
h1 = −θ˙21(am+L1(7m+mH)) sinθ1−( ˙θ1+ ˙θ2)2L2(7m+mH) sin(θ1 +θ2) +m(( ˙θ1+ ˙θ2)2
×L2sin(θ1+θ2+α) +b( ˙θ1+ ˙θ2+ ˙θ3)2sin(θ1+θ2+θ3 +α) + 2( ˙θ1+ ˙θ2)2
×(cos(α/2) + cos(3α/2) + cos(5α/2))(L2sin(θ1+θ2+ 9α/2) +bsin(θ1 +θ2+ 9α/2 +β)) h2 = 8gm+gmH −θ˙12(am+L1(7m+mH)) cosθ1−( ˙θ1+ ˙θ2)2L2(7m+mH) cos(θ1+θ2)
+m(( ˙θ1+ ˙θ2)2L2cos(θ1+θ2+α) +b( ˙θ1+ ˙θ2+ ˙θ3)2cos(θ1+θ2+θ3+α) + 2( ˙θ1 + ˙θ2)2
×(cos(α/2) + cos(3α/2) + cos(5α/2))(L2cos(θ1+θ2+ 9α/2) +bcos(θ1+θ2+ 9α/2 +β)) h3 = −θ˙2(2 ˙θ1+ ˙θ2)L1L2(7m+mH) sinθ2−gmH(L1sinθ1 +L2sin(θ1+θ2)) +m(−bθ˙3(2( ˙θ1
+ ˙θ2) + ˙θ3)L2sinθ3+ ˙θ2(2 ˙θ1+ ˙θ2)L1L2sin(θ2+α) + 2bθ˙1θ˙3L2sin(θ3+α) +2bθ˙2θ˙3L2sin(θ3+α) +bθ˙23L2sin(θ3+α) + 2bθ˙1θ˙2L1sin(θ2+θ3+α) +bθ˙22L1sin(θ2+θ3+α) + 2bθ˙1θ˙3L1sin(θ2+θ3+α) + 2bθ˙2θ˙3L1sin(θ2
+θ3+α) +bθ˙23L1sin(θ2+θ3+α) + 2 ˙θ1θ˙2L1L2sin(θ2+ 2α) + ˙θ22L1L2sin(θ2+ 2α) +2 ˙θ1θ˙2L1L2sin(θ2 + 3α) + ˙θ22L1L2sin(θ2+ 3α) + 2 ˙θ1θ˙2L1L2sin(θ2+ 4α)
+ ˙θ22L1L2sin(θ2+ 4α) + 2bθ˙2(2 ˙θ1 + ˙θ2)L1(cos(α/2) + cos(3α/2) + cos(5α/2)) cosβsin(θ2 +9α/2) + 2 ˙θ1θ˙2L1L2sin(θ2+ 5α) + ˙θ22L1L2sin(θ2+ 5α) + 2 ˙θ1θ˙2L1L2sin(θ2 + 6α)
+ ˙θ22L1L2sin(θ2+ 6α) + 2 ˙θ1θ˙2L1L2sin(θ2+ 7α) + ˙θ22L1L2sin(θ2+ 7α) + 2bθ˙2(2 ˙θ1+ ˙θ2)
×L1(cos(α/2) + cos(3α/2) + cos(5α/2) cos(θ2+ 9α/2) sinβ) +gm(−(a+ 7L1) sinθ1
−7L2sin(θ1+θ2) +L2(1 + 2 cosα+ 2 cos 2α+ 2 cos 3α) sin(θ1+θ2+ 4α) +b(sin(θ1 +θ2+θ3+α) + 2(cos(α/2) + cos(3α/2) + cos(5α/2)) sin(θ1+θ2+ 9α/2 +β))) h4 = ˙θ21L1L2(7m+mH) sinθ2−gL2mHsin(θ1+θ2) +m(−b(−θ˙3(2( ˙θ1+ ˙θ2) + ˙θ3)L2(−1
+ cosα) + ˙θ21L1cos(θ2+α)) sinθ3+bcosθ3( ˙θ3(2( ˙θ1+ ˙θ2) + ˙θ3)L2sinα−θ˙21L1sin(θ2+α)) + ˙θ21L1(−L2(1 + 2 cosα+ 2 cos 2α+ 2 cos 3α) sin(θ2+ 4α)−2b(cos(α/2) + cos(3α/2) + cos(5α/2)) sin(θ2+ 9α/2 +β))) +gm(−7L2sin(θ1+θ2) +bsin(θ1+θ2+θ3+α) +L2(1 +2 cosα+ 2 cos 2α+ 2 cos 3α) sin(θ1+θ2+ 4α) + 2b(cos(α/2) + cos(3α/2) + cos(5α/2)) sin(θ1+θ2+ 9α/2 +β))
h5 = bm(( ˙θ1 + ˙θ2)2L2(sinθ3−sin(θ3+α))−θ˙12L1sin(θ2+θ3 +α) +gsin(θ1+θ2 +θ3+α))
次に,第3章式(3.1)における行列M(q),h(q,q)˙ の詳細な項について述べる.
M(q)について,
M(q) =
M11 M12 M13 M14 M15 M16 M22 M23 M24 M25 M26 M33 M34 M35 M36 M44 M45 M46 M55 M56
Sym. M66
(A.3)
とおいたとき,各項の詳細は以下通りである.
M11 = 2(m1+m2) +mH M12 = 0
M13 = (a1m1+L1(m1+ 2m2+mH)) cosθ1
M14 = (a2m2+L2(m1+m2+mH)) cosθ2 M15 =−(L2m1+b2m2) cosθ3
M16 =−b1m1cosθ4 M21 = 0
M22 = 2(m1+m2) +mH
M23 =−(a1m1+L1(m1+ 2m2+mH)) sinθ1
M24 =−(a2m2+L2(m1+m2+mH)) sinθ2 M25 = (L2m1+b2m2) sinθ3
M26 =b1m1sinθ4
M33 =a21m1+L21(m1+ 2m2+mH)
M34 =L1(a2m2+L2(m1+m2+mH)) cos(θ1−θ2) M35 =−L1(L2m1+b2m2) cos(θ1−θ3)
M36 =−b1L1m1cos(θ1−θ4) M44 =a22m2+L22(m1+m2+mH) M45 =−L2(L2m1+b2m2) cos(θ2−θ3) M46 =−b1L2m1cos(θ2−θ4)
M55 =L22m1+b22m2 M56 =b1L2m1cos(θ3−θ4) M66 =b21m1
h(q,q)˙ についても,
h(q,q) =˙
h1
h2
h3 h4
h5
h6
(A.4)
とおいたとき,各項の詳細は以下通りである.
h1 = −θ˙12(a1m1+L1(m1+ 2m2+mH)) sinθ1−θ˙22(a2m2+L2(m1+m2+mH)) sinθ2 + ˙θ32(L2m1+b2m2) sinθ3+b1θ˙24m1sinθ4
h2 = g(2(m1+m2) +mH)−θ˙21(a1m1+L1(m1+ 2m2+mH)) cosθ1−θ˙22(a2m2 +L2(m1+m2+mH)) cosθ2+ ˙θ23(L2m1+b2m2) cosθ3+b1θ˙42m1cosθ4
h3 = −g(a1m1+L1(m1+ 2m2+mH)) sinθ1+L1( ˙θ22(a2m2+L2(m1+m2+mH))
×sin(θ1−θ2)−θ˙32(L2m1+b2m2) sin(θ1−θ3)−b1θ˙24m1sin(θ1−θ4))
h4 = −θ˙12L1(a2m2+L2(m1+m2+mH)) sin(θ1−θ2)−g(a2m2+L2(m1+m2+mH)) sinθ2−L2( ˙θ23(L2m1+b2m2) sin(θ2−θ3) +b1θ˙24m1sin(θ2−θ4))
h5 = (L2m1+b2m2)( ˙θ21L1sin(θ1−θ3) + ˙θ22L2sin(θ2−θ3) +gsinθ3) +b1θ˙42L2m1
×sin(θ3−θ4)
h6 = b1m1( ˙θ12L1sin(θ1−θ4) + ˙θ22L2sin(θ2−θ4)−θ˙32L2sin(θ3−θ4) +gsinθ4)
最後に,第4章式(4.1)における行列M(q),h(q,q)˙ の詳細な項について述べる.
M(q)について,
M(q) =
M11 M12 M13 M14 M15 M16 M17 M22 M23 M24 M25 M26 M27
M33 M34 M35 M36 M37
M44 M45 M46 M47 M55 M56 M57
M66 M67
Sym. M77
(A.5)
とおいたとき,各項の詳細は以下通りである.
M11 = 2m1+ 2m2+mt+mH
M12 = 0
M13 = (a1m1+L1(m1+ 2m2+mt+mH)) cosθ1 M14 = (a2m2+L2(m1+m2+mt+mH)) cosθ2 M15 = −(L2m1+b2m2) cosθ3
M16 = −b1m1cosθ4
M17 = Ltmtcosθ5
M22 = 2m1+ 2m2+mt+mH
M23 = −(a1m1+L1(m1+ 2m2+mt+mH)) sinθ1 M24 = −(a2m2+L2(m1+m2+mt+mH)) sinθ2
M25 = (L2m1+b2m2) sinθ3
M26 = b1m1sinθ4
M27 = −Ltmtsinθ5
M33 = a21m1+L21(m1+ 2m2+mt+mH)
M34 = L1(a2m2+L2(m1+m2+mt+mH)) cos(θ1−θ2) M35 = −L1(L2m1+b2m2) cos(θ1−θ3)