JP4532919B2 - Walking robot - Google Patents
Walking robot Download PDFInfo
- Publication number
- JP4532919B2 JP4532919B2 JP2004024199A JP2004024199A JP4532919B2 JP 4532919 B2 JP4532919 B2 JP 4532919B2 JP 2004024199 A JP2004024199 A JP 2004024199A JP 2004024199 A JP2004024199 A JP 2004024199A JP 4532919 B2 JP4532919 B2 JP 4532919B2
- Authority
- JP
- Japan
- Prior art keywords
- walking robot
- walking
- contact portion
- ground contact
- road surface
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Manipulator (AREA)
Description
本発明は、少なくとも二本の脚を有し、該脚により歩行運動が可能な歩行ロボットに関する。 The present invention relates to a walking robot having at least two legs and capable of walking motion with the legs.
従来、歩行ロボットの脚部構造としては、ひと固まりの剛体となって接地するものが多く、現在歩行ロボットの形として人々が目にできるものは、この構造のものに限られている。しかし、試験的に提案されたものには、複数の部分に脚部が分割され、互いに相対運動できるものもある。例えば、歩行ロボットの脚部において、ヒトの爪先を模した関節を備える技術が示されている(例えば、特許文献1を参照。)。この脚部構造を有する歩行ロボットにおいては、胴体部に収納したモータの出力を、フレキシブルワイヤーを介して当該爪先関節に接続し、爪先を駆動するものである。 Conventionally, there are many leg structures of walking robots that are grounded as a group of rigid bodies, and what can be seen by people as the shape of walking robots is limited to this structure. However, some of the experimentally proposed ones have legs divided into a plurality of parts and can move relative to each other. For example, a technique of providing a joint imitating a human toe at a leg portion of a walking robot is disclosed (see, for example, Patent Document 1). In the walking robot having this leg structure, the output of the motor housed in the body is connected to the toe joint via a flexible wire to drive the toe.
また、別の脚部構造については、脚部の接地面積を変更可能とする脚部構造が開示されている(例えば、特許文献2を参照。)。この脚部構造を有する歩行ロボットにおいては、歩行ロボットの安定性の向上を図るために、歩行の場所に応じて脚部の接地面積を変える。しかし、容量の小さなモータを大きな減速比を持つ減速機を介して、該モータの駆動力を脚部に伝えて接地面積を変更している。そのため、脚部の接地面積の変更に長い時間を要する。 Moreover, about another leg part structure, the leg part structure which can change the contact area of a leg part is disclosed (for example, refer patent document 2). In a walking robot having this leg structure, the contact area of the leg is changed according to the place of walking in order to improve the stability of the walking robot. However, a ground contact area is changed by transmitting a driving force of a motor having a small capacity to a leg through a reduction gear having a large reduction ratio. Therefore, it takes a long time to change the contact area of the legs.
また、歩行ロボットの向きを変更するために、歩行ロボットの脚部に受動的に動く脚関節を脚部先端に設けて、脚部を駆動することで当該関節が曲がり、形の上で爪先立ちを実現しようとした技術が開示されている(例えば、特許文献3を参照。)。この脚部構造を有する歩行ロボットにおいては、従来から行われている歩行ロボットの脚踏み動作による向き変更よりも、該変更に要する所要時間が少ないため、向き変更に要するエネルギー消費も減少することがうたわれている。
歩行ロボットに対する何らかの要求に対して歩行ロボットの高さを増加させる必要がある場合、歩行路面と接地する脚部において設けられた爪先部をワイヤによって駆動することで、歩行ロボットの高さを増加させようとすると、ワイヤにより歩行ロボットの剛性が低下するとともに、歩行ロボットの高さを増加させるために必要な駆動力を爪先部に十分に伝達させるのが困難である。 When it is necessary to increase the height of the walking robot in response to some demands on the walking robot, the height of the walking robot is increased by driving the toe portion provided on the leg that contacts the walking road surface with a wire. If it does so, while the rigidity of a walking robot will fall with a wire, it will be difficult to fully transmit the driving force required in order to increase the height of a walking robot to a toe part.
また、歩行ロボットの爪先部を駆動して歩行ロボットの高さを増加させる場合、アクチュエータであるモータが該爪先部を駆動するために要する消費エネルギーを低下させるべく、該モータの容量を小さくし且つ高減速比の減速機を介して爪先部に駆動力を伝達しようとすると、歩行ロボットの高さを変更するために要する時間が長くなる虞がある。また
、減速機を介することで爪先部への伝達効率が低下するため、モータによる消費エネルギーが却って増加する。
Further, when the toe part of the walking robot is driven to increase the height of the walking robot, the motor capacity is reduced to reduce the energy consumption required for the motor as an actuator to drive the toe part, and If it is attempted to transmit the driving force to the toe portion via the reduction gear having a high reduction ratio, the time required for changing the height of the walking robot may be increased. Moreover, since the transmission efficiency to a toe | tip part falls by passing through a reduction gear, the energy consumption by a motor increases on the contrary.
本発明では、上記した問題に鑑み、より簡易な構造によって歩行ロボットの体重を支えるとともに歩行ロボットを所望の高さとする脚部を有する歩行ロボットを提供し、更には該歩行ロボットの高さの変更に要する消費エネルギーを抑制することを目的とする。 In view of the above problems, the present invention provides a walking robot having legs that support the weight of the walking robot with a simpler structure and have the walking robot at a desired height, and further changes the height of the walking robot. The purpose is to reduce the energy consumption required.
本発明においては、上記した課題を解決するために、複数のリンク部材と該リンク部材の各々を連結する関節部とで構成される脚を少なくとも二本有し、該脚の駆動により歩行を行う歩行ロボットにおいて、前記脚の先端には歩行路面と接地する第一接地部位と第二接地部位とを有する脚先部が設けられ、更に、前記第一接地部位と前記第二接地部位とのうち一方を他方に対して前記歩行路面に向けて突出する方向に相対的に移動させることで、前記歩行ロボットの高さを増加する歩行ロボット高さ調整手段を備える。 In order to solve the above-described problems, the present invention has at least two legs each composed of a plurality of link members and joint portions connecting the link members, and walks by driving the legs. In the walking robot, a leg tip portion having a first grounding portion and a second grounding portion that are in contact with the walking road surface is provided at a tip of the leg, and further, out of the first grounding portion and the second grounding portion. A walking robot height adjusting means is provided for increasing the height of the walking robot by moving one of them relative to the other in a direction protruding toward the walking road surface.
即ち、歩行ロボットの重量を支える脚において、歩行路面と接地する脚先部を、第一接地部位と第二接地部位の二つの接地部位で構成するものである。この脚先部は、人間でたとえるならば足首から足指先までの部位に該当する。そして、この第一接地部位と第二接地部位とのうち一方を歩行路面に突出させるように相対的に移動させることで、換言すると、例えば前記一方の接地部位を歩行路面に対して垂直となる方向に相対的に移動させることで、第一接地部位と第二接地部位との間に段差が生じる。そして、その生じた段差が、歩行ロボットの高さの増加量に反映される。 That is, in the leg that supports the weight of the walking robot, the leg tip portion that comes into contact with the walking road surface is constituted by two ground contact portions, a first ground contact portion and a second ground contact portion. This leg tip corresponds to a part from the ankle to the tip of the toe if compared with a human. Then, by moving relatively one of the first ground contact portion and the second ground contact portion so as to protrude on the walking road surface, in other words, for example, the one ground contact portion is perpendicular to the walking road surface. By relatively moving in the direction, a step is generated between the first ground contact portion and the second ground contact portion. And the level | step difference which arises is reflected in the increase amount of the height of a walking robot.
よって、上述の技術は、第一接地部位と第二接地部位とを上記の所定の方向に、いわば直線的に相対移動させることで、歩行ロボットの高さにオフセットを与えて、その高さを増加させる技術である。そのため、歩行ロボットの高さを変更している最中であっても、歩行ロボットの重心はそのまま上昇するだけで重心が揺れて不安定となる虞は少ない。従って、歩行ロボットを構成するその他の関節やリンク機構を制御して、歩行ロボットの重心を安定化させる必要性が低くなり、その安定化に要する消費エネルギーを抑制し得る。 Therefore, the above-described technique gives an offset to the height of the walking robot by moving the first ground contact portion and the second ground contact portion relative to each other in the predetermined direction, that is, linearly, so that the height is increased. It is a technology to increase. Therefore, even when the height of the walking robot is being changed, the center of gravity of the walking robot simply rises as it is, and there is little possibility that the center of gravity shakes and becomes unstable. Therefore, the necessity of stabilizing the center of gravity of the walking robot by controlling other joints and link mechanisms constituting the walking robot is reduced, and energy consumption required for the stabilization can be suppressed.
そして、第一接地部位と第二接地部位とを上述した相対移動をさせるという、比較的簡潔な構成によって歩行ロボットの高さを増加させることが可能となる。尚、第一接地部位と第二接地部位との間に生じている段差を解消する方向に、両者を相対移動させることで、歩行ロボットの高さを減少させることも可能である。 The height of the walking robot can be increased with a relatively simple configuration in which the first ground contact portion and the second ground contact portion are moved relative to each other as described above. In addition, it is also possible to reduce the height of the walking robot by moving both of them relative to each other in a direction to eliminate the step generated between the first ground contact portion and the second ground contact portion.
より詳細には、上述の歩行ロボットにおいて、前記歩行ロボット高さ調整手段は、前記第一接地部位を前記第二接地部位に対して前記歩行路面に向けて突出する方向に相対移動させることで、該第一接地部位を該歩行路面と接地し且つ該第二接地部位を該歩行路面から離れている状態として該歩行ロボットの高さを増加するようにしてもよい。従って、歩行ロボットの高さが増加されているときは、脚先部の中でも第一接地部位のみが歩行路面に接地している。 More specifically, in the above-described walking robot, the walking robot height adjusting means moves the first ground contact portion relative to the second ground contact portion in a direction protruding toward the walking road surface, The height of the walking robot may be increased with the first ground contact portion being in contact with the walking road surface and the second ground contact portion being separated from the walking road surface. Therefore, when the height of the walking robot is increased, only the first ground contact portion is in contact with the walking road surface among the leg tips.
このとき、前記第一接地部位は、前記脚と前記脚先部との連結部位に設けられているようにしてもよい。脚と脚先部との連結部位は、歩行ロボットの重量が集中的に加わる部位である。従って、歩行ロボットの高さを増加して第一接地部位のみが歩行路面に接地しているときは、第一接地部位に歩行ロボットの重量が加わるようにすることで、歩行ロボットを安定的に支え、その転倒等を防止することが可能となる。 At this time, the first ground contact portion may be provided at a connection portion between the leg and the leg tip portion. The connecting part between the leg and the leg tip part is a part where the weight of the walking robot is added intensively. Accordingly, when the height of the walking robot is increased and only the first ground contact portion is in contact with the walking road surface, the weight of the walking robot is added to the first ground contact portion so that the walking robot can be stably It is possible to support and prevent the fall or the like.
ここで、上述までの歩行ロボットにおいて、第一接地部位と第二接地部位との相対移動を行うアクチュエータとして、歩行ロボットに備えられた第一接地部位と第二接地部位と
の何れかに流体による流体圧を供給する流体圧供給手段を用いてもよい。そして、前記歩行ロボット高さ調整手段は、前記流体圧供給手段から供給される流体圧によって、前記歩行路面に向けて突出する方向における前記第一接地部位と前記第二接地部位との相対移動を行う。ここで、流体圧としては、空気圧や油圧等が例示できる。
Here, in the walking robot up to the above, as an actuator for performing relative movement between the first ground contact portion and the second ground contact portion, either the first ground contact portion or the second ground contact portion provided in the walking robot is fluidized. A fluid pressure supply means for supplying fluid pressure may be used. The walking robot height adjusting means performs relative movement between the first ground contact portion and the second ground contact portion in a direction protruding toward the walking road surface by the fluid pressure supplied from the fluid pressure supply means. Do. Here, examples of the fluid pressure include air pressure and hydraulic pressure.
このように構成される歩行ロボットにおいては、流体圧によるアクチュエータである流体圧供給手段を用いるため、歩行ロボット高さの調整に際しては第一接地部位又は第二接地部位にかかる流体圧を調整すればよい。そのため、一般に広く使われるモータによる歩行ロボットの高さ調整と比べて、アクチュエータ自身の重量が軽減される。特に、流体として空気等の気体を用いると、アクチュエータの重量はより軽減される。更には、歩行ロボットの高さを増加させた後の歩行ロボットの姿勢保持においては、流体圧を利用する場合には、該流体圧を一定にするために流体の流れを停止するという比較的簡易な構成で実現が可能である。即ち、一度ロボットの高さを増加させた後は停止した流体において漏れがない限り流体を改めて供給する必要はなく、従ってエネルギーの消費が少ない。一方で、モータをアクチュエータとして利用する場合には、モータが常にトルクを発生すべくモータへの電流の供給を継続する必要がある。以上より、消費エネルギーの観点からも、流体圧供給手段による第一接地部位と第二接地部位との相対移動がより好適である。 Since the walking robot configured as described above uses fluid pressure supply means that is an actuator based on fluid pressure, when adjusting the height of the walking robot, the fluid pressure applied to the first ground contact portion or the second ground contact portion may be adjusted. Good. Therefore, the weight of the actuator itself is reduced as compared with the height adjustment of a walking robot using a motor that is generally widely used. In particular, when a gas such as air is used as the fluid, the weight of the actuator is further reduced. Further, in maintaining the posture of the walking robot after increasing the height of the walking robot, when using the fluid pressure, the flow of the fluid is stopped relatively easily in order to keep the fluid pressure constant. This can be realized with a simple configuration. In other words, once the height of the robot is increased, it is not necessary to supply the fluid again unless there is a leak in the stopped fluid, so that energy consumption is low. On the other hand, when a motor is used as an actuator, it is necessary to continue supplying current to the motor so that the motor always generates torque. From the above, also from the viewpoint of energy consumption, relative movement between the first ground contact portion and the second ground contact portion by the fluid pressure supply means is more preferable.
また、歩行ロボットの高さが増加されるとき第一接地部位が歩行路面に接地する場合において、脚先部における歩行路面との接地面積が、第一接地部位と第二接地部位とが接地する接地面積から第一接地部位のみが接地する接地面積へと減少する。従って、歩行ロボットの高さが増加されるとき、歩行路面との接地面積の減少により、歩行ロボットの姿勢の安定性が低下する虞がある。 When the height of the walking robot is increased and the first ground contact portion contacts the walking road surface, the ground contact area between the leg tip portion and the walking road surface is grounded between the first ground contact portion and the second ground contact portion. The ground contact area is reduced to the ground contact area where only the first ground contact portion is grounded. Therefore, when the height of the walking robot is increased, the posture stability of the walking robot may be reduced due to a decrease in the contact area with the walking road surface.
そこで、上述の歩行ロボットにおいて前記歩行ロボット高さ調整手段によって前記歩行ロボットの高さが増加される場合において該歩行ロボットの重心が存在すべき領域であって前記第一接地部位と前記歩行路面との位置関係によって決定される安定領域に該歩行ロボットの重心位置を制御する重心制御手段を、更に備える場合、前記重心制御手段によって前記歩行ロボットの重心位置を前記安定領域に属させた後に、前記歩行ロボット高さ調整手段による該歩行ロボットの高さを増加してもよい。 Therefore, in the above-described walking robot, when the height of the walking robot is increased by the walking robot height adjusting means, the center of gravity of the walking robot should exist, and the first ground contact portion, the walking road surface, When the center of gravity control means for controlling the center of gravity position of the walking robot is further provided in the stable region determined by the positional relationship, the center of gravity position of the walking robot belongs to the stable region by the center of gravity control means, The height of the walking robot may be increased by the walking robot height adjusting means.
即ち、歩行ロボット高さ調整手段による歩行ロボットの高さの増加は、歩行ロボットの重心が上述の所定の安定領域に属するようにされた後において行われることで、歩行路面との接地部位面積の減少による姿勢の不安定化を回避することが可能となる。ここで、上述の安定領域は、歩行ロボットの有する脚の状態、即ち、歩行路面に対して歩行ロボットが脚によってどのように支えられているかによって決定される。例えば、歩行ロボットの有する脚の数が増加するに従いそれによる安定領域は拡大し、また、歩行ロボットの有する脚が歩行ロボットの本体に対して遠い位置で歩行路面と接地している場合にも安定領域は拡大する。 That is, the increase in the height of the walking robot by the walking robot height adjusting means is performed after the center of gravity of the walking robot is made to belong to the above-described predetermined stable region, so that the ground contact area with the walking road surface is increased. It becomes possible to avoid posture instability due to the decrease. Here, the above-described stable region is determined by the state of the legs of the walking robot, that is, how the walking robot is supported by the legs with respect to the walking road surface. For example, as the number of legs of the walking robot increases, the stable area due to this increases, and it is also stable when the legs of the walking robot are in contact with the walking road surface at a position far from the body of the walking robot. The area expands.
ここで、歩行ロボットの高さが増加されるとき第一接地部位が歩行路面に接地する場合において、該歩行ロボットを次のように構成することで、該歩行ロボットの向きをより容易に、変更することが可能である。即ち、前記第一接地部位は、前記脚先部に設けられた回転軸の軸周りに回転自在であり、前記歩行ロボット高さ調整手段によって前記第一接地部位を前記歩行路面と接地し且つ前記第二接地部位を該歩行路面から離れている状態とした後、前記第一接地部位を該歩行路面に接地した状態で前記回転軸を中心として前記歩行ロボットの向きを回転変更する歩行ロボット向き変更手段を、更に備えるようにしてもよい。 Here, when the height of the walking robot is increased, when the first ground contact portion contacts the walking road surface, the direction of the walking robot can be changed more easily by configuring the walking robot as follows. Is possible. That is, the first ground contact portion is rotatable around an axis of a rotation shaft provided at the leg tip portion, the first ground contact portion is grounded to the walking road surface by the walking robot height adjusting means, and Changing the direction of the walking robot to change the direction of the walking robot around the rotation axis in a state where the second grounding part is separated from the walking road surface and the first grounding part is grounded to the walking road surface A means may be further provided.
このように歩行ロボットの脚に設けられた第一接地部位が回転軸周りに回転することで
、歩行ロボットが第一接地部位を介して脚が歩行路面に接地している状態で、歩行ロボットの向きを変更することが可能となる。その結果、歩行ロボットの姿勢の安定性を低下させることなく、より確実に歩行ロボットの向きを所望の向きに変更することが可能となる。また、従来のように、足踏み動作を繰り返して向きを変更する場合と比べて、きわめて短時間で歩行ロボットの向きを変更することが可能となる。
In this way, the first grounding portion provided on the leg of the walking robot rotates around the rotation axis, so that the walking robot is in a state where the leg is in contact with the walking road surface via the first grounding portion. It becomes possible to change the direction. As a result, it is possible to change the direction of the walking robot to a desired direction more reliably without reducing the stability of the posture of the walking robot. In addition, the direction of the walking robot can be changed in a very short time as compared with the conventional case where the direction is changed by repeating the stepping action.
尚、前記回転軸の軸方向は、前記第一接地部位が前記歩行路面に向けて突出する方向と略同一であるのが好ましい。このようにすることで、歩行ロボットの向きを変更する際の歩行ロボットの姿勢の安定性の低下をより確実に抑制し得る。 The axial direction of the rotating shaft is preferably substantially the same as the direction in which the first ground contact portion protrudes toward the walking road surface. By doing in this way, the fall of the stability of the posture of a walking robot at the time of changing the direction of a walking robot can be suppressed more reliably.
また、上述の歩行ロボットにおいて、前記歩行ロボット向き変更手段は、前記第一接地部位を有する少なくとも二本の脚において、各第一接地部位が前記歩行路面に接地した状態での該各第一接地部位における荷重中心によって決定される一の仮想円に沿った同一の回転方向に、該脚に駆動力を与えることで、前記回転軸を中心として前記歩行ロボットの向きを変更してもよい。 Further, in the above-described walking robot, the walking robot orientation changing means may be configured such that each of the first grounding portions in a state where each first grounding portion is in contact with the walking road surface in at least two legs having the first grounding portion. The direction of the walking robot may be changed around the rotation axis by applying a driving force to the leg in the same rotation direction along one virtual circle determined by the load center at the site.
即ち、少なくとも二本の脚によって歩行ロボットが支えられている状態において、該歩行ロボットの高さが増加されて第一接地部位のみが歩行路面に接地しているとき、該脚に対して上述の方向に駆動力を与えると、第一接地部位と歩行路面との間の摩擦力によって第一接地部位と歩行路面との相対位置は変化せずに、駆動力の反力によって第一接地部位が回転軸を中心として回転する。これにより、歩行ロボットの向きが変更される。また、同一の仮想円とは、歩行ロボットの各脚の第一接地部位に加わる荷重の中心を含む仮想円である。この仮想円に沿った方向に脚に駆動力を与えることで、歩行ロボットの向きが変更されるときの該歩行ロボットの重心が大きく変動して姿勢が不安定となるのを可及的に抑制し得る。 That is, when the walking robot is supported by at least two legs, when the height of the walking robot is increased and only the first ground contact portion is in contact with the walking road surface, When the driving force is applied in the direction, the relative position between the first ground contact portion and the walking road surface does not change due to the frictional force between the first ground contact portion and the walking road surface, and the first ground contact portion is moved by the reaction force of the driving force. It rotates around the rotation axis. Thereby, the direction of the walking robot is changed. The same virtual circle is a virtual circle including the center of the load applied to the first ground contact portion of each leg of the walking robot. By applying a driving force to the legs in the direction along the virtual circle, it is possible to suppress as much as possible that the center of gravity of the walking robot greatly changes and the posture becomes unstable when the direction of the walking robot is changed. Can do.
また、上述のように向きを変更する歩行ロボットにおいて、前記第一接地部位が前記回転軸を中心として回転するとき該第一接地部位が前記脚先部と接触部を有する場合、該接触部における摩擦力が略一定であるようにしてもよい。このように構成することで、歩行ロボットの向きが変更されるときに要する消費エネルギーは、歩行路面の状態に拘わらずほぼ一定となり、消費エネルギーの悪化を抑制し得る。 In the walking robot that changes the direction as described above, when the first ground contact portion rotates around the rotation axis, the first ground contact portion includes the leg tip portion and the contact portion. The frictional force may be substantially constant. With this configuration, the energy consumption required when the direction of the walking robot is changed is substantially constant regardless of the state of the walking road surface, and deterioration of the energy consumption can be suppressed.
更に、上記の問題点を鑑みて、本発明において、複数のリンク部材と該リンク部材の各々を連結する関節部とで構成される脚を少なくとも二本有し、該脚の駆動により歩行を行う歩行ロボットにおいて、前記関節部のうち少なくとも一の関節部は、前記歩行ロボットの高さを増加させる方向に該関節部に連結されるリンク部材を相対移動させるロボット高さ増加用関節部であり、前記ロボット高さ増加用関節部は、流体による流体圧を動力源として前記リンク部材の相対移動を行う。 Furthermore, in view of the above problems, the present invention has at least two legs each composed of a plurality of link members and joint portions connecting the link members, and walks by driving the legs. In the walking robot, at least one of the joints is a robot height increasing joint that relatively moves a link member connected to the joint in a direction that increases the height of the walking robot. The robot height increasing joint performs relative movement of the link member using fluid pressure generated by a fluid as a power source.
即ち、歩行ロボットの高さを増加する際に、脚の関節部の少なくとも一の関節部がロボット高さ増加用関節部として作用することで、歩行ロボットの高さをオフセット的に増加することが可能となる。このように歩行ロボットの高さを増加することで、歩行ロボットの重心が変動する量が少なくなり、歩行ロボットのバランスを調整するためにロボット高さ増加用関節部以外の関節部が駆動される必要性が低くなり、高さ変更時における消費エネルギー量を抑制し得る。特に、ロボット高さ増加用関節部以外の関節部が、主に電気エネルギーを動力源とするモータによって構成されるときは、高さ変更時における消費エネルギー量の抑制が顕著となる。そして、先述したようにロボット高さ増加用関節部の動力源として流体圧とすることで、歩行ロボットの高さ変更後の姿勢保持の場合を含めて、高さ変更に要する消費エネルギーを更に抑制し得る。 That is, when the height of the walking robot is increased, the height of the walking robot can be increased in an offset manner by at least one of the joints of the legs acting as a robot height increasing joint. It becomes possible. By increasing the height of the walking robot in this manner, the amount by which the center of gravity of the walking robot fluctuates decreases, and joints other than the robot height increasing joint are driven to adjust the balance of the walking robot. The necessity becomes low, and the amount of energy consumed when changing the height can be suppressed. In particular, when the joints other than the robot height increasing joint are configured by a motor that mainly uses electric energy as a power source, the amount of energy consumption during the height change becomes significant. And, as mentioned above, by using fluid pressure as the power source of the joint for increasing the robot height, the energy consumption required for the height change is further suppressed, including the case of holding the posture after the height change of the walking robot. Can do.
より簡易な構造によって歩行ロボットの体重を支えるとともに歩行ロボットを所望の高さとする脚部を有する歩行ロボットを提供し、更には該歩行ロボットの高さの変更に要する消費エネルギーを抑制することが可能となる。 It is possible to provide a walking robot that has a leg that makes the walking robot a desired height while supporting the weight of the walking robot with a simpler structure, and can further reduce energy consumption required for changing the height of the walking robot It becomes.
ここで、本発明に係る歩行ロボットの実施の形態について図面に基づいて説明する。 Here, an embodiment of a walking robot according to the present invention will be described with reference to the drawings.
図1に本発明を適用するのに適した2本の脚を有する歩行ロボット1の下半身の概略的な骨格図を示す。図1において、歩行ロボット1は左右それぞれの脚に6ケの関節を備える。当該6ケの関節は上から順に、脚部回転用の関節10、股関節部のピッチ方向の関節12、同ロール方向の関節14、膝関節部のピッチ方向の関節16、足関節部のピッチ方向の関節18、同ロール方向の関節20となっており、その下部には脚先部24が備えられる。
FIG. 1 shows a schematic skeleton diagram of the lower half of a walking
また、下半身の最上部には人体の骨盤に相当する腰板リンク26が用意される。腰板リンク26には関節の制御に必要な電源やアンプ(増幅器)、及び本発明に関係する蓄圧タンク90等が搭載されている。ここで、蓄圧タンク90は、歩行ロボット1が本発明における背伸び動作を行うための動力源である高圧空気を貯留するためのタンクである。蓄圧タンク90に貯留されている高圧空気の供給については、後述する。
A
右脚と左脚とは鏡像の関係にあり、対称形状である。各々の番号の次のL、Rの文字はそれぞれ左、右を意味するもので、それ以外の意味はない。そして、以下において、例えば関節10L/Rと記載されるときは、左右両側の関節10Lと10Rを表すものとし、また、例えば関節10と表す場合と、関節10L/Rと表す場合とでは、その表現において差はない。股関節は図示のように3つの関節10、12、14から構成されており、股関節と膝関節との結合には大腿リンク30が用意され、また足関節も図示のように2つ関節18、20から構成されており、足関節と膝関節との結合にはスネリンク32が用意される。
The right leg and the left leg are mirror images and have a symmetrical shape. The letters L and R next to each number mean left and right, respectively, and have no other meaning. In the following description, for example, when it is described as joint 10L / R, it represents
ここで、足関節に接続される脚先部24L/Rには、本発明に係る歩行ロボット1の高さを増加させる動作(以下、「背伸び動作」という)を行う関節50R、50Lが設けられている。関節50L/Rは後述するように直線運動を行うタイプの関節であり、図1に示す他の関節10L/R等が回転式の関節であるのに対して、明確な違いがある。また、関節50L/Rにおいても、両脚の足部に鏡像の関係で同じ形式の関節が設けられている。
Here, joints 50R and 50L that perform an operation of increasing the height of the walking
ここで、図2には、背伸び動作用の関節50の構造が詳細に示されている。脚先部24には、蓄圧タンク90から供給される圧縮空気の空気圧によって駆動されるピストン52を一定方向に移動自在に収納するシリンダー54が設けられる。シリンダー54は異なる2つの直径からなり、空気圧を導き入れる圧力室56を形成している。またピストン52は、回り止めピン58によってシリンダー54に対して相対回転が阻止されている。その結果、ピストン52は図2における上下方向にのみ、空気圧によって移動させられる。尚、以下の記載にて上下と方向が示されるときは、各図における上下方向を意味する。また、ピストン52の上部空間60は大気開放になっており、その結果少ない圧縮空気の消費で所望の上下運動が実現できる構造となっている。
Here, FIG. 2 shows in detail the structure of the joint 50 for back extension operation. The
ここで、ピストン52の中心部には上下を貫通する形で回転軸62が配置されている。回転軸62の下側には、直接歩行路面と接地する第一接地部位66が回転軸62回りに回
転自在に支持されている。また、脚先部24の先端には第一接地部位66とは独立して歩行路面に接地する第二接地部位64が設けられている。尚、第二接地部位64は脚先部24側に固定されている。ここで、ピストン52が図示位置にあるとき、即ちピストン52が最上位置にあるときは、これら第一、第二接地部位は実質的に同じ面となるように設計されている。
Here, a
このように、ピストン52がシリンダー54の中において上下に移動することで、第一接地部位66が第二接地部位64より突出する方向に移動する。その結果、ピストン52が下方向に移動すると、第一接地部位66が歩行路面と接地した状態となり、且つ第二接地部位64は歩行路面と接地していない状態となる。その結果、第一接地部位66と第二接地部位との間に段差δが生じ、その段差δが歩行ロボット1の高さ変化量として現れる。尚、図2に示される状態では、段差δは零である。
In this manner, the
また、第一、第二接地部位は、路面と良く馴染むように、比較的柔らかい弾性材65、67が接着剤によってその接地表面に貼りつけられている。更に、第一接地部位66とピストン52との間には、両者の間の滑りを良くする目的で、ドーナツ状の形状をした低摩擦係数を持つ第一樹脂板70が装着され、同時に第一接地部位66と第二接地部位64との間にはドーナツ状の形状をした比較的高い摩擦係数を持つ第二樹脂板72が装着されている。
In addition, the first and second ground contact portions have relatively soft
回転軸62の上部には、ピストン52が空気圧によって下降したあと、空気圧が除去された場合に、速やかに図示の最上位置に復帰するために、リターンスプリング80が用意されている。リターンスプリング80によって図示の最上位置にピストンが復帰したときは、第二樹脂板72がストッパーとなり、第一樹脂板70は除荷されるような寸法となっているものとする。即ち、第一樹脂板70の厚さは、第二樹脂板72の厚さより僅かに薄い寸法である。
A
また、図2に示す82は図1に示した足関節ロール用関節20L/Rを駆動するモータであり、図2に示す84はモータ82の出力を減速して増力する減速機を収納した部分、図2に示す76は足関節のピッチ関節18L/Rを収納するカバーである。 2 is a motor that drives the ankle roll joint 20L / R shown in FIG. 1, and 84 shown in FIG. 2 is a portion that houses a reduction gear that decelerates the output of the motor 82 to increase its power. 2 is a cover for accommodating the pitch joint 18L / R of the ankle joint.
次に、図3には、背伸び動作を行うための関節50L/Rにおける空気圧制御を行う空気圧制御回路が示されている。蓄圧タンク90には逆止弁91を介して高圧空気が注入されており、その空気圧を減圧弁92で所望のレベルに減圧する。そして、電磁弁94の開弁によって、高圧空気がピストン52L/Rを押し下げるように圧力室56L/Rに導かれる。この電磁弁94は通電時には、図3に示す左側の回路構成となることで、減圧弁92の出力を圧力室56L/Rに導くが、通電が停止されると図示の回路構成となることで、圧力室56を大気に連通する。このような電磁弁94は通常使用されるものであって、広く市販されている。例示の電磁弁は、パイロット弁として売られているもので、通電時の消費電力が僅かに0.5Wの電磁弁である。
Next, FIG. 3 shows an air pressure control circuit for performing air pressure control at the joint 50L / R for performing the back extension operation. High pressure air is injected into the
また、図4には上述の電磁弁94や歩行ロボット1の関節のアクチュエータであるモータ等から構成される制御装置の概略構成が示されている。CPU(中央演算装置)100は歩行ロボット1の脚運動を決める歩容データを収めてあるメモリ102にアクセスして歩容データを読み取り、更に後述する現在の各関節の関節角度値、関節角速度値を読み取る。その後、後述する演算式によりモータ106が発揮すべきモータトルクを計算して、このモータトルクを指令値としてアンプ(増幅器)104に送る。アンプ104はこの指令値から電流値を算出、決定してモータ106を駆動する。モータ106が駆動されると関節は角度を変えるから、その角度を適切なセンサ(角度計)108で読み取り、角度情報としてCPU100に送る。
FIG. 4 shows a schematic configuration of a control device including the above-described
図4でアンプ104やモータ106、角度計108は本実施例の場合は関節の数に応じた数、即ちそれぞれ12ケずつ存在するが、図面においては説明の簡素化のために3つだけが模式的に描かれている。尚、歩容データの様式は、この実施例では予め算出された各関節角度の時系列データの形で収納されているものとする。その一例は、例えば特開平4-201187の第六図に詳細に開示されている。尚、CPU100による電磁弁94の制御については後述する。
In FIG. 4, there are twelve
次に、第5図には、歩行ロボット1が背伸び動作を行うときの重心管理を示している。図5は歩行ロボット1をその上方から見たもので、歩行ロボット1が右脚に対して左脚を少し前に開いて立っている状態を示す。概ね矩形で描かれた2つの脚先部24L/Rと、この脚先部24L/Rを包む六角形の包絡線120が作る第二安定領域Aと、空気圧を送られた場合に歩行路面と接地する2つの円形で描かれた第一接地部位66L/Rと第一接地部位66L/Rを包む楕円形の包絡線122が作る第一安定領域Bとが図示されている。尚、第一安定領域Bと第二安定領域Aは、歩行路面上の平面である。
Next, FIG. 5 shows the center-of-gravity management when the walking
図5中、黒丸の点124は歩行ロボット1の重心から下ろした鉛直線が歩行路面と交わる点である。空気圧がピストン52に送られていない状態では、脚先部24L/R全体が接地しているため、この点124が第二安定領域Aにあるとき歩行ロボット1の姿勢は安定している。つまり、必ずしも点124が第一安定領域Bに属する必要はない。これに対して空気圧がピストン52に送られているときは、第一接地部位66L/Rのみが歩行路面と接地しているから、点124が第一安定領域Bにある場合のみ歩行ロボット1の姿勢が安定となり得る。一方で、点124が第一安定領域Bを除く第二安定領域Aに属するときは、歩行ロボット1は転倒する虞が高い。
In FIG. 5, a
そこで、背伸び動作を行うにあたり、先ず歩行ロボット1の重心位置によって決定される点124が第一安定領域Bに属するように、歩行ロボット1の各関節10、12、14、16、18、20を制御する必要がある。望ましくは左右にある第一接地部位66L/Rに概ね同じ荷重がかかるように、点124を、第一接地部位66L/Rの中央点126Rと126Lとを結ぶ直線の中央点の近傍とする。このようにすることで、左右にある第一接地部位66L/Rに概ね同じ荷重がかかるとともに点124が第一安定領域Bに属するため、背伸び動作時において歩行ロボット1の姿勢を可及的に安定化することが可能となる。
Therefore, when performing the back stretching operation, first, each joint 10, 12, 14, 16, 18, 20 of the walking
ここで、点124が第一安定領域Bに属するようになった後は、空気圧をピストン52に送り、第一接地部位66L/Rを第二接地部位64L/Rに対して下方に、即ち歩行路面の方向に延ばす。このようにすることで、歩行ロボット1は背伸び状態となって歩行ロボット1の高さが増加し、高い場所に置かれたものをセンサにより検出したり、本実施例では省かれている歩行ロボット1の上腕が高い場所にも届くようになったりする。即ち、背伸び動作は第一接地部位66L/Rと第二接地部位64L/Rの直線的な相対移動によるものであるから、上述の重心管理が行われた後であれば、背伸び動作を行っても点124が第一安定領域Bから出ることはない。従って、背伸び動作時には、他の脚関節12、14、16等を逐次動かして歩行ロボットの姿勢の安定性を調整することないことが、本実施例の特徴である。その結果、背伸び動作時において他の脚関節の制御に要する消費エネルギーを抑制し得る。
Here, after the
次に、CPU100による電磁弁94の制御による歩行ロボット1の背伸び動作の制御について、図6に基づいて詳細に説明する。図6に背伸び動作の制御アルゴリズムを示す。この制御アルゴリズムは、予め決められたCPU100の起動周期ごとに実行されるものとする。起動周期が来るごとにタイマー割り込みが起き、ステップ130で背伸び動作
指令のビットが1になったかどうかが確認される。この指令が来ていない(ビットが0)ときはステップ131に進み、他の動作制御ループに移る。ビットが1のときはステップ132に進み、第一接地部位66を突出させる状態かどうかを確かめる。背伸び動作開始前は、第一接地部位66および第二接地部位64はほぼ同じ平面にあるので、歩行ロボット1の高さを増加する作業を意味するFlag−Uは0となっているのでNoに進み、歩行ロボット1の重心によって決定される点124を図5に示す第一安定領域Bまで移動させる制御ループ140に進む。プロセス140ではステップ141でメモリから6つの目標関節角度Dθitを読みだす。ここで添字iは、脚の関節に付けられた番号であって、関節は左右12ケ存在するため添字iは1〜12まである。また添字tは起動周期ごとに順に付けられた番号であって、運動時間を代表している。
Next, the control of the back stretching operation of the walking
続いてステップ142に進み、角度計108より、実際の関節角度値Rθitを読みだす。この例では実際の関節角度値Rθitの他に実際の関節角速度Rωitを、関節角度値RθitをFV変換して読み出す例を示している。尚、関節角速度Rωitは、Rωit=Rθit−Rθi(t−1)と計算で求めても良い。ここでは、用意されたRωitを読み込むことする。次にステップ143に進み、必要なモータトルクTiを以下に示す式(1)に従って、計算する。
In
Ti=K1(Dθit−Rθit)+K2(Dωit−Rωit)・・・(1)
ここで、Dωitは目標関節角速度であり、目標関節角度Dθitと関節角度値Rθitとの差分に所定の定数を乗じた量である。尚、K1は目標関節角度Dθitとの差をトルクに換算する、いわゆる角度偏差比例の換算係数であり、K2は目標関節角速度Dωitとの差をトルクに換算する、いわゆる角速度偏差比例の換算係数である。
T i = K 1 (D θ it - R θ it) + K 2 (D ω it - R ω it) ··· (1)
Here, D ω it is a target joint angular velocity, and is an amount obtained by multiplying a difference between the target joint angle D θ it and the joint angle value R θ it by a predetermined constant. K 1 is a so-called angular deviation proportional conversion coefficient that converts the difference from the target joint angle D θ it into torque, and K 2 is a so-called angular speed that converts the difference from the target joint angular speed D ω it into torque. This is a conversion factor proportional to the deviation.
続いてステップ144でこの算出したモータトルクを各アンプに出力する。ステップ146で上述した重心管理作業が終了したか否かを調べ、終了していないときはステップ147において、時間表でtをt+1として1つ進め、ステップ150で作業の終了をチェック、終了していないときは再び次の起動周期が来るまで、待つ。全ての作業が終了している場合にはステップ153に進み、他の動作制御プログラムを実行する。
Subsequently, in
ステップ146で重心管理が終了しているときは、ステップ148に進み、Flag−Uのビットを1にしておく。この後はステップ149に進んで時間表の時刻を今読み込んだ時刻に合わせておき、次の時刻の関節角度を読み込むことを防止しておく。このステップ149における作業(t=t)によって、後述する姿勢保持制御によって歩行ロボット1はこのときの姿勢を保持するようになる。
When the gravity center management is completed in
次の起動周期がくると、ステップ132の結果はYesとなる。そこで、プロセス160に移行する。プロセス160では、ステップ161で目標関節角度Dθit(この値は先にt=tとしたから前回の処理に使ったものと同じであるが)を読み込み、ステップ162で現実の関節角度Rθitと角速度Rωit(これは時々刻々変化しているから前のデータとは違う)を読み込み、ステップ163でモータトルクを計算する。トルク計算については、先述と同様に行われる。その後、ステップ164で各アンプにトルク指令値として出力する。この状態で背伸び動作を終了して止めるための指令のビット1があるか否かをステップ166で調べる。プロセス160に最初に進んだ時点では、ステップ166での判断はNoであるから、ステップ168に進み、電磁弁94にオン(励磁)指令を出力する。その後はt=tと指定して、この起動周期の処理を終える。以後このサイクルは繰り返されるから、電磁弁94は励磁された状態を維持し、従って歩行ロボット1は背伸び動作の姿勢を維持している。
When the next activation cycle comes, the result of
ここで背伸び動作を終了して止めるための指令ビットが発せられると、ステップ166
の結果はYesとなり、ステップ170で電磁弁94にオフ(消磁)指令が出力される。そして、ステップ172に進み、歩行ロボット1の高さを背伸び動作前の状態に戻すFlag−Dのビットが1か否かを調べる。電磁弁94にオフ指令が出された直後は、Flag−D=0なので、ステップ174に進み、タイマーのカウンタCを例えば100に設定する。このカウンタCは起動サイクルごとに1ずつ差し引かれ、0になったときにタイマー設定時間が満了となる。例えば、起動サイクルを2msとすれば、カウンタCの値が100であることは、0.2秒のタイマー設定をしたことを意味する。この時間は、電磁弁94がオフとなって歩行ロボット1の高さが下降し始め、第一接地部位66と第二接地部位64との段差δが零となり、第一接地部位66と第二接地部位64とが同一平面になるまでの時間より長く設定されている。
When a command bit is issued to end and stop the stretching operation here, step 166 is performed.
The result is Yes, and an off (demagnetization) command is output to the
そして、ステップ176でFlag−Dのビットを1に設定し、t=tとしたあと、この起動周期の処理を終える。次のサイクルではステップ172の結果がYesとなる。そのときは、ステップ173に進みカウンタCを1減じておき、次のステップ175でカウンタの残りが0か否かを調べる。カウンタCの残りが0ではないときはNoに進み、t=tを指定してこの回の処理を終える。この処理を200回繰り返すとステップ175の結果はYesとなる。そのときは、歩行ロボット1は無事地面まで下降しており、ステップ177でFlag−UおよびFlag−Dの値を共に0に設定してこの回の処理を終える。
In
以上のアルゴリズムを実行することにより、歩行ロボット1は背伸び動作を所望の時間行い再度もとの位置、即ち背伸び動作前の状態に戻る一連の動作を実現できる。
By executing the above algorithm, the walking
上述した構造の関節50を有する歩行ロボット1においては、歩行時においては、ピストン52の圧力室56は大気側に開放されている。従って、ピストン52はリターンスプリング80によって図2に示す最上位置に保持され、従来技術の歩行ロボット1の歩行時と同じように、脚先部24は一枚の板として機能している。
In the walking
そして、何らかの必要性から歩行ロボット1の高さを少しばかり高くしたいときは、図6に示すアルゴリズムを実行することで歩行ロボット1の高さが、第一接地部位66と第二接地部位64との間の段差δに応じた高さだけ高くなる。その際、歩行ロボット1の関節50を除く12ケの関節は同じ姿勢角度を取りつづけており、空気圧による垂直駆動の関節50のみが駆動されるから、歩行ロボット1の姿勢が途中で崩れる虞はない。
Then, when it is desired to slightly increase the height of the walking
また、歩行ロボット1が背伸び動作を継続している間は、圧力室56に送られた空気圧が外部からのエネルギー供給を受けない状態で、歩行ロボット1の姿勢が維持されるため、エネルギー消費は基本的に電磁弁94が消費する僅かな電力となる。更に、この状態から歩行ロボット1の高さを下げる際には、単に圧力室56内の圧縮空気を大気側に開放するだけで良く、このときのエネルギー損失はほぼ零である。
Further, while the walking
ここで、関節50に相当する機構を従来のような回転型の関節として駆動をモータで行うと、歩行ロボット1の高さが増加するに従い歩行ロボット1の姿勢は前のめり状態となるため、関節50以外の足関節を制御して歩行ロボット1の重心変動による均衡をとる必要がある。尚、背伸び動作においては歩行ロボット1の重心を上に持ち上げるのであるため、その過程では理論的に同じポテンシャルエネルギーを必要とするが、背伸び状態を保持する場合においては、歩行ロボット1の姿勢を保つためにモータに通電を続けておく必要がある。更に、歩行ロボット1の高さを下げるときも同様にモータを駆動するため、エネルギーを消費することとなる。一方で、上述した構造の関節50を有する歩行ロボット1においては、このような従来の歩行ロボット1にあるエネルギーの消費を抑制することが可能となる。これは充電池等に搭載したエネルギーで全てのタスクを達成しなければな
らない歩行ロボットにおいても、大きな利点である。
Here, when the mechanism corresponding to the joint 50 is driven by a motor as a conventional rotary joint, the posture of the walking
次に、図2に示す関節50を有する歩行ロボット1の第二の実施例について、図7および図8に基づいて説明する。本実施例における歩行ロボット1は、その向きを変更する歩行ロボット1であり、いわゆる「回れ右」の動作を行うものである。
Next, a second embodiment of the walking
図7に歩行ロボット1の向き変更動作の基本原理を示す。図7(a)は歩行ロボット1の上部から見た脚の動かし方を示している。図7(a)では、歩行ロボット1の重心は図の座標原点Oに一致する。また、このとき、歩行ロボット1は、圧力室56L/Rに高圧空気が供給されてピストン52L/Rが下側方向に移動することで、脚先部24L/Rにおいては第一接地部位66L/Rにおいてのみが、歩行路面と接地している。このときの脚先部24L/Rの位置を太線で示す。また、脚先部24L/Rに作用する分布荷重の中心点をPL、PRとする。この中心点PL、PRが2つの脚先部24L/Rの第一接地部位66L/R(図で点線の円で表示)の中央に来るように関節50を除く脚関節が調節されている場合を想定し、この場合を例にとって歩行ロボット1の向き変更動作について説明する。
FIG. 7 shows the basic principle of the direction changing operation of the walking
図7(a)に示す状態で脚先部24L/Rの方向が歩行ロボット1の胴体に対して変化しないよう固定した状態で、反時計回りに左右両脚を回転させるべく、関節50を除く脚関節に駆動力を与える。しかし、脚先部24L/Rと歩行路面との間には摩擦が存在するため、この駆動力は歩行ロボット1が地球を反時計回りに回転させる動作となる。一方で、ニュートンの作用・反作用の法則によって、歩行ロボット1は地球から時計回りの回転力を受けることとなる。そして地球の慣性モーメントは歩行ロボット1のそれよりも圧倒的に大きいため、結果的に歩行ロボット1が時計方向に回転運動する。このとき、回転軸62を中心とする第一接地部位66L/Rの回転動作によって、歩行ロボット1が回転しその向きが時計回り方向に変更されることになる。
In the state shown in FIG. 7A, the legs excluding the joint 50 are used to rotate the left and right legs counterclockwise in a state where the direction of the
歩行ロボット1の向き変更動作の様子を図7(b)に示す。図7(b)は地球に固定した座標から歩行ロボット1を見た様子を示している。歩行ロボット1の両脚の状態は、図7(a)に示す状態にある左右両脚に、該脚を図7(a)、(b)に示す仮想円TCに沿って動かすべく駆動力を、関節50を除く脚関節によって与える。この仮想円TCは中心点PL、PRを通る円として定義される。本実施例においては、仮想円の中心は、座標原点Oと一致している。
FIG. 7B shows how the walking
そして、駆動力が左右の両脚に与えられることで、上述したように歩行ロボット1の向きが図7(b)に示すように時計回転方向に変更する。そして、本実施例においては、歩行ロボット1の向きが、PL、PRにおける仮想円TCの接線方向に一致すると、歩行ロボット1の向き変更動作が終了する。その結果、歩行ロボット1は図7(a)の状態から時計方向にθR(座標原点Oを中心とする回転角)だけ旋回する。このとき、歩行ロボットの両脚も点PL、点PRを中心にθS(歩行ロボット1の両脚の荷重中心PL、PRを中心とする回転角)だけ回転するが、幾何学的な関係からθRとθSとは互いに相等しい。
Then, when the driving force is applied to the left and right legs, the direction of the walking
また、脚先部24L/Rの接地部位だけを見ていると、歩行路面と第一接地部位66L/Rとの間の摩擦力が第一接地部位66L/Rと第一樹脂板70との間の摩擦力より大きい場合には、第一接地部位66L/Rは歩行路面に対して不動状態であり、第一樹脂板70を含む第一接地部位66L/Rがピストン52に対して回転摺動運動をしている。ここで、2つの平面が一定の歩行ロボット1の重量を受けながら互いに回転摺動する場合には、回転抵抗は接地面積が広い程大きくなる。そこで、空気圧によって第一接地部位66L
/Rを突出させることで、回転動作時の回転抵抗を減らし、然る後に股関節の関節10L/Rを固定したまま第一接地部位66L/Rの中心が仮想円TCに沿って反時計方向に回転するべく、関節50を除く関節を駆動することで、少ない回転抵抗のもとで、安定した姿勢を保ちながら歩行ロボット1の向き変更動作を実行できる。
Further, when only the ground contact part of the
/ R protrudes to reduce the rotational resistance during the rotational operation, and then the center of the first
更に、膝関節も望ましくは真っ直ぐに伸ばして固定した状態で向き変更動作を行えば、即ち関節10L/Rと関節16L/Rは一定の関節角度を保持したまま向き変更動作を行えば、より少ないエネルギーで向きの変更が行える。
Further, if the knee joint is desirably straightened and fixed and the direction changing operation is performed, that is, the
また、本実施例の脚先部24の関節50は、ピストン52と第一接地部位66との間には相対回転運動を少ない摩擦で実現するために、低摩擦係数を持つ第一樹脂板70が介在している。従って、歩行路面の摩擦係数が高いアスファルト路面のような歩行路面であっても、歩行路面と第一接地部位66との間の摩擦係数とは無関係に、ピストン52と第一接地部位66との間の摩擦力が向き変更動作時における抵抗力となる。従って、歩行路面と第一接地部位66との摩擦力に拘わらず、一定の消費エネルギーで向き変更動作が実行し得る。
In addition, the joint 50 of the
尚、このことは、歩行ロボット1において、歩行路面がプラスタイルのように滑りやすい路面の場合には電磁弁94に通電することなく(圧縮空気を消耗することなく)、向き変更動作を行うことを否定するものではない。そのような選択は、歩行ロボット1に環境に関する知識ベースを与えておくだけで容易に実施可能である。
This means that the walking
更に、向き変更動作時に、本出願人が特願2002−205845で開示している関節制動装置を使って、本実施例における関節10、16の駆動モータにブレーキをかけ、当該関節の駆動モータへの電力供給を停止すれば、より少ないエネルギー消費で向き変更動作を実行できる。 Further, during the direction changing operation, the joint braking device disclosed by the present applicant in Japanese Patent Application No. 2002-205845 is used to brake the drive motors of the joints 10 and 16 in the present embodiment. If the power supply is stopped, the direction changing operation can be executed with less energy consumption.
ここで、CPU100による歩行ロボット1の向き変更動作の制御について、図8に基づいて詳細に説明する。図8は、向き変更動作において歩行ロボット1の向きを時計回りの方向とする、いわゆる「回れ右」動作を行うための制御アルゴリズムを示す。以降、図8の制御アルゴリズムの説明については、向き変更動作を回れ右動作と称する。この制御アルゴリズムは、予め決められたCPU100の起動周期ごとに実行されるものとする。
Here, the control of the direction changing operation of the walking
尚、図8に示す制御アルゴリズムは、図6に示す制御アルゴリズムと類似している。そのため、制御アルゴリズムの説明において重複が生じる。そこで、図8および図6に示す制御アルゴリズム中のステップの参照番号の下2桁の番号が両者一致していれば、そのステップにおける機能は同じものとして、その詳細な説明は割愛する。但し、機能が同一のステップについては、図6に示す制御アルゴリズムとの区別のために、図8に示す制御アルゴリズムにおける参照番号の3桁目には200番を使用している。つまり図8に示す200番台のステップは、基本的に第一実施例である図6に示す3桁目が100番台の下2桁が同一のステップと機能は同じであり、回れ右動作に特有のステップは300番台の番号を付するものとする。 The control algorithm shown in FIG. 8 is similar to the control algorithm shown in FIG. Therefore, duplication occurs in the description of the control algorithm. Therefore, if the last two digits of the step reference numbers in the control algorithm shown in FIG. 8 and FIG. 6 match, the function in that step is assumed to be the same, and the detailed description thereof is omitted. However, for steps having the same function, the number 200 is used as the third digit of the reference number in the control algorithm shown in FIG. 8 in order to distinguish it from the control algorithm shown in FIG. That is, the steps in the 200s shown in FIG. 8 are basically the same as the steps of the first embodiment shown in FIG. These steps are numbered in the 300s.
図8に示す制御アルゴリズムについて説明する。図8で左半分の処理は先の第一実施例と同じである。これらの処理によって歩行ロボット1の重心位置が、図5に示す第一安定領域B内であって、図7の(a)の原点位置Oにきているものとする。以降、ステップ232での結果がYesとされる場合から説明する。
The control algorithm shown in FIG. 8 will be described. In FIG. 8, the process on the left half is the same as in the first embodiment. It is assumed that the center of gravity position of the walking
次の起動サイクルが開始されると、ステップ232の結果はYesとなり、処理プロセス310が処理される。即ち、目標関節角度DθJtが読み込まれる。この歩容データは
回れ右動作のものであり、図6に示す歩容データと区別するために、添字における関節番号をJで表示している。以降の制御パラメータの添字についても同様である。続いてステップ312では、実際の関節角度RθJtと実際の角速度RωJtを読み込み、ステップ313でモータトルクを計算する。トルク計算については、第一実施例の場合と同様に求める。そして、ステップ314でアンプ104にモータトルクの計算結果を出力する。
When the next activation cycle is started, the result of
更に、ステップ316では、回れ右動作が終了したか否かを判断する。最初のステップ316の判断においては、回れ右動作は終了していないため、ステップ318で電磁弁94を励磁するべくオン指令を出力する。
Further, in step 316, it is determined whether or not the turning right operation is finished. In the determination at the first step 316, since the turning right operation is not completed, an on command is output at
ステップ318からステップ250へ進み、ステップ250で回れ右動作を終了するか否かを判断する。回れ右動作を継続するならばステップ247で周期管理番号tを1つだけ進めてこの回の処理を終える。尚、この処理過程で電磁弁94をオンとしているが、プロセス310における関節角度指令値において、最初の微小時間は各関節が動かないように同じ角度指令値としてメモリに蓄えておけば、電磁弁94が励磁されて、歩行ロボット1が持ち上げられている間、歩行ロボット1の姿勢を不変のものにしておくことができる。
Proceeding from
さて、上述の処理が繰り返されると、ステップ316における判断の結果がYesとなり、回れ右動作が終了する。そこで、ステップ320へ進み、電磁弁94をオフする。そのあとは、上述の第一実施例と同じく、歩行ロボット1の高さが下降を続けて脚先部24全体が地面と接地するまでの時間、他の動作制御に移行することを防止する。尚、この期間も、各関節の角度指令値を一定にしたものがメモリに蓄えられているものとする。その結果、歩行ロボット1は姿勢を変えることなく短い時間で足部が地面に着地する。
Now, if the above process is repeated, the result of determination in step 316 is Yes, and the turning right operation ends. Then, it progresses to step 320 and the
本実施例における向き変更動作(回れ右動作)を行う歩行ロボット1においては、脚先部24では接地面積こそ狭めているが、歩行路面とは第一接地部位66を介して接地しており、歩行ロボット1の姿勢の安定性が損なわれることはない。また脚関節については、関節10L/R、16L/Rを固定することで、向き変更動作に要するエネルギーを抑制し得る。
In the walking
また、歩行ロボット1が向き変更動作を行っている最中も、第一接地部位66のみによって接地している状態が、即ち背伸び動作状態が維持されているが、第一実施例で述べたように背伸び動作状態を維持するためのエネルギーは主に電磁弁94が消費する僅かな電力である。また、向き変更動作においては、上述したように両脚が仮想円TCに沿った動きをすべく関節50を除く関節に駆動力が与えられるため、従来から行われている足踏みによる向き変更と比べて消費エネルギーが極めて低い。
Further, while the walking
上述した第一実施例および第二実施例においては、2本の脚を有する歩行ロボット1を例示したが、4本・6本脚の歩行ロボットでも同じように適用できる。また歩容データを予め作りメモリに収納する方式を例示したが、この方式に限定されるべきではなく、遠隔操作による方法や、その場で状況に応じて歩容を作りだす場合でも適用できる。
In the first embodiment and the second embodiment described above, the walking
また図2において脚先部24の構造で例示したものは、スネリンク32の真下に第一接地部位66を配置したが、これに限定されるべきではない。第一実施例に示す第一接地部位66の位置を脚先部の先端に配置して、即ち、第一接地部位66と第二接地部位64の構造体をそっくり入れ換えて、背伸び動作時において脚先部24の先端に設けられた第一接地部位66が第二接地部位64に対して突出する方向に相対移動するようにしてもよい。その場合、向き変更動作時においては、脚先部24の先端を中心として向き変更が行わ
れる。更に、上述の実施例ではピストン52が直接鉛直方向に第一接地部位66を押し出す構造を例示しているが、ピストン52とシリンダー54を水平に配置して、カムやリンクを介して駆動方向を変えてもよい。また空気圧に限定されるべきではなく、油圧によっても目的を達成してもよい。
Further, in the example illustrated in the structure of the
次に、歩行ロボットの高さを変更する実施例について、図9に基づいて説明する。図9には、本実施例に係る歩行ロボット1の下半身の概略的な骨格図を示す。尚、図1に示す歩行ロボット1と同一の構成については、同一の参照番号を付することで、その説明を省略する。
Next, the Example which changes the height of a walking robot is described based on FIG. FIG. 9 shows a schematic skeleton diagram of the lower half of the walking
本実施例に係る歩行ロボット1においては、上述のスネリンクが上部スネリンク32aL/Rと下部スネリンク32bL/Rとで構成される。そして、上部スネリンク32aL/Rと下部スネリンク32bL/Rとは、関節500L/Rで連結されている。関節500L/Rは、蓄圧タンク90に貯留されている高圧空気によって駆動するピストンを内包している。
In the walking
そして、蓄圧タンク90から高圧空気が該ピストンに供給されることで、上部スネリンク32aL/Rが下部スネリンク32bL/Rに対して、歩行ロボット1の高さがオフセット的に増加する方向に相対移動する。即ち、高圧空気の供給により、実施例1における関節50L/R中のピストン52の動作に準じた動作が行われることで、上部スネリンク32aL/R以上の歩行ロボット1の構成要素が、下部スネリンク32bL/R以下の歩行ロボット1の構成要素に対して相対移動することになる。
Then, when high pressure air is supplied from the
このように構成される歩行ロボット1においては、関節500L/Rに対して高圧空気を供給することで歩行ロボットの高さを変更することが可能となり、高さ変更のための構成を簡易なものとすることが可能となる。また、オフセット的に歩行ロボットの高さを増加させるため、ロボットの高さ変更時において重心位置が大きく変動する虞が低い。従って、高さ変更時における関節500L/R以外の関節の駆動を行う必要性が低くなり、高さ変更に要する消費エネルギーを可及的に抑制し得る。更に、関節500L/Rの動力源を流体圧とすることにより、電気モータ等のように電気エネルギーを動力源とする場合と異なり、歩行ロボット1の高さ変更後は高圧空気の漏れがない限り、歩行ロボット1の高さ維持に要する消費エネルギーは極めて少ない。
In the walking
尚、本実施例においては、スネリンクの位置に関節500L/Rを設けたが、その代わりに大腿リンク30L/Rの位置に関節500L/Rを設けてもよい。即ち、大腿リンク30L/Rを上部大腿リンク下部大腿リンクに分けてそれぞれの大腿リンクを関節500L/Rにて連結する構造としてもよい。
In this embodiment, the joint 500L / R is provided at the position of the snelink, but instead, the joint 500L / R may be provided at the position of the
1・・・・歩行ロボット
10・・・・関節
12・・・・関節
14・・・・関節
16・・・・関節
18・・・・関節
20・・・・関節
24・・・・脚先部
30・・・・大腿リンク
32・・・・スネリンク
52・・・・ピストン
54・・・・シリンダー
56・・・・圧力室
62・・・・回転軸
64・・・・第二接地部位
66・・・・第一接地部位
80・・・・リターンスプリング
90・・・・蓄圧タンク
94・・・・電磁弁
100・・・・CPU
1 ... Walking robot 10 ... Joint 12 ... Joint 14 ... Joint 16 ... Joint 18 ... Joint 20 ... Joint 24 ... Leg tip Part 30...
Claims (8)
前記脚の先端には歩行路面と接地する第一接地部位と第二接地部位とを有する脚先部が設けられ、
前記第一接地部位と前記第二接地部位とのうち一方を他方に対して前記歩行路面に向けて突出する方向に相対的に移動させることで、前記歩行ロボットの高さを増加する歩行ロボット高さ調整手段を備え、
前記歩行ロボット高さ調整手段は、前記第一接地部位を前記第二接地部位に対して前記歩行路面に向けて突出する方向に相対移動させることで、該第一接地部位を該歩行路面と接地し且つ該第二接地部位を該歩行路面から離れている状態として該歩行ロボットの高さを増加し、
前記第一接地部位は、前記脚先部に設けられた回転軸の軸周りに回転自在であり、
前記歩行ロボットは、
前記歩行ロボット高さ調整手段によって前記第一接地部位を前記歩行路面と接地し且つ前記第二接地部位を該歩行路面から離れている状態とした後、前記第一接地部位を該歩行路面に接地した状態で前記回転軸を中心として前記歩行ロボットの向きを回転変更する歩行ロボット向き変更手段を、更に備えることを特徴とする歩行ロボット。 In a walking robot having at least two legs composed of a plurality of link members and joint portions connecting the link members, and walking by driving the legs,
The tip of the leg is provided with a leg tip portion having a first grounding portion and a second grounding portion that contact the walking road surface,
A walking robot height that increases the height of the walking robot by moving one of the first ground contact portion and the second ground contact portion relative to the other in a direction protruding toward the walking road surface. Adjusting means,
The walking robot height adjusting means moves the first ground contact portion relative to the second ground contact portion in a direction projecting toward the walking road surface, thereby grounding the first ground contact portion with the walking road surface. And increasing the height of the walking robot with the second ground contact portion being away from the walking road surface,
The first ground contact portion is rotatable around an axis of a rotation shaft provided at the leg tip portion,
The walking robot is
After the first ground contact portion is grounded to the walking road surface and the second ground contact portion is separated from the walking road surface by the walking robot height adjusting means, the first ground contact portion is grounded to the walking road surface. A walking robot further comprising walking robot direction changing means for rotating and changing the direction of the walking robot with the rotation axis as a center in a state where the robot has been rotated.
前記歩行ロボット高さ調整手段は、前記流体圧供給手段から供給される流体圧によって、前記歩行路面に向けて突出する方向における前記第一接地部位と前記第二接地部位との相対移動を行うことを特徴とする請求項1又は請求項2に記載の歩行ロボット。 Fluid pressure supply means for supplying fluid pressure by fluid to either the first ground contact portion or the second ground contact portion;
The walking robot height adjusting means performs relative movement between the first ground contact portion and the second ground contact portion in a direction protruding toward the walking road surface by the fluid pressure supplied from the fluid pressure supply means. The walking robot according to claim 1 or 2, characterized in that:
手段を、更に備え、
前記重心制御手段によって前記歩行ロボットの重心位置を前記安定領域に属させた後に、前記歩行ロボット高さ調整手段による該歩行ロボットの高さを増加することを特徴とする請求項1から請求項3の何れかに記載の歩行ロボット。 When the height of the walking robot is increased by the walking robot height adjusting means, the center of gravity of the walking robot should be present, and is determined by the positional relationship between the first ground contact portion and the walking road surface. A center of gravity control means for controlling the position of the center of gravity of the walking robot in a stable region;
The height of the walking robot is increased by the walking robot height adjusting means after the gravity center position of the walking robot belongs to the stable region by the gravity center control means. The walking robot according to any one of the above.
前記脚の先端には歩行路面と接地する第一接地部位と第二接地部位とを有する脚先部が設けられ、
前記第一接地部位と前記第二接地部位とのうち一方を他方に対して前記歩行路面に向けて突出する方向に相対的に移動させることで、前記歩行ロボットの高さを増加する歩行ロボット高さ調整手段を備え、
前記歩行ロボット高さ調整手段は、前記第一接地部位を前記第二接地部位に対して前記歩行路面に向けて突出する方向に相対移動させることで、該第一接地部位を該歩行路面と接地し且つ該第二接地部位を該歩行路面から離れている状態として該歩行ロボットの高さを増加し、
前記歩行ロボットは、
前記歩行ロボット高さ調整手段によって前記歩行ロボットの高さが増加される場合において該歩行ロボットの重心が存在すべき領域であって前記第一接地部位と前記歩行路面との位置関係によって決定される安定領域に該歩行ロボットの重心位置を制御する重心制御手段を、更に備え、
前記重心制御手段によって前記歩行ロボットの重心位置を前記安定領域に属させた後に、前記リンク部材の各々を連結する関節部は同じ姿勢角度を取りつづけた状態で、前記歩行ロボット高さ調整手段により該歩行ロボットの高さを増加することを特徴とする歩行ロボット。 In a walking robot having at least two legs composed of a plurality of link members and joint portions connecting the link members, and walking by driving the legs,
The tip of the leg is provided with a leg tip portion having a first grounding portion and a second grounding portion that contact the walking road surface,
A walking robot height that increases the height of the walking robot by moving one of the first ground contact portion and the second ground contact portion relative to the other in a direction protruding toward the walking road surface. Adjusting means,
The walking robot height adjusting means moves the first ground contact portion relative to the second ground contact portion in a direction projecting toward the walking road surface, thereby grounding the first ground contact portion with the walking road surface. And increasing the height of the walking robot with the second ground contact portion being away from the walking road surface,
The walking robot is
When the height of the walking robot is increased by the walking robot height adjusting means, the center of gravity of the walking robot should be present, and is determined by the positional relationship between the first ground contact portion and the walking road surface. A center of gravity control means for controlling the position of the center of gravity of the walking robot in a stable region;
After the position of the center of gravity of the walking robot belongs to the stable region by the center of gravity control means, the joint portion connecting each of the link members keeps the same posture angle, and the height adjustment means by the walking robot A walking robot characterized by increasing the height of the walking robot.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004024199A JP4532919B2 (en) | 2004-01-30 | 2004-01-30 | Walking robot |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2004024199A JP4532919B2 (en) | 2004-01-30 | 2004-01-30 | Walking robot |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2005212070A JP2005212070A (en) | 2005-08-11 |
JP4532919B2 true JP4532919B2 (en) | 2010-08-25 |
Family
ID=34906959
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2004024199A Expired - Fee Related JP4532919B2 (en) | 2004-01-30 | 2004-01-30 | Walking robot |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4532919B2 (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101428327B1 (en) | 2012-12-27 | 2014-08-07 | 현대자동차주식회사 | Apparatus for variable supporting foot of robot |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004025327A (en) * | 2002-06-24 | 2004-01-29 | Akira Yoshizawa | Facing structure of robot |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3026275B2 (en) * | 1992-05-20 | 2000-03-27 | 本田技研工業株式会社 | Foot structure of a legged walking robot |
JPH06135358A (en) * | 1992-10-29 | 1994-05-17 | Mitsubishi Heavy Ind Ltd | Foot step-on mechanism for rough terrain walking type conveying machine |
JPH11320461A (en) * | 1998-05-12 | 1999-11-24 | Sony Corp | Artificial foot part |
JPH11320463A (en) * | 1998-05-12 | 1999-11-24 | Sony Corp | Artificial foot part |
-
2004
- 2004-01-30 JP JP2004024199A patent/JP4532919B2/en not_active Expired - Fee Related
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004025327A (en) * | 2002-06-24 | 2004-01-29 | Akira Yoshizawa | Facing structure of robot |
Also Published As
Publication number | Publication date |
---|---|
JP2005212070A (en) | 2005-08-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9724823B2 (en) | Method for controlling the walking motion of a mobile robot, and robot implementing said method | |
EP1820612B1 (en) | Leg joint assist device of legged mobile robot | |
US6962220B2 (en) | Leg joint assist device for leg type movable robot | |
EP1340478B1 (en) | Parallel linkage and artificial joint device using the same | |
JP3665013B2 (en) | Leg joint assist device for legged mobile robot | |
US8042627B2 (en) | Walking robot | |
KR100515277B1 (en) | Bipedal moving device, and device and method for controlling walking of the bipedal moving device | |
JP2004223712A (en) | Walking type robot and its position movement method | |
JP4277671B2 (en) | Walking robot and its foot device | |
JP3956414B2 (en) | Robot apparatus and control method of robot apparatus | |
JP4532919B2 (en) | Walking robot | |
JP5632609B2 (en) | Robot control apparatus and robot control method | |
JP3888295B2 (en) | Walking robot that lowers the gain of inverted pendulum control when stationary | |
JP4508681B2 (en) | Walking robot | |
JP2006116672A (en) | Walking control device of bipedal robot and walking control method | |
JP4352774B2 (en) | Motion control device and motion control method for legged walking robot | |
JP2005224921A (en) | Joint braking device of mobile robot | |
JP2006167868A (en) | Joint device of walking robot | |
JP2004174650A (en) | Robot walking while varying stiffness | |
WO2024143184A1 (en) | Mobile robot | |
Garcia et al. | Controlling dynamic stability and active compliance to improve quadrupedal walking | |
JP2007326169A (en) | Walking robot | |
JP2024092568A (en) | Mobile robot | |
JP4946566B2 (en) | Walking robot and walking control method | |
JP2008036796A (en) | Robot driving mechanism |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20061128 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20091124 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20100125 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20100216 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20100416 |
|
RD13 | Notification of appointment of power of sub attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7433 Effective date: 20100416 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A821 Effective date: 20100416 |
|
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: 20100601 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20100611 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130618 Year of fee payment: 3 |
|
LAPS | Cancellation because of no payment of annual fees |