KR20040075331A - 다리식 이동로봇의 착상충격 완충장치 - Google Patents

다리식 이동로봇의 착상충격 완충장치 Download PDF

Info

Publication number
KR20040075331A
KR20040075331A KR10-2004-7010029A KR20047010029A KR20040075331A KR 20040075331 A KR20040075331 A KR 20040075331A KR 20047010029 A KR20047010029 A KR 20047010029A KR 20040075331 A KR20040075331 A KR 20040075331A
Authority
KR
South Korea
Prior art keywords
leg
variable volume
bag
shaped member
foot flat
Prior art date
Application number
KR10-2004-7010029A
Other languages
English (en)
Other versions
KR100893901B1 (ko
Inventor
다케나카도루
고미히로시
하마야가즈시
다케무라요시나리
마츠모토다카시
요시이케다카히데
니시무라요이치
아키모토가즈시
요코야마다로
Original Assignee
혼다 기켄 고교 가부시키가이샤
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 혼다 기켄 고교 가부시키가이샤 filed Critical 혼다 기켄 고교 가부시키가이샤
Publication of KR20040075331A publication Critical patent/KR20040075331A/ko
Application granted granted Critical
Publication of KR100893901B1 publication Critical patent/KR100893901B1/ko

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J5/00Manipulators mounted on wheels or on carriages
    • B25J5/02Manipulators mounted on wheels or on carriages travelling along a guideway
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D57/00Vehicles 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/02Vehicles 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/032Vehicles 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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/0091Shock absorbers
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D57/00Vehicles 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/02Vehicles 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
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16FSPRINGS; SHOCK-ABSORBERS; MEANS FOR DAMPING VIBRATION
    • F16F15/00Suppression of vibrations in systems; Means or arrangements for avoiding or reducing out-of-balance forces, e.g. due to motion
    • F16F15/02Suppression of vibrations of non-rotating, e.g. reciprocating systems; Suppression of vibrations of rotating systems by use of members not moving with the rotating systems
    • F16F15/023Suppression of vibrations of non-rotating, e.g. reciprocating systems; Suppression of vibrations of rotating systems by use of members not moving with the rotating systems using fluid means
    • FMECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
    • F16ENGINEERING ELEMENTS AND UNITS; GENERAL MEASURES FOR PRODUCING AND MAINTAINING EFFECTIVE FUNCTIONING OF MACHINES OR INSTALLATIONS; THERMAL INSULATION IN GENERAL
    • F16FSPRINGS; SHOCK-ABSORBERS; MEANS FOR DAMPING VIBRATION
    • F16F9/00Springs, vibration-dampers, shock-absorbers, or similarly-constructed movement-dampers using a fluid or the equivalent as damping medium
    • F16F9/02Springs, vibration-dampers, shock-absorbers, or similarly-constructed movement-dampers using a fluid or the equivalent as damping medium using gas only or vacuum
    • F16F9/04Springs, vibration-dampers, shock-absorbers, or similarly-constructed movement-dampers using a fluid or the equivalent as damping medium using gas only or vacuum in a chamber with a flexible wall
    • F16F9/0472Springs, vibration-dampers, shock-absorbers, or similarly-constructed movement-dampers using a fluid or the equivalent as damping medium using gas only or vacuum in a chamber with a flexible wall characterised by comprising a damping device
    • F16F9/0481Springs, vibration-dampers, shock-absorbers, or similarly-constructed movement-dampers using a fluid or the equivalent as damping medium using gas only or vacuum in a chamber with a flexible wall characterised by comprising a damping device provided in an opening to the exterior atmosphere
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10TECHNICAL SUBJECTS COVERED BY FORMER USPC
    • Y10TTECHNICAL SUBJECTS COVERED BY FORMER US CLASSIFICATION
    • Y10T74/00Machine element or mechanism
    • Y10T74/20Control lever and linkage systems
    • Y10T74/20207Multiple controlling elements for single controlled element
    • Y10T74/20299Antirattling elements

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Transportation (AREA)
  • Robotics (AREA)
  • Physics & Mathematics (AREA)
  • Acoustics & Sound (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Manipulator (AREA)
  • Toys (AREA)

Abstract

로봇의 다리체의 족평 기구(6)에 설치된 착상충격 완충장치(18)이며, 족평 기구(6)의 바닥면측에 압축팽창 가능한 백 형상 부재(19)(가변용적체)를 구비하고 있다. 백 형상 부재(19)는 고무 등의 탄성재에 의해 구성되어 있다. 백 형상 부재(19)에는, 전자 밸브(27) 등을 구비하는 유입·유출 수단(20)에 의해 대기중의 공기가 입출가능하다. 족평 기구(6)의 이상 상태에서, 백 형상 부재(19)내에의 공기의 유입을 제어함으로써, 백 형상 부재(19)의 최종적인 팽창 상태에서의 높이를 로봇의 보용형태에 따른 높이로 제어한다. 다리식 이동로봇의 다리체의 착상 동작시의 충격 하중을 로봇의 보용형태에 맞추어서 적정하게 경감하면서, 이 로봇의 자세의 안정성의 확보를 용이하게 행할 수 있고, 또한 경량의 구성으로 할 수 있다.

Description

다리식 이동로봇의 착상충격 완충장치{DEVICE FOR ABSORBING FLOOR-LANDING SHOCK FOR LEGGED MOBILE ROBOT}
2족 이동로봇 등, 복수의 다리체를 구비한 다리식 이동로봇에서는, 각 다리체는 그 선단부에 설치된 족평(足平) 기구의 접지면부를 통하여 바닥에 접지된다. 여기에서, 이 족평 기구는, 보다 상세하게는, 각 다리체의 가장 선단측의 관절(발목관절)에 연결된 기구이다. 그리고 다리식 이동로봇은, 각 다리체의 이상(離床)·착상 동작에 의해 이동한다. 이 이상·착상 동작은, 보다 상세하게 말하면, 복수의 다리체중의 적어도 하나의 다리체를 지지다리로 하고, 이 지지다리의 족평 기구를 접지 상태로 유지하는 한편, 다른 다리체를 미접지 다리로 하여, 이 미접지 다리의 족평 기구를 그 접지 장소로부터 공중에 들어 올려서 이동시키고, 다른 접지 개소에 접지시킨다는 동작의 반복이다.
이 종류의 다리식 이동로봇에서는, 각 다리체의 착상 동작에 의해, 이 다리체의 족평 기구의 접지면부를 접지시켰을 때에, 이 다리체의 족평 기구를 통하여 순간적으로 비교적 큰 충격 하중(과도적인 상반력)이 작용한다. 특히, 다리식 이동로봇을 비교적 빠른 이동 속도로 이동시키는 것과 같은 경우에는, 다리체의 족평 기구가 접지하기 직전에 있어서의 다리체의 운동에너지가 크기 때문에, 상기 충격 하중이 큰 것이 된다. 그리고 이 충격 하중이 크면, 그것에 견딜수 있도록 각 다리체의 각 부의 강성을 높일 필요가 생기고, 나아가서는, 각 다리체의 소형화나 경량화의 방해가 된다. 이 때문에, 이러한 충격 하중을 경감하는 것이 요망된다.
이러한 충격 완충장치로서는, 예를 들면 본원 출원인이 일본 특개평 5-305578호 공보에 제안한 것이 알려져 있다. 이 충격 완충장치에서는, 족평 기구의 발뒤꿈치부에 작동유가 충전된 실린더를 구비하고, 이 실린더내를 슬라이딩 가능한 피스톤으로부터 족평 기구의 발뒤꿈치부의 바닥면측을 향하여 로드가 뻗어 설치되어 있다. 그리고, 이 로드의 선단부에는 버섯 모양으로 직경확장되어 이루어지는 접지체가 설치되어 있다. 또, 피스톤은, 그 상측에서 실린더내에 수용된 스프링에 의해, 상기 접지체가 족평 기구의 바닥면측에 돌출하는 방향으로 가압되어 있다. 또한, 이 피스톤에는, 그 상측의 실과 하측의 실 사이에서의 작동유의 유통을 가능하게 하는 유통로가 뚫려 있다.
이와 같이 구성된 충격 완충장치에서는, 다리체의 착상 동작시에, 상기 접지체가 접지하고, 피스톤과 함께 상기 스프링의 가압력과 역방향으로 가압된다. 이 때, 실린더내의 작동유가 피스톤의 유통로를 통하여 유통하면서, 피스톤이 스프링을 압축하는 방향으로 슬라이딩 하고, 이것에 의해 다리체의 착상 동작시의 충격 하중이 경감된다.
그렇지만, 이러한 충격 완충장치에서는, 각 다리체의 상기 접지체가 접지하고나서 이 다리체의 족평 기구가 접지할 때까지의 이 접지체의 스트로크가 로봇의 이동 속도 등의 보용형태에 의하지 않고 일정하기 때문에, 로봇의 보용형태에 따라서는, 충격 완충장치가, 그 보용형태에 적합한 완충 효과를 발휘할 수 없는 경우가 있다. 예를 들면 로봇의 이동 속도가 빠를 경우에, 다리체의 족평 기구의 운동에너지의 감쇠가 너무 늦거나, 또는, 로봇의 이동 속도가 느린 경우에, 다리체의 족평 기구의 운동에너지의 감쇠가 지나치게 빠른 경우가 있다.
이 때문에, 로봇의 자세의 안정성을 원활하게 확보하는 것이 곤란하게 된을 경우도 있다.
더욱이 상기 충격 완충장치에서는, 작동유를 사용하고 있기 때문에, 완충장치의 중량이 큰 것이 되어, 로봇의 경량화의 방해가 된다. 또, 다리체의 착상 동작때에 접지하는 접지체는, 피스톤의 슬라이딩방향(실린더의 축심방향)으로 밖에 이동할 수 없는 동시에 고체 형상이기 때문에, 바닥의 형상에 따라서는 이 접지체에 그 가동 방향과 교차하는 방향으로 충격 하중이 작용하고, 이 충격 하중을 충분히 경감할 수 없거나, 충격 완충장치의 손상을 발생할 우려가 있다.
본 발명은 이러한 배경을 감안하여 이루어진 것으로, 다리식 이동로봇의 다리체의 착상 동작시의 충격 하중을 로봇의 보용형태에 맞추어서 적정하게 경감하면서, 이 로봇의 자세의 안정성의 확보를 용이하게 행할 수 있고, 또한, 경량인 구성으로 할 수 있는 착상충격 완충장치를 제공하는 것을 목적으로 한다.
본 발명은, 다리식 이동로봇의 다리체의 착상 동작시의 충격 하중을 경감하기 위한 착상충격 완충장치에 관한 것이다.
도 1은 본 발명의 실시형태에서의 다리식 이동로봇의 기본 구성을 도시하는 측면도, 도 2는 본 발명의 제 1 실시형태의 착상충격 완충장치를 구비한 족평 기구의 측면에서 본 단면도, 도 3은 도 2의 족평 기구의 바닥면측에서 본 평면도, 도 4는 도 1의 다리식 이동로봇의 동작 제어의 처리를 나타내는 플로우챠트, 도 5는 도 2의 족평 기구의 착상충격 완충장치의 작동을 설명하기 위한 플로우챠트, 도 6은 도 2의 족평 기구의 착상충격 완충장치의 작동을 설명하기 위한 타이밍 차트이다. 도 7은 본 발명의 제 2 실시형태의 착상충격 완충장치의 작동을 설명하기 위한 플로우챠트, 도 8은 본 발명의 제 3 실시형태의 착상충격 완충장치를 구비한 족평 기구의 주요부의 모식도, 도 9는 본 발명의 제 3 실시형태의 착상충격 완충장치의 작동을 설명하기 위한 플로우챠트, 도 10은 본 발명의 제 4 실시형태의 착상충격 완충장치의 작동을 설명하기 위한 플로우챠트이다. 도 11은 본 발명의 제 1∼제 4 실시형태에 관계되는 변형 태양에서의 족평 기구의 주요부의 모식도, 도 12는 본 발명의 제 1∼제 4 실시형태에 관계되는 변형 태양에서의 족평 기구의 주요부의 모식도이다. 도 13은 본 발명의 제 5 실시형태의 착상충격 완충장치를 구비한 족평 기구의 주요부의 모식도, 도 14는 도 13의 족평 기구의 착상충격 완충장치의 작동을 설명하기 위한 플로우챠트, 도 15는 도 13의 족평 기구의 착상충격 완충장치의 작동을 설명하기 위한 타이밍 차트, 도 16은 본 발명의 제 6 실시형태의 착상충격 완충장치를 구비한 족평 기구의 측면에서 본 단면도이다.
본 발명의 다리식 이동로봇의 착상충격 완충장치는 이러한 목적을 달성하기위해서, 족평 기구의 접지면부를 통하여 각각 접지할 수 있는 복수의 다리체의 이상·착상 동작에 의해 이동하는 다리식 이동로봇에 있어서, 각 다리체의 착상 동작때에 상반력을 받아서 압축되는 동시에 적어도 이 다리체의 이상 동작에 의해 이 상반력을 받지 않게 되었을 때에는 팽창할 수 있도록 이 다리체의 족평 기구에 설치되고, 그 압축팽창에 따라 내부에 유체를 입출할 수 있는 가변용적체와, 각 다리체의 이상 상태에서 이 가변용적체를 팽창시키면서 이 가변용적체에 유체를 유입시키는 동시에 상기 상반력에 의한 이 가변용적체의 압축에 따라 이 가변용적체로부터 유체를 유출시키는 유입·유출 수단을 구비하고, 이 유입·유출 수단에 의한 상기 가변용적체내의 유체의 유출때에 유출 저항을 발생시키도록 한 착상충격 완충장치로서, 상기 각 다리체의 이상 상태에서의 상기 가변용적체의 팽창시에, 이 가변용적체의 압축 방향의 사이즈가 상기 다리식 이동로봇의 보용형태에 따른 소정의 사이즈가 되도록, 상기 유입·유출 수단에 의한 가변용적체에의 상기 유체의 유입량을 이 보용형태에 따라 제어하는 팽창 제어 수단을 구비한 것을 특징으로 하는 것이다(제 1 발명).
또한, 본 발명에서, 각 다리체의 착상 동작은, 이 다리체의 족평 기구의 접지면부가 바닥으로부터 떨어진 상태로부터, 이 족평 기구를 하강시켜서 그 접지면부를 바닥에 접지시키는 동작을 의미하고, 각 다리체의 이상 동작은, 이 다리체의 족평 기구의 접지면부를 바닥에 접지시킨 상태로부터, 이 족평 기구를 공중에 들어 올려서 그 접지면부를 바닥으로부터 떨어지게 하는 동작을 의미한다. 또, 각 다리체 혹은 족평 기구의 이상 상태는, 이 다리체의 미접지 다리기의 상태이며, 이 다리체의 족평 기구의 접지면부를 바닥으로부터 떨어지게 한 상태를 의미한다. 또한, 각 다리체 혹은 족평 기구의 착상 상태는, 이 다리체의 지지다리기의 상태이며, 이 다리체의 족평 기구의 접지면부의 전부 혹은 일부를 바닥에 접지시킨 상태를 의미한다.
이러한 본 발명(제 1 발명)에 의하면, 각 다리체의 착상 동작때에, 팽창 상태의 가변용적체가 압축되고, 이 때, 가변용적체내의 유체가 상기 유입·유출 수단에 의해 이 가변용적체내로부터 유출 저항을 수반하며 유출된다. 이것에 의해 착상 동작을 행하는 다리체의 운동에너지가 흡수되어, 이 다리체의 족평 기구의 운동량이 감소하고, 그 착상 동작때에 이 다리체에 작용하는 충격 하중이 경감된다. 그리고 본 발명(제 1 발명)에서는, 다리체의 이상 상태에서의 상기 가변용적체의 팽창시에, 상기 팽창 제어 수단이, 상기 유입·유출 수단에 의한 가변용적체에의 상기 유체의 유입량을 이 보용형태에 따라 제어함으로써, 각 다리체의 착상 동작에 의한 가변용적체의 압축 개시전에서의 가변용적체의 압축 방향의 사이즈는, 로봇의 보용형태에 따른 소정의 사이즈로 제어되게 된다. 이 때문에, 각 다리체의 착상 동작에 의한 가변용적체의 압축량, 나아가서는, 이 가변용적체로부터의 유체의 유출량을 로봇의 보용형태(예를 들면 이동 속도 등의 보용형태)에 정합한 것으로 할 수 있다. 그 결과, 본 발명(제 1 발명)의 착상충격 완충장치에 의한 착상충격의 완충 효과를 로봇의 보용형태에 적합한 것으로 할 수 있다. 즉, 각 다리체의 착상 동작시에 이 다리체에 작용하는 상반력의 과도한 변화를 로봇의 보용형태에 적합한 것으로 할 수 있고, 나아가서는, 로봇의 자세의 안정화를 적절하게 도모할 수 있다.
또한, 일반적으로는, 로봇의 이동 속도가 빠를 수록, 각 다리체의 착상 동작전에 있어서의 가변용적체의 압축 방향의 사이즈를 크게 하는 것이 바람직하다. 이와 같이 하면, 가변용적체의 압축시에 가변용적체로부터 유출되는 유체의 유량이 많아지고, 그 유출 저항이 증가하여, 착상충격 완충장치의 댐핑 효과(운동에너지의 감쇠 효과)를 높일 수 있다.
이러한 본 발명(제 1 발명)에서는, 상기 유체는 압축성 유체인 것이 바람직하다(제 2 발명). 즉, 압축성 유체는, 스프링성을 갖기 때문에, 각 다리체의 착상 동작때에, 다리체의 운동에너지의 일부는 가변용적체의 내부의 압축성 유체의 탄성에너지로 변환된다. 그리고 그 탄성에너지는, 압축성 유체가 가변용적체의 압축에 따라 이 가변용적체로부터 유출되는 과정에서 유출 저항에 의해 해산된다. 이 결과, 각 다리체의 착상 동작때에, 가변용적체 및 그 내부의 압축성 유체를 통하여 다리체에 작용하는 상반력의 순간적인 급변이 발생하는 것을 회피하면서, 충격 하중을 더 효과적으로 경감할 수 있다.
또한, 상기 압축성 유체로서는, 공기 등의 기체나, 기포를 함유하는 액체 혹은 겔 등을 들 수 있다. 이 경우, 특히, 압축성 유체로서 기체를 사용한 경우에는, 이 압축성 유체가 경량의 것이 되고, 나아가서는 본 발명의 착상충격 완충장치를 경량의 것으로 할 수 있다.
이와 같이 압축성 유체를 사용하는 본 발명(제 2 발명)은, 상기 다리식 이동로봇이, 그 각 다리체의 족평 기구에 작용하는 상반력의 수평방향 축주위의모멘트(예를 들면 6축력센서 등에 의해 검출되는 모멘트)를 소정의 목표 모멘트에 추종시키도록 이 족평 기구의 위치 및 자세가 컴플라이언스 제어에 의해 제어되는 로봇일 경우에 매우 적합하다(제 3 발명). 즉, 압축성 유체의 스프링정수는, 상기 다리체의 착상 동작에 의한 상기 가변용적체의 압축에 의해 작아지므로, 상기 컴플라이언스 제어의 제어계의 안정성을 확보하면서 이 제어의 게인(컴플라이언스 게인)을 높일 수 있다. 그 결과, 각 족평 기구에 작용하는 수평방향 축주위의 모멘트의 목표 모멘트에의 추종성을 높일 수 있다. 따라서 착상시의 충격 하중을 적정하게 경감하면서, 로봇의 자세의 안정성을 확보할 수 있다.
더욱이, 본 발명(제 1∼제 3 발명)에서는, 상기 가변용적체는, 상기 각 다리체의 착상 동작때에 이 다리체의 족평 기구의 접지면부에 선행하여 접지하도록 이 다리체의 족평 기구의 바닥면측에 설치된 변형 가능한 백 형상(袋狀) 부재에 의해 구성되어 있는 것이 바람직하다(제 4 발명). 즉, 상기 백 형상 부재는, 각 다리체의 착상 동작때에, 이 다리체의 족평 기구의 접지면부에 선행하여 접지하고, 압축된다. 이 때, 이 백 형상 부재는, 바닥의 표면형상에 따르도록 하여 변형할 수 있기 때문에, 이 백 형상 부재가 접지할 수 있는 한, 바닥의 형상 등에 좌우되지 않고 본 발명의 착상충격 완충장치의 완충 기능을 발휘할 수 있다. 따라서 다리체의 착상 동작시의 충격 하중의 경감 효과의 확실성을 높일 수 있다. 또, 백 형상 부재는, 그 변형의 자유도가 높으므로, 각 다리체의 착상 동작때에 이 백 형상 부재에 여러 다양한 방향으로부터 상반력이 작용해도, 이 백 형상 부재가 파손되는 것과 같은 사태를 회피할 수 있다.
또, 본 발명(제 1∼제 4 발명)에서는, 상기 팽창 제어 수단은, 상기 각 다리체의 이상 상태에서의 상기 가변용적체에의 상기 유체의 유입시간에 기초하여 이 가변용적체의 압축 방향의 사이즈가 소정의 사이즈로 팽창했는지 아닌지를 판단하고, 이 가변용적체의 사이즈가 소정의 사이즈로 팽창했다고 판단했을 때, 상기 유입·유출 수단에 의한 가변용적체에의 유체의 유입을 차단하게 한다(제 5 발명). 이것에 의하면, 센서 등을 필요로 하지 않고, 비교적 간단한 구성으로 가변용적체의 팽창을 제어할 수 있다.
또는, 상기 가변용적체의 압축 방향의 사이즈에 따라 변화되는 물리량을 검출하는 센서를 구비하고 있고, 상기 팽창 제어 수단은, 이 센서의 검출 데이터에 기초하여 이 가변용적체의 압축 방향의 사이즈가 소정의 사이즈로 팽창했는지 아닌지를 판단하고, 이 가변용적체의 압축 방향의 사이즈가 소정의 사이즈로 팽창했다고 판단했을 때, 상기 유입·유출 수단에 의한 가변용적체에의 유체의 유입을 차단하게 한다(제 6 발명). 이것에 의하면, 각 다리체의 이상 상태에서 가변용적체를 팽창시켰을 때의 이 가변용적체의 최종적인 압축 방향의 사이즈를 확실하게 보용형태에 따른 소정의 사이즈로 제어할 수 있다.
더욱이, 본 발명(제 1∼제 6 발명)에서는, 상기 각 다리체의 족평 기구의 접지면부가 접지하고 있는지 아닌지를 검지하기 위한 센서가 구비되어 있고, 상기 팽창 제어 수단은, 상기 다리식 이동로봇의 목표 보용에 따라 정해지는 각 다리체의 착상의 예정 시각(각 다리체의 족평 기구가 그 접지면부를 통하여 접지하는 예정 시각)에서 상기 센서에 의해 상기 족평 기구의 접지면부의 접지가 검지되지 않을때, 상기 가변용적체의 압축 방향의 사이즈를 크게 하도록 상기 유입·유출 수단에 의한 이 가변용적체에의 유체의 유입을 제어하는 것이 바람직하다(제 7 발명).
즉, 각 다리체의 착상의 예정 시각에서, 상기 센서에 의해 상기 족평 기구의 접지면부의 접지가 검지되지 않을 때에는, 로봇의 이후의 동작을 행하기 위해서, 이 다리체의 족평 기구를 신속하게 바닥에 접지시킬 필요가 있다. 그리고, 이러한 경우에는, 이 족평 기구가 실제로 바닥에 접지했을 때에, 다리체에 작용하는 충격 하중이 큰 것으로 되기 쉽다. 여기에서, 본 발명에서는, 이러한 경우에는, 상기한 바와 같이, 가변용적체의 압축 방향의 사이즈를 크게 하도록 상기 유입·유출 수단에 의한 이 가변용적체에의 유체의 유입을 제어한다. 이것에 의해 가변용적체의 압축 가능량이 증가하여, 족평 기구가 실제로 접지할 때의 충격 하중을 적정하게 경감할 수 있다.
또, 본 발명(제 1∼제 4 발명)에서는, 상기 가변용적체의 압축 방향에서의 사이즈를 검출하는 센서를 구비하고 있고, 상기 팽창 제어 수단은, 상기 다리식 이동로봇의 보용형태에 따라 상기 가변용적체의 팽창시에서의 이 가변용적체의 압축 방향의 목표 사이즈의 경시변화 패턴을 설정하고, 상기 센서에 의해 검출되는 가변용적체의 압축 방향의 사이즈가 상기 목표 사이즈의 경시 변화 패턴을 따라서 변화하도록 상기 유입·유출 수단에 의한 가변용적체의 유체의 유출·유입을 제어하도록 해도 좋다(제 8 발명).
이것에 의하면, 가변용적체의 압축 방향의 사이즈를 축차 로봇의 보용형태에 적합한 것으로 제어하는 것이 가능하게 된다. 따라서, 본 발명의 착상충격 완충장치에 의한 완충 효과, 및, 로봇의 자세의 안정화의 효과를 높일 수 있다.
본 발명의 제 1 실시형태를 도 1~도 6을 참조하여 설명한다. 도 1은 본 실시형태의 다리식 이동로봇(1)의 전체의 기본 구성을 모식화하여 도시하는 측면도이다. 동 도면에 나타내는 바와 같이, 본 실시형태의 다리식 이동로봇(1)은, 예를 들면 그 상체(2)(동체)의 하단부로부터 뻗어설치된 좌우 한쌍(2개)의 다리체(3, 3)를 구비하는 2족 이동로봇이다. 또한, 상체(2)에는, 팔체나 머리부가 부착되어 있어도 좋다.
각 다리체(3)는, 대퇴부(4), 하퇴부(5), 족평 기구(6)를 상체(2)의 하단부로부터 고관절(7), 무릎관절(8), 발목관절(9)을 순서대로 통하여 접속해서 구성되어 있다. 보다 상세하게 말하면, 각 다리체(3)는, 상체(2)의 하단부로부터 고관절(7)을 통하여 대퇴부(4)를 뻗어 설치하는 동시에, 이 대퇴부(4)의 선단부에 무릎관절(8)을 통하여 하퇴부(5)를 연결하고, 또한, 이 하퇴부(5)의 선단부에 발목관절(9)을 통하여 족평 기구(6)를 연결한 구성으로 되어 있다. 그리고, 각 다리체(3)는 그 최선단측에 존재하는 족평 기구(6)를 통하여 바닥(A)에 접지 가능하게 되고, 그 접지에 의해 상체(2)를 지지한다. 이 경우, 각 다리체(3)의 고관절(7)은, 로봇(1)의 상하방향, 전후방향, 좌우측 방향의 3축 주위의 회전 동작이 가능하게 되고, 무릎관절(8)은, 좌우측 방향의 1축주위의 회전 동작이 가능하게 되고, 발목관절(9)은, 전후방향 및 좌우측 방향의 2축주위의 회전 동작이 가능하게 되어 있다. 이들 각 관절(7∼9)의 회전 동작에 의해, 각 다리체(3)는 인간의 다리체와 거의 동일한 운동을 행할 수 있게 되어 있다.
또, 각 다리체(3)의 각 관절(7∼9)에는, 그 각 축주위의 회전 동작을 행하기 위한 액추에이터로서의 전동 모터(도시하지 않음)가 설치되어 있다. 또한, 로봇(1)의 상체(2)에는, 이 로봇(1)의 다리체(3, 3)의 동작 제어(각 관절(7∼9)의 전동 모터의 동작 제어)를 행하는 제어장치(10)나, 로봇(1)의 동작용 전원으로서의 축전장치(11) 등이 탑재되어 있다. 제어장치(10)는 마이크로 컴퓨터 등을 포함하는 전자회로에 의해 구성된 것이다. 이 경우, 제어장치(10)는, 로봇(1)의 이동시에는, 인간과 동일하게, 양 다리체(3, 3)의 이상·착상 동작을 번갈아 반복함으로써, 로봇(1)을 이동시키도록 하고 있다. 그 이상·착상 동작의 반복은, 보다 상세하게 말하면, 다음과 같은 동작이다. 즉, 양 다리체(3, 3)중의 어느 한쪽을 지지다리로 하고 다른쪽을 미접지 다리로 한다. 그리고 지지다리측의 다리체(3)를 착상시킨 상태(이 다리체(3)의 족평 기구(6)를 바닥(A)에 접지시킨 상태)에서, 미접지 다리측의 다리체(3)를 이상시킨다(이 다리체(3)의 족평 기구(6)를 바닥(A)상으로부터 공중으로 들어 올림). 또한, 이상시킨 미접지 다리측의 다리체(3)의 족평 기구(6)을 공중에서 이동시킨 후, 원하는 장소에 착상시킨다. 그리고 그 착상시킨 미접지 다리측의 다리체(3)를 새롭게 지지다리라고 하는 동시에, 지금까지 지지다리로 되어 있었던 다리체(3)를 새롭게 미접지 다리라고 하고, 새롭게 미접지 다리로 된 다리체(3)을 상기 와 동일하게 움직인다. 이와 같은 다리체(3, 3)의 동작의 반복이, 로봇(1)의 이동때의 양 다리체(3, 3)의 이상·착상 동작의 반복이다.
각 다리체(3)의 족평 기구(6)의 구성을 도 2 및 도 3을 참조하여 더욱 설명한다. 도 2는 족평 기구(6)의 측면에서 본 단면도, 도 3은 이 족평 기구(6)의 바닥면측에서 본 평면도이다.
족평 기구(6)는, 대략 평판상의 족평 플레이트 부재(12)를 골격부재로서 구비하고 있다. 이 족평 플레이트 부재(12)는, 그 전단부(발끝부)과 후단부(발뒤꿈치부)는 약간 상방으로 만곡되어 있지만, 다른 부분은 평탄한 평판상으로 되어 있다. 또, 족평 플레이트 부재(12)의 상면부에는, 횡단면 사각형상의 통부재(13)가 그 축심을 상하 방향을 향하게 하여 고정 설치되어 있다. 이 통부재(13)의 내부에는, 이 통부재(13)의 내주면에 따르도록 하고 대략 상하방향으로 이동할 수 있게 설치된 가동판(14)이 설치되고, 이 가동판(14)이 발목관절(9)에 6축력센서(15)를 통하여 연결되어 있다. 이 6축력센서(15)는 족평 기구(6)에 작용하는 상반력(상세하게는, 전후, 좌우, 및 상하방향의 3축방향의 병진력, 및, 그 3축주위의 모멘트)을 검출하는 것이며, 그 검출 출력은 제어장치(10)에 입력된다.
또, 가동판(14)은, 그 하면의 둘레 가장자리부가 스프링, 고무 등의 탄성재로 이루어지는 복수의 탄성부재(16)(도면에서는 스프링으로서 기재하고 있음)를 통하여 족평 플레이트 부재(12)의 상면부에 연결되어 있다. 따라서 족평 플레이트 부재(12)는, 탄성부재(16), 가동판(14) 및 6축력센서(15)를 통하여 발목관절(9)에 연결되어 있다. 또한, 통부재(13)의 내부(가동판(14)의 하측의 공간)는, 도시 생략하는 구멍이나 간극을 통하여 대기측에 개방되어 있어, 대기중의 공기가 통부재(13)의 내부에 입출 자유롭게 되어 있다.
족평 플레이트 부재(12)의 바닥면(하면)에는, 접지 부재(17)가 부착되어 있다. 이 접지 부재(17)는, 족평 플레이트 부재(12)의 접지시에, 이 족평 플레이트부재(12)와 바닥면 사이에 개재시키는 탄성부재(바닥면에 직접적으로 접촉하는 탄성부재)이며, 본 실시형태에서는 족평 플레이트 부재(12)의 바닥면의 네 모퉁이(족평 플레이트 부재(12)의 발끝부의 양측부 및 발뒤꿈치부의 양 측부)에 고착되어 있다. 또, 접지 부재(17)는, 본 실시형태에서는 비교적 연질의 고무재로 이루어지는 연질층(17a)과, 비교적 경질의 고무재로 이루어지는 경질층(17b)을 상하에 중합하여 이루어지는 2층구조로 형성되고, 경질층(17b)이, 다리체(3)의 착상시에 직접적으로 바닥면에 접촉하는 접지면부로서 최하면측에 설치되어 있다.
족평 기구(6)에는, 상기한 구성의 것 이외에, 본 발명에 관계되는 착상충격 완충장치(18)가 구비되어 있다. 이 착상충격 완충장치(18)는, 족평 플레이트 부재(12)의 바닥면에 부착된 백 형상 부재(19)와, 이 백 형상 부재(19)의 내부에 대해 압축성 유체로서의 공기(대기중의 공기)를 입출시키기 위한 유입·유출 수단(20)을 구비하고 있다.
백 형상 부재(19)는, 그 주위에 상기 접지 부재(17)가 존재하도록 하여, 족평 플레이트 부재(12)의 바닥면의 대략 중앙부에 설치되어 있다. 이 백 형상 부재(19)는, 고무 등의 탄성재에 의해 변형 자유롭게 구성되어 있고, 외력에 의한 탄성변형이 발생하지 않는 자연상태에서는, 도 2에 도시하는 바와 같이, 상방으로 개구한 술통형의 바닥있는 용기 형상을 나타낸다. 그리고, 이 백 형상 부재(19)는, 그 개구 단부가 전체 둘레에 걸쳐서 족평 플레이트 부재(12)의 바닥면에 고착되고, 이 족평 플레이트 부재(12)에 의해 덮개 씌워져 있다. 또, 백 형상 부재(19)는, 술통형의 바닥있는 용기 형상을 나타내는 자연상태에서는, 이 백 형상부재(19)의 바닥부가 상기 접지 부재(17)보다도 하방으로 돌출하도록 설치되어 있다. 즉, 이 백 형상 부재(19)의 높이(족평 플레이트 부재(12)의 하면으로부터 백 형상 부재(19)의 바닥까지의 거리)는, 접지 부재(17)의 두께보다도 큰 것으로 되어 있다. 따라서, 족평 플레이트 부재(12)가 접지 부재(17)를 통하여 접지한 상태(다리체(3)의 착상 상태)에서는, 백 형상 부재(19)는, 도 1에서 착상 상태의 다리체(3)(도면에서는 로봇(1)의 전방측의 다리체(3))에 관하여 도시하는 바와 같이 상반력에 의해 백 형상 부재(19)의 높이 방향으로 압축된다.
여기에서 백 형상 부재(19)가 술통형의 바닥있는 용기 형상을 나타내는 자연상태는 이 백 형상 부재(19)의 팽창 상태이며, 이 팽창 상태에서는, 이하에 설명하는 유입·유출 수단(20)을 통하여 대기압과 동등 압력의 공기가 충전되어 있다. 또, 백 형상 부재(19)는, 탄성재에 의해 구성되어 있기 때문에, 압축되었을 때, 자연상태의 형상(술통형의 바닥있는 용기 형상)으로의 형상복원력을 갖는다. 또한, 백 형상 부재(19)의 자연상태의 형상은 반드시 술통형일 필요는 없고, 예를 들면, 바닥있는 원통 형상이라도 좋다.
상기 유입·유출 수단(20)은, 백 형상 부재(19)의 내부와 상기 통부재(13)의 내부를 연통시키도록 족평 플레이트 부재(12)에 뚫어 설치된 2개의 유통 구멍(유통로)(21, 22)과, 각 유통 구멍(21, 22)에 각각 통부재(13)내에서 접속되어서, 이 통부재(13)의 외부에 도출된 유체관로(23, 24)(유통로)를 갖추고, 이들 유체관로(23, 24)의 선단부(백 형상 부재(19)측과 반대측의 단부)는 대기중으로 개방되어 있다. 그리고 유체관로(23)에는, 이것을 통과하여 공기가 백 형상 부재내에 유입하는 것을 차단하는 역지밸브(25)가 설치되어 있다. 또, 유체관로(24)에는, 이것을 통과하여 백 형상 부재(19)내의 공기가 유출되는 것 차단하는 역지밸브(26)와, 상기 제어장치(10)에 의해 개폐 제어가능한 전자 밸브(27)가 설치되어 있다. 여기에서, 도 2에서는, 편의상, 유체관로(23, 24) 및 이것들에 설치된 역지밸브(25, 26), 전자 밸브(27)는 족평 기구(6) 등으로부터 이간하여 설치되어 있는 것과 같이 기재되어 있지만, 이것들은, 실제상은, 족평 기구(6) 등, 다리체(3)의 적당한 장소에 부착되고, 또는, 상기 통부재(13)내에 수용된다. 또한, 본 실시형태에서는 상기 유통 구멍(21, 22)은 스로틀 통로로 되어 있고, 유통 구멍(21)의 개구면적은, 유통 구멍(22)의 개구면적보다도 작은 것으로 되어 있다.
이와 같이 구성된 유입·유출 수단(20)에서는, 백 형상 부재(19)가 압축되면, 유통 구멍(21) 및 유체관로(23)를 통하여 백 형상 부재(19)내의 공기가 대기중으로 유출된다. 또, 전자 밸브(27)를 개방한 상태에서는, 백 형상 부재(19)가 압축 상태로부터 형상복원력에 의해 자연상태로 팽창함에 따라, 대기중의 공기가 유체관로(24) 및 유통 구멍(22)을 통하여 백 형상 부재(19)내에 유입되게 된다. 그리고 백 형상 부재(19)에 대한 공기의 입출때에는, 스로틀 통로로서의 유통 구멍(21, 22)에 의해, 유체저항이 발생하게 된다. 이 경우, 유통 구멍(21)의 개구면적은 작으므로, 백 형상 부재(19)로부터의 공기의 유출 저항은 비교적 크다. 반대로, 유통 구멍(22)의 개구면적은 비교적 크므로, 백 형상 부재(19)에의 공기의 유입 저항은 비교적 작다.
또한, 상기 전자 밸브(27)는, 이것을 개폐 제어하는 제어장치(10)와 더불어,본 발명에서의 팽창 제어 수단을 구성하는 것이다.
다음에, 본 실시형태에서, 로봇(1)을 이동시키기 위한 다리체(3)의 기본적인 동작 제어에 관하여 설명한다. 또한, 이 동작 제어(도 4의 STEP6 이외의 처리)는, 본원 출원인에 의한 일본 특개평 10-277969호 공보 등에서 상세하게 설명되어 있으므로, 여기에서는 개요를 설명한다.
로봇(1)의 상체(2)에 탑재되어 있는 상기 제어장치(10)는, 도 4의 플로우챠트에 나타내는 처리를 소정의 제어 사이클로 실행한다. 즉, 제어장치(10)는, 우선, 로봇(1)의 보용(다리체(3)의 발걸음의 형태)의 전환 타이밍인지 아닌지를 판단한다(STEP1). 여기에서, 보용의 전환 타이밍은, 지지다리의 전환 타이밍이며, 예를 들면 미접지 다리측의 다리체(3)가 착상했을 때(본 실시형태에서는 이 다리체(3)의 족평 기구(6)의 백 형상 부재(19)가 접지했을 때)의 타이밍이다. 이 타이밍의 판단은, 예를 들면 상기 6축력센서(15)의 출력 등에 기초하여 이루어진다.
그리고, STEP1에서 보용의 전환 타이밍일 경우에는, 제어장치(10)는, 제어 처리용 시간 t를 「0」으로 초기화 한 후(STEP2), 외부로부터 주어지는 로봇(1)의 동작 지령이나, 로봇(1)의 미리 정해진 이동 계획(어떠한 타이밍에서 로봇(1)을 어떻게 움직일지 등을 정한 계획)에 기초하여 보용 패러미터를 갱신한다(STEP3). 여기에서, 보용 패러미터는, 로봇(1)의 1보분의 목표 보용을 규정하는 패러미터이며, 예를 들면 보행, 주행 등의 로봇(1)의 이동 모드, 로봇(1)의 이동시의 보폭, 이동 속도(보행 주기) 등의 패러미터이다. 또, 로봇(1)의 목표 보용은, 상체(2)의 목표위치 및 자세의 궤도, 각 다리체(3)의 족평 기구(6)의 목표 위치 및 자세의 궤도, 목표 전체 상반력(양 다리체(3, 3)에 각각 작용하는 상반력의 합력의 목표값), 목표 ZMP(전체 상반력의 작용점의 목표 위치)의 궤도 등으로 구성되는 것이다. 또한, 목표 ZMP는, 보다 상세하게는, 상체(2)의 목표 위치 및 자세의 궤도, 및 각 다리체(3)의 족평 기구(6)의 목표 위치 및 자세의 궤도에 의해 정해지는 로봇(1)의 목표 운동 패턴에 따라 로봇(1)에 작용하는 관성력과 중력과의 합력에 동적으로 평형하는 전체 상반력(이 합력과 동일작용선상의 전체 상반력)의 작용점의 목표 위치이며, 그 전체 상반력의 연직방향 축주위의 모멘트이외의 모멘트(수평방향의 축주위의 모멘트)가 「0」이 되는 바닥상의 점(Zero Moment Point)의 목표 위치이다.
제어장치(10)는, 상기한 바와 같이 STEP3에서 새로운 보용 패러미터를 설정한 후, 또는, 상기 STEP1에서 보용의 전환 타이밍이 아닐 경우에는, STEP4의 처리를 실행하고, 현재의 제어 사이클에서의 목표 보용으로서의 순시 목표 보용을 현재 설정되어 있는 보용 패러미터에 기초하여 구한다. 즉, 현재 설정되어 있는 보용 패러미터에 의해 규정되는 로봇(1)의 1보분의 목표 보용중, 현재의 제어 사이클(현재시각 t)에서의 목표 보용(현재시각 t에서의 상체(2)의 목표 위치 및 자세, 각 족평 기구(6)의 목표 위치 및 자세, 목표 전체 상반력, 목표 ZMP)가 순간 목표 보용으로서 구해진다.
이어서, 제어장치(10)는, STEP5에서, 복합 컴플라이언스 동작의 제어 처리를 실행하고, STEP4에서 구한 순시 목표 보용중, 각 족평 기구(6)의 목표 위치 및 자세를 수정한다. 이 복합 컴플라이언스 동작의 처리에서는, 상체(2)의 목표자세(목표 경사각도)와, 도시하지 않은 자이로제 센서나 가속도 센서 등의 출력에 의해 검출되는 상체(2)의 실제 경사각도와의 편차에 따라, 상체(2)를 그 목표 자세로 복원시키기 위해서 목표 ZMP(목표 전체 상반력의 작용점) 주위에 발생시켜야 할 전체 상반력의 모멘트 성분(이하, 보상 전체 상반력 모멘트라고 함)이 구해진다. 여기에서, 구해지는 보상 전체 상반력 모멘트는, 수평방향의 축주위의 모멘트이며, 로봇(1)의 전후방향의 축주위의 모멘트 성분과, 좌우측 방향의 축주위의 모멘트 성분으로 이루어진다. 그리고 제어장치(10)는, 각 다리체(3)의 6축력센서(15)에 의해 각각 검출되는 각 다리체(3)마다의 실제 상반력의 합력(실제 전체 상반력)을, 접지 상태의 족평 기구(6)의 접지성을 확보할 수 있는 범위내에서, 상기 보상 전체 상반력 모멘트와 목표 전체 상반력과의 합력에 추종시키도록 각 족평 기구(6)의 목표 위치 및 자세를 수정한다. 이 경우, 목표 전체 상반력의 작용점으로서의 상기 목표 ZMP에서는, 목표 전체 상반력의 수평방향(전후방향 및 좌우측 방향)의 축주위의 모멘트 성분은 「0」이다. 따라서, 각 족평 기구(6)의 목표 위치 및 자세의 수정은, 실제 전체 상반력의 수평방향의 축주위의 모멘트 성분을 보상 전체 상반력 모멘트에 추종시키도록 행해진다. 또한, 이러한 각 족평 기구(6)의 목표 위치 및 자세의 수정시에는, 각 족평 기구(6)의 접지시에 있어서의 상기 탄성부재(16) 및 접지 부재(17)의 탄성변형의 영향을 보상하도록, 각 족평 기구(6)의 목표 위치 및 자세가 수정된다.
이어서, 제어장치(10)는, 상기 전자 밸브(27)의 제어 처리를 실행한다(STEP6). 또한, 이 제어 처리에 관해서는 후술한다.
이어서, 상기 STEP4에서 구해진 순시 목표 보용중의 상체(2)의 목표 위치 및 자세와, STEP5에서 수정된 각 족평 기구(6)의 목표 위치 및 자세로부터, 로봇(1)의 기하학 모델(강체 링크 모델)에 기초하는 키네마틱스 연산 처리에 의해, 양 다리체(3, 3)의 각 관절(7∼9)의 목표 변위량(보다 상세하게는 각 관절(7∼9)의 각 축주위의 목표 회전각)을 구한다(STEP7). 그리고 제어장치(10)는, 이 구한 목표 변위량에 각 관절(7∼9)의 실제 변위량을 추종시키도록, 각 관절(7∼9)을 구동하는 전동 모터(도시생략)의 토크를 제어한다(STEP8). 또한, 이 경우, 각 관절(7∼9)의 실제 변위량(각 관절(7∼9)의 각 축주위의 실제 회전각)은, 각 관절(7∼9)에 구비되는 로터리 엔코더 등에 의해 검출된다. 또한, 제어장치(10)는, 제어 처리용 시간 t를 소정의 시간 △t(제어 사이클의 주기에 사당하는 시간)만큼 증가시키고(STEP9), 도 4의 처리를 종료한다.
이상과 같은 제어장치(10)의 제어 처리에 의해, 로봇(1)은, 그 자세의 안정성을 자율적으로 확보하면서, 목표 보용에 추종하도록 하여 이동하게 된다.
한편, 상기 STEP6에서는, 제어장치(10)는, 도 5의 플로우챠트에 도시하는 바와 같이, 각 다리체(3) 마다, 그 다리체(3)에 대응하여 구비된 상기 전자 밸브(27)를 제어한다.
제어장치(10)는, 우선, 현재 설정되어 있는 보용 패러미터(로봇(1)의 이동 모드나, 보폭, 이동 속도 등)에 따라, 다리체(3)가 착상 상태로부터 이상 상태로 이행한 직후에 백 형상 부재(19)를 압축 상태로 유지하는 시간(기간)을 규정하는 압축 상태 유지시간 Thold와, 그 압축 상태의 유지의 해제후에 전자 밸브(27)를 개방제어하는 시간(기간)을 규정하는 밸브개방 시간 Topen을 설정한다(STEP11). 이 경우, 기본적으로는, 로봇(1)의 이동 속도가 빠를 수록, 압축 상태 유지시간 Thold는 짧은 시간으로 설정된다. 또, 밸브개방 시간 Topen은, 기본적으로는, 로봇(1)의 이동 속도가 빠를 수록, 긴 시간으로 설정된다. 단, 이들 압축 상태 유지시간 Thold 및 밸브개방 시간 Topen의 합은, 다리체(3)가 이상 상태로 유지되는 시간보다도 짧은 시간이다.
또한, 제어장치(10)는, 현재 설정되어 있는 보용 패러미터에 기초하여, 다리체(3)가 지지다리기가 되는 시간 Tsup(족평 기구(6)가 접지 부재(17) 혹은 백 형상 부재(19)를 통하여 접지한 상태로 유지되는 시간. 이하, 지지다리 시간 Tsup이라고 함)을 구한다(STEP12).
이어서, 제어장치(10)은, 현재시각 t(보용의 전환 차례로부터의 경과 시간)가, 0≤t<Tsup+Thold의 기간내에 있을지 아닌지, 즉, 다리체(3)의 족평 기구(6)의 백 형상 부재(19)가 거의 접지하기 시작했을 때(지지다리기의 개시시)로부터, 이 다리체(3)의 지지다리기의 종료후, 상기 압축 상태 유지시간 Thold가 경과할 때까지의 기간내에 있는지 아닌지를 판단한다(STEP13). 이 때, 0≤t<Tsup+Thold인 경우에는, 제어장치(10)는, 전자 밸브(27)를 개방제어한다(STEP14).
한편, STEP13에서, 0≤t<Tsup+Thold가 아닌 경우, 즉, 다리체(3)의 지지다리기의 종료후, 또한 압축 상태 유지시간 Thold가 경과한 후의 상태일 경우에는, 제어장치(10)는, 현재시각 t가, Tsup+Thold≤t<Tsup+Thold+Topen인지 아닌지를 판단한다(STEP15). 이 때, Tsup+Thold≤t<Tsup+Thold+Topen일 경우에는, 제어장치(10)는, 전자 밸브(27)를 개방제어한다(STEP16). 또, 제어장치(10)는, Tsup+Thold≤t<Tsup+Thold+Topen이 아닌 경우(이 경우에는 기본적으로는, 이상 상태의 다리체(3)의 착상 동작에 의해, 이 다리체(3)의 백 형상 부재(19)가 다시 접지하기 조금 전의 상태임)에는, 전자 밸브(27)를 개방제어한다(STEP17).
상술한 바와 같은 전자 밸브(27)의 제어에 의해, 도 6의 타이밍 차트에 도시하는 바와 같이 전자 밸브(27)는, 다리체(3)의 지지다리기의 개시시부터, 지지다리기의 종료후, 상기 압축 상태 유지시간 Thold가 경과할 때까지, 이 지지다리기의 전체 시간을 포함하여, 개방 유지된다. 따라서 이 상태에서는, 상기 백 형상 부재(19)내에는 대기중의 공기는 유입될 수 없다. 또, 전자 밸브(27)는, 다리체(3)의 미접지 다리기(백 형상 부재(19)를 포함하여 족평 기구(6)의 전체가 바닥(A)으로부터 떨어진 상태)에서, 밸브개방 시간 Topen만큼 개방 유지되고, 이 상태에서는, 백 형상 부재(19)내에는, 유체관로(24)를 통과하여 대기중의 공기가 백 형상 부재(19)내에 유입될 수 있다.
다음에, 상기 착상충격 완충장치(18)의 작동 및 효과를 설명한다. 상술한 제어장치(10)의 제어 처리에 의한 로봇(1)의 이동시에, 미접지 다리측의 다리체(3)(이상 상태의 다리체(3))의 착상 동작때는, 우선, 상기 백 형상 부재(19)가 접지한다. 그리고 다리체(3)의 착상 동작의 진행에 따라 이 백 형상 부재(19)에 작용하는 상반력에 의해, 백 형상 부재(19)가 압축된다.
이 때, 백 형상 부재(19)가 압축됨에 따라, 이 백 형상 부재(19)내의 공기가 압축·가압되고, 상기 유통 구멍(21) 및 유체관로(23)를 통하여 유출된다. 그리고이 때, 공기의 유출 저항이 유통 구멍(21)에서 발생한다. 이것에 의해 다리체(3)의 운동에너지가 감쇠한다. 또, 이 경우, 압축성 유체인 공기의 스프링성에 의해, 다리체(3)의 운동에너지의 일부가 이 공기의 탄성에너지로 변환되어서 흡수되고, 또한 그 탄성에너지가, 백 형상 부재(19)로부터의 공기의 유출 저항에 의해 해산된다. 이것에 의해 백 형상 부재(19)를 통하여 다리체(3)에 작용하는 상반력의 순간적인 급변을 피하면서, 다리체(3)의 착상 동작시의 충격 하중(착상충격)이 경감된다. 이 경우, 백 형상 부재(19)는 변형 자유롭고, 바닥(A)의 형상에 따라 변형되어 압축되기 때문에, 바닥(A)의 형상이나 착상 직전의 족평 기구(6)의 자세의 영향을 그다지 받지 않아 착상충격을 경감할 수 있는 동시에, 백 형상 부재(19)의 파손 등도 발생하기 어렵다.
또한, 백 형상 부재(19)는, 족평 기구(6)가 그 전방부 및 후방부의 접지 부재(17)을 통하여 접지하는 상태(다리체(3)의 착상 동작이 완료된 상태)로 될 때까지 압축된다.
계속해서, 다리체(3)의 이상 동작에 의해, 백 형상 부재(19)는, 자신의 형상복원력에 의해 팽창하려고 하지만, 상기한 바와 같이 전자 밸브(27)는, 다리체(3)의 지지다리기의 종료후, 상기 압축 상태 유지시간 Thold가 경과할 때까지 개방 유지되어 있다. 이 때문에, 다리체(3)의 이상 동작의 개시 직후에 족평 기구(6)가 접지 부재(17)를 통하여 접지하고 있는 상태는 물론, 족평 기구(6)의 접지 부재(17)가 바닥(A)으로부터 떨어지고 나서, 압축 상태 유지시간 Thold가 경과할 때까지는, 백 형상 부재(19)에는, 대기중의 공기가 유입될 수 없다. 따라서 이 백형상 부재(19)는, 족평 기구(6)가 착상 상태로부터 이상 상태로 이행한 후, 상기 압축 상태 유지시간 Thold가 경과할 때까지 팽창하지 않는다.
그리고 족평 기구(6)가 완전하게 바닥(A)으로부터 떨어지고, 상기 압축 상태 유지시간 Thold가 경과하면, 상기 전자 밸브(27)가, 상기 밸브개방 시간 Topen만큼 개방 유지된다. 이 때, 백 형상 부재(19)는, 자신의 자연상태에의 복원력에 의해 팽창하면서, 그 내부에 대기중의 공기가 유체관로(24)를 통하여 유입된다. 이 경우, 밸브개방 시간 Topen은, 백 형상 부재(19)가 자연상태로 팽창할 때까지 요하는 시간 이하의 시간으로 설정되어 있다. 따라서 밸브개방 시간 Topen의 경과시에 있어서의 팽창 상태의 백 형상 부재(19)의 높이는, 밸브개방 시간 Topen에 따른 것이 된다. 그리고 이와 같이 백 형상 부재(19)가 팽창한 상태에서, 다리체(3)의 착상 동작이 다시 행해지고, 상기한 바와 같이 그 착상 동작때의 착상충격이 경감된다.
이상에서 설명한 바와 같은 본 실시형태의 착상충격 완충장치(18)의 작동에 의해, 각 다리체(3)의 착상 동작때의 착상충격을 경감할 수 있다. 이 경우, 본 실시형태에서는 다리체(3)의 착상 상태에서는, 백 형상 부재(19)에 공기가 유입되지 않아, 이 백 형상 부재(19)가 팽창하지 않는다. 이 때문에, 백 형상 부재(19)의 개소에 상반력을 작용시키지 않고, 족평 기구(6)의 착상 상태에서의 자세제어에 의해, 이 족평 기구(6)의 원하는 부위에 집중적으로 상반력을 작용시키도록 할 수 있다. 예를 들면 로봇(1)이 꺼꾸러지듯이 넘어질 것 같이 되었을 때에, 족평 기구(6)의 전단측에 상반력을 집중시키도록 할 수 있다. 이 결과, 로봇(1)의 자세의 안정화를 용이하게 도모할 수 있다. 또한, 이것에 관하여, 보충설명을 하면,가령 다리체(3)의 착상 상태에서 전자 밸브(27)를 개방한 상태로 해 두면, 백 형상 부재(19)에는, 대기중의 공기가 유입되려고 하기(백 형상 부재(19)가 항상 부풀려고 하기) 때문에, 이 백 형상 부재(19)의 개소에는 항상 상반력이 작용하게 된다. 이 때문에, 족평 기구(6)의 원하는 부위에 상반력을 집중시킬 수 없어, 족평 기구(6)의 착상 상태에서의 자세제어에 의한 로봇(1)의 자세의 안정화에 한계가 발생하기 쉽게 된다. 이에 반해, 본 실시형태의 착상충격 완충장치(18)에서는, 상술한 바와 같이 로봇(1)의 자세의 안정화의 한계를 높일 수 있다.
또한, 백 형상 부재(19)는, 다리체(3)가 착상 상태로부터 이상 상태로 이행한 직후까지, 압축 상태로 유지되기 때문에, 다리체(3)의 족평 기구(6)가 바닥(A)으로부터 떨어질 때에, 백 형상 부재(19)가 팽창하여, 바닥(A)에 접지해버리는 것과 같은 일이 없다. 이 결과, 다리체(3)의 이상 동작때에 차질을 발생하거나 하지 않아, 원활하게 다리체(3)의 이상 동작을 행할 수 있다. 그리고 이 경우, 다리체(3)가 이상 상태로 이행한 직후에 백 형상 부재(19)를 압축 상태로 유지하는 시간, 즉, 상기 압축 상태 유지시간 Thold는, 로봇(1)의 이동 속도가 빠를 수록, 짧으므로, 필요 최저한의 시간에 그치게 할 수 있다. 그 때문에 그 후에, 백 형상 부재(19)를 팽창시키기 위한 시간을 충분하게 확보할 수 있다.
또, 본 실시형태에서는 다리체(3)의 이상 상태에서 백 형상 부재(19)가 팽창할 때의 백 형상 부재(19)의 높이의 상한, 즉, 다리체(3)의 착상 동작 직전에서의 백 형상 부재(19)의 높이(이것은 백 형상 부재(19)의 압축 방향의 사이즈임)가, 상기 밸브개방 시간 Topen(백 형상 부재(19)에 공기를 유입시키는 시간)에 의해 규정된다. 그리고 이 밸브개방 시간 Topen은, 보용 패러미터에 따라 설정되고, 기본적으로는, 로봇(1)의 이동 속도가 빠를 수록, 긴 시간으로 설정된다. 이 때문에, 로봇(1)의 이동 속도가 빠를 수록, 다리체(3)의 착상 동작의 직전의 백 형상 부재(19)의 높이가 높아진다. 따라서 로봇(1)의 이동 속도가 빠를 수록, 다리체(3)의 착상 동작때의 백 형상 부재(19)의 압축량이 커진다. 그 결과, 착상충격 완충장치(18)에 의한 착상충격의 경감 효과를 로봇(1)의 보용형태에 적합한 것으로 할 수 있어, 로봇(1)의 보용형태에 좌우되지 않고, 원활하게 착상충격을 경감할 수 있다.
또, 본 실시형태의 착상충격 완충장치(18)는, 다음과 같은 효과도 이룰 수 있다. 즉, 백 형상 부재(19)내에 대해 입출하는 유체는 압축성 유체의 공기이기 때문에, 착상충격 완충장치(18)를 경량으로 구성할 수 있다. 또한, 다리체(3)의 착상 동작때에, 백 형상 부재(19)내의 압력이 순간적으로 증가하지 않아, 어느 정도의 시정수를 가지고 상승하기 때문에, 상반력의 급변을 피할 수 있다. 또, 백 형상 부재(19)의 압축시에 이 백 형상 부재(19)로부터 유출되는 공기는 대기중으로 방출되는 동시에, 이 백 형상 부재(19)의 팽창시에는 대기중으로부터 새로운 공기가 이 백 형상 부재(19)내에 유입되기 때문에, 백 형상 부재(19)로부터의 공기의 유출 저항에 따르는 발열이 백 형상 부재(19)내에 축적되지 않는다. 즉, 착상충격 완충장치(18)의 방열성이 좋아 방열기 등의 발열대책 기기를 구비할 필요가 없다.
또, 다리체(3)의 착상 동작때에 스프링으로서 기능하는 백 형상 부재(19)내의 공기의 스프링정수는, 백 형상 부재(19)의 접지 직후의 압축에 따라 작아지기때문에, 전술의 복합 컴플라이언스 동작의 제어의 효과를 높일 수 있다. 즉, 로봇(1)의 복합 컴플라이언스의 동작의 제어에서는, 전술한 바와 같이, 실제 전체 상반력의 수평방향의 축주위의 모멘트 성분(이하, 여기에서는, 실제 전체 상반력 모멘트라고 함)을, 그 모멘트 성분의 목표값으로서의 보상 전체 상반력 모멘트(보상 전체 상반력 모멘트가 「0」일 경우도 포함함)에 추종시키도록 각 족평 기구(6)의 위치 및 자세가 수정된다. 그리고, 이와 같은 복합 컴플라이언스 동작 제어는, 바닥(A)에 경사가 있는 경우라도, 족평 기구(6)의 착상 위치 및 자세를 바닥(A)면에 순응시켜, 로봇(1)의 자세의 안정성을 확보하기 위한 것이다. 이 경우, 상기 실제 전체 상반력 모멘트의 보상 전체 상반력 모멘트 에의 추종성을 높이기 위해서는, 복합 컴플라이언스 동작 제어에서의 컴플라이언스 게인, 즉, 실제 전체 상반력 모멘트와 보상 전체 상반력 모멘트 사이의 편차의 변화에 대한 족평 기구(6)의 목표 착상 위치 및 자세의 변화량(발목관절(9)의 회전각의 변화량)을 크게하는 것이 바람직하다. 단, 상기 컴플라이언스 게인을 크게 채용하면, 일반적으로는, 복합 컴플라이언스 동작 제어의 루프 게인(이것은, 대강, 상기 컴플라이언스 게인과, 족평 기구(6)가 갖는 스프링 기구(상기 접지 부재(17), 탄성부재(16), 및 착상충격 완충장치(18))의 토털적인 스프링정수와의 적(積)에 비례함)이 커져, 제어계가 불안정하게 되기 쉽다.
그런데, 본 실시형태의 착상충격 완충장치(18)의 백 형상 부재(19)내의 공기의 스프링정수는, 백 형상 부재(19)의 접지 직후의 압축에 따라 작아지기 때문에, 상기 루프 게인이 작아진다. 그 결과, 상기 컴플라이언스 게인을 높여도, 복합 컴플라이언스 동작 제어의 안정성을 확보할 수 있다. 따라서 실제 전체 상반력 모멘트의 보상 전체 상반력 모멘트에의 추종성을 높일 수 있고, 나아가서는, 로봇(1)의 자세의 안정성의 확보를 높일 수 있다.
다음에 본 발명의 제 2 실시형태를 도 7을 참조하여 설명한다. 도 7은 본 실시형태의 주요부의 작동을 설명하기 위한 플로우챠트이다. 또한, 본 실시형태는, 상기 제 1 실시형태의 것과, 상기 전자 밸브(27)의 제어 처리의 일부만이 다은 것이므로, 상기 제 1 실시형태와 동일한 참조 부호를 사용한다. 그리고, 제 1 실시형태와 동일 구성 부분에 대해서는 설명을 생략한다.
상기 제 1 실시형태에서는 시각정보에만 기초하여 전자 밸브(27)의 개폐의 타이밍을 정하도록 했는데, 로봇(1)의 다리체(3)의 착상 동작시의 실제의 접지 타이밍(족평 기구(6)의 백 형상 부재(19)가 접지하는 타이밍)이 예정 시각보다도 늦은 경우에는, 제어장치(10)는 신속하게 다리체(3)를 착상시키기 위해서, 족평 기구(6)를 적극적으로 하강시킨다. 이 때문에, 이 족평 기구(6)의 착상 동작시에 통상보다도 큰 착상충격이 발생하기 쉽게 된다.
본 실시형태는, 이와 같은 사태에 대처하는 것이며, 제어장치(10)는, 상기 도 4의 STEP6에서, 도 7의 플로우챠트에 도시하는 바와 같이 전자 밸브(27)를 제어한다. 즉, 본 실시형태에서는 제어장치(10)는, 상기 제 1 실시형태에서의 도 5의 STEP11, 12의 처리와 동일한 처리를 STEP21, 22에서 실행한 후, STEP23에서, 현재시각 t가 0≤t<Tsup인지 아닌지, 즉, 현재시각 t가 다리체(3)의 지지다리기내에 있는지 아닌지를 판단한다. 이 때, 0≤t<Tsup일 경우에는, 제어장치(10)는, 또한,다리체(3)의 족평 기구(6)가 그 접지 부재(17) 혹은 백 형상 부재(19)를 통하여 실제로 접지하고 있는지 아닌지를 판단한다(STEP24). 이 판단은, 예를 들면 상기 6축력센서(15)의 출력에 기초하여 이루어진다. 그리고 이 STEP24에서, 족평 기구(6)가 접지하고 있을 경우에는, 전자 밸브(27)를 개방제어한다(STEP25). 또, STEP24에서 족평 기구(6)가 접지하고 있지 않은 경우에는, 전자 밸브(27)를 밸브개방 제어한다(STEP26).
또, STEP23에서, 0≤t<Tsup이 아닐 경우에는, 제어장치(10)는, 다음에 상기 제 1 실시형태에서의 도 5의 STEP15와 동일한 판단 처리, 즉, 현재시각 t가 Tsup+Thold≤t<Tsup+Thold+Topen인지 아닌지의 판단을 STEP27에서 실행한다. 그리고 이 판단 결과에 따라, 상기 제 1 실시형태와 동일하게 전자 밸브(27)의 개폐 제어를 STEP28 또는 STEP29에서 실행한다. 또한, 이 경우, 본 실시형태에서는 STEP27에서 Tsup+Thold≤t<Tsup+Thold+Topen이 아닌 상태는, Tsup≤t<Tsup+Thold인 상태가 포함된다. 따라서 Tsup≤t<Tsup+Thold인 상태에서는, 상기 제 1 실시형태와 동일하게, 전자 밸브(27)가 STEP29에서 밸브폐쇄 제어된다.
상술한 바와 같은 전자 밸브(27)의 개폐 제어에 의해, 다리체(3)의 지지다리기에서 족평 기구(6)가 접지 부재(17) 혹은 백 형상 부재(19)를 통하여 접지하고 있는 경우, 즉, 목표 보용에 의한 예정대로 다리체(3)의 이상·착상 동작이 행해지고 있는 경우에는, 상기 제 1 실시형태와 완전히 동일하게, 전자 밸브(27)의 개폐 제어가 이루어진다. 따라서 이 경우에는, 본 실시형태의 착상충격 완충장치(18)에 의한 작동 및 효과는, 상기 제 1 실시형태와 동일하다.
한편, 다리체(3)의 지지다리기(0≤t<Tsup)에서 족평 기구(6)가 접지 부재(17) 혹은 백 형상 부재(19)를 통하여 접지하지 있지 않은 경우, 즉, 예를 들면 다리체(3)의 착상 동작시에 이 다리체(3)의 백 형상 부재(19)가 접지해야 할 시간에 아직 이 백 형상 부재(19)가 접지하고 있지 않은 것과 같은 경우에는, 전자 밸브(27)가 밸브개방 제어된다. 또한, 이 경우, 전자 밸브(27)는 반드시 완전개방 상태로 할 필요는 없고, 예를 들면 반개방 상태로 제어하도록 해도 좋다.
이와 같이, 전자 밸브(27)가 밸브개방 제어되기 때문에, 다리체(3)의 이상 상태에서의 상기 밸브개방 시간 Topen의 경과시에 전자 밸브(27)가 폐쇄됨으로써 팽창이 중단된 백 형상 부재(19)가 다시 팽창하면서, 이 백 형상 부재(19)의 내부에 공기가 유입되고, 이 백 형상 부재(19)의 높이가 증가한다. 그 결과, 다리체(3)의 족평 기구(6)를 신속하게 접지시키기 위해 이 족평 기구(6)를 하강시켜도, 다리체(3)의 착상충격을 확실하게 경감할 수 있다.
다음에 본 발명의 제 3 실시형태를 도 8 및 도 9를 참조하여 설명한다. 도 8은 본 실시형태의 착상충격 완충장치를 구비한 족평 기구의 주요부를 모식화하여 도시한 도면, 도 9는 본 실시형태의 주요부의 작동을 설명하기 위한 플로우챠트이다. 또한, 본 실시형태에서는 족평 기구는, 착상충격 완충장치에 관계되는 구성을 제외하고 상기 제 1 실시형태의 것과 동일하여, 도 8에서는, 족평 기구의 주요부 구성만을 기재하고 있다. 또, 본 실시형태의 설명에서는, 상기 제 1 실시형태와 동일 구성 부분 혹은 동일 기능 부분에 대해서는, 제 1 실시형태와 동일한 참조 부호를 사용하고, 설명을 생략한다.
도 8을 참조하고, 본 실시형태에서는 족평 플레이트 부재(12)의 바닥면에 부착된 백 형상 부재(19)의 내부의 바닥면부에는, 플레이트 부재(28)가 고정 설치되고, 이 플레이트 부재(28)로부터 상방을 향해서 뻗어 설치된 로드 부재(29)가 족평 플레이트 부재(12)를 상하 방향(백 형상 부재(19)의 압축 방향)으로 슬라이딩 하도록 관통하고, 이 족평 플레이트 부재(12)의 상측으로 돌출하고 있다. 따라서 이 로드 부재(29)의 돌출 부분의 길이(이하, 돌출량이라고 함)는, 백 형상 부재(19)가 압축됨에 따라, 커지고, 백 형상 부재(19)의 높이에 따른 것으로 된다. 그리고 이 로드 부재(29)의 돌출 부분에는, 그 돌출량, 나아가서는, 백 형상 부재(19)의 높이(백 형상 부재(19)의 압축 방향의 사이즈)를 검출하기 위한 센서로서, 리니어 포텐셔미터(30)가 장착되어 있고, 이 리니어 포텐셔미터(30)의 출력 신호는, 상기 제 1 실시형태의 것과 동일 구성의 유입·유출 수단(20)의 전자 밸브(27)의 개폐 제어를 상기 제어장치(10)에 의해 행하기 위해서, 이 제어장치(10)에 입력되게 되어 있다. 이상에서 설명한 이외의 구성(전자 밸브(27)의 개폐 제어 이외의 제어장치(10)의 제어 처리를 포함함)은, 상기 제 1 실시형태와 동일하다.
또, 본 실시형태에서는 상기 제어장치(10)는, 상기 도 4의 STEP6에서, 도 9의 플로우챠트에 도시한 바와 같이 전자 밸브(27)를 제어한다. 즉, 제어장치(10)는, 우선, 현재 설정되어 있는 보용 패러미터(로봇(1)의 이동 모드나, 보폭, 이동 속도 등)에 따라, 상기 제 1 실시형태에서 설명한 상기 압축 상태 유지시간 Thold와, 다리체(3)의 이상 상태에서 백 형상 부재(19)를 팽창시킬 때의 이 백 형상 부재(19)의 상한의 높이의 목표값 Hcmd(이하, 목표 팽창 높이 Hcmd이라고 함)를 설정한다(STEP31). 이 경우, 압축 상태 유지시간 Thold의 설정의 방법은, 상기 제 1 실시형태와 동일하다. 또, 목표 팽창 높이 Hcmd는, 기본적으로는, 로봇(1)의 이동 속도가 빠를 수록, 큰 높이로 설정된다. 단, 본 실시형태에서는 목표 팽창 높이 Hcmd는 백 형상 부재(19)의 자연상태에서의 높이 이하의 높이이다.
또한, 제어장치(10)는, 상기 제 1 실시형태에서의 도 5의 STEP12와 동일하게, 현재 설정되어 있는 보용 패러미터에 기초하여 다리체(3)가 지지다리기가 되는 지지다리 시간 Tsup를 구한다(STEP32).
이어서, 제어장치(10)는, 현재시각 t(보용의 전환차례의 경과 시간)이, 0≤t<Tsup+Thold의 기간내에 있는지 아닌지를 판단한다(STEP33). 이 때, 0≤t<Tsup+Thold인 경우에는, 제어장치(10)는, 전자 밸브(27)를 개방제어한다(STEP34). 이 STEP33, 34의 처리는, 상기 제 1 실시형태의 도 5의 STEP13, 14의 처리와 동일하다.
한편, STEP33에서 0≤t<Tsup+Thold가 아닌 경우에는, 제어장치(10)는, 또한, 상기 리니어 포텐셔미터(30)의 출력에 의해 백 형상 부재(19)의 현재의 백 형상 부재(19)의 실제의 높이 Hact를 검출하고(STEP35), 이 검출한 높이 Hact를 상기 목표 팽창 높이 Hcmd와 비교한다(STEP36). 그리고 제어장치(10)는, Hact<Hcmd일 경우에는, 전자 밸브(27)을 개방제어하고(STEP37), Hact≥Hcmd일 경우에는, 전자 밸브(27)을 폐쇄제어한다(STEP38).
상술한 바와 같은 전자 밸브(27)의 개폐 제어에 의해, 다리체(3)의 착상 상태와, 그 착상 상태로부터 이상 상태로의 이행 직후에 있어서 백 형상 부재(19)가압축 상태로 유지되는 것은 상기 제 1 실시형태와 완전히 동일하다.
한편, 본 실시형태에서는 다리체(3)의 이상 상태에서의 전자 밸브(27)의 밸브개방후의 백 형상 부재(19)의 팽창시에는, 백 형상 부재(19)의 실제의 높이 Hact가 보용 패러미터에 따라 설정된 목표 팽창 높이 Hcmd로 되었을 때에, 전자 밸브(27)가 개방제어되어서, 백 형상 부재(19)에의 공기의 유입이 차단된다. 그 결과, 로봇(1)의 착상전의 백 형상 부재(19)의 높이는 목표 팽창 높이 Hcmd로 제어된다. 따라서 상기 제 1 실시형태와 동일하게, 착상충격 완충장치(18)에 의한 착상충격의 경감 효과를 로봇(1)의 보용형태에 적합한 것으로 할 수 있고, 로봇(1)의 보용형태에 좌우되지 않고, 원활하게 착상충격을 경감할 수 있다. 그리고 이 경우, 백 형상 부재(19)의 높이가 확실하게 로봇(1)의 보용형태에 따른 목표 팽창 높이 Hcmd로 제어되므로, 착상충격의 경감 효과를 양호하게 확보할 수 있다.
다음에 본 발명의 제 4 실시형태를 도 10을 참조하여 설명한다. 도 10은 본 실시형태의 주요부의 작동을 설명하기 위한 플로우챠트이다. 또한, 본 실시형태는, 상기 제 3 실시형태의 것과, 상기 전자 밸브(27)의 제어 처리의 일부만이 다른 것이므로, 상기 제 1 실시형태와 동일한 참조 부호를 사용한다. 그리고 제 3 실시형태와 동일 구성 부분에 대해서는 설명을 생략한다.
본 실시형태는, 상기 제 2 실시형태와 동일하게, 다리체(3)의 족평 기구(6)가 예정 시각보다도 늦게 접지하는 경우를 고려한 것이다. 그리고 상기제어장치(10)는, 상기 도 4의 STEP6에서, 도 10의 플로우챠트에 나타낸 바와 같이 전자 밸브(27)를 제어한다. 즉, 제어장치(10)는, 상기 제 3 실시형태에서의도 9의 STEP31, 32의 처리와 동일한 처리를 STEP41, 42에서 실행한 후, STEP 43에서, 현재시각 t가 0≤t<Tsup인지 아닌지, 즉, 현재시각 t가 다리체(3)의 지지다리기내에 있는지 아닌지를 판단한다. 이 때, 0≤t<Tsup일 경우에는, 제어장치(10)는, 또한, 다리체(3)의 족평 기구(6)가 그 접지 부재(17) 혹은 백 형상 부재(19)를 통하여 실제로 접지하고 있는지 아닌지를 판단한다(STEP44). 이 판단은, 예를 들면 상기 6축력센서(15)의 출력에 기초하여 이루어진다. 그리고 이 STEP44에서, 족평 기구(6)가 접지하고 있을 경우에는, 전자 밸브(27)를 개방제어한다(STEP45).
또, STEP44에서 족평 기구(6)가 접지하고 있지 않은 경우에는, 제어장치(10)는, 현재 설정되어 있는 목표 팽창 높이 Hcmd를 증가시킨다(STEP46). 이 경우, 목표 팽창 높이 Hcmd의 증가량은 예를 들면 미리 정한 단위증가량으로 한다. 또한, 제어장치(10)는, 상기 리니어 포텐셔미터(30)의 출력에 의해 백 형상 부재(19)의 현재의 백 형상 부재(19)의 실제의 높이 Hact를 검출하고(STEP47), 이 검출한 높이 Hact를 목표 팽창 높이 Hcmd와 비교한다(STEP48).
그리고 제어장치(10)는, Hact<Hcmd일 경우에는, 전자 밸브(27)를 밸브개방 제어하고(STEP49), Hact≥Hcmd일 경우에는, 전자 밸브(27)를 개방제어한다(STEP45).
한편, 상기 STEP43에서 현재시각 t가 0≤t<Tsup이 아닐 경우에는, 제어장치(10)는, 다음에 현재시각 t가 Tsup≤t<Tsup+Thold인지 아닌지를 판단한다(STEP50). 이 때, Tsup≤t<Tsup+Thold일 경우에는, 제어장치(10)는, 전자 밸브(27)를 개방제어한다(STEP51). 또, Tsup≤t<Tsup+Thold가 아닌 경우에는, 제어장치(10)는, 전술한 STEP47로부터의 처리를 실행하고, 백 형상 부재(19)의 실제의 높이 Hact와 목표 팽창 높이 Hcmd와의 비교에 기초하여 전자 밸브(27)를 개폐 제어한다.
이상에서 설명한 전자 밸브(27)의 개폐 제어에 의해, 다리체(3)의 지지다리기에서 족평 기구(6)가 접지 부재(17) 혹은 백 형상 부재(19)를 통하여 접지하고 있을 경우, 즉, 목표 보용에 의한 예정대로 다리체(3)의 이상·착상 동작이 이루어지고 있을 경우에는, 상기 제 3 실시형태와 완전히 동일하게, 전자 밸브(27)의 개폐 제어가 이루어진다. 따라서 이 경우에는, 본 실시형태의 착상충격 완충장치(18)에 의한 작동 및 효과는, 상기 제 3 실시형태와 동일하다.
한편, 다리체(3)의 지지다리기(0≤t<Tsup)에서 족평 기구(6)가 접지 부재(17) 혹은 백 형상 부재(19)를 통하여 접지하고 있지 않은 경우, 즉, 예를 들면 다리체(3)의 착상 동작시에 이 다리체(3)의 백 형상 부재(19)가 접지해야할 시각에 아직 이 백 형상 부재(19)이 접지하지 않은 것과 같은 경우에는, 목표 팽창 높이 Hcmd가 증가되어서, 전자 밸브(27)가 개방제어된다. 그리고 이 때, 전자 밸브(27)의 개방, 즉, 백 형상 부재(19)에의 공기의 유입은, 백 형상 부재(19)의 실제의 높이가 증가된 목표 팽창 높이 Hcmd로 될 때까지 실행된다. 이것에 의해 백 형상 부재(19)의 높이가 본래의 보용형태에 따른 높이보다도 커지도록 이 백 형상 부재(19)가 팽창된다. 단, 본 실시형태에서는 백 형상 부재(19)내에 유입되는 공기는 대기압의 공기이기 때문에, 백 형상 부재(19)의 팽창시의 높이의 상한은, 이 백 형상 부재(19)의 자연상태에서의 높이이다.
이와 같이, 다리체(3)의 착상 동작시에 이 다리체(3)의 백 형상 부재(19)가 접지해야 할 시각에 아직 이 백 형상 부재(19)가 접지하지 않은 것과 같은 경우에는, 백 형상 부재(19)의 내부에 공기를 유입시켜서 백 형상 부재(19)의 높이를 증가시키므로, 다리체(3)의 족평 기구(6)를 신속하게 접지시키기 위해 이 족평 기구(6)를 하강시켜도, 다리체(3)의 착상충격을 확실하게 경감할 수 있다.
또한, 상기 제 3 및 제 4 실시형태에서는 백 형상 부재(19)의 높이 Hact를 리니어 포텐셔미터(30)에 의해 검출하도록 했는데, 레이저광 등을 이용한 거리측정 센서에 의해 검출하게 해도 좋다. 또, 백 형상 부재(19)의 팽창시의 내부의 압력은, 일반적으로, 백 상태 부재(19)의 높이와 상관성을 가지므로, 백 형상 부재(19)내의 압력을 압력센서에 의해 검출하고, 그 검출 압력에 기초하여 전자 밸브(27)의 개폐 제어를 행함으로써 백 형상 부재(19)의 팽창시의 높이를 제어하도록 해도 좋다.
또, 이상에서 설명한 제 1∼제 4 실시형태에서는 백 형상 부재(19)를 압축 상태로 유지하거나, 또는, 백 형상 부재(19)의 팽창시의 높이를 제어하기 위해서, 백 형상 부재(19)에의 공기의 유입을 전자 밸브(27)를 통하여 제어함으로써 행하도록 했는데, 백 형상 부재(19)의 압축팽창의 제어를 위해서, 예를 들면, 도 11에 도시하는 바와 같은 기구적 수단 또는 도 12에 도시하는 바와 같은 전자적 수단을 사용하도록 해도 좋다. 또한, 이들 도 11, 12에서는, 상기 도 8과 동일하게, 족평 기구(6)의 주요부 구성만을 기재하고 있다.
도 11에 도시하는 예에서는, 상기 제 3 실시형태의 것과 동일하게, 백 형상부재(19)의 내부의 바닥면부에 플레이트 부재(31)가 고정 설치되고, 이 플레이트 부재(31)로부터 상방을 향해서 뻗어 설치된 로드 부재(32)가 족평 플레이트 부재(12)를 상하 방향(백 형상 부재(19)의 압축 방향)으로 슬라이딩 하도록 관통하여, 이 족평 플레이트 부재(12)의 상측에 돌출하고 있다. 그리고 이 로드 부재(32)에 원웨이 클러치 기구(33)가 장착되어 있고, 이 원웨이 클러치 기구(33)는, 백 형상 부재(19)의 압축 방향(로드 부재(32)가 상방향 이동하는 방향)에서는 로드 부재(32)를 이동 자유롭게 하는 동시에, 백 형상 부재(19)의 팽창 방향(로드 부재(32)가 하방향 이동하는 방향)에서는, 상기 제어장치(10)로부터 주어지는 지령 등에 의해, 로드 부재(32)를 결합(로킹) 가능하게 하고 있다. 이와 같은 기구를 구비한 경우에는, 다리체(3)의 착상 동작에 의해, 백 형상 부재(19)가 압축 상태로 된 후(족평 기구(6)가 그 전방부 및 후방부의 접지 부재(17)를 통하여 접지한 후), 다리체(3)가 착상 상태로부터 이상 상태로 이행한 직후(상기 제 1∼제 4 실시형태에서 그 이상 상태로의 이행 직후에 전자 밸브(27)를 폐쇄상태로부터 개방상태로 전환하는 타이밍)까지, 로드 부재(32)를 원웨이 클러치 기구(33)에 의해 걸어서, 상기 제 1∼제 4 실시형태와 동일하게 백 형상 부재(19)를 압축 상태로 유지할 수 있다. 이 경우, 로드 부재(32)를 걸어서, 백 형상 부재(19)를 보다 확실하게 압축 상태로 유지할 수 있다. 또한, 다리체(3)의 이상 상태에서는, 상기 제 1∼제 4 실시형태에서 전자 밸브(27)를 개방상태로부터 폐쇄상태로 전환하는 타이밍에서, 원웨이 클러치 기구(33)에 의해 로드 부재(32)을 걸어서 백 형상 부재(19)의 높이를 보다 확실하게 원하는 높이로 제어할 수 있다.
또, 도 12에 도시하는 예에서는, 백 형상 부재(19)의 내부의 바닥면부에는, 플레이트 형상의 자성체(34)가 고정 설치되고, 이 백 형상 부재(19)의 내부의 상면부(족평 플레이트 부재(12)의 하면부)에는, 전자석(35)이 고정 설치되어 있다. 이러한 전자수단을 구비한 경우에는, 다리체(3)의 착상 동작에 의해, 백 형상 부재(19)가 압축 상태로 된 후(족평 기구(6)가 그 전방부 및 후방부의 접지 부재(17)를 통하여 접지한 후), 다리체(3)가 착상 상태로부터 이상 상태로 이행한 직후(상기 제 1∼제 4 실시형태에서 그 이상 상태에의 이행 직후에 전자 밸브(27)를 폐쇄상태로부터 개방상태로 전환하는 타이밍)까지, 전자석(35)에 의해 자성체(34)에 대해 흡착력을 생기게 함으로써, 백 형상 부재(19)를 보다 확실하게 압축 상태로 유지할 수 있다.
다음에 본 발명의 제 5 실시형태를 도 13∼도 15를 참조하여 설명한다. 도 13은 본 실시형태의 착상충격 완충장치를 구비한 족평 기구의 주요부를 모식화하여 도시한 도면, 도 14는 본 실시형태의 주요부의 작동을 설명하기 위한 플로우챠트, 도 15는 본 실시형태의 주요부의 작동을 설명하기 위한 타이밍 차트이다. 또한, 본 실시형태에서는 족평 기구는, 착상충격 완충장치에 관계되는 구성을 제외하고 상기 제 1 실시형태의 것과 동일하며, 도 13에서는, 족평 기구의 주요부 구성만을 기재하고 있다. 또, 본 실시형태의 설명에서는, 상기 제 1 실시형태와 동일 구성 부분 혹은 동일 기능 부분에 대해서는, 제 1 실시형태와 동일한 참조 부호를 사용하고, 설명을 생략한다.
도 13을 참조하고, 본 실시형태의 착상충격 완충장치(18)에서는, 족평 플레이트 부재(12)의 바닥면에 부착된 백 형상 부재(19)의 내부에 연통하여 백 형상 부재(19)측으로부터 도출된 유체관로(35)와, 이 유체관로(35)에 설치되어서 상기 제어장치(10)에 의해 개방 정도를 제어할 수 있는 전자비례 밸브(36)로 이루어지는 유입·유출 수단(37)을 구비하고 있다. 또, 백 형상 부재(19)의 내부에는, 압력센서(38)가 구비되고, 또한, 족평 플레이트 부재(12)상에는, 백 형상 부재(19)의 높이를 검출하는 거리측정 센서(39)가 구비되어 있다. 이 거리측정 센서(39)는, 예를 들면 레이저광을 사용하여 백 형상 부재(19)의 높이를 검출하는 것이다. 이들 센서(38, 39)의 출력(검출 신호)은, 제어장치(10)에 입력된다. 이상에서 설명한 이외의 구조는, 상기 제 1 실시형태의 것과 동일하다.
또, 본 실시형태에서는 상기 제어장치(10)의 제어 처리는, 도 4의 STEP6의 처리만이 상기 제 1 실시형태의 것과 다르고, 이 STEP6에서는, 각 다리체(3) 마다, 도 14의 플로우챠트에 나타내는 바와 같이 상기 전자비례 밸브(36)를 제어하도록 하고 있다.
즉, 제어장치(10)는, 우선, 현재시각 t가 t=0인지 아닌지, 즉, 다리체(3)의 지지다리기의 시작 타이밍인지 아닌지를 판단하고(STEP61), t=0일 경우에는, 현재의 보용 패러미터에 따라 백 형상 부재(10)내의 목표압(Pcmd)과, 이 백 형상 부재(19)의 목표 높이 HHcmd의 경시 변화의 패턴을 설정한다(STEP62). 이 경우, 목표압 Pcmd 및 목표 높이 HHcmd의 패턴은, 예를 들면 각각 도 15(a), (b)에 도시하는 바와 같이 설정된다.
보다 구체적으로는, 목표 높이 HHcmd는, 지지다리기의 개시 직후(족평기구(6)의 백 형상 부재(19)의 접지 직후)의 기간 Ta(이 기간은, 기본적으로는, 족평 기구(6)가 그 전방부 및 후방부의 접지 부재(17)를 통하여 완전하게 접지할 때까지의 기간임)에서는, 초기값 HHcmd0로부터 「0」까지 단조적으로 감소해 가도록 설정된다. 그리고 상기 기간 Ta의 경과시부터, 다리체(3)의 미접지 다리기의 초기(다리체(3)가 착상 상태로부터 이상 상태로 이행한 직후)까지의 기간 Tb에서, 목표 높이 HHcmd는 「0」으로 유지된다. 또한, HHcmd=0은, 족평 기구(6)가 그 전방부 및 후방부의 접지 부재(17)를 통하여 접지하고 백 형상 부재(19)가 완전하게 압축된 상태에서의 백 형상 부재(19)의 높이를 의미한다. 또한, 이 기간 Tb의 경과시부터, 미접지 다리기의 종료시까지는, 목표 높이 HHcmd가 소정의 값 HHcmd1까지 증가되고, 최종적으로 이 소정값 HHcmd1으로 유지된다. 여기에서, 이 소정값 HHcmd1은, 상기 제 3 및 제 4 실시형태에서의 목표 높이 Hcmd에 상당하는 것이다. 또한, 지지다리기의 개시시에 있어서의 목표 높이 HHcmd의 초기값 HHcmd0는, 이 지지다리기 앞의 미접지 다리기에서의 최종적인 목표 높이 HHcmd(HHcmd1)에 상당하는 것이다. 이 경우, 미접지 다리기에어서의 최종적인 목표 높이 HHcmd1이나, 기간 Tb의 길이 등이 상기 제 1∼제 4 실시형태와 동일하게, 로봇(1)의 이동 속도 등에 따른 것으로 설정된다.
또, 목표압 Pcmd는, 기본적으로는, 다리체(3)의 지지다리기의 초기의 상기 기간 Ta에서, 「0」으로부터 일시적으로 증가한 후, 「0」까지 감소하도록 설정된다. 그리고 기간 Ta의 경과후는, 미접지 다리기의 종료시까지, Pcmd=0으로 유지된다. 또한, Pcmd=0은, 백 형상 부재(19)내의 압력이 대기압과 동등한 것을 의미한다. 이 경우, 목표압 Pcmd의 미접지 다리기에서의 최대값 등이 보용 패러미터에 따른 것으로 설정되고, 기본적으로는, 로봇(1)의 이동 속도가 빠를 수록, 목표압 Pcmd의 최대값은 커지도록 설정된다.
상술한 바와 같이 목표압 Pcmd 및 목표 높이 HHcmd의 시간에 따른 변화의 패턴을 설정한 후, 또는, STEP1에서 t=0이 아닌 경우에는, 제어장치(10)는, 다음에 상기 패턴에 기초하여 현재시각 t에서의 순시 목표압 Pcmd 및 순간 목표 높이 HHcmd를 구한다(STEP63).
이어서, 제어장치(10)는, 백 형상 부재(19)내의 실제 압력 Pact를 상기 압력센서(38)에 의해 검출하는 동시에, 백 형상 부재(19)의 실제의 높이 Hact를 상기 거리측정 센서(39)에 의해 검출한 후(STEP64), 족평 기구(6)가 백 형상 부재(19) 혹은 접지 부재(17)를 통하여 접지하고 있는지 아닌지를 판단한다(STEP65). 이 판단은, 예를 들면 상기 6축력센서(15) 혹은 압력센서(38)에 의한 실제 압력 Pact의 검출값에 기초하여 행해진다.
그리고, 족평 기구(6)가 접지하고 있을 경우에는, 제어장치(10)는, 상기 STEP63에서 구한 순시 목표압 Pcmd 및 순시 목표압 HHcmd와, STEP64에서 검출한 백 형상 부재(19)내의 실제 압력 Pact 및 백 형상 부재(19)의 실제의 높이 Hact에 기초하여 상기 전자비례 밸브(36)의 개방 정도를 제어한다(STEP66). 이 경우, 제어장치(10)는 예를 들면 다음 식(1)에 의해, 전자비례 밸브(36)의 개방 정도(이하, 밸브개방 정도라고 함)를 결정하고, 그 밸브개방 정도로 전자비례 밸브(36)를 제어한다.
밸브개방 정도=k1·(Pact-Pcmd)+k2·(Hact-HHcmd) ……(1)
여기에서, 식(1)중의 k1, k2는 미리 정한 양의 게인 계수이다. 또, 식(1)의 우변의 계산 결과가 음의 값으로 되었을 때에는, 강제적으로 밸브 개방 정도=0(전자비례 밸브(36)의 폐쇄상태)으로 한다.
또, STEP65에서, 족평 기구(6)가 접지하고 있지 않을 경우에는, 제어장치(10)는, 상기 STEP63에서 구한 순시 목표 높이 HHcmd와, STEP64에서 검출한 백 형상 부재(19)의 실제의 높이 Hact에 기초하여, 상기 전자비례 밸브(36)의 개방 정도를 제어한다(STEP67). 이 경우, 제어장치(10)는, 예를 들면 다음 식(2)에 의해, 밸브개방 정도를 결정하고, 그 밸브개방 정도로 전자비례 밸브(36)를 제어한다.
밸브개방 정도=-k3·(Hact-HHcmd) ……(2)
여기에서, 식(2)중의 k3은 미리 정한 양의 게인 계수이다. 또, 식(2)의 우변의 계산 결과가 음의 값으로 되었을 때에는, 강제적으로 밸브 개방 정도=0(전자비례 밸브(36)의 폐쇄상태)로 한다.
상술한 바와 같은 전자비례 밸브(36)의 밸브개방 정도의 제어, 바꾸어 말하면, 백 형상 부재(19)에의 공기의 유입 제어에 의해, 족평 기구(6)(백 형상 부재(19)를 포함함)의 접지 상태, 즉, 다리체(3)의 지지다리기에서는, 기본적으로는, 백 형상 부재(19)내의 실제 압력 Pact과 백 형상 부재(19)의 실제의 높이 Hact가 각각, 대체로 목표압 Pcmd 및 목표 높이 HHcmd의 패턴에 추종하도록 변화된다. 또, 족평 기구(6)의 미접지 상태, 즉, 다리체(3)의 미접지 다리기에서는, 백 형상부재(19)의 실제의 높이 Hact가, 목표 높이 HHcmd의 패턴에 추종하도록 변화된다. 그리고 이 경우, 목표 높이 HHcmd의 패턴은, 상기한 바와 같이 설정되어 있으므로, 백 형상 부재(19)는, 다리체(3)의 착상 동작에 의한 압축후, 이 다리체(3)가 착상 상태로부터 이상 상태로 이행한 직후까지, 기본적으로는 압축 상태로 유지된다. 더욱이, 다리체(3)의 미접지 다리기에서는, 로봇(1)의 보용형태를 규정하는 보용 패러미터에 따른 높이까지 백 형상 부재(19)가 팽창한다. 따라서 상기 제 1 실시형태와 동일한 작용 효과를 이룰 수 있다. 더욱이, 본 실시형태에서는 족평 기구(6)의 접지 상태에서, 백 형상 부재(19)내의 실제 압력 Pact도 보용 패러미터에 따른 목표압 Pcmd에 대체로 추종하도록 제어되기 때문에, 착상충격 완충장치(18)에 의한 착상충격의 경감 효과를, 로봇(1)의 보용형태에 적합한 것으로 할 수 있다.
또한, 본 실시형태에서는 족평 기구(6)의 접지 상태에서, 상기 식(1)에 의해 전자비례 밸브(36)의 밸브개방 정도를 결정하도록 했는데, 예를 들면 다음 식(3) 또는 식(4)에 의해 밸브개방 정도를 결정하도록 해도 좋다.
밸브개방 정도=k1·(Pact-Pcmd)-k2·HHcmd ……(3)
밸브개방 정도=-k1·Pcmd+k2·(Hact-HHcmd) ……(4)
이들 식(3), (4)를 사용한 경우에도, 다리체(3)의 지지다리기에서는, 기본적으로는, 백 형상 부재(19)내의 실제 압력 Pact와 백 형상 부재(19)의 실제의 높이 Hact를, 각각, 대체로 목표압 Pcmd 및 목표 높이 HHcmd의 패턴에 추종하도록 변화시킬 수 있다.
또한, 본 실시형태에서는 목표압 Pcmd 및 목표 높이 HHcmd의 패턴을 설정하도록 했지만, 예를 들면 목표 높이 HHcmd의 패턴만을 설정하고, 이것에 백 형상 부재(19)의 실제의 높이 Hact를 추종하게 하도록 전자비례 밸브(36)를 제어하도록 해도 좋다. 이 경우에는, 다리체(3)의 지지다리기 및 미접지 다리기 어느곳에 있어서도, 예를 들면 상기 식(2)에 의해 전자비례 밸브(36)의 개방 정도를 결정하도록 하면 좋다.
이상에서 설명한 제 1∼제 5 실시형태에서는 백 형상 부재(19)를 족평 플레이트 부재(12)의 바닥면측에 구비한 것을 나타냈지만, 백 형상 부재(19)를 예를 들면 족평 플레이트 부재(12)와 발목관절(9) 사이에 설치하도록 해도 좋다. 이 경우의 실시형태를 제 6 실시형태로서 도 16을 참조하여 설명한다. 도 16은 본 실시형태의 착상충격 완충장치를 구비한 족평 기구의 측면에서 본 단면도이다. 또한, 본 실시형태는, 상기 제 1 실시형태의 것과, 족평 기구의 일부의 구성과 착상충격 완충장치의 일부의 구성만이 다른 것이므로, 상기 제 1 실시형태와 동일 구성 부분 혹은 동일 기능 부분에 대해서는, 이 제 1 실시형태와 동일한 참조 부호를 사용하고, 설명을 생략한다.
본 실시형태에서는 족평 기구(6)의 상면부에는, 상기 제 1 실시형태의 것과 동일하게 단면 사각 형상의 통부재(13)가 고정 설치되어 있고, 통부재(13)내에, 상기 제 1 실시형태의 백 형상 부재와 동일한 술통형태 형상으로 상방으로 개구한 백 형상 부재(19)(가변용적체)가 수용되어 있다. 이 경우, 백 형상 부재(19)의 바닥면부는, 통부재(13)내에서 족평 플레이트 부재(12)에 고착되어 있다. 또,통부재(13)내에는, 백 형상 부재(19)의 상측에서, 바닥있는 가동 통부재(40)가 수용되고, 이 가동 통부재(40)는, 통부재(13)의 내주면을 따라서 상하이동 자유롭게 설치되어 있다. 그리고 이 가동 통부재(40)의 바닥부에 상기 백 형상 부재(19)의 개구 단부가 고정 설치되어 있다. 따라서 가동 통부재(40)는, 백 형상 부재(19)를 통하여 족평 플레이트 부재(12)에 연결되어 있다. 또한, 가동 통부재(40)의 바닥부에는, 2개의 유통 구멍(41, 42)이 백 형상 부재(19)의 내부에 연통하여 뚫어 설치되어 있다. 이들 유통 구멍(41, 42)은 스로틀 통로로 되어 있다.
또, 가동 통부재(40)의 내부에는, 그 내주면을 따라서 거의 상하 방향으로 움직일 수 있는 가동 플레이트(43)가 수용되고, 이 가동 플레이트(43)는, 그 하면의 둘레 가장자리부가 스프링, 고무 등의 탄성재로 이루어지는 복수의 탄성부재(44)(도면에서는 스프링으로 기재되어 있음)를 통하여 가동 통부재(40)의 바닥부에 연결되어 있다. 그리고 이 가동 플레이트(43)의 상면부에 6축력센서(15)를 통하여 다리체(3)의 발목관절(9)이 연결되어 있다.
또, 상기 유통 구멍(41, 42)을 포함하는 유입·유출 수단(20)이 설치되어 있다. 이 유입·유출 수단(20)은, 그 기본 구성은, 상기 제 1 실시형태의 것과 동일하며, 유통 구멍(41)에 접속되고 이 유통 구멍(41)으로부터 도출된 유체관로(23)와, 이 유체관로(23)에 설치된 역지밸브(25)와, 유통 구멍(42)에 접속되고 이 유통 구멍(42)으로부터 도출된 유체관로(24)과, 이 유체관로(24)에 설치된 역지밸브(26) 및 전자 밸브(27)를 구비하는 것이다. 그리고 유체관로(23, 24)의 선단부는 대기측으로 개방되어 있다. 이 유입·유출 수단(20)과, 상기 백 형상 부재(19)에 의해본 실시형태의 착상충격 완충장치(18)가 구성되어 있다.
또한, 본 실시형태에서는 백 형상 부재(19)는, 다리체(3)의 이상 상태에서, 족평 플레이트 부재(12) 등의 중량에 의해 백 형상 부재(19)가 늘어나서 가동 통부재(40)가 통부재(13)로부터 빠져나가는 일이 없도록, 도시된 팽창 상태(자연상태) 이상으로는 잘 늘어나지 않는 탄성재에 의해 구성되어 있다. 혹은, 구조적으로 가동 통부재(40)가 통부재(13)로부터 빠져나가지 않도록 되어 있다. 이상에서 설명한 것 이외의 구성(상기 제어장치(10)의 제어 처리를 포함함)은, 상기 제 1 실시형태의 것과 동일하다.
상술한 바와 같이 구성된 본 실시형태의 착상충격 완충장치(18)에서는, 다리체(3)의 착상 동작때에, 이 다리체(3)의 족평 기구(6)가 접지 부재(17)를 통하여 접지하면, 백 형상 부재(19)가 압축되면서, 이 백 형상 부재(19)내의 공기가 유통 구멍(41)을 통하여 유출한다. 이 때, 유통로(41)는 스로틀 통로이므로, 유출 저항을 발생한다. 이러한 본 실시형태의 착상충격 완충장치(18)의 작동에 의해, 다리체(3)의 착상 동작때의 착상충격이 상기 제 1 및 제 2 실시형태의 것과 동일하게 경감된다. 또, 상기 제 1 실시형태와 동일하게 전자 밸브(27)를 개폐제어함으로써, 백 형상 부재(19)의 압축후, 족평 기구(6)가 착상 상태로부터 이상 상태로 이행한 직후까지, 백 형상 부재(l9)가 압축 상태로 유지된다. 또한, 족평 기구(6)의 이상 상태에서는, 백 형상 부재(19)는, 원하는 높이까지 팽창한다. 이것에 의해 상기 제 1 실시형태와 동일한 작용 효과를 이룰 수 있다.
또한, 본 실시형태에서는 상기 제 1 실시형태와 동일하게 백 형상부재(19)에의 공기의 유입 제어를 행하는 것을 도시했지만, 상기 제 2∼제 4 실시형태와 동일하게 백 형상 부재(19)에의 공기의 유입을 제어하도록 하는 것도 가능하다.
또, 본 실시형태에서는 가변용적체로서 백 형상 부재(19)를 구비했는데, 예를 들면 상기 통부재(13)를 원통 형상(실린더 튜브 형상)으로 형성하는 동시에, 가동 통부재(40)를 피스톤 형상으로 형성하고, 통부재(13)내에서의 가동 통부재(40)의 하측의 공간의 가변용적체로서 구성하도록 하는 것도 가능하다.
더욱이, 상기 제 1∼제 6의 각 실시형태에서는 가변용적체에 대해 입출시키는 유체를 공기로 한 것을 도시했는데, 본 발명은, 이 유체는 작동유 등의 액체라도 좋다.
이상과 같이, 본 발명은, 2족 이동로봇 등, 다리식 이동로봇의 다리체의 착상 동작시의 충격 하중을 로봇의 보용형태에 맞추어서 적정하게 경감하면서, 이 로봇의 자세의 안정성의 확보를 용이하게 행할 수 있고, 게다가, 경량의 구성으로 할 수 있는 착상충격 완충장치를 제공할 수 있는 것으로서 유용하다.

Claims (8)

  1. 족평 기구의 접지면부를 통하여 각각 접지가능한 복수의 다리체의 이상·착상 동작에 의해 이동하는 다리식 이동로봇에서, 각 다리체의 착상 동작때에 상반력을 받아서 압축되는 동시에 적어도 이 다리체의 이상 동작에 의해 이 상반력을 받지 않게 되었을 때에는 팽창할 수 있도록 이 다리체의 족평 기구에 설치되고, 그 압축팽창에 따라 내부에 유체를 입출할 수 있는 가변용적체와, 각 다리체의 이상 상태에서 이 가변용적체를 팽창시키면서 이 가변용적체에 유체를 유입시키는 동시에 상기 상반력에 의한 이 가변용적체의 압축에 따라 이 가변용적체로부터 유체를 유출시키는 유입·유출 수단을 구비하고, 이 유입·유출 수단에 의한 상기 가변용적체내의 유체의 유출때에 유출 저항을 발생시키도록 한 착상충격 완충장치로서,
    상기 각 다리체의 이상 상태에서의 상기 가변용적체의 팽창시에, 이 가변용적체의 압축 방향의 사이즈가 상기 다리식 이동로봇의 보용형태에 따른 소정의 사이즈로 되도록, 상기 유입·유출 수단에 의한 가변용적체에의 상기 유체의 유입량을 이 보용형태에 따라 제어하는 팽창 제어 수단을 구비한 것을 특징으로 하는 다리식 이동로봇의 착상충격 완충장치.
  2. 제 1 항에 있어서, 상기 유체는 압축성 유체인 것을 특징으로 하는 다리식 이동로봇의 착상충격 완충장치.
  3. 제 2 항에 있어서, 상기 다리식 이동로봇은, 그 각 다리체의 족평 기구에 작용하는 상반력의 수평방향 축주위의 모멘트를 소정의 목표 모멘트에 추종시키도록 이 족평 기구의 위치 및 자세가 컴플라이언스 제어에 의해 제어되는 로봇인 것을 특징으로 하는 다리식 이동로봇의 착상충격 완충장치.
  4. 제 1 항에 있어서, 상기 가변용적체는, 상기 각 다리체의 착상 동작때에 이 다리체의 족평 기구의 접지면부에 선행하여 접지하도록 이 다리체의 족평 기구의 바닥면측에 설치된 변형가능한 백 형상 부재에 의해 구성되어 있는 것을 특징으로 하는 다리식 이동로봇의 착상충격 완충장치.
  5. 제 1 항에 있어서, 상기 팽창 제어 수단은, 상기 각 다리체의 이상 상태에서의 상기 가변용적체에의 상기 유체의 유입시간에 기초하여 이 가변용적체의 압축 방향의 사이즈가 소정의 사이즈로 팽창한 것인지 아닌지를 판단하고, 이 가변용적체의 사이즈가 소정의 사이즈로 팽창했다고 판단했을 때, 상기 유입·유출 수단에 의한 가변용적체에의 유체의 유입을 차단시키는 것을 특징으로 하는 다리식 이동로봇의 착상충격 완충장치.
  6. 제 1 항에 있어서, 상기 가변용적체의 압축 방향의 사이즈에 따라 변화하는 물리량을 검출하는 센서를 구비하고 있고, 상기 팽창 제어 수단은, 이 센서의 검출 데이터에 기초하여 이 가변용적체의 압축 방향의 사이즈가 소정의 사이즈로 팽창한것인지 아닌지를 판단하고, 이 가변용적체의 압축 방향의 사이즈가 소정의 사이즈로 팽창했다고 판단했을 때, 상기 유입·유출 수단에 의한 가변용적체에의 유체의 유입을 차단시키는 것을 특징으로 하는 다리식 이동로봇의 착상충격 완충장치.
  7. 제 1 항에 있어서, 상기 각 다리체의 족평 기구가 접지하고 있는지 아닌지를 검지하기 위한 센서가 구비되어 있고, 상기 팽창 제어 수단은, 상기 다리식 이동로봇의 목표 보용에 따라 정해지는 각 다리체의 착상의 예정 시각에서 상기 센서에 의해 상기 족평 기구의 접지가 검지되지 않을 때, 상기 가변용적체의 압축 방향의 사이즈를 크게 하도록 상기 유입·유출 수단에 의한 이 가변용적체에의 유체의 유입을 제어하는 것을 특징으로 하는 다리식 이동로봇의 착상충격 완충장치.
  8. 제 1 항에 있어서, 상기 가변용적체의 압축 방향에서의 사이즈를 검출하는 센서를 구비하고 있고, 상기 팽창 제어 수단은, 상기 다리식 이동로봇의 보용형태 에 따라 상기 가변용적체의 팽창시에 있어서의 이 가변용적체의 압축 방향의 목표 사이즈의 경시변화 패턴을 설정하고, 상기 센서에 의해 검출되는 가변용적체의 압축 방향의 사이즈가 상기 목표 사이즈의 경시 변화 패턴을 따라 변화하도록 상기 유입·유출 수단에 의한 가변용적체의 유체의 유출·유입을 제어하는 것을 특징으로 하는 다리식 이동로봇의 착상충격 완충장치.
KR1020047010029A 2001-12-25 2002-12-11 다리식 이동로봇의 착상충격 완충장치 KR100893901B1 (ko)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
JPJP-P-2001-00392789 2001-12-25
JP2001392789A JP3672867B2 (ja) 2001-12-25 2001-12-25 脚式移動ロボットの着床衝撃緩衝装置
PCT/JP2002/012982 WO2003055651A1 (fr) 2001-12-25 2002-12-11 Dispositif d'absorption de choc de retombee sur le sol pour robot mobile dote de jambes

Publications (2)

Publication Number Publication Date
KR20040075331A true KR20040075331A (ko) 2004-08-27
KR100893901B1 KR100893901B1 (ko) 2009-04-20

Family

ID=19188691

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020047010029A KR100893901B1 (ko) 2001-12-25 2002-12-11 다리식 이동로봇의 착상충격 완충장치

Country Status (6)

Country Link
US (1) US7378811B2 (ko)
EP (1) EP1475191B1 (ko)
JP (1) JP3672867B2 (ko)
KR (1) KR100893901B1 (ko)
DE (1) DE60231337D1 (ko)
WO (1) WO2003055651A1 (ko)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100688338B1 (ko) * 2005-09-30 2007-03-02 한국과학기술원 시간영역 수동성 제어를 이용한 보행 로봇의 충격제어시스템
KR101068123B1 (ko) * 2008-09-09 2011-09-28 박규식 놀이공원용 이족보행 하반신 로봇
KR101353528B1 (ko) * 2012-10-11 2014-01-17 주식회사 칼라카나 디딤면의 형상에 따라 가변하는 가변부를 구비한 인간형 로봇
CN112478013A (zh) * 2020-11-24 2021-03-12 胡永星 一种新型机械人足缓冲机构
KR20220132362A (ko) * 2021-03-23 2022-09-30 국민대학교산학협력단 로봇용 가변 강성 발바닥

Families Citing this family (38)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4049644B2 (ja) * 2002-09-13 2008-02-20 川田工業株式会社 歩行ロボットの衝撃吸収機構
US7327112B1 (en) 2006-03-06 2008-02-05 Adrian Gregory Hlynka Multiple leg tumbling robot
JP5900838B2 (ja) * 2012-04-13 2016-04-06 株式会社Ihi ロボットの接地部構造
US9387588B1 (en) 2014-08-25 2016-07-12 Google Inc. Handling gait disturbances with asynchronous timing
US10081098B1 (en) 2014-08-25 2018-09-25 Boston Dynamics, Inc. Generalized coordinate surrogates for integrated estimation and control
US9618937B1 (en) 2014-08-25 2017-04-11 Google Inc. Slip detection using robotic limbs
US9499219B1 (en) 2014-08-25 2016-11-22 Google Inc. Touch-down sensing for robotic devices
JP6228097B2 (ja) * 2014-10-06 2017-11-08 本田技研工業株式会社 移動ロボット
US9446518B1 (en) 2014-11-11 2016-09-20 Google Inc. Leg collision avoidance in a robotic device
KR20160070239A (ko) 2014-12-09 2016-06-20 폴텍주식회사 완충장치
US9499218B1 (en) 2014-12-30 2016-11-22 Google Inc. Mechanically-timed footsteps for a robotic device
US9731416B1 (en) * 2015-03-11 2017-08-15 Google Inc. Legged robot passive fluid-based ankles with spring centering
US9594377B1 (en) * 2015-05-12 2017-03-14 Google Inc. Auto-height swing adjustment
JP6879562B2 (ja) * 2015-06-11 2021-06-02 ソフト ロボティクス, インコーポレイテッド モジュール式ロボットシステム
CN105172927B (zh) * 2015-07-30 2017-10-13 西北工业大学 一种自主复位三档变速弹跳移动机器人
US9586316B1 (en) 2015-09-15 2017-03-07 Google Inc. Determination of robotic step path
US9789919B1 (en) 2016-03-22 2017-10-17 Google Inc. Mitigating sensor noise in legged robots
US10179619B1 (en) * 2016-03-30 2019-01-15 Schaft Inc. Robotic foot sensor
CN106074074B (zh) * 2016-06-02 2019-02-12 哈尔滨易奥秘科技发展有限公司 一种偏心纤维复合弹性体及具有该弹性体的康复训练装置
CN106015426B (zh) * 2016-07-13 2017-10-31 中国船舶重工集团公司第七一九研究所 基于高度阀的船舶用气囊控制装置
CN106625590B (zh) * 2016-12-07 2018-10-23 吉林大学 缓冲节能与主动抗沉陷仿生机械足
CN107256063B (zh) * 2017-08-10 2018-07-24 洪灵坪 一种机电一体化限位机构及限位方法
CN109747728A (zh) * 2017-11-07 2019-05-14 山东交通学院 一种全转动副模块化机器人运输平台
CN108068908B (zh) * 2017-12-29 2023-10-10 深圳市优必选科技有限公司 机器人脚板结构和人形机器人
CN108482513B (zh) * 2018-05-02 2023-08-01 佛山科学技术学院 一种三态机械脚结构
CN108748183B (zh) * 2018-06-13 2021-02-26 芜湖捷创科技信息咨询有限公司 一种足式行走机器人
CN109018061B (zh) * 2018-07-24 2020-06-09 武汉大学 一种基于仿生学的柔性被动足部系统
CN109109021A (zh) * 2018-10-11 2019-01-01 佛山市高明曦逻科技有限公司 一种用于机器人的智能缓冲脚
CN109278065A (zh) * 2018-10-11 2019-01-29 佛山市高明曦逻科技有限公司 利用气压调控的机器人智能缓冲脚
CN110053683B (zh) * 2019-04-19 2021-04-23 常州大学 一种压力控制运动模式切换的机器人小腿足
CN110525531B (zh) * 2019-07-08 2020-08-11 杭州电子科技大学 一种摩擦式移动软机器人及其驱动方法
CN210180564U (zh) * 2019-08-28 2020-03-24 杭州宇树科技有限公司 一种新型足端力采集装置及应用其的四足机器人
CN110630852A (zh) * 2019-11-06 2019-12-31 徐州市凯诺机械有限公司 一种起重机支撑装置
CN110667730B (zh) * 2019-11-11 2021-08-27 路邦科技授权有限公司 一种仿生机器人的腿部行走控制系统
CN112145614B (zh) * 2020-10-21 2022-04-12 合肥联宝信息技术有限公司 一种用于电子设备的缓冲器
CN214524135U (zh) * 2021-02-02 2021-10-29 杭州宇树科技有限公司 一种足端结构及应用其的四足机器人
CN114211526B (zh) * 2021-12-07 2024-01-09 江苏集萃智能制造技术研究所有限公司 基于液压驱动系统的机器人减震系统
CN115140214B (zh) * 2022-07-25 2023-09-05 安徽工程大学 救灾六足仿生机器人

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6164517A (ja) * 1984-09-06 1986-04-02 Nissan Motor Co Ltd 車両用サスペンシヨン装置
JP3270767B2 (ja) 1992-04-28 2002-04-02 本田技研工業株式会社 衝撃吸収機構を備えた脚式歩行ロボット
US5455497A (en) * 1992-04-20 1995-10-03 Honda Giken Kogyo Kabushiki Kaisha Legged mobile robot and a system for controlling the same
JP3293952B2 (ja) * 1992-05-26 2002-06-17 本田技研工業株式会社 衝撃吸収手段を備えた脚式歩行ロボット
JP3629133B2 (ja) 1997-01-31 2005-03-16 本田技研工業株式会社 脚式移動ロボットの制御装置
JP3649865B2 (ja) * 1997-07-23 2005-05-18 本田技研工業株式会社 脚式移動ロボットの脚構造
JPH11320461A (ja) 1998-05-12 1999-11-24 Sony Corp 人工足部

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR100688338B1 (ko) * 2005-09-30 2007-03-02 한국과학기술원 시간영역 수동성 제어를 이용한 보행 로봇의 충격제어시스템
KR101068123B1 (ko) * 2008-09-09 2011-09-28 박규식 놀이공원용 이족보행 하반신 로봇
KR101353528B1 (ko) * 2012-10-11 2014-01-17 주식회사 칼라카나 디딤면의 형상에 따라 가변하는 가변부를 구비한 인간형 로봇
CN112478013A (zh) * 2020-11-24 2021-03-12 胡永星 一种新型机械人足缓冲机构
CN112478013B (zh) * 2020-11-24 2021-12-17 真木农业设备(安徽)有限公司 一种机械人足缓冲机构
KR20220132362A (ko) * 2021-03-23 2022-09-30 국민대학교산학협력단 로봇용 가변 강성 발바닥

Also Published As

Publication number Publication date
JP2003191182A (ja) 2003-07-08
US20050120820A1 (en) 2005-06-09
EP1475191A1 (en) 2004-11-10
WO2003055651A1 (fr) 2003-07-10
EP1475191A4 (en) 2008-02-13
EP1475191B1 (en) 2009-02-25
US7378811B2 (en) 2008-05-27
KR100893901B1 (ko) 2009-04-20
JP3672867B2 (ja) 2005-07-20
DE60231337D1 (de) 2009-04-09

Similar Documents

Publication Publication Date Title
KR100893901B1 (ko) 다리식 이동로봇의 착상충격 완충장치
KR100917352B1 (ko) 다리식 이동로봇의 착상충격 완충장치
KR100917183B1 (ko) 다리식 이동로봇의 착상충격 완충장치
KR101209096B1 (ko) 다리식 이동 로봇의 다리체 관절 어시스트 장치
KR101262692B1 (ko) 다리식 이동 로봇의 다리체 관절 어시스트 장치
JP3674778B2 (ja) 脚式移動ロボットの脚体関節アシスト装置
US7143850B2 (en) Leg joint assist device for legged movable robot
WO2002040223A1 (fr) Robot mobile a deux jambes et son procede de commande, sa structure jambes, et unite jambe mobile destinee a ce robot
KR101812603B1 (ko) 능동-수동 동작 모드를 갖는 착용로봇

Legal Events

Date Code Title Description
A201 Request for examination
E902 Notification of reason for refusal
E701 Decision to grant or registration of patent right
GRNT Written decision to grant
FPAY Annual fee payment

Payment date: 20120323

Year of fee payment: 4

FPAY Annual fee payment

Payment date: 20130318

Year of fee payment: 5

LAPS Lapse due to unpaid annual fee