• 検索結果がありません。

第 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(θ12+θ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θ3sin(θ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)

関連したドキュメント