JP6903229B2 - 回転接続機構、ロボットおよびロボットアーム - Google Patents

回転接続機構、ロボットおよびロボットアーム Download PDF

Info

Publication number
JP6903229B2
JP6903229B2 JP2020515536A JP2020515536A JP6903229B2 JP 6903229 B2 JP6903229 B2 JP 6903229B2 JP 2020515536 A JP2020515536 A JP 2020515536A JP 2020515536 A JP2020515536 A JP 2020515536A JP 6903229 B2 JP6903229 B2 JP 6903229B2
Authority
JP
Japan
Prior art keywords
link
freedom
rotation
degrees
joint
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2020515536A
Other languages
English (en)
Other versions
JPWO2019208652A1 (ja
Inventor
昇 川口
昇 川口
友哉 服部
友哉 服部
正樹 春名
正樹 春名
光史 廣瀬
光史 廣瀬
賢 上田
賢 上田
新吾 木村
新吾 木村
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Mitsubishi Electric Corp
Original Assignee
Mitsubishi Electric Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Mitsubishi Electric Corp filed Critical Mitsubishi Electric Corp
Publication of JPWO2019208652A1 publication Critical patent/JPWO2019208652A1/ja
Application granted granted Critical
Publication of JP6903229B2 publication Critical patent/JP6903229B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00—Manipulators not otherwise provided for
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J15/00—Gripping heads and other end effectors
    • B25J15/0009—Gripping heads and other end effectors comprising multi-articulated fingers, e.g. resembling a human hand
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J17/00—Joints
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/003—Programme-controlled manipulators having parallel kinematics
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D57/00—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
    • B62D57/02—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
    • B62D57/032—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members with alternately or sequentially lifted supporting base and legs; with alternately or sequentially lifted feet or skid
    • F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
    • F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
    • F15B2211/00—Circuits for servomotor systems
    • F15B2211/70—Output members, e.g. hydraulic motors or cylinders or control therefor
    • F15B2211/705—Output members, e.g. hydraulic motors or cylinders or control therefor characterised by the type of output members or actuators
    • F15B2211/7051—Linear output members
    • F15B2211/7053—Double-acting output members
    • F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16—ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16H—GEARING
    • F16H25/00—Gearings comprising primarily only cams, cam-followers and screw-and-nut mechanisms
    • F16H25/18—Gearings comprising primarily only cams, cam-followers and screw-and-nut mechanisms for conveying or interconverting oscillating or reciprocating motions
    • F16H25/20—Screw mechanisms
    • F16H2025/2062—Arrangements for driving the actuator
    • F16H2025/2081—Parallel arrangement of drive motor to screw axis
    • F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16—ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16H—GEARING
    • F16H25/00—Gearings comprising primarily only cams, cam-followers and screw-and-nut mechanisms
    • F16H25/18—Gearings comprising primarily only cams, cam-followers and screw-and-nut mechanisms for conveying or interconverting oscillating or reciprocating motions
    • F16H25/20—Screw mechanisms
    • F16H25/24—Elements essential to such mechanisms, e.g. screws, nuts
    • F16H25/2454—Brakes; Rotational locks

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Robotics (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Transportation (AREA)
  • Manipulator (AREA)
  • Transmission Devices (AREA)

Description

本発明は、人に近い動きができるロボットが有する関節部に使用される回転接続機構およびこれを使用したロボット、ロボットアームおよびロボットハンドに関する。
人と同様に、胴体、両腕、両脚、頭を有する人型ロボットが開発されている。従来の人型ロボットでは、関節部にモータとギヤを配置し、その軸上に関節交点を配置しているタイプが一般的である。そのような人型ロボットでは、回転自由度の分だけ関節にギヤを配置する必要があり、関節が大きくなる。関節で骨格を接続し、関節ごとに２本のアクチュエータによるリンクの伸縮により２回転自由度で関節を駆動する２足歩行ロボットが提案されている（特許文献１）。２個のアクチュエータによるリンクの伸縮により２回転自由度で関節を駆動し、さらに１個の回転アクチュエータを付加した、３回転自由度でロボットの足首、手首、首を駆動するロボットが提案されている（特許文献２）。また、固定側部材に設けられた３自由度の軸受けに一端が接続され他端が可動側部材に接続する１本の固定長リンクと、固定側部材に３回転自由度の軸受けで一端が接続され他端が可動側部材に３自由度の軸受けで接続される３本の可変長リンクを有するパラレルリンク機構が提案されている（特許文献３）。
人型ロボットが有する手部またはロボットハンドに使用できる密閉型のウォームギヤ式指関節ユニットが提案されている（特許文献４）。特許文献４で示されている密閉型のウォームギヤ式指関節ユニットは、１個の関節軸を有するものである。複数の指関節部を有する指部にウォームギヤ機構を適用することに関しては、何も開示されていない。
特開２００４−２０２６７６号 特表２０１１−５２７６４１号 特開２００３−１７２４１８号 国際公開第２００７／０７７６９８号
アクチュエータを使用することで、関節部をコンパクトにできる。しかし、関節部が２回転自由度だと、例えば手首部で捻りを伴う動作ができない。捻りを伴う動作ができないと、人に近い動作ができない場合がある。
特許文献２の３回転自由度関節は、構造が複雑である。また、人間と相似な形状とすることを目的とするため、足首部、手首部を太くすることができず、支点である関節と作用点であるリンクの接続点の間隔が狭くなる。そのため、ロボットが出せる力が十分でない場合があると考えられる。
特許文献３のパラレルリンク機構は、３本の可変長リンクの両端に２回転自由度の接続部を設ける必要がある。可動部材５は、連結棒４と３本の伸縮機構７との合計４点でベース部材１と接続している。つまり、特許文献３のパラレルリンク機構では、可動部材５の４点の３次元空間での位置が決められている。空間中の平面は３点で決まるので、４点の位置が決められる特許文献３のパラレルリンク機構では４点への荷重の配分や位置決めの制御が難しい。
ロボットを実用化するにあたっては、従来と同様に人に近い動きができる動作が可能なロボットでありながら、できるだけ低コストで製造できるような技術も必要である。２回転自由度以上の接続部は１回転自由度の接続部と比較して高価である。２回転自由度の関節部では、２回転自由度以上を有する接続部の個数を減らし、３回転自由度の関節部では３点支持にして制御をより容易にすることが望まれている。
この発明は上記の問題点を解決するためになされたものであり、従来よりも低コストな回転接続機構を得ることを目的とする。
この発明に係る回転接続機構は、第１部材に第２部材を少なくとも２回転自由度を有して回転可能に接続する関節部と、第１アクチュエータと、第２アクチュエータとを備えたものである。第１アクチュエータは、４回転自由度または５回転自由度を有する第１リンク、関節部に対する相対的な位置関係が固定されて第２部材に設けられて第１リンクの一端が少なくとも２回転自由度を有して回転可能に取付けられる第２部材第１取付部、第１リンクの他端が少なくとも２回転自由度を有して回転可能に取付けられる第１部材第１取付部、関節部に対する相対的な位置関係が固定されて第１部材に設けられた第１基準点と第２部材第１取付部との距離を変更する力を発生させる第１動力源を有する。第２アクチュエータは、３回転自由度または４回転自由度または５回転自由度を有する第２リンク、第２部材第１取付部に対する相対的な位置関係が固定されて第１リンクに設けられて第２リンクの一端が少なくとも１回転自由度を有して回転可能に取付けられる第１リンク第２取付部、第２リンクの他端が少なくとも２回転自由度を有して回転可能に取付けられる第１部材第２取付部、関節部に対する相対的な位置関係が固定されて第１部材に設けられた第２基準点と第１リンク第２取付部との距離を変更する力を発生させる第２動力源を有する。
また、第１部材に第２部材を少なくとも２回転自由度を有して回転可能に接続する関節部と、第１アクチュエータと、第２アクチュエータとを備えたものである。第１アクチュエータは、４回転自由度または５回転自由度を有する長さが変更可能な第１リンク、関節部に対する相対的な位置関係が固定されて第２部材に設けられて第１リンクの一端が少なくとも２回転自由度を有して回転可能に取付けられる第２部材第１取付部、関節部に対する相対的な位置関係が固定されて第１部材に設けられて第１リンクの他端が少なくとも２回転自由度を有して回転可能に取付けられる第１部材第１取付部、第１リンクの長さを変更する力を発生させる第１動力源を有する。第２アクチュエータは、３回転自由度または４回転自由度または５回転自由度を有する長さが変更可能な第２リンク、第２部材第１取付部に対する相対的な位置関係が固定されて第１リンクに設けられて第２リンクの一端が少なくとも１回転自由度を有して回転可能に取付けられる第１リンク第２取付部、関節部に対する相対的な位置関係が固定されて第１部材に設けられて第２リンクの他端が少なくとも２回転自由度を有して回転可能に取付けられる第１部材第２取付部、第２リンクの長さを変更する力を発生させる第２動力源を有する。
また、第１部材に第２部材を少なくとも２回転自由度を有して回転可能に接続する関節部と、第１アクチュエータと、第２アクチュエータとを備えたものである。第１アクチュエータは、５回転自由度を有する長さが固定された第１リンク、関節部に対する相対的な位置関係が固定されて第２部材に設けられて第１リンクの一端が少なくとも２回転自由度を有して回転可能に取付けられる第２部材第１取付部、第１リンクの他端が少なくとも２回転自由度を有して回転可能に取付けられる第１部材第１取付部、第１部材第１取付部が設けられた第１移動部材、第１移動軸を有して第１移動部材を第１移動軸に沿って移動するようにガイドする、関節部に対する相対的な位置関係が固定されて第１部材に設けられた第１ガイド部、第１ガイド部に対する第１移動部材の位置を変更させる力を発生させる第１動力源を有する。第２アクチュエータは、５回転自由度を有する長さが固定された第２リンク、第２部材第１取付部に対する相対的な位置関係が固定されて第１リンクに設けられて第２リンクの一端が少なくとも２回転自由度を有して回転可能に取付けられる第１リンク第２取付部、第２リンクの他端が少なくとも２回転自由度を有して回転可能に取付けられる第１部材第２取付部、第１部材第２取付部が設けられた第２移動部材、第２移動軸を有して第２移動部材を第２移動軸に沿って移動するようにガイドする、関節部に対する相対的な位置関係が固定されて第１部材に設けられた第２ガイド部、第２ガイド部に対する第２移動部材の位置を変更させる力を発生させる第２動力源を有する。
この発明に係るロボットハンドは、基部と、基部から直列に接続した第１指節部、第２指節部および第３指節部と、基部が存在する側に存在する部材である基部側部材に第１指節部、第２指節部および第３指節部の何れかである先端側部材を回転可能に接続する３個の指関節部とを有する少なくとも３本の指部とを備える。基部に第１指節部を回転可能に接続する指関節部である第１指関節部および第１指節部に第２指節部を回転可能に接続する指関節部である第２指関節部は、基部側部材に配置されたモータ、モータにより回転するウォーム、ウォームとかみ合い先端側部材と共に指関節部の回転軸の回りを回転するウォームホイールを有するウォームギヤ機構により先端側部材を基部側部材に対して回転させる。
この発明によれば、従来よりも低コストな回転接続機構を得ることができる。
この発明の実施の形態１に係る人型ロボットの斜視図である。 実施の形態１に係る人型ロボットの正面図である。 実施の形態１に係る人型ロボットの左側面図である。 実施の形態１に係る人型ロボットの背面図である。 実施の形態１に係る人型ロボットの上から見た平面図である。 実施の形態１に係る人型ロボットの骨格構造を説明する斜視図である。 実施の形態１に係る人型ロボットの骨格構造を説明する正面図である。 実施の形態１に係る人型ロボットの骨格構造を説明する左側面図である。 実施の形態１に係る人型ロボットの骨格構造を説明する背面図である。 実施の形態１に係る人型ロボットの骨格構造を説明する上から見た平面図である。 実施の形態１に係る人型ロボットの骨格構造での上半身を左の手部側の斜め前から見た斜視図である。 実施の形態１に係る人型ロボットの骨格構造での上半身を右の手部側の斜め後から見上げる斜視図である。 実施の形態１に係る人型ロボットの骨格構造での上半身を右の手部側の斜め後から見下ろす斜視図である。 実施の形態１に係る人型ロボットの骨格構造での体幹部を拡大した正面図である。 実施の形態１に係る人型ロボットの骨格構造での体幹部を拡大した背面図である。 実施の形態１に係る人型ロボットが有する胸上部の正面図である。 実施の形態１に係る人型ロボットが有する胸上部の左側面図である。 実施の形態１に係る人型ロボットが有する胸上部の背面図である。 実施の形態１に係る人型ロボットが有する胸上部の上から見た平面図である。 実施の形態１に係る人型ロボットが有する胸上部の下から見た平面図である。 実施の形態１に係る人型ロボットの骨格構造での腰部から下の部分を上から見た平面図である。 実施の形態１に係る人型ロボットが有する体幹部を左の手部側の斜め前から見た斜視図である。 実施の形態１に係る人型ロボットが有する体幹部を左の手部側の斜め後から見た斜視図である。 実施の形態１に係る人型ロボットの上肢部が無い状態での体幹部の左側面図である。 実施の形態１に係る人型ロボットで使用されるアクチュエータが有する可変長リンクの構造を説明する断面図である。 実施の形態１に係る人型ロボットにおいて胸上部と胸下部の区分と胸部を動かす可変長リンクの配置を説明する側面から見た模式図である。 実施の形態１に係る人型ロボットにおいて胸上部と胸下部の区分と胸部を動かす可変長リンクの配置を説明する正面から見た模式図である。 実施の形態１に係る人型ロボットが有する胴体屈曲部での可変長リンクの配置を左の手部側の斜め後から見た斜視図である。 実施の形態１に係る人型ロボットが有する胴体屈曲部の基準状態での可変長リンクの配置を背骨部が延在する方向から見た図である。 実施の形態１に係る人型ロボットが有する３回転自由度接続機構で、捻り軸と可変長リンクの位置関係により可変長リンクの伸縮が捻り軸の回りに回転させるトルクが発生するかどうかを説明する図である。 実施の形態１に係る人型ロボットが有する胴体屈曲部の胸部を回転させて前方に傾けた状態での可変長リンクの配置を背骨部が延在する方向から見た図である。 実施の形態１に係る人型ロボットの頭部を拡大した側面図である。 実施の形態１に係る人型ロボットの頭部を拡大した斜視図である。 実施の形態１に係る人型ロボットが有する首部での可変長リンクの配置を説明する斜視図である。 実施の形態１に係る人型ロボットが有する首部の基準状態での可変長リンクの配置を首部中心棒が延在する方向から見た図である。 実施の形態１に係る人型ロボットが有する首部の頭部を回転させて前方に傾けた状態での可変長リンクの配置を首部中心棒が延在する方向から見た図である。 実施の形態１に係る人型ロボットの上半身の斜視図である。 実施の形態１に係る人型ロボットが有する左の肩関節部での可変長リンクの配置を説明する斜視図である。 実施の形態１に係る人型ロボットの左の上肢部の正面図である。 実施の形態１に係る人型ロボットの左の上肢部の側面図である。 実施の形態１に係る人型ロボットの左の上肢部の肘関節部までの部分を拡大した正面図である。 実施の形態１に係る人型ロボットの左の上肢部の肘関節部までの部分を拡大した側面図である。 実施の形態１に係る人型ロボットが有する体幹部および上肢部で左右の肘関節部を９０度曲げた状態での正面図である。 実施の形態１に係る人型ロボットが有する体幹部および上肢部で左右の肘関節部を９０度曲げた状態での上から見た平面図である。 実施の形態１に係る人型ロボットが有する左の肘関節部のリンク配置を説明する斜視図である。 実施の形態１に係る人型ロボットの骨格構造での左の肘関節部から先の部分を拡大した斜視図である。 実施の形態１に係る人型ロボットの左の肘関節部から先の部分を拡大した正面図である。 実施の形態１に係る人型ロボットの左の肘関節部から先の部分を外側のアクチュエータを除いた状態で拡大した左側面図である。 実施の形態１に係る人型ロボットの左の肘関節部から先の部分を拡大した裏面図である。 実施の形態１に係る人型ロボットが有する左の手首部での可変長リンクの配置を説明する斜視図である。 実施の形態１に係る人型ロボットが有する左の手首部の基準状態での可変長リンクの配置を前腕部が延在する方向から見た図である。 実施の形態１に係る人型ロボットが有する左の手首部を第４指部側に傾けた状態での可変長リンクの配置を前腕部が延在する方向から見た図である。 実施の形態１に係る人型ロボットの骨格構造での腰部から下の部分の正面図である。 実施の形態１に係る人型ロボットの骨格構造での腰部から下の部分の左側面図である。 実施の形態１に係る人型ロボットの骨格構造での腰部から下の部分の背面図である。 実施の形態１に係る人型ロボットの骨格構造での膝関節部から下の部分の斜視図である。 実施の形態１に係る人型ロボットの大腿部を拡大した正面図である。 実施の形態１に係る人型ロボットの大腿部を拡大した左側面図である。 実施の形態１に係る人型ロボットの大腿部を拡大した背面図である。 実施の形態１に係る人型ロボットの大腿部を右斜め前から見た斜視図である。 実施の形態１に係る人型ロボットの大腿部を右斜め後から見た斜視図である。 実施の形態１に係る人型ロボットが有する左の股部での可変長リンクの配置を説明する斜視図である。 実施の形態１に係る人型ロボットが有する左の股部の基準状態での可変長リンクの配置を大腿骨部が延在する方向から見た図である。 実施の形態１に係る人型ロボットが有する左の股部の大腿部を左前方に上げた状態での可変長リンクの配置を大腿骨部が延在する方向から見た図である。 実施の形態１に係る人型ロボットが有する股関節部を動かす可変長リンクを正面側で高く裏面側で低く取付けることによる効果を説明する図である。 実施の形態１に係る人型ロボットが有する左の膝関節部を動かす可変長リンクの配置を説明する斜視図である。 実施の形態１に係る人型ロボットの膝関節部から下の部分を拡大した正面図である。 実施の形態１に係る人型ロボットの膝関節部から下の部分を拡大した左側面図である。 実施の形態１に係る人型ロボットの膝関節部から下の部分を拡大した背面図である。 実施の形態１に係る人型ロボットの下腿部から下の部分の斜視図である。 実施の形態１に係る人型ロボットが有する左の足首関節部を動かす可変長リンクの配置を説明する斜視図である。 実施の形態１に係る人型ロボットが有する左の手部を手の平側から見た斜視図である。 実施の形態１に係る人型ロボットが有する左の手部を手の甲側から見た斜視図である。 実施の形態１に係る人型ロボットが有する左の手部の正面図である。 実施の形態１に係る人型ロボットが有する左の手部を対向可能指部が存在する側から見た側面図である。 実施の形態１に係る人型ロボットが有する左の手部の裏面図である。 実施の形態１に係る人型ロボットが有する左の手部を対向可能指部が存在しない側から見た側面図である。 実施の形態１に係る人型ロボットが有する左の手部を指先側から見た図である。 実施の形態１に係る人型ロボットが有する左の手部の第２指部を断面で表示した図である。 実施の形態１に係る人型ロボットが有する胸部内関節部と胸腰部接続関節部での関節部およびリンク取付部の間隔を表現する変数を説明する図である。 実施の形態１に係る人型ロボットが有する肩関節部での関節部およびリンク取付部の間隔を表現する変数を説明する図である。 実施の形態１に係る人型ロボットが有する肘関節部での関節部およびリンク取付部の間隔を表現する変数を説明する図である。 実施の形態１に係る人型ロボットが有する手首関節部での関節部およびリンク取付部の間隔を表現する変数を説明する図である。 実施の形態１に係る人型ロボットが有する足首関節部での関節部およびリンク取付部の間隔を表現する変数を説明する図である。 実施の形態１に係る人型ロボットが有する股関節部での関節部およびリンク取付部の間隔を表現する変数を説明する図である。 この発明の実施の形態２に係る人型ロボットが有するアクチュエータが有する可変長リンクの構造を説明する断面図である。 この発明の実施の形態３に係る人型ロボットが有する左の手部を手の甲側から見た斜視図である。 実施の形態３に係る人型ロボットが有する左の手部を手の平側から見た斜視図である。 実施の形態３に係る人型ロボットが有する左の手部の正面図である。 実施の形態３に係る人型ロボットが有する左の手部を第１指部が存在する側から見た側面図である。 実施の形態３に係る人型ロボットが有する左の手部の背面図である。 実施の形態３に係る人型ロボットが有する左の手部を指先側から見た側面図である。 実施の形態３に係る人型ロボットが有する左の手部を手首側から見た側面図である。 実施の形態３に係る人型ロボットが有する左の手部の対向指部を曲げた状態で第１指部が存在する側から見た側面図である。 実施の形態３に係る人型ロボットが有する左の手部の掌板部の平面図である。 実施の形態３に係る人型ロボットが有する左の手部の対向指部の第２指節部付近を拡大した斜視図である。 この発明の実施の形態４に係る人型ロボットが有する左の手部を手幅回転指部が伸びた状態で手の甲側から見た斜視図である。 実施の形態４に係る人型ロボットが有する左の手部を手幅回転指部が掌板部と交差する方向を向いた状態で手の甲側から見た斜視図である。 実施の形態４に係る人型ロボットが有する左の手部を手幅回転指部が伸びた状態での正面図である。 実施の形態４に係る人型ロボットが有する左の手部を手幅回転指部が伸びた状態での第１指部が存在する側から見た側面図である。 実施の形態４に係る人型ロボットが有する左の手部を手幅回転指部が伸びた状態での背面図である。 実施の形態４に係る人型ロボットが有する左の手部を手幅回転指部が伸びた状態での第４指部が存在する側から見た側面図である。 実施の形態４に係る人型ロボットが有する左の手部を手幅回転指部が伸びた状態での指先側から見た側面図である。 実施の形態４に係る人型ロボットが有する左の手部を手幅回転指部が掌板部と交差する方向を向いた状態での正面図である。 実施の形態４に係る人型ロボットが有する左の手部を手幅回転指部が掌板部と交差する方向を向いた状態での第１指部が存在する側から見た側面図である。 実施の形態４に係る人型ロボットが有する左の手部を手幅回転指部が掌板部と交差する方向を向いた状態での裏面図である。 実施の形態４に係る人型ロボットが有する左の手部を手幅回転指部が掌板部と交差する方向を向いた状態での第４指部が存在する側から見た側面図である。 実施の形態４に係る人型ロボットが有する左の手部を手幅回転指部が掌板部と交差する方向を向いた状態での指先側から見た側面図である。 実施の形態４に係る人型ロボットが有する左の手部を手幅回転指部が伸びた状態で手の甲側から見た手幅回転指を拡大した斜視図である。 実施の形態４に係る人型ロボットが有する左の手部を手幅回転指部が掌板部と交差する方向を向いた状態で手の甲側から見た手幅回転指を拡大した斜視図である。 この発明の実施形態５に係る人型上半身ロボットの全体斜視図である。 実施形態５に係る人型上半身ロボットの全体正面図である。 実施形態５に係る人型上半身ロボットの全体左側面図である。 実施形態５に係る人型上半身ロボットを前方から見た斜視図である。 実施形態５に係る人型上半身ロボットを左腕側から見た斜視図である。 実施形態５に係る人型上半身ロボットを背面から見た斜視図である。 実施形態５に係る人型上半身ロボットの正面図である。 実施形態５に係る人型上半身ロボットの平面図である。 実施形態５に係る人型上半身ロボットの底面図である。 実施形態５に係る人型上半身ロボットが有する胴体屈曲部の斜視図である。 実施形態５に係る人型上半身ロボットが有する胴体屈曲部の正面図である。 実施形態５に係る人型上半身ロボットが有する胴体屈曲部の左側面図である。 実施形態５に係る人型上半身ロボットが有する胴体屈曲部の右側面図である。 実施形態５に係る人型上半身ロボットが有する胴体屈曲部のリンク配置を示す斜視図である。 実施形態５に係る人型上半身ロボットが有する胴体屈曲部の基準状態でのリンク配置を背骨部が延在する方向から見た図である。 実施形態５に係る人型上半身ロボットが有する胴体屈曲部の基準状態でのリンク配置を評価する変数を示す図である。 実施形態５に係る人型上半身ロボットが有する肩部の正面図である。 実施形態５に係る人型上半身ロボットが有する肩部の平面図である。 実施形態５に係る人型上半身ロボットが有する肩部の右側面図である。 実施形態５に係る人型上半身ロボットの左肩を下から見た図である。 実施形態５に係る人型上半身ロボットの左肩の斜視図である。 実施形態５に係る人型上半身ロボットの左肩の別の斜視図である。 実施形態５に係る人型上半身ロボットが有する肩部のリンク配置を説明する斜視図である。 実施形態５に係る人型上半身ロボットが有する肘部の斜視図である。 実施形態５に係る人型上半身ロボットが有する肘部の正面図である。 実施形態５に係る人型上半身ロボットが有する肘部の左側面図である。 実施形態５に係る人型上半身ロボットが有する肘部のリンク配置を説明する斜視図である。 実施形態５に係る人型上半身ロボットが有する手首部の斜視図である。 実施形態５に係る人型上半身ロボットが有する手首部の別の斜視図である。 実施形態５に係る人型上半身ロボットが有する手首部の正面図である。 実施形態５に係る人型上半身ロボットが有する手首部の右側面図である。 実施形態５に係る人型上半身ロボットが有する手首部のリンク配置を説明する斜視図である。 実施形態５に係る人型上半身ロボットが有する手首部の基準状態でのリンク配置を前腕部が延在する方向から見た図である。 実施形態５に係る人型上半身ロボットが有する手首部の基準状態でのリンク配置を評価する変数を示す図である。 実施形態５に係る人型上半身ロボットが有する手部を手首部を含めて手の甲側から見た図である。 実施形態５に係る人型上半身ロボットが有する手部を手首部を含めて側面から見た図である。 実施形態５に係る人型上半身ロボットが有する手部を手の甲側から見た図である。 実施形態５に係る人型上半身ロボットが有する手部を手の平側から見た図である。 実施形態５に係る人型上半身ロボットが有する手部を側面から見た図である。 実施形態５に係る人型上半身ロボットが有する２方向回転指を指元の軸回りに回転させる指元部の斜視図である。 実施形態５に係る人型上半身ロボットが有する２方向回転指を指元の軸回りに回転させる指元部の別の斜視図である。 実施形態５に係る人型上半身ロボットが有する手部の親指のリンク配置を説明する図である。 実施形態５に係る人型上半身ロボットが有する胴体屈曲部での関節部とリンク取付部の位置を表現する変数を説明する図である。 実施形態５に係る人型上半身ロボットが有する胴体屈曲部でリンクの長さを決めることで位置が固定される点を示す図である。 比較例として実施形態１に係る人型ロボットが有する胴体屈曲部でリンクの長さを決めることで位置が固定される点を示す図である。 この発明の実施形態６に係る人型上半身ロボットの正面図である。 実施形態６に係る人型上半身ロボットが有する胴体屈曲部のリンク配置を示す斜視図である。 実施形態６に係る人型上半身ロボットが有する胴体屈曲部でリンクの長さを決めることで位置が固定される点を示す図である。
実施の形態１．
図１は、この発明の実施の形態１に係る人型ロボット１００の斜視図である。人型ロボット１００の正面図、左側面図、背面図および平面図を、それぞれ図２、図３、図４および図５に示す。人型ロボット１００の骨格構造を説明する斜視図を図６に示す。人型ロボット１００を骨格だけにした場合の正面図、左側面図、背面図および平面図を、それぞれ図７、図８、図９および図１０に示す。人型ロボット１００の左右方向の軸をＸ軸とし、前後方向の軸をＹ軸とし、高さ方向の軸をＺ軸とする。右から左への向きをＸ軸の正の向きとし、前から後への向きをＹ軸の正の向きとし、下から上への向きをＺ軸の正の向きとする。
図１から図５に示す、人型ロボット１００が直立し両腕を下ろした姿勢を基準状態と呼ぶ。基準状態は、人型ロボット１００が使用される際によく取る姿勢である。基準状態は直立した姿勢でなくてもよい。さまざまな動作の起点となるような姿勢が、基準状態であることが望ましい。
人型ロボット１００は、人の体に似た構造を有する。人型ロボット１００は、体幹部１、体幹部１の上側中央に接続する頭部２、体幹部１の上部の左右から出る一対の上肢部３、体幹部１の下部から出る左右一対の下肢部４を有する。体幹部１は、上側の胸部５と下側の腰部６に分けられる。上肢部３は、上腕部７、前腕部８および手部９が直列に接続する。下肢部４は、腰部６から順に、大腿部１０、下腿部１１および足部１２が直列に接続する。左右一対の上肢部３は、右の上肢部３と左の上肢部３とが鏡像の関係となる構造を有する。左右一対の下肢部４についても同様に鏡像の関係が成立する。左右の上肢部３は、鏡像の関係にならない部分があってもよい。左右の下肢部４も、鏡像の関係にならない部分があってもよい。
人型ロボット１００では、骨格を回転可能に接続する各関節部は、筋肉に相当するアクチュエータが有する長さが変更可能なリンク（可変長リンク）が長さを変えることにより動かされる。各関節部を動かす可変長リンクの数は、その関節部で必要な回転自由度の次数と同数である。可変長リンクは、その可動範囲内で長さを変更でき、可動範囲内の任意の長さを維持することができる。アクチュエータは、可変長リンクの長さを変更する力を発生させる動力源であるモータも有する。符合ＸＸのアクチュエータＸＸが有するリンクの符合をＸＸＬとし、モータの符合をＸＸＭと表記する。図には、可変長リンクの符合ＸＸＬ、モータの符合ＸＸＭを表示する。アクチュエータの符合ＸＸは、原則として図には表示しない。
この明細書では、「リンク」とは、一端と他端を有して、一端が取付けられる点と他端が取付けられる点との間を結ぶ部材である。リンクの回転自由度は、一端および他端がそれぞれ取付けられる箇所での回転自由度と、リンク自体の回転自由度の和である。リンク自体の回転自由度に関して、リンクがねじれることが可能な場合に、リンクは１回転自由度を有する。リンクがねじれることができない場合は回転自由度を有しない、すなわち０回転自由度とする。リンクＡがリンクＢに取付けられる場合は、リンク取付部の回転自由度は、リンクＡの回転自由度に含まれ、リンクＢの回転自由度には含まれない。
「アクチュエータ」とは、リンクを有して、リンクの一端が接続する第２部材を、他端が接続する第１部材に対して移動させるものである。第１部材が固定側の部材である。第２部材が第１部材に対して移動する部材である。第２部材を移動させる方法としては、以下の２つがある。
（方法１）リンクの長さを変更する。
（方法２）長さが固定されたリンクの他端を移動させる。
アクチュエータは、リンク、リンクの一端および他端がそれぞれ取付けられるリンク取付部および動力源を含むものである。リンクの他端を移動させるアクチュエータの場合は、移動させるための部材もアクチュエータに含む。
これまでの人型ロボットの多くは、各関節部にモータとギヤを配置し、その軸上に関節交点を配置している。そのため、関節部に要するスペースが大きくなり、コンパクトな関節部を作りにくい。それに対して、人型ロボット１００では、関節部の近くにギヤを配置する必要が無いので、関節部をコンパクトにできる。また、関節部で接続される骨格と並行してリンクが存在するので、関節部だけの場合よりも関節部が大きな力に耐えることができる。各関節部に必要な次数の回転自由度を持たせているので、人型ロボット１００は、人の動きに近い動きをすることができる。人と同様な動作ができることは、例えば、人が入れない区域などで人の替わりに作業するロボットとしては必要な条件である。
人型ロボット１００の各関節部の自由度は、首部、手首部、股部、胸部５と腰部６の間は、前後左右に動かせ、捻りの動作もできる３回転自由度としている。肩部、肘部、足首部は前後左右に動かせる２回転自由度としている。膝部は、前後に動かせる１回転自由度としている。なお、肩部、足首部、肘部などを３回転自由度にしてもよい。
胸部５は、胸上部５Ｕと胸下部５Ｄとに分かれている。胸上部５Ｕには、上腕部７および頭部１が接続する。胸下部５Ｄは、腰部６に接続する。胸上部５Ｕは、１回転自由度で上下方向に胸下部５Ｄに対する角度を変更できる。胸部５は、胸上部５Ｕを胸下部５Ｄに１回転自由度を有して回転可能に接続する胸屈曲部Ｃ１（図２６に図示）を有する。
図１０から図２４を参照して、体幹部１の構造を説明する。図１１は、骨格構造での上半身を左の手部側の斜め前から見た斜視図である。図１２は、骨格構造での上半身を右の手部側の斜め後から見上げる斜視図である。図１３は、骨格構造での上半身を右の手部側の斜め後から見下ろす斜視図である。図１４は、骨格構造での体幹部１を拡大した正面図である。図１５は、骨格構造での体幹部１を拡大した背面図である。図１６から図１８は、胸上部５Ｕの正面図、左側面図、背面図である。図１９は、胸上部５Ｕを上から見た平面図である。図２０は、胸上部５Ｕを下から見た平面図である。図２１は、骨格構造での腰部６から下の部分を上から見た平面図である。図２２は、体幹部１を左の手部側の斜め前から見た斜視図である。図２３は、体幹部１を左の手部側の斜め後から見た斜視図である。図２４は、上肢部３が無い状態での体幹部１の左側面図である。
主に図１０から図２１を参照して、体幹部１を構成する骨格と、筋肉に相当するアクチュエータが有する可変長リンクが取付けられる箇所に関して説明する。胸部５は、肩部フレーム５１、胸郭部フレーム５２、胸郭部前後連結フレーム５３、胸部中央連結フレーム５４、胸部内関節部フレーム５５、背骨部５６、リンク取付用フレーム５７を有する。胸上部５Ｕは、肩部フレーム５１、胸郭部フレーム５２、胸郭部前後連結フレーム５３、胸部中央連結フレーム５４および胸部内関節部フレーム５５を有して構成される。胸下部５Ｄは、背骨部５６およびリンク取付用フレーム５７を有して構成される。胸部内関節部１６は、胸上部５Ｕと胸下部５Ｄとを上下方向に回転可能な１回転自由度で接続する。
肩部フレーム５１は、両肩に相当する位置を結ぶフレームである。胸郭部フレーム５２は、肩部フレーム５１の下側の左右に設けられた折れ曲がったフレームである。胸郭部フレーム５２には、上腕部７を動かすための可変長リンクが取付けられる。胸郭部前後連結フレーム５３は、胸郭部フレーム５２を前後方向で連結するフレームである。胸部中央連結フレーム５４は、左右の胸郭部前後連結フレーム５３を連結するフレームである。胸部内関節部フレーム５５は、左右の胸郭部前後連結フレーム５３のそれぞれの下側に設けられた板状のフレームである。胸部内関節部フレーム５５は、背骨部５６と共に胸部内関節部１６を構成する。
背骨部５６は、正面から見るとＴ字状の棒である。背骨部５６の上側の水平方向の円筒状の部分を、胸内回転軸部５６Ｔと呼ぶ。２枚の胸部内関節部フレーム５５が胸内回転軸部５６Ｔを回転可能に挟んで保持することで、胸部内関節部１６が構成される。
背骨部５６の縦に延在する部分は円柱状である。背骨部５６は、胸部５と腰部６とを連結する連結棒である。背骨部５６の下端には、背骨部５６を腰部６に３回転自由度を有して回転可能に接続する胸腰部関節部１８が設けられる。胸腰部関節部１８には、球面軸受が用いられる。リンク取付用フレーム５７は、胸内回転軸部５６Ｔの上側に接続する。リンク取付用フレーム５７には、胸部５を腰部６に対して回転させる可変長リンクが取付けられる。なお、図１６から図２０では、胸部５を腰部６に対して回転させる可変長リンクの取付位置が分るように、胸上部５Ｕに含まれる部材だけでなく胸下部５Ｄに設けられたリンク取付用フレーム５７も図示する。
肩部フレーム５１は、図５に示すように左右の端部がＸ軸に対して角度ξ1だけ後方に曲がっている。肩部フレーム５１の両端には、上腕部７を２回転自由度を有して回転可能に胸部５に接続する肩関節部１３が接続する。肩関節部１３は、直交する２つの回転軸を有する２軸ジンバルである。肩関節部１３の２軸ジンバルは、肩部フレーム５１の方向に存在する回転軸Ｒx1の回りを回転する部材（回転部材と呼ぶ）を、上腕部７に設けられたヨークが上腕部７と回転部材とがなす角度を変更可能（回転可能）に挟む形状である。ヨークとは、他の部材を回転可能に保持する穴または突起が設けられた互いに対向する部材である。ヨークに設けられた穴に保持され、他の部材を回転可能にする部材を軸部材と呼ぶ。２軸ジンバルでは、回転部材の回転軸と軸部材は直交する。肩関節部１３では、回転部材の回転軸と直交する直線上に存在する２個の突起を、ヨークに設けた穴に入れる。そうすることで、ヨークは回転部材を回転可能に保持する。肩関節部１３はこのような構造なので、上腕部７は、肩部フレーム５１の方向の回転軸の回りを回転できる。また、上腕部７と肩部フレーム５１とがなす角度も変更できる。
胸郭部フレーム５２は、肩部フレーム５１において左右の端部が後方に曲がる箇所よりも少し中央側で肩部フレーム５１の下側に接続する。胸郭部フレーム５２は、前後方向から見るとＬ字状であり、側面から見ると下側の辺を有しない長方形の上側の両角を切ったように見える形状である。肩部フレーム５１から前後方向および下方に延在する胸郭部フレーム５２は、Ｌ字状に折れ曲がって中央側に水平に延在する。胸郭部フレーム５２の前側および背面側で水平に延在する部分は、中央側で胸郭部前後連結フレーム５３により連結される。左右の胸郭部前後連結フレーム５３は、胸部中央連結フレーム５４により連結される。
胸郭部フレーム５２の前側のＬ字状の角の部分に、胸側主リンク取付部Ｊ１が設けられる。胸側主リンク取付部Ｊ１に、上腕部７を動かすための上腕部駆動主アクチュエータ１４が有する可変長リンクである上腕部駆動主リンク１４Ｌ（図３７に図示）が２回転自由度を有して回転可能に取付けられる。背中側のＬ字状の角の部分に、胸側補助リンク取付部Ｊ２が設けられる。胸側補助リンク取付部Ｊ２は、上腕部駆動補助リンク１５Ｌが２回転自由度を有して回転可能に取付けられる２軸ジンバルである。肩部フレーム５１の下側で胸郭部フレーム５２の間には、上腕部駆動主アクチュエータ１４および上腕部駆動補助アクチュエータ１５が自由に動ける空間が存在する。
胸側主リンク取付部Ｊ１は、回転部材に取付けられたヨークが、上腕部駆動主リンク１４Ｌに設けられた円柱状の突起（軸部材）を回転可能に挟んで保持する構造である。回転部材は、胸郭部フレーム５２に垂直な回転軸（Ｙ軸）の回りに回転する部材である。突起（軸部材）は、上腕部駆動主リンク１４Ｌが有する角筒状の部分の対向する両側面から垂直に出る。胸側補助リンク取付部Ｊ２も、同様な構造である。つまり、胸側主リンク取付部Ｊ１および胸側補助リンク取付部Ｊ２は、胸郭部フレーム５２側に回転部材とヨークを有する２軸ジンバルである。胸側主リンク取付部Ｊ１の回転部材が回転する回転軸および胸側補助リンク取付部Ｊ２の回転部材が回転する回転軸は、同一直線上に存在する。
胸郭部前後連結フレーム５３の中央部下側には、ＹＺ平面に平行な板状の胸部内関節部フレーム５５が接続する。胸部内関節部フレーム５５には、胸内回転軸部５６Ｔを回転可能に保持する機構が設けられる。胸内回転軸部５６Ｔは、背骨部５６の上部に設けられた水平な円筒状の部分である。２枚の胸部内関節部フレーム５５が胸内回転軸部５６Ｔを回転可能に挟んで保持することで、胸部内関節部１６が構成される。胸部内関節部１６は、胸上部５Ｕと胸下部５Ｄとを前後方向に回転可能な１回転自由度で接続する。胸上部５Ｕと胸下部５Ｄとの間の接続角度は、胸上部５Ｕに一端が接続され、胸下部５Ｄに他端が接続される胸部内リンク１７Ｌ（図２２に図示）の長さにより決まる。胸部内アクチュエータ１７は、胸部５の前側中央に設けられる。
胸部内リンク１７Ｌの一端は、下側胸部内リンク取付部Ｊ３により背骨部５６に回転可能に取付けられる。背骨部５６から前方に下側胸部内リンク取付部Ｊ３のヨークが出て、胸部内リンク１７Ｌを回転可能に挟む。胸部内リンク１７Ｌのもう一端は、上側胸部内リンク取付部Ｊ４により胸部中央連結フレーム５４に回転可能に取付けられる。上側胸部内リンク取付部Ｊ４のヨークは、胸部中央連結フレーム５４に設けられる。胸屈曲部Ｃ１は、胸部内関節部１６、胸部内アクチュエータ１７、上側胸部内リンク取付部Ｊ４、下側胸部内リンク取付部Ｊ３を有して構成される。
胸部５と腰部６の間には、図２２、図２３および図２４に示すように、３本の胸腰部中央アクチュエータ１９、胸腰部右アクチュエータ２０、胸腰部左アクチュエータ２１が存在する。胸腰部中央リンク１９Ｌは、胸部５の下部の背中側中央の点から腰部６の胸腰部関節部１８の背中側中央の点を結ぶ。胸腰部右リンク２０Ｌは、胸部５の下部の前側右の点から腰部６の背中側右の点を結ぶ。胸腰部左リンク２１Ｌは、胸部５の下部の前側左の点から腰部６の背中側左の点を結ぶ。上から見ると、胸腰部右リンク２０Ｌと胸腰部左リンク２１Ｌは、背骨部５６を挟むように存在する。胸腰部右リンク２０Ｌと胸腰部左リンク２１Ｌは、胸部５では正面側の位置から腰部６では背面側の位置に向かう。
リンク取付用フレーム５７には、背中側の中央に胸部中央リンク取付部Ｊ５、前側右に胸部右リンク取付部Ｊ６、前側左に胸部左リンク取付部Ｊ７が設けられる。胸部中央リンク取付部Ｊ５、胸部右リンク取付部Ｊ６、胸部左リンク取付部Ｊ７は、基準状態で胸部内関節部１６と同じ高さになるように設けられる。胸部中央リンク取付部Ｊ５、胸部右リンク取付部Ｊ６、胸部左リンク取付部Ｊ７には、それぞれ胸腰部中央リンク１９Ｌ、胸腰部右リンク２０Ｌ、胸腰部左リンク２１Ｌの一端が２回転自由度を有して回転可能に取付けられる。
胸部中央リンク取付部Ｊ５は、リンク取付用フレーム５７から背面側に出るＹ軸に平行な回転軸の回りに回転するヨークが胸腰部中央リンク１９Ｌを回転可能に挟む構造である。胸部右リンク取付部Ｊ６は、リンク取付用フレーム５７から右斜め前に出る回転軸の回りに回転するヨークが胸腰部右リンク２０Ｌを回転可能に挟む構造である。胸部左リンク取付部Ｊ７は、リンク取付用フレーム５７から左斜め前に出る回転軸の回りに回転するヨークが胸腰部左リンク２１Ｌを回転可能に挟む構造である。
胸腰部中央アクチュエータ１９が有する可変長リンクである胸腰部中央リンク１９Ｌを例にして、可変長リンクの構造を説明する。図２５は、アクチュエータが有する可変長リンクの構造を説明する断面図である。図２５には、断面表示しないモータ１９Ｍも示す。モータ１９Ｍと円筒１９Ｃとは、互いの位置関係が固定されている。胸腰部中央リンク１９Ｌは、ねじ棒１９Ａ、ナット１９Ｂ、円筒１９Ｃ、ナット位置固定部１９Ｄ、ナット回転保持部１９Ｅ、ナットギヤ１９Ｆを有する。ねじ棒１９Ａは、側面に雄ねじが設けられた断面が円形の棒である。ナット１９Ｂは、ねじ棒１９Ａとかみ合う雌ねじが内面に設けられた貫通穴を有する雌ねじ部材である。円筒１９Ｃは、ねじ棒１９Ａの一部およびナット１９Ｂを内部に収容する。ナット位置固定部１９Ｄは、円筒１９Ｃに対するナット１９Ｂの軸方向の位置を固定する。ナット回転保持部１９Ｅは、ナット１９Ｂを円筒１９Ｃに対して回転可能に保持する。ナットギヤ１９Ｆは、ナット１９Ｂと共に回転するギヤである。
ナット位置固定部１９Ｄは、ナット１９Ｂを移動させないように円筒１９Ｃの内部に周方向に設けられた突起である。ナット位置固定部１９Ｄである突起は、ナット１９Ｂが有する周方向に設けられた突起を挟むように設けられる。ナット位置固定部１９Ｄは、３箇所に設けている。３箇所は、ナットギヤ１９Ｆとナット１９Ｂとの接続部分と、ナット回転保持部１９Ｅの両側である。ナット位置固定部１９Ｄは、円筒１９Ｃに対するナット１９Ｂの軸方向の相対位置を固定するものであれば、どのようなものでもよい。ねじ棒１９Ａの軸方向は、円筒１９Ｃの長さ方向でもある。
ナットギヤ１９Ｆは、円筒１９Ｃの外側に配置される。ナットギヤ１９Ｆは、モータ１９Ｍの回転軸に設けられた駆動ギヤ１９Ｇとかみ合う。駆動ギヤ１９Ｇが回転すると、ナットギヤ１９Ｆおよびナット１９Ｂが回転する。ナット１９Ｂが回転すると、ナット１９Ｂはねじ棒１９Ａに対して移動することになる。ナット１９Ｂの位置は円筒１９Ｃの長さ方向に対して固定されているので、ナット１９Ｂが回転すると、ねじ棒１９Ａがナット１９Ｂおよび円筒１９Ｃに対して移動する。ねじ棒１９Ａは、モータ１９Ｍが発生する力により移動する。
ねじ棒１９Ａの一端が、胸部中央リンク取付部Ｊ５により、リンク取付用フレーム５７に回転可能に取付けられる。円筒１９Ｃの一端が、腰部中央リンク取付部Ｊ１０により、腰部主フレーム６１に回転可能に取付けられる。ねじ棒１９Ａが円筒１９Ｃから出る方向に移動すると、胸部中央リンク取付部Ｊ５と腰部中央リンク取付部Ｊ１０の距離が長くなる。ねじ棒１９Ａが円筒１９Ｃに入る方向に移動すると、胸部中央リンク取付部Ｊ５と腰部中央リンク取付部Ｊ１０の距離が短くなる。このように、胸腰部中央リンク１９Ｌはその長さが変更可能であり、その両端が取付けられる２点間の距離を変更することができる。
胸腰部中央リンク１９Ｌが有するねじ棒１９Ａの側の端は、胸部５ではなく、腰部６に取付けられてもよい。その場合には、円筒１９Ｃは、胸部５に取付けられる。雄ねじが設けられたねじ棒１９Ａは、その一端が胸腰部中央リンク１９Ｌの両側のリンク取付部のどちらかに取付けられる。円筒１９Ｃの一端は、胸腰部中央リンク１９Ｌの両端のリンク取付部の中で、ねじ棒１９Ａが取付けられていないリンク取付部に取付けられる。
ナット１９Ｂは、ねじ棒１９Ａに設けられた雄ねじとかみ合う雌ねじが内面に設けられた貫通穴を有する。ナット１９Ｂは、モータ１９Ｍからの力が伝えられて回転する。ナット１９Ｂは、貫通穴を有するので、有穴部材と呼ぶ。円筒１９Ｃは、ねじ棒１９Ａおよびナット１９Ｂを収容する筒である。ナット位置固定部１９Ｄは、ねじ棒１９Ａの軸方向での円筒１９Ｃに対するナット１９Ｂの相対位置を固定する有穴部材位置固定部である。ナット回転保持部１９Ｅは、ナット１９Ｂと円筒１９Ｃの間に設けられて、ナット１９Ｂを円筒１９Ｃに対して回転可能に保持する有穴部材保持部である。有穴部材保持部を有するので、可変長リンクである胸腰部中央リンク１９Ｌは軸回りの回転を可能とする１回転自由度を有する。軸回りの回転とは、リンクの両端で軸回りの回転角度が異なることである。可変長リンクが１回転自由度を有するので、その両端を取付けるリンク取付部は２回転自由度を有するものでよい。可変長リンクが１回転自由度を有しない場合は、どちらかの端を取付けるリンク取付部は３回転自由度を有するようにする。ここで、可変長リンクがその両端が２回転自由度を有してリンク取付部に取付けられ軸回りに１回転自由度を有する場合、または、可変長リンクがその一端が３回転自由度を有してリンク取付部に取付けられ他端が２回転自由度を有してリンク取付部に取付けられる場合を、可変長リンクが５回転自由度を有すると定義する。
胸腰部右リンク２０Ｌ、胸腰部左リンク２１Ｌおよび他のアクチュエータが有する可変長リンクも同様な構造である。
ねじ棒とナットとの間のねじは、ボールネジや台ねじなどの回転時の摩擦係数が小さいものを使用する。ねじのピッチが同じであれば、摩擦係数が小さければ、可変長リンクの長さを変更するために必要な力が小さくなる。そのため、モータは、摩擦係数が大きい場合よりも最大出力が小さいものでよくなる。アクチュエータが動作する場合の消費電力も小さくなる。静止時の摩擦力の大きさは、モータが駆動力を発生させなくてもナットが回転しない程度の大きさとする。そうすることで、電力供給が遮断された場合にも、人型ロボットの各関節部において電力が途絶える前の角度を維持できる。人型ロボットが静止していた場合は、その姿勢を維持できる。人型ロボットが物体を保持していた場合は、物体を保持したままの状態を維持できる。
摩擦力の大きさは、電力供給が遮断された状況で、１人または複数人の力で、各関節部の角度を変更できるような大きさとする。電力供給が遮断された災害時などに、人型ロボットが負傷した人の救助などに邪魔になる可能性がある。人型ロボットの姿勢を変更できれば、例えば救助の邪魔にならないような姿勢に変更したり、移動させたりできる。可変長リンクの長さを変更させようとする力によりナットが回転するかどうかは、ねじの摩擦係数だけでなくピッチも関係する。摩擦係数が同じでもピッチを小さくすれば、ナットが回転する力の最小値を大きくできる。ねじのピッチと摩擦係数の大きさは、ナットが回転することで可変長リンクの長さを変更できる力の最小値が、適切な大きさになるように決める。
ねじ棒およびナットを収容する筒は、角筒でもよく、平面と曲面が組み合わさった側面を持つものでもよい。長さ方向で筒の径が変化してもよい。ねじ棒の一端が少なくとも２回転自由度を持たせてリンク取付部に取付けられ、筒またはモータ側の端が少なくとも２回転自由度を持たせてリンク取付部に取付けられるものであれば、可変長リンクはどのような構造でもよい。取付具を介して筒またはモータ側の端をリンク取付部に取付けてもよい。筒の端部でない部分をリンク取付部に取付けてもよい。その場合には、リンク取付部に取付けられる筒の箇所までが可変長リンクであり、可変長リンクの一端がリンク取付部に取付けられることになる。
腰部６は、胸腰部関節部１８が設けられる腰部主フレーム６１、下肢部４が接続される下肢部接続フレーム６２、腰部主フレーム６１の背面側の下部を覆う腰部カバー６３を有する。下肢部接続フレーム６２は、左右にそれぞれ１個が設けられる。腰部カバー６３と腰部主フレーム６１の間の空間には、電源装置を配置したり、配線などを通したりする。
腰部主フレーム６１は、上から見ると長方形と円とが、長方形の前側で円の一部が重なるように組合された形状である。腰部主フレーム６１は、背面側の左右対称な位置に長方形の部分から後方に出た２つの厚板状の部分を有する。上から見て円の部分は、胸腰部関節部１８が存在する円筒である。胸腰部関節部１８は、背骨部５６の一端に設けられた球面を３回転自由度を有して保持する球面軸受けで構成される。図１２に示すように、後方に出た２つの厚板状の部分の上側に、胸腰部右リンク２０Ｌ、胸腰部左リンク２１Ｌの他端が２回転自由度を有して回転可能にそれぞれ取付けられる腰部右リンク取付部Ｊ８、腰部左リンク取付部Ｊ９が設けられる。腰部主フレーム６１の上部の背面側の中央に、胸腰部中央リンク１９Ｌが２回転自由度を有して回転可能に取付けられる腰部中央リンク取付部Ｊ１０が設けられる。
腰部右リンク取付部Ｊ８、腰部左リンク取付部Ｊ９、腰部中央リンク取付部Ｊ１０は２軸ジンバルである。腰部右リンク取付部Ｊ８、腰部左リンク取付部Ｊ９は、貫通穴を有するヨークが回転可能に上向きに設けられる。貫通穴には、可変長リンクに設けられた軸部材が入る。腰部中央リンク取付部Ｊ１０は、貫通穴を有するヨークが回転可能に背面側に向けて設けられる。
図２６は、胸上部５Ｕと胸下部５Ｄの区分と胸部５を動かす可変長リンクの配置を説明する側面から見た模式図である。図２６では、リンク配置を理解しやすくするため、胸部内リンク１７Ｌを実際よりも前側に図示している。図２７は、正面から見た模式図である。胸下部５Ｄは、ハッチングを付けて示す。胸下部５Ｄは、３本の可変長リンクにより胸腰部関節部１８の回りをＸ軸、Ｙ軸、Ｚ軸の回りに回転できる。胸上部５Ｕは、胸下部５Ｄに対して１本の可変長リンクによりＸ軸の回りに回転できる。
胴体屈曲部Ｃ２は、胸部５を腰部６に３回転自由度を有して回転可能に接続する３回転自由度接続機構である。胴体屈曲部Ｃ２は、胸腰部関節部１８、胸腰部中央アクチュエータ１９、胸腰部右アクチュエータ２０、胸腰部左アクチュエータ２１、胸部中央リンク取付部Ｊ５、胸部右リンク取付部Ｊ６、胸部左リンク取付部Ｊ７、腰部中央リンク取付部Ｊ１０、腰部右リンク取付部Ｊ８、腰部左リンク取付部Ｊ９を有する。３回転自由度とは、胸部５を腰部６に対して前後方向（Ｘ軸回りの回転）に傾けることで１自由度、左右方向（Ｙ軸回りの回転）に傾けることで１自由度、背骨部５６（Ｚ軸）の回りに胸部５を腰部６に対して旋回させることで１自由度、合計で３自由度を有して回転できることである。
この発明に係る３回転自由度接続機構は、３回転自由度の関節部と３本のアクチュエータという簡素な構造である。３回転自由度接続機構は、より広く考えると、第２部材を第１部材に回転可能に接続する回転接続機構である。回転接続機構の中で関節部に３回転自由度を有するものが、３回転自由度接続機構である。
胴体屈曲部Ｃ２を３回転自由度接続機構として一般的に考えると、胴体屈曲部Ｃ２は、接続する側の第２部材である胸部５を、接続される側の第１部材である腰部６に対して３回転自由度を有して回転可能に接続する。胸腰部関節部１８は、胸部５を腰部６に３回転自由度を有して回転可能に接続する関節部である。背骨部５６は、胸部５に対して方向が固定された捻り軸である。胸部５は、背骨部５６の回りを腰部６に対して回転可能である。３回転自由度接続機構では、腰部６に近い側を第１部材とする。腰部６から遠い側を第２部材とする。胸腰部関節部１８は、捻り軸の回りに第２部材である胸部５を第１部材である腰部６に対して回転可能にし、かつ第２部材を第１部材に３回転自由度を有して回転可能に接続する。
胸腰部中央アクチュエータ１９、胸腰部右アクチュエータ２０および胸腰部左アクチュエータ２１は、長さが変更可能な可変長リンク、可変長リンクの長さを変更する力を発生させるモータをそれぞれ有する３本のアクチュエータである。腰部中央リンク取付部Ｊ１０、腰部右リンク取付部Ｊ８および腰部左リンク取付部Ｊ９は、腰部６（第１部材）に設けられた３個の第１部材側リンク取付部である。３個の第１部材側リンク取付部のそれぞれには、３本のアクチュエータのそれぞれの一端が少なくとも２回転自由度を有して回転可能に取付けられる。腰部中央リンク取付部Ｊ１０、腰部右リンク取付部Ｊ８および腰部左リンク取付部Ｊ９は、胸腰部関節部１８に対する相対的な位置関係が固定されている。胸部中央リンク取付部Ｊ５、胸部右リンク取付部Ｊ６および胸部左リンク取付部Ｊ７は、胸部５（第２部材）に設けられた３個の第２部材側リンク取付部である。３個の第２部材側リンク取付部のそれぞれには、３本のアクチュエータのそれぞれの他端が少なくとも２回転自由度を有して回転可能に取付けられる。胸部中央リンク取付部Ｊ５、胸部右リンク取付部Ｊ６および胸部左リンク取付部Ｊ７は、胸腰部関節部１８に対する相対的な位置関係が固定されている。
人型ロボット１００が直立した基準状態では、胴体屈曲部Ｃ２は、回転可能な３つの軸の中で捻り軸（背骨部、Ｚ軸）および他の２つの回転軸（Ｘ軸とＹ軸）の何れも両方向に回転可能である。３本のリンクと捻り軸とがなす３個の角度の最大値が決められた角度δ0（例えば、３度程度）以上であるように、胸部中央リンク取付部Ｊ５、胸部右リンク取付部Ｊ６、胸部左リンク取付部Ｊ７、腰部中央リンク取付部Ｊ１０、腰部右リンク取付部Ｊ８、腰部左リンク取付部Ｊ９は、配置されている。
人型ロボット１００が有するすべての３回転自由度接続機構では、基準状態で捻り軸および他の２つの回転軸の少なくとも一つで両方向に回転可能に決められている。つまり、それぞれの３回転自由度接続機構の基準状態では、捻り軸を含む少なくとも２つの回転軸で両方向に回転可能である。
胴体屈曲部Ｃ２は、例えば、胸腰部関節部１８から上の上半身を前方向に２０度程度、後方向に２０度程度、左右方向に２０度程度傾けることができる。また、背骨部５６の回りに両方向に２０度程度、胸部５を腰部６に対して回転させる（捻る）ことができる。さらに、胸部内関節部１６により胸上部５Ｕを胸下部５Ｄに対して前方向に例えば１５度程度、後ろ方向に２０度程度、前後に傾けることができる。そのため、例えば、胸下部５Ｄを前後方向に傾けても胸上部５Ｕを鉛直に保つことができる。また、両手を作業しやすい位置になるような姿勢をとることができる。なお、可動範囲は一例であって、より広くあるいはより狭く可動範囲を決めることも可能である。
人型ロボット１００が直立した基準状態での胴体屈曲部Ｃ２での可変長リンクの配置を左の手部側斜め後から見た斜視図を図２８に示す。胸下部５Ｄに設けられた３個の第２部材側リンク取付部Ｊ５、Ｊ６、Ｊ７と腰部６に設けられた３個の第１部材側リンク取付部Ｊ１０、Ｊ８、Ｊ９とをそれぞれ結ぶ３本の可変長リンク１９Ｌ、２０Ｌ、２１Ｌを、胴体屈曲部Ｃ２は有する。胸下部５Ｄに設けられた３個の第２部材側リンク取付部Ｊ５、Ｊ６、Ｊ７は、胸腰部関節部１８に対して位置が固定されている。腰部６に設けられた３個の第１部材側リンク取付部Ｊ１０、Ｊ８、Ｊ９は、胸腰部関節部１８に対して位置が固定されている。３本の可変長リンク１９Ｌ、２０Ｌ、２１Ｌの長さを変更することで、胸下部５Ｄの腰部６に対する接続角度を３回転自由度で変更できる。胸腰部関節部１８のＸ軸回りの回転角度をαs、Ｙ軸回りの回転角度をβs、Ｚ軸回りの回転角度をγsとする。胸上部５Ｕは胸下部５Ｄに対して、胸部内関節部１６によりＸ軸回りに回転できる。胸部内関節部１６でのＸ軸回りの回転角度をψとする。
胸腰部関節部１８などの関節部が回転することで変化する捻り軸が向く方向の取りうる範囲を、関節部の可動範囲と呼ぶ。胸腰部関節部１８の前後方向、左右方向、背骨部５６の回りに回転可能な角度範囲として前に示した例は、その回転軸での取りうる最大角度範囲を示すものである。ある回転軸で取りうる角度範囲は、他の回転軸が取っている角度の影響を受ける。そのため、各回転軸の角度範囲を任意に組み合わせて得られる領域がすべて可動範囲になる訳ではない。他の関節部に関しても同様である。
図２９は、胴体屈曲部Ｃ２での可変長リンクの配置を背骨部が延在する方向から見た図である。図２９では、捻り軸である背骨部５６を、二重丸で表す。第２部材側リンク取付部である胸部中央リンク取付部Ｊ５、胸部右リンク取付部Ｊ６および胸部左リンク取付部Ｊ７を、白丸で表す。第１部材側リンク取付部である腰部中央リンク取付部Ｊ１０、腰部右リンク取付部Ｊ８および腰部左リンク取付部Ｊ９は、黒丸で表す。可変長リンクである胸腰部中央リンク１９Ｌ、胸腰部右リンク２０Ｌおよび胸腰部左リンク２１Ｌを、太線で示す。他の同種の図でも同様に表す。３個の第２部材側リンク取付部を結んでできる三角形を第２部材側三角形Ｔ１と呼ぶ。
図２８および図２９から以下のことが分る。可変長リンク２０Ｌ、２１Ｌが長く、捻り軸５６に対してねじれの位置にあり、水平面に対して大きく傾斜している。捻り軸５６の方向から見た場合は、可変長リンク２０Ｌ、２１Ｌがほぼ並行しており、捻り軸５６を挟むように存在する。可変長リンク２０Ｌを短くする捻り軸５６の回りの回転方向と、可変長リンク２１Ｌを短くする捻り軸５６の回りの回転方向とは、互いに逆向きになっている。そのため、第２部材６を回転させると、可変長リンク２０Ｌ、２１Ｌの一方の長さが長くなり、もう一方の長さがが短くなる。そのため、捻り軸５６の回りに回転する際に、伸びるリンクにより押される力と、短くなるリンクにより引かれる力の両方が発生して、捻り軸５６の回りに回転しやすくなる。胴体屈曲部Ｃ２では、可動範囲内の各状態で、捻り軸の回りに回転する際に、長さが長くなる可変長リンクと短くなる可変長リンクとが存在する。
二重丸で表される捻り軸５６は、第２部材側三角形Ｔ１の内部であり、かつ第２部材側三角形Ｔ１の底辺の２等分線上に存在する。第２部材側三角形の底辺の２等分線を対称軸線と呼び、底辺を対称軸垂直線と呼ぶ。可変長リンク２０Ｌ、２１Ｌを同じように伸ばし、可変長リンク１９Ｌを縮めると、対称軸線の方向で第２部材６の傾きを変えることができる。可変長リンク２０Ｌ、２１Ｌを同じように縮め、可変長リンク１９Ｌを伸ばせば、対称軸線の方向で第２部材６の傾きを反対向きに変えることができる。また、可変長リンク１９Ｌの長さを変えないで、可変長リンク２０Ｌを長くし可変長リンク２１Ｌを短くする、あるいは、可変長リンク２０Ｌを短くし可変長リンク２１Ｌを長くすると、対称軸垂直線の方向で第２部材６の傾きを変えることができる。
可変長リンクの伸縮により捻り軸の回りに第２部材が回転できるリンク配置についての条件について考察する。図３０に、捻り軸と可変長リンクの位置関係により可変長リンクの伸縮が捻り軸の回りに回転させるトルクが発生するかどうかを説明する図を示す。図３０では、可変長リンクＬ３の下端（白丸で示す）は捻り軸との位置関係が固定であるとする。図３０(a)には、捻り軸Ｇ１と可変長リンクＬ１とが平行である場合を示す。図３０(b)には、捻り軸Ｇ２と可変長リンクＬ２とが同一平面上にあり平行でない場合を示す。図３０(c)には、捻り軸Ｇ３と可変長リンクＬ３とがねじれの関係にある場合を示す。各場合では、捻り軸の方向から見た図を上側に、捻り軸に垂直な方向から見た図を下側に示す。図３０(c)では、捻り軸に垂直かつ可変長リンクＬ３の下端Ｐ３が捻り軸Ｇ３上に来る方向（矢印Ａで示す）から見た図も示す。
捻り軸Ｇ１と可変長リンクＬ１とが平行である場合は、図３０(a)に示すように、捻り軸Ｇ１の方向から見ると、捻り軸Ｇ１と可変長リンクＬ１はそれぞれ点になる。したがって、可変長リンクＬ１の伸縮により、捻り軸Ｇ１に垂直な向きの力の成分、および捻り軸Ｇ１の回りに回転させるトルクが発生しない。捻り軸Ｇ２と可変長リンクＬ２とが同一平面上にあり平行でない場合は、図３０(b)に示すように、可変長リンクＬ２が捻り軸Ｇ２の方向を向く。そのため、可変長リンクＬ２の伸縮により、捻り軸Ｇ２に垂直な向きの力の成分が発生するが、捻り軸Ｇ２の方向を向いているので、捻り軸Ｇ１の回りに回転させるトルクはゼロである。捻り軸Ｇ３と可変長リンクＬ３とがねじれの関係にある場合は、図３０(c)に示すように、可変長リンクＬ３の伸縮により、捻り軸Ｇ３の回りに三角形Ｕ３の面積に比例する回転トルクが発生する。
可変長リンクＬ３の一端Ｐ３と捻り軸Ｇ３との距離Ｋは決まっているので、回転トルクの大きさは、捻り軸Ｇ３および一端Ｐ３とで決まる平面（リンク基準面と呼ぶ）と可変長リンクＬ３の他端Ｑ３との距離Ｄにより決まることになる。距離Ｄと可変長リンクＬ３の長さ（Ｗで表す）の比（Ｄ／Ｗ）は、可変長リンクＬ３の長さが単位量だけ変化した場合に、距離Ｄが変化する量を表す。リンク基準面と可変長リンクＬ３とがなす角度（傾斜角度と呼ぶ）をθとすると、以下が成立する。
sinθ＝Ｄ／Ｗ
図３０(a)、(b)では、傾斜角度θ＝０となる。可変長リンクの伸縮により捻り軸の回りの必要な回転トルクを発生させるには、傾斜角度θが決められた角度δ0（例えば、３度程度）以上である必要がある。ここでは、可変長リンクが１本の場合で考えたが、可変長リンクが２本以上ある場合は、可変長リンクの傾斜角度の中の最大値がδ0以上であればよい。なお、リンク基準面は、可変長リンクごとに決まる平面である。具体的には、捻り軸の方向が第１部材に対して固定されている場合には、捻り軸およびその可変長リンクの第１部材側リンク取付部を含む平面である。捻り軸の方向が第２部材に対して固定されている場合には、捻り軸およびその可変長リンクの第２部材側リンク取付部を含む平面である。
傾斜角度θの場合の可変長リンクＬ３による回転トルクＴＡは、以下のようになる。
ＴＡ∝Ｋ*Ｗ*sinθ＝Ｋ*Ｄ＝２*三角形Ｕ３の面積
第２部材を捻り軸の回りに回転させる際に必要となる回転トルクは、第２部材の慣性モーメントも関係する。傾斜角度θに対する閾値δ0は、すべての３回転自由度接続機構で同じ値としてもよいし、３回転自由度接続機構ごとに決めてもよい。また、傾斜角度θを求める際に、可変長リンクの長さの変化量を単位量ではなく、可変長リンクの長さの変化可能範囲の幅を考慮した変化量としてもよい。
基準状態においては、可変長リンク１９Ｌは捻り軸５６と同一平面上にあり、可変長リンク１９Ｌとリンク基準面がなす傾斜角度θs1は０度である。可変長リンク２０Ｌおよび可変長リンク２１Ｌは、捻り軸５６とねじれの関係にある。可変長リンク２０Ｌおよび可変長リンク２１Ｌの傾斜角度θs2とθs3は、約４１度である。３本の可変長リンク１９Ｌ、２０Ｌ、２１Ｌが、リンク基準面となす傾斜角度の最大値θsmaxは、δ0以上である。
したがって、可変長リンク２０Ｌ、２１Ｌの何れかが伸縮すると、捻り軸５６の回りの回転トルクを発生できる。
傾斜角度θs2とθs3が約４１度なので、胸部５を大きく傾けても、少なくともθs2とθs3のどちからはδ0以上である。すなわち、胸腰部関節部１８の可動範囲内の各状態で、３本の可変長リンク１９Ｌ、２０Ｌ、２１Ｌの何れか少なくとも１本が捻り軸５６とねじれの関係にある。さらに、リンク基準面と可変長リンク２０Ｌとなす傾斜角度は、δ0以上である。捻り軸５６の方向は第２部材５に固定されているので、リンク基準面は、第２部材側リンク取付部である胸部右リンク取付部Ｊ６または胸部左リンク取付部Ｊ７と捻り軸５６を含む平面である。
図３１は、胸部５を回転させて前方に傾けた状態での胴体屈曲部Ｃ２での可変長リンクの配置を背骨部が延在する方向から見た図である。図３１では、胸部５（第２部材）を左に１５度捻って、左に１５度の方向に前に３０度だけ傾けている。捻り軸５６が胸部５に対して方向が固定なので、捻り軸５６を傾けると、捻り軸５６の方向から見た腰部６（第１部材）を傾ける方向に、傾ける角度に応じて腰部６が伸縮して見える。図３１では、腰部６が、cos(30度)＝約0.87倍に縮む。捻り軸５６の回りに回転させているので、可変長リンク２０Ｌが長くなり、可変長リンク２１Ｌが短くなる。捻り軸５６の回りに回転させる以外の場合は、以下のようになる。捻り軸５６を前に傾ける場合は、可変長リンク２０Ｌ、２１Ｌの傾斜角度θs2、θs3がどちらも小さくなる。右に傾ける場合は、可変長リンク２０Ｌの傾斜角度θs2が大きくなり、可変長リンク２１Ｌの傾斜角度θs3が小さくなる。胴体屈曲部Ｃ２では、可動範囲の中でどのように傾けても、傾斜角度の最大値θsmaxは３０度程度以上である。なお、関節部の可動範囲が、可動範囲内の境界付近などで捻り軸の回りの回転が不要なように決められている場合は、可動範囲内の境界付近などでは傾斜角度の最大値θsmaxは決められた角度δ0以上でなくてもよい。
腰部６の構造の説明に戻る。下肢部接続フレーム６２は、略長方形の板材である。下肢部接続フレーム６２は、腰部主フレーム６１の下部の左右に前方が高くなるように固定される。下肢部接続フレーム６２の内側(体の中心に近い側)で垂直に突起６４が出ている。突起６４の先端部には外側の斜め上に向けて大腿部１０を腰部６に接続する股関節部２２が設けられる。股関節部２２は、腰部６側の球面を大腿部１０側の窪みが囲む球面軸受を有する。股関節部２２は、球面部材と、球面部材の球面を３回転自由度で回転可能に保持する大腿部１０の端部に設けられた球面受部材とを有する。球面部材は、腰部６の一部である突起６４から外側斜め上に出た球面を有する。こうすることで、大腿部１０の可動範囲を大きくすることができる。
下肢部接続フレーム６２の前側で突起６５が出て、突起６５の先端部の前側には股部正面リンク取付部Ｊ１１が設けられる。股部正面リンク取付部Ｊ１１には、股関節部２２を回転させるための大腿部正面リンク２３Ｌ（図５７に図示）が取付けられる。突起６５は折れ曲がっており、股部正面リンク取付部Ｊ１１が設けられる部分の面は基準状態ではほぼ鉛直である。股部正面リンク取付部Ｊ１１では、突起６５に回転部材と回転部材により回転する円筒が設けられ、大腿部正面リンク２３Ｌの一端にヨークおよび軸部材が設けられる。股部正面リンク取付部Ｊ１１は、突起６５に設けられた円筒の中を大腿部正面リンク２３Ｌの一端に回転可能に設けられた軸部材が通る構造の２軸ジンバルである。
下肢部接続フレーム６２の外側の背面側の角付近で突起６６が出て、突起６６の先端部の外側には股部外側リンク取付部Ｊ１２が設けられる。股部外側リンク取付部Ｊ１２には、大腿部外側リンク２４Ｌが取付けられる。下肢部接続フレーム６２の内側の背面側の角付近で垂直に突起６７が出て、突起６７の先端部の内側には股部内側リンク取付部Ｊ１３が設けられる。股部内側リンク取付部Ｊ１３には、大腿部内側リンク２５Ｌが取付けられる。突起６７は折れ曲がっており、股部内側リンク取付部Ｊ１３は内側の斜め下に設けられる。股部外側リンク取付部Ｊ１２と股部内側リンク取付部Ｊ１３は、股部正面リンク取付部Ｊ１１と同様な構造の２軸ジンバルである。
図５、図１０、図１２、図１３、図３２および図３３を参照して、頭部２の構造について説明する。図３２は、頭部２を拡大した側面図である。図３３は、頭部２を拡大した斜視図である。肩部フレーム５１の上面の中央から首部中心棒２６が上方に伸びる。頭部２は、首部中心棒２６の先端に設けられた首関節部２７に接続している。首関節部２７には、首部中心棒２６の先端に球面が設けられた球面軸受が用いられる。首関節部２７は、頭部２と胸部５を３回転自由度を有して回転可能に接続する。頭部２は、正方形の４つの角を切りとった八角形の板状の頭部基準板２Ａを有する。頭部基準板２Ａに目、耳、口などの機能を実現する装置が取付けられる。
頭部２は、３本の首部背面アクチュエータ２８、首部右側アクチュエータ２９、首部左側アクチュエータ３０により首関節部２７の回りを３回転自由度で回転できる。つまり、前後左右方向にそれぞれ例えば２０度程度、頭部２を傾けることができる。さらに、首部中心棒２６の回りに両方向に例えば６０度程度、頭部２を回すことができる。
肩部フレーム５１の上面には、首下部フレーム５８が設けられる。首下部フレーム５８には、頭部２を動かす３本のアクチュエータが有する可変長リンクの一端が取付けられる。首下部フレーム５８は、水平面上で１２０度の間隔で中心から伸びる３枚の板状の部分を有する。３枚の板状の部分の先端は９０度曲がって、曲がった部分に首部背面リンク取付部Ｊ１４、首部右側リンク取付部Ｊ１５、首部左側リンク取付部Ｊ１６が設けられる。
首部背面リンク取付部Ｊ１４は、肩部フレーム５１の背側中央に位置する。首部右側リンク取付部Ｊ１５は、肩部フレーム５１の前側中央の少し右に位置する。首部左側リンク取付部Ｊ１６は、肩部フレーム５１の前側中央の少し左に位置する。
首部背面リンク取付部Ｊ１４は、首下部フレーム５８から背側に出る回転部材により回転するヨークに、首部背面リンク２８Ｌの他端に設けられた軸部材が回転可能に保持される２軸ジンバルである。右側リンク取付部Ｊ１５、首部左側リンク取付部Ｊ１６も同様な構造の２軸ジンバルである。
頭部２の下部の背側中央には、頭部背面リンク取付部Ｊ１７が設けられる。頭部２の下部の右側には、頭部右側リンク取付部Ｊ１８が設けられる。頭部２の下部の左側には、頭部左側リンク取付部Ｊ１９が設けられる。
首部背面リンク２８Ｌ、首部右側リンク２９Ｌ、首部左側リンク３０Ｌのそれぞれは、その一端が頭部背面リンク取付部Ｊ１７、頭部右側リンク取付部Ｊ１８、頭部左側リンク取付部Ｊ１９のそれぞれに２回転自由度を有して回転可能に取付けられる。他端は、首部背面リンク取付部Ｊ１４、首部右側リンク取付部Ｊ１５、首部左側リンク取付部Ｊ１６のそれぞれに２回転自由度を有して回転可能に取付けられる。
首部背面リンク２８Ｌは、リンク取付具２８Ｎを介して頭部背面リンク取付部Ｊ１７に取付けられる。首部背面リンク２８Ｌの長さは、頭部背面リンク取付部Ｊ１７と首部背面リンク取付部Ｊ１４と間の距離よりも短い。リンク取付具２８Ｎは、首部背面リンク２８Ｌの円筒とモータ２８Ｍの間からモータ２８Ｍに沿って伸びる。リンク取付具２８Ｎは、側面から見てＬ字状に曲がる部材である。Ｌ字状のリンク取付具２８Ｎの先端は、首部背面リンク２８Ｌが延長された位置で頭部背面リンク取付部１７に取付けられる。モータ２８Ｍの下端は、リンク取付具２８Ｎの取付位置よりも下側に存在する。首部右側リンク２９Ｌ、首部左側リンク３０Ｌも同様な構造である。こうすることで、アクチュエータが有する可変長リンクの長さよりも長いモータを使用できる。
首部Ｃ３は、第２部材である頭部２を第１部材である胸部５に３回転自由度を有して回転可能に接続する３回転自由度接続機構である。首部Ｃ３は、関節部である首関節部２７、３本の可変長リンクである首部背面リンク２８Ｌ、首部右側リンク２９Ｌおよび首部左側リンク３０Ｌ、３個の第１部材側リンク取付部である首部背面リンク取付部Ｊ１４、首部右側リンク取付部Ｊ１５および首部左側リンク取付部Ｊ１６、３個の第２部材側リンク取付部である頭部背面リンク取付部Ｊ１７、頭部右側リンク取付部Ｊ１８および頭部左側リンク取付部Ｊ１９を有して構成される。
捻り軸である首部中心棒２６は、胸部５に対して方向が固定されている。首部中心棒２６は、頭部２に対する角度が変更可能である。首部背面リンク取付部Ｊ１４、首部右側リンク取付部Ｊ１５および首部左側リンク取付部Ｊ１６では、首部中心棒２６および首関節部２７に対する相対的な位置関係は、固定されている。頭部背面リンク取付部Ｊ１７、頭部右側リンク取付部Ｊ１８および頭部左側リンク取付部Ｊ１９でも、首関節部２７に対する相対的な位置関係は、固定されている。
首部Ｃ３での可変長リンクの配置を説明する。図３４は、首部Ｃ３での可変長リンクの配置を説明する斜視図である。首部Ｃ３は、３個の第２部材側リンク取付部Ｊ１７、Ｊ１８、Ｊ１９と３個の第１部材側リンク取付部Ｊ１４、Ｊ１５、Ｊ１６とをそれぞれ結ぶ３本の可変長リンク２８Ｌ、２９Ｌ、３０Ｌを有する。そのため、３本の可変長リンク２８Ｌ、２９Ｌ、３０Ｌの長さを変更することで、頭部２の胸部５に対する接続角度を３回転自由度で変更できる。首関節部２７のＸ軸回りの回転角度をαp、Ｙ軸回りの回転角度をβp、Ｚ軸回りの回転角度をγpとする。
首関節部２７は、第２部材側リンク取付部Ｊ１８、Ｊ１９を結ぶ線分上にある。第２部材側三角形Ｔ２は、二等辺三角形であり、首関節部２７は底辺の中点にある。そのため、第２部材２を前後方向に傾ける場合には、可変長リンク２８Ｌの長さを変えるだけでよい。第２部材２を左右方向に傾ける場合には、可変長リンク２９Ｌ、３０Ｌの一方を長くし、もう一方を短くすればよい。
他の関節部で、捻り軸との角度が変更可能な第１部材に設けられた２個の第１部材側リンク取付部を結ぶ線分上に関節部が存在するように第１部材側リンク取付部を配置する場合も、同様な効果がある。あるいは、捻り軸との角度が変更可能な第２部材に設けられた２個の第２部材側リンク取付部を結ぶ線分上に関節部が存在するように第２部材側リンク取付部を配置する場合も、同様な効果がある。
図３５は、基準状態で首部Ｃ３での可変長リンクの配置を首部中心棒２６が延在する方向から見た図である。基準状態で、可変長リンク２９Ｌ、３０Ｌと捻り軸２６とはねじれの関係にある。可変長リンク２８Ｌの第１部材側リンク取付部Ｊ１４と捻り軸２６とを含むリンク基準面と可変長リンク２８Ｌとがなす傾斜角度θp1は、０度である。可変長リンク２９Ｌ、３０Ｌの傾斜角度θp2、θp3は、約１６度である。３本の可変長リンク２８Ｌ、２９Ｌ、３０Ｌのそれぞれが捻り軸２６となす角度の最大値θpmaxは約１６度であり、δ0（例えば、３度程度）以上である。可変長リンク２８Ｌ、２９Ｌ、３０Ｌの長さを変化させた場合に、捻り軸２６の回りに回転するトルクが発生し、捻り軸２６の回りを回転させることができる。
頭部２を傾けた場合でも、３個の傾斜角角度の最大値θpmaxはδ0以上である。図３６は、頭部２を回転させて前方に傾けた状態での首部Ｃ３での可変長リンクの配置を首部中心棒２６が延在する方向から見た図である。図３６では、頭部２を左に１５度捻って、左に１５度の方向に３０度前に傾けた状態での可変長リンクの配置を示す。可変長リンク２８Ｌ、３０Ｌの傾斜角度θp1、θp3が大きくなり、可変長リンク２９Ｌの傾斜角度θp2が小さくなる。捻り軸２６の回りに回転させない場合は、第２部材（頭部）２を前後に傾けても、可変長リンク２９Ｌ、３０Ｌの傾斜角度θp2、θp3は、約１６度で変化しない。第２部材２を左右に傾ける場合は、可変長リンク２９Ｌ、３０Ｌの傾斜角度θp2、θp3の一方が大きくなり、もう一方が小さくなる。したがって、可変長リンク２８Ｌ、２９Ｌ、３０Ｌのそれぞれの長さが取りうる範囲内で変化する各場合で、どれか１本の可変長リンクは、捻り軸２６に対してねじれの関係にあり、３本のリンクの傾斜角度の中での最大値θpmaxは、約１６度以上である。
３個の第１部材側リンク取付部で決まる平面、または、３個の第２部材側リンク取付部で決まる平面を、リンク取付平面と呼ぶ。捻り軸である首中心棒２６とリンク取付平面の交点を、捻り中心と呼ぶ。第１部材である胸部５側に存在する第１部材側リンク取付部Ｊ１４、Ｊ１５、Ｊ１６は、リンク取付平面の上で、捻り中心から等距離にある円周上に中心角が１２０度となる３点に配置される。第２部材である頭部２側の第２部材側リンク取付部Ｊ１７、Ｊ１８、Ｊ１９は、リンク取付平面の上で、首関節部２７に対して等距離で、互いに９０度、９０度、１８０度の中心角を有する位置に配置される。そのため、首関節部２７がどのように回転しても、可変長リンク２８Ｌ、２９Ｌ、３０Ｌが３本とも、捻り軸２６と同一平面上になることはない。すなわち、可変長リンク２８Ｌ、２９Ｌ、３０Ｌの少なくとも１本は、捻り軸２６とねじれの関係にある。
他の３回転自由度接続機構でも、第１部材側のリンク取付平面での捻り中心と３個の第１部材側リンク取付部とがなす３個の中心角と、第２部材側のリンク取付平面での捻り中心と３個の第２部材側リンク取付部とがなす３個の中心角とを異ならせている。そのため、３本の可変長リンクを含む平面が捻り軸も含むことが、３本の可変長リンクすべてで同時に発生することはない。１本の可変長リンク（リンクＡと呼ぶ）が捻り軸と同一平面上に配置される状態で、リンクＡと捻り軸が同一平面上であることを維持するように、その平面に垂直な回転軸の回りに関節部を可動範囲内で回転させる。この可動範囲内の関節部の回転では、以下のどちらかの状態になる。(A)残りの２本の可変長リンクの少なくとも一本は、捻り軸と同一平面上に配置されない。(B)残りの２本の可変長リンクは、それぞれ異なる回転角度で捻り軸と同一平面上に配置される。そのため、関節部がどのように回転しても、可変長リンクを含む平面が捻り軸も含むことが、３本の可変長リンクすべてで同時に発生することはない。すなわち、３本の可変長リンクの少なくとも１本は、捻り軸とねじれの関係にある。
首部中心棒２６（捻り軸）の回りに回転する際に、首部右側リンク２９Ｌおよび首部左側リンク３０Ｌの一方は長くなり、もう一方は短くなる。そのため、捻り軸の回りに回転する際に、伸びるリンクにより押される力と、短くなるリンクにより引かれる力の両方が発生して、捻り軸の回りに回転しやすくなる。
図１０から図１６、図３７を参照して肩部Ｃ４の構造を説明する。図３７は、人型ロボット１００の上半身の斜視図である。上腕部７は、肩関節部１３により胸部５に２回転自由度を有して回転可能に接続する。上腕部７および前腕部８は真っすぐな棒状である。上腕部７の棒状の部分を上腕骨部７Ｂと呼ぶ。前腕部８の棒状の部分を前腕骨部８Ｂと呼ぶ。肩関節部１３から決められた距離の位置の上腕骨部７Ｂに、上腕部駆動主リンク１４Ｌが２回転自由度を有して回転可能に取付けられる上腕部主リンク取付部Ｊ２０が設けられる。上腕部主リンク取付部Ｊ２０は、上腕骨部７Ｂに設けられた回転部材を上腕部駆動主リンク１４Ｌの一端に設けられた半円状のヨークが挟む構造の２軸ジンバルである。回転部材は、上腕骨部７Ｂが延在する方向の回り（軸回り）を回転するように上腕骨部７Ｂに設けられる。ヨークは、回転部材を上腕骨部７Ｂとなす角度を変更可能に挟む。回転部材の両側から出る突起を、上腕部駆動主リンク１４Ｌ側のヨークが回転可能に挟む。突起は円柱状である。２個の突起は、回転部材に垂直な同一直線上に存在する。上腕部主リンク取付部Ｊ２０は、上腕骨部７Ｂの軸回りの１回転自由度を含む２回転自由度を有する。
上腕部駆動主リンク１４Ｌの上腕部主リンク取付部Ｊ２０から決められた距離の位置に、上腕部駆動主リンク側補助リンク取付部Ｊ２１が設けられる。上腕部駆動主リンク側補助リンク取付部Ｊ２１に、上腕部駆動補助リンク１５Ｌの一端が１回転自由度を有して回転可能に取付けられる。上腕部駆動主リンク１４Ｌおよび上腕部駆動補助リンク１５Ｌの中心線は同一平面上にある。上腕部駆動主リンク１４Ｌおよび上腕部駆動補助リンク１５Ｌの中心線が存在する平面を、リンク移動面と呼ぶ。上腕部駆動主リンク側補助リンク取付部Ｊ２１では、リンク移動面において上腕部駆動主リンク１４Ｌと上腕部駆動補助リンク１５Ｌがなす角度を変更できる１回転自由度を有して回転可能に、上腕部駆動補助リンク１５Ｌが上腕部駆動主リンク１４Ｌに取付けられる。上腕部駆動主リンク側補助リンク取付部Ｊ２１は、上腕部駆動主リンク１４Ｌに設けられた突起（軸部材）を、上腕部駆動補助リンク１５Ｌの一端に設けられたヨークが挟む構造である。上腕部駆動主リンク１４Ｌに設けられた突起は、リンク移動面に垂直に設けられる。
リンク移動面は、胸側主リンク取付部Ｊ１、胸側補助リンク取付部Ｊ２、上腕部駆動主リンク側補助リンク取付部Ｊ２１により決まる平面である。上腕部駆動主リンク１４Ｌおよび上腕部駆動補助リンク１５Ｌの長さが変化すると、上腕部駆動主リンク１４Ｌおよび上腕部駆動補助リンク１５Ｌがリンク移動面において移動する。さらに、リンク移動面は、胸側主リンク取付部Ｊ１と胸側補助リンク取付部Ｊ２を通る直線（リンク移動面回転軸と呼ぶ）の回りを回転する。上腕部駆動主リンク１４Ｌおよび上腕部駆動補助リンク１５Ｌの長さがある条件を満足して変化する場合は、リンク移動面が回転しない場合がある。別の条件が満足して変化する場合は、リンク移動面だけが回転してリンク移動面内では上腕部駆動主リンク１４Ｌおよび上腕部駆動補助リンク１５Ｌが移動しない場合もある。リンク移動面回転軸は、胸側主リンク取付部Ｊ１の回転部材が回転する回転軸および胸側補助リンク取付部Ｊ２の回転部材が回転する回転軸でもある。
上腕部駆動主リンク１４Ｌおよび上腕部駆動補助リンク１５Ｌは、リンク移動面に存在する。リンク移動面においては、上腕部駆動主リンク１４Ｌと上腕部駆動補助リンク１５Ｌとの相対的な位置関係は、上腕部駆動主リンク側補助リンク取付部Ｊ２１で上腕部駆動主リンク１４Ｌと上腕部駆動補助リンク１５Ｌとがなす角度が変化するだけである。したがって、上腕部駆動主リンク側補助リンク取付部Ｊ２１はリンク移動面内での回転だけができる１回転自由度でよい。上腕部駆動主リンク側補助リンク取付部Ｊ２１は、２回転自由度を有してもよい。
図３８は、左の肩関節部１３での可変長リンクの配置を説明する斜視図である。肩関節部１３、胸側主リンク取付部Ｊ１および胸側補助リンク取付部Ｊ２は、胸部５に固定されており、互いの相対的な位置関係は固定である。上腕部主リンク取付部Ｊ２０は、肩関節部１３からの距離が決まっている。上腕部駆動主リンク側補助リンク取付部Ｊ２１は、上腕部駆動主リンク１４Ｌ上で、上腕部主リンク取付部Ｊ２０から決められた距離の位置に存在する。上腕部主リンク取付部Ｊ２０の３次元空間での位置が決まると、肩関節部１３から上腕部主リンク取付部Ｊ２０へ向かう方向に上腕骨部７Ｂは向く。上腕部主リンク取付部Ｊ２０の位置を変更することで、胸部５に対して上腕骨部７Ｂを含む上腕部７を動かすことができる。上腕部駆動主リンク１４Ｌおよび上腕部駆動補助リンク１５Ｌは、トラス構造を構成する。
上腕部駆動主リンク１４Ｌおよび上腕部駆動補助リンク１５Ｌの長さが決まると、肩関節部１３、胸側主リンク取付部Ｊ１および胸側補助リンク取付部Ｊ２のそれぞれからの上腕部主リンク取付部Ｊ２０までの距離が決まる。３点からの上腕部主リンク取付部Ｊ２０までの距離が決まるので、上腕部主リンク取付部Ｊ２０の位置が決まる。
上腕部駆動主リンク１４Ｌの長さを長くすることで上腕骨部７Ｂが上がり、短くすることで上腕骨部７Ｂが下がる。上腕部駆動補助リンク１５Ｌを長くすることで上腕骨部７Ｂが前に出て、短くすることで上腕骨部７Ｂが背側に移動する。上腕骨部７Ｂは、肩関節部１３を回転の中心にして決められた可動範囲内で自由に動くことができる。例えば、上下方向および前後方向に関して、下向きを０度とし、前向きを９０度として、−３０度から９５度程度まで、上腕骨部７Ｂを回転できる。また、左右方向には、外側に９５度程度、正面を越えて内側に５度（−５度）程度、上腕骨部７Ｂを回転できる。
肩関節部１３で使用するタイプの２軸ジンバルでは、２軸ジンバルの回転部材の回転軸Ｒx1（図５に示す）の方向に上腕骨部７Ｂが向いた場合（特異点と呼ぶ）は、２軸ジンバルのヨークに直交する方向には上腕骨部７Ｂを傾けることができない。回転軸Ｒx1の方向を、水平面内で人型ロボット１００の左右方向（Ｘ軸方向）に対して後側にξ１の角度をなす方向としている。そうすることで、特異点が肩関節部１３よりも後側に存在することになる。そのため、上腕骨部７Ｂを左右方向よりも前側の可動範囲内で自由に動かすことができる。従来の人型ロボットでは、肩関節部の２軸ジンバルの特異点を避けて動くために不自然な動きをする場合がある。人型ロボット１００では、可動範囲内では特異点を避けるための不自然な動きをしなくてもよい。つまり、人型ロボット１００では、その動きを自然な人の動きに従来よりも近づけることができる。
肩関節部１３は、胸部５の上部に存在して左右方向に延在する肩部フレーム５１の端部に存在する。肩関節部１３は、胸部５の中心から遠い側でかつ後方側に延びた回転軸Ｒx1の回りに回転可能である。さらに、回転軸Ｒx1と上腕骨部７Ｂとがなす角度を変更する回転が可能である。肩関節部１３は、上腕骨部７Ｂを２回転自由度を有して回転可能に胸部５に接続する。胸側主リンク取付部Ｊ１は、肩関節部１３よりも下側かつ前側の位置で胸部５に設けられる。胸側補助リンク取付部Ｊ２は、肩関節部１３よりも下側かつ後側の位置で胸部５に設けられる。なお、胸側主リンク取付部Ｊ１を肩関節部１３よりも後側に設け、胸側補助リンク取付部Ｊ２を前側に設けてもよい。胸側主リンク取付部Ｊ１および胸側補助リンク取付部Ｊ２を、前後方向に肩関節部１３を挟む位置に設ければよい。
肩部Ｃ４は、第１部材である胸部５に第２部材である上腕部７を肩関節部１３により回転可能に接続する回転接続機構である。肩関節部１３は、胸部５に上腕骨部７Ｂを含む上腕部７を、２回転自由度を有して回転可能に接続する関節部である。肩部Ｃ４は、肩関節部１３の角度を変更して上腕部７を胸部５に対して移動させる。
上腕部駆動主リンク１４Ｌが、４回転自由度または５回転自由度を有する第１リンクである。上腕部主リンク取付部Ｊ２０が、肩関節部１３に対する相対的な位置関係が固定されて上腕部７に設けられた第２部材第１取付部である。上腕部主リンク取付部Ｊ２０には、上腕部駆動主リンク１４Ｌの一端が少なくとも２回転自由度を有して回転可能に取付けられる。胸側主リンク取付部Ｊ１が、上腕部駆動主リンク１４Ｌの他端が少なくとも２回転自由度を有して回転可能に取付けられる第１部材第１取付部である。胸側主リンク取付部Ｊ１は、肩関節部１３に対する相対的な位置関係が固定されて胸部５に設けられた第１基準点でもある。上腕部駆動主リンク１４Ｌ自体が、１回転自由度を有する。上腕部駆動主リンク１４Ｌ自体は、１回転自由度を有しなくてもよい。モータ１４Ｍは、上腕部駆動主リンク１４Ｌの長さを変更する力を発生させる第１動力源である。上腕部駆動主リンク１４Ｌの長さは、上腕部主リンク取付部Ｊ２０と胸側主リンク取付部Ｊ１の距離である。上腕部駆動主リンク１４Ｌ、上腕部主リンク取付部Ｊ２０、胸側主リンク取付部Ｊ１およびモータ１４Ｍを有する上腕部駆動主アクチュエータ１４が、第１アクチュエータである。
上腕部駆動補助リンク１５Ｌが、３回転自由度または４回転自由度または５回転自由度を有する第２リンクである。上腕部駆動主リンク側補助リンク取付部Ｊ２１が、上腕部主リンク取付部Ｊ２０に対する相対的な位置関係が固定されて上腕部駆動主リンク１４Ｌに設けられた第１リンク第２取付部である。上腕部駆動主リンク側補助リンク取付部Ｊ２１には、上腕部駆動補助リンク１５Ｌの一端が少なくとも１回転自由度を有して回転可能に取付けられる。胸側補助リンク取付部Ｊ２は、肩関節部１３に対する相対的な位置関係が固定されて胸部５に設けられた第２基準点である。上腕部駆動補助リンク１５Ｌ自体が、１回転自由度を有する。上腕部駆動補助リンク１５Ｌ自体は、１回転自由度を有しなくてもよい。胸側補助リンク取付部Ｊ２が、上腕部駆動補助リンク１５Ｌの他端が少なくとも２回転自由度を有して回転可能に取付けられる第１部材第２取付部である。モータ１５Ｍは、上腕部駆動補助リンク１５Ｌの長さを変更する力を発生させる第２動力源である。上腕部駆動補助リンク１５Ｌの長さは、上腕部駆動主リンク側補助リンク取付部Ｊ２１と胸側補助リンク取付部Ｊ２の距離である。上腕部駆動補助リンク１５Ｌ、上腕部駆動主リンク側補助リンク取付部Ｊ２１、胸側補助リンク取付部Ｊ２、モータ１５Ｍを有する上腕部駆動補助アクチュエータ１５が、第２アクチュエータである。
上腕部駆動主リンク１４Ｌおよび上腕部駆動補助リンク１５Ｌが伸縮しても、上腕部駆動主リンク側補助リンク取付部Ｊ２１は必ずリンク移動面上に存在する。したがって、上腕部駆動主リンク側補助リンク取付部Ｊ２１は、リンク移動面に垂直な回転軸（垂直回転軸と呼ぶ）の回りに回転可能な１回転自由度を持たせる。
胸側主リンク取付部Ｊ１および胸側補助リンク取付部Ｊ２が、リンク移動面回転軸と垂直回転軸とによる２回転自由度を有する。したがって、上腕部駆動主リンク１４Ｌおよび上腕部駆動補助リンク１５Ｌがどのように伸縮しても、上腕部駆動主リンク１４Ｌおよび胸側補助リンク取付部Ｊ２はねじれることはない。そのため、上腕部駆動主リンク１４Ｌおよび上腕部駆動補助リンク１５Ｌは、軸回りの１回転自由度は不要である。上腕部駆動主リンク１４Ｌは４回転自由度を有し、上腕部駆動補助リンク１５Ｌは３回転自由度を有する。なお、胸側主リンク取付部Ｊ１において上腕部駆動主リンク１４Ｌがリンク移動面回転軸の回りを回転すると、垂直回転軸もリンク移動面回転軸の回りを回転する。胸側補助リンク取付部Ｊ２において上腕部駆動補助リンク１５Ｌがリンク移動面回転軸の回りを回転すると、垂直回転軸もリンク移動面回転軸の回りを回転する。
上腕部主リンク取付部Ｊ２０には、上腕骨部７Ｂの軸回りの１回転自由度を含む２回転自由度を持たせる。そうすることで、上腕部主リンク取付部Ｊ２０において上腕骨部７Ｂの軸回りの角度が変化すること、および上腕骨部７Ｂと上腕部駆動主リンク１４Ｌとの間で角度が変化することに対応できる。
胸側主リンク取付部Ｊ１が、リンク移動面回転軸および垂直回転軸とは異なる方向の回転軸を含む２回転自由度である場合は、上腕部駆動主リンク１４Ｌがねじれる。ねじれを吸収するために、上腕部駆動主リンク１４Ｌに軸回りの１回転自由度を持たせる。あるいは、上腕部駆動主リンク側補助リンク取付部Ｊ２１を２回転自由度にしてもよい。上腕部駆動主リンク側補助リンク取付部Ｊ２１に追加する１回転自由度は、上腕部駆動主リンク１４Ｌの軸回りの１回転自由度である。なお、胸側主リンク取付部Ｊ１が３回転自由度を有する場合は、上腕部駆動主リンク１４Ｌは軸回りの１回転自由度を持たなくてもよく、上腕部駆動主リンク側補助リンク取付部Ｊ２１に回転自由度を追加しなくてもよい。
胸側補助リンク取付部Ｊ２が、リンク移動面回転軸および垂直回転軸とは異なる方向の回転軸を含む２回転自由度である場合は、上腕部駆動補助リンク１５Ｌがねじれる。ねじれを吸収するために、上腕部駆動補助リンク１５Ｌに軸回りの１回転自由度を持たせる。あるいは、上腕部駆動主リンク側補助リンク取付部Ｊ２１を２回転自由度にしてもよい。上腕部駆動主リンク側補助リンク取付部Ｊ２１に追加する１回転自由度は、上腕部駆動補助リンク１５Ｌの軸回りの１回転自由度である。なお、上腕部駆動主リンク１４Ｌがねじれることを防止するために上腕部駆動主リンク側補助リンク取付部Ｊ２１を２回転自由度にしている場合は、上腕部駆動主リンク側補助リンク取付部Ｊ２１を３回転自由度にする。胸側補助リンク取付部Ｊ２が３回転自由度を有する場合は、上腕部駆動補助リンク１５Ｌは軸回りの１回転自由度を持たなくてもよく、上腕部駆動主リンク側補助リンク取付部Ｊ２１に回転自由度を追加しなくてもよい。
胸側主リンク取付部Ｊ１および胸側補助リンク取付部Ｊ２の一方が、リンク移動面回転軸と垂直回転軸とによる２回転自由度を有し、他方がリンク移動面回転軸および垂直回転軸とは異なる方向の回転軸を含む２回転自由度である場合は、胸側主リンク取付部Ｊ１の回転自由度のと胸側補助リンク取付部Ｊ２の回転自由度の合計を、８回転自由度にすればよい。つまり、上腕部駆動主リンク１４Ｌまたは上腕部駆動補助リンク１５Ｌに軸回りの１回転自由度を持たせるか、あるいは上腕部駆動主リンク側補助リンク取付部Ｊ２１を２回転自由度にすればよい。胸側主リンク取付部Ｊ１または胸側補助リンク取付部Ｊ２を３回転自由度にしてもよい。
胸側主リンク取付部Ｊ１および胸側補助リンク取付部Ｊ２の両方が、リンク移動面回転軸および垂直回転軸とは異なる方向の回転軸を含む２回転自由度である場合は、胸側主リンク取付部Ｊ１の回転自由度のと胸側補助リンク取付部Ｊ２の回転自由度の合計を、９回転自由度にすればよい。
胸側主リンク取付部Ｊ１および胸側補助リンク取付部Ｊ２の位置は固定されているが、どちらか少なくとも一方が移動可能な場合は、リンク移動面がリンク移動面回転軸の回りを回転するとは限らないので、上腕部駆動主リンク側補助リンク取付部Ｊ２１が少なくとも２回転自由度を持つ必要がある。
関節部が３回転自由度の場合は、第１リンクおよび第２リンクに５回転自由度を持たせると共に、第２部材と第１部材との間に５回転自由度を有する第３リンクを追加する。以上のことは、２回転自由度または３回転自由度で回転可能に第２部材を第１部材に接続する回転接続機構にあてはまる。
図１１から図１５、図３９から図４４を参照して肘部Ｃ５の構造を説明する。図３９と図４０は、左の上肢部３の正面図および側面図である。図４１と図４２は、左の上肢部３の肘関節部３１までの部分を拡大した正面図および側面図である。図４３は、左右の肘関節部３１を９０度曲げた状態での人型ロボット１００の正面図である。図４４は、左右の肘関節部３１を９０度曲げた状態での人型ロボット１００の上から見た平面図である。図４３と図４４では、体幹部１と左右の上肢部３だけを示す。図４３と図４４では、右の上腕部７が体幹部１から離れるように移動し、左の上腕部７が体幹部１に近づくように移動し、左右の肘関節部３１を９０度曲げている。図４４から分るように、左右の前腕骨部８Ｂは、体幹部１の正面方向に対してそれぞれ外側に開いた方向を向いている。つまり、肘関節部３１の主に曲がる方向は、体幹部１の正面方向（Ｙ軸）と角度ξ２をなす方向である。
上肢部３の正面方向は、肘関節部３１が主に曲がる方向だけに９０度曲げたときの前腕骨部８Ｂが向く方向である。人型ロボット１００が直立して上肢部３を鉛直下向きにした時に、上肢部３の正面方向は、人型ロボット１００の正面方向よりもξ２だけ外側を向いている。そのため、人型ロボット１００の正面図である図２では、上肢部３を斜めから見ることになる。上肢部３の説明では、上肢部３の正面方向をＹ軸方向とし、上肢部３の正面方向と直交する方向をＸ軸方向とする。
前腕部８は、上腕部７に肘関節部３１により２回転自由度を有して回転可能に接続される。肘関節部３１は、上腕部７と同じ方向の回転軸Ｒz2を有する２軸ジンバルである。２軸ジンバルでは、回転軸Ｒz2の回りに前腕部８が回転する。さらに、前腕部８の上腕部７に対する角度も変更できる。肘関節部３１では、回転部材は上腕部７に設けられ、ヨークは前腕骨部８Ｂに設けられる。上腕部７および前腕部８には、肘部駆動外側リンク３２および肘部駆動内側リンク３３が取付けられる。肘部駆動外側リンク３２および肘部駆動内側リンク３３は、長さが決まったリンクであり、２本の肘駆動リンクである。肘部駆動外側リンク３２および肘部駆動内側リンク３３は、リンクのねじれを可能とする１回転自由度を有する。
肘部駆動外側リンク３２および肘部駆動内側リンク３３の上腕部７への取付位置は、移動可能である。そのために、上腕骨部７Ｂの両側に、２本のリニアガイドである上腕部外側リニアガイド３４Ｇおよび上腕部内側リニアガイド３５Ｇが、上腕骨部７Ｂに平行に設けられる。図１１などに示すように、上腕部７の肩関節部１３の近くには、上腕部外側リニアガイド３４Ｇのモータ３４Ｍと上腕部内側リニアガイド３５Ｇのモータ３５Ｍを保持するモータ保持具７Ａが設けられる。
肘部駆動外側リンク３２の上腕部７への取付位置である上腕部外側リンク取付部Ｊ２２は、上腕部外側アクチュエータ３４により移動する。肘部駆動内側リンク３３の上腕部７への取付位置である上腕部内側リンク取付部Ｊ２３は、上腕部内側アクチュエータ３５により移動する。上腕部外側リンク取付部Ｊ２２および上腕部内側リンク取付部Ｊ２３には、肘部駆動外側リンク３２および肘部駆動内側リンク３３がそれぞれ２回転自由で取付けられる。肘部駆動外側リンク３２および肘部駆動内側リンク３３は、トラス構造を構成する。
図４１を参照して、上腕部外側アクチュエータ３４の構造を説明する。上腕部外側アクチュエータ３４は、上腕部外側リニアガイド３４Ｇ、肘部駆動外側リンク３２、肘部駆動外側リンク取付部Ｊ２５、上腕部外側リンク取付部Ｊ２２およびモータ３４Ｍを有する。上腕部外側リニアガイド３４Ｇは、枠体である上腕部外側フレーム３４Ｆの内部にねじ棒３４Ａ、ナット３４Ｂ、レール３４Ｃおよび把持部３４Ｄを有する。
モータ３４Ｍは、上腕部外側リニアガイド３４Ｇの裏に配置している。そうすることで、上腕部外側リニアガイド３４Ｇおよびモータ３４Ｍをコンパクトにできる。モータ３４Ｍは、肩関節部１３に近い側でタイミングベルトにより力をねじ棒３４Ａに伝えて、ねじ棒３４Ａを回転させる。タイミングベルトを使用することで、ギヤで力を伝える場合よりも軽量にできる。ねじ棒３４Ａの雄ねじとかみ合う雌ねじが設けられた貫通穴を有するナット３４Ｂは、ねじ棒３４Ａの長さ方向に移動可能である。ナット３４Ｂをねじ棒３４Ａの回りに回転させない機構が設けられている。そのため、ねじ棒３４Ａが回転すると、ナット３４Ｂがねじ棒３４Ａに沿って移動する。上腕部外側リンク取付部Ｊ２２はナット３４Ｂに取付けられており、ナット３４Ｂが移動すると上腕部外側リンク取付部Ｊ２２も移動する。ナット３４Ｂは、上腕部外側アクチュエータ３４により移動する移動部材である。
ナット３４Ｂをねじ棒３４Ａの回りに回転させない機構は、ねじ棒３４Ａと平行に設けられたレール３４Ｃと、レール３４Ｃを挟みナット３４Ｂに接続した把持部３４Ｄを有する。把持部３４Ｄは、レール３４Ｃと間の摩擦は小さくなるように設けられる。把持部３４Ｄがレール３４Ｃを挟んでいるので、把持部３４Ｄおよびナット３４Ｂはねじ棒３４Ａの回りを回転しない。他の機構により、ナット３４Ｂをねじ棒３４Ａの回りに回転しないようにしてもよい。
上腕部内側アクチュエータ３５も、上腕部外側アクチュエータ３４と同様な構造である。上腕部内側リニアガイド３５Ｇ、肘部駆動内側リンク３３、肘部駆動内側リンク取付部Ｊ２４、上腕部内側リンク取付部Ｊ２３およびモータ３５Ｍを有する。上腕部内側リニアガイド３５Ｇは、枠体である上腕部内側フレーム３５Ｆの内部にねじ棒３５Ａ、ナット３５Ｂ、レール３５Ｃおよび把持部３５Ｄを有する。上腕部内側リンク取付部Ｊ２３はナット３５Ｂに取付けられている。ナット３５Ｂは、上腕部内側アクチュエータ３５により移動する移動部材である。
上腕部外側フレーム３４Ｆと上腕部内側フレーム３５Ｆは一体に製造している。一体に製造することで、コンパクトにでき、強度も高くできる。なお、上腕部外側フレーム３４Ｆと上腕部内側フレーム３５Ｆを、別体に製造してもよい。
レール３４Ｃおよびレール３５Ｃは、長方形の板材の両側の辺である。レール３４Ｃ、レール３５Ｃ、ねじ棒３４Ａおよびレール３５Ｃを互いに平行に配置する必要がある。上腕部外側リニアガイド３４Ｇおよび上腕部内側リニアガイド３５Ｇを決められた精度で配置する必要がある。そのための作業には、時間を要する。
把持部３５Ｄは、ナット３５Ｂに設けられている。把持部３５Ｄは、レール３５Ｃに係合する。把持部３５Ｄとレール３５Ｃは、第１移動部材であるナット３５Ｂがねじ棒３５Ａの回りに回転することを防止する第１回転防止部である。
把持部３４Ｄは、ナット３４Ｂに設けられている。把持部３４Ｄは、レール３４Ｃに係合する。把持部３４Ｄとレール３４Ｃは、第２移動部材であるナット３４Ｂがねじ棒３４Ａの回りに回転することを防止する第２回転防止部である。
上腕部外側リンク取付部Ｊ２２は、次のような構造を有する２軸ジンバルである。上腕部外側アクチュエータ３４により移動する移動部材であるナット３４Ｂに回転部材、回転部材により回転するヨーク、およびヨークが回転可能に挟む軸部材が設けられる。肘部駆動外側リンク３２の端部には、軸部材が入る貫通穴が設けられる。上腕部内側リンク取付部Ｊ２３も、同様な構造の２軸ジンバルである。
前腕骨部８Ｂの肘関節部３１から決められた距離の位置に、肘部駆動内側リンク取付部Ｊ２４が設けられる。肘部駆動内側リンク取付部Ｊ２４には、肘部駆動内側リンク３３の一端が２回転自由度を有して回転可能に取付けられる。肘部駆動内側リンク取付部Ｊ２４は、上腕部外側リンク取付部Ｊ２２と同様な構造の２軸ジンバルである。肘部駆動内側リンク３３の肘部駆動内側リンク取付部Ｊ２４から決められた距離の位置に、肘部駆動外側リンク取付部Ｊ２５が設けられる。肘部駆動外側リンク取付部Ｊ２５には、肘部駆動外側リンク３２の他端が２回転自由度を有して回転可能に取付けられる。肘部駆動外側リンク取付部Ｊ２５は、肘部駆動内側リンク３３に設けられた突起を、肘部駆動外側リンク３２の一端から伸びるヨークが挟む構造である。肘部駆動外側リンク取付部Ｊ２５のヨークは、肘部駆動外側リンク３２と肘部駆動内側リンク３３とがなす角度が小さい場合でも突起を挟めるように、十分な長さを持たせる。肘部駆動内側リンク３３の突起が設けられた部分は、肘部駆動内側リンク３３の回りを回転可能である。肘部駆動外側リンク３２の一端から伸びるヨークは、肘部駆動内側リンク３３とヨークとがなす角度が変更可能なように突起を挟む。肘部駆動外側リンク取付部Ｊ２５は、肘部駆動内側リンク３３の軸回りの１回転自由度を含む２回転自由度を有する。
上腕部外側リンク取付部Ｊ２２および肘部駆動外側リンク取付部Ｊ２５のどちらか少なくとも一方を、３回転自由度を有するようにしてもよい。上腕部内側リンク取付部Ｊ２３および肘部駆動内側リンク取付部Ｊ２４のどちらか少なくとも一方を、３回転自由度を有するようにしてもよい。
図４５は、左の肘部Ｃ５でのリンク配置を説明する斜視図である。肘関節部３１、上腕部外側アクチュエータ３４および上腕部内側アクチュエータ３５は、上腕部７に固定されている。上腕部外側リンク取付部Ｊ２２は、上腕部外側アクチュエータ３４により上腕骨部７Ｂに沿って移動する。上腕部内側リンク取付部Ｊ２３は、上腕部内側アクチュエータ３５に沿って移動する。前腕部８に設けられる肘部駆動内側リンク取付部Ｊ２４は、肘関節部３１から決められた距離Ｋ1uの位置に存在する。肘部駆動内側リンク３３に設けられる肘部駆動外側リンク取付部Ｊ２５は、肘部駆動内側リンク取付部Ｊ２４（厳密には、その回転中心）から決められた距離Ｋ2uの位置に存在する。前腕部８は、肘関節部３１（厳密には、その回転中心）から距離Ｋ1uの位置にある肘部駆動内側リンク取付部Ｊ２４の方向に向く。肘部駆動内側リンク取付部Ｊ２４の位置を変更することで、上腕部７に対して前腕部８を動かすことができる。
肘部駆動内側リンク３３および肘部駆動外側リンク３２は、長さが決まっている。上腕部外側リンク取付部Ｊ２２および上腕部内側リンク取付部Ｊ２３が上腕骨部７Ｂに沿って移動することで、肘部駆動内側リンク取付部Ｊ２４の位置が変化する。
肘部Ｃ５は、肘関節部３１、肘部駆動内側リンク３３、肘部駆動外側リンク３２、前腕側主リンク取付部である肘部駆動内側リンク取付部Ｊ２４、肘部駆動内側リンク３３に設けられた肘部駆動主リンク側補助リンク取付部である肘部駆動外側リンク取付部Ｊ２５、２個の上腕側リンク取付部である上腕部内側リンク取付部Ｊ２３および上腕部外側リンク取付部Ｊ２２、２本のリニアガイドである上腕部外側リニアガイド３４Ｇおよび上腕部内側リニアガイド３５Ｇを有して構成される。
上腕部外側リンク取付部Ｊ２２および上腕部内側リンク取付部Ｊ２３が共に肩関節部１３に近くなるように移動すると、肘関節部３１が曲がって前腕部８が上腕部７に近づく。肩関節部１３から遠くなるように移動すると、肘関節部３１が伸びて前腕部８が上腕部７から離れる。上腕部外側リンク取付部Ｊ２２を肩関節部１３に近くなるように移動させ、上腕部内側リンク取付部Ｊ２３は遠くなるように移動させると、前腕部８が外側を向く。上腕部内側リンク取付部Ｊ２３を肩関節部１３に近くなるように移動させ、上腕部外側リンク取付部Ｊ２２は遠くなるように移動させると、前腕部８が内側を向く。
肘関節部３１は、上腕骨部７Ｂと前腕骨部８Ｂが１直線になる状態から、上腕骨部７Ｂと前腕骨部８Ｂとの間の角度が例えば７０度程度になるまで、上肢部３の正面方向と上腕骨部７Ｂとを含む平面内（肘主駆動面）で角度を変化させることができる。上腕骨部７Ｂに垂直な平面内（肘副駆動面）では、肘関節部３１を直角に曲げた状態で、内側および外側に例えば７０度程度は回転できる。肘主駆動面での肘関節部３１の回転角度が直角（９０度）でない場合は、肘副駆動面での回転角度は直角の場合よりも小さくなる。肘関節部３１の回転角度が１８０度の状態すなわち肘関節部３１を伸ばした状態では、肘副駆動面で回転できない。
肘関節部３１を駆動する２本のリンクを固定長にして上腕部においてリンク取付部の位置を移動させる方式とすることで、肘関節部３１を駆動する機構をコンパクトにできる。肘関節部を２本の可変長リンクで駆動する場合には、肘関節部を肘副駆動面で回転させるために、２本のリンクが前腕部の取付位置でなす角度を決められた角度以上にする必要がある。そのためには、２本の可変長リンクの取付位置の間隔は、この実施の形態で使用する２本のリニアガイドの間隔よりも広くする必要がある。
肘部駆動内側リンク３３は、長さが決まった肘部駆動主リンクである。肘部駆動外側リンク３２は、長さが決まった肘部駆動補助リンクである。肘部駆動内側リンク取付部Ｊ２４は、肘部駆動内側リンク３３一端が少なくとも２回転自由度を有して回転可能に取付けられる前腕側主リンク取付部である。肘部駆動外側リンク取付部Ｊ２５は、肘部駆動外側リンク３２の一端が少なくとも２回転自由度を有して回転可能に取付けられる肘部駆動主リンク側補助リンク取付部である。上腕部内側リンク取付部Ｊ２３および上腕部外側リンク取付部Ｊ２２は、肘部駆動内側リンク３３および肘部駆動外側リンク３２の他端がそれぞれ少なくとも２回転自由度を有して回転可能に取付けられ、上腕骨部７Ｂに沿って移動可能に上腕部７に設けられた２個の上腕側リンク取付部である。
肘部駆動外側リンク３２の前腕部８側の一端を、肘部駆動内側リンク３３ではなく前腕部８に取付けるようにしてもよい。その場合には、２個の前腕側リンク取付部が前腕部８に設けられることになる。２個の前腕側リンク取付部のそれぞれには、２本の肘部駆動リンクである肘部駆動外側リンク３２および肘部駆動内側リンク３３の一端がそれぞれ少なくとも２回転自由度を有して回転可能に取付けられる。
上腕部外側アクチュエータ３４が有するナット３４Ｂは、肘部駆動外側リンク３２を移動させる移動部材である。上腕部内側アクチュエータ３５が有するナット３５Ｂは、肘部駆動内側リンク３３を移動させる移動部材である。ねじ棒３４Ａおよびねじ棒３５Ａは、ナット３４Ｂおよびナット３５Ｂをそれぞれ上腕骨部７Ｂに沿って移動させるガイド部である。モータ３４Ｍは、ねじ棒３４Ａに対するナット３４Ｂの位置を変更する力を発生させる動力源である。モータ３５Ｍは、ねじ棒３５Ａに対するナット３５Ｂの位置を変更する力を発生させる動力源である。上腕部外側リニアガイド３４Ｇは、ナット３４Ｂ、ねじ棒３４Ａおよびモータ３４Ｍを有するリニアガイドである。上腕部内側リニアガイド３５Ｇは、ナット３５Ｂ、ねじ棒３５Ａおよびモータ３５Ｍを有するリニアガイドである。
肘部Ｃ５は、第１部材である上腕部７に第２部材である前腕部８を肘関節部３１により回転可能に接続する回転接続機構である。肘関節部３１は、上腕部７に前腕部８を、２回転自由度を有して回転可能に接続する関節部である。肘部Ｃ５は、肘関節部３１の角度を変更して前腕部８を上腕部７に対して移動させる。
肘部駆動内側リンク３３が、５回転自由度を有する長さが固定された第１リンクである。肘部駆動内側リンク取付部Ｊ２４が、肘関節部３１に対する相対的な位置関係が固定されて前腕部８に設けられた第２部材第１取付部である。肘部駆動内側リンク取付部Ｊ２４には、肘部駆動内側リンク３３の一端が少なくとも２回転自由度を有して回転可能に取付けられる。上腕部内側リンク取付部Ｊ２３が、肘部駆動内側リンク３３の他端が少なくとも２回転自由度を有して回転可能に取付けられる第１部材第１取付部である。ナット３５Ｂが、上腕部内側リンク取付部Ｊ２３が設けられた第１移動部材である。ねじ棒３５Ａが、ナット３５Ｂが沿って移動する第１移動軸である。上腕部内側リニアガイド３５Ｇは、上腕部内側フレーム３５Ｆにより両端が保持されたねじ棒３５Ａなどを有する。上腕部内側リニアガイド３５Ｇが、ナット３５Ｂをねじ棒３５Ａに沿って移動するようにガイドする第１ガイド部を構成する。
モータ３５Ｍが、ねじ棒３５Ａに対するナット３５Ｂ位置を変更させる力を発生させる動力源である。点Ｐ１Ｎ（図８２に図示）は、ねじ棒３５Ａの中心を通る直線が上腕部内側フレーム３５Ｆの上端と交わる点である。点Ｐ１Ｎが、肘関節部３１に対する相対的な位置関係が固定されて上腕部７に設けられた第１基準点である。モータ３５Ｍが回転してねじ棒３５Ａが回転することで、ナット３５Ｂがねじ棒３５Ａに沿って移動する。ナット３５Ｂが移動すると、点Ｐ１Ｎと肘部駆動内側リンク取付部Ｊ２４の距離が変化する。モータ３５Ｍは、点Ｐ１Ｎと肘部駆動内側リンク取付部Ｊ２４の距離を変更する力を発生させる動力源である。肘部駆動内側リンク３３、上腕部内側リニアガイド３５Ｇ、肘部駆動内側リンク取付部Ｊ２４、上腕部内側リンク取付部Ｊ２３およびモータ３５Ｍを有する上腕部内側アクチュエータ３５が、第１アクチュエータである。
肘部駆動外側リンク３２が、５回転自由度を有する長さが固定された第２リンクである。肘部駆動外側リンク取付部Ｊ２５が、肘部駆動内側リンク取付部Ｊ２４に対する相対的な位置関係が固定されて肘部駆動内側リンク３３に設けられた第１リンク第２取付部である。肘部駆動外側リンク取付部Ｊ２５には、肘部駆動外側リンク３２の一端が少なくとも２回転自由度を有して回転可能に取付けられる。肘部駆動外側リンク取付部Ｊ２５の回転自由度は、肘部駆動内側リンク３３の軸回りの１回転自由度を含む。上腕部外側リンク取付部Ｊ２２が、肘部駆動外側リンク３２の他端が少なくとも２回転自由度を有して回転可能に取付けられる第１部材第２取付部である。ナット３４Ｂが、上腕部外側リンク取付部Ｊ２２が設けられた第２移動部材である。ねじ棒３４Ａが、ナット３４Ｂが沿って移動する第２移動軸である。上腕部内側リニアガイド３４Ｇは、上腕部内側フレーム３４Ｆにより両端が保持されたねじ棒３４Ａなどを有する。上腕部内側リニアガイド３４Ｇが、ナット３４Ｂをねじ棒３４Ａに沿って移動するようにガイドする第２ガイド部を構成する。
モータ３４Ｍが、ねじ棒３４Ａに対するナット３４Ｂの位置を変更させる力を発生させる動力源である。点Ｐ２Ｎ（図８２に図示）は、ねじ棒３４Ａの中心を通る直線が上腕部外側フレーム３４Ｆの上端と交わる点である。点Ｐ２Ｎが、肘関節部３１に対する相対的な位置関係が固定されて上腕部７に設けられた第２基準点である。モータ３４Ｍが回転してねじ棒３４Ａが回転することで、ナット３４Ｂがねじ棒３５Ａに沿って移動する。ナット３４Ｂが移動すると、点Ｐ２Ｎと肘部駆動外側リンク取付部Ｊ２５の距離が変化する。モータ３４Ｍは、点Ｐ２Ｎと肘部駆動外側リンク取付部Ｊ２５の距離を変更する力を発生させる動力源である。肘部駆動外側リンク３２、上腕部外側リニアガイド３４Ｇ、肘部駆動外側リンク取付部Ｊ２５、上腕部外側リンク取付部Ｊ２２およびモータ３４Ｍを有する上腕部外側アクチュエータ３４が、第２アクチュエータである。
図４６から図４９を参照して、手首部Ｃ６の構造を説明する。図４６、図４７、図４８、図４９は、骨格構造での左の肘関節部３１から先の部分を拡大した斜視図、正面図、左側面図、裏面図である。
人間の手に似た手部９は、前腕部８に手首関節部３６により３回転自由度を有して回転可能に接続される。手首関節部３６には、棒状の前腕骨部８Ｂの一端に設けられた球面を回転可能に保持する球面軸受が用いられる。球面を受ける部材は手首板部９１に設けられる。手部９は、手首関節部３６の回りを３回転自由度で回転できる。３本のアクチュエータすなわち前腕部正面アクチュエータ３７、前腕部外側アクチュエータ３８、前腕部内側アクチュエータ３９の長さが変化すると、手部９と前腕骨部８Ｂとの間の角度が変化する。手部９を前腕骨部８Ｂに対して、例えば、手の平の方向（正面方向）に２０度程度、手の甲の方向（裏面方向）に２０度程度、前腕骨部８Ｂの方向および正面から裏面に向かう方向に垂直な方向の両側にそれぞれ２０度程度、傾けることができる。前腕骨部８Ｂの回りに両方向に７０度程度、手部９を回転できる。
手首部Ｃ６の正面方向および裏面方向の可動範囲の角度が小さいが、肘部Ｃ５と合わせて９０度、曲げることができる。手の平を壁などにあてて押しつける際は、例えば、手首部Ｃ６で手の甲側に２０度曲げて、残りは、肘部Ｃ５を７０度程度曲げて、結果的に体の上下軸と平行な手の平の面を作り出し、胸面と平行に手の平を押し出す動作となる。
前腕部正面リンク３７Ｌ、前腕部外側リンク３８Ｌおよび前腕部内側リンク３９Ｌの一端を前腕部８に取付けるために、前腕部８の手首関節部３６から決められた距離の位置に前腕部正面リンク取付部Ｊ２６、前腕部外側リンク取付部Ｊ２７および前腕部内側リンク取付部Ｊ２８が設けられる。前腕部正面リンク取付部Ｊ２６は、前腕部８の正面に設けられる。前腕部外側リンク取付部Ｊ２７は、前腕部８に垂直な平面で前腕部正面リンク取付部Ｊ２６に対して９０度の角度をなす位置に設けられる。前腕部内側リンク取付部Ｊ２８は、前腕部外側リンク取付部Ｊ２７との間の角度が１８０度になる位置に設けられる。前腕部外側リンク取付部Ｊ２７と前腕部内側リンク取付部Ｊ２８を結ぶ線分の中点が、前腕部８の断面の中心と一致する。
手部９は、手首板部９１、板状の掌板部９２、掌板部９２を手首板部９１に垂直に接続する手部取付部９８、４本の普通指部である第１指部９３、第２指部９４、第３指部９５、第４指部９６、および対向可能指部９７を有する。手首板部９１は、長い辺と短い辺が交互に並ぶ６角形の板状である。４本の普通指部は、掌板部９２の手首板部９１と反対側に接続される。対向可能指部９７は、４本の普通指部とは異なる方向で掌板部９２に４接続し、普通指部と対向する位置に移動できる。手首板部９１は、手首関節部３６を介して前腕骨部８Ｂと接続する。４本の普通指部は、ほぼ同じ方向を向いて並ぶ。
手部９は、人間の手に似ている。対向可能指部９７は親指に相当し、第１指部９３、第２指部９４、第３指部９５、第４指部９６はそれぞれ、人差指、中指、薬指、小指に相当する。
掌板部９２において、指部が曲がる側に存在する面を手の平側とよび、その反対側の面を手の甲側と呼ぶ。手部では、手の平側を正面とし、手の甲側を裏面とする。掌板部９２と平行な平面において、普通指部が延在する方向を指先方向と呼ぶ。指先方向は、手首から指先に向かう方向である。指先方向と直交する方向を手幅方向と呼ぶ。
前腕部正面リンク取付部Ｊ２６は、前腕部８の正面側に出る回転部材により回転するヨークに、前腕部正面リンク３７Ｌの一端に設けられた軸部材が回転可能に保持される２軸ジンバルである。前腕部外側リンク取付部Ｊ２７、前腕部内側リンク取付部Ｊ２８も同様な構造の２軸ジンバルである。前腕部８の正面から裏面に向かう方向は、手部９において第１指部９３から第４指部９６が並ぶ方向とほぼ平行である。
前腕部正面リンク３７Ｌでは、手部９側でモータ３７Ｍが発生する力がタイミングベルトによりナット３７Ｂに伝えられる構造である。前腕部正面リンク３７Ｌは、可変長リンクの円筒とモータの間からＬ字状に伸びるリンク取付具３７Ｎを介して前腕部正面リンク取付部Ｊ２６に取付けられる。モータの一端は、片側の取付位置よりも肘関節部３１に近い位置に存在する。前腕部外側リンク３８Ｌ、前腕部内側リンク３９Ｌも同様な構造である。
手首板部９１が前腕骨部８Ｂに垂直であり対向可能指部９７が上肢部３の正面方向に存在する状態が、手部９の基準状態である。手首板部９１に前腕部正面リンク３７Ｌ、前腕部外側リンク３８Ｌおよび前腕部内側リンク３９Ｌのもう一端を取付けるために、手首板部９１の前腕部８側の面に手部側正面リンク取付部Ｊ２９、手部側外側リンク取付部Ｊ３０および手部側内側リンク取付部Ｊ３１が設けられる。
手部側正面リンク取付部Ｊ２９、手部側外側リンク取付部Ｊ３０、手部側内側リンク取付部Ｊ３１および手首関節部３６は、同一平面上に存在する。手部側正面リンク取付部Ｊ２９、手部側外側リンク取付部Ｊ３０および手部側内側リンク取付部Ｊ３１は、正三角形を構成する位置に配置される。手首関節部３６、その正三角形の重心に位置する。そのため、手首関節部３６は、手部側外側リンク取付部Ｊ３０および手部側内側リンク取付部Ｊ３１を結ぶ線分の二等分線上に存在する。手部側正面リンク取付部Ｊ２９は、前腕骨部８Ｂと前腕部正面リンク取付部Ｊ２６で決まる平面上に基準状態では存在する。
手部側正面リンク取付部Ｊ２９は、手首板部９１の前腕部８側の面に設けられた突起から手首関節部３６の方向に出る回転部材により回転するヨークに、前腕部正面リンク３７Ｌの一端に設けられた軸部材が回転可能に保持される２軸ジンバルである。手部側外側リンク取付部Ｊ３０、手部側内側リンク取付部Ｊ３１も同様な構造の２軸ジンバルである。
前腕部正面リンク３７Ｌ、前腕部外側リンク３８Ｌおよび前腕部内側リンク３９Ｌのそれぞれは、その一端が手部側正面リンク取付部Ｊ２９、手部側外側リンク取付部Ｊ３０および手部側内側リンク取付部Ｊ３１のそれぞれに２回転自由度を有して回転可能に取付けられる。それぞれの他端は、前腕部正面リンク取付部Ｊ２６、前腕部外側リンク取付部Ｊ２７、前腕部内側リンク取付部Ｊ２８のそれぞれに２回転自由度を有して回転可能に取付けられる。
手首部Ｃ６は、第２部材である手部９を第１部材である前腕部８に３回転自由度を有して回転可能に回転可能に接続する３回転自由度接続機構である。手首部Ｃ６は、関節部である手首関節部３６、３本の可変長リンクである前腕部正面リンク３７Ｌ、前腕部外側リンク３８Ｌおよび前腕部内側リンク３９Ｌ、３個の第１部材側リンク取付部である前腕部正面リンク取付部Ｊ２６、前腕部外側リンク取付部Ｊ２７および前腕部内側リンク取付部Ｊ２８、３個の第２部材側リンク取付部である手部側正面リンク取付部Ｊ２９、手部側外側リンク取付部Ｊ３０および手部側内側リンク取付部Ｊ３１を有して構成される。
前腕骨部８Ｂは、第１部材である前腕部８に対して方向が固定された捻り軸である。前腕骨部８Ｂは、手部９に対する角度が変更可能である。前腕部正面リンク取付部Ｊ２６、前腕部外側リンク取付部Ｊ２７および前腕部内側リンク取付部Ｊ２８では、手首関節部３６に対する相対的な位置関係は、固定されている。第２部材である手部９に設けられたリンク取付部である手部側正面リンク取付部Ｊ２９、手部側外側リンク取付部Ｊ３０および手部側内側リンク取付部Ｊ３１でも、手首関節部３６に対する相対的な位置関係は、手首板部９１により固定されている。
手首部Ｃ６での可変長リンクの配置を説明する。図５０は、左の手首部Ｃ６での可変長リンクの配置を説明する斜視図である。３個の第１部材側リンク取付部Ｊ２６、Ｊ２７、Ｊ２８と３個の第２部材側リンク取付部Ｊ２９、Ｊ３０、Ｊ３１とをそれぞれ結ぶ３本の可変長リンク３７Ｌ、３８Ｌ、３９Ｌを、手首部Ｃ６は有する。そのため、３本の可変長リンク３７Ｌ、３８Ｌ、３９Ｌの長さを変更することで、手部９の前腕骨部８Ｂに対する接続角度を３回転自由度で変更できる。手首関節部３６のＸ軸回りの回転角度をαv、Ｙ軸回りの回転角度をβv、Ｚ軸回りの回転角度をγvとする。
手首関節部３６は、第２部材側リンク取付部Ｊ２９、Ｊ３０、Ｊ３１で決まるリンク取付平面の上にある。そのため、手首関節部３６は、リンク取付平面と捻り軸８との交点である捻り中心でもある。第２部材三角形Ｔ３は、正三角形である。手首関節部３６は、第２部材三角形Ｔ３の重心の位置に存在する。第２部材側リンク取付部Ｊ２９と捻り中心を通る直線に対して、第２部材側リンク取付部Ｊ３０、Ｊ３１は対称に配置される。
図５１は、基準状態で左の手首部Ｃ６での可変長リンクの配置を前腕部が延在する方向から見た図である。基準状態で、可変長リンク３８Ｌ、３９Ｌは、捻り軸８とねじれの関係にある。可変長リンク３７Ｌの第１部材側リンク取付部Ｊ２６と捻り軸８とを含むリンク基準面と可変長リンク３７Ｌとがなす傾斜角度θv1は、０度である。可変長リンク３８Ｌ、３９Ｌの傾斜角度θv2、θv3は、約８．１度である。基準状態では、３本の可変長リンク３７Ｌ、３８Ｌ、３９Ｌの傾斜角度の最大値θvmaxは約８．１度であり、δ0（例えば、３度程度）以上である。可変長リンク３８Ｌ、３９Ｌの長さを変化させる場合に、捻り軸８の回りに回転するトルクが発生し、捻り軸８の回りを回転させることができる。
手部９を前腕骨部８Ｂに対して可動範囲内で傾けたり捻ったりした場合でも、３本の可変長リンク３７Ｌ、３８Ｌ、３９Ｌの少なくとも１本は捻り軸８とねじれの関係にあり、その傾斜角度の最大値θvmaxは、δ0以上である。基準状態では、可変長リンク３７Ｌは捻り軸８と同一平面上にあり、可変長リンク３８Ｌ、３９Ｌは捻り軸８とねじれの関係にある。可変長リンク３８Ｌ、３９Ｌの傾斜角度θv2、θv3の両方が小さくなるのは、手部９を第４指部９６側に傾ける場合である。手部９を第４指部９６側に傾ける場合には、可変長リンク３７Ｌは捻り軸８と同一平面上にある。図５２は、左の手首部Ｃ６を第４指部９６側に傾けた状態での可変長リンクの配置を前腕骨部８Ｂが延在する方向から見た図である。図５２では、第４指部９６側に２０度、手部９を傾けている。可変長リンク３８Ｌ、３９Ｌの傾斜角度θv2、θv3は、約７．４度である。手首部Ｃ６を手の平の方向または手の甲方向に傾ける場合、および手首部Ｃ６を捻り軸８の回りに回転させる場合は、可変長リンク３８Ｌ、３９Ｌの傾斜角度θv2、θv3の一方が大きくなり、もう一方が小さくなる。
図１１、図２１、図２２、図５３から図６１を参照して、大腿部１０を腰部６に対して動かす股部Ｃ７の構造を説明する。図５３、図５４、図５５は、骨格構造での腰部から下の部分の正面図、左側面図および背面図である。図５６は、骨格構造での膝関節部４０から下の部分の斜視図である。図５７、図５８、図５９は、大腿部を拡大した正面図、左側面図および背面図である。図６０は、大腿部を右斜め前から見た斜視図である。図６１は、大腿部を右斜め後から見た斜視図である。
図５３に示されるように、基準状態では、正面から見た大腿部１０を通る直線を股関節部２２よりも上側に延ばした直線上に、股部正面リンク取付部Ｊ１１が存在する。股部外側リンク取付部Ｊ１２は、水平に外側に出ている。股部内側リンク取付部Ｊ１３は、内側で斜め前下の方向に出ている。基準状態では、正面から見ると、股関節部２２、膝関節部４０、足首関節部４１が鉛直な同一直線上に存在する。図５８に示すように、平板上の下肢部接続フレーム６２は、水平面（ＸＹ平面）に対して角度ξ３（約４５度）で傾斜し、前方が高い。そのため、股部正面リンク取付部Ｊ１１、股部外側リンク取付部Ｊ１２および股部内側リンク取付部Ｊ１３で決まる平面は、その法線が前方斜め下を向く。
大腿部１０は、棒状の大腿骨部１０Ａ、大腿骨部１０Ａに垂直に設けられた膝部側リンク取付板１０Ｂ、膝部側リンク取付板１０Ｂと膝関節部４０をつなぐ２個のフレームである膝部接続フレーム１０Ｃを有する。膝部接続フレーム１０Ｃは、膝関節部４０が大腿骨部１０Ａよりも後方に位置するように、大腿骨部１０Ａに対して傾斜して膝部側リンク取付板１０Ｂと接続する。膝部側リンク取付板１０Ｂに設けられた３個のリンク取付部に、股関節部２２を３回転自由度で回転させる３本の可変長リンクの一端がそれぞれ取付けられる。膝関節部４０が大腿骨部１０Ａよりも後方に存在することで、基準状態で股関節部２２、膝関節部４０、足首関節部４１が、正面から見て鉛直線上に存在するように配置しやすい。
大腿部正面リンク２３Ｌ、大腿部外側リンク２４Ｌおよび大腿部内側リンク２５Ｌは、大腿部１０に垂直な膝部側リンク取付板１０Ｂに設けられた膝部正面リンク取付部Ｊ３２、膝部外側リンク取付部Ｊ３３および膝部内側リンク取付部Ｊ３４にそれぞれ取付けられる。膝部側リンク取付板１０Ｂは、中心側でつながった３個の長方形が互いに１２０度の角度を有する方向に伸びた形状である。膝部正面リンク取付部Ｊ３２が設けられる長方形は、大腿部１０の正面側に存在する。
膝部正面リンク取付部Ｊ３２は、２個の円筒が十字型に接合した十字部材を使用して２回転自由度で回転可能とする構造である。膝部側リンク取付板１０Ｂに、十字部材の一方の円筒を回転可能に保持するヨークが設けられる。大腿部正面リンク２３Ｌの一端には、十字部材の他方の円筒を回転可能に保持するヨークが設けられる。
膝部外側リンク取付部Ｊ３３、膝部内側リンク取付部Ｊ３４も、膝部正面リンク取付部Ｊ３２と同様な構造である。
股部Ｃ７は、第２部材である大腿部１０を第１部材である腰部６に３回転自由度で回転可能に接続する３回転自由度接続機構である。股部Ｃ７は、関節部である股関節部２２、３本の可変長リンクである大腿部正面リンク２３Ｌ、大腿部外側リンク２４Ｌおよび大腿部内側リンク２５Ｌ、３個の第１部材側リンク取付部である股部正面リンク取付部Ｊ１１、股部外側リンク取付部Ｊ１２および股部内側リンク取付部Ｊ１３、３個の第２部材側リンク取付部である膝部正面リンク取付部Ｊ３２、膝部外側リンク取付部Ｊ３３および膝部内側リンク取付部Ｊ３４を有して構成される。
捻り軸である大腿骨部１０Ａは、大腿部１０に対して方向が固定されている。大腿骨部１０Ａは、腰部６に対する角度が変更可能である。股部正面リンク取付部Ｊ１１、股部外側リンク取付部Ｊ１２および股部内側リンク取付部Ｊ１３では、股関節部２２に対する相対的な位置関係は、下肢部接続フレーム６２により固定されている。膝部正面リンク取付部Ｊ３２、膝部外側リンク取付部Ｊ３３および膝部内側リンク取付部Ｊ３４でも、股関節部２２に対する相対的な位置関係は、大腿骨部１０Ａおよび膝部側リンク取付板１０Ｂにより固定されている。
股関節部２２を動かすための可変長リンクの配置を説明する。図６２は、左の股部Ｃ７での可変長リンクの配置を説明する斜視図である。３個の第１部材側リンク取付部Ｊ１１、Ｊ１２、Ｊ１３と３個の第２部材側リンク取付部Ｊ３２、Ｊ３３、Ｊ３４とをそれぞれ結ぶ３本の可変長リンク２３Ｌ、２４Ｌ、２５Ｌを、股部Ｃ７は有する。そのため、３本の可変長リンク２３Ｌ、２４Ｌ、２５Ｌの長さを変更することで、大腿部１０の腰部６に対する接続角度を３回転自由度で変更できる。股関節部２２のＸ軸回りの回転角度をαq、Ｙ軸回りの回転角度をβq、Ｚ軸回りの回転角度をγqとする。
股部Ｃ７は、大腿部１０を前方に例えば９０度程度上げることができ、後方に例えば１０度上げることができる。左右方向には、内側に例えば１０度程度、外側に３０度程度、大腿部１０を動かすことができる。また、大腿骨部１０Ａの回りに、例えば、外側（股を開く向き）に２０度程度、内側に１０度の捻り回転ができる。
図６３は、左の股部Ｃ７での可変長リンクの配置を大腿骨部が延在する方向から見た図である。基準状態で、可変長リンク２４Ｌ、２５Ｌと捻り軸１０Ａとはねじれの関係にある。可変長リンク２３Ｌの第２部材側リンク取付部Ｊ３２と捻り軸１０Ａとを含むリンク基準面と可変長リンク２３Ｌとがなす傾斜角度θq1は、０度である。可変長リンク２４Ｌの傾斜角度θq2は、約１．９度である。可変長リンク２５Ｌの傾斜角度θq3は、約３．９度である。３本の可変長リンク２３Ｌ、２４Ｌ、２５Ｌの傾斜角度の最大値θqmaxは、δ0（例えば、３度程度）以上である。可変長リンク２４Ｌ、２５Ｌの長さを変化させた場合に、捻り軸１０Ａの回りに回転するトルクが発生し、捻り軸１０Ａの回りを回転させることができる。
図６４は、左の股部Ｃ７の大腿部１０を左前方に上げた状態での可変長リンクの配置を大腿骨部１０Ａが延在する方向から見た図である。図６４は、左前方１５度の方向に大腿部１０を３０度上げた状態である。大腿部１０を上げると、図６４から分るように、下肢部接続フレーム６２が図における上下方向に長くなり、可変長リンク２５Ｌの傾斜角度θq3は、図６３の場合よりも大きくなっている。また、可変長リンク２３Ｌの傾斜角度θq1も、大きくなっている。大腿部１０を可動範囲内で動かす際に、すなわち股関節部２２の可動範囲内の各状態で、少なくとも１本の可変長リンク２３Ｌ、２４Ｌ、２５Ｌは捻り軸１０Ａとねじれの関係にある。また、股関節部２２の可動範囲内の各状態で、３本の可変長リンク２３Ｌ、２４Ｌ、２５Ｌの傾斜角度の最大値θqmaxは、δ0（例えば、３度程度）以上である。
股関節部２２が大腿骨部１０Ａの回りに回転可能であることは、人型ロボット１００が方向を変えて歩く際に必要である。股関節部２２が大腿骨部１０Ａの回りに回転できない場合には、人型ロボット１００は正面を向いたまま斜め方向に歩くことになる。また、下肢部３を動かして体全体の向きを変える際には、股関節部２２で開脚方向を変更できる必要がある。
図６５により、股関節部２２を動かす可変長リンクを正面側で高く裏面側で低く取付けることによる効果を説明する。図６５では、図を簡明にするため、可変長リンク２３Ｌ、２４Ｌだけを示す。図６５では、左側にこの実施の形態１のように股関節部２２を動かす可変長リンク２３Ｌ、２４Ｌ、２５Ｌを正面側で高く裏面側で低く取付けた場合の側面図を示す。右側に、股関節部２２を動かす可変長リンク２３Ｌ、２４Ｌ、２５Ｌをすべて同じ高さに取付けた場合の側面図を示す。直立した状態を実線で示し、大腿部を前に４５度および可動範囲の限界まで上げた状を破線で示す。
股関節部２２を動かす可変長リンク２３Ｌ、２４Ｌ、２５Ｌをすべて同じ高さに取付けると、正面側で高くした場合よりも股関節部２２の前側の可動範囲が小さくなる。大腿部１０および膝関節部４０が前方に位置する方向に股関節部２２を回転させると、可変長リンク２３Ｌと下肢部接続フレーム６２とが干渉するからである。正面側の可変長リンク２３Ｌを高い位置にすると、可変長リンク２３Ｌと下肢部接続フレーム６２とが干渉しにくくなり、股関節部２２を前側に大きく回転させることができ、大腿部１０をより上まで上げることができる。
すべて同じ高さに取付ける場合には、可動範囲が狭いにも関わらず、可動範囲の限界まで股関節部２２を動かす際に、正面側を高く取付けた場合よりも、可変長リンク２４Ｌを長くする必要がある。逆に、可変長リンク２３Ｌは短くする必要がある。
図５３から図６２を参照して、下腿部１１を大腿部１０に対して動かす膝部Ｃ８の構造を説明する。図５６に示すように、膝関節部４０は、板状の下腿部１１を２個の膝部接続フレーム１０Ｃが挟んで、回転軸を通した構造である。基準状態では、回転軸はＸ軸に平行である。２個の膝部接続フレーム１０Ｃは、強度を高めるために正面側で連結板１０Ｄにより連結している。連結板１０Ｄは、膝関節部４０が逆方向に曲がることを防止する機能も持つ。図５８などに示すように、膝関節部４０は、大腿部１０の裏側に設けられた１本の膝部駆動アクチュエータ４２が有する膝部駆動リンク４２Ｌが長さを変えることにより、角度が変更される。下腿部１１は、膝関節部４０の近くで曲がり、足首関節部４１から決められた距離の位置でも曲がった板状の部材である。下腿部１１は、膝関節部４０と足首関節部４１とを結ぶ直線よりも前側に存在する。
膝部駆動アクチュエータ４２は、膝関節部４０の側で動力源であるモータ４２Ｍからの力がギヤで膝部駆動リンク４２Ｌに伝えられる構造である。
股関節部２２に近い大腿骨部１０Ａの後側の位置に、膝部駆動リンク４２Ｌの一端が１回転自由度を有して回転可能に取付けられる膝部駆動リンク取付部Ｊ３５が設けられる。
膝部駆動リンク取付部Ｊ３５は、大腿骨部１０Ａ側にヨークが設けられ、膝部駆動リンク４２Ｌの一端に円柱状の軸部材が設けられた構造である。
膝部駆動リンク４２Ｌは、膝関節部４０側では２個の補助具を使用して、大腿部１０と下腿部１１の両方に接続している。２個の補助具とは、大腿部側補助具４３と下腿部側補助具４４である。大腿部側補助具４３は、一端が膝部駆動リンク４２Ｌの一端に回転可能に取付けられる。大腿部側補助具４３の一端と膝部駆動リンク４２Ｌの一端が取付けられる箇所を、膝部駆動リンク補助具接続部Ｊ３７と呼ぶ。大腿部側補助具４３の他端は、大腿部１０の後側に設けられた大腿部側補助具取付部Ｊ３６に回転可能に取付けられる。下腿部側補助具４４の一端も、膝部駆動リンク補助具接続部Ｊ３７に回転可能に取付けられる。下腿部側補助具４４の他端は、下腿部１１の後側に設けられた下腿部側補助具取付部Ｊ３８に回転可能に取付けられる。
大腿骨部１０Ａの膝部側リンク取付板１０Ｂよりも少し手前の位置から棒状の大腿部側補助具取付部１０Ｄが後側に伸びる。大腿部側補助具取付部１０Ｄの先端に、大腿部側補助具取付部Ｊ３６が設けられる。大腿部側補助具取付部Ｊ３６は、膝部側リンク取付板１０Ｂの近くに存在する。大腿部側補助具４３は、２個のフレームの側面を連結した形状である。大腿部側補助具取付部１０Ｄの先端には貫通穴が設けられている。また、大腿部側補助具４３の両端にも貫通穴が設けられている。大腿部側補助具取付部Ｊ３６は、それぞれの貫通穴の位置が一致するように大腿部側補助具４３が大腿部側補助具取付部１０Ｄを挟み、それらの貫通穴を回転軸が通る構造である。
大腿部側補助具４３の反対側の端は、膝部駆動リンク補助具接続部Ｊ３７で下腿部側補助具４４および膝部駆動リンク４２Ｌと１回転自由で接続する。下腿部側補助具４４は、２個のフレームの側面を連結した形状である。膝部駆動リンク補助具接続部Ｊ３７では、大腿部側補助具４３が膝部駆動リンク４２Ｌを挟む。さらに、下腿部側補助具４４が、大腿部側補助具４３および膝部駆動リンク４２Ｌを挟む。この挟んだ箇所には、下腿部側補助具４４、大腿部側補助具４３および膝部駆動リンク４２Ｌに、それぞれ貫通穴が設けられる。それらの貫通穴を通る軸部材により、大腿部側補助具４３、下腿部側補助具４４および膝部駆動リンク４２Ｌは互いに１回転自由度で回転可能である。
下腿部１１が膝関節部４０の側で曲がる箇所の近くに、下腿部側補助具取付部Ｊ３８が設けられる。下腿部側補助具取付部Ｊ３８には、下腿部側補助具４４の一端が１回転自由度を有して回転可能に取付けられる。下腿部側補助具取付部Ｊ３８は、下腿部１１および下腿部側補助具４４に設けられた貫通穴に回転軸を通した構造である。下腿部側補助具取付部Ｊ３８により、下腿部側補助具４４は、下腿部１１に１回転自由度を有して回転可能に取付けられる。
図６６は、左の膝関節部４０を動かす可変長リンクの配置を説明する斜視図である。膝関節部４０、膝部駆動リンク取付部Ｊ３５および大腿部側補助具取付部Ｊ３６は、大腿部１０に固定されており、互いの相対的な位置関係は固定である。下腿部側補助具取付部Ｊ３８は、下腿部１１に固定されている。下腿部側補助具取付部Ｊ３８は、膝関節部４０からの距離が決まっている。膝部駆動リンク補助具接続部Ｊ３７は、大腿部側補助具取付部Ｊ３６および下腿部側補助具取付部Ｊ３８からの距離がそれぞれ決まっている。したがって、膝関節部４０の回転角度が決まると、パンタグラフのように大腿部側補助具４３と下腿部側補助具４４が動き、膝部駆動リンク補助具接続部Ｊ３７の位置が決まる。逆に、膝部駆動リンク補助具接続部Ｊ３７の位置が決まると、膝関節部４０の回転角度が決まる。
膝部駆動リンク４２Ｌの長さは、膝部駆動リンク取付部Ｊ３５と膝部駆動リンク補助具接続部Ｊ３７との間の距離になる。よって、膝部駆動リンク４２Ｌの長さを変えることで、膝関節部４０の回転角度を変えることができる。
膝部Ｃ８は、膝関節部４０、膝部駆動アクチュエータ４２、大腿部１０の後側に設けられた膝部駆動リンク取付部Ｊ３５、大腿部側補助具４３、大腿部１０の後側に設けられた大腿部側補助具取付部Ｊ３６、下腿部側補助具４４、下腿部の後側に設けられた下腿部側補助具取付部Ｊ３８を有して構成される。膝関節部４０は、大腿部１０と下腿部１１を１回転自由度を有して回転可能に接続する。膝部駆動アクチュエータ４２は、長さが変更可能な膝部駆動リンク４２Ｌとモータ４２Ｍを有する。膝部駆動リンク取付部Ｊ３５には、膝部駆動リンク４２の一端が回転可能に取付けられる。大腿部側補助具４３には、一端が膝部駆動リンク４２Ｌの他端に回転可能に取付けられる。大腿部側補助具取付部Ｊ３６には、大腿部側補助具４３の他端が回転可能に取付けられる。下腿部側補助具４４には、一端が膝部駆動リンク４２Ｌの他端に回転可能に取付けられる。下腿部側補助具取付部Ｊ３８には、下腿部側補助具４４の他端が回転可能に取付けられる。
膝部Ｃ８は、股関節部２２、膝関節部４０および足首関節部４１が同一直線上に配置される状態から、大腿部１０と下腿部１１の間の角度が例えば４０度程度まで曲げることができる。
大腿部側補助具４３および下腿部側補助具４４を有するので、膝部駆動リンク４２Ｌの伸縮による力をパンタグラフのようにして大腿部側補助具取付部Ｊ３６および下腿部側補助具取付部Ｊ３８に伝えることができる。そのため、大腿部１０と下腿部１１とが平行に近くなるほどに膝関節部４０を大きく曲げた場合に、膝関節部４０を回転させる力を伝えやすくなる。その結果、膝部駆動アクチュエータ４２が発生する力が小さくても、膝関節部４０の屈伸運動をよりスムーズにできるようになる。
図５３から図５６、図６７から図７０を参照して、足部１２を下腿部１１に対して動かす足首部Ｃ９の構造を説明する。図６７、図６８、図６９および図７０は、下腿部１１から下の部分の正面図、左側面図、背面図および斜視図である。
足首関節部４１は、足部１２を下腿部１１に対して前後および左右の２回転自由度を有して回転可能に接続する２軸ジンバルである。下腿部１１の下端には、下腿部１１が前後方向に回転できるように左右方向の円柱状の部分が設けられている。下腿部１１のこの円柱状の部分を前後回転ヨーク４１Ａが挟んで回転可能に保持し、下腿部１１が前後回転ヨーク４１Ａに対して前後方向に回転できる。前後回転ヨーク４１Ａの前後方向の面には円柱状の部分（軸部材）が設けられている。足部１０に設けられた左右回転ヨーク４１Ｂが、前後回転ヨーク４１Ａの軸部材を前後から挟んで回転可能に保持し、下腿部１１および前後回転ヨーク４１Ａが足部１２に対して左右方向に回転できる。
足部１２は、下腿部外側アクチュエータ４５および下腿部内側アクチュエータ４６により、足首関節部４１の回りを前後および左右の２回転自由度で回転できる。板状の下腿部１１の左右の面に、下腿部外側リンク４５Ｌ、下腿部内側リンク４６Ｌの一端を２回転自由度を有して回転可能に取付ける下腿部外側リンク取付部Ｊ３９、下腿部内側リンク取付部Ｊ４０が設けられる。下腿部外側リンク取付部Ｊ３９は、回転部材、ヨーク、軸部材が下腿１１側に設けられており、下腿部外側リンク４５Ｌの一端に設けられた円筒の中に軸部材が入る構造である。下腿部内側リンク取付部Ｊ４０も同様な構造である。
下腿部外側アクチュエータ４５は、足部１２の側でモータ４５Ｍからの力がギヤで下腿部外側リンク４５Ｌに伝えられる構造である。下腿部内側アクチュエータ４６も、同様な構造である。
足部１２の後部の左右の位置に、下腿部外側リンク４５Ｌ、下腿部内側リンク４６Ｌのもう一端をそれぞれ２回転自由度を有して回転可能に取付ける足部外側リンク取付部Ｊ４１、足部内側リンク取付部Ｊ４２が設けられる。足部外側リンク取付部Ｊ４１、足部内側リンク取付部Ｊ４２は、下腿部外側リンク取付部Ｊ３９、下腿部内側リンク取付部Ｊ４０と同様な構造の２軸ジンバルである。
足部外側リンク取付部Ｊ４１と足部内側リンク取付部Ｊ４２の間隔は、下腿部外側リンク取付部Ｊ３９と下腿部内側リンク取付部Ｊ４０の間隔よりも大きい。そうすることで、足首関節部４１を左右方向に回転させやすくなる。
足部１２は、足首関節部４１、足本体部１２Ａと、足本体部１２Ａの前側に設けられたつま先部１２Ｂとを有する。足本体部１２Ａには、足部外側リンク取付部Ｊ４１および足部内側リンク取付部Ｊ４２が設けられる。足本体部１２Ａとつま先部１２Ｂとの間には、つま先関節部１２Ｃが設けられる。つま先関節部１２Ｃにより、つま先部１２Ｂの足本体部１２Ａに対する上下方向の角度を変更できる。つま先部１２Ｂと足本体部１２Ａとの間には図示しないバネが設けられており、つま先部１２Ｂを曲げる力が加えられるとつま先部１２Ｂが力に応じて適度に曲がる。
足本体部１２Ａの後端の中央に、かかと車輪部１２Ｄが設けられる。かかと車輪部１２Ｄは、適度な回転摩擦を有する車輪である。かかと車輪部１２Ｄが有ることで、人型ロボット１００が歩く際に、足部１２の後側の角（かかと）がなめらかに着地できる。また、かかとの着地を回転しながら知らせるタッチセンサーの役目を、かかと車輪部１２Ｄは有する。つま先関節部１２Ｃ付近の足部１２の側面には、適度な回転摩擦を有する足側面車輪部１２Ｅが設けられる。足側面車輪部１２Ｅは、かかとだけでなく足部１２の全体が着地したことを知らせるタッチセンサーの役目を有する。足側面車輪部１２Ｅにより、移動する際につま先部１２Ｂが床または地面と接触していることを回転しながら検出し、その後、離間したことを検出することができる。
図７１は、左の足首関節部４１を動かす可変長リンクの配置を説明する斜視図である。
足首関節部４１、足部外側リンク取付部Ｊ４１および足部内側リンク取付部Ｊ４２は足本体部１２Ａに固定されており、互いの相対的な位置関係は固定である。下腿部外側リンク取付部Ｊ３９および下腿部内側リンク取付部Ｊ４０は、下腿部１１に固定されている。足首関節部４１、下腿部外側リンク取付部Ｊ３９および下腿部内側リンク取付部Ｊ４０は、互いの相対的な位置関係は固定である。下腿部外側リンク４５Ｌと下腿部内側リンク４６Ｌは、長さが変更可能な可変長リンクである。下腿部外側リンク４５Ｌは、下腿部外側リンク取付部Ｊ３９と足部外側リンク取付部Ｊ４１とを結ぶ。下腿部内側リンク４６Ｌは、下腿部内側リンク取付部Ｊ４０と足部内側リンク取付部Ｊ４２とを結ぶ。下腿部外側リンク４５Ｌおよび下腿部内側リンク４６Ｌの長さを変更すると、下腿部４１の足本体部１２Ａに対する接続角度を、Ｘ軸回りおよびＹ軸回りに変更することができる。足首関節部４１のＸ軸回りの回転角度をαm、Ｙ軸回りの回転角度をβmとする。
足首部Ｃ９は、足首関節部４１、下腿部外側アクチュエータ４５および下腿部内側アクチュエータ４６を有する。足首関節部４１は、下腿部１１の下部と足部１２を少なくとも２回転自由度を有して回転可能に接続する。下腿部外側アクチュエータ４５および下腿部内側アクチュエータ４６は、下腿部外側リンク４５Ｌおよび下腿部内側リンク４６Ｌと、モータ４５Ｍおよびモータ４６Ｍをそれぞれ有する２本の足首部アクチュエータである。
足首部Ｃ９は、さらに、下腿部外側リンク取付部Ｊ３９および下腿部内側リンク取付部Ｊ４０、足部外側リンク取付部Ｊ４１および足部内側リンク取付部Ｊ４２を有する。下腿部外側リンク取付部Ｊ３９および下腿部内側リンク取付部Ｊ４０は、下腿部外側リンク４５Ｌおよび下腿部内側リンク４６Ｌの一端がそれぞれ回転可能に取付けられる下腿部１１に設けられた２個の下腿部側リンク取付部である。足部外側リンク取付部Ｊ４１および足部内側リンク取付部Ｊ４２は、下腿部外側リンク４５Ｌおよび下腿部内側リンク４６Ｌの一端がそれぞれ回転可能に取付けられる２個の足部側リンク取付部である。足部外側リンク取付部Ｊ４１および足部内側リンク取付部Ｊ４２は、足首関節部４１よりも後の位置で足本体部１２Ａに設けられる。
足首部Ｃ９は、足首関節部４１を、足首関節部４１と膝関節部４０を結ぶ直線が足部１２に対して例えば前方６０度程度から後方３０度程度の角度をなす範囲で回転させることができ、左右方向には例えば１５度程度傾けることができる。
下腿部外側リンク４５Ｌおよび下腿部内側リンク４６Ｌを両方とも長くすると、下腿部４１を前に傾けることができる。下腿部外側リンク４５Ｌおよび下腿部内側リンク４６Ｌを両方とも短くすると、下腿部４１を後に傾けることができる。下腿部外側リンク４５Ｌを長くし、下腿部内側リンク４６Ｌ短くすると、下腿部４１を内側に傾けることができる。下腿部外側リンク４５Ｌを短くし、下腿部内側リンク４６Ｌ長くすると、下腿部４１を外側に傾けることができる。
図７２から図７９を参照して、手部９の構造を説明する。図７２は、左の手部９を手の平側から見た斜視図である。図７３は、左の手部９を手の甲側から見た斜視図である。図７４、図７５、図７６、および図７７は、左の手部９の正面図、対向可能指部９７が存在する側から見た側面図、裏面図、および対向可能指部９７が存在しない側から見た側面図である。図７８は、左の手部９を指先側から見た図である。図７９は、左の手部９の第２指部９４を断面で表示した図である。
手首板部９１に掌板部９２を取付ける手部取付部９８は、図７４および図７９から分るように、取付板部９８Ａと掌板接続部９８Ｂとが、横から見るとＬ字状に接続した部材である。取付板部９８Ａは、手首板部９１に接続する。掌板接続部９８Ｂには、掌板部９２が接続される。取付板部９８Ａと向き合う掌板部９２の辺に、第１指部９３、第２指部９４、第３指部９５および第４指部９６が接続する。基準状態では、第１指部９３、第２指部９４、第３指部９５および第４指部９６は、掌板部９２と略平行な方向に延在する。第２指部９４が手首板部９１のほぼ中央に位置する。第１指部９３、第２指部９４、第３指部９５、第４指部９６は、根元側よりも先端側の間隔が広くなるように設けられる。図７６から分るように、第２指部９４は取付板部９８Ａに対して垂直で、第２指部９４の中心と取付板部９８Ａの中心は一致している。
対向可能指部９７は、第１指部９３などにほぼ直交する方向に回転可能に、第１指部９３などよりも取付板部９８Ａに近い側かつ第１指部９３側の掌板部９２に設けられる。掌板部９２は、指部が接続する基部である。手部９の基準状態では、掌板部９２に垂直な方向から見ると、対向可能指部９７は掌板部９２と並んで延在する。
第１指部９３、第２指部９４、第３指部９５および第４指部９６は、同様な構造である。第１指部９３、第２指部９４、第３指部９５、第４指部９６を普通指部と呼ぶ。図において符合が付けやすい第４指部９６で、普通指部の構造を説明する。
第４指部９６は、掌板部９２に近い側から第１指節部９６Ａ、第２指節部９６Ｂおよび第３指節部９６Ｃが直列に接続する。掌板部９２と第１指節部９６Ａとの間には、第１指関節部９６Ｄが存在する。第１指関節部９６Ｄは、第１指節部９６Ａを掌板部９２に回転可能に接続する。第１指節部９６Ａと第２指節部９６Ｂとの間には、第２指関節部９６Ｅが存在する。第２指関節部９６Ｅは、第２指節部９６Ｂを第１指節部９６Ａに回転可能に接続する。第２指節部９６Ｂと第３指節部９６Ｃとの間には、第３指関節部９６Ｆが存在する。第３指関節部９６Ｆは、第３指節部９６Ｃを第２指節部９６Ｂに回転可能に接続する。第１指関節部９６Ｄ、第２指関節部９６Ｅおよび第３指関節部９６Ｆの回転軸は、互いに平行である。
掌板部９２、第１指節部９６Ａ、第２指節部９６Ｂおよび第３指節部９６Ｃの中の隣接する２個に関して、掌板部９２に近い側の部材を基部側部材、基部側部材でない側の部材を先端側部材と呼ぶ。第１指関節部９６Ｄ、第２指関節部９６Ｅ、第３指関節部９６Ｆは、第１指節部９６Ａ、第２指節部９６Ｂ、第３指節部９６Ｃの何れかである先端側部材を基部側部材に回転可能に接続する３個の指関節部である。
基準状態では、第１指関節部９６Ｄは、掌板部９２の裏面側に存在する。図７７に示すように、基準状態での手部９を側面から見ると、第１指関節部９６Ｄ、第２指関節部９６Ｅ、第３指関節部９６Ｆの回転軸は、取付板部９８Ａにほぼ垂直な１個の平面上にある。
この平面上または近くを、基準状態で前腕骨部８Ｂを手部９の方に延長した線が通る。基準状態では、取付板部９８Ａに対して前腕部７が垂直である。
第１指関節部９６Ｄの回転軸は、掌板部９２の裏面側に設けられた指元ヨーク９６Ｇに保持される。第１指関節部９６Ｄの回転軸は、掌板部９２から少し外側に出た決められた位置に配置される。指元ヨーク９６Ｇの間には、指部第１モータ９６Ｈが配置される。第１指部モータ９６Ｈの回転軸に直結した第１ウォーム９６Ｊ(ねじ歯車)が、第１指関節部９６Ｄの回転軸の回りを回転する第１ウォームホイール９６Ｋ(斜歯歯車)とかみ合う。第１ウォーム９６Ｊは、掌板部９２側で第１ウォームホイール９６Ｋとかみ合う。指部第１モータ９６Ｈおよび第１ウォーム９６Ｊは、掌板部９２に対して傾斜して設けられる。第１ウォームホイール９６Ｋは第１指節部９６Ａに取付けられている。第１指部モータ９６Ｈが回転すると、第１ウォーム９６Ｊが回転し、第１ウォームホイール９６Ｋが第１指節部９６Ａと共に回転する。
第１指関節部９６Ｄは、掌板部９２に配置され指部第１モータ９６Ｈ、指部第１モータ９６Ｈにより回転する第１ウォーム９６Ｊ、第１ウォーム９６Ｊとかみ合い第１指節部９６Ａと共に第１指関節部９６Ｄの回転軸の回りを回転する第１ウォームホイール９６Ｋを有するウォームギヤ機構により第１指節部９６Ａを掌板部９２に対して回転させる。
第１指節部９６Ａは、第１ウォームホイール９６Ｋと共に回転する部材と、第２指関節部９６Ｅの回転軸を保持するヨーク部材とが指先に向かう方向で結合した構造である。第１指節部９６Ａに、指部第２モータ９６Ｌが取付けられる。指部第２モータ９６Ｌの回転軸に直結した第２ウォーム９６Ｍが、第２指関節部９６Ｅの回転軸の回りを回転する第２ウォームホイール９６Ｎとかみ合う。指部第２モータ９６Ｌおよび第２ウォーム９６Ｍは、第１指節部９６Ａに対して傾斜して設けられる。第２ウォームホイール９６Ｎは第２指節部９６Ｂに取付けられている。指部第２モータ９６Ｌが回転すると、第２ウォーム９６Ｍが回転し、第２ウォームホイール９６Ｎが第２指節部９６Ｂと共に回転する。
第２指関節部９６Ｅは、第１指節部９６Ａに配置され指部第２モータ９６Ｌ、指部第２モータ９６Ｌにより回転する第２ウォーム９６Ｍ、第２ウォーム９６Ｍとかみ合い第２指節部９６Ｂと共に第２指関節部９６Ｅの回転軸の回りを回転する第２ウォームホイール９６Ｎを有するウォームギヤ機構により第２指節部９６Ｂを第１指節部９６Ａに対して回転させる。
第１指関節部９６Ｄと第２指関節部９６Ｅは、それぞれ別のモータにより駆動されるので、第１指関節部９６Ｄの回転角度と第２指関節部９６Ｅの回転角度は独立に決めることができる。
基準状態において、第１指関節部９６Ｄが第１指節部９６Ａを回転させる方向、第２指関節部９６Ｅが第２指節部９６Ｂを回転させる方向、第３指関節部９６Ｆが第３指節部９６Ｃを回転させる方向は、すべて手の平側に向かう方向である。
指部第１モータ９６Ｈおよび第１ウォーム９６Ｊを掌板部９２に対して傾斜して設けることで、掌板部９２を小さくすることができる。指部第２モータ９６Ｌおよび第２ウォーム９６Ｍを第１指節部９６Ａに対して傾斜して設けることで、第１指節部９６Ａを短くすることができる。その結果、手部９を人の手と同程度の大きさにできる。
第１指節部９６Ａは、ウォームギヤ機構を有する第１指関節部９６Ｄにより掌板部９２に対して回転し、かつウォームギヤ機構を有する第２指関節部９６Ｅにより第２指節部９６Ｂと回転可能に接続する。このように、手部９では、４本の普通指部では手の平側から２個の指関節部である第１指関節部と第２指関節部にウォームギヤ機構を適用している。
図７９を参照して、第３指関節部９４Ｆを回転させる機構を説明する。第３指関節部９４Ｆには、第３指節駆動歯車９４Ｐが設けられる。第３指節駆動歯車９４Ｐは、第３指節部９４Ｃと共に回転する。第２指節部９４Ｂには、３個のアイドラギヤ９４Ｑ、９４Ｒ、９４Ｓが設けられる。３個のアイドラギヤ９４Ｑ、９４Ｒ、９４Ｓは、第２ウォームホイール９４Ｎの回転を第３指節駆動歯車９４Ｐに伝える。アイドラギヤ９４Ｑは第２ウォームホイール９４Ｎとかみ合い、第２ウォームホイール９４Ｎが回転すると、反対方向に回転する。アイドラギヤ９４Ｒはアイドラギヤ９４Ｑとかみ合い、アイドラギヤ９４Ｑが回転すると、反対方向に回転する。アイドラギヤ９４Ｓはアイドラギヤ９４Ｒとかみ合い、アイドラギヤ９４Ｒが回転すると、反対方向に回転する。第３指節駆動歯車９４Ｐはアイドラギヤ９４Ｓとかみ合い、アイドラギヤ９４Ｓが回転すると、反対方向に回転する。アイドラギヤ９４Ｑ、９４Ｒ、９４Ｓが３個と奇数個なので、第２ウォームホイール９４Ｎが回転すると、第３指節駆動歯車９４Ｐが同じ方向に回転する。
アイドラギヤ９４Ｑ、９４Ｒ、９４Ｓは、第２指関節部９４Ｅが有する第２ウォームホイール９４Ｎにより駆動される奇数個の回転軸で回転する歯車である。第３指節駆動歯車９４Ｐは、アイドラギヤ９４Ｑ、９４Ｒ、９４Ｓにより駆動される第３指関節部９４Ｆに設けられた歯車である。第２ウォームホイール９４Ｎは、第２指関節部９４Ｅの回転と連動して回転する歯車である。
第２ウォームホイール９４Ｎ、アイドラギヤ９４Ｑ、９４Ｒ、９４Ｓ、第３指節駆動歯車９４Ｐのギヤ比は、第２ウォームホイール９４Ｎの回転角度φ2と第３指節駆動歯車９４Ｐの回転角度φ3が同じになるように決めている。つまり、φ3のφ2に対する比の値ｆ＝φ3/φ2を、ｆ＝１としている。第２ウォームホイール９４Ｎすなわち第２指節部９４Ｂの回転角度φ2に対する第３指節駆動歯車９４Ｐすなわち第３指節部９４Ｃの回転角度φ3の比の値ｆ＝φ3/φ2は、１に近い適切な値であればよい。
第３指関節部を第２指関節部に連動させて回転させることで、１本の指部あたり２個のモータで３個の指関節部を回転させることができる。第２指関節部を曲げないで第３指関節部だけを曲げるような動作をする必要がある場合はほとんどないので、手部９を使用する上で問題にはならない。なお、第３指関節部も、第１指関節部および第２指関節部と同様にウォームギヤ機構で回転させるようにしてもよい。ある指では第３指関節部を第２指関節部に連動させて回転させ、別の指では第３指関節部をウォームギヤ機構で回転させるようにしてもよい。
対向可能指部９７の構造を説明する。図７６に示すように、対向可能指部９７の第１指関節部９７Ｄの回転軸を保持する指元ヨーク９７Ｇは、第２指部９４とほぼ直交する方向で掌板部９２の裏面側の取付板部９８Ａに近い位置に設けられる。指元ヨーク９７Ｇの間には、指部第１モータ９７Ｈが配置される。第１指部モータ９７Ｈの回転軸に直結した第１ウォーム９７Ｊが、第１指関節部９７Ｄの回転軸の回りを回転する第１ウォームホイール９７Ｋとかみ合う。第１ウォームホイール９７Ｋは第２指節部９７Ｂに取付けられている。第１指部モータ９７Ｈが回転すると、第１ウォームホイール９７Ｋが第１指節部９７Ａと共に回転する。第１指節部９７Ａが回転すると、第１指部９３などと対向する位置に第２指節部９７Ｂおよび第３指節部９７Ｃが移動する。
対向可能指部９７の第１指節部９７Ａは、第１ウォームホイール９７Ｋと共に回転する第１指節元部９７Ｔ、第１指節元部９７Ｔの回転方向と約７０度の角度を有する方向を向いた第１指節先部９７Ｕとを有する。なお、第１指節先部９７Ｕが向く方向は、第１指節部９３Ａなどが向く方向と略平行である。第１指節元部９７Ｔの第１指関節部９７Ｄに接続する側とは反対側の端は平板状になっている。第１指節元部９７Ｔの平板状の部分に、第１指節先部９７Ｕが結合する。第１指節先部９７Ｕには、指部第２モータ９７Ｈが配置され、第２指関節部９３Ｅの回転軸を保持するヨーク部材が設けられる。
対向可能指部９７では、第１指関節部９７Ｄが第１指節部９７Ａを回転させる方向が、第２指関節部９７Ｅが第２指節部９７Ｂを回転させる方向とは異なる。対向可能指部９７の第２指関節部９７Ｅから指先側の構造は、第１指部９３などと同様である。
手部９では、指関節部を駆動するためのすべての機構が手部９の内部に設けられている。そのため、手部９だけを取外してメンテナンスや故障の修理などができる。
動作を説明する。人型ロボット１００の姿勢は、胸部内関節部１６、胸腰部関節部１８、肩関節部１３、肘関節部３１、手首関節部３６、股関節部２２、膝関節部４０、足首関節部４１、首関節部２７がとる角度により決まる。これらの関節部の角度は、その関節部を駆動するリンクの長さにより決まる。人型ロボット１００の各関節部を駆動するリンクを、指定された姿勢をとることができる各関節部の角度である指定角度から決まる値になるようにすることで、人型ロボット１００が指定された姿勢をとることができる。人型ロボット１００が動く場合も、姿勢の変化に対応する指定角度の時系列をリンクの長さの時系列に変換して、リンクの長さを決められた時系列に応じて変化させることで、指定されたように人型ロボット１００を動かすことができる。
各関節部について、その関節部が指定角度をとることができるような可変長リンクの長さの決め方、およびリニアガイドではリンク取付部の位置の決め方を説明する。なお、指定角度は、その関節部の可動範囲内であることが必要である。まず、胸部内関節部１６と胸腰部関節部１８について説明する。なお、胸腰部関節部１８は、胸下部５Ｄの腰部６に対する接続方向を変更する。胸部内関節部１６は、胸上部５Ｕの胸下部５Ｄに対する接続方向を変更する。
胸部内関節部１６と胸腰部関節部１８での関節部およびリンク取付部の間隔を、以下の変数により表現する。図８０は、胸部内関節部と胸腰部関節部での関節部およびリンク取付部の間隔を表現する変数を説明する図である。
まず、各点の位置を表す変数を以下のように定義する。
Ｐ0s：胸腰部関節部１８の位置。
Ｐ1s：腰側中央リンク取付部Ｊ１０の位置。
Ｐ2s：腰側右リンク取付部Ｊ８の位置。
Ｐ3s：腰側左リンク取付部Ｊ９の位置。
Ｐ4s：胸側中央リンク取付部Ｊ５の位置。
Ｐ4s0：胸側中央リンク取付部Ｊ５の基準状態での位置。
Ｐ5s：胸側右リンク取付部Ｊ６の位置。
Ｐ5s0：胸側右リンク取付部Ｊ６の基準状態での位置。
Ｐ6s：胸側左リンク取付部Ｊ７の位置。
Ｐ6s0：胸側左リンク取付部Ｊ７の基準状態での位置。
Ｐ0As：胸腰部関節部１８の位置を３点Ｐ4s、Ｐ5s、Ｐ6sで決まる平面に投影した位置。
Ｐ7s：胸部内関節部１６の位置。
Ｐ7s0：胸部内関節部１６の基準状態での位置。
Ｐ8s：下側胸部内リンク取付部Ｊ３の位置。
Ｐ8s0：下側胸部内リンク取付部Ｊ３の基準状態での位置。
Ｐ9s：上側胸部内リンク取付部Ｊ４の位置。
Ｐ9s0：上側胸部内リンク取付部Ｊ４の基準状態での位置。
各点の間隔を、以下の変数で表現する。
Ｗs1：線分Ｐ0sＰ1s、線分Ｐ0sＰ2sのＸ軸に投影した長さ。
Ｄs1：線分Ｐ0sＰ1sのＹ軸に投影した長さ。
Ｄs2：線分Ｐ0sＰ2s、線分Ｐ0sＰ3sのＹ軸に投影した長さ。
Ｗs2：線分Ｐ0As0Ｐ5s0、線分ＰoAs0Ｐ6s0のＸ軸に投影した長さ。
Ｄs3：線分Ｐ0AsＰ4s0のＹ軸に投影した長さ。
Ｄs4：線分Ｐ0AsＰ5s0、線分Ｐ0AsＰ6s0のＹ軸に投影した長さ。
Ｄs5：線分Ｐ7s0Ｐ8s0、線分Ｐ7s0Ｐ9s0のＹ軸に投影した長さ。
Ｈs1：線分Ｐ0sＰ7sの長さ。３点Ｐ4s、Ｐ5s、Ｐ6sで決まる平面と点Ｐ０sの距離。
Ｈs2：線分Ｐ0sＰ1s、線分Ｐ0sＰ2s、線分Ｐ0sＰ3sのＺ軸に投影した長さ。
Ｈs3：線分Ｐ7s0Ｐ8s0のＺ軸に投影した長さ。
Ｈs4：線分Ｐ7s0Ｐ9s0のＺ軸に投影した長さ。
上で定義した変数を使用することにより、各点の座標は以下のように表される。ここで、胸腰部関節部１８の位置Ｐ0sを、座標の原点とする。
Ｐ0s＝(０,０,０)
Ｐ1s＝(０,Ｄs1,-Ｈs2)
Ｐ2s＝(Ｗs1,Ｄs2,-Ｈs2)
Ｐ3s＝(-Ｗs1,Ｄs2,-Ｈs2)
Ｐ4s0＝(０,Ｄs3,Ｈs1)
Ｐ5s0＝(Ｗs2,-Ｄs4,Ｈs1)
Ｐ6s0＝(-Ｗs2,-Ｄs4,Ｈs1)
Ｐ7s0＝(０,０,Ｈs1)
Ｐ8s0＝(０,-Ｄs5,Ｈs1-Ｈs3)
Ｐ9s0＝(０,-Ｄs5,Ｈs1+Ｈs3)
胸腰部関節部１８および胸部内関節部１６の回転角度を、以下の変数で表現する。
αs：胸腰部関節部１８のＸ軸回りの回転角。基準状態でαs＝０
βs：胸腰部関節部１８のＹ軸回りの回転角。基準状態でβs＝０
γs：胸腰部関節部１８のＺ軸回りの回転角。基準状態でγs＝０
[Ｒs]：胸腰部関節部１８の回転行列。
ψ：胸部内関節部１６のＸ軸回りの回転角。基準状態でψ＝０
[Ｒs2]：胸部内関節部１６の回転行列。
胸腰部関節部１８の回転行列[Ｒs]は、以下のようになる。
Figure 0006903229
胸部内関節部１６の回転行列[Ｒs2]は、以下のようになる。
Figure 0006903229
胸下部５Ｄに存在する任意の点ＰDの基準状態での位置を点ＰD0とすると、胸腰部関節部１８での回転後の点ＰＤの位置は、以下のように表現できる。
ＰD＝[Ｒs]*ＰD0
胸上部５Ｕに存在する任意の点ＰＵの基準状態での位置を点ＰU0とすると、胸部内関節部１６および胸腰部関節部１８での回転後の点ＰUの位置は、以下のように表現できる。
ＰU＝[Ｒs]*([Ｒs2]*(ＰU0-Ｐ7s0)+Ｐ7s0)
リンクの長さを、以下の変数で表現する。
Ｌ1s：胸腰部中央リンク１９Ｌの長さ。線分Ｐ1sＰ4sの長さ。
Ｌ2s：胸腰部右リンク２０Ｌの長さ。線分Ｐ2sＰ5sの長さ。
Ｌ3s：胸腰部左リンク２１Ｌの長さ。線分Ｐ3sＰ6sの長さ。
Ｌ1s0：基準状態での胸腰部中央リンク１９Ｌの長さ。線分Ｐ1sＰ4s0の長さ。
Ｌ2s0：基準状態での胸腰部右リンク２０Ｌの長さ。線分Ｐ2sＰ5s0の長さ。
Ｌ3s0：基準状態での胸腰部左リンク２１Ｌの長さ。線分Ｐ3sＰ6s0の長さ。
Ｌ4s：胸部内リンク１７Ｌの長さ。線分Ｐ8sＰ9sの長さ。
まず、基準状態で、胸部内関節部１６を指定された角度ψにするための胸部内リンク１７Ｌの長さＬ4sの求め方を説明する。胸上部５Ｕに存在する上側胸部内リンク取付部Ｊ４の位置Ｐ9sは、以下のようになる。
Ｐ9s＝(x9s,y9s,z9s)
＝[Ｒs2]*(０,-Ｄs5,Ｈs4)t+(０,０,Ｈs1)
変数ごとに表現すると、以下となる。
x9s＝０
y9s＝-Ｄs5*cosψ-Ｈs4*sinψ
z9s＝-Ｄs5*sinψ+Ｈs4*cosψ+Ｈs1
胸下部５Ｄに存在する下側胸部内リンク取付部Ｊ３の位置Ｐ8sは、胸部内関節部１６での回転では変化しない。そのため、位置Ｐ8sは、基準状態での位置Ｐ8s0である。胸部内リンク１７Ｌの長さＬ4sは、以下で計算できる。
Ｌ4s＝√((Ｄs5*(1-cosψ)-Ｈs4*sinψ)2
+(-Ｄs5*sinψ+Ｈs4*cosψ+Ｈs3)2)
胸下部５Ｄに存在する３点の位置Ｐ4s、Ｐ5s、Ｐ8sは、胸腰部関節部１８での回転により、以下のようになる。
Ｐ4s＝(x4s,y4s,z4s)
＝[Ｒs]*Ｐ4s0＝[Ｒs]*(０,Ｄs3,Ｈs1)t
Ｐ5s＝(x5s,y5s,z5s)
＝[Ｒs]*Ｐ5s0＝[Ｒs]*(Ｗs2,-Ｄs4,Ｈs1)t
Ｐ6s＝(x6s,y6s,z6s)
＝[Ｒs]*Ｐ6s0＝[Ｒs]*(-Ｗs2,-Ｄs4,Ｈs1)t
Ｐ4s、Ｐ5s、Ｐ6sが求められたので、リンクの長さＬ1s、Ｌ2s、Ｌ3sは以下の式で計算できる。
Ｌ1s＝√(x4s２+(y4s-Ｄs1)２+(z4s+Ｈs2)２)
Ｌ2s＝√((x5s-Ｗs1)２+(y5s-Ｄs2)２+(z5s+Ｈs2)２)
Ｌ3s＝√((x6s+Ｗs1)２+(y6s-Ｄs2)２+(z5s+Ｈs2)２)
Ｌ1s0＝√((Ｄs3-Ｄs1)２+(Ｈs1+Ｈs2)２)
Ｌ2s0＝√((Ｗs2-Ｗs1)２+(Ｄs2+Ｄs4)２+(Ｈs1+Ｈs2)２)
Ｌ3s0＝√((Ｗs2-Ｗs1)２+(Ｄs2+Ｄs4)２+(Ｈs1+Ｈs2)２)
基準状態からＺ軸回りに微小に回転させた場合に、各リンクの長さがどのように変化するかを考察する。Ｐ4s、Ｐ5s、Ｐ6sは以下のようになる。ここで、γsが微小として、sinγs≒γs、cosγs≒１で近似する。
Ｐ4s＝(x4s,y4s,z4s)
＝(-Ｄs3*sinγs,Ｄs3*cosγs,Ｈs1)
≒(-Ｄs3*γs,Ｄs3,Ｈs1)
Ｐ5s＝(x5s,y5s,z5s)
＝(Ｗs2*cosγs+Ｄs4*sinγs,
Ｗs2*sinγs-Ｄs4*cosγs,Ｈs1)
≒(Ｗs2+Ｄs4*γs, Ｗs2*γs-Ｄs3, Ｈs1)
Ｐ6s＝(x6s,y6s,z6s)
＝(-Ｗs2*cosγs+Ｄs4*sinγs,
-Ｗs2*sinγs-Ｄs4*cosγs,Ｈs1)
≒(-Ｗs2-Ｄs4*γs, -Ｗs2*γs-Ｄs4, Ｈs1)
リンクの長さを計算すると、以下のようになる。
Ｌ1s＝√((Ｄs3*γs)２+(Ｄs3-Ｄs1)２+(Ｈs1+Ｈs2)２)
Ｌ2s＝√((Ｗs2-Ｗs1-Ｄs4*γs)２+(Ｄs2+Ｄs4-Ｗs2*γs)２
+(Ｈs1+Ｈs2)２)
Ｌ3s＝√((Ｗs2-Ｗs1+Ｄs4*γs)２+(Ｄs2+Ｄs4+Ｗs2*γs)２
+(Ｈs1+Ｈs2)２)
基準状態でのリンクの長さとの差を求めると、以下のようになる。ここで、γs＞０とする。
Ｌ1s ２ -Ｌ1s0 ２＝(Ｄs2*γs)２＞０
Ｌ2s ２ -Ｌ2s0 ２＝(Ｗs2-Ｗs1-Ｄs4*γs)２-(Ｗs2-Ｗs1)２
+(Ｄs2+Ｄs4-Ｗs2*γs)２-(Ｄs2+Ｄs4)２＜０
Ｌ3s ２ -Ｌ3s0 ２＝(Ｗs2-Ｗs1+Ｄs4*γs)２-(Ｗs2-Ｗs1)２
+(Ｄs2+Ｄs4+Ｗs2*γs)２-(Ｄs2+Ｄs4)２＞０
基準状態では、胸腰部右リンク２０Ｌの長さＬ2s、胸腰部左リンク２１Ｌの長さＬ3sのどちらか一方が長くなり、他方が短くなることが分る。したがって、捻り軸の回りに回転する際に、伸びるリンクにより押される力と、短くなるリンクにより引かれる力の両方が発生して、捻り軸の回りに回転しやすくなる。
肩関節部１３に関して、指定角度をとることができるような可変長リンクの長さの決め方を説明する。肩関節部１３での関節部およびリンク取付部の間隔を、以下の変数により定義する。図８１は、肩関節部１３での関節部およびリンク取付部の間隔を表現する変数を説明する図である。なお、Ｑ1tとＱ2tは、図８２に示す。
まず、各点の位置を表す変数を以下のように定義する。
Ｐ0t：肩関節部１３の位置。
Ｐ1t：胸部側主リンク取付部Ｊ１の位置。
Ｐ2t：胸部側補助リンク取付部Ｊ２の位置。
Ｑ1t：上腕部主リンク取付部Ｊ２０の位置。Ｑ1t＝(x1t,y1t,z1t)
Ｑ1t0：上腕部主リンク取付部Ｊ２０の基準状態での位置。
Ｑ2t：上腕部駆動主リンク側補助リンク取付部Ｊ２１の位置。Ｑ2t＝(x2t,y2t,z2t)
Ｑ2t0：上腕部駆動主リンク側補助リンク取付部Ｊ２１の基準状態での位置。
各点の間隔を、以下の変数で表現する。なお、Ｋ1tとＫ2tは、図８２に示す。
Ｗt1：線分Ｐ0tＰ1t、線分Ｐ0tＰ2tのＸ軸に投影した長さ。
Ｄt1：線分Ｐ0tＰ1tのＹ軸に投影した長さ。
Ｄt2：線分Ｐ0tＰ2tのＹ軸に投影した長さ。
Ｈt1：線分Ｐ0tＰ1t、線分Ｐ０tＰ2tのＺ軸に投影した長さ。
Ｋ1t：線分Ｐ0tＱ1tの長さ。
Ｋ2t：線分Ｑ1tＱ2tの長さ。
上で定義した変数を使用することにより、各点の座標は以下のように表される。ここで、肩関節部１３の位置Ｐ０tを、座標の原点とする。
Ｐ0t＝(０,０,０)
Ｐ1t＝(-Ｗt1,-Ｄt1,-Ｈt1)
Ｐ2t＝(-Ｗt1,Ｄt2,-Ｈt1)
Ｑ1t0＝(０,０,-Ｋ1t)
肩関節部１３の回転角度を、以下の変数で表現する。
αｔ：肩関節部１３のＸ軸回りの回転角。基準状態でαｔ＝０
βｔ：肩関節部１３のＹ軸回りの回転角。基準状態でβｔ＝０
[Ｒt]：肩関節部１３の回転行列。
回転行列[Ｒt]は、以下のようになる。
Figure 0006903229
リンクの長さを、以下の変数で表現する。
Ｌ1t：上腕部駆動主リンク１４Ｌの長さ。線分Ｐ１tＱ1tの長さ。
Ｌ2t：上腕部駆動補助リンク１５Ｌの長さ。線分Ｐ2tＱ2tの長さ。
肩関節部１３では、上腕部駆動主リンク側補助リンク取付部Ｊ２１が上腕部駆動主リンク１４Ｌ上にあるので、上腕部駆動主リンク側補助リンク取付部Ｊ２１の位置Ｑ2tは、以下を満足する必要がある。
Ｑ2t＝(Ｋ2t/Ｌ1t)*Ｐ1t＋(１−Ｋ2t/Ｌ1t)*Ｑ1t
また、リンク取付部の間隔に関して、以下の制約条件が成立する必要がある。
√(x1t2+y1t2+z1t2)＝Ｋ1t
肩関節部１３の角度行列[Ｒt]を用いて、上腕部側主リンク取付部Ｊ２０の位置Ｑ1tを以下のようにして求める。
Ｑ1t＝[Ｒt]*Ｑ1t0
この式を変数ごとに表現すると、以下のようになる。
x1t＝Ｋ1t*cosαｔ*sinβｔ
y1t＝−Ｋ1t*sinαｔ
z1t＝−Ｋ1t*cosαｔ*cosβｔ
位置Ｑ1tが求められると、以下の式でＬ1tが計算できる。
Ｌ1t＝√((x1t+Ｗt1)２+(y1t+Ｄt1)２+(z1t+Ｈt1)２)
位置Ｑ2tに関する制約式を変数ごとに表現すると、以下のようになる。
x2t＝x1t-(x1t+Ｗt1)*(Ｋ1t/Ｌ1t)
y2t＝y1t-(y1t+Ｄt1)*(Ｋ1t/Ｌ1t)
z2t＝z1t-(z1t+Ｈt1)*(Ｋ1t/Ｌ1t)
位置Ｑ2tが求められると、以下の式でＬ2tが計算できる。
Ｌ2t＝√((x2t+Ｗt1)２+(y2t-Ｄt2)２+(z2t+Ｈt1)２)
肘関節部３１に関して、指定角度をとることができるような上腕部でのリンク取付部の位置の決め方を説明する。肘関節部３１での関節部およびリンク取付部の間隔を、以下の変数により定義する。図８２は、肘関節部３１での関節部およびリンク取付部の間隔を表現する変数を説明する図である。
まず、各点の位置を表す変数を以下のように定義する。
Ｐ0u：肘関節部３１の位置。
Ｐ1u：上腕部外側リンク取付部Ｊ２２の位置。
Ｐ1u0：上腕部外側リンク取付部Ｊ２２の基準状態での位置。
Ｐ2u：上腕部内側リンク取付部Ｊ２３の位置。
Ｐ2u0：上腕部内側リンク取付部Ｊ２３の基準状態での位置。
Ｐ3u：肘部駆動外側リンク取付部Ｊ２５の位置。Ｐ3u＝(x3u,y3u,z3u)
Ｐ3u0：肘部駆動外側リンク取付部Ｊ２５の基準状態での位置。
Ｐ4u：肘部駆動内側リンク取付部Ｊ２４の位置。Ｐ4u＝(x4u,y4u,z4u)
Ｐ4u0：肘部駆動内側リンク取付部Ｊ２４の基準状態での位置。
各点の間隔を、以下の変数で表現する。
Ｗu1：線分Ｐ0uＰ1uのＸ軸に投影した長さ。
Ｗu2：線分Ｐ0uＰ2uのＸ軸に投影した長さ。
Ｄu1：線分Ｐ0uＰ1u、線分Ｐ0uＰ2uのＹ軸に投影した長さ。
Ｈu1：線分Ｐ0uＰ1u0、線分Ｐ0uＰ2u0のＺ軸に投影した長さ。
Ｋ1u：線分Ｐ0uＰ4u0のＺ軸に投影した長さ。
Ｌ1u0：線分Ｐ1uＰ3uの長さ。肘部駆動外側リンク３２の長さ。
Ｌ2u0：線分Ｐ2uＰ4uの長さ。肘部駆動内側リンク３３の長さ。
Ｋ2u：線分Ｐ3uＰ4uの長さ。
上で定義した変数を使用することにより、各点の座標は以下のように表される。ここで、肘関節部３１の位置Ｐ0uを、座標の原点とする。
Ｐ0u＝(０,０,０)
Ｐ1u0＝(Ｗu1,Ｄu1,Ｈu1)
Ｐ2u0＝(-Ｗu2,Ｄu1,Ｈu1)
Ｐ4u0＝(０,Ｄu1,-Ｋ1u)
上腕部外側アクチュエータ３４と上腕部内側アクチュエータ３５は、上腕部９（Ｚ軸）に平行に設けられている。上腕部外側アクチュエータ３４、上腕部内側アクチュエータ３５によりそれぞれ移動される上腕部外側リンク取付部Ｊ２２、上腕部内側リンク取付部Ｊ２３の位置Ｐ1u、Ｐ2uはＺ軸に平行な方向に移動する。つまり、Ｐ1u、Ｐ2uは、以下のように表現できる。
Ｐ1u＝(Ｗu1,Ｄu1,z1u)
Ｐ2u＝(-Ｗu2,Ｄu1,z2u)
肘部駆動外側リンク３２は肘部駆動内側リンク３３に取付けられているので、Ｐ2u、Ｐ3u、Ｐ4uは、同一直線上に存在することになる。したがって、以下が成立する。
Ｐ3u＝(Ｋ2u/Ｌ2u0)*Ｐ2u＋(１−Ｋ2u/Ｌ2u0)*Ｐ4u
基準状態でこの式を適用することで、Ｐ3u0は以下のようになる。
Ｐ3u0＝(-(Ｋ2u/Ｌ2u0)*Ｗu1,Ｄu1,-(Ｋ2u/Ｌ2u0)*(Ｈu1+Ｋ1u)-Ｋ1u)
固定長である肘部駆動外側リンク３２、肘部駆動内側リンク３３の長さは、以下のようになる。
Ｌ2u0＝√(Ｗu2２+(Ｈu1+Ｋ1u)２)
Ｌ1u0＝√(Ｗu1２+(Ｈu1+Ｋ1u)２
+Ｋ2u*(Ｋ2u-Ｈu1-Ｋ1u+Ｗu1)/(Ｗu1２+(Ｈu1+Ｋ1u)２))
肘関節部３１の回転角度を、以下の変数で表現する。
αｕ：肘関節部３１のＸ軸回りの回転角。基準状態でαｕ＝０
γｕ：肘関節部３１のＺ軸回りの回転角。基準状態でγｕ＝０
[Ｒu]：肘関節部３１の回転行列。
回転行列[Ｒu]は、以下のようになる。
Figure 0006903229
[Ｒu]が与えられると、以下の式で、Ｐ4uを求める。
Ｐ4u＝(x4u,y4u,z4u)＝[Ｒu]*Ｐ4u0
＝[Ｒu]*(０,Ｄu1,-Ｋ1u)t
Ｌ2u0が一定であることから、以下の式で、Ｐ4uからz2uを求める。
Ｌ2u ２＝(x4u+Ｗu2)２+(y4u-Ｄu1)２+(z4u-z2u)２＝Ｌ2u0 ２
z2u＝z4u+√(Ｌ2u0 ２-(x4u+Ｗu2)２-(y4u-Ｄu1)２)
Ｐ2u、Ｐ3u、Ｐ4uが同一直線上に存在することを表す制約式を適用して、Ｐ2uとＰ4uからＰ3uを求める。変数ごとに表現すると、以下のようになる。
x3u＝x4u-(Ｗu1+x4u)*(Ｋ2u/Ｌ2u0)
y3u＝y4u+(Ｄu1-y4u)*(Ｋ2u/Ｌ2u0)
z3u＝z4u+(z2u-z4u)*(Ｋ2u/Ｌ2u0)
Ｌ1u0が一定であることから、以下の式で、Ｐ3uからz1uを求める。
Ｌ1u ２＝(x3u-Ｗu1)２+(y3u-Ｄu1)２+(z3u-z1u)２＝Ｌ1u0 ２
z1u＝z3u+√(Ｌ1u0 ２-(x3u-Ｗu1)２-(y3u-Ｄu1)２)
手首関節部３６に関して、指定角度をとることができるような可変長リンクの長さの決め方を説明する。手首関節部３６での関節部およびリンク取付部の間隔を、以下の変数により定義する。図８３は、手首関節部３６での関節部およびリンク取付部の間隔を表現する変数を説明する図である。
まず、各点の位置を表す変数を以下のように定義する。
Ｐ0v：手首関節部３６の位置。
Ｐ1v：前腕部正面リンク取付部Ｊ２６の位置。
Ｐ2v：前腕部外側リンク取付部Ｊ２７の位置。
Ｐ3v：前腕部内側リンク取付部Ｊ２８の位置。
Ｐ4v：手部側正面リンク取付部Ｊ２９の位置。
Ｐ4v0：手部側正面リンク取付部Ｊ２９の基準状態での位置。
Ｐ5v：手部側外側リンク取付部Ｊ３０の位置。
Ｐ5v0：手部側外側リンク取付部Ｊ３０の基準状態での位置。
Ｐ6v：手部側内側リンク取付部Ｊ３１の位置。
Ｐ6v0：手部側内側リンク取付部Ｊ３１の基準状態での位置。
ここで、Ｐ0v、Ｐ4v、Ｐ5vおよびＰ6vは、同一平面上にある。
各点の間隔を、以下の変数で表現する。
Ｗv1：線分Ｐ0vＰ1v、線分Ｐ0vＰ2vのＸ軸に投影した長さ。
Ｄv1：線分Ｐ0vＰ1vのＹ軸に投影した長さ。
Ｈv1：線分Ｐ0vＰ2vの長さ。
Ｄv2：線分Ｐ0vＰ4vの長さ。
上で定義した変数を使用することにより、各点の座標は以下のように表される。ここで、手首関節部３６の位置Ｐ０vを、座標の原点とする。
Ｐ０v＝(０,０,０)
Ｐ1v＝(０,Ｄv1,-Ｈv1)
Ｐ2v＝(Ｗv1,０,-Ｈv1)
Ｐ3v＝(-Ｗv1,０,-Ｈv1)
Ｐ4v0＝(０,Ｄv2,０)
Ｐ5v0＝(Ｄv2*cos(π/6),-Ｄv2*sin(π/6),０)
Ｐ6v0＝(-Ｄv2*cos(π/6),-Ｄv2*sin(π/6),０)
手首関節部３６の回転角度を、以下の変数で表現する。
αv：手首関節部３６のＸ軸回りの回転角。基準状態でαv＝０
βv：手首関節部３６のＹ軸回りの回転角。基準状態でβv＝０
γv：手首関節部３６のＺ軸回りの回転角。基準状態でγv＝０
[Ｒv]：手首関節部３６の回転行列。
回転行列[Ｒv]は、以下のようになる。
Figure 0006903229
リンクの長さを、以下の変数で表現する。
Ｌ1v：前腕部正面リンク３７Ｌの長さ。線分Ｐ１vＰ4vの長さ。
Ｌ2v：前腕部外側リンク３８Ｌの長さ。線分Ｐ2vＰ4vの長さ。
Ｌ3v：前腕部内側リンク３９Ｌの長さ。線分Ｐ3vＰ6vの長さ。
Ｌ1v0：基準状態での前腕部正面リンク３７Ｌの長さ。線分Ｐ1vＰ4v0の長さ。
Ｌ2v0：基準状態での前腕部外側リンク３８Ｌの長さ。線分Ｐ2vＰ5v0の長さ。
Ｌ3v0：基準状態での前腕部内側リンク３９Ｌの長さ。線分Ｐ3vＰ6v0の長さ。
[Ｒv]が与えられて、以下の式で、Ｐ4v、Ｐ5v、Ｐ6vを求める。
Ｐ4v＝(x4v,y4v,z4v)
＝[Ｒv]*(０,Ｄv2,０)t
Ｐ5v＝(x5v,y5v,z5v)
＝[Ｒv]*(Ｄv2*cos(π/6),-Ｄv2*sin(π/6),０)t
Ｐ6v＝(x6v,y6v,z6v)
＝[Ｒv]*(-Ｄv2*cos(π/6),-Ｄv2*sin(π/6),０)t
Ｐ4v、Ｐ5v、Ｐ6vが求められたので、リンクの長さＬ1v、Ｌ2v、Ｌ3vは以下の式で計算できる。
Ｌ1v＝√(x4v２+(Ｄv1-y4v)２+(Ｈv1+z4v)２)
Ｌ2v＝√((Ｗv1-x5v)２+y5v２+(Ｈv1+z5v)２)
Ｌ3v＝√((Ｗv1+x6v)２+y6v２+(Ｈv1+z6v)２)
Ｌ1v0＝√((Ｄv1-Ｄv2)２+Ｈv1２)
Ｌ2v0＝√((Ｗv1-Ｄv2*cos(π/6))２+(Ｄv2*sin(π/6))２+Ｈv1２)
Ｌ3v0＝√((Ｗv1-Ｄv2*cos(π/6))２+(Ｄv2*sin(π/6))２+Ｈv1２)
基準状態からＺ軸回りに微小に回転させた場合に、各リンクの長さがどのように変化するかを考察する。Ｐ4v、Ｐ5v、Ｐ6vは以下のようになる。ここで、γvが微小として、sinγv≒γv、cosγv≒１で近似する。
Ｐ4v＝(x4v,y4v,z4v)
＝(-Ｄv2*sinγv,Ｄv2*cosγv,０)
≒(-Ｄv2*γv,Ｄv2,０)
Ｐ5v＝(x5v,y5v,z5v)
＝(Ｄv2*cos(π/6-γv),Ｄv2*sin(π/6-γv), ０)
≒(Ｄv2*cos(π/6)+Ｄv2*sin(π/6)*γv,
Ｄv2*cos(π/6)*γv-Ｄv2*sin(π/6),０)
Ｐ6v＝(x6v,y6v,z6v)
＝(-Ｄv2*cos(π/6+γv),-Ｄv2*sin(π/6+γv), ０)
≒(-Ｄv2*cos(π/6)+Ｄv2*sin(π/6)*γv,
-Ｄv2*cos(π/6)*γv-Ｄv2*sin(π/6),０)
リンクの長さを計算すると、以下のようになる。
Ｌ1v＝√((Ｄv2*γv)２+(Ｄv1-Ｄv2)２+Ｈv1２)
Ｌ2v＝√((Ｗv1-Ｄv2*cos(π/6)-Ｄv2*sin(π/6)*γv)２
+(Ｄv2*cos(π/6)*γv-Ｄv2*sin(π/6))２+Ｈv1２)
Ｌ3v＝√((Ｗv1-Ｄv2*cos(π/6)+sin(π/6)*γv)２
+(Ｄv2*cos(π/6)*γv+Ｄv2*sin(π/6))２+Ｈv1２)
基準状態でのリンクの長さとの差を求めると、以下のようになる。ここで、γv＞０とする。
Ｌ1v ２-Ｌ1v0 ２＝(Ｄv2*γv)２＞０
Ｌ2v ２-Ｌ2v0 ２＝(Ｗv1-Ｄv2*cos(π/6)-Ｄv2*sin(π/6)*γv)２
-(Ｗv1-Ｄv2*cos(π/6))２
+(Ｄv2*sin(π/6)-Ｄv2*cos(π/6)*γv)２
-(Ｄv2*sin(π/6))２＜０
Ｌ3v ２-Ｌ3v0 ２＝(Ｗv1-Ｄv2*cos(π/6)+Ｄv2*sin(π/6)*γv)２
-(Ｗv1-Ｄv2*cos(π/6))２
+(Ｄv2*sin(π/6)+Ｄv2*cos(π/6)*γv)２
-(Ｄv2*sin(π/6))２＞０
基準状態では、前腕部外側リンク３８Ｌの長さＬ2v、前腕部内側リンク３９Ｌの長さＬ3vのどちらか一方が長くなり、他方が短くなることが分る。したがって、捻り軸である前腕骨部８Ｂの回りに回転する際に、伸びるリンクにより押される力と、短くなるリンクにより引かれる力の両方が発生して、捻り軸の回りに回転しやすくなる。
首関節部２７も、手首関節部３６と同様に、３本の可変長リンクの長さを変更することにより３回転自由度で接続角度を変更する。首関節部２７でも、手首関節部３６と同様な方法で、決められた接続角度になるような３本の可変長リンクの長さを決めることができる。
足首関節部４１に関して、指定角度をとることができるような可変長リンクの長さの決め方を説明する。足首関節部４１での関節部およびリンク取付部の間隔を、以下の変数により定義する。図８４は、足首関節部４１での関節部およびリンク取付部の間隔を表現する変数を説明する図である。
まず、各点の位置を表す変数を以下のように定義する。
Ｐ0m：足首関節部４１の位置。
Ｐ1m：足部外側リンク取付部Ｊ４１の位置。
Ｐ2m：足部内側リンク取付部Ｊ４２の位置。
Ｐ3m：下腿部外側リンク取付部Ｊ３９の位置。
Ｐ3m0：下腿部外側リンク取付部Ｊ３９の基準状態での位置。
Ｐ4m：下腿部内側リンク取付部Ｊ４０の位置。
Ｐ4m0：下腿部内側リンク取付部Ｊ４０の基準状態での位置。
各点の間隔を、以下の変数で表現する。
Ｗm1：線分Ｐ0mＰ1m、線分Ｐ0mＰ2mのＸ軸に投影した長さ。
Ｗm2：線分Ｐ0mＰ3m0、線分Ｐ0mＰ4m0のＸ軸に投影した長さ。
Ｄm1：線分Ｐ0mＰ1m、線分Ｐ0mＰ2mのＹ軸に投影した長さ。
Ｄm2：線分Ｐ0mＰ3m0、線分Ｐ0mＰ4m0のＹ軸に投影した長さ。
Ｈm1：線分Ｐ0mＰ1m、線分Ｐ0mＰ2mのＺ軸に投影した長さ。
Ｈm2：線分Ｐ０mＰ3m0、線分Ｐ0mＰ4m0のＺ軸に投影した長さ。
Ｄm1：線分Ｐ0mＰ1mのＹ軸に投影した長さ。
上で定義した変数を使用することにより、各点の座標は以下のように表される。ここで、足首関節部４１の位置Ｐ０mを、座標の原点とする。
Ｐ0m＝(０,０,０)
Ｐ1m＝(Ｗm1,Ｄm1,-Ｈm1)
Ｐ2m＝(-Ｗm1,Ｄm1,-Ｈm1)
Ｐ3m0＝(Ｗm2,-Ｄm2,Ｈm2)
Ｐ4m0＝(-Ｗm2,-Ｄm2,Ｈm2)
足首関節部４１の回転角度を、以下の変数で表現する。
αm：足首関節部４１のＸ軸回りの回転角。基準状態でαm＝０
βm：足首関節部４１のＹ軸回りの回転角。基準状態でβm＝０
[Ｒm]：足首関節部４１の回転行列。
回転行列[Ｒm]は、以下のようになる。
Figure 0006903229
リンクの長さを、以下の変数で表現する。
Ｌ1m：下腿部外側リンク４５Ｌの長さ。線分Ｐ1mＰ3mの長さ。
Ｌ2m：下腿部内側リンク４６Ｌの長さ。線分Ｐ2mＰ4mの長さ。
[Ｒm]が与えられて、以下の式で、Ｐ3m、Ｐ4mを求める。
Ｐ3m＝(x3m,y3m,z3m)＝[Ｒm]*(Ｗm2,-Ｄm2,Ｈm2)t
Ｐ4m＝(x4m,y4m,z4m)＝[Ｒm]*(-Ｗm2,-Ｄm2,Ｈm2)t
Ｐ3m、Ｐ4mが求められたので、リンクの長さＬ1m、Ｌ2mは以下の式で計算できる。
Ｌ1m＝√((x3m-Ｗm1)２+(y3m-Ｄm1)２+(z3m+Hm1)２)
Ｌ2m＝√((x4m+Ｗm1)２+(y4m-Ｄm1)２+(z4m+Hm2)２)
股関節部２２に関して、指定角度をとることができるような可変長リンクの長さの決め方を説明する。股関節部２２での関節部およびリンク取付部の間隔を、以下の変数により定義する。図８５は、股関節部２２での関節部およびリンク取付部の間隔を表現する変数を説明する図である。
まず、各点の位置を表す変数を以下のように定義する。
Ｐ０ｑ：股関節部２２の位置。
Ｐ１ｑ：股部正面リンク取付部Ｊ１１の位置。
Ｐ１ｑ０：股部正面リンク取付部Ｊ１１の基準状態での位置。
Ｐ２ｑ：股部外側リンク取付部Ｊ１２の位置。
Ｐ２ｑ０：股部外側リンク取付部Ｊ１２の基準状態での位置。
Ｐ３ｑ：股部内側リンク取付部Ｊ１３の位置。
Ｐ３ｑ０：股部内側リンク取付部Ｊ１３の基準状態での位置。
Ｐ４ｑ：膝部正面リンク取付部Ｊ３２の位置。
Ｐ５ｑ：膝部外側リンク取付部Ｊ３３の位置。
Ｐ６ｑ：膝部内側リンク取付部Ｊ３４の位置。
各点の間隔を以下の変数で定義する。なお座標系として、互いに直交するＵ軸、Ｖ軸およびＷ軸を使用する。ＵＶＷ座標系は、大腿骨部１０Ａと共に移動する座標系である。Ｗ軸を、大腿骨部１０Ａが延在する方向とする。Ｕ軸を、基準状態でＸ軸と一致する軸とする。
Ｗq2：線分Ｐ０ｑＰ２ｑ０をＵ軸に投影した長さ。
Ｗq3：線分Ｐ０ｑＰ３ｑ０をＵ軸に投影した長さ。
Ｄq1：線分Ｐ０ｑＰ１ｑ０をＶ軸に投影した長さ。
Ｄq2：線分Ｐ０ｑＰ２ｑ０をＶ軸に投影した長さ。
Ｄq3：線分Ｐ０ｑＰ３ｑ０をＶ軸に投影した長さ。
Ｄq4：線分Ｐ０ｑＰ４ｑをＶ軸に投影した長さ。
Ｈq1：線分Ｐ０ｑＰ１ｑ０をＷ軸に投影した長さ。
Ｈq2：線分Ｐ０ｑＰ２ｑ０をＷ軸に投影した長さ。
Ｈq3：線分Ｐ０ｑＰ３ｑ０をＷ軸に投影した長さ。
Ｈq4：線分Ｐ０ｑＰ４ｑ０、線分Ｐ０ｑＰ５ｑ０、線分Ｐ０ｑＰ６ｑ０をＷ軸に投影した長さ。
上で定義した変数を使用することにより、基準状態での各点の座標はＵＶＷ座標系では、以下のように表される。股関節部２２の位置を座標の原点とする。
Ｐ０ｑ＝(０,０,０)
Ｐ１ｑ０＝(０,-Ｄq1,Ｈq1)
Ｐ２ｑ０＝(Ｗq2,Ｄq2,-Ｈq2)
Ｐ３ｑ０＝(-Ｗq3,Ｄq3,-Ｈq3)
Ｐ４ｑ＝(０,-Ｄq3,-Ｈq4)
Ｐ５ｑ＝(Ｄq4*cos(π/6),Ｄq4*sin(π/6),-Ｈq4)
Ｐ６ｑ＝(-Ｄq4*cos(π/6),Ｄq4*sin(π/6),-Ｈq4)
リンクの長さを以下の変数で表現する。
Ｌ１ｑ：大腿部正面リンク２３Ｌの長さ。線分Ｐ１ｑＰ４ｑの長さ。
Ｌ２ｑ：大腿部外側リンク２４Ｌの長さ。線分Ｐ２ｑＰ５ｑの長さ。
Ｌ３ｑ：大腿部内側リンク２５Ｌの長さ。線分Ｐ３ｑＰ６ｑの長さ。
Ｌ１ｑ０：基準状態での大腿部正面リンク２３Ｌの長さ。線分Ｐ１ｑ０Ｐ４ｑの長さ。
Ｌ２ｑ０：基準状態での大腿部外側リンク２４Ｌの長さ。線分Ｐ２ｑ０Ｐ５ｑの長さ。
Ｌ３ｑ０：基準状態での大腿部内側リンク２５Ｌの長さ。線分Ｐ３ｑ０Ｐ６ｑの長さ。
股関節部２２の回転角度を、以下の変数で定義する。
αq：股関節部２２のＸ軸回りの回転角。基準状態でαq＝αq0。
βq：股関節部２２のＹ軸回りの回転角。基準状態でβq＝０。
γq：股関節部２２のＹ軸回りの回転角。基準状態でγq＝０。
[Ｒq]：股関節部２２のＵＶＷ座標系での回転行列。
大腿骨部１０Ａが延在する方向がＸＹＺ座標系で基準状態(αq0,０,０)から(αq,βq,γq)に回転する場合には、ＸＹＺ座標系で固定された点は、ＵＶＷ座標系では(αq0-αq,-βq,-γq)だけ回転することになる。したがって、回転行列Ｒqは以下のようになる。
Figure 0006903229
ＸＹＺ座標系で固定された点Ｐ１ｑ、Ｐ２ｑ、Ｐ３ｑのＵＶＷ座標系での座標は、以下のようになる。大腿骨部１０Ａと共に移動する点Ｐ４ｑ、Ｐ５ｑ、Ｐ６ｑは、ＵＶＷ座標系では座標が変化しない。
Ｐ１ｑ＝(u1q,v1q,w1q)
＝[Ｒq]*(０,-Ｄq1,Ｈq1)ｔ
Ｐ２ｑ＝(u2q,v2q,w2q)
＝[Ｒq]*(Ｗq2,Ｄq2,-Ｈq2)ｔ
Ｐ３ｑ＝(u3q,v3q,w3q)
＝[Ｒq]*(-Ｗq3,Ｄq3,-Ｈq3)ｔ
点Ｐ１ｑ、Ｐ２ｑ、Ｐ３ｑのＵＶＷ座標系での座標が求められたので、リンクの長さは以下のようになる。
Ｌ１ｑ＝√(u1q2+(v1q+Dq4)2+(w1q+Hq4)2)
Ｌ２ｑ＝√((u2q-Dq4*cos(π/6))2+(v2q-Dq4*sin(π/6))2+(w2q+Hq4)2)
Ｌ３ｑ＝√((u3q+Dq4*cos(π/6))2+(v3q-Dq4*sin(π/6))2+(w3q+Hq4)2)
基準状態からＷ軸回りに微小に回転させた場合に、各リンクの長さがどのように変化するかを考察する。点Ｐ１ｑ、Ｐ２ｑ、Ｐ３ｑは以下のようになる。ここで、γqは微小として、sinγq≒γq、cosγq≒１で近似する。
Ｐ１ｑ＝(u1q,v1q,w1q)
＝(-Dq1*sinγq,-Dq1*cosγq,Hq1)
≒(-Dq1*γq,-Dq1,Hq1)
Ｐ２ｑ＝(u2q,v2q,w2q)
＝(Wq2*cosγq+Dq2*sinγq,-Wq2*sinγq+Dq2*cosγq,-Hq2)
≒(Wq2+Dq2*γq,-Wq2*γq+Dq2,-Hq2)
Ｐ３ｑ＝(u3q,v3q,w3q)
＝(-Wq3*cosγq+Dq3*sinγq,Wq3*sinγq+Dq3*cosγq,-Hq3)
≒(-Wq3+Dq3*γq,Wq3*γq+Dq3,-Hq3)
リンクの長さを計算すると、以下のようになる。
Ｌ１ｑ＝√((Dq1*γq)2+(-Dq1+Dq4)2+(Hq1+Hq4)2)
Ｌ２ｑ＝√((Wq2+Dq2*γq-Dq4*cos(π/6))2
+(-Wq2*γq+Dq2-Dq4*sin(π/6))2+(-Hq2+Hq4)2)
Ｌ３ｑ＝√((-Wq3+Dq3*γq+Dq4*cos(π/6))2
+(Wq3*γq+Dq3-Dq4*sin(π/6))2+(-Hq3+Hq4)2)
基準状態でのリンクの長さとの差を求めると、以下のようになる。
Ｌ１ｑ ２−Ｌ１ｑ０ ２＝(Dq1*γq)2＞０
Ｌ２ｑ ２−Ｌ２ｑ０ ２＝(Wq2+Dq2*γq-Dq4*cos(π/6))2-(Wq2-Dq4*cos(π/6))2
+(-Wq2*γq+Dq2-Dq4*sin(π/6))2-(Dq2-Dq4*sin(π/6))2
＝γq*((Dq22+Wq22)*γq+2*(Wq2*sin(π/6)-Dq2*cos(π/6))*Dq4)
Ｌ３ｑ ２−Ｌ３ｑ０ ２＝(-Wq3+Dq3*γq+Dq4*cos(π/6))2-(-Wq3+Dq4*cos(π/6))2
+(Wq3*γq+Dq3-Dq4*sin(π/6))2-(Dq3-Dq4*sin(π/6))2
＝γq*((Dq32+Wq32)*γq-2*(Wq3*sin(π/6)-Dq3*cos(π/6))*Dq4)
上に示す式から、Wq2*sin(π/6)-Dq2*cos(π/6)＞０、かつWq3*sin(π/6)-Dq3*cos(π/6)＞０が成立する場合、あるいは、Wq2*sin(π/6)-Dq2*cos(π/6)＜０、かつWq3*sin(π/6)-Dq3*cos(π/6)＜０が成立する場合には、基準状態からＷ軸回りに微小角度回転すると、大腿部外側リンク２４Ｌの長さＬ２ｑ、大腿部内側リンク２５Ｌの長さＬ３ｑのどちらか一方が長くなり、他方が短くなることが分かる。図８５に示すように、線分Ｐ０ｑＰ２ｑ０がＶ軸となす角度と線分Ｐ０ｑＰ３ｑ０がＶ軸となす角度は、どちらもπ/6(＝６０度)より大きい。つまり、Wq2*sin(π/6)-Dq2*cos(π/6)＞０、かつWq3*sin(π/6)-Dq3*cos(π/6)＞０が成立する。股関節部２２では、基準状態からＷ軸回りに微小角度回転する場合に、大腿部外側リンク２４Ｌの長さＬ２ｑ、大腿部内側リンク２５Ｌの長さＬ３ｑのどちらか一方が長くなり、他方が短くなることが分かる。
膝関節部４０に関して、指定角度をとることができるような膝部駆動リンク４２Ｌの長さの決め方を説明する。膝関節部４０、膝部駆動リンク取付部Ｊ３５、大腿部側補助具取付部Ｊ３６の位置は、大腿骨部１０Ａに対して決まっている。膝関節部４０の角度αnが決まると、下腿部側補助具取付部Ｊ３８の位置が決まる。大腿部側補助具４３と下腿部側補助具４４の長さは固定なので、下腿部側補助具取付部Ｊ３８の位置が決まると、膝部駆動リンク補助具接続部Ｊ３７の位置が決まる。膝部駆動リンク４２Ｌの長さを、決まった膝部駆動リンク補助具接続部Ｊ３７と膝部駆動リンク取付部Ｊ３５との距離にすれば、膝関節部４０を指定した角度αnにすることができる。
手部９は、各指部の第１指関節部、第２指関節部が指定された角度になるように、各指関節部のウォームギヤが指定された角度に対応する位置になるように、モータが駆動される。対向可能指部９７が普通指部と対向でき、第１指関節部だけを曲げることができるので、指部を伸ばして薄い紙などを挟んで持つことができる。対向可能指部９７を持たず、あらかじめ対向するように指部を配置してもよい。指部は５本でなくてもよく、少なくとも３本を有すればよい。手部９のように、１本の対向可能指部と４本の普通指部を有する方が、物を掴む、ボタンを押す、レバーを操作するなど人と同様な動作をする上で有利である。
人型ロボット１００では、各関節部をアクチュエータの伸縮により駆動する方式としている。そのため、関節部に減速機（ギヤ）を配置するする必要がなく、関節部をコンパクトにできる。関節部にギヤを配置すると、ギヤに大きなスペースが必要になり関節部が大きくなる。関節部にギヤを配置する人型ロボットで、大きな力を出そうとすると大きな関節部となって、人型ロボットとしての外観から離れていき、いびつさが感じられる外観となる可能性が考えられる。人型ロボット１００では関節部がコンパクトなので、人型ロボットの外観をより自然に人間に近づけることができる。関節部を人間の関節と同様な次数の回転自由度を持たせているので、人と同様な動作をすることができる。
既に開発されている人型ロボット（ヒューマノイドロボット）は、関節部の曲げ剛性が十分でないものや、実運用する上で必要となる推力または剛性が十分でないという課題が残っていると思われる。この発明に係る人型ロボットは、これらの課題の解決策の一つになると考えられる。
ねじ棒とナットによるアクチュエータを使用しているので、ねじ部の逆効率が大きくなり、静止状態での関節部の把持力が大きくなる。ねじ部での摩擦に相当する力以下の大きさの力が、アクチュエータで駆動される部材を動かそうとして外部から作用する場合も、関節部は動かない。摩擦に相当する力よりも大きい力が外部から作用する場合は、ねじ部が動きを弱めるダンパとして働きながら関節部が外力により動かされる。減衰作用（ダンピング作用）を有するので、外力や外乱に対するロバスト性が向上する。
手部９は、親指に相当する対向可能指部９７を有する。対向可能指部９７を４本の普通指部９３、９４、９５、９６と対向させることができ、対向可能指部９７と普通指部９３、９４、９５、９６とで物を掴むことができる。各指関節部は、ウォームとウォームホイールを使用するウォームギヤ機構で駆動するようにしたので、指曲げの力を大きくすることができる。
第１指関節部および第２指関節部をそれぞれウォームギヤ機構で駆動するので、第１指関節部と第２指関節部のどちらか一方だけを曲げたり、両方を曲げたりできる。そのため、手部９が持つ物体の形状に合わせて各指部の各指関節部を適切に曲げてよりフィットした状態で物体を保持できる。また、電源供給が遮断された場合にも、ウォームギヤ機構により把持力を維持できる。
モータが駆動力を発生させない場合に、指関節部は回転しない。その理由は、ウォームギヤ機構の逆効率が大きく、ウォームギヤ機構での摩擦力などが指関節部に作用する外力よりも大きいからである。ウォームギヤ機構で移動される側の部材に外部から移動させる力が作用しても、その力の大きさがウォームギヤ機構での摩擦力以下である場合は、指関節部は回転しない。指関節部にさらに大きな力が働く場合は、ウォームギヤ機構が動きを弱めるダンパとして働きながら指関節部は回転する。そのため、手部が物体を持った状態でロボットが例えば上腕部を動かすなどの動作をしても、上腕部の運動により物体に働く力の反力を手部の指関節部が出すことができ、物体を手に保持したままにできる。モータが駆動力を発生させない場合に指関節部が動く力の大きさは、１人または複数人の人間が出せる力とする。そうすることで、電力供給が遮断された災害時などに、例えば人型ロボットが保持している物体を手部から離すことができる。
この発明に係る人型ロボットは、人に近い動きを可能とする構造を有するものである。そのため、人型ロボットが通常の人の作業を代替することが可能となる。人工知能が搭載されれば、あるいは人により遠隔操作されることで、産業上、高齢化社会、労働力不足の解消に利用可能と判断される。特に、長時間作業が厳しい環境（放射線環境、高温環境、低温環境、宇宙環境等）下、危険が伴う作業や単純作業での労働力不足の解消に利用可能と推測される。
３回転自由度接続機構は、胸屈曲部Ｃ１、肩部Ｃ４、肘部Ｃ５、膝部Ｃ８、足首部Ｃ９で使用してもよい。３回転自由度接続機構は、胴体屈曲部Ｃ２、首部Ｃ３、手首部Ｃ６、股部Ｃ７のすべてではなく、胴体屈曲部Ｃ２、首部Ｃ３、手首部Ｃ６、股部Ｃ７、胸屈曲部Ｃ１、肩部Ｃ４、肘部Ｃ５、膝部Ｃ８、足首部Ｃ９の少なくとも一つで使用してもよい。
人型ロボットは、胸部、頭部および上肢部だけを備えるものでもよい。人型ロボットは、腰部、胸部、頭部および上肢部だけを備えるものでもよい。人型ロボットは、腰部および下肢部だけを備えるものでもよい。人型ロボットは、頭部を備えなくてもよい。そのような人型ロボットが有する少なくとも一つの関節部に、３回転自由度接続機構を使用してもよい。腰部を有せず上肢部を有する人型ロボットでは、手部から遠い側を第１部材とする。
人型ロボットではなく、手部と、手部から直列に接続された１個または複数個の腕区間部とを有するロボットアームに、この発明に係る３回転自由度接続機構を適用してもよい。手部および腕区間部の何れかを第２部材として、手部から遠い側の第１部材に第２部材を３回転自由度を有して回転可能に接続するように、３回転自由度接続機構を使用すればよい。そのようなロボットアームは、手部を適切な位置に適切な角度で向けることができる。
この発明に係る手部は、手部だけをロボットハンドとして使用することもできる。また、この実施の形態１とは異なる手部を使用してもよい。
関節部およびリンク取付部に２回転自由度を持たせる２軸ジンバルは、実施の形態で示したものとは異なる構造のものを使用してもよい。関節部およびリンク取付部が適用される箇所に応じて、適切なものを使用すればよい。
実施の形態１での胴体屈曲部、胸屈曲部、首部、肩部、肘部、手首部、股部、膝部、足首部が有する各特徴は、３回転自由度接続機構を有さない人型ロボットにも適用できる。
アクチュエータは、ねじ棒などを使用するスクリュー系のものでなくてもよく、油圧を利用するものなどでもよい。２点間の距離を変更し維持できるものであれば、アクチュエータはどのような構成のものでもよい。アクチュエータで、モータの回転をねじ棒に伝える機構は、ギヤ、タイミングベルトなど適切なものを使用すればよい。
対向可能指部は、掌板部の側面の位置から掌板部と交差して普通指部と対向する位置に移動可能であり、かつ普通指部と同様に３個の指関節部を持たせるようにしてもよい。そのためには、対向可能指部が、第４指節部と、第４指節部を第３指節部に回転可能に接続する第４指関節部をさらに有する。そして、第３指関節部は、ウォームギヤ機構により第３指節部を第２指節部に対して回転させるようにする。第４指関節部は、第３指関節部と連動して回転してもよいし、第３指関節部とは独立に回転してもよい。手部が、常に普通指部と対向する位置に存在する指部を備えてもよい。普通指部とは異なる方向に曲げられる指部を手部が、備えてもよい。
人型ロボット、ロボットアーム、ロボットハンドは、遠隔操作される。また、ロボットに自動動作するプログラムを持たせ、プログラムにしたがって自律動作させてもよい。自律動作中でも、外部からロボットの動きを止めることを可能にする。また、自律動作から遠隔操作への切替も可能にする。ロボットを自律動作中にロボットが人などの生物あるいは想定外の物体と接触する場合は、ロボットが自動で検知して動きを止める機能をロボットに持たせる。
以上のことは、他の実施の形態でもあてはまる。
実施の形態２．
実施の形態２は、油圧機構を可変長リンクに使用した場合である。人型ロボット１００Ｚは、油圧機構を使用したアクチュエータを有する。各アクチュエータの駆動源は電気モータを使用し、油圧ポンプをモータで駆動し、油圧シリンダ内部の軸方向にピストンを移動させる構成である。ねじ機構を電気モータで駆動する場合の制御の方法を、油圧機構を利用する場合もそのまま利用できる。図８６は、実施の形態２に係る人型ロボットが有するアクチュエータが有する可変長リンクの構造を説明する断面図である。
胸腰部中央アクチュエータ１９Ｚを例にして、油圧機構を使用するアクチュエータの構造を説明する。アクチュエータ１９Ｚは、可変長リンク１９ＬＺとモータ１９Ｍとを有する。可変長リンク１９ＬＺは、円筒状のシリンダ１９Ｈと、シリンダ１９Ｈの内部を移動するピストン１９Ｊと、配管１９Ｋと、ポンプ１９Ｎとを有する。シリンダ１９Ｈには、鉱物油などの液体が充填される。ピストン１９Ｊは、シリンダ１９Ｈの内部を第１の部屋１９Ｐと第２の部屋１９Ｑとに区分する。ピストン１９Ｊは、シリンダ１９Ｈの内部で軸回りに回転できる。配管１９Ｋは、第１の部屋１９Ｐと第２の部屋１９Ｑとを結ぶ。配管１９Ｋには、液体が充填される。ポンプ１９Ｎは、配管１９Ｋの途中に設けられる。ポンプ１９Ｎは、モータ１９Ｍにより駆動される。ポンプ１９Ｎは、モータ１９Ｍにより駆動される。ポンプ１９Ｎは、液体を第１の部屋１９Ｐから第２の部屋１９Ｑへ移動させることができ、液体を第２の部屋１９Ｑから第１の部屋１９Ｐへ移動させることができる。
ピストン１９Ｊの一端が胸側中央リンク取付部Ｊ５に取付けられる。シリンダ１９Ｈの一端が腰側中央リンク取付部Ｊ１０に取付けられる。
ポンプ１９Ｎが、第１の部屋１９Ｐから第２の部屋１９Ｑへ液体を移動させると、ピストン１９Ｊが胸側中央リンク取付部Ｊ５に近づく方向へ移動する。ポンプ１９Ｎが、第２の部屋１９Ｑから第１の部屋１９Ｐへ液体を移動させると、ピストン１９Ｊが胸側中央リンク取付部Ｊ５から遠ざかる方向へ移動する。第１の部屋１９Ｐとの第２の部屋１９Ｑとの間で液体が移動しなければ、ピストン１９Ｊの位置は変化しない。したがって、可変長リンク１９ＬＺの長さは変化可能であり、可動範囲内の任意の長さを維持できる。
モータ１９Ｍがポンプ１９Ｎを駆動することで、ねじ棒１９Ａなどを使用するスクリュー系のアクチュエータの替わりに油圧機構を使用するアクチュエータを使用することができる。
配管１９Ｋを液体が流れるか流れないかを切替えるバルブを設けてもよい。可変長リンク１９ＬＺの長さを変化させる場合には、バルブを開く。可変長リンク１９ＬＺの長さを固定する場合には、バルブを閉じる。
実施形態２の構成であればモータで駆動される油圧機構がピストンを移動させる。ねじ棒を使用する場合に必要であるモータの回転をねじ棒に伝える回転連結部品が不要になる。部品数の減少により、信頼性が向上する。また、各駆動軸の制御も電気駆動モータの各軸回転制御と同じ手法で各アクチュエータを制御することが可能であり、そのまま置き換えが可能である。油圧アクチュエータで駆動させた場合の効果として、電気モータでねじ機構を駆動する場合に比べてより大きな推力を発生させることが可能となり、防災時の使用に耐え得る高ロバスト性、高把持力を有した人型ロボットが実現できる。
また実施形態２の構成であれば、油圧によるダンピング特性を考慮したアクチュエータを構成することが可能となる。外乱に対してダンピング特性を発揮しながら動作して、外乱に対するロバスト性が向上する。さらに、将来のロボットの大型化や把持力増加に対応できる。
実施の形態３．
実施の形態３は、対向可能指部の替わりに普通指部と常に対向する対向指部を有する手部を人型ロボットが有する場合である。図８７は、実施の形態３に係る人型ロボットが有する左の手部９Ａを手の甲側から見た斜視図である。図８８は、左の手部９Ａを手の平側から見た斜視図である。図８９、図９０、および図９１は、左の手部９Ａの正面図、第１指部８３が存在する側から見た側面図、および背面図である。手部９Ａの手の平側から見た図を正面図とする。左の手部９Ａは、手の平を正面に向けており第１指部８３から第４指部８６を上に向けた状態で図示している。図９２は、左の手部９Ａを指先側から見た側面図である。図９３は、左の手部９Ａを手首側から見た側面図である。図９４は、対向指部８７を曲げた状態での第１指部が存在する側から見た側面図である。図９３では、図を見やすくするために、手部取付部８１を省略した状態で図示している。
手部９Ａの構造を説明する。手部９Ａは、手部取付部８１により手首板部９１に取付けられる。手部取付部８１は、側面から見るとＬ字状の部材である。手部取付部８１は、手首板部９１に取付けられる円形の取付板部８１Ａと、掌板部８２と接続する長方形状の掌板接続部８１Ｂとを有する。取付板部８１Ａと掌板接続部８１Ｂとは、約９０度の角度で接続する。ここでは、手部取付部８１と手首板部９１の間に円筒状の部材を挟んでいる。
円筒状の部材を挟まなくてもよい。
図９５は、左の手部の掌板部の平面図である。図９５に示すように、掌板部８２において、第１指部８３、第２指部８４、第３指部８５、第４指部８６および対向指部８７が取付けられる略長方形の部分を、それぞれ第１指取付部８２Ａ、第２指取付部８２Ｂ、第３指取付部８２Ｃ、第４指取付部８２Ｄおよび対向指取付部８２Ｅと呼ぶ。掌板部８２のそれ以外の部分を、掌板本体部８２Ｆと呼ぶ。第１指取付部８２Ａ、第２指取付部８２Ｂ、第３指取付部８２Ｃおよび第４指取付部８２Ｄは、掌板本体部８２Ｆの指先方向の指先側に接続する。対向指取付部８２Ｅは、指先方向の手首側であり手幅方向では第１指取付部８２Ａ側である掌板部８２の角に存在する。
第１指取付部８２Ａ、第２指取付部８２Ｂ、第３指取付部８２Ｃ、第４指取付部８２Ｄおよび対向指取付部８２Ｅは、指部の第１指節部が接続される指部ごとに分離した指取付部である。掌板本体部８２Ｆは、指取付部が接続する本体部である。
第１指取付部８２Ａと第２指取付部８２Ｂとは直接は接続せず、掌板本体部８２Ｆを介して接続する。第２指取付部８２Ｂと第３指取付部８２Ｃも、掌板本体部８２Ｆを介して接続する。第３指取付部８２Ｃと第４指取付部８２Ｄも、掌板本体部８２Ｆを介して接続する。第１指取付部８２Ａ、第２指取付部８２Ｂ、第３指取付部８２Ｃおよび第４指取付部８２Ｄは、隣接するものとの間に間隔を持たせて掌板本体部８２Ｆと接続する。第１指部８３、第２指部８４、第３指部８５および第４指部８６は、指先側が開くように掌板部８２に取付けられる。そのため、第１指取付部８２Ａ、第２指取付部８２Ｂ、第３指取付部８２Ｃおよび第４指取付部８２Ｄは、それぞれが第１指部８３、第２指部８４、第３指部８５および第４指部８６と同じ方向になるように、掌板本体部８２Ｆと接続する。
第１指取付部８２Ａ、第２指取付部８２Ｂ、第３指取付部８２Ｃおよび第４指取付部８２Ｄは、指先方向と直交する手幅方向の幅が狭くなる幅減少部を介して掌板本体部８２Ｆと接続する。そのため、第１指取付部８２Ａ、第２指取付部８２Ｂ、第３指取付部８２Ｃおよび第４指取付部８２Ｄが掌板本体部８２Ｆと接続する箇所には、切り込みまたは段差を設ける。第１指取付部８２Ａには、第２指取付部８２Ｂでない側は幅を狭くする段差８２Ｇを設け、第２指取付部８２Ｂ側には半円状の切り込み８２Ｈを設ける。第２指取付部８２Ｂには、両側に半円状の切り込み８２Ｊ、８２Ｋを設ける。第３指取付部８２Ｃには、両側に半円状の切り込み８２Ｌ、８２Ｍを設ける。第４指取付部８２Ｄには、第３指取付部８２Ｃ側に切り込み８２Ｎを設け、第３指取付部８２Ｃでない側に段差８２Ｐを設ける。
切り込み８２Ｈ、８２Ｊ、８２Ｋ、８２Ｌ、８２Ｍ、８２Ｎは、すべて同じ形状である。切り込み８２Ｈ、８２Ｊの間は、直線で結ぶ。切り込み８２Ｍ、８２Ｎの間は、直線で結ぶ。切り込み８２Ｋ、８２Ｌの間は、直線で結ぶ。切り込み８２Ｈ、８２Ｊと、これらを結ぶ直線をまとめて、掌板本体部８２Ｆに設けた切り込みと考えてもよい。切り込み８２Ｋ、８２Ｌで１個の切り込み、切り込み８２Ｍ、８２Ｎで１個の切り込みを、掌板本体部８２Ｆに設けていると考えてもよい。
第１指取付部８２Ａ、第２指取付部８２Ｂ、第３指取付部８２Ｃおよび第４指取付部８２Ｄの手幅方向の幅は同じであり、幅減少部の幅も同じになる。幅減少部は、切り込みまたは段差を設けられて幅が小さくなっている箇所である。
物体を手部９Ａで把持する時に、第１指部８３、第２指部８４、第３指部８５、第４指部８６および対向指取付部８２Ｅが、適度に曲がる。その理由は、第１指取付部８２Ａ、第２指取付部８２Ｂ、第３指取付部８２Ｃ、第４指取付部８２Ｄおよび対向指取付部８２Ｅが互いに分離しているからである。また、第１指取付部８２Ａ、第２指取付部８２Ｂ、第３指取付部８２Ｃおよび第４指取付部８２Ｄは、幅減少部を介して掌板本体部８２Ｆと接続するからである。
掌板部８２の第１指部８３側には、対向指取付部８２Ｅと第１指取付部８２Ａとを分離する切り込み８２Ｑを設けている。切り込み８２Ｑは、対向指取付部８２Ｅ側では手首側の外形線と平行であるが、第１指取付部８２Ａ側では間隔が内部に入るほど狭くなるような直線部分と、対向指取付部８２Ｅ側と平行な部分とを有する。切り込み８２Ｋは、手幅方向で端から最も遠い部分では半円状である。対向指取付部８２Ｅには、第１ウォーム８７Ｊを通す貫通穴８２Ｕを設ける。なお、図９５では、掌板部８２に部材を取付けるための穴などは、図示を省略している。
掌板本体部８２Ｆの掌板接続部８１Ｂが取付けられる箇所には、２個の切り込み８２Ｒが設けられる。２個の切り込み８２Ｒで挟まれる部分の掌板本体部８２Ｆを、手首取付部８２Ｓと呼ぶ。掌板接続部８１Ｂは、手首取付部８２Ｓに１個のねじでねじ留めされ、２個の切り込み８２Ｒの指先側の掌板本体部８２Ｆにそれぞれ１個のねじでねじ留めされる。切り込み８２Ｒで挟まれており、手首取付部８２Ｓは幅が狭い。手首取付部８２Ｓを介して手部９Ａを手首板部９１に取付けるので、指先方向に向かう軸の回りに手部９Ａを適度に回転させることができる。
掌板本体部８２Ｆは、３本の直線で折れ曲がっている。折れ曲がった各部分に１個の普通指部が接続する。そのため、第１指取付部８２Ａ、第２指取付部８２Ｂ、第３指取付部８２Ｃ、第４指取付部８２Ｄがそれぞれ接続する部分が、互いに異なる角度になる。折れ曲がる角度は１か所で６度程度である。掌板部８２を折り曲げることにより、掌板部８２で物体を包み込むように把持することが、掌板部８２に折れ曲がりが無い場合よりも容易になる。３か所の折れ曲がりで発生する線の方向は、指先方向に略平行な方向である。
掌板部８２の手の平側には、複数の掌肉部８２Ｔが設けられる。掌肉部８２Ｔの形状は、掌板部８２から遠い側の角および辺が面取りされた直方体である。掌肉部８２Ｔは、物体を掴んだ場合に物体に掌板部８２から加えられる荷重を緩和するためのクッションの役割を果たす。掌肉部８２Ｔは、例えばゴムなど、適度な弾性を持つ材料で製造する。
掌肉部８２Ｔは、第１指取付部８２Ａ、第２指取付部８２Ｂ、第３指取付部８２Ｃ、第４指取付部８２Ｄおよび対向指取付部８２Ｅに、それぞれ１個が設けられる。掌板本体部８２Ｆには、折れ曲がった部分ごとに３個の掌肉部８２Ｔが設けられる。対向指部８７が存在する部分の掌板本体部８２Ｆには、掌肉部８２Ｔは設けない。
４本の普通指部である第１指部８３、第２指部８４、第３指部８５および第４指部８６は、根元側よりも指先側が開くように掌板部８２に接続する。図９１から分かるように、第２指部８４は取付板部８１Ａに対して垂直で、第２指部８４の中心と取付板部８１Ａの中心は一致している。第１指部８３、第２指部８４、第３指部８５および第４指部８６は、同様な構造である。
手部９Ａが手部９と大きく異なる点は、対向指部８７である。対向指部８７から、その構造を説明する。対向指部８７は、掌板部８２の手の平側に掌板部８２と交差する方向に指先が延在するように設けられる。対向指部８７は、第１指部８３から第４指部８６と向き合うように設けられている。対向指部８７は、掌板部８２の手首側かつ第１指部８３側の角に近い位置に設ける。対向指部８７が回転する方向は、第１指部８３および第２指部８３と交差する方向である。図８９に示すように、対向指部８７を伸ばした状態で掌板部８２との角度を小さくすると、指先が第２指部８４に近づく方向に移動する。
対向指部８７は、第１指部８３などと同様に、掌板部８２に近い側から第１指節部８７Ａ、第２指節部８７Ｂ、第３指節部８７Ｃが直列に接続する。掌板部８２と第１指節部８７Ａとの間には、第１指関節部８７Ｄが存在する。第１指関節部８７Ｄは、第１指節部８７Ａを掌板部８２に回転可能に接続する。第１指節部８７Ａと第２指節部８７Ｂとの間には、第２指関節部８７Ｅが存在する。第２指関節部８７Ｅは、第２指節部８７Ｂを第１指節部８７Ａに回転可能に接続する。第２指節部８７Ｂと第３指節部８７Ｃとの間には、第３指関節部８７Ｆが存在する。第３指関節部８７Ｆは、第３指節部８７Ｃを第２指節部８７Ｂに回転可能に接続する。第１指関節部８７Ｄ、第２指関節部８７Ｅおよび第３指関節部８７Ｆの回転軸は、互いに平行である。つまり、対向指部８７では、第１指関節部８７Ｄが第１指節部８７Ａを回転させる方向、第２指関節部８７Ｅが第２指節部８７Ｂを回転させる方向、および第３指関節部８７Ｆが第３指節部８ＣＢを回転させる方向が、すべて同じ方向である。対向指部８７が常に第１指部８３から第４指部８６と対向する位置にあり３個の指関節部を有するので、手部９Ａは手部９よりも、物体をより適切に掴むことができる。
掌板部８２、第１指節部８７Ａ、第２指節部８７Ｂおよび第３指節部８７Ｃの中の隣接する２個に関して、掌板部８２に近い側の部材を基部側部材、基部側部材でない側の部材を先端側部材と呼ぶ。第１指関節部８７Ｄ、第２指関節部８７Ｅ、第３指関節部８７Ｆは、第１指節部８７Ａ、第２指節部８７Ｂ、第３指節部８７Ｃの何れかである先端側部材を基部側部材に回転可能に接続する３個の指関節部である。第１指部８３、第２指部８４、第３指部８５、第４指部８６に関しても同様である。
対向指部８７は、手幅方向には移動できない。つまり、図７２から図７８に示す手部９のように、対向指部８７は掌板部８２の側面の位置に移動して、指先を第１指部８３から第４指部８６と略同じ方向に向けることはできない。対向指部８７にさらに１個の指関節部とモータを追加すれば、対向指部８７は、手幅方向にも移動させることは可能である。
手部９Ａでは、指関節部とモータの数を手部９と同じにしている。
対向指部８７の第１指関節部８７Ｄを回転させる動力源となる指部第１モータ８７Ｈは、掌板部８２の手の甲側に垂直に固定する。指部第１モータ８７Ｈの回転軸側には、回転数を変換する第１ギヤヘッド８７Ｔが設けられる。第１ギヤヘッド８７Ｔは、外形が四角柱状である。第１ギヤヘッド８７Ｔと指部第１モータ８７Ｈは、互いに動かないように固定されている。第１ギヤヘッド８７Ｔが掌板部８２に垂直に固定される。第１ギヤヘッド８７Ｔを垂直に固定することで、指部第１モータ８７Ｈおよび第１ギヤヘッド８７Ｔを掌板部８２に剛性を高くして固定できる。
指部第２モータ８７Ｌにも第２ギヤヘッド８７Ｕが固定されている。第２ギヤヘッド８７Ｕも、外形が四角柱状である。他の指の指部第１モータまたは指部第２モータも、それぞれ第１ギヤヘッドまたは第２ギヤヘッドが固定されている。
指元ヨーク部８７Ｇから指先側の対向指部８７は、掌板部８２の手の平側に存在する。
第１ウォーム８７Ｊに対応する位置には、掌板部８２には貫通穴８２Ｕが設けられる。指部第１モータ８７Ｈの回転軸に直結された第１ウォーム８７Ｊは、手の平側の指元ヨーク部８７Ｇにより回転可能に支持される第１ウォームホイール８７Ｋとかみ合い回転させる。
第１指関節部８７Ｄは、掌板部８２に配置され指部第１モータ８７Ｈ、指部第１モータ８７Ｈにより回転する第１ウォーム８７Ｊ、第１ウォーム８７Ｊとかみ合い第１指節部８７Ａと共に第１指関節部８７Ｄの回転軸の回りを回転する第１ウォームホイール８７Ｋを有するウォームギヤ機構により第１指節部８７Ａを掌板部８２に対して回転させる。
対向指部８７が大きな力で物体を掴む場合には、反作用として第１ウォームホイール８７Ｋを回転させる力も大きくなる。第１ウォームホイール８７Ｋを回転しないようにする力を指部第１モータ８７Ｈが出す。指部第１モータ８７Ｈが強固に掌板部８２に固定されていないと、第１ウォームホイール８７Ｋを回転させる力により、指部第１モータ８７Ｈおよび第１ギヤヘッド８７Ｔが掌板部８２から剥がれてしまう。指部第１モータ８７Ｈおよび第１ギヤヘッド８７Ｔを掌板部８２に垂直にすることで、指部第１モータ８７Ｈを掌板部８２から分離させようとする力に対抗する力を発生させやすくなる。
第１指節部８７Ａは、第１ホイール連動部８７ＡＡと、第１ヨーク部８７ＡＢと、第２モータ設置部８７ＡＣとで構成される。第１ホイール連動部８７ＡＡは、第１ウォームホイール８７Ｋを挟んでと共に回転する箱状の部材である。第１ヨーク部８７ＡＢは、第２指関節部８７Ｅの回転軸を挟んで保持する部材である。第１ホイール連動部８７ＡＡの長さは、対向指部８７の指先と普通指部の指先との間で物体を挟める程度の長さとする。
第２モータ設置部８７ＡＣには、指部第２モータ８７Ｌが設置される。第２モータ設置部８７ＡＣは、第１ヨーク部８７ＡＢに接して手首側に存在する部材である。第１ホイール連動部８７ＡＡと、第２モータ設置部８７ＡＣとは一体に製造される。第１ホイール連動部８７ＡＡは、対向指部８７の側面から見ると第２指関節部８７Ｅの側が幅広の多角形である。第１ホイール連動部８７ＡＡには、第２指関節部８７Ｅの側に２枚の板材である第１ヨーク部８７ＡＢがねじ止めされる。第１ヨーク部８７ＡＢの先端には、突起８７ＡＤが設けられる。突起８７ＡＤは、第２指関節部８７Ｅが手の甲側への回転を許容回転角度に制限するストッパである。
第２モータ設置部８７ＡＣは、第１ヨーク部８７ＡＢに垂直なモータ設置面と、第１ヨーク部８７ＡＢよりも間隔が広く第１ヨーク部８７ＡＢに平行な側面と、第１ホイール連動部８７ＡＡと接続する底面とを有する。側面はモータ設置面よりも高さが低く、指元側の角が大きく面取りされている。モータ設置面の上側の角も面取りされている。モータ設置面には、指部第２モータ８７Ｌおよび第２ギヤヘッド８７Ｕが垂直に固定される。モータ設置面には貫通穴が設けられており、第２ギヤヘッド８７Ｕの回転軸がこの貫通穴を通る。
指部第２モータ８７Ｌの回転軸には、第２ウォーム８７Ｍが取付けられる。第２ウォーム８７Ｍは、第１ヨーク部８７ＡＢに回転可能に保持される第２ウォームホイール８７Ｎとかみ合う。第２ウォーム８７Ｍと第２ウォームホイール８７Ｎとによるウォームギヤ機構により、指部第２モータ８７Ｌの回転が第２指関節部８７Ｅを回転の軸として、第２指節部８７Ｂが第１指節部８７Ａに対して回転する。
第２指節部８７Ｂは、第２ウォームホイール８７Ｎを挟んで保持し、第２ウォームホイール８７Ｎと共に回転する。第２指節部８７Ｂは、２枚の板材である。第２指節部８７Ｂの第３指節部８７Ｃ側の端部には、第３指関節部８７Ｆの回転軸が設けられる。第２指節部８７Ｂは、厚さは一定である。第２指節部８７Ｂは、第２ウォームホイール８７Ｎを挟み第１ヨーク部８７ＡＢで挟まれる部分、中間部分、第３指関節部８７Ｆの回転軸が設けられる部分で、小さい段差を有する階段状になっている。２枚の第２指節部８７Ｂの間隔は、第２指関節部８７Ｅの側で狭く、第３指関節部８７Ｆの側で広い。第１ヨーク部８７ＡＢの先端に設けたストッパ８７ＡＤは、第１ヨーク部８７ＡＢで挟まれる部分と側面が接する。中間部分との間に存在する第２指節部８７Ｂの段差にストッパ８７ＡＤが当たることで、第２指関節部８７Ｅが手の平と反対側に回転する角度が制限される。
第２指関節部８７Ｅは、第１指節部８７Ａに配置され指部第２モータ８７Ｌ、指部第２モータ８７Ｌにより回転する第２ウォーム８７Ｍ、第２ウォーム８７Ｍとかみ合い第２指節部８７Ｂと共に第２指関節部８７Ｅの回転軸の回りを回転する第２ウォームホイール８７Ｎを有するウォームギヤ機構により第２指関節部８７Ｅを第１指節部８７Ａに対して回転させる。
図９６を参照して、第２指関節部８７Ｅに連動させて第３指関節部８７Ｆを回転させるギヤについて説明する。図９６は、対向指部８７の第２指節部８７Ｂ付近を拡大した斜視図である。第２指節部８７Ｂには、第２指関節部８７Ｅの回転に連動して第３指関節部８７Ｆを回転させるための複数のギヤが設けられる。第２指節部８７Ｂの外側に存在するアイドラギヤ８７Ｒは、第１ヨーク部８７ＡＢの先端に設けられた部分ギヤ８７Ｑとかみ合う。アイドラギヤ８７Ｒと部分ギヤ８７Ｑの組は、第２指節部８７Ｂの両側面に存在する。アイドラギヤ８７Ｒは、部分ギヤ８７Ｑとかみ合うことで、第２ウォームホイール８７Ｎと同じ回転方向に回転する。アイドラギヤ８７Ｒは指先側でアイドラ外ギヤ８７ＳＡとかみ合う。アイドラ外ギヤ８７ＳＡの回転軸には、第２指節部８７Ｂに挟まれてアイドラ内ギヤ８７ＳＢが固定されている。アイドラ外ギヤ８７ＳＡおよびアイドラ内ギヤ８７ＳＢは、アイドラギヤ８７Ｒとは反対方向に回転する。アイドラ外ギヤ８７ＳＡおよびアイドラ内ギヤ８７ＳＢは、同じ回転軸の周りに回転する。アイドラ内ギヤ８７ＳＢは、第３指節部８７ＡＣと共に第３指関節部８７Ｆの回転軸の回りを回転する第３指節駆動歯車８７Ｐとかみ合う。第３指節駆動歯車８７Ｐは、アイドラ内ギヤ８７ＳＢとは反対側に回転する。第３指節駆動歯車８７Ｐは、第２ウォームホイール８７Ｎと同じ方向に回転する。
第２ウォームホイール８７Ｎと第３指節駆動歯車８７Ｐの間のギヤ比は、１に近い適切な値になるように調整する。
アイドラギヤ８７Ｒは、第２指関節部８７Ｂの回転と連動して回転する歯車である。アイドラ外ギヤ８７ＳＡ（アイドラ内ギヤ８７ＳＢも含む）は、アイドラギヤ８７Ｒにより駆動される奇数個の回転軸で回転する歯車である。第３指節駆動歯車８７Ｐは、アイドラ内ギヤ８７ＳＢにより駆動される第３指関節部８７Ｆに設けられた歯車である。
第３指節部８７Ｃは、指先部８７ＣＡと、指先基部８７ＣＢとで構成する。指先部８７ＣＡは、円筒の先端に半球が接続した形状である。指先基部８７ＣＢは、第３指節駆動歯車８７Ｐと共に回転する部材である。指先基部８７ＣＢの指先側には、角が丸い長方形の板状の部材が設けられる。この板状の部材に、指先部８７ＣＡが取付けられる。そのため、指先部８７ＣＡを用途に合わせた形状のものに容易に取り替えることができる。
第１指部８３は、指部第１モータ８３Ｈも含めて手の甲側にすべての部材が存在する。
指部第１モータ８３Ｈは、第１モータ固定部８３Ｖに取付けられる。第１モータ固定部８３Ｖは、直方体状の箱体である。第１モータ固定部８３Ｖは、第１指取付部８２Ａに取付けられる。第１モータ固定部８３Ｖは、指先側の面と第１指取付部８２Ａ側の面は、開口している。指元側には補強のためのリブが設けられており、側面から見ると指元側の辺は斜めに見える。第１モータ固定部８３Ｖは、掌板部８２Ｂに垂直であり、掌板部８２Ｂに平行な面に指部第１モータ８３Ｈおよび第１ギヤヘッド８３Ｔが取付けられる。第１モータ固定部８３Ｖと掌板部８２Ｂの間に、第１ギヤヘッド８３Ｔの回転軸に取付けられた第１ウォーム８３Ｊが入る。
指部第１モータ８３Ｈを第１モータ固定部８３Ｖに垂直に固定することで、指部第１モータ８３Ｈと第１モータ固定部８３Ｖとを剛性を高くして固定できる。
第１ウォーム８３Ｊは、指元ヨーク部８３Ｇに保持される回転軸の回りに回転する第１ウォームホイール８３Ｋとかみ合う。第１指節部８３Ａは、第１ウォームホイール８３Ｋと共に第１指関節部８３Ｄの回りを回転する。
第１指節部８３Ａから指先側の構造は、対向指部８７と同様である。第１ホイール連動部８３ＡＡの長さは、対向指部８７の第１ホイール連動部８７ＡＡよりも短い。
第２指部８４、第３指部８５および第４指部８６の構造は、第１指部８３の構造と同様である。
第１指部８３を例にして、ウォームギヤ機構の配置について説明する。第１指関節部８３Ｄにおいて、図９０に示されているように、ウォームギヤ機構は、掌板部８２が延在する方向では指元ヨーク部８３Ｇが存在する範囲または指元ヨーク部８３Ｇよりも掌板部８２が存在する側の範囲に存在する。同時に、ウォームギヤ機構は、掌板部８２に垂直な方向では掌板部８２よりも回転軸が存在する側の範囲に存在する。第２指部８４などでも同様にウォームギヤ機構を配置している。第１指関節部のウォームギヤ機構をこのような範囲に配置しているので、手部９Ａで物体を保持する際に、ウォームギヤ機構が物体を保持する上で邪魔または障害になることはない。なお、図９０は、第１指関節部８３Ｄおよび第２指関節部８３Ｅの回転軸に平行な方向から手部９Ａを見た図である。
第２指関節部８３Ｅにおいて、図９０に示されているように、ウォームギヤ機構は、第１指節部８３Ａが延在する方向と直交する方向では、第１指節部８３Ａが存在する範囲または第１指節部８３Ａよりも掌板部８２から遠い側の範囲に存在する。第１指節部８３Ａが延在する方向と直交する方向で第１指節部８３Ａよりも掌板部８２から遠い側の範囲は、手の甲側である。第１指部８３は、各指関節部は伸ばした状態から手の平側に回転できる。各指関節部を手の平側に回転させると、第１指部８３は掌板部８２に近づく。第１指部８３の手の甲側は、第１指部８３よりも掌板部８２から遠い側である。第２指部８４などでも、第２指関節部では同様にウォームギヤ機構を配置している。第２指関節部のウォームギヤ機構をこのような範囲に配置しているので、手部９Ａで物体を保持する際に、ウォームギヤ機構が物体を保持する上で邪魔または障害になることはない。
動作を説明する。手部９Ａは、各指部の第１指関節部、第２指関節部が指定された角度になるように、各指関節部のウォームギヤが指定された角度に対応する位置になるように、モータが駆動される。
各指関節部は、ウォームとウォームホイールを使用するウォームギヤ機構で駆動するようにしたので、指曲げの力を大きくすることができる。第１指関節部および第２指関節部をそれぞれウォームギヤ機構で駆動するので、第１指関節部と第２指関節部のどちらか一方だけを曲げたり、両方を曲げたりできる。また、電源供給が遮断された場合にも、ウォームギヤ機構により把持力を維持できる。
対向指部８７は、第１指関節部８７Ｄに加えて、第２指関節部８７Ｅおよび第３指関節部８７Ｆも有するので、図１０２に示すように、第２指関節部８７Ｅを曲げて物体を保持することができる。第２指関節部８７Ｅおよび第３指関節部８７Ｆは、第１指関節部８７Ｄと平行な回転軸を有する。そのため、手部９Ａでは、第１指関節部８７Ｄだけを曲げて、第２指関節部８７Ｅおよび第３指関節部８７Ｆを伸ばして、紙のような薄い物体を持つこともできる。
手部９では、第１ウォーム９３Ｊが第１指節部９３Ａよりも掌板部９２の側に出ている。それに対して、手部９Ａでは、第１ウォーム８３Ｊは手の甲側に存在する。第１指部８３では、第１指節部８３Ａ、第２指節部８３Ｂおよび第３指節部８３Ｃが掌板部８２に面している。第１指部８３などと掌板部８２との間で物体を保持する際に、第１ウォーム８３Ｊなどが物体と接触することを防ぐ部材などが不要になり、手部９Ａは手部９よりも構造が簡単になる。
第１指部８３、第２指部８４、第３指部８５および第４指部８６を、同じ構造としたが、指により構造を変更してもよい。ウォームギヤ機構を有するすべての指関節部で、モータで駆動されるウォームを基部側部材に対して垂直としたが、少なくとも１本の指部の少なくとも１個のウォームギヤ機構で基部側部材に対して垂直としてもよい。
３個の指関節部を有する対向指部を、対向可能指部のように掌板部に対して手幅方向に回転可能にしてもよい。
以上のことは、他の実施の形態にもあてはまる。
実施の形態４．
実施の形態４は、対向指部の替わりに手幅方向に指全体が回転する手幅回転指を有する手部を人型ロボットが有するように実施の形態３を変更した場合である。図９７は、実施の形態４に係る人型ロボットが有する左の手部９Ｂを手幅回転指部８８が伸びた状態で手の甲側から見た斜視図である。図９８は、左の手部９Ｂを手幅回転指部８８が掌板部８２に交差する方向を向いた状態で手の甲側から見た斜視図である。図９９、図１００、図１０１、図１０２、および図１０３は、手幅回転指部８８が伸びた状態での左の手部９Ｂの正面図、第１指部８３が存在する側から見た側面図、背面図、第４指部８６が存在する側から見た側面図、および指先側から見た側面図である。図１０４、図１０５、図１０６、図１０７、および図１０８は、手幅回転指部８８が掌板部８２に交差する方向を向いた状態での左の手部９Ｂの正面図、第１指部８３が存在する側から見た側面図、背面図、第４指部８６が存在する側から見た側面図、および指先側から見た側面図である。図１０９と図１１０は、手幅回転指部８８を拡大した斜視図である。図１０９は、手幅回転指部８８が伸びた状態での斜視図である。図１１０は、手幅回転指部８８が掌板部８２に交差する方向を向いた状態での斜視図である。
図９７から図１１０では、手首板部９１までを図示している。掌板部８２、第１指部８３、第２指部８４、第３指部８５および第４指部８６は、実施の形態１の場合と同じ構造である。これらの図では、実施の形態３の図８７から図９７では省略しているカバーなども図示している。
第１指節カバー８３Ｘは、第１ヨーク部８３ＡＢを第１ホイール連動部８３ＡＡに取付ける部分を覆うカバーである。第１指節カバー８３Ｘは、略長方形の板材をＵの字状に曲げた部材である。略長方形の板材は、一辺の中央に略長方形の突起を有する。第１指節カバー８３Ｘは、手の平側から第１指節部８３Ａに被せる。略長方形の突起の部分は角を丸くしており、途中で段差ができるように折り曲げている。
第２指節カバー８３Ｙは、第２ウォームホイール８３Ｎ、２枚の第２指節部８３Ｂに挟まれない側に存在する部分ギヤ８３Ｑ、アイドラギヤ８３Ｒおよびアイドラ外ギヤ８３ＳＡなどを覆うカバーである。第２指節カバー８３Ｙは、第１指節カバー８３Ｘと同様な形状である。第１指部８３に沿う方向の長さは、第２指節カバー８３Ｙの方が、第１指節カバー８３Ｘよりも長い。
第２ウォームカバー８３Ｚは、第２ウォーム８３Ｍを手の甲側から覆うカバーである。
第２ウォームカバー８３Ｚは、一方にだけ底があり他方にフランジを有する円筒を軸方向に半分に切ったような形状である。円筒の部分の内部に、第２ウォーム８３Ｍが存在する。第２モータ設置部８３ＡＣのモータ設置面の裏面に、フランジを取付ける。フランジの外形は、モータ設置面と同じような形状である。
手部９Ａと異なる点を説明する。手部９Ｂは、対向指部８７の替わりに手幅回転指部８８を有する。手幅回転指部８８は、手幅方向に指全体が回転可能に掌板部８２に取付けられる。手幅回転指部８８は、対向指部８７と同様な位置で掌板部８２に取付けられる。手幅回転指部８８は、掌板部８２の一部である手幅回転指取付部８２Ｖに取付けられる。手幅回転指取付部８２Ｖは、対向指部指取付部８２Ｅと同様に、指先方向の手首側であり手幅方向では第１指取付部８２Ａ側である掌板部８２の角に存在する。手幅回転指取付部８２Ｖの形状は、対向指部指取付部８２Ｅと同様な形状である。
手幅回転指部８８は、指元ヨーク部８８Ｇから指先側は対向指部８７と同じ構造である。手幅回転指部８８と対向指部８７とが異なるのは、掌板部８２への取付け方向だけである。
手幅回転指部８８は、手幅方向に回転するように、２面が開いた箱状の手幅指元部８８Ｗを介して掌板部８２に取付けられる。手幅指元部８８Ｗは、手幅回転指取付部８２Ｖの手の甲側に、手首に向かうように２０度程度の角度を持たせて取付ける。指部第１モータ８８Ｈおよび第２ギヤヘッド８８Ｔは、手幅指元部８８Ｗの内部に収納され、手幅指元部８８Ｗの手幅方向の面であるモータ設置面に取付けられる。モータ設置面には貫通穴があり、第２ギヤヘッド８８Ｔの回転軸が貫通穴を通る。モータ設置面の外面には、指元ヨーク部８８Ｇが取付けられる。指元ヨーク部８８Ｇは、その軸部材がモータ設置面に平行であり掌板部８２に対して約６５度の角度をなすように取付けられる。そうすることで、手幅回転指部８８を伸ばした状態で第１指関節部８８Ｄを回転させた場合に、第３指節部８８Ｃが掌板部８２よりも指先側に位置して、手幅回転指部８８と掌板部８２との間に物体を保持しやすい。手幅指元部８８Ｗは、モータ設置面および掌板部８２への取付面の両側に側面を有する。２個の側面の角は大きく直線で切取った形状である。手幅指元部８８Ｗの側面は、上底が短く下底に垂直な辺を有する台形状である。手首側の側面では、掌板部８２への取付面の側の辺が、もう一方の側面よりも短い。
手幅回転指部８８は、対向指部８７と同様に、第１指節部８８Ａが第１指節部８３Ａなどよりも長い。そのため、第１指節カバー８３Ｘは、第２指節カバー８３Ｙよりも長い。
動作を説明する。手部９Ｂは、各指部の第１指関節部、第２指関節部が指定された角度になるように、各指関節部のウォームギヤが指定された角度に対応する位置になるように、モータが駆動される。
各指関節部は、ウォームとウォームホイールを使用するウォームギヤ機構で駆動するようにしたので、指曲げの力を大きくすることができる。第１指関節部および第２指関節部をそれぞれウォームギヤ機構で駆動するので、第１指関節部と第２指関節部のどちらか一方だけを曲げたり、両方を曲げたりできる。また、電源供給が遮断された場合にも、ウォームギヤ機構により把持力を維持できる。
手幅方向に回転する手幅回転指部８８を備えることで、手幅回転指部８８を伸ばした際の手部９Ｂの手幅方向の長さが手部９Ａよりも大きくなる。そのため、手部９Ｂの方が手部９Ａよりも大きな物体を保持することができる。掌板部８２を上側に向けて、左右の手部９Ｂが同じ高さに並ぶようにすれば、両手で大きな物体を持つこともできる。
実施の形態５．
実施の形態５は、人型上半身ロボットを移動可能で高さが変更可能な台座に載せた場合である。図１１１から図１１３を参照して、人型上半身ロボットの全体構成を説明する。この発明の実施形態５に係る人型上半身ロボットの全体斜視図、全体正面図、全体側面図を、それぞれ図１１１、図１１２、図１１３に示す。
人型上半身ロボット１００Ｃは、腰部から上の上半身のロボットである。人型上半身ロボット１００Ｃは、人型上半身ロボット１００Ｃを制御するための制御装置（図示せず）を収納する制御装置収納部１５０の上面に載せる。人型上半身ロボット１００Ｃの腰部が、制御装置収納部１５０の上面に固定される。制御装置収納部１５０は、直方体の形状である。人型上半身ロボットおよび制御装置は、開発中であるため、制御装置の改造が容易なように、制御装置収納部１５０は大きめにしている。実際に人型ロボットを使用する際には、制御装置を小型の鞄程度の大きさにして、例えば人型ロボットの背面に配置する。
制御装置収納部１５０は、台座昇降部１６０の上に載せられる。台座昇降部１６０は、台車１７０の上に載せられる。台座昇降部１６０は、図では簡易的に書いているが、上面と下面を結ぶリンクの角度が変化して上面の高さを変更できる。台車１７０は、人などに押される、あるいは自動走行の機能を持たせる。台座昇降部１６０は、人型上半身ロボット１００Ｃが搭載され、上半身ロボット１００Ｃを上下方向に移動させる高さ調整部である。台車１７０は、上半身ロボット１００Ｃおよび台座昇降部１６０を移動させる移動部である。台座昇降部および台車は図に示すもの以外の構成のものでもよい。人型上半身ロボット１００Ｃは、台車１７０により使用する場所に移動し、台座昇降部１６０により操作する対象に対して適切な高さにする。さらに、上半身ロボット１００Ｃに作業に適切な姿勢をとらせることができる。人型上半身ロボット１００Ｃ、台座昇降部１６０および台車１７０とで１体のロボットと考えることもできる。
実施の形態１の人型ロボット１００のように、人と同様な形状の下半身を持たせてもよい。腰部を有さず胸部までの上半身のロボットでもよい。腰部を持たない上半身ロボットは、胸部が制御装置収納部１５０の上面に固定されることで、制御装置収納部１５０に搭載される。
図１１４から図１１９に示すように、人型上半身ロボット１００Ｃは、人の腰から上と同様な構造を有する。図１１４、図１１５および図１１６は、人型上半身ロボット１００Ｃの斜視図である。図１１４は、前方から見た場合の斜視図である。図１１５は、左側面から見た場合の斜視図である。図１１６は、背面から見た斜視図である。人型上半身ロボット１００Ｃの正面図、平面図および底面図を、それぞれ図１１７、図１１８および図１１９に示す。
人型上半身ロボット１００Ｃは、体幹部１Ｃ、体幹部１Ｃの上部の左右から出る一対の上肢部３Ｃを有する。なお、人型上半身ロボット１００Ｃは、頭部を有しない。体幹部１Ｃの中央上側に頭部を有するようにしてもよい。
体幹部１Ｃは、上側の胸部５Ｃと下側の腰部６Ｃに分けられる。上肢部３Ｃは、上腕部７Ｃ、前腕部８Ｃおよび手部９Ｃが直列に接続する。左右一対の上肢部３Ｃは、右の上肢部３Ｃと左の上肢部３Ｃとが鏡像の関係となる構造を有する。左右の上肢部３Ｃは、鏡像の関係にならない部分があってもよい。
人型上半身ロボット１００Ｃの各関節部の自由度の次数は、手首部、胸部５Ｃと腰部６Ｃの間は、前後左右に動かせ、捻りの動作もできる３回転自由度としている。肩部、肘部は前後左右に動かせる２回転自由度としている。なお、肩部、肘部などを３回転自由度にしてもよい。
図１１４から図１３２を参照して、体幹部１Ｃの構造を説明する。図１２０、図１２１、図１２２および図１２３は、それぞれ人型上半身ロボット１００Ｃが有する胴体屈曲部の斜視図、正面図、左側面図および右側面図である。図１２０から図１２３では、人型上半身ロボット１００Ｃは上肢部３Ｃおよび肩部Ｃ４Ｃを駆動するアクチュエータなどを取外した状態である。図１２７、図１２８および図１２９は、それぞれ人型上半身ロボット１００Ｃが有する肩部の正面図、平面図および左側面図である。図１２０から図１２３では、人型上半身ロボット１００Ｃは上腕部７Ｃから先を肩部Ｃ４Ｃから取外した状態である。図１３０は、人型上半身ロボット１００Ｃの左肩を下から見た図である。図１３１、図１３２は、人型上半身ロボット１００Ｃの左肩の斜視図である。図１３１は、人型上半身ロボット１００Ｃの左肩を前方上から見た斜視図である。図１３２は、人型上半身ロボット１００Ｃの左肩を後方上から見た斜視図である。
胸部５Ｃは、肩部フレーム５１Ｃおよび胸部骨格板５２Ｃを有する。胸部骨格板５２Ｃは、人型上半身ロボット１００Ｃの左右方向および上下方向に延在する板状の部材である。人型ロボット１００が有する胸部５は、多くのフレームを有する構造である。胸部５と比較すると、胸部５Ｃは、簡単な構造である。
胸部骨格板５２Ｃは、人型上半身ロボット１００Ｃの前後方向の中心に位置する。胸部骨格板５２Ｃは、正面から見ると略長方形である。長方形の上に、左右方向の幅がしだいに広くなる部分が接続し、さらにその上の部分では左右方向の幅が階段状に狭くなる。この階段状の部分に、左右から肩部フレーム５１Ｃが接続する。左右方向の幅が階段状に狭くなる部分での高さは、左右方向の両端の肩部フレーム５１Ｃで接続する部分でだけ高い。長方形の下端の左右の端部には、半円状に出る部分が存在する。
胸部骨格板５２Ｃは、側面から見ると上下方向に延在する板状の部分と、上下方向の板状の部分の上と下に前後方向に延在する板状の部分とを有する。上側の板状の部分は、前後方向の幅が左右方向で同じである。下側の板状の部分は、前後方向の幅が左右方向の中央で大きい。胸部骨格板５２Ｃは、中央付近の２箇所に上下に伸びる補強リブが前面および背面にある。また、胸部骨格板５２Ｃは、軽量化のために補強リブで挟まれる部分に２個、左右の補強リブの外側にそれぞれ１個の開口を有する。
胸部骨格板５２Ｃの上側で左右の端に近い部分すなわち両肩に相当する部分には、肩部フレーム５１Ｃが接続する。肩部フレーム５１Ｃは、後方に曲がって延在する。肩部フレーム５１Ｃの外側の端には、肩関節部装着穴５１Ｈが設けられている。肩関節部装着穴５１Ｈには、肩関節部１３が装着される。
図１２０および図１２１などに示すように、胸部骨格板５２Ｃの左右の端付近には、上下に並んで肩部第１装着穴５２Ｈおよび肩部第２装着穴５２Ｌが設けられている。肩部第２装着穴５２Ｌは、胸部骨格板５２Ｃの下端の左右の端部の半円状に出る部分に設けられる。上側の肩部第１装着穴５２Ｈには、前方から胸側主リンク取付部Ｊ１が装着される。下側の肩部第２装着穴５２Ｌには、後方から胸側補助リンク取付部Ｊ２が装着される。なお、人型ロボット１００では、胸側主リンク取付部Ｊ１が胸郭部フレーム５２の前側の部分から後方に向けて取付けられている。また、胸側補助リンク取付部Ｊ２は、胸郭部フレーム５２の後側の部分から前方に向けて取付けられている。
胸側主リンク取付部Ｊ１は、胸部骨格板５２Ｃに垂直な回転軸の回りに回転する回転部材に設けられたヨークが上腕部駆動主リンク１４Ｌを挟む２軸ジンバルである。胸側補助リンク取付部Ｊ２は、胸部骨格板５２Ｃに垂直な回転軸の回りに回転する回転部材に設けられたヨークが上腕部駆動補助リンク１５Ｌを挟む２軸ジンバルである。胸側主リンク取付部Ｊ１および胸側補助リンク取付部Ｊ２の回転部材を回転させる回転軸は、胸側主リンク取付部Ｊ１と胸側補助リンク取付部Ｊ２とを通るリンク移動面回転軸とは、方向が異なる。したがって、上腕部駆動主リンク１４Ｌおよび上腕部駆動補助リンク１５Ｌは、軸回りの１回転自由度が必要である。
胸部骨格板５２Ｃの下側には、円柱状の背骨部５６が設けられる。背骨部５６は、胸部骨格板５２Ｃの前後方向の幅が広い下面に垂直である。背骨部５６の下端には、背骨部５６を腰部６に３回転自由度を有して回転可能に接続する胸腰部関節部１８が設けられる。胸腰部関節部１８には、球面軸受が用いられる。捻り軸である背骨部５６は、胸部５Ｃに対して方向が固定されている。
腰部６Ｃは、円盤状である。円盤の中心に胸腰部関節部１８が設けられる。胸腰部関節部１８の周囲の腰部６Ｃは、円筒状になっており他の部分よりも厚い。
胸部５Ｃと腰部６Ｃの間には、図１２０から図１２３に示すように、３本の胸腰部中央アクチュエータ１９Ｃ、胸腰部右アクチュエータ２０Ｃ、胸腰部左アクチュエータ２１Ｃが設けられる。胸腰部中央アクチュエータ１９Ｃは、胸腰部中央リンク１９ＬＣを有する。胸腰部右アクチュエータ２０Ｃは、胸腰部右リンク２０ＬＣを有する。胸腰部左アクチュエータ２１Ｃは、胸腰部左リンク２１ＬＣを有する。
胸部骨格板５２Ｃの下面には、胸部中央リンク取付部Ｊ５Ｃおよび胸部右リンク取付部Ｊ６Ｃが設けられる。胸部中央リンク取付部Ｊ５Ｃおよび胸部右リンク取付部Ｊ６Ｃには、胸腰部中央リンク１９ＬＣおよび胸腰部右リンク２０ＬＣの一端がそれぞれ２回転自由度を有して回転可能に接続する。胸部中央リンク取付部Ｊ５Ｃは、胸部骨格板５２Ｃに設けられたヨークが胸腰部中央リンク１９ＬＣの一端を回転可能に挟む構造である。胸部中央リンク取付部Ｊ５Ｃのヨークは、胸部骨格板５２Ｃから背面側に出るＹ軸に平行な回転軸の回りを回転する回転部材に設けられる。胸部右リンク取付部Ｊ６Ｃは、胸部骨格板５２Ｃに設けられたヨークが胸腰部右リンク２０ＬＣの一端を回転可能に挟む構造である。胸部右リンク取付部Ｊ６Ｃのヨークは、胸部骨格板５２Ｃから前面側に出るＸ軸と約２５度の角度をなす水平な回転軸の回りを回転する回転部材に設けられる。
胸部中央リンク取付部Ｊ５Ｃ、胸部右リンク取付部Ｊ６Ｃは、同じ高さに存在する。背骨部５６において、胸部５Ｃに設けられた胸部中央リンク取付部Ｊ５Ｃ、胸部右リンク取付部Ｊ６Ｃの高さの箇所を背骨上端部５６Ｂと呼ぶ。
中央リンク左リンク取付部Ｊ７Ｃは、胸腰部中央リンク１９ＬＣの胸部中央リンク取付部Ｊ５Ｃから決められた距離の位置に設けられる。中央リンク左リンク取付部Ｊ７Ｃには、胸腰部左リンク２１ＬＣの一端が２回転自由度を有して回転可能に接続する。中央リンク左リンク取付部Ｊ７Ｃは、胸腰部左リンク２１ＬＣの一端に設けられたヨークが、胸腰部中央リンク１９ＬＣに設けられた突起を挟む構造である。突起は、胸腰部中央リンク１９ＬＣに設けられた直方体の両側面に出る同一直線上に設けられる。突起が設けられる直方体は、胸腰部中央リンク１９ＬＣの軸回りに回転可能である。中央リンク左リンク取付部Ｊ７Ｃは、胸腰部中央リンク１９ＬＣの軸回りの１回転自由度を含む２回転自由度を有する。胸部中央リンク取付部Ｊ５Ｃ、胸部右リンク取付部Ｊ６Ｃおよび中央リンク左リンク取付部Ｊ７Ｃは、２軸ジンバルである。
腰部６Ｃの上面には、腰部中央リンク取付部Ｊ１０Ｃ、腰部右リンク取付部Ｊ８Ｃおよび腰部左リンク取付部Ｊ９Ｃが設けられる。腰部中央リンク取付部Ｊ１０Ｃ、腰部右リンク取付部Ｊ８Ｃおよび腰部左リンク取付部Ｊ９Ｃには、胸腰部中央リンク１９ＬＣ、胸腰部右リンク２０ＬＣおよび胸腰部左リンク２１ＬＣの他端がそれぞれ２回転自由度を有して回転可能に接続する。２軸ジンバルである腰部中央リンク取付部Ｊ１０Ｃ、腰部右リンク取付部Ｊ８Ｃおよび腰部左リンク取付部Ｊ９Ｃは、胸腰部関節部１８と同じ高さに存在する。腰部中央リンク取付部Ｊ１０Ｃは、腰部６Ｃに設けられたヨークが胸腰部中央リンク１９ＬＣの他端を回転可能に挟む構造である。腰部中央リンク取付部Ｊ１０Ｃのヨークは、腰部６Ｃから背面側に出るＹ軸に平行な回転軸の回りを回転する回転部材に設けられる。腰部右リンク取付部Ｊ８Ｃは、腰部６Ｃに設けられたヨークが胸腰部右リンク２０ＬＣの他端を回転可能に挟む構造である。腰部右リンク取付部Ｊ８Ｃのヨークは、腰部６Ｃから右腕側に出るＸ軸と平行な回転軸の回りを回転する回転部材に設けられる。腰部左リンク取付部Ｊ９Ｃは、腰部６Ｃに設けられたヨークが胸腰部左リンク２１ＬＣの他端を回転可能に挟む構造である。腰部左リンク取付部Ｊ９Ｃのヨークは、腰部６Ｃの背面側に出る水平な回転軸の回りを回転する回転部材に設けられる。回転軸は、Ｘ軸と約２５度の角度をなす。
胸腰部中央リンク１９ＬＣ、胸腰部右リンク２０ＬＣおよび胸腰部左リンク２１ＬＣは、腰部６Ｃには取付具を介して取付けられる。取付具は、ねじ棒と平行な部材である。取付具を介するので、胸腰部中央リンク１９ＬＣ、胸腰部右リンク２０ＬＣおよび胸腰部左リンク２１ＬＣは、ねじ棒が延在する直線から決められた方向に決められた距離の位置で腰部６Ｃに取付けられる。決められた方向は、リンク取付部のヨークを回転させる回転軸およびリンクが存在する平面内でリンクと直交する方向である。
胴体屈曲部Ｃ２Ｃは、胸腰部関節部１８の回りに３回転自由度を有して胸部５Ｃを腰部６Ｃに対して回転可能に接続する回転接続機構である。図１２４から図１２５を参照して、胴体屈曲部Ｃ２Ｃでのリンクとリンク取付部の配置を説明する。図１２４は、人型上半身ロボット１００Ｃが有する胴体屈曲部Ｃ２Ｃのリンク配置を示す斜視図である。図１２５は、胴体屈曲部Ｃ２Ｃの基準状態でのリンク配置を背骨部が延在する方向から見た図である。
図１２５から分かるように、胸腰部中央リンク１９ＬＣは背骨部５６の真後ろに背骨部５６との角度が数度以下で存在する。胸腰部右リンク２０ＬＣは、背骨部５６の右側（正面から見ると左側）に存在する。胸腰部左リンク２１ＬＣは、腰部６Ｃの左側（正面から見ると右側）の端付近から背骨部５６の後ろを結ぶ。腰部６Ｃ側では、腰部中央リンク取付部Ｊ１０Ｃ、腰部左リンク取付部Ｊ９Ｃおよび腰部右リンク取付部Ｊ８Ｃが背骨部５６の背面側で左右方向および前後方向に十分な幅を有して配置されている。そのため、胸部５Ｃの荷重を背骨部５６、胸腰部中央リンク１９ＬＣ、胸腰部右リンク２０ＬＣ、胸腰部左リンク２１ＬＣに分散させて安定して支持できる。胸部中央リンク取付部Ｊ５Ｃ、胸部右リンク取付部Ｊ６Ｃ、背骨上端部５６Ｂで形成される三角形では、背骨上端部５６Ｂに対応する頂点での角度が１１０度程度である。胸部中央リンク取付部Ｊ５Ｃ、胸部右リンク取付部Ｊ６Ｃは、背骨上端部５６Ｂから腰部６Ｃの半径程度離れている。そのため、胸腰部中央リンク１９ＬＣを伸縮させると、胸部５Ｃを主に前後方向に傾けることができる。胸腰部右リンク２０ＬＣを伸縮させると、胸部５Ｃを主に左右方向に傾けることができる。胸腰部左リンク２１ＬＣを伸縮させると、背骨部５６の回りに胸部５Ｃを主に回転させることができる。
図１２６により、胴体屈曲部でのリンク取付部の配置に関する条件を表現するための線分などを定義する。図１２６は、胴体屈曲部の基準状態でのリンク配置を評価する変数を示す図である。図１２６(A)では、腰部６Ｃでのリンク取付部の配置を示す。図１２６(B)では、胸部５Ｃでのリンク取付部の配置を示す。腰部中央リンク取付部Ｊ１０Ｃ、腰部左リンク取付部Ｊ９Ｃおよび腰部右リンク取付部Ｊ８Ｃで決定される平面を、腰部基準平面と呼ぶ。図１２６(A)には、腰部基準平面での胸腰部関節部１８、腰部中央リンク取付部Ｊ１０Ｃ、腰部左リンク取付部Ｊ９Ｃおよび腰部右リンク取付部Ｊ８Ｃの位置関係を示す。腰部基準平面と背骨部５６の交点を、第１捻り中心と呼ぶ。胴体屈曲部Ｃ２Ｃでは、第１捻り中心は胸腰部関節部１８と一致する。なお、胸腰部関節部１８が腰部基準平面上にない場合は、第１捻り中心は胸腰部関節部１８とは異なる位置になる。また、胸腰部関節部１８での接続角度が変化すると、第１捻り中心の位置が僅かに変化する。胸腰部関節部１８と腰部基準面との距離は、上限値以下であるように決める。
腰部中央リンク取付部Ｊ１０Ｃと胸腰部関節部１８（第１捻り中心）を結ぶ線分を第１線分Ｓ１１と呼ぶ。腰部右リンク取付部Ｊ８Ｃと胸腰部関節部１８を結ぶ線分を第３線分Ｓ１３と呼ぶ。腰部左リンク取付部Ｊ９Ｃと胸腰部関節部１８を結ぶ線分を第２線分Ｓ１２と呼ぶ。第１線分Ｓ１１、第２線分Ｓ１２および第３線分Ｓ１３の長さを、変数Ｌ１１、Ｌ１２およびＬ１３で表す。第１線分Ｓ１１と第３線分Ｓ１３とがなす角度を、変数η１で表す。
胴体屈曲部Ｃ２Ｃでは、η１は約９０度である。すなわち、第１線分Ｓ１１と第３線分Ｓ１３はほぼ直交する。そのため、腰部中央リンク取付部Ｊ１０Ｃ、腰部左リンク取付部Ｊ９Ｃおよび胸腰部関節部１８で形成される三角形（第１部材三角形）は、どの方向から見ても十分な幅を有する。胸部５Ｃの荷重を第１部材三角形で安定して支持することができる。η１は、直交（９０度で交差）でなくても、例えば６０度から１２０度などのように９０度を含むように決められた第１交差角範囲内に存在すればよい。
第１線分Ｓ１１が、第２線分Ｓ１２と第３線分Ｓ１３の間に存在する。そのため、第１部材三角形の幅は、第１線分Ｓ１１が第２線分Ｓ１２と第３線分Ｓ１３の間に無い場合よりも広くでき、胸部５Ｃの荷重を第１部材三角形で安定して支持することができる。また、第１線分Ｓ１１の長さＬ１１および第３線分Ｓ１３の長さＬ１３の何れか短い方を長い方で割った値を長短比と呼ぶ。長短比を変数λで表す。λ＝約０．９３である。そのため、胸部５Ｃの荷重を腰部左リンク取付部Ｊ９Ｃおよび胸腰部関節部１８でほぼ均等に支持できる。長短比λは、例えば０．８などの決められた下限比以上であればよい。
胸部中央リンク取付部Ｊ５Ｃを通り背骨部５６に垂直な平面と背骨部５６の交点を、第２捻り中心５６Ｂと呼ぶ。ここで、第２捻り中心５６Ｂは、背骨上端部５６Ｂでもある。胸部中央リンク取付部Ｊ５Ｃ、第２捻り中心５６Ｂおよび胸部右リンク取付部Ｊ６Ｃを通る平面を、胸部基準平面と呼ぶ。人型上半身ロボット１００Ｃでは、胸部基準平面が背骨部５６に垂直である。図１２６(B)には、胸部基準平面での第２捻り中心５６Ｂ、胸部中央リンク取付部Ｊ５Ｃおよび胸部右リンク取付部Ｊ６Ｃの位置関係を示す。ここで、胸部基準平面において、第２捻り中心５６Ｂと胸部中央リンク取付部Ｊ５Ｃを結ぶ線分を、第４線分Ｓ１４と呼ぶ。第２捻り中心５６Ｂと胸部右リンク取付部Ｊ６Ｃを結ぶ線分を、第５線分Ｓ１５と呼ぶ。第４線分Ｓ１４と第５線分Ｓ１５がなす角度を、変数η２で表す。
胴体屈曲部Ｃ２Ｃでは、η２は約１１９度である。また、中央リンク左リンク取付部Ｊ７Ｃで、胸腰部左リンク２１ＬＣは胸腰部中央リンク１９ＬＣに対する角度ζは、ζ＝約３２度の角度で接続する。
η２は約１１９度と、例えば５５度から１２５度のなどのように９０度を含むように決められた第２交差角範囲内である。そのため、胸部中央リンク取付部Ｊ５Ｃおよび胸部右リンク取付部Ｊ６Ｃの一方の位置が変化するようにリンクを伸縮させることで胸部５Ｃが傾く方向と、他方の位置が変化するようにリンクを伸縮させることで傾く方向が十分に異なる。その結果、胸部５Ｃをどの方向にも適切に傾けることができる。ζ＝約３２度と、例えば２０度などのように決められた第３交差角以上である。そのため、胸腰部左リンク２１ＬＣを伸縮させることで、胸部５Ｃを背骨部５６の回りを効率的に回転させることができる。
胴体屈曲部Ｃ２Ｃは、第１部材である腰部６Ｃに第２部材である胸部５Ｃを胸腰部関節部１８により回転可能に接続する回転接続機構である。胸腰部関節部１８は、腰部６Ｃに胸部５Ｃを、３回転自由度を有して回転可能に接続する関節部である。胴体屈曲部Ｃ２Ｃは、胸腰部関節部１８の角度を変更して胸部５Ｃを腰部６Ｃに対して移動させる。
胸腰部中央リンク１９ＬＣが、５回転自由度を有する第１リンクである。胸部中央リンク取付部Ｊ５Ｃは、胸部５Ｃに設けられた第２部材第１取付部である。胸部中央リンク取付部Ｊ５Ｃは、胸腰部関節部１８に対する相対的な位置関係が固定されている。胸部中央リンク取付部Ｊ５Ｃに、胸腰部中央リンク１９ＬＣの一端が少なくとも２回転自由度を有して回転可能に取付けられる。腰部中央リンク取付部Ｊ１０Ｃが、腰部６Ｃに設けられた第１部材第１取付部である。腰部中央リンク取付部Ｊ１０Ｃに、胸腰部中央リンク１９ＬＣの他端が少なくとも２回転自由度を有して回転可能に取付けられる。腰部中央リンク取付部Ｊ１０Ｃは、胸腰部関節部１８に対する相対的な位置関係が固定されている。腰部中央リンク取付部Ｊ１０Ｃは、腰部６Ｃに設けられた第１基準点でもある。胸腰部中央リンク１９ＬＣ自体が、１回転自由度を有する。モータ１９Ｍは、胸腰部中央リンク１９ＬＣの長さを変更する力を発生させる第１動力源である。胸腰部中央リンク１９ＬＣの長さは、胸部中央リンク取付部Ｊ５Ｃと腰部中央リンク取付部Ｊ１０Ｃの距離である。胸腰部中央リンク１９ＬＣ、胸部中央リンク取付部Ｊ５Ｃ、腰部中央リンク取付部Ｊ１０Ｃおよびモータ１９Ｍを有する胸腰部中央アクチュエータ１９が、第１アクチュエータである。
胸腰部左リンク２１ＬＣが、５回転自由度を有する第２リンクである。中央リンク左リンク取付部Ｊ７Ｃが、胸腰部中央リンク１９ＬＣに設けられた第１リンク第２取付部である。中央リンク左リンク取付部Ｊ７Ｃは、胸部中央リンク取付部Ｊ５Ｃに対する相対的な位置関係が固定されている。中央リンク左リンク取付部Ｊ７Ｃに、胸腰部左リンク２１ＬＣの一端が少なくとも２回転自由度を有して回転可能に取付けられる。腰部左リンク取付部Ｊ９Ｃが、腰部６Ｃに設けられた第１部材第２取付部である。腰部右リンク取付部Ｊ８Ｃには、胸腰部左リンク２１ＬＣの他端が少なくとも２回転自由度を有して回転可能に取付けられる。腰部左リンク取付部Ｊ９Ｃは、胸腰部関節部１８に対する相対的な位置関係が固定されている。腰部左リンク取付部Ｊ９Ｃは、腰部６Ｃに設けられた第２基準点でもある。胸腰部左リンク２１ＬＣ自体が、１回転自由度を有する。モータ２１Ｍは、胸腰部左リンク２１ＬＣの長さを変更する力を発生させる第２動力源である。胸腰部左リンク２１ＬＣの長さは、中央リンク左リンク取付部Ｊ７Ｃと腰部左リンク取付部Ｊ９Ｃの距離である。胸腰部左リンク２１ＬＣ、中央リンク左リンク取付部Ｊ７Ｃ、腰部左リンク取付部Ｊ９Ｃ、モータ２１Ｍを有する胸腰部左アクチュエータ２１が、第２アクチュエータである。
胸腰部右リンク２０ＬＣが、５回転自由度を有する第３リンクである。胸部右リンク取付部Ｊ６Ｃが、胸部５Ｃに設けられた第２部材第３取付部である。胸部右リンク取付部Ｊ６Ｃは、胸部５Ｃに対する相対的な位置関係が固定されている。胸部右リンク取付部Ｊ６Ｃに、胸腰部右リンク２０ＬＣの一端が少なくとも２回転自由度を有して回転可能に取付けられる。腰部右リンク取付部Ｊ８Ｃが、腰部６Ｃに設けられた第１部材第３取付部である。腰部右リンク取付部Ｊ８Ｃに、胸腰部右リンク２０ＬＣの他端が少なくとも２回転自由度を有して回転可能に取付けられる。胸腰部右リンク２０ＬＣ自体が、１回転自由度を有する。モータ２０Ｍは、胸腰部右リンク２０ＬＣの長さを変更する力を発生させる第３動力源である。胸腰部右リンク２０ＬＣの長さは、胸部右リンク取付部Ｊ６Ｃと腰部右リンク取付部Ｊ８Ｃの距離である。胸腰部右リンク２０ＬＣ、胸部右リンク取付部Ｊ６Ｃ、腰部右リンク取付部Ｊ８Ｃ、モータ２０Ｍを有する胸腰部右アクチュエータ２０が、第３アクチュエータである。
腰部基準平面は、第１部材第１取付部、第１部材第２取付部および第１部材第３取付部を通る平面である第１部材基準平面である。第１捻り中心は、第１部材基準平面と捻り軸との交点である。第１線分は、第１捻り中心と第１部材第１取付部を結ぶ線分である。第２線分は、第１捻り中心と第１部材第２取付部を結ぶ線分である。第３線分は、第１捻り中心と第１部材第３取付部を結ぶ線分である。
胸部５Ｃのように捻り軸との間の角度が固定されている第２部材では、第２部材第１取付部を通り捻り軸に垂直な平面と捻り軸との交点を第２捻り中心と呼ぶ。第２捻り中心、第２部材第１取付部および第２部材第２取付部を通る平面を第２部材基準平面と呼ぶ。胸部５Ｃでは、胸部基準平面が第２部材基準平面である。第２部材基準平面において、第２捻り中心と第２部材第１取付部を結ぶ線分が、第４線分である。第５線分は、第２捻り中心と第２部材第１取付部を結ぶ線分である。
胸腰部中央リンク１９ＬＣ、胸腰部右リンク２０ＬＣおよび胸腰部左リンク２１ＬＣが軸回りの１回転自由度を持たないようにして、胸部５Ｃまたは腰部６Ｃに設けられたリンク取付部が３回転自由度を有するようにしてもよい。
肩部Ｃ４Ｃの構造は、肩部Ｃ４と基本的に同じである。胸側主リンク取付部Ｊ１が、上腕部主リンク取付部Ｊ２０とほぼ同じ高さにある。胸側補助リンク取付部Ｊ２は、胸側主リンク取付部Ｊ１よりも低いすなわち腰部６Ｃに近い位置にある。上腕部駆動補助リンク１５Ｌが、斜め上に向かって延在する。上腕部駆動補助リンク１５Ｌが斜め下から上腕部駆動主リンク１４Ｌと、上腕部駆動主リンク側補助リンク取付部Ｊ２１で接続する。上腕部７Ｃを上下させる際に、主に上腕部駆動補助リンク１５Ｌが伸縮する。上腕部７Ｃを左右方向に移動させる際に、主に上腕部駆動主リンク１４Ｌが伸縮する。上腕部駆動補助リンク１５Ｌが斜め下から上腕部駆動主リンク１４Ｌと接続するので、上腕部７Ｃを上げる際に必要な力を上腕部駆動補助アクチュエータ１５で発生させやすい。胸側補助リンク取付部Ｊ２を胸側主リンク取付部Ｊ１よりも低い段違いの位置に配置する。つまり、上腕部駆動補助リンク１５Ｌは、上腕部駆動主リンク１４Ｌを介して、上腕部７Ｃを下側から付き上げるように支持する。そうすることで、人型上半身ロボット１００Ｃは、上腕部７Ｃを含む上肢部３Ｃの上下方向の位置をより安定的に保持できる。
図１３４から図１３７を参照して、肘部Ｃ５Ｃの構造を説明する。図１３４、図１３５、図１３６は、人型上半身ロボット１００Ｃが有する肘部Ｃ５Ｃの斜視図、正面図および側面図である。図１３７は、肘部Ｃ５Ｃのリンク配置を説明する斜視図である。
上腕骨部７Ｂは、上腕部内側フレーム３４Ｆの上面に設けられた上腕骨部装着部７Ｈにはめ込まれる。肘部駆動内側リンク取付部Ｊ２４には、前腕部８Ｃと接続するための肘部先端部８Ｄが設けられる。肘部先端部８Ｄは、前腕部８Ｃの肘部装着穴８Ｈ（図１３８などに図示）に装着される。また、肘関節部３１のヨークには、根元側に肘関節部先端３１Ｄが設けられる。肘関節部先端３１Ｄは、前腕部８Ｃの肘関節部接続穴８Ｊ（図１３８などに図示）に装着される。
肘部Ｃ５Ｃの構造は、肘部Ｃ５と基本的に同じである。肘部Ｃ５Ｃが、肘部Ｃ５と異なる点を説明する。上腕部外側アクチュエータ３４Ｐは、ナット３４Ｂ、レール３４Ｃおよびレール３４Ｃに係合する把持部３４Ｄを有さない。それらの替りに、スプライン軸３４Ｅおよびナット３４Ｊを有する。ナット３４Ｊは、スプライン軸３４Ｅが通るガイド穴およびねじ棒３４Ａが通る駆動軸穴（貫通穴）を有する有穴部材である。ガイド穴は、ナット３４Ｊを貫通するように設けられる。ねじ棒３４Ａおよびスプライン軸３４Ｅは平行である。スプライン軸３４Ｅおよびねじ棒３４Ａが通っているので、ねじ棒３４Ａが回転してもナット３４Ｊは回転しない。スプライン軸３４Ｅは、ガイド穴を通りねじ棒３４Ａに平行に設けられたガイド軸である。ガイド穴とスプライン軸３４Ｅが、ナット３４Ｊが回転することを防止する第２回転防止部を構成する。上腕部外側リンク取付部Ｊ２２は、ナット３４Ｊのガイド穴および駆動軸穴で挟まれる部分に設けられる。
駆動軸穴の内面には、ねじ棒３４Ａの外面に設けられた雄ねじとかみ合う雌ねじが設けられている。モータ３４Ｍが回転すると、その回転がタイミングベルトによりねじ棒３４Ａに伝えられる。ねじ棒３４Ａが回転すると、ナット３４Ｊは回転できないので、ナット３４Ｊはねじ棒３４Ａおよびスプライン軸３４Ｅに沿って移動する。
スプライン軸３４Ｅは、表面が滑らかな金属の円筒である。ガイド穴の内面には、スプライン軸３４Ｅとの摩擦が小さくなるようにベアリングなどが設けられる。
上腕部外側リニアガイド３４ＧＣは、ねじ棒３４Ａ、スプライン軸３４Ｅ、ナット３４Ｊ、上腕部外側フレーム３４Ｆを有する。上腕部外側フレーム３４Ｆは、ねじ棒３４Ａ、スプライン軸３４Ｅ、ナット３４Ｊを収納する。ねじ棒３４Ａを通る直線が、上腕部外側フレーム３４Ｆの最も肩側の部分と交差する点を第２基準点Ｐ２Ｎとする。第２基準点Ｐ２Ｎは、図１３５に図示する。上腕部外側リニアガイド３４ＧＣが、ナット３４Ｊをねじ棒３４Ａに沿って移動するようにガイドする第２ガイド部を構成する。上腕部外側リニアガイド３４ＧＣは、肘関節部３１および第２基準点Ｐ２Ｎに対する相対的な位置関係が固定されて上腕部７Ｃに設けられる。
上腕部内側アクチュエータ３５Ｐも、上腕部外側アクチュエータ３４Ｐと同様に、スプライン軸３５Ｅおよびナット３５Ｊを有する。ナット３５Ｊに設けられたガイド穴とスプライン軸３５Ｅが、ナット３５Ｊが回転することを防止する第１回転防止部を構成する。上腕部内側リニアガイド３５ＧＣは、上腕部外側リニアガイド３４ＧＣと同様な構造である。上腕部内側リニアガイド３５ＧＣは、ねじ棒３５Ａ、スプライン軸３５Ｅ、ナット３５Ｊ、上腕部内側フレーム３５Ｆを有する。上腕部外側フレーム３５Ｆは、ねじ棒３５Ａ、スプライン軸３５Ｅ、ナット３５Ｊを収納する。ねじ棒３５Ａを通る直線が、上腕部内側フレーム３５Ｆの最も肩に近い部分と交差する点を第１基準点Ｐ１Ｎとする。第１基準点Ｐ１Ｎは、図１３５に図示する。上腕部内側リンク取付部Ｊ２３は、ナット３４Ｊのガイド穴および駆動軸穴で挟まれる部分に設けられる。上腕部内側リニアガイド３５ＧＣが、ナット３５Ｊをねじ棒３５Ａに沿って移動するようにガイドする第１ガイド部を構成する。上腕部内側リニアガイド３５ＧＣは、肘関節部３１および第１基準点Ｐ１Ｎに対する相対的な位置関係が固定されて上腕部７Ｃに設けられる。
ナット３４Ｊにねじ棒３４Ａとスプライン軸３４Ｅとが通っているので、ナット３４Ｊに働く力を２本の棒で分散して受けることができる。ナット３５Ｊに関しても同様である。
肘関節部に３回転自由度を持たせてもよい。肘関節部が３回転自由度を有する場合は、上腕部と前腕部を、３本目のリンクである可変長リンク（第３リンク）により結ぶ。可変長リンクは、５回転自由度を有し、上腕部に少なくとも２回転自由度を有して回転可能に取付けられ、前腕部に少なくとも２回転自由度を有して回転可能に取付けられる。第３リンクである可変長リンクは、ねじ機構を利用するものでも、油圧機構を利用するものでもよい。３本目のリンクは、リンクの他端を移動させるリニアアクチュエータを用いたものでもよい。
図１３８から図１４４を参照して、手首部Ｃ６Ｃの構造を説明する。図１３８は、人型上半身ロボット１００Ｃが有する手首部Ｃ６Ｃの斜視図である。図１３９は、手首部Ｃ６Ｃの別の斜視図である。図１４０は、手首部Ｃ６Ｃの正面図である。図１４１は、手首部Ｃ６Ｃの右側面図である。図１４２は、手首部Ｃ６Ｃのリンク配置を説明する斜視図である。図１４３は、手首部Ｃ６Ｃの基準状態でのリンク配置を前腕部が延在する方向から見た図である。図１４４は、手首部Ｃ６Ｃの基準状態でのリンク配置を評価する変数を示す図である。
手首部Ｃ６Ｃが手首部Ｃ６と異なる点は、前腕部外側リンク３８ＬＣが手首板部９１Ｃではなく、前腕部正面リンク３７ＬＣの途中に取付けられる点である。前腕部正面リンク３７ＬＣの一端は、手部側正面リンク取付部Ｊ２９Ｃで手首板部９１Ｃに取付けられる。前腕部正面リンク３７ＬＣの他端は、前腕部正面リンク取付部Ｊ２６Ｃで前腕部８Ｃに取付けられる。前腕部外側リンク３８ＬＣの一端は、正面リンク側外側リンク取付部Ｊ３０Ｃで前腕部正面リンク３７ＬＣに取付けられる。前腕部外側リンク３８ＬＣの他端は、前腕部外側リンク取付部Ｊ２７Ｃで前腕部８Ｃに取付けられる。前腕部内側リンク３９ＬＣの一端は、手部側内側リンク取付部Ｊ３１Ｃで手首板部９１Ｃに取付けられる。前腕部内側リンク３９ＬＣの他端は、前腕部外側リンク取付部Ｊ２７Ｃで前腕部８Ｃに取付けられる。
図１４３に示すように、手首板部９１Ｃは、ほぼ正方形の１つの角を大きく切り、残りの３つの角を小さく同じように切った八角形の板状の形状である。手首板部９１Ｃにおいて、手首関節部３６、手部側正面リンク取付部Ｊ２９Ｃおよび手部側内側リンク取付部Ｊ３１Ｃは、ほぼ直角二等辺三角形になるように配置されている。この三角形は、手首板部９１Ｃの八角形の辺からの距離が各辺でほぼ同じである。手首板部９１Ｃは、捻り軸である前腕骨部８Ｂとの角度が変更可能である。
手首関節部３６は球面軸受けである。手首関節部３６は、３回転自由度を有する。手首板部９１Ｃには、手首関節部３６が設けられた面に２個の突起が設けられる。２個の突起は、手首関節部３６との間の距離がほぼ同じである。２個の突起のそれぞれと手首関節部３６を結ぶ２本の線分は、手首関節部３６においてほぼ直交する。２個の突起のそれぞれには、手首関節部３６に向かう方向の手首板部９１Ｃに平行な回転軸の回りを回転する回転部材と、回転部材と共に回転するヨークが設けられる。１個のヨークは、手部側正面リンク取付部Ｊ２９Ｃを構成する。もう１個のヨークは手部側内側リンク取付部Ｊ３１Ｃを構成する。手部側正面リンク取付部Ｊ２９Ｃが有するヨークは、前腕部正面リンク３７ＬＣの他端に設けられた貫通穴を通る軸部材を挟んで保持する。手部側内側リンク取付部Ｊ３１Ｃが有するヨークは、前腕部内側リンク３９ＬＣの他端に設けられた貫通穴を通る軸部材を挟んで保持する。正面リンク側外側リンク取付部Ｊ３０Ｃでは、ヨークが前腕部外側リンク３８ＬＣの一端に設けられる。前腕部正面リンク３７ＬＣには、その延在する方向である軸回りに回転可能な部材が装着されている。正面リンク側外側リンク取付部Ｊ３０Ｃが有するヨークは、回転可能な部材から出る突起を回転可能に挟んで保持する。正面リンク側外側リンク取付部Ｊ３０Ｃは、前腕部正面リンク３７ＬＣの軸回りの１回転自由度を含む２回転自由度を有する。
前腕部正面リンク取付部Ｊ２６Ｃ、前腕部外側リンク取付部Ｊ２７Ｃおよび前腕部内側リンク取付部Ｊ２８Ｃは、前腕部８Ｃの３方向に張り出した部分に設けられる。３方向に張り出した部分は、手首関節部３６から同じ長さの位置に設けられる。前腕部正面リンク取付部Ｊ２６Ｃ、前腕部外側リンク取付部Ｊ２７Ｃおよび前腕部内側リンク取付部Ｊ２８Ｃは、この張り出した部分から前腕部８Ｃに垂直に外側に向く回転軸の回りに回転するヨークを有する。前腕部正面リンク取付部Ｊ２６Ｃでは、ヨークが前腕部正面リンク３７ＬＣの一端に設けられた貫通穴を通る軸部材を挟んで保持する構造である。前腕部外側リンク取付部Ｊ２７Ｃおよび前腕部内側リンク取付部Ｊ２８Ｃも同様な構造である。前腕部正面リンク取付部２６Ｃ、前腕部外側リンク取付部Ｊ２７Ｃおよび前腕部内側リンク取付部Ｊ２８Ｃにおいて、ヨークが回転する回転軸が向く方向は、約７０度の等間隔な方向である。前腕部正面リンク取付部２６Ｃの回転軸が中央に配置される。
図１４４により、手首部でのリンク取付部の配置に関する条件を表現するための線分などを定義する。図１４４は、手首部の基準状態でのリンク配置を評価する変数を示す図である。図１４４(A)では、上腕部８Ｃでのリンク取付部の配置を示す。図１４４(B)では、手首関節部３６側でのリンク取付部の配置を示す。前腕部正面リンク取付部Ｊ２６Ｃ、前腕部外側リンク取付部Ｊ２７Ｃおよび前腕部内側リンク取付部Ｊ２８Ｃで決定される平面を、前腕部基準平面と呼ぶ。前腕部基準平面は、図１４４(A)には、前腕部基準平面での前腕骨部８Ｂ、腰部前腕部正面リンク取付部Ｊ２６Ｃ、前腕部外側リンク取付部Ｊ２７Ｃおよび前腕部内側リンク取付部Ｊ２８Ｃの位置関係を示す。前腕部基準平面と前腕骨部８Ｂの交点を第１捻り中心と呼ぶ。第１捻り中心の符号は、前腕骨部と同じ８Ｂとする。捻り軸である前腕骨部８Ｂの方向は、第１部材である前腕部８に固定されている。そのため、手首関節部３６の接続角度が変化しても、第１捻り中心の位置は変化しない。
前腕部正面リンク取付部Ｊ２６Ｃと第１捻り中心８Ｂを結ぶ線分を、第１線分Ｓ２１と呼ぶ。前腕部外側リンク取付部Ｊ２７Ｃと第１捻り中心８Ｂを結ぶ線分を、第３線分Ｓ２３と呼ぶ。前腕部内側リンク取付部Ｊ２８Ｃと第１捻り中心８Ｂを結ぶ線分を、第２線分Ｓ２２と呼ぶ。第１線分Ｓ２１、第２線分Ｓ２２および第３線分Ｓ２３の長さを、変数Ｌ２１、Ｌ２２およびＬ２３で表す。第１線分Ｓ２１と第３線分Ｓ２３とがなす角度を、変数η１Ａで表す。
手首部Ｃ６Ｃでは、η１Ａは約９０度である。すなわち、第１線分Ｓ２１と第３線分Ｓ２３はほぼ直交する。すなわちη１Ａは、例えば６０度から１２０度に決められた第１交差角範囲内の角度である。第１線分Ｓ２１が、第２線分Ｓ２２と第３線分Ｓ２３の間に存在する。Ｌ２１およびＬ２３の中で短い方を長い方で割った値である長短比λは、λ＝０．９９である。長短比λは、例えば０．８に決められた下限比以上である。胴体屈曲部Ｃ２Ｃの場合と同様に、手首部Ｃ６Ｃでも手部９Ｃの荷重を前腕部８Ｃの３箇所のリンク取付部で安定して支持できる。
手首関節部３６、手部側正面リンク取付部Ｊ２９Ｃおよび手部側内側リンク取付部Ｊ３１Ｃを通る平面を、手首部基準平面と呼ぶ。手首部基準平面は、第２部材基準平面である。図１４４(B)には、手首部基準平面での手首関節部３６、手部側正面リンク取付部Ｊ２９Ｃおよび手部側内側リンク取付部Ｊ３１Ｃの位置関係を示す。手首関節部３６と手部側正面リンク取付部Ｊ２９Ｃを結ぶ線分を、第４線分Ｓ２４と呼ぶ。手首関節部３６と手部側内側リンク取付部Ｊ３１Ｃを結ぶ線分を、第５線分Ｓ２５と呼ぶ。第４線分Ｓ２４と第５線分Ｓ２５がなす角度を、変数η２Ａで表す。
手首部Ｃ６Ｃでは、η２Ａは約９２度である。η２Ａは、例えば５５度から１２５度に決められた第２交差角範囲内の角度である。胴体屈曲部Ｃ２Ｃの場合と同様に、手首部Ｃ６Ｃでも手部９Ｃをどの方向にも適切に傾けることができる。正面リンク側外側リンク取付部Ｊ３０Ｃで、前腕部正面リンク３７ＬＣと前腕部外側リンク３８ＬＣとがなす角度ζＡは、ζＡ＝約２６度である。ζＡは、例えば２０度などのように決められた第３交差角以上である。そのため、手部９Ｃを前腕骨部８Ｂの回りを効率的に回転させることができる。
手首部Ｃ６Ｃは、第１部材である前腕部８Ｃに第２部材である手部９Ｃを手首関節部３６により回転可能に接続する回転接続機構である。手首関節部３６は、前腕部８Ｃに対する方向が固定された捻り軸の回りに手部９Ｃを前腕部８Ｃに対して回転可能にし、かつ前腕部８Ｃに手部９Ｃを、３回転自由度を有して回転可能に接続する関節部である。
前腕部正面リンク３７ＬＣが、５回転自由度を有する第１リンクである。前腕部正面リンク取付部Ｊ２６Ｃが、前腕部８Ｃに設けられた第１部材第１取付部である。前腕部正面リンク取付部Ｊ２６Ｃは、手首関節部３６に対する相対的な位置関係が固定されている。前腕部正面リンク取付部Ｊ２６Ｃは、前腕部８Ｃに設けられた第１基準点でもある。前腕部正面リンク取付部Ｊ２６Ｃに、前腕部正面リンク３７ＬＣの他端が少なくとも２回転自由度を有して回転可能に取付けられる。手部側正面リンク取付部Ｊ２９Ｃが、手部９Ｃに設けられた第２部材第１取付部である。手部側正面リンク取付部Ｊ２９Ｃに、前腕部正面リンク３７ＬＣの一端が少なくとも２回転自由度を有して回転可能に取付けられる。手部側正面リンク取付部Ｊ２９Ｃは、手首関節部３６に対する相対的な位置関係が固定されている。前腕部正面リンク３７ＬＣ自体が１回転自由度を有する。モータ３７Ｍが、前腕部正面リンク３７ＬＣの長さを変更する力を発生させる第１動力源である。前腕部正面リンク３７ＬＣの長さは、前腕部正面リンク取付部Ｊ２６Ｃと手部側正面リンク取付部Ｊ２９Ｃの距離である。前腕部正面リンク３７ＬＣ、前腕部正面リンク取付部Ｊ２６Ｃ、手部側正面リンク取付部Ｊ２９Ｃ、モータ３７Ｍを有する前腕部正面アクチュエータ３７が、第１アクチュエータである。
前腕部外側リンク３８ＬＣが、５回転自由度を有する第２リンクである。前腕部外側リンク取付部Ｊ２７Ｃが、前腕部８Ｃに設けられた第１部材第２取付部である。前腕部外側リンク取付部Ｊ２７Ｃは、手首関節部３６に対する相対的な位置関係が固定されている。前腕部外側リンク取付部Ｊ２７Ｃは、前腕部８Ｃに設けられた第２基準点でもある。前腕部外側リンク取付部Ｊ２７Ｃに、前腕部外側リンク３８ＬＣの他端が少なくとも２回転自由度を有して回転可能に取付けられる。正面リンク側外側リンク取付部Ｊ３０Ｃが、前腕部正面リンク３７ＬＣに設けられた第１リンク第２取付部である。正面リンク側外側リンク取付部Ｊ３０Ｃは、正面リンク側正面リンク取付部Ｊ２９Ｃに対する相対的な位置関係が固定されている。正面リンク側外側リンク取付部Ｊ３０Ｃに、前腕部外側リンク３８ＬＣの一端が少なくとも２回転自由度を有して回転可能に取付けられる。前腕部外側リンク３８ＬＣ自体が１回転自由度を有する。モータ３８Ｍが、前腕部外側リンク３８ＬＣの長さを変更する力を発生させる第２動力源である。前腕部外側リンク３８ＬＣの長さは、前腕部外側リンク取付部Ｊ２７Ｃと正面リンク側外側リンク取付部Ｊ３０Ｃの距離である。前腕部外側リンク３８ＬＣ、前腕部外側リンク取付部Ｊ２７Ｃ、正面リンク側外側リンク取付部Ｊ３０Ｃ、モータ３８Ｍを有する前腕部外側アクチュエータ３８が、第２アクチュエータである。
前腕部内側リンク３９ＬＣが、５回転自由度を有する第３リンクである。前腕部内側リンク取付部Ｊ２８Ｃが、前腕部８Ｃに設けられた第１部材第３取付部である。前腕部内側リンク取付部Ｊ２８Ｃは、手首関節部３６に対する相対的な位置関係が固定されている。前腕部内側リンク取付部Ｊ２８Ｃに、前腕部内側リンク３９ＬＣの他端が少なくとも２回転自由度を有して回転可能に取付けられる。手部側内側リンク取付部Ｊ３１Ｃが、手部９Ｃに設けられた第２部材第３取付部である。手部側内側リンク取付部Ｊ３１Ｃは、手首関節部３６に対する相対的な位置関係が固定されている。手部側内側リンク取付部Ｊ３１Ｃに、前腕部内側リンク３９ＬＣの一端が少なくとも２回転自由度を有して回転可能に取付けられる。前腕部内側リンク３９ＬＣ自体が１回転自由度を有する。モータ３９Ｍが、前腕部内側リンク３９ＬＣの長さを変更する力を発生させる第３動力源である。前腕部内側リンク３９ＬＣの長さは、前腕部内側リンク取付部Ｊ２８Ｃと手部側内側リンク取付部Ｊ３１Ｃの距離である。前腕部内側リンク３９ＬＣ、前腕部内側リンク取付部Ｊ２８Ｃ、手部側内側リンク取付部Ｊ３１Ｃ、モータ３９Ｍを有する前腕部外側アクチュエータ３８が、第３アクチュエータである。
前腕部基準平面は、第１部材基準面である。手部９Ｃは、捻り軸である前腕骨部８Ｂとの角度が変更可能な第２部材である。手部基準面は、第２部材第１取付部、第２部材第３取付部および関節部を通る第２部材基準平面である。第２部材基準平面において、関節部と第２部材第１取付部を結ぶ線分が第４線分である。関節部と第２部材第３取付部を結ぶ線分が第５線分である。なお、捻り軸の方向が第２部材に対して固定されている場合は、第２部材第１取付部を通る捻り軸に垂直な平面と捻り軸との交点である第２捻り中心を、関節部の替わりに使用して、第４線分と第５線分を定義する。つまり、第２捻り中心と第２部材第１取付部を結ぶ線分が第４線分である。第２捻り中心と第２部材第３取付部を結ぶ線分が第５線分である。
図１４５から図１５２を参照して、手部９Ｃの構造を説明する。図１４５は、手首部を含めて手部９Ｃを手の甲側から見た図である。図１４６は、手首部を含めて手部９Ｃを側面から見た図である。図１４７から図１４９は、手部９Ｃを手の甲側から、手の平側から、側面からそれぞれ見た図である。図１５０および図１５１は、手部９Ｃが有する２方向回転指を指元の軸回りに回転させる指元部の斜視図である。図１５０および図１５１では、指元部８０を掌板部８２から分離した状態を示している。図１５１は、指元部８０を第１指部８３側から見た斜視図である。図１５２は、指元部８０を掌板部８２側から見た斜視図である。
手部９Ｃでは、第１指部８３、第２指部８４、第３指部８５、第４指部８６は、実施の形態４の手部９Ｂと同じである。手部９Ｂが有する親指に相当する手幅回転指８８の替わりに、２方向回転指８９を手部９Ｃは有する。２方向回転指８９は、指先から第１指関節部８９Ｄまでは、手幅回転指８８の指先から第１指関節部８８Ｄまでと同じである。２方向回転指８９は、第１指関節部８９Ｄと掌板部８２との間に第１指関節部８９Ｄから指先を回転させる指元部８０を有する。
指元部８０は、指元指節部８０Ａ、指元モータ固定部８０Ｂ、指元指関節部８０Ｃ、指元モータ８０Ｄ、指元ギヤヘッド８０Ｅ、指元ウォーム８０Ｆ、指元ウォームホイール８０Ｇを有する。指元指節部８０Ａは、掌板部８２にほぼ平行に第１指部８３が延在する方向とほぼ直交する方向に延在する。内部に空間を有する指元モータ固定部８０Ｂは、掌板部８２に固定される。指元モータ固定部８０Ｂの側面に指元指節部８０Ａが接続する。指元指節部８０Ａには、第１指関節部８９Ｄにより第１指節部８９Ａが回転可能に接続する。
指元指関節部８０Ｃは、指元指節部８０Ａが延在する方向を向く回転軸Ｒx３を有する。指元モータ８０Ｄおよび指元ギヤヘッド８０Ｅは、掌板部８２に直交するように指元モータ固定部８０Ｂの外面に固定される。指元モータ８０Ｄにより駆動される回転軸には、指元ウォーム８０Ｆが接続する。互いに歯がかみ合う指元ウォーム８０Ｆおよび指元ウォームホイール８０Ｇは、指元モータ固定部８０Ｂの内部に存在する。指元ウォームホイール８０Ｇと接続する回転軸Ｒx３が、指元モータ固定部８０Ｂの壁面に設けられた貫通穴を通り、指元指節部８０Ａと接続する。指元モータ８０Ｄが回転すると、指元指節部８０Ａが回転軸Ｒx３の回りを回転する。つまり、指元指関節部８０Ｃは、回転軸Ｒx３を有するウォームギヤ機構により指元指節部８０Ａを指元モータ固定部８０Ｂおよび掌板部８２に対して回転させる。ウォームギヤ機構を使用しているので、指元指関節部８０Ｃは大きな力を出すことができる。また、電源供給が断たれた場合でも、回転軸Ｒx３回りの回転角を維持できる。
回転軸Ｒx３は、第１指節部８９Ａに対して決められた角度の方向に延在する回転軸である指元回転軸である。決められた角度の方向とは、Ｙ軸に平行な回転軸Ｒx３に対して第１指節部８９Ａは約３０度の角度をなす方向である。指元部８０は、回転軸Ｒx３の回りに指元指節部８０Ａを回転させる。
指元指節部８０Ａには、２個の突起８０ＡＡおよび突起８０ＡＢが設けられる。指元モータ固定部８０Ｂには、突起８０ＢＡが設けられる。突起８０ＢＡは、指元指節部８０Ａと共に回転軸Ｒx３の回りを回転する突起８０ＡＡおよび突起８０ＡＢの間に存在する。突起８０ＢＡと、突起８０ＡＡおよび突起８０ＡＢとは、指元指節部８０Ａが回転軸Ｒx３の回りで回転できる範囲を制限する。
指元指節部８０Ａは、第１モータ固定部８９Ｖが掌板部８２に対して手の平側を向くように第１モータ固定部８９Ｖと接続する。第１モータ固定部８９Ｖは、指元指節部８０Ａに対して手の平側に傾いて接続する。第１モータ固定部８９Ｖは、側面から見るとＬ字状に折れ曲がった板材である。Ｌ字の一方の面で、第１モータ固定部８９Ｖに指元指節部８０Ａが斜めに接続する。第１モータ固定部８９ＶのＬ字をなす２面の内側に、指元ヨーク部８９Ｇが接続される。指元ヨーク部８９Ｇの内部には、第１指関節部８９Ｄの回転軸と連動して回転する第１ウォームホイール８９Ｋ、第１ホイール連動部８９ＡＡおよび第１ウォーム８９Ｊが存在する。第１モータ固定部８９ＶのＬ字の他方の面には、指部第１モータ８９Ｈおよび第１ギヤヘッド８９Ｔが固定される。第１指関節部８９Ｄの回転軸Ｒz３は、指元ヨーク部８９Ｇおよび回転軸Ｒx３に垂直である。指部第１モータ８９Ｈおよび第１ギヤヘッド８９Ｔが固定される面と対向する面として、ウォーム先端保持部８９ＶＢが指元ヨーク部８９Ｇに取付けられる。ウォーム先端保持部８９ＶＢには、第１ウォーム８９Ｊの先端が挿入される穴が設けられている。
指部第１モータ８９Ｈの回転軸には、指元ヨーク部８９Ｇおよび第１モータ固定部８９Ｖで囲まれる位置で第１ウォーム８９Ｊが接続する。第１ウォーム８９Ｊの歯は第１ウォームホイール８９Ｋの歯とかみ合う。指部第１モータ８９Ｈが回転すると第１ウォーム８９Ｊおよび第１ウォームホイール８９Ｋが回転して、第１ホイール連動部８９ＡＡと指元ヨーク部８９Ｇとの間の角度が変化する。こうして、第１指関節部８９Ｄで第１指節部８９Ａを曲げ伸ばしができる。
２方向回転指８９は、直交する回転軸Ｒx３および回転軸Ｒz３の回りの２方向で回転可能である。回転軸Ｒz３の回りに回転することで、２方向回転指８９は指先が掌板部８２から離れる方向に回転する。回転軸Ｒx３の回りに回転することで、２方向回転指８９は第１指部８３と並ぶ方向から掌板部８２と直交する方向まで回転できる。
２方向回転指８９が２方向に回転できるので、手部９Ｃは持つ物体の形状に応じて５本の指を適切に曲げて物体を適切に持つことができる。大きい物体の場合は、２方向回転指８９を第１指部８３と並ぶ位置に移動させて、掌板部８２および５本の指の上に物体を載せることができる。２方向回転指８９を有する手部９Ｃは、人と同程度の指駆動を実現し、いろいろな手を使う高度な作業をこなせる効果を有する。なお、２本以上の指部を、指元部を有する２方向回転指としてもよい。
動作を説明する。人型上半身ロボット１００Ｃの姿勢は、胸腰部関節部１８、肩関節部１３、肘関節部３１、手首関節部３６がとる角度により決まる。これらの関節部の角度は、その関節部を駆動するリンクの長さにより決まる。人型上半身ロボット１００Ｃの各関節部を駆動するリンクを、指定された姿勢をとることができる各関節部の角度である指定角度から決まる値になるようにする。そうすることで、人型上半身ロボット１００Ｃが指定された姿勢をとることができる。人型上半身ロボット１００Ｃが動く場合も、姿勢の変化に対応する指定角度の時系列をリンクの長さの時系列に変換して、リンクの長さを決められた時系列に応じて変化させることで、指定されたように人型上半身ロボット１００Ｃを動かすことができる。
各関節部について、その関節部が指定角度をとることができるような可変長リンクの長さの決め方、およびリニアガイドではリンク取付部の位置の決め方を説明する。なお、指定角度は、その関節部の可動範囲内であることが必要である。まず、胸腰部関節部１８について説明する。胸腰部関節部１８は、胸部５Ｃの腰部６Ｃに対する接続方向を変更する。
胸腰部関節部１８での関節部およびリンク取付部の位置を、以下の変数により表現する。図１５３は、胸腰部関節部での関節部およびリンク取付部の位置を表現する変数を説明する図である。
各点の位置を表す変数を以下のように定義する。
Ｐ0s：胸腰部関節部１８の位置。
Ｐ1s：腰側中央リンク取付部Ｊ１０Ｃの位置。
Ｐ2s：腰側右リンク取付部Ｊ８Ｃの位置。
Ｐ3s：腰側左リンク取付部Ｊ９Ｃの位置。
Ｐ4s：胸側中央リンク取付部Ｊ５Ｃの位置。
Ｐ4s0：胸側中央リンク取付部Ｊ５の基準状態での位置。
Ｐ5s：胸側右リンク取付部Ｊ６Ｃの位置。
Ｐ5s0：胸側右リンク取付部Ｊ６Ｃの基準状態での位置。
Ｐ6sA：中央リンク左リンク取付部Ｊ７Ｃの位置。
Ｐ10s：腰側中央リンク取付部Ｊ１０Ｃを通り胸腰部中央リンク１９ＬＣに垂直な平面と胸腰部中央リンク１９ＬＣとの交点の位置。
Ｐ11s：腰部左リンク取付部Ｊ９Ｃを通り胸腰部左リンク２１ＬＣに垂直な平面と胸腰部左リンク２１ＬＣとの交点の位置。
Ｐ12s：腰側右リンク取付部Ｊ８Ｃを通り胸腰部右リンク２０ＬＣに垂直な平面と胸腰部右リンク２０ＬＣとの交点の位置。
胸腰部関節部１８の回転角度は、実施の形態１の場合と同様に以下の変数で表現する。
αs：胸腰部関節部１８のＸ軸回りの回転角。基準状態でαs＝０
βs：胸腰部関節部１８のＹ軸回りの回転角。基準状態でβs＝０
γs：胸腰部関節部１８のＺ軸回りの回転角。基準状態でγs＝０
[Ｒs]：胸腰部関節部１８の回転行列。回転行列[R2]は、以下のようになる。
Figure 0006903229
リンクの長さを、以下の変数で表現する。
Ｌ1s：胸腰部中央リンク１９ＬＣの長さ。線分Ｐ10sＰ4sの長さ。
Ｌ1sd：線分Ｐ1sＰ4sの長さ。
Ｌ2s：胸腰部右リンク２０ＬＣの長さ。線分Ｐ11sＰ5Sの長さ。
Ｌ2sd：線分Ｐ2sＰ5sの長さ。
Ｌ3s：胸腰部左リンク２１ＬＣの長さ。線分Ｐ12sＰ6sAの長さ。
Ｌ3sd：線分Ｐ3sＰ6sAの長さ。
Ｈd：胸腰部中央リンク１９ＬＣ、胸腰部右リンク２０ＬＣ、胸腰部左リンク２１ＬＣでの腰部６Ｃに設けられたリンク取付部とねじ棒との間の距離。
ここでは、各点および各リンクの長さを計算する手順を説明する。点Ｐ0s、Ｐ1s、Ｐ2s、Ｐ3sの位置は、固定である。胸腰部関節部１８の角度が決まると、[Ｒs]が決まる。そして、点Ｐ4s、Ｐ5sの位置が、以下のように決まる。
Ｐ4s＝[Ｒs]*Ｐ4s0
Ｐ5s＝[Ｒs]*Ｐ5s0
点Ｐ4s、Ｐ5sの位置が決まると、Ｌ1sd、Ｌ2sdも決まる。
点Ｐ1s、Ｐ4sの位置から、点Ｐ10sの位置を決める。腰側中央リンク取付部Ｊ１０Ｃのヨークを回転させる回転軸と点Ｐ1sとを含む平面を第１リンク平面と呼ぶ。点Ｐ10sは、第１リンク平面上に存在する。三平方の定理により、Ｌ1sを以下のように決める。
Ｌ1s＝√(Ｌ1sd ２−Ｈd２)
点Ｐ10sの位置は、第１リンク平面において点Ｐ1sからＨdの距離であり、点Ｐ4sからＬ1sの距離の点である。
点Ｐ10sの位置が決まると、次に点Ｐ6sAの位置を決める。点Ｐ6sAの位置は、点Ｐ4s、Ｐ10sを通る直線において点Ｐ4sから決められた距離の位置である。点Ｐ6sAの位置が決まると、Ｌ3sdも決まる。
点Ｐ3s、Ｐ6sAの位置から、点Ｐ12sの位置を決める。腰部右リンク取付部Ｊ８Ｃのヨークを回転させる回転軸と点Ｐ3sとを含む平面を第２リンク平面と呼ぶ。点Ｐ12sは、第２リンク平面上に存在する。三平方の定理により、Ｌ3sを以下のように決める。
Ｌ3s＝√(Ｌ3sd ２−Ｈd２)
点Ｐ12sの位置は、第２リンク平面において点Ｐ3sからＨdの距離であり、点Ｐ6sAからＬ3sの距離の点である。
点Ｐ2s、Ｐ5sの位置から、点Ｐ11sの位置を決める。腰部左リンク取付部Ｊ９Ｃのヨークを回転させる回転軸と点Ｐ2sとを含む平面を第３リンク平面と呼ぶ。点Ｐ11sは、第３リンク平面上に存在する。三平方の定理により、Ｌ2sを以下のように決める。
Ｌ2s＝√(Ｌ2sd ２−Ｈd２)
点Ｐ11sの位置は、第３リンク平面において点Ｐ2sからＨdの距離であり、点Ｐ5sからＬ2sの距離の点である。こうして、すべてのリンク取付部の位置と各リンクの長さを決めることができる。
各リンクの長さを決めると、胸腰部関節部１８の回転角度がどのように決まるかを検討する。胴体屈曲部Ｃ２Ｃでは、胴体屈曲部Ｃ２よりもリンクの長さの変化が胸腰部関節部１８の回転角度へもたらす影響が考慮しやすくなる。
図１５４は、人型上半身ロボット１００Ｃが有する胴体屈曲部Ｃ２Ｃでリンクの長さを決めることで位置が固定される点を示す図である。図１５４(A)が３本のリンクの長さが未定の状態である。図１５４(B)が、第１リンクである胸腰部中央リンク１９ＬＣと、第２リンクである胸腰部左リンク２１ＬＣの長さを決めた状態である。図１５４(C)が、３本のリンクの長さを決めた状態である。図において、長さが決まったリンクを太い実線で表現し、長さが未定のリンクを細い点線で表現する。位置が決まった点を二重丸で表現し、位置が未定の点を白丸で表現する。関節部である胸腰部関節部１８を表す点では、その回転角度が決まった場合に二重丸で表現する。
図１５４(A)に示すように、３本の可変長リンクの長さが決まっていない状態では、胸腰部関節部１８の回転角度および第２部材である胸部５Ｃに存在する点の位置は未定である。第１リンク１９ＬＣと第２リンク２１ＬＣの長さを決めると、点Ｐ4Sは点Ｐ0S、Ｐ1S、Ｐ3Sからの距離が決まる。その結果、図１５４(B)に示すように、点Ｐ4Sの位置は一意に決まる。点Ｐ4Sの位置が決まるということは、胸部５Ｃの捻り軸である背骨部５６の回りの回転角度と、第２部材第１取付部である腰側中央リンク取付部Ｊ１０Ｃの方向への背骨部５６の傾き角度が決まることである。
図１５４(B)に示す状態では、胸腰部関節部１８は、点Ｐ0Sおよび点Ｐ4Sを通る回転軸Ｒ11の回りに回転可能である。そのため、点Ｐ5Sは、点Ｐ0Sからの距離および点Ｐ4Sからの距離が一定のまま回転軸Ｒ11の回りを回転する。点Ｐ0S（関節部）と点Ｐ4S（第２部材第１取付部）を結ぶ回転軸Ｒ11を、第１取付部方向軸と呼ぶ。なお、図１５４(B)では回転軸Ｒ11がＸＺ平面上にあるように書いているが、必ずしもそうなる訳ではない。第１リンク１９ＬＣと第２リンク２１ＬＣの長さにより決まる点Ｐ4Sの位置が、ＸＺ平面上に存在しなければ、回転軸Ｒ11はＸＺ平面と交差する方向になる。
さらに、第３リンク２０ＬＣの長さを決めると、点Ｐ5Sおよび胸腰部関節部１８の回転角度が決まる。こうして、図１５４(C)に示す状態になる。
この発明に係る３回転自由度を有する関節部を有する回転接続機構では、第１リンクおよび第２リンクの長さを決めることで捻り軸の回りの回転角度と、捻り軸と第２部材第１取付部を含む平面（第１取付部存在面と呼ぶ）内での捻り軸の傾き角度（第１取付部傾斜角度と呼ぶ）を決めることができる。第１取付部存在面に直交する回転軸を、第１取付部傾斜軸と呼ぶ。第１取付部傾斜角度は、第１取付部傾斜軸の回りの回転角度である。
第１リンクおよび第２リンクの長さを決めた状態では、第３リンクの長さを変更することで、第１取付部方向軸の回りに関節部は回転可能である。
第３リンクである胸腰部右リンク２０ＬＣの長さを決めると、図１５４(C)に示す状態になる。点Ｐ5Sは、点Ｐ0Sおよび点Ｐ4Sに加えて点Ｐ2Sからの距離も決まる。３点からの距離が決まるので、点Ｐ5Sの位置は一意に決まる。点Ｐ5Sの位置も決まると、関節部１８の角度も決まる。
このように、第１リンクおよび第２リンクの長さを決めることで捻り軸の回りの回転角度と、第１取付部傾斜角度を決めることができる。さらに、第３リンクの長さを決めると、第１取付部方向軸の回りの回転角度を決めることができる。なお、第１リンクの長さだけを決めた状態では、３点Ｐ0S、Ｐ1S、Ｐ4Sで決まる三角形の形状が決まることになる。この状態で、第２リンクの長さを変更すると、この三角形の頂点Ｐ4Sは点Ｐ0Sおよび点Ｐ1Sを通る回転軸の回りを回転する。胴体屈曲部Ｃ２Ｃは、各リンクの長さに対する関節部の角度の関係が解析しやすいという特徴を有する。
比較例として実施の形態１での胴体屈曲部Ｃ２の場合について説明する。図１５５は、人型ロボット１００が有する胴体屈曲部Ｃ２でリンクの長さを決めることで位置が固定される点を示す図である。図１５５(A)が３本のリンクの長さが未定の状態である。図１５５(B)が、第１リンクである胸腰部中央リンク１９Ｌと、第２リンクである胸腰部左リンク２１Ｌの長さを決めた状態である。図１５５(C)が、３本のリンクの長さを決めた状態である。
図１５５(A)に示すように、３本の可変長リンクの長さが決まっていない状態では、第２部材である胸部５に存在する点の位置は未定である。第１リンク１９Ｌと第２リンク２１Ｌの長さを決めると、図１５５(B)に示す状態になる。第１リンク１９Ｌは、胸部５と点Ｐ4Sで接続する。第２リンク２１Ｌは、胸部５と点Ｐ6Sで接続する。そのため、点Ｐ4Sの位置も点Ｐ5Sの位置も一意に決めることはできない。
図１５５(B)に示す状態では、３点Ｐ1S、Ｐ2S、Ｐ4Sで決まる三角形である第１三角形と、３点Ｐ2S、Ｐ4S、Ｐ6Sで決まる三角形である第２三角形とが、点Ｐ2Sおよび点Ｐ4Sを結ぶ底辺Ｓ３０を共有して形成される。第１三角形の底辺Ｓ３０に対応する頂点Ｐ1Sの角度をε１とする。第２三角形の底辺Ｓ３０に対応する頂点Ｐ6Sの角度をε２とする。角度ε１と角度ε２の間には、底辺Ｓ３０の長さが同じになるという制約条件がある。この制約条件が守られれば、角度ε１および角度ε２は変化可能である。
角度ε１および角度ε２が変化すると、点Ｐ5Sの位置も変化する。点Ｐ5Sの位置が変化すると、第３リンクである胸腰部右リンク２０Ｌの長さが変化する。そのため、第３リンク２０Ｌの長さを決めると、点Ｐ5S、Ｐ4S、Ｐ6Sの位置および関節部である胸腰部関節部１８の角度も一意に決まる。第３リンク２０Ｌの長さも決めた状態が、図１５５(C)である。このように、胴体屈曲部Ｃ２では、３本の可変長リンクの長さを決めた時だけ関節部の角度を決めることができる。胴体屈曲部Ｃ２では、２本の可変長リンクの長さを決めた時点では、関節部の角度の３成分の中の一部だけを決めることはできない。
肩部Ｃ４Ｃのリンクおよびリンク取付部の接続関係は、肩部Ｃ４と同じである。肩関節部１３が指定角度を取るような可変長リンクの長さの決め方は、肩部Ｃ４Ｃの場合でも肩部Ｃ４の場合と同じである。肩関節部１３は、２回転自由度を有する関節部である。第２リンクである上腕部駆動補助リンク１５Ｌを第１リンクである上腕部駆動主リンク１４Ｌに接続しているので、第１リンク１４Ｌおよび第２リンク１５Ｌの長さを決めることで、関節部１３の回転角度を一意に決めることができる。
第２リンク１５Ｌを第２部材である上腕骨部７Ｂに接続する場合でも、第１リンク１４Ｌおよび第２リンク１５Ｌの長さを決めることで、関節部１３の回転角度を一意に決めることができる。ただし、第２部材７Ｂに２個のリンク取付部を設けるので、関節部１３の回転角度を決める方法は少し複雑になる。
肘部Ｃ５Ｃでのリンクおよびリンク取付部の接続関係は、肘部Ｃ５と同じである。肘関節部３１が指定角度を取るような第１リンクおよび第２リンクの取付位置の決め方は、肘部Ｃ５Ｃの場合でも肘部Ｃ５の場合と同じである。肘関節部３１は、２回転自由度を有する関節部である。
手首部Ｃ６Ｃは、胴体屈曲部Ｃ２Ｃと同様なリンク配置を有している。したがって、３回転自由度を有する関節部である手首関節部３６が指定角度を取るような、３本の可変長リンクの長さは、胴体屈曲部Ｃ２Ｃと同様な方法で決めることができる。手首部Ｃ６Ｃではリンクの両側のリンク取付部が同一直線上に存在するので、胴体屈曲部Ｃ２Ｃよりも処理が簡単になる。
手部９Ｃは、各指関節部のウォームギヤが指定された角度に対応する位置になるように、モータが駆動される。手部９Ｃでは、各指関節部のウォームギヤが指定された角度に対応する位置になると、各指部の第１指関節部、第２指関節部が指定された角度になる。２方向回転指８９では、第１指関節部から指先全部を回転させる指元部８０を有する。２方向回転指８９では、指を指定した方向に向けるように指元部のウォームギヤが指定された角度に対応する位置になるようにモータが駆動される。指元部を有する指は、２本以上でもよい。
人型ロボット１００が有する首部Ｃ３、股部Ｃ７、膝部Ｃ８、足首部Ｃ９の少なくとも１個に、この発明に係る２回転自由度または３回転自由度を有する関節部を有する回転接続機構を適用してもよい。
人型ロボットではなく、手部と、手部から直列に接続された１個または複数個の腕区間部とを有するロボットアームに、この発明に係る回転接続機構を適用してもよい。手部および腕区間部の何れかを第２部材として、手部から遠い側の第１部材に第２部材を２回転自由度または３回転自由度を有して回転可能に接続するように、回転接続機構を使用すればよい。そのようなロボットアームは、手部を適切な位置に適切な角度で向けることができる。
手部としては、実施の形態１の手部９、実施の形態３の手部９Ａ、実施の形態４の手部９Ｂあるいは他の手部を使用してもよい。
以上のことは、他の実施の形態でもあてはまる。
実施の形態６．
実施の形態６は、人型上半身ロボットの胴体屈曲部の関節部の位置を背骨部の上端に移動させるように実施の形態５を変更した場合である。図１５６は、この発明の実施形態６に係る人型上半身ロボットの正面図である。人型上半身ロボット１００Ｄでは、背骨部５６と胸部５Ｅと接続する端（上端）に胸腰部関節部１８Ｄを設けている。そのため、背骨部５６の軸方向は、腰部６Ｄに対して垂直な方向に固定される。背骨部５６において、腰部中央リンク取付部Ｊ１０Ｃの高さの箇所を背骨下端部５６Ｄと呼ぶ。背骨下端部５６Ｄは、腰部基準平面と捻り軸である背骨部５６の交点である第１捻り中心である。
胸腰部関節部１８Ｄは、球面軸受けを有する。胸腰部関節部１８Ｄは、胸部５Ｅを腰部６Ｄに３回転自由度を有して回転可能に接続する。第２部材である胸部５Ｅは、背骨部５６との角度が変更可能である。その他の点では、人型上半身ロボット１００Ｄは人型上半身ロボット１００Ｃと同様である。
図１５７は、実施形態６に係る人型上半身ロボットが有する胴体屈曲部のリンク配置を示す斜視図である。人型上半身ロボット１００Ｃに対する図１２４と比較すると、胸腰部関節部１８Ｄが背骨部５６の上端にある点が異なる。胸腰部関節部１８Ｄが背骨部５６の上端にあるので、胸部５Ｅを回転させるＸ軸およびＹ軸が、図１２４の場合よりも高い位置にあることになる。
人型上半身ロボット１００Ｄが有する胴体屈曲部Ｃ２Ｄは、第１部材である腰部６Ｄに第２部材である胸部５Ｅを関節部である胸腰部関節部１８Ｄにより回転可能に接続する回転接続機構である。
動作を説明する。人型上半身ロボット１００Ｄの姿勢は、胸腰部関節部１８Ｄ、肩関節部１３、肘関節部３１、手首関節部３６がとる角度により決まる。 各関節部について、その関節部が指定角度をとることができるような可変長リンクの長さの決め方、およびリニアガイドではリンク取付部の位置の決め方は、人型上半身ロボット１００Ｃと同様である。
胴体屈曲部Ｃ２Ｄでも、リンクの長さの変化の胸腰部関節部１８Ｄの回転角度への影響が考慮しやすい。図１５８は、人型上半身ロボット１００Ｄが有する胴体屈曲部Ｃ２Ｄでリンクの長さを決めることで位置が固定される点を示す図である。図１５８(A)が３本のリンクの長さが未定の状態である。図１５８(B)が、第１リンクである胸腰部中央リンク１９ＬＣと、第２リンクである胸腰部左リンク２１ＬＣの長さを決めた状態である。図１５８(C)が、３本のリンクの長さを決めた状態である。図に表示する記号の意味は、図１５４の場合と同じである。
図１５８(A)に示すように、３本の可変長リンクの長さが決まっていない状態では、関節部である胸腰部関節部１８Ｄの回転角度および第２部材である胸部５Ｅに存在する点の位置は、未定である。なお、関節部１８Ｄに対応するＰ0Sの位置は、各リンクの長さが変化しても変化しない。第１リンク１９ＬＣと第２リンク２１ＬＣの長さを決めると、点Ｐ4Sは３点Ｐ0S、Ｐ1S、Ｐ3Sからの距離が決まるので、図１５８(B)に示すように、点Ｐ4Sの位置は一意に決まる。点Ｐ4Sの位置が決まるということは、胸部５Ｅの捻り軸である背骨部５６の回りの回転角度と、第２部材第１取付部である腰側中央リンク取付部Ｊ１０Ｃの方向への背骨部５６の傾き角度が決まることである。
図１５８(B)に示す状態では、関節部１８Ｄは、２点Ｐ0S、Ｐ4Sを通る回転軸Ｒ21の回りに回転可能である。そのため、点Ｐ5Sは、点Ｐ0Sからの距離および点Ｐ4Sからの距離が一定のまま回転軸Ｒ21の回りを回転する。回転軸Ｒ21を、第１取付部方向軸と呼ぶ。なお、図１５８(B)では回転軸Ｒ21がＸＺ平面上にあり、かつＸ軸に平行なように書いているが、必ずしもそうなる訳ではない。
さらに、第３リンク２０ＬＣの長さを決めると、点Ｐ5Sおよび胸腰部関節部１８Ｄの回転角度が決まる。こうして、図１５８(C)に示す状態になる。
このように、人型上半身ロボット１００Ｄでも、人型上半身ロボット１００Ｃと同様に第１リンクおよび第２リンクの長さを決めることで捻り軸の回りの回転角度と、第１取付部傾斜角度を決めることができる。さらに、第３リンクの長さを決めると、第１取付部方向軸の回りの回転角度を決めることができる。人型上半身ロボット１００Ｄでも、各リンクの長さに対する関節部の角度の関係が解析しやすいという特徴がある。
胸腰部関節部１８Ｄだけでなく、他の関節部の位置は変更可能である。第１部材および第２部材に対する相対的な位置が固定されており、決められた次数の回転自由度を有して第２部材を第１部材に回転可能に接続するものであれば、関節部はどこに配置されてもよい。３回転自由度を有する関節部の場合は、捻り軸の方向は第１部材または第２部材のどちらに対して方向が固定されていてもよい。
以上のことは、他の実施の形態にもあてはまる。
る。
本発明はその発明の精神の範囲内において各実施の形態の自由な組み合わせ、あるいは各実施の形態の変形や省略が可能である。
１００、１００Ｚ 人型ロボット
１００Ｃ、１００Ｄ 人型上半身ロボット
１５０ 制御装置収納部
１６０ 台座昇降部
１７０ 台車
１ 体幹部
２ 頭部（第２部材）
２Ａ 頭部基準板
３ 上肢部
４ 下肢部
５、５Ｃ、５Ｅ 胸部（第１部材、第２部材）
５Ｕ 胸上部
５Ｄ 胸下部
６、６Ｃ、６Ｄ 腰部（第１部材）
７、７Ｃ 上腕部
７Ａ モータ保持具
７Ｂ 上腕骨部
７Ｈ 上腕骨部装着部
８、８Ｃ 前腕部（第１部材）
８Ｂ 前腕骨部（捻り軸）
８Ｄ 肘部先端部
８Ｈ 肘部装着穴
８Ｊ 肘関節部接続穴
９、９Ａ、９Ｂ、９Ｃ 手部（第２部材）
１０ 大腿部（第２部材）
１０Ａ 大腿骨部（捻り軸）
１０Ｂ 膝部側リンク取付板
１０Ｃ 膝部接続フレーム
１０Ｄ 大腿部側補助具取付部
１１ 下腿部
１２ 足部
１２Ａ 足本体部
１２Ｂ つま先部
１２Ｃ つま先関節部
１２Ｄ かかと車輪部
１２Ｅ 足側面車輪部
１３ 肩関節部（関節部）
１４ 上腕部駆動主アクチュエータ（第１アクチュエータ）
１４Ｌ 上腕部駆動主リンク（第１リンク）
１４Ｍ モータ（動力源、第１動力源）
１５ 上腕部駆動補助アクチュエータ（第２アクチュエータ）
１５Ｌ 上腕部駆動補助リンク（第２リンク）
１５Ｍ モータ（動力源、第２動力源）
１６ 胸部内関節部
１７ 胸部内アクチュエータ
１７Ｌ 胸部内リンク
１７Ｍ モータ（動力源）
１８、１８Ｄ 胸腰部関節部（関節部）
１９ 胸腰部中央アクチュエータ
１９Ａ ねじ棒
１９Ｂ ナット（有穴部材）
１９Ｃ 円筒（筒）
１９Ｄ ナット位置固定部（有穴部材位置固定部）
１９Ｅ ナット回転保持部（有穴部材保持部）
１９Ｆ ナットギヤ
１９Ｇ 駆動ギヤ
１９、１９Ｚ 胸腰部中央アクチュエータ
１９Ｃ 胸腰部中央アクチュエータ（第１アクチュエータ）
１９Ｌ 胸腰部中央リンク（可変長リンク）
１９ＬＣ 胸腰部中央リンク（第１リンク）
１９ＬＺ 胸腰部中央リンク（可変長リンク）
１９Ｈ シリンダ
１９Ｊ ピストン
１９Ｋ 配管
１９Ｎ ポンプ
１９Ｐ 第１の部屋
１９Ｑ 第２の部屋
１９Ｍ モータ（動力源、第１動力源）
２０ 胸腰部右アクチュエータ
２０Ｃ 胸腰部右アクチュエータ（第３アクチュエータ）
２０Ｌ 胸腰部右リンク（可変長リンク）
２０ＬＣ 胸腰部右リンク（第３リンク）
２０Ｍ モータ（動力源、第３動力源）
２１ 胸腰部左アクチュエータ
２１Ｃ 胸腰部左アクチュエータ（第２アクチュエータ）
２１Ｌ 胸腰部左リンク（可変長リンク）
２１ＬＣ 胸腰部左リンク（第２リンク）
２１Ｍ モータ（動力源、第３動力源）
２２ 股関節部（関節部）
２３ 大腿部正面アクチュエータ
２３Ｌ 大腿部正面リンク（可変長リンク）
２３Ｍ モータ
２４ 大腿部外側アクチュエータ
２４Ｌ 大腿部外側リンク（可変長リンク）
２４Ｍ モータ（動力源）
２５ 大腿部内側アクチュエータ
２５Ｌ 大腿部内側リンク（可変長リンク）
２５Ｍ モータ（動力源）
２６ 首部中心棒（捻り軸）
２７ 首関節部（関節部）
２８ 首部背面アクチュエータ
２８Ｌ 首部背面リンク（可変長リンク）
２８Ｍ モータ（動力源）
２８Ｎ リンク取付具
２９ 首部右側アクチュエータ
２９Ｌ 首部右側リンク（可変長リンク）
２９Ｍ モータ（動力源）
２９Ｎ リンク取付具
３０ 首部左側アクチュエータ
３０Ｌ 首部左側リンク（可変長リンク）
３０Ｍ モータ（動力源）
３０Ｎ リンク取付具
３１ 肘関節部（関節部）
３１Ｄ 肘関節部先端
３２ 肘部駆動外側リンク（第２リンク）
３３ 肘部駆動内側リンク（第１リンク）
３４、３４Ｐ 上腕部外側アクチュエータ（第２アクチュエータ）
３４Ａ ねじ棒（第２移動軸）
３４Ｂ、３４Ｊ ナット（第２移動部材）
３４Ｃ レール（第２回転防止部）
３４Ｄ 把持部（第２回転防止部）
３４Ｅ スプライン軸（ガイド軸、第２回転防止部）
３４Ｆ 上腕部外側フレーム
３４Ｇ、３４ＧＣ 上腕部外側リニアガイド（第２ガイド部）
３４Ｍ モータ（動力源、第２動力源）
３５、３５Ｐ 上腕部内側アクチュエータ（第１アクチュエータ）
３５Ａ ねじ棒（第１移動軸）
３５Ｂ、３５Ｊ ナット（第１移動部材）
３５Ｃ レール（第１回転防止部）
３５Ｄ 把持部（第１回転防止部）
３５Ｅ スプライン軸（ガイド軸、第１回転防止部）
３５Ｆ 上腕部内側フレーム
３５Ｇ、３５ＧＣ 上腕部内側リニアガイド（第１ガイド部）
３５Ｍ モータ（動力源、第１動力源）
３６ 手首関節部（関節部）
３７ 前腕部正面アクチュエータ
３７Ｃ 前腕部正面アクチュエータ（第１アクチュエータ）
３７Ｌ 前腕部正面リンク（可変長リンク）
３７ＬＣ 前腕部正面リンク（第１リンク）
３７Ｍ モータ（動力源、第１動力源）
３７Ｎ リンク取付具
３８ 前腕部外側アクチュエータ
３８Ｃ 前腕部外側アクチュエータ（第２アクチュエータ）
３８Ｌ 前腕部外側リンク（可変長リンク）
３８ＬＣ 前腕部外側リンク（第２リンク）
３８Ｍ モータ（動力源、第２動力源）
３８Ｎ リンク取付具
３９ 前腕部内側アクチュエータ
３９Ｃ 前腕部内側アクチュエータ（第３アクチュエータ）
３９Ｌ 前腕部内側リンク（可変長リンク）
３９ＬＣ 前腕部内側リンク（第３リンク）
３９Ｍ モータ（動力源、第３動力源）
３９Ｎ リンク取付具
４０ 膝関節部（関節部）
４１ 足首関節部（関節部）
４１Ａ 前後回転ヨーク
４１Ｂ 左右回転ヨーク
４２ 膝部駆動アクチュエータ
４２Ｌ 膝部駆動リンク
４２Ｍ モータ（動力源）
４３ 大腿部側補助具
４４ 下腿部側補助具
４５ 下腿部外側アクチュエータ
４５Ｌ 下腿部外側リンク
４５Ｍ モータ（動力源）
４６ 下腿部内側アクチュエータ
４６Ｌ 下腿部内側リンク
４６Ｍ モータ（動力源）
５１ 肩部フレーム
５１Ｈ 肩関節部装着穴
５２ 胸郭部フレーム
５２Ｃ、５２Ｄ 胸部骨格板
５２Ｈ 肩部第１装着穴
５２Ｌ 肩部第２装着穴
５３ 胸郭部前後連結フレーム
５４ 胸部中央連結フレーム
５５ 胸部内関節部フレーム
５６ 背骨部（捻り軸、連結棒）
５６Ｂ 背骨上端部（第２捻り中心）
５６Ｄ 背骨下端部（第１捻り中心）
５６Ｔ 胸内回転軸部
５７ リンク取付用フレーム
５８ 首下部フレーム
６１ 腰部主フレーム
６２ 下肢部接続フレーム
６３ 腰部カバー
６４ 突起
６５ 突起
６６ 突起
６７ 突起
８１ 手部取付部
８１Ａ 取付板部
８１Ｂ 掌板接続部
８２ 掌板部（基部）
８２Ａ 第１指取付部（指取付部）
８２Ｂ 第２指取付部（指取付部）
８２Ｃ 第３指取付部（指取付部）
８２Ｄ 第４指取付部（指取付部）
８２Ｅ 対向指部指取付部（指取付部）
８２Ｆ 掌板本体部（本体部）
８２Ｇ、８２Ｐ 段差
８２Ｈ、８２Ｊ、８２Ｋ、８２Ｌ、８２Ｍ、８２Ｎ、８２Ｑ、８２Ｒ 切り込み
８２Ｓ 手首取付部
８２Ｔ 掌肉部
８２Ｕ 貫通穴
８２Ｖ 手幅回転指取付部（指取付部）
８３ 第１指部（普通指部）
８４ 第２指部（普通指部）
８５ 第３指部（普通指部）
８６ 第４指部（普通指部）
８７ 対向指部
８８ 手幅回転指部
８３Ａ、８４Ａ、８５Ａ、８６Ａ、８７Ａ、８８Ａ 第１指節部
８３ＡＡ、８４ＡＡ、８５ＡＡ、８６ＡＡ、８７ＡＡ、８８ＡＡ 第１ホイール連動部
８３ＡＢ、８４ＡＢ、８５ＡＢ、８６ＡＢ、８７ＡＢ、８８ＡＢ 第１ヨーク部
８３ＡＣ、８４ＡＣ、８５ＡＣ、８６ＡＣ、８７ＡＣ、８８ＡＣ 第２モータ設置部
８３ＡＤ、８４ＡＤ、８５ＡＤ、８６ＡＤ、８７ＡＤ、８８ＡＤ 突起
８３Ｂ、８４Ｂ、８５Ｂ、８６Ｂ、８７Ｂ、８８Ｂ 第２指節部
８３Ｃ、８４Ｃ、８５Ｃ、８６Ｃ、８７Ｃ、８８Ｃ 第３指節部
８３ＣＡ、８４ＣＡ、８５ＣＡ、８６ＣＡ、８７ＣＡ、８８ＣＡ 指先部
８３ＣＢ、８４ＣＢ、８５ＣＢ、８６ＣＢ、８７ＣＢ、８８ＣＢ 指先基部
８３Ｄ、８４Ｄ、８５Ｄ、８６Ｄ、８７Ｄ、８８Ｄ 第１指関節部
８３Ｅ、８４Ｅ、８５Ｅ、８６Ｅ、８７Ｅ、８８Ｅ 第２指関節部
８３Ｆ、８４Ｆ、８５Ｆ、８６Ｆ、８７Ｆ、８８Ｆ 第３指関節部
８３Ｇ、８４Ｇ、８５Ｇ、８６Ｇ、８７Ｇ、８８Ｇ 指元ヨーク部
８３Ｈ、８４Ｈ、８５Ｈ、８６Ｈ、８７Ｈ、８８Ｈ 指部第１モータ
８３Ｊ、８４Ｊ、８５Ｊ、８６Ｊ、８７Ｊ、８８Ｊ 第１ウォーム
８３Ｋ、８４Ｋ、８５Ｋ、８６Ｋ、８７Ｋ、８８Ｋ 第１ウォームホイール
８３Ｌ、８４Ｌ、８５Ｌ、８６Ｌ、８７Ｌ、８８Ｌ 指部第２モータ
８３Ｍ、８４Ｍ、８５Ｍ、８６Ｍ、８７Ｍ、８８Ｍ 第２ウォーム
８３Ｎ、８４Ｎ、８５Ｎ、８６Ｎ、８７Ｎ、８８Ｎ 第２ウォームホイール
８３Ｐ、８４Ｐ、８５Ｐ、８６Ｐ、８７Ｐ、８８Ｐ 第３指節駆動歯車
８３Ｑ、８４Ｑ、８５Ｑ、８６Ｑ、８７Ｑ、８８Ｑ 部分ギヤ
８３Ｒ、８４Ｒ、８５Ｒ、８６Ｒ、８７Ｒ、８８Ｒ アイドラギヤ
８３ＳＡ、８４ＳＡ、８５ＳＡ、８６ＳＡ、８７ＳＡ、８８ＳＡ アイドラ外ギヤ
８３ＳＢ、８４ＳＢ、８５ＳＢ、８６ＳＢ、８７ＳＢ、８８ＳＢ アイドラ内ギヤ
８３Ｔ、８４Ｔ、８５Ｔ、８６Ｔ、８７Ｔ、８８Ｔ 第１ギヤヘッド
８３Ｕ、８４Ｕ、８５Ｕ、８６Ｕ、８７Ｕ、８８Ｕ 第２ギヤヘッド
８３Ｖ、８４Ｖ、８５Ｖ、８６Ｖ 第１モータ固定部
８８Ｗ 手幅指元部
８９ ２方向回転指部
８９Ａ 第１指節部
８９ＡＡ 第１ホイール連動部
８９ＡＢ 第１ヨーク部
８９ＡＣ 第２モータ設置部
８９ＡＤ 突起
８９Ｂ 第２指節部
８９Ｃ 第３指節部
８９ＣＡ 指先部
８９ＣＢ 指先基部
８９Ｄ 第１指関節部
８９Ｅ 第２指関節部
８９Ｆ 第３指関節部
８９Ｇ 指元ヨーク部
８９Ｈ 指部第１モータ
８９Ｊ 第１ウォーム
８９Ｋ 第１ウォームホイール
８９Ｌ 指部第２モータ
８９Ｍ 第２ウォーム
８９Ｎ 第２ウォームホイール
８９Ｐ 第３指節駆動歯車
８９Ｑ 部分ギヤ
８９Ｒ アイドラギヤ
８９ＳＡ アイドラ外ギヤ
８９ＳＢ アイドラ内ギヤ
８９Ｔ 第１ギヤヘッド
８９Ｕ 第２ギヤヘッド
８９Ｖ 第１モータ固定部
８９ＶＢ ウォーム先端保持部
８０ 指元部
８０Ａ 指元指節部
８０ＡＡ 突起
８０ＡＢ 突起
８０Ｂ 指元モータ固定部
８０ＢＡ 突起
８０Ｃ 指元指関節部
８０Ｄ 指元モータ
８０Ｅ 指元ギヤヘッド
８０Ｆ 指元ウォーム
８０Ｇ 指元ウォームホイール
８３Ｘ、８４Ｘ、８５Ｘ、８６Ｘ、８８Ｘ、８９Ｘ 第１指節カバー
８３Ｙ、８４Ｙ、８５Ｙ、８６Ｙ、８８Ｙ、８９Ｙ 第２指節カバー
８３Ｚ、８４Ｚ、８５Ｚ、８６Ｚ、８８Ｚ、８９Ｚ 第２ウォームカバー
９１、９１Ｃ 手首板部
９８ 手部取付部
９８Ａ 取付板部
９８Ｂ 掌板接続部
９２ 掌板部（基部）
９３ 第１指部（普通指部）
９４ 第２指部（普通指部）
９５ 第３指部（普通指部）
９６ 第４指部（普通指部）
９７ 対向可能指部
９７Ｔ 第１指節元部
９７Ｕ 第１指節先部
９３Ａ、９４Ａ、９５Ａ、９６Ａ、９７Ａ 第１指節部
９３Ｂ、９４Ｂ、９５Ｂ、９６Ｂ、９７Ｂ 第２指節部
９３Ｃ、９４Ｃ、９５Ｃ、９６Ｃ、９７Ｃ 第３指節部
９３Ｄ、９４Ｄ、９５Ｄ、９６Ｄ、９７Ｄ 第１指関節部
９３Ｅ、９４Ｅ、９５Ｅ、９６Ｅ、９７Ｅ 第２指関節部
９３Ｆ、９４Ｆ、９５Ｆ、９６Ｆ、９７Ｆ 第３指関節部
９３Ｇ、９４Ｇ、９５Ｇ、９６Ｇ、９７Ｇ 指元ヨーク部
９３Ｈ、９４Ｈ、９５Ｈ、９６Ｈ、９７Ｈ 指部第１モータ
９３Ｊ、９４Ｊ、９５Ｊ、９６Ｊ、９７Ｊ 第１ウォーム
９３Ｋ、９４Ｋ、９５Ｋ、９６Ｋ、９７Ｋ 第１ウォームホイール
９３Ｌ、９４Ｌ、９５Ｌ、９６Ｌ、９７Ｌ 指部第２モータ
９３Ｍ、９４Ｍ、９５Ｍ、９６Ｍ、９７Ｍ 第２ウォーム
９３Ｎ、９４Ｎ、９５Ｎ、９６Ｎ、９７Ｎ 第２ウォームホイール
９３Ｐ、９４Ｐ、９５Ｐ、９６Ｐ、９７Ｐ 第３指節駆動歯車
９３Ｑ、９４Ｑ、９５Ｑ、９６Ｑ、９７Ｑ アイドラギヤ
９３Ｒ、９４Ｒ、９５Ｒ、９６Ｒ、９７Ｒ アイドラギヤ
９３Ｓ、９４Ｓ、９５Ｓ、９６Ｓ、９７Ｓ アイドラギヤ
Ｊ１ 胸側主リンク取付部（第１部材第１取付部）
Ｊ２ 胸側補助リンク取付部（第１部材第２取付部）
Ｊ３ 下側胸部内リンク取付部
Ｊ４ 上側胸部内リンク取付部
Ｊ５ 胸部中央リンク取付部（第２部材側リンク取付部）
Ｊ５Ｃ 胸部中央リンク取付部（第２部材第１取付部）
Ｊ６ 胸部右リンク取付部（第２部材側リンク取付部）
Ｊ６Ｃ 胸部右リンク取付部（第２部材第３取付部）
Ｊ７ 胸部左リンク取付部（第２部材側リンク取付部）
Ｊ７Ｃ 中央リンク左リンク取付部（第１リンク第２取付部）
Ｊ８ 腰部右リンク取付部（第１部材側リンク取付部）
Ｊ８Ｃ 腰部右リンク取付部（第１部材第３取付部）
Ｊ９ 腰部左リンク取付部（第１部材側リンク取付部）
Ｊ９Ｃ 腰部左リンク取付部（第１部材第２取付部）
Ｊ１０ 腰部中央リンク取付部（第１部材側リンク取付部）
Ｊ１０Ｃ 腰部中央リンク取付部（第１部材第１取付部）
Ｊ１１ 股部正面リンク取付部（第１部材側リンク取付部）
Ｊ１２ 股部外側リンク取付部（第１部材側リンク取付部）
Ｊ１２ 股部外側リンク取付部（第１部材側リンク取付部）
Ｊ１３ 股部内側リンク取付部（第１部材側リンク取付部）
Ｊ１４ 首部背面リンク取付部（第１部材側リンク取付部）
Ｊ１５ 首部右側リンク取付部（第１部材側リンク取付部）
Ｊ１６ 首部左側リンク取付部（第１部材側リンク取付部）
Ｊ１７ 頭部背面リンク取付部（第２部材側リンク取付部）
Ｊ１８ 頭部右側リンク取付部（第２部材側リンク取付部）
Ｊ１９ 頭部左側リンク取付部（第２部材側リンク取付部）
Ｊ２０ 上腕部主リンク取付部（第２部材第１取付部）
Ｊ２１ 上腕部駆動主リンク側補助リンク取付部（第１リンク第２取付部）
Ｊ２２ 上腕部外側リンク取付部（上腕側リンク取付部、第１部材第２取付部）
Ｊ２３ 上腕部内側リンク取付部（上腕側リンク取付部、第１部材第１取付部）
Ｊ２４ 肘部駆動内側リンク取付部（前腕側主リンク取付部、第２部材第１取付部）
Ｊ２５ 肘部駆動外側リンク取付部（肘部駆動主リンク側補助リンク取付部、第１リンク第２取付部）
Ｊ２６ 前腕部正面リンク取付部（第１部材側リンク取付部）
Ｊ２６Ｃ 前腕部正面リンク取付部（第１部材第１取付部）
Ｊ２７ 前腕部外側リンク取付部（第１部材側リンク取付部）
Ｊ２７Ｃ 前腕部外側リンク取付部（第１部材第２取付部）
Ｊ２８ 前腕部内側リンク取付部（第１部材側リンク取付部）
Ｊ２８Ｃ 前腕部内側リンク取付部（第１部材第３取付部）
Ｊ２９ 手部側正面リンク取付部（第２部材側リンク取付部）
Ｊ２９Ｃ 手部側正面リンク取付部（第２部材第１取付部）
Ｊ３０ 手部側外側リンク取付部（第２部材側リンク取付部）
Ｊ３０Ｃ 正面リンク側外側リンク取付部（第１リンク第２取付部）
Ｊ３１ 手部側内側リンク取付部（第２部材側リンク取付部）
Ｊ３１Ｃ 手部側内側リンク取付部（第２部材第３取付部）
Ｊ３２ 膝部正面リンク取付部（第２部材側リンク取付部）
Ｊ３３ 膝部外側リンク取付部（第２部材側リンク取付部）
Ｊ３４ 膝部内側リンク取付部（第２部材側リンク取付部）
Ｊ３５ 膝部駆動リンク取付部
Ｊ３６ 大腿部側補助具取付部
Ｊ３７ 膝部駆動リンク補助具接続部
Ｊ３８ 下腿部側補助具取付部
Ｊ３９ 下腿部外側リンク取付部（下腿部側リンク取付部）
Ｊ４０ 下腿部内側リンク取付部（下腿部側リンク取付部）
Ｊ４１ 足部外側リンク取付部（足部側リンク取付部）
Ｊ４２ 足部内側リンク取付部（足部側リンク取付部）
Ｃ１ 胸屈曲部
Ｃ２ 胴体屈曲部（３回転自由度接続機構）
Ｃ２Ｃ、Ｃ２Ｄ 胴体屈曲部（回転接続機構）
Ｃ３ 首部（３回転自由度接続機構）
Ｃ４、Ｃ４Ｃ 肩部（回転接続機構）
Ｃ５、Ｃ５Ｃ 肘部（回転接続機構）
Ｃ６ 手首部（３回転自由度接続機構）
Ｃ６Ｃ 手首部（回転接続機構）
Ｃ７ 股部（３回転自由度接続機構）
Ｃ８ 膝部
Ｃ９ 足首部
Ｇ１、Ｇ２、Ｇ３ 捻り軸
Ｌ１、Ｌ２、Ｌ３ 可変長リンク
Ｔ１、Ｔ２、Ｔ３、Ｔ４ 第２部材側三角形
Ｒx1 肩関節部１３の回転軸
Ｒz2 肘関節部２２の回転軸
Ｒx3 ２方向指回転軸８９全体を回転させる回転軸
Ｒz3 ２方向指回転軸８９の第１指関節部８９Ｄの回転軸
Ｒz4 ２方向指回転軸８９の第２指関節部８９Ｅの回転軸
Ｒz5 ２方向指回転軸８９の第３指関節部８９Ｆの回転軸
Ｒ11 胴体屈曲部Ｃ２Ｃの第３リンク２０ＬＣの伸縮による回転の回転軸
Ｒ21 胴体屈曲部Ｃ２Ｄの第３リンク２０ＬＣの伸縮による回転の回転軸
Ｓ３０ 胴体屈曲部Ｃ２で２本のリンクの長さを決めてできる第１三角形と第２三角形とで共通な底辺
ε１ 胴体屈曲部Ｃ２で形成される第１三角形の底辺Ｓ３０に対する頂点の角度
ε２ 胴体屈曲部Ｃ２で形成される第２三角形の底辺Ｓ３０に対する頂点の角度
Ｓ１１、Ｓ２１ 第１線分
Ｓ１２、Ｓ２２ 第２線分
Ｓ１３、Ｓ２３ 第３線分
Ｓ１４、Ｓ２４ 第４線分
Ｓ１５、Ｓ２５ 第５線分
η１、η１Ａ 第１線分と第３線分がなす角度
η２、η２Ａ 第４線分と第５線分がなす角度
ζ、ζＡ 第１リンクと第２リンクが第１リンク第２取付部でなす角度
Ｐ１Ｎ 第１基準点
Ｐ２Ｎ 第２基準点

Claims (29)

  1. 第１部材に第２部材を少なくとも２回転自由度を有して回転可能に接続する関節部と、
    ４回転自由度または５回転自由度を有する第１リンク、前記関節部に対する相対的な位置関係が固定されて前記第２部材に設けられて前記第１リンクの一端が少なくとも２回転自由度を有して回転可能に取付けられる第２部材第１取付部、前記第１リンクの他端が少なくとも２回転自由度を有して回転可能に取付けられる第１部材第１取付部、前記関節部に対する相対的な位置関係が固定されて前記第１部材に設けられた第１基準点と前記第２部材第１取付部との距離を変更する力を発生させる第１動力源を有する第１アクチュエータと、
    ３回転自由度または４回転自由度または５回転自由度を有する第２リンク、前記第２部材第１取付部に対する相対的な位置関係が固定されて前記第１リンクに設けられて前記第２リンクの一端が少なくとも１回転自由度を有して回転可能に取付けられる第１リンク第２取付部、前記第２リンクの他端が少なくとも２回転自由度を有して回転可能に取付けられる第１部材第２取付部、前記関節部に対する相対的な位置関係が固定されて前記第１部材に設けられた第２基準点と前記第１リンク第２取付部との距離を変更する力を発生させる第２動力源を有する第２アクチュエータとを備えた回転接続機構。
  2. 第１部材に第２部材を少なくとも２回転自由度を有して回転可能に接続する関節部と、
    ４回転自由度または５回転自由度を有する長さが変更可能な第１リンク、前記関節部に対する相対的な位置関係が固定されて前記第２部材に設けられて前記第１リンクの一端が少なくとも２回転自由度を有して回転可能に取付けられる第２部材第１取付部、前記関節部に対する相対的な位置関係が固定されて前記第１部材に設けられて前記第１リンクの他端が少なくとも２回転自由度を有して回転可能に取付けられる第１部材第１取付部、前記第１リンクの長さを変更する力を発生させる第１動力源を有する第１アクチュエータと、
    ３回転自由度または４回転自由度または５回転自由度を有する長さが変更可能な第２リンク、前記第２部材第１取付部に対する相対的な位置関係が固定されて前記第１リンクに設けられて前記第２リンクの一端が少なくとも１回転自由度を有して回転可能に取付けられる第１リンク第２取付部、前記関節部に対する相対的な位置関係が固定されて前記第１部材に設けられて前記第２リンクの他端が少なくとも２回転自由度を有して回転可能に取付けられる第１部材第２取付部、前記第２リンクの長さを変更する力を発生させる第２動力源を有する第２アクチュエータとを備えた回転接続機構。
  3. 前記関節部が２回転自由度を有し、
    前記第１リンクが４回転自由度を有し、
    前記第２リンクが３回転自由度を有し、
    前記第１部材第１取付部、前記第１リンク第２取付部および前記第１部材第２取付部で決定される平面であるリンク移動面上を前記第２リンクが回転する１回転自由度を前記第１リンク第２取付部が有し、
    前記第１部材第１取付部および前記第１部材第２取付部が、前記第１部材第１取付部および前記第１部材第２取付部を通るリンク移動面回転軸と前記リンク移動面に垂直な垂直回転軸による２回転自由度を有し、
    前記第２部材第１取付部が２回転自由度を有する、請求項２に記載の回転接続機構。
  4. ５回転自由度を有する長さが変更可能な第３リンク、前記関節部に対する相対的な位置関係が固定されて前記第２部材に設けられて前記第３リンクの一端が少なくとも２回転自由度を有して回転可能に取付けられる第２部材第３取付部、前記関節部に対する相対的な位置関係が固定されて前記第１部材に設けられて前記第３リンクの他端が少なくとも２回転自由度を有して回転可能に取付けられる第１部材第３取付部、前記第３リンクの長さを変更する力を発生させる第３動力源を有する第３アクチュエータをさらに備え、
    前記関節部が、前記第１部材または前記第２部材に対する方向が固定された捻り軸の回りに前記第２部材を前記第１部材に対して回転可能にし、かつ前記第２部材を前記第１部材に３回転自由度を有して回転可能に接続し、
    前記第１リンクおよび前記第２リンクが５回転自由度を有し、
    前記第１リンク第２取付部が少なくとも２回転自由度を有して回転可能に前記第２リンクを前記第１リンクに取付ける、請求項２または請求項３に記載の回転接続機構。
  5. 第１部材に第２部材を少なくとも２回転自由度を有して回転可能に接続する関節部と、
    ５回転自由度を有する長さが固定された第１リンク、前記関節部に対する相対的な位置関係が固定されて前記第２部材に設けられて前記第１リンクの一端が少なくとも２回転自由度を有して回転可能に取付けられる第２部材第１取付部、前記第１リンクの他端が少なくとも２回転自由度を有して回転可能に取付けられる第１部材第１取付部、前記第１部材第１取付部が設けられた第１移動部材、第１移動軸を有して前記第１移動部材を前記第１移動軸に沿って移動するようにガイドする、前記関節部に対する相対的な位置関係が固定されて前記第１部材に設けられた第１ガイド部、前記第１ガイド部に対する前記第１移動部材の位置を変更させる力を発生させる第１動力源を有する第１アクチュエータと、
    ５回転自由度を有する長さが固定された第２リンク、前記第２部材第１取付部に対する相対的な位置関係が固定されて前記第１リンクに設けられて前記第２リンクの一端が少なくとも２回転自由度を有して回転可能に取付けられる第１リンク第２取付部、前記第２リンクの他端が少なくとも２回転自由度を有して回転可能に取付けられる第１部材第２取付部、前記第１部材第２取付部が設けられた第２移動部材、第２移動軸を有して前記第２移動部材を前記第２移動軸に沿って移動するようにガイドする、前記関節部に対する相対的な位置関係が固定されて前記第１部材に設けられた第２ガイド部、前記第２ガイド部に対する前記第２移動部材の位置を変更させる力を発生させる第２動力源を有する第２アクチュエータとを備えた回転接続機構。
  6. ５回転自由度を有する長さが変更可能な第３リンク、前記関節部に対する相対的な位置関係が固定されて前記第２部材に設けられて前記第３リンクの一端が少なくとも２回転自由度を有して回転可能に取付けられる第２部材第３取付部、前記関節部に対する相対的な位置関係が固定されて前記第１部材に設けられて前記第３リンクの他端が少なくとも２回転自由度を有して回転可能に取付けられる第１部材第３取付部、前記第３リンクの長さを変更する力を発生させる第３動力源を有する第３アクチュエータをさらに備え、
    前記関節部が、前記第１部材または前記第２部材に対する方向が固定された捻り軸の回りに前記第２部材を前記第１部材に対して回転可能にし、かつ前記第２部材を前記第１部材に３回転自由度を有して回転可能に接続する、請求項５に記載の回転接続機構。
  7. 前記第１リンクおよび前記第２リンクのそれぞれは、雄ねじが設けられたねじ棒と、前記ねじ棒に設けられた前記雄ねじとかみ合う雌ねじが内面に設けられた貫通穴を有する有穴部材と、前記有穴部材および前記ねじ棒を収容する筒と、前記ねじ棒の軸方向での前記筒に対する前記有穴部材の相対位置を固定する有穴部材位置固定部とを有し、
    前記第１リンクでは、前記ねじ棒および前記筒の一方が前記第１部材第１取付部に取付けられ、他方が前記第２部材第１取付部に取付けられ、
    前記第２リンクでは、前記ねじ棒および前記筒の一方が前記第１部材第２取付部に取付けられ、他方が前記第１リンク第２取付部に取付けられ、
    前記第１動力源および前記第２動力源のそれぞれが前記ねじ棒を移動させる力を発生する、請求項１から請求項３の何れか１項に記載の回転接続機構。
  8. 前記第１リンク、前記第２リンクおよび前記第３リンクのそれぞれは、雄ねじが設けられたねじ棒と、前記ねじ棒に設けられた前記雄ねじとかみ合う雌ねじが内面に設けられた貫通穴を有する有穴部材と、前記有穴部材および前記ねじ棒を収容する筒と、前記ねじ棒の軸方向での前記筒に対する前記有穴部材の相対位置を固定する有穴部材位置固定部とを有し、
    前記第１リンクでは、前記ねじ棒および前記筒の一方が前記第１部材第１取付部に取付けられ、他方が前記第２部材第１取付部に取付けられ、
    前記第２リンクでは、前記ねじ棒および前記筒の一方が前記第１部材第２取付部に取付けられ、他方が前記第１リンク第２取付部に取付けられ、
    前記第３リンクでは、前記ねじ棒および前記筒の一方が前記第１部材第３取付部に取付けられ、他方が前記第２部材第３取付部に取付けられ、
    前記第１動力源、前記第２動力源および前記第３動力源のそれぞれが前記ねじ棒を移動させる力を発生する、請求項４に記載の回転接続機構。
  9. 前記第１リンクおよび前記第２リンクのそれぞれは、液体が充填されたシリンダと、前記シリンダの内部を第１の部屋と第２の部屋とに区分する移動可能なピストンと、前記第１の部屋と前記第２の部屋とを結ぶ前記液体が充填された配管と、前記配管の途中に設けられて、前記液体を前記第１の部屋から前記第２の部屋へ移動させ、かつ前記液体を前記第２の部屋から前記第１の部屋へ移動させるポンプとを有し、
    前記第１リンクでは、前記ピストンおよび前記シリンダの一方が前記第１部材第１取付部に取付けられ、他方が前記第２部材第１取付部に取付けられ、
    前記第２リンクでは、前記ピストンおよび前記シリンダの一方が前記第１部材第２取付部に取付けられ、他方が前記第１リンク第２取付部に取付けられ、
    前記第１動力源および前記第２動力源のそれぞれが前記ポンプを駆動する力を発生する、請求項１から請求項３の何れか１項に記載の回転接続機構。
  10. 前記第１リンク、前記第２リンクおよび前記第３リンクのそれぞれは、液体が充填されたシリンダと、前記シリンダの内部を第１の部屋と第２の部屋とに区分する移動可能なピストンと、前記第１の部屋と前記第２の部屋とを結ぶ前記液体が充填された配管と、前記配管の途中に設けられて、前記液体を前記第１の部屋から前記第２の部屋へ移動させ、かつ前記液体を前記第２の部屋から前記第１の部屋へ移動させるポンプとを有し、
    前記第１リンクでは、前記ピストンおよび前記シリンダの一方が前記第１部材第１取付部に取付けられ、他方が前記第２部材第１取付部に取付けられ、
    前記第２リンクでは、前記ピストンおよび前記シリンダの一方が前記第１部材第２取付部に取付けられ、他方が前記第１リンク第２取付部に取付けられ、
    前記第３リンクでは、前記ピストンおよび前記シリンダの一方が前記第１部材第３取付部に取付けられ、他方が前記第２部材第３取付部に取付けられ、
    前記第１動力源、前記第２動力源および前記第３動力源のそれぞれが前記ポンプを駆動する力を発生する、請求項４に記載の回転接続機構。
  11. 前記第１部材第１取付部、前記第１部材第２取付部および前記第１部材第３取付部を通る平面である第１部材基準平面と前記捻り軸との交点である第１捻り中心と前記第１部材第１取付部とを結ぶ第１線分と、前記第１捻り中心と前記第１部材第３取付部とを結ぶ第３線分とがなす角度が決められた第１交差角範囲内である、請求項４、請求項６、請求項８、請求項１０の何れか１項に記載の回転接続機構。
  12. 前記第１線分の長さと前記第３線分の長さの何れか短い方を長い方で割った長短比が決められた下限比以上である、請求項１１に記載の回転接続機構。
  13. 前記第１移動軸および前記第２移動軸のそれぞれが、雄ねじが設けられたねじ棒であり、
    前記第１移動部材および前記第２移動部材のそれぞれが、前記ねじ棒に設けられた前記雄ねじとかみ合う雌ねじが内面に設けられた貫通穴を有する有穴部材であり、
    前記第１動力源および前記第２動力源のそれぞれが前記ねじ棒を回転させる力を発生し、
    前記第１移動部材が回転することを防止する第１回転防止部および前記第２移動部材が回転することを防止する第２回転防止部をさらに備えた請求項５に記載の回転接続機構。
  14. 前記第３リンクは、雄ねじが設けられたねじ棒と、前記ねじ棒に設けられた前記雄ねじとかみ合う雌ねじが内面に設けられた貫通穴を有する有穴部材と、前記有穴部材および前記ねじ棒を収容する筒と、前記ねじ棒の軸方向での前記筒に対する前記有穴部材の相対位置を固定する有穴部材位置固定部とを有し、
    前記第３リンクでは、前記ねじ棒および前記筒の一方が前記第１部材第３取付部に取付けられ、他方が前記第１リンク第３取付部に取付けられ、
    前記第１移動軸および前記第２移動軸のそれぞれが、前記ねじ棒であり、
    前記第１移動部材および前記第２移動部材のそれぞれが、前記有穴部材であり、
    前記第１動力源および前記第２動力源のそれぞれが前記ねじ棒を回転させる力を発生し、
    前記第３動力源が前記ねじ棒を移動させる力を発生し、
    前記第１移動部材が回転することを防止する第１回転防止部および前記第２移動部材が回転することを防止する第２回転防止部をさらに備えた請求項６に記載の回転接続機構。
  15. 前記第３リンクは、液体が充填されたシリンダと、前記シリンダの内部を第１の部屋と第２の部屋とに区分する移動可能なピストンと、前記第１の部屋と前記第２の部屋とを結ぶ前記液体が充填された配管と、前記配管の途中に設けられて、前記液体を前記第１の部屋から前記第２の部屋へ移動させ、かつ前記液体を前記第２の部屋から前記第１の部屋へ移動させるポンプとを有し、
    前記第３動力源が前記ポンプを駆動する力を発生し、
    前記ピストンおよび前記シリンダの一方が前記第１部材第３取付部に取付けられ、他方が前記第２部材第３取付部に取付けられ、
    前記第１移動軸および前記第２移動軸のそれぞれが、雄ねじが設けられたねじ棒であり、
    前記第１移動部材および前記第２移動部材のそれぞれが、前記ねじ棒に設けられた前記雄ねじとかみ合う雌ねじが内面に設けられた貫通穴を有する有穴部材であり、
    前記第１動力源および前記第２動力源のそれぞれが前記ねじ棒を回転させる力を発生し、
    前記第１移動部材が回転することを防止する第１回転防止部および前記第２移動部材が回転することを防止する第２回転防止部をさらに備えた請求項６に記載の回転接続機構。
  16. 前記捻り軸との間の角度が固定された前記第２部材に設けられた前記第２部材第１取付部を通り前記捻り軸に垂直な平面と前記捻り軸との交点である第２捻り中心と前記第２部材第１取付部を結ぶ第４線分と、前記第２捻り中心と前記第２部材第３取付部を結ぶ第５線分とがなす角度が、決められた第２交差角範囲内である、請求項４、請求項６、請求項８、請求項１０、請求項１１、請求項１２の何れか１項に記載の回転接続機構。
  17. 前記捻り軸との間の角度が変更可能な前記第２部材に設けられた前記第２部材第１取付部と前記関節部を結ぶ第４線分と、前記関節部と前記第２部材第３取付部を結ぶ第５線分とがなす角度が、決められた第２交差角範囲内である、請求項４、請求項６、請求項８、請求項１０、請求項１１、請求項１２の何れか１項に記載の回転接続機構。
  18. 前記第１リンク第２取付部において前記第１リンクと前記第２リンクとがなす角度が、決められた第３交差角以上である、請求項１から請求項１７の何れか１項に記載の回転接続機構。
  19. 胸部と、
    前記胸部の上部の左右に直列に接続した上腕部、前腕部、および手部を有する左右一対の上肢部と、
    前記手部、前記前腕部、前記上腕部の何れかを前記第２部材として、前記手部から遠い側の前記第１部材に前記第２部材を少なくとも２回転自由度を有して回転可能に接続する請求項１から請求項１８の何れか１項に記載の回転接続機構とを備えたロボット。
  20. 腰部と、
    前記腰部の上方に接続した胸部と、
    前記胸部の上部の左右に直列に接続した上腕部、前腕部、および手部を有する左右一対の上肢部と、
    前記手部、前記前腕部、前記上腕部、前記胸部の何れかを前記第２部材として、前記腰部に近い側の前記第１部材に前記第２部材を少なくとも２回転自由度を有して回転可能に接続する請求項１から請求項１８の何れか１項に記載の回転接続機構とを備えたロボット。
  21. 前記腰部または前記胸部が搭載され、前記腰部または前記胸部を上下方向に移動させる高さ調整部と、
    前記高さ調整部を移動させる移動部とをさらに備えた請求項１９または請求項２０に記載のロボット。
  22. 腰部と、
    前記腰部の上方に接続した胸部と、
    前記胸部の上部の左右に直列に接続した上腕部、前腕部および手部をそれぞれ有する左右一対の上肢部と、
    前記腰部の下部の左右に直列に接続した大腿部、下腿部および足部をそれぞれ有する左右一対の下肢部と、
    前記手部、前記前腕部、前記上腕部、前記胸部、前記足部、前記下腿部、前記大腿部の何れかを前記第２部材として、前記腰部に近い側の前記第１部材に前記第２部材を少なくとも２回転自由度を有して回転可能に接続する請求項１から請求項１８の何れか１項に記載の回転接続機構とを備えたロボット。
  23. 左右の前記手部をそれぞれ前記第２部材とし、前記前腕部を前記第１部材として、３回転自由度を有して前記第２部材を前記第１部材に回転可能に接続する、請求項４、請求項８、請求項１０の何れか１項に記載の回転接続機構である左右一対の手首部を備えた請求項１９から請求項２２の何れか１項に記載のロボット。
  24. 前記胸部を前記第２部材とし、前記腰部を前記第１部材として、３回転自由度を有して前記第２部材を前記第１部材に回転可能に接続する、請求項４、請求項８、請求項１０の何れか１項に記載の回転接続機構である胴体屈曲部を備えた請求項２０または請求項２２に記載のロボット。
  25. 左右の前記大腿部をそれぞれ前記第２部材とし、前記腰部を前記第１部材として、３回転自由度を有して前記第２部材を前記第１部材に回転可能に接続する、請求項４、請求項８、請求項１０の何れか１項に記載の回転接続機構である左右一対の股部を備えた請求項２２に記載のロボット。
  26. 左右の前記上腕部をそれぞれ前記第２部材とし、前記胸部を前記第１部材として、２回転自由度を有して前記第２部材を前記第１部材に回転可能に接続する請求項３に記載の回転接続機構である左右一対の肩部を備えた請求項１９から請求項２２の何れか１項に記載のロボット。
  27. 前記肩部において、前記第１部材第１取付部および前記第１部材第２取付部が異なる高さに設けられる、請求項２６に記載のロボット。
  28. 左右の前記前腕部をそれぞれ前記第２部材とし、前記上腕部を前記第１部材として、２回転自由度を有して前記第２部材を前記第１部材に回転可能に接続する請求項５に記載の回転接続機構である左右一対の肘部を備えた請求項１９から請求項２２の何れか１項に記載のロボット。
  29. 手部と、
    前記手部から直列に接続された１個または複数個の腕区間部と、
    前記手部および前記腕区間部の何れかを前記第２部材として、前記手部から遠い側の前記第１部材に前記第２部材を少なくとも２回転自由度を有して回転可能に接続する請求項１から請求項１８の何れか１項に記載の回転接続機構とを備えたロボットアーム。
JP2020515536A 2018-04-25 2019-04-24 回転接続機構、ロボットおよびロボットアーム Active JP6903229B2 (ja)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JP2018084072 2018-04-25
JP2018084072 2018-04-25
PCT/JP2019/017482 WO2019208652A1 (ja) 2018-04-25 2019-04-24 回転接続機構、ロボット、ロボットアームおよびロボットハンド

Publications (2)

Publication Number Publication Date
JPWO2019208652A1 JPWO2019208652A1 (ja) 2021-04-22
JP6903229B2 true JP6903229B2 (ja) 2021-07-14

Family

ID=68295152

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020515536A Active JP6903229B2 (ja) 2018-04-25 2019-04-24 回転接続機構、ロボットおよびロボットアーム

Country Status (3)

Country Link
US (1) US12103160B2 (ja)
JP (1) JP6903229B2 (ja)
WO (1) WO2019208652A1 (ja)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111439322B (zh) * 2020-05-19 2021-02-19 燕山大学 一种四足仿生机器人轻量化四自由度腿部机构
WO2022145450A1 (ja) * 2020-12-28 2022-07-07 三菱電機株式会社 ロボットハンド、ロボットアーム、ロボット、ロボットハンド操作システム、ロボットハンド操作装置、ロボットアーム操作システム、ロボットアーム操作装置およびロボット操作システム
CN114084246B (zh) * 2021-12-14 2023-06-06 浙江大学湖州研究院 一种面向太空微重力环境的仿人形机器人下肢
CN114275068B (zh) * 2021-12-15 2024-05-14 武汉工程大学 一种攀爬机器人
WO2024080225A1 (ja) * 2022-10-13 2024-04-18 ソフトバンクグループ株式会社 人型ロボットの制御システム及びプログラム
CN116293201B (zh) * 2023-04-08 2023-10-10 南京北控工程检测咨询有限公司 一种管道载物器及管道机器人
CN116729520B (zh) * 2023-08-11 2023-10-20 太原理工大学 一种基于双层波纹管气动软体驱动器的仿生四足机器人

Family Cites Families (21)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4957320A (en) 1988-08-31 1990-09-18 Trustees Of The University Of Pennsylvania Methods and apparatus for mechanically intelligent grasping
US5355743A (en) * 1991-12-19 1994-10-18 The University Of Texas At Austin Robot and robot actuator module therefor
JP2003165084A (ja) * 2001-11-30 2003-06-10 Kanto Auto Works Ltd 手指構造
JP2003172418A (ja) 2001-12-07 2003-06-20 Koji Kondo パラレルメカニズムロボットアーム（３）
KR100541433B1 (ko) 2002-12-23 2006-01-11 삼성전자주식회사 ２족보행로봇
EP1669171A4 (en) * 2003-09-12 2006-09-13 Tmsuk Co Ltd LOWER PART MODULE OF A WALKING ROBOT
JP2007516854A (ja) * 2003-12-30 2007-06-28 ストライダー ラブス，インコーポレイテッド 伸縮式の手のひらを有するロボットハンド
JP4614879B2 (ja) 2005-12-28 2011-01-19 株式会社ハーモニック・ドライブ・システムズ 密閉型のウォームギヤ式指関節ユニット
KR100841184B1 (ko) * 2006-10-18 2008-06-24 경상대학교산학협력단 병렬 기구형 다중 플랫폼 인간형 로봇 발
US7950306B2 (en) * 2007-02-23 2011-05-31 Microdexterity Systems, Inc. Manipulator
US20090050191A1 (en) * 2007-08-22 2009-02-26 Sol Focus, Inc. System and Method for Solar Tracking
FR2930905B1 (fr) 2008-05-09 2010-10-01 Bia Cheville pour robot humanoide
EP2551071A4 (en) 2010-03-24 2015-05-06 Yaskawa Denki Seisakusho Kk ROBOTIC HAND AND ROBOT DEVICE
WO2012039479A1 (ja) 2010-09-24 2012-03-29 国立大学法人岐阜大学 人間型電動ハンド
JP5672219B2 (ja) * 2011-11-25 2015-02-18 トヨタ自動車株式会社 ロボットの関節機構及びロボット
CN102672714B (zh) * 2012-03-21 2014-05-21 天津大学 高刚度高精度五坐标并联动力头
TWI537535B (zh) * 2013-11-08 2016-06-11 國立交通大學 追日機構
JP6104876B2 (ja) * 2014-11-28 2017-03-29 Thk株式会社 ロボットにおけるロール回転構造
WO2016159901A1 (en) * 2015-04-03 2016-10-06 Akcali Ibrahim Deniz Lambda fixator
CN108291618A (zh) * 2015-12-03 2018-07-17 川崎重工业株式会社 2个自由度的驱动机构
CN112873266B (zh) * 2021-01-22 2022-05-17 北京理工大学 仿人机器人及其二自由度模块化仿人机器人关节

Also Published As

Publication number Publication date
JPWO2019208652A1 (ja) 2021-04-22
US20210162602A1 (en) 2021-06-03
US12103160B2 (en) 2024-10-01
WO2019208652A1 (ja) 2019-10-31

Similar Documents

Publication Publication Date Title
JP6590064B2 (ja) ロボット
JP6903229B2 (ja) 回転接続機構、ロボットおよびロボットアーム
Zeiaee et al. Design and kinematic analysis of a novel upper limb exoskeleton for rehabilitation of stroke patients
Mao et al. Human movement training with a cable driven arm exoskeleton (CAREX)
CN105640739B (zh) 一种基于空间重力平衡的上肢康复外骨骼
US20190201273A1 (en) Robotic upper limb rehabilitation device
Sugar et al. Design and control of RUPERT: a device for robotic upper extremity repetitive therapy
Brackbill et al. Dynamics and control of a 4-dof wearable cable-driven upper arm exoskeleton
US20220193890A1 (en) Spherical mechanism constructed with scissors linkages with control means
WO2017167349A1 (en) Spherical joint mechanism with a double parallelogram mechanism
Mao et al. Transition from mechanical arm to human arm with CAREX: A cable driven ARm EXoskeleton (CAREX) for neural rehabilitation
JP2018001385A (ja) パラレルリンク装置、産業用ロボット、及び力覚提示装置
Dehez et al. ShouldeRO, an alignment-free two-DOF rehabilitation robot for the shoulder complex
CN107050763A (zh) 一种新型踝关节康复机器人其控制方法
CN109015605A (zh) 穿戴式变构型外肢体机器人
CN110787024B (zh) 一种采用无动力补偿关节的肩关节康复外骨骼机构
JP7328125B2 (ja) ウェアラブル装置の結合構造
Xu et al. A pilot investigation of continuum robots as a design alternative for upper extremity exoskeletons
Cai et al. Dual-Arm Upper Limb Rehabilitation Robot: Mechanism Design and Preliminary Experiments
Mustafa et al. Development of a bio-inspired wrist prosthesis
Lingampally et al. Head/neck mechanisms for humanoid robots-A survey
Hsieh et al. Dimensional synthesis of a lightweight shoulder exoskeleton
Niyetkaliyev et al. A hybrid multi-joint robotic shoulder exoskeleton for stroke rehabilitation
US20240367312A1 (en) Robot
Trotobas et al. The Kinematic Synthesis of a Spherical Mechanism for Assisting in Wrist Pronation and Supination

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20201023

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20201023

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20210525

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20210622

R150 Certificate of patent or registration of utility model

Ref document number: 6903229

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250