JPS6154417B2 - - Google Patents
Info
- Publication number
- JPS6154417B2 JPS6154417B2 JP57224000A JP22400082A JPS6154417B2 JP S6154417 B2 JPS6154417 B2 JP S6154417B2 JP 57224000 A JP57224000 A JP 57224000A JP 22400082 A JP22400082 A JP 22400082A JP S6154417 B2 JPS6154417 B2 JP S6154417B2
- Authority
- JP
- Japan
- Prior art keywords
- angle
- power
- attached
- actuator
- vertical plane
- 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
Links
- 210000003423 ankle Anatomy 0.000 claims description 2
- 210000000689 upper leg Anatomy 0.000 claims description 2
- 210000001699 lower leg Anatomy 0.000 claims 1
- 210000002414 leg Anatomy 0.000 description 9
- 230000033001 locomotion Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 4
- 210000002683 foot Anatomy 0.000 description 3
- 206010033799 Paralysis Diseases 0.000 description 2
- 210000003141 lower extremity Anatomy 0.000 description 2
- ZZUFCTLCJUWOSV-UHFFFAOYSA-N furosemide Chemical compound C1=C(Cl)C(S(=O)(=O)N)=CC(C(O)=O)=C1NCC1=CC=CO1 ZZUFCTLCJUWOSV-UHFFFAOYSA-N 0.000 description 1
- 230000002618 waking effect Effects 0.000 description 1
Landscapes
- Prostheses (AREA)
- Numerical Control (AREA)
- Rehabilitation Tools (AREA)
Description
【発明の詳細な説明】
この発明は、動力装具の姿勢制御装置に関する
ものであり、もう少し詳しくいうと、下肢麻卑身
体障害者の立位を保ち、かつ外部から動力を付与
することにより歩行を可能ならしめる動力装具の
姿勢制御装置に関するものである。[Detailed Description of the Invention] This invention relates to a posture control device for a power orthosis, and more specifically, it allows a physically disabled person with paralyzed lower limbs to maintain a standing position and to walk by applying power from the outside. The present invention relates to a posture control device for a power orthosis that makes it possible to control the posture of a power orthosis.
従来、この種の装具は、下肢麻卑患者の上体と
下肢を真直ぐに維持するためのもので、杖や支え
にすがつて身障者が自分の力で歩行を行うもので
ある。また、従来、動力装具と称するものに、た
とえばベオグラート大学のM.Vukobratovicのも
のがあるが、これはリハビリテーシヨンを目的と
したもので、患者に動力を与えることにより二足
歩行を可能ならしめるためのものではない。した
がつて動力装具の二足歩行制御装置としては、こ
の発明に近いものはないが、ロボツトの二足歩行
制御は従来もいろいろ研究されているので、その
一例について説明する。 Conventionally, this type of orthosis has been used to maintain the upper body and lower limbs of paralyzed patients in a straight line, allowing the disabled person to walk on his own by relying on a cane or support. In addition, conventionally known power orthoses include the one made by M. Vukobratovic of Belgrade University, but this is intended for rehabilitation purposes, and is used to enable patients to walk on two legs by applying power to them. It's not for. Therefore, there is no bipedal locomotion control device for power orthoses that is close to the present invention, but there have been various studies on bipedal locomotion control for robots, so one example will be explained.
第1図は二足歩行制御システムのプラントとし
て用いる簡単化された人間リンクモデルである。
図において、1は上体、2a,2bは大腿、3
a,3bは下腿、4a,4bは足首を示す。ま
た、θ1,θ2,θ3,θ4およびθ5は各リン
クの鉛直面からの角度を示し、T1,T2,T3,
T4,T5およびT6はそれぞれのリンクの接点に作
用するトルクを示す。 FIG. 1 is a simplified human link model used as a plant for a bipedal locomotion control system.
In the figure, 1 is the upper body, 2a and 2b are the thighs, and 3
a and 3b indicate the lower legs, and 4a and 4b indicate the ankles. In addition, θ 1 , θ 2 , θ 3 , θ 4 and θ 5 indicate the angle of each link from the vertical plane, and T 1 , T 2 , T 3 ,
T 4 , T 5 and T 6 represent the torques acting on the contacts of each link.
二足歩行制御システムの研究として従来報告さ
れているものにオハイオ大学のH.Hemamiや国内
では早大加藤研究室、阪大有本研究室、千葉大美
多研究室のものがある。人間リンクモデルの各関
節の角度をコマンド信号に従つて制御することに
より、二足歩行を実現しようとするのは、こうし
た研究に共通しているが、そのためには各関節の
鉛直面に相対的な角度を知らねばならず、そのた
めに従来の二足歩行システムはすべて接地脚の角
度を鉛直面に対する基準角度として用いていた。
すなわち第1図において、足を床に平行に接地す
れば、接地脚の角度θ1は足に取付けた角度計か
ら知ることができる。本来角度計は各関節間の相
対角度差を計るものであるから、θ1と各関節に
取成けた角度計から計つた相対角度差から順次θ
2,θ3,θ4,θ5を求めることができ、これ
らを用いて、第2図のような制御系を組むことが
できる。第2図において、θR1,θR2,θR3,θ
R4およびθR5はコマンドとして与える各リンクの
角度信号、△θ1,△θ2,△θ3,△θ4およ
び△θ5は偏差信号である。これらの信号は、信
号を適当に演算処理した後アクチユエータに印加
し、トルクを発生させる演算処理回路およびアク
チユエータでなるブロツク5に入力される。ま
た、T1〜T5はアクチユエータの出力として得ら
れる各関節の駆動トルクで、プラントおよび角度
計でなるブロツク6に印加される。これによりプ
ラントである人間リンクモデルが駆動される。プ
ラントの出力として検出されるのは前記したよう
にθ1および各関節間の角度差θ2−θ1、θ3
−θ2、……であるから、これらを処理して、θ
1,〜θ5それぞれの値を求め、これをフイード
バツクすることにより二足歩行制御を行う。 Previously reported research on bipedal locomotion control systems includes H. Hemami at Ohio University, and in Japan, the Kato laboratory at Waseda University, the Arimoto laboratory at Osaka University, and the Mita laboratory at Chiba University. Common to these studies is the attempt to realize bipedal walking by controlling the angle of each joint of the human link model according to command signals, but in order to do so, it is necessary to Therefore, all conventional bipedal walking systems use the angle of the ground leg as a reference angle with respect to the vertical plane.
That is, in FIG. 1, if the foot touches the ground parallel to the floor, the angle θ1 of the grounding leg can be determined from the angle meter attached to the foot. Originally, the angle meter measures the relative angle difference between each joint, so from θ 1 and the relative angle difference measured from the angle meter installed at each joint, θ is sequentially calculated.
2 , θ 3 , θ 4 , and θ 5 can be obtained, and using these, a control system as shown in FIG. 2 can be constructed. In Figure 2, θ R1 , θ R2 , θ R3 , θ
R4 and θ R5 are angle signals of each link given as commands, and Δθ 1 , Δθ 2 , Δθ 3 , Δθ 4 and Δθ 5 are deviation signals. These signals are input to block 5, which comprises an arithmetic processing circuit and an actuator, which applies appropriate arithmetic processing to the signals and then applies them to the actuator to generate torque. Further, T 1 to T 5 are driving torques for each joint obtained as the output of the actuator, and are applied to the block 6 consisting of the plant and the angle meter. This drives the human link model, which is a plant. As mentioned above, what is detected as the output of the plant is θ 1 and the angle difference between each joint θ 2 −θ 1 , θ 3
−θ 2 , ..., so by processing these, θ
The bipedal walking control is performed by determining the respective values of 1 and .theta.5 and feeding them back.
以上のように従来の装置においては、接地脚か
ら角度基準情報を得るように構成されているた
め、(a)床に凹凸があり足裏が正しく平行に接地し
ない場合や、坂道などの場合、正しい角度基準情
報が得られない、(b)左脚接地の場合と右脚接地の
場合で制御系を切換えなければならない等の欠点
があつた。 As described above, conventional devices are configured to obtain angle reference information from the grounding legs, so (a) when the floor is uneven and the soles of the feet do not touch the ground in parallel, or when the ground is on a slope, etc. There were drawbacks such as the inability to obtain correct angle reference information, and (b) the need to switch the control system between the left leg and right leg contact.
この発明は、上記のような従来のものの欠点を
除去するためになされたもので、ジヤイロを用い
て常に鉛直面からの正しい角度基準を得て、制御
系の切換えのような複雑な処理を行わず、平担で
ない道路、坂道でおいても正しく制御の行える動
力装具の姿勢制御装置を提供することを目的とす
るものである。 This invention was made in order to eliminate the drawbacks of the conventional ones as described above, and uses a gyro to always obtain the correct angle reference from the vertical plane and perform complex processing such as switching the control system. First, it is an object of the present invention to provide a posture control device for a power equipment that can perform accurate control even on uneven roads and slopes.
以下、この発明の一実施例を図面について説明
する。第3図a,bにおいて、各関節に油圧アク
チユエータ7が装着され、これに制御回路および
油圧モータ部分8が接続されている。9は油圧タ
ンクである。制御系は第4図のように構成されて
おり、従来の第2図のものとあまり違いはない
が、従来のプラント+角度計6のジヤイロが加わ
つたブロツク6aが相違する。ジヤイロを上体に
搭載した場合、後述するように第1図における上
体の角度θ3を検出できるので、これを鉛直面に
対する角度基準として用い、第4図に示す制御系
を組むことによりθ1,〜θ5を計算し、従来の
ものと同様の制御を行うことができる。 An embodiment of the present invention will be described below with reference to the drawings. In FIGS. 3a and 3b, a hydraulic actuator 7 is attached to each joint, to which a control circuit and a hydraulic motor section 8 are connected. 9 is a hydraulic tank. The control system is constructed as shown in FIG. 4, and is not much different from the conventional one shown in FIG. 2, except for the conventional plant plus the block 6a in which a gyroscope for the angle meter 6 is added. When the gyroscope is mounted on the upper body, it is possible to detect the angle θ 3 of the upper body in Fig. 1 as described later, so by using this as an angle reference with respect to the vertical plane and assembling the control system shown in Fig. 4, θ can be detected. 1 , to θ5 , and the same control as the conventional one can be performed.
簡単に鉛直面からの角度を検出するジヤイロと
しては第5図に示す機構が考えられる。図におい
て、ジヤイロのロータ10を軸支する回転軸11
が内支持枠12に支持されており、この内支持枠
12は上体に固定された外支持枠13に支持軸1
4を介して支持されている。内支持枠12と外支
持枠13間には弱いバネ15が張設されている。 A mechanism shown in FIG. 5 can be considered as a gyroscope that easily detects the angle from the vertical plane. In the figure, a rotating shaft 11 that supports the rotor 10 of the gyro
is supported by an inner support frame 12, and this inner support frame 12 has a support shaft 1 attached to an outer support frame 13 fixed to the upper body.
It is supported through 4. A weak spring 15 is stretched between the inner support frame 12 and the outer support frame 13.
以上の構成により、歩行運動中、上体の角度は
ほぼ歩行とともに周期的に変化するが、これを時
間的に平均すれば、ほぼ鉛直になると考えられ
る。一方、ジヤイロはロータ10の有するジヤイ
ロ剛性のため周期の短い運動には追随せず、慣性
空間に対し(したがつて鉛直面に対し)一定の姿
勢を保つ。よつてジヤイロと上体に固定された外
支持枠13とを弱いバネ15(場合によつてはダ
ンパをつけてもよい)でつなぎ、ジヤイロに弱い
復元モーメントを与えるようにしておけば、ジヤ
イロの姿勢角はほぼ外支持枠13の平均的な姿勢
角、すなわち鉛直状態を保つこととなり、これを
鉛直の基準として用いることができる。したがつ
て一時的な上体の姿勢角θ3は支持軸14の回転
角を検出するかまたはバネ15のバネ力を測定す
ることにより知ることができる。ジヤイロ姿勢角
のアツプデート(たとえば寝ている状態から起き
た場合などに必要)は一定時間直立状態を保つこ
とによつて行うことができる。 With the above configuration, during walking movement, the angle of the upper body changes periodically as the user walks, but if this is averaged over time, it is considered to be approximately vertical. On the other hand, due to the rigidity of the rotor 10, the gyro does not follow short-period movements and maintains a constant attitude relative to the inertial space (and therefore relative to the vertical plane). Therefore, by connecting the gyroscope and the outer support frame 13 fixed to the upper body with a weak spring 15 (a damper may be attached in some cases) to give a weak restoring moment to the gyroscope, the gyroscope's The attitude angle is approximately the average attitude angle of the outer support frame 13, that is, the vertical state is maintained, and this can be used as a vertical reference. Therefore, the temporary posture angle θ 3 of the upper body can be determined by detecting the rotation angle of the support shaft 14 or by measuring the spring force of the spring 15. Updating the gyroscope angle (necessary, for example, when waking up from a sleeping position) can be done by remaining upright for a certain period of time.
以上は、この発明を動力装具の制御に使用した
場合につき説明を行つたが、これはロボツト等の
二足歩行システム一般に適用することができる。 The above description has been made regarding the case where the present invention is used to control a power orthosis, but the present invention can also be applied to general bipedal walking systems such as robots.
以上のようにこの発明によれば、角度基準とし
て、接地脚の接地面からの角度情報を用いず、ジ
ヤイロを用いて上体の鉛直面からの角度を検出す
るよう構成したので、接地脚の切換わりに伴う、
制御系の切換えなどの複雑な処理を行わず、か
つ、平担でない道路、坂道などでも正しい制御を
行うことができる効果がある。 As described above, according to the present invention, the angle from the vertical plane of the torso is detected using a gyroscope instead of using the angle information from the contact surface of the grounding leg as the angle reference. Along with the switching,
This has the advantage of being able to perform correct control even on uneven roads, slopes, etc., without having to perform complicated processing such as switching control systems.
第1図はこの発明を適用する動力装具を簡単化
した人間リンクモデルの構成概念図、第2図は接
地脚の接地面からの角度情報を用いた従来のもの
の制御ブロツク図、第3図はこの発明の一実施例
の動力装具の概要配置図でありaは前方斜視図、
bは後方斜視図、第4図は同じく制御ブロツク
図、第5図は同じくジヤイロの概略構成斜視図で
ある。
5……演算処理回路およびアクチユエータ、6
a……プラント、角度計およびジヤイロ、7……
油圧アクチユエータ、8……制御回路及び油圧モ
ータ部分、9……油圧タンク、10……ロータ、
11……回転軸、12……内支持枠、13……外
支持枠、14……支持軸、15……バネ。なお、
図中、同一符号は同一または相当部分を示す。
Fig. 1 is a conceptual diagram of the structure of a simplified human link model of a power orthosis to which this invention is applied, Fig. 2 is a control block diagram of a conventional device using angle information from the contact surface of the grounding leg, and Fig. 3 is FIG. 1 is a schematic layout diagram of a power equipment according to an embodiment of the present invention; a is a front perspective view;
4b is a rear perspective view, FIG. 4 is a control block diagram, and FIG. 5 is a schematic perspective view of the gyro. 5... Arithmetic processing circuit and actuator, 6
a...Plant, angle meter and gyroscope, 7...
Hydraulic actuator, 8... Control circuit and hydraulic motor part, 9... Hydraulic tank, 10... Rotor,
11...Rotating shaft, 12...Inner support frame, 13...Outer support frame, 14...Support shaft, 15...Spring. In addition,
In the drawings, the same reference numerals indicate the same or corresponding parts.
Claims (1)
ユエータと、このアクチユエータに動力を付与す
る手段を備えた動力装具の姿勢制御装置におい
て、リンクを形成する各関節の相対角度を検出す
るため各関節にそれぞれ取付けられるべき角度計
と、鉛直面からの角度基準を検出するために胴体
に取付けられるべきジヤイロと、前記各リンクの
鉛直面に対する角度とコマンドとして与えられた
角度信号との偏差信号から前記アクチユエータに
与える動力を演算する演算処理回路を備えてなる
ことを特徴とする動力装具の姿勢制御装置。1. In a posture control device for a power orthosis that includes an actuator attached to the thigh, lower leg, ankle, etc. and a means for applying power to this actuator, a device is attached to each joint to detect the relative angle of each joint forming a link. an angle meter to be attached to the body, a gyroscope to be attached to the fuselage for detecting an angle reference from the vertical plane, and a deviation signal between the angle of each link with respect to the vertical plane and an angle signal given as a command to be given to the actuator. A posture control device for a power equipment, characterized by comprising a calculation processing circuit for calculating power.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP57224000A JPS59115035A (en) | 1982-12-22 | 1982-12-22 | Posture control apparatus of power accessory tool |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP57224000A JPS59115035A (en) | 1982-12-22 | 1982-12-22 | Posture control apparatus of power accessory tool |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPS59115035A JPS59115035A (en) | 1984-07-03 |
| JPS6154417B2 true JPS6154417B2 (en) | 1986-11-21 |
Family
ID=16807014
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP57224000A Granted JPS59115035A (en) | 1982-12-22 | 1982-12-22 | Posture control apparatus of power accessory tool |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPS59115035A (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2000107213A (en) * | 1998-10-07 | 2000-04-18 | Shigeki Toyama | Joint assist device using ultrasonic motor |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS59227377A (en) * | 1983-06-08 | 1984-12-20 | 株式会社井上ジャパックス研究所 | Robot device |
| JPH0372370U (en) * | 1989-11-17 | 1991-07-22 | ||
| JP2003301807A (en) * | 2002-02-07 | 2003-10-24 | Nippon Robotics Kk | Hydraulic actuator |
-
1982
- 1982-12-22 JP JP57224000A patent/JPS59115035A/en active Granted
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2000107213A (en) * | 1998-10-07 | 2000-04-18 | Shigeki Toyama | Joint assist device using ultrasonic motor |
Also Published As
| Publication number | Publication date |
|---|---|
| JPS59115035A (en) | 1984-07-03 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| EP2827809B1 (en) | Human machine interface for lower extremity orthotics | |
| US7061200B2 (en) | Legged mobile robot and actuator device applicable to join shaft of the robot | |
| US8202234B2 (en) | Control device for walking assistance device | |
| CN103813771B (en) | Exercise assisting device, exercise assisting method, computer program, and program recording medium | |
| US5513106A (en) | System for controlling locomotion of a walking robot having a sensor for detecting externally exerted forces | |
| US12036158B2 (en) | Mobility aid | |
| US6971267B2 (en) | Method and processor for obtaining moments and torques in a biped walking system | |
| KR102146363B1 (en) | Wearable robot and control method for the same | |
| KR20150083331A (en) | a walking assist device and a method for controlling the the walking assist device | |
| WO2006080134A1 (en) | Wearing-type motion assistance device and program for control | |
| KR20170141837A (en) | Ankle-less walking assistant robot system and method for controlling the same | |
| WO2017100898A1 (en) | Exoskeleton with cambered wheels for human locomotion | |
| US7540342B1 (en) | Virtual walker apparatus | |
| KR100555990B1 (en) | Pneumatic Distributed Control Walking Assistant Robot | |
| JPS6154417B2 (en) | ||
| KR100391830B1 (en) | Welfare Robotic System for the Rehabilitation Training of the people with disability for bipedal walking | |
| JP2002263151A (en) | Omnidirectional walking aid | |
| JP2012205826A (en) | Walking support device and program therefor | |
| Kikuchi et al. | Basic study on gait rehabilitation system with intelligently controllable walker (i-Walker) | |
| Mori et al. | Development of an autonomous forearm-supported walker for nursing facilities | |
| JP2911984B2 (en) | Walking control device for legged mobile robot | |
| JPH07136957A (en) | Interface device | |
| Di et al. | Real-time fall and overturn prevention control for human-cane robotic system | |
| CN214081417U (en) | wearable exoskeleton | |
| JP7505262B2 (en) | Work improvement support device, work improvement support system, work improvement support method, and program |