KR20140037786A - 넘어짐 관리 능력을 갖는 휴머노이드 로봇 및 상기 넘어짐을 관리하기 위한 방법 - Google Patents

넘어짐 관리 능력을 갖는 휴머노이드 로봇 및 상기 넘어짐을 관리하기 위한 방법 Download PDF

Info

Publication number
KR20140037786A
KR20140037786A KR1020137007601A KR20137007601A KR20140037786A KR 20140037786 A KR20140037786 A KR 20140037786A KR 1020137007601 A KR1020137007601 A KR 1020137007601A KR 20137007601 A KR20137007601 A KR 20137007601A KR 20140037786 A KR20140037786 A KR 20140037786A
Authority
KR
South Korea
Prior art keywords
robot
fall
polygon
module
gravity
Prior art date
Application number
KR1020137007601A
Other languages
English (en)
Other versions
KR101882532B1 (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 KR20140037786A publication Critical patent/KR20140037786A/ko
Application granted granted Critical
Publication of KR101882532B1 publication Critical patent/KR101882532B1/ko

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D57/00—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
    • B62D57/02—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
    • B62D57/032—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members with alternately or sequentially lifted supporting base and legs; with alternately or sequentially lifted feet or skid
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06F—ELECTRIC DIGITAL DATA PROCESSING
    • G06F11/00—Error detection; Error correction; Monitoring
    • G06F11/30—Monitoring
    • Y—GENERAL 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
    • Y10—TECHNICAL SUBJECTS COVERED BY FORMER USPC
    • Y10S—TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10S901/00—Robots
    • Y10S901/01—Mobile robot

Abstract

본 발명은 특히 넘어짐을 관리할 수 있는 휴머노이드 로봇에 관한 것이다. 넘어짐의 위험성은 휴머노이드 로봇의 대량 생산 사용의 발전을 저해한다. 종래 기술에서, 무게 중심이 매우 종종 이의 지지 다각형 외부에 있기 때문에 넘어짐을 감지하기 위한 모달리티가 상당한 동적 로봇의 경우에 적합하지 않다. 또한 넘어짐을 관리하기 위한 모달리티는 이의 연산 리소스에 있어서 경제적이어야 하는 로봇에 극히 적합하지 않다. 본 발명에 따라서, 지지 다각형은 지면에 매우 근접하는 것을 결정하는 이펙터가 제공된다. 넘어짐의 각도를 분류함으로써 일련의 전략으로부터 선택된 보호 전략이 이용된다.

Description

넘어짐 관리 능력을 갖는 휴머노이드 로봇 및 상기 넘어짐을 관리하기 위한 방법{HUMANOID ROBOT HAVING FALL-MANAGEMENT CAPABILITIES, AND METHOD FOR MANAGING SAID FALLS}
본 발명은 휴머노이드 로봇의 분야에 관한 것이다. 더 구체적으로는, 본 발명은 상기 로봇의 넘어짐을 관리하는데 적용되며, 이는 이들 로봇의 사용을 향상시키기 것과 관련된다.
로봇은 인간의 외관과 기능의 특정 속성(머리, 몸통, 2개의 팔, 2개의 손, 2개의 다리, 2개의 발 등)을 갖는 한, 휴머노이드라고 지칭될 수 있다. 외관 외에, 휴머노이드 로봇이 수행할 수 있는 기능은 운동 수행 능력, 말하기 능력, "사고(reason)" 능력이 있다. 휴머노이드 로봇은 사지(limb) 또는 머리를 이용해, 걷고, 몸짓을 취할 수 있다. 휴머노이드 로봇이 수행할 수 있는 몸짓의 복잡도는 점점 증가한다. 그러나, 로봇은 특히 이의 관절의 모터에 관하여 파괴되기가 쉽다. 이 파괴성은 대량 응용의 개발을 위해 상당한 단점이다. 게다가, 이들 응용의 문헌 내에서, 이는 반복적인 넘어짐으로 인해 파괴 또는 오류를 대처하는데 특히 취약하며, 이는 휴머노이드 로봇의 제조자 또는 분배자가 초기 판매에 대하여 불균형을 이루는 애프터-세일 서비스를 제공하고 상당한 비용 소요를 부담해야 하기 때문이다.
넘어짐의 위험성을 최소화하기 위한 보행 능력이 제공된 휴머노이드 로봇에 적용가능한 제1 전략은 상기 보행이 충분히 안정적으로 하는 것을 보장하는 것이다. 이를 수행하기 위하여 널리 사용되는 수단은 로봇의 궤적을 조절하는 것이며, 이에 따라 영 모멘트 포인트(Zero Moment Point; ZMP)(즉, 지지 축의 모멘트와 방위각 축의 모멘트가 영인 지면 상의 지점)가 보행하는 로봇의 경우 로봇의 지지 다각형 내에 포함되며, 로봇이 한 발로 서있는 경우에 지지 다각형은 이 발의 형상을 갖는다. 로봇이 두 발로 서있는 경우에, 이 다각형의 영역은 두 발의 영역에 발의 내부 영역을 더한 것이다. 이 전략은 그러나 모든 상태에서, 특히 로봇이 평평하지 않은 지면을 걷고 제3자에 의해 야기된 충격을 받거나 또는 균형의 제한이 있는 상태에서 이동할 때 로봇의 안정성을 보장하기에 충분하지 못하다.
이 문제점에 대한 종래의 해결 방법은 진행 표면 상에서 로봇의 무게 중심의 이탈이 로봇에 대한 지지 다각형 내에 포함되는지를 식별하는 단계, 그 뒤에 상기 다각형으로부터 상기 무게 중심이 이탈되는 경우 상기 다각형의 이탈 각의 함수로서 최상의 넘어짐 자세를 결정하는 단계로 구성되는 공통적인 원리를 이용한다. 이들 해결 방법은 로봇이 넘어짐 위치에 있는지의 불확실함 없이 센서가 제공된 정적 로봇의 경우에 이를 결정할 수 있다. 보행하는 동안, 특히 상기 넘어짐 감지 센서가 넘어짐의 시작과 보행 궤적 내에 포함된 정상 몸짓을 혼동할 수 있을 때 로봇에 대해 동일하게 적용되지 않는다. 게다가, 이 경우에 넘어짐에 대하여 보호를 위한 기구는 적절하지 못하게 트리거되는 반면 로봇의 동작의 정상적 코스를 방해하기 위한 요인이 없다.
본 발명은 로봇의 넘어짐에 대하여 보호를 하기 위한 적절한 기구를 이용할 필요가 있는 경우 더욱 정밀한 방식으로 수행함으로써 이 문제점을 해결한다. 이는 진행 표면과 거의 접촉하는 지점에 물리적 다각형을 추가함으로써 물리적 다각형으로부터 추정되는 가상 지지 다각형을 형성함으로써 수행된다.
이를 위해, 본 발명은 휴머노이드 로봇을 개시하며, 상기 표면 상에서 이동할 수 있는 휴머노이드 로봇은 로봇의 하나 이상의 제1 말단과 표면의 접촉을 감지하기 위한 하나 이상의 모듈 및 상기 하나 이상의 말단으로 구성된 제1 지지 다각형에 대해 로봇의 무게 중심의 이탈 지점의 위치를 포함하고, 상기 표면과 상기 로봇의 하나 이상의 제2 말단의 근접을 감지하기 위한 하나 이상의 모듈을 추가로 포함하고, 제1 지지 다각형에 대해 상기 로봇의 무게 중심의 이탈 지점의 위치를 연산하기 위한 모듈은 또한 제2 지지 다각형에 대해 상기 로봇의 무게 중심의 이탈 위치를 연산할 수 있으며, 상기 제2 다각형은 상기 표면과 거의 접촉함에 따라 감지된 말단들에 속한 상기 로봇의 상기 제2 말단의 상기 표면 상에서 이탈 지점에 제1 다각형을 추가함으로써 제1 다각형으로부터 추정된다.
바람직하게는, 상기 표면과 상기 하나 이상의 제2 말단의 근접을 감지하기 위한 모듈은 상기 표면에 대해 상기 하나 이상의 제2 말단의 위치에 대한 입력으로서 수신되고, 상기 위치는 로봇의 기준 프레임에서 상기 말단의 공간 내의 위치를 포함하는 로봇의 기하학적 모델의 출력으로서 제공된다.
바람직하게는, 로봇의 제2 말단이 상기 표면과 거의 접촉하는 상태는 로봇의 크기 및 로봇의 하지의 높이에서 스윙하는 최대치를 포함하는 기준의 그룹에 속한 기준의 함수로서 선택된 거리 한계점을 특징으로 한다.
바람직하게는, 상기 하나 이상의 제1 말단은 로봇의 발 중 하나이고, 상기 발에는 하나 이상의 압력 센서가 제공된다.
바람직하게는, 하나 이상의 제2 말단은 로봇의 손 중 하나이다.
바람직하게는, 본 발명의 로봇은 지지 다각형에 대해 상기 로봇의 무게 중심의 이탈 지점의 위치를 연산하기 위한 상기 모듈의 압력으로서 기준 자세의 기하학적 모델과 로봇 자세의 기하학적 모델 간의 거리의 소정의 기준에 따른 비교에 의해 로봇의 자세를 필터링하기 위한 모듈을 추가로 포함한다.
바람직하게는, 본 발명의 로봇은 수직 축과 로봇의 무게 중심의 이탈 지점의 위치를 연산하기 위한 모듈을 제공하는 관성 리그를 추가로 포함하고, 지면과 접촉하는 로봇의 발 중 하나와 흉부를 연결하는 축과의 상기 리그의 각도는 로봇의 무게 중심의 이탈 축에 적용된 회전 각을 제공한다.
바람직하게는, 본 발명의 로봇은 지지 다각형에 대해 상기 로봇의 무게 중심의 이탈 지점의 위치를 연산하기 위한 모듈의 출력으로서 넘어짐을 보호하기 위한 동작의 그룹을 모니터링하는 모듈을 추가로 포함하고, 로봇의 무게 중심의 이탈 지점이 제2 지지 다각형의 외부에 있는 로봇의 넘어진 상태의 하나 이상의 출력을 연산 모듈이 제공할 때 하나 이상의 동작의 그룹이 트리거된다.
바람직하게는, 보호 동작의 그룹은 로봇의 발 관절의 종속을 불가능하게 하는 것, 머리, 팔 및 골반을 포함하는 그룹에 속한 하나 이상의 요소의 보호 자세로 배치되는 것 및 상기 그룹에 속한 하나 이상의 요소의 관절을 무능하게 하는 것을 포함한다.
바람직하게는, 상기 연산 모듈은 로봇의 넘어짐 상태의 상태 특성에 대하여 넘어짐에 대한 보호를 위한 동작의 그룹을 모니터링하기 위한 모듈에 로봇의 기준 프레임에서 넘어짐 방향의 각 특성을 추가로 제공하고, 선택된 기준 값에 대한 상기 넘어짐의 각도 값은 수행되는 넘어짐에 대하여 보호를 위한 동작의 그룹의 보호 동작의 선택을 결정한다.
바람직하게는, 넘어지는 각도가 앞으로 넘어지는 것을 결정할 때, 머리의 보호 자세를 취하는 것은 실질적으로 머리를 뒤로 두는 것이며, 팔의 보호 자세를 취하는 것은 실질적으로 팔을 앞으로 두는 것이고 골반의 보호 자세를 취하는 것은 골반을 인접하게 모으는 것이다.
바람직하게는, 넘어지는 각도가 좌측 또는 우측으로 넘어지는 것을 결정할 때, 머리의 보호 자세를 취하는 것은 실질적으로 머리를 앞으로 두는 것이며, 팔의 보호 자세를 취하는 것은 실질적으로 팔을 몸의 앞에 두는 것이고 골반의 보호 자세를 취하는 것은 골반을 개방한다.
바람직하게는, 넘어지는 각도가 뒤로 넘어지는 것을 결정할 때, 머리의 보호 자세를 취하는 것은 실질적으로 머리를 앞으로 두는 것이며, 팔의 보호 자세를 취하는 것은 실질적으로 팔을 뒤로 두는 것이고 골반의 보호 자세를 취하는 것은 골반을 인접하게 모으는 것이다.
본 발명은 또한, 로봇의 하나 이상의 제1 말단과 표면의 접촉을 감지하기 위한 하나 이상의 모듈 및 상기 표면 상에서 이동할 수 있는 휴머노이드 로봇의 넘어짐을 관리하기 위한 방법을 개시하며, 상기 방법은 상기 하나 이상의 말단으로 구성된 제1 지지 다각형에 대해 상기 로봇의 무게 중심의 이탈 지점의 위치를 연산하기 위한 단계를 포함하고, 상기 방법은 상기 표면과 상기 로봇의 하나 이상의 제2 말단의 근접을 감지하기 위한 하나 이상 단계 및 제2 지지 다각형에 대해 상기 로봇의 무게 중심의 이탈 지점의 위치를 연산하기 위한 단계를 추가로 포함하며, 상기 제2 다각형은 상기 표면과 거의 접촉함에 따라 감지된 말단들에 속한 상기 로봇의 상기 제2 말단의 상기 표면 상에서 이탈 지점에 제1 다각형을 추가함으로써 제1 다각형으로부터 추정된다.
본 발명은 또한 프로그램이 컴퓨터에서 실행될 때 방법을 실시할 수 있는 프로그램 코드 지시를 포함하는 컴퓨터 프로그램을 개시하며, 상기 프로그램은 로봇의 하나 이상의 제1 말단과 표면의 접촉을 감지하기 위한 하나 이상의 모듈을 포함하고 및 상기 표면 상에서 이동할 수 있는 휴머노이드 로봇의 넘어짐을 관리하며, 상기 프로그램은 제1 지지 다각형에 대해 상기 로봇의 무게 중심의 이탈 지점의 위치를 연산하기 위한 모듈을 포함하고, 상기 프로그램은 상기 표면과 상기 로봇의 하나 이상의 제2 말단의 근접을 감지하는 데이터용 하나 이상의 입력 모듈과 제2 지지 다각형에 대해 상기 로봇의 무게 중심의 이탈 지점의 위치를 연산하기 위한 모듈을 추가로 포함하며, 상기 제2 다각형은 상기 표면과 거의 접촉함에 따라 감지된 말단들에 속한 상기 로봇의 상기 제2 말단의 상기 표면 상에서 이탈 지점에 제1 다각형을 추가함으로써 제1 다각형으로부터 추정된다.
게다가, 본 발명의 알고리즘은 단지 1차 등식만을 사용하는 이점을 제공하며, 이에 따라 이는 종래 기술의 해결 방법에 비해 넘어짐 감지 단계에서 연산 리소스에 대해 더욱 바람직해진다.
바람직하게는, 이 해결 방법은 바람직하지 못하게 넘어짐 자세인 것으로 고려될 수 있는 허용가능한 자세를 사전에 필터링하는 것을 포함할 수 있으며, 이에 따라 본 발명의 연산 효율성이 추가로 증가된다. 게다가, 본 발명에 따라서, 넘어짐 상태가 감지 시에, 특히 단순한 기준의 함수로서 선택된 보호 해결방법이 이용될 것이며, 이 단순함은 또한 모든 이들 기능을 수행하기 위한 리소스를 유지해야 하는 다기능 휴머노이드 로봇의 경우에 가능한 연산 효율성을 유도한다. 또한, 본 발명의 넘어짐 관리 모드는 로봇이 보호 위치에 배치되어야 하는 오류(모터 오류, 전기적 오류 등)를 관리하는 모드에 특히 적합하다.
본 발명은 이의 다양한 특징 및 이점이 본 발명의 첨부된 도면 및 몇몇 예시적인 실시 형태에 따른 기술내용으로부터 명확해질 것이다.
도 1a, 1b, 1c, 1d, 1e 및 1f는 종래 기술에 따르는 로봇의 넘어짐을 예견하기 위한 연산 원리를 도시하는 도면.
도 2는 종래 기술에 따르는 로봇의 넘어짐을 관리하는 연산 모드의 기본도.
도 3은 본 발명의 몇몇 실시 형태에서 휴머노이드 로봇의 몸통의 지면 부분과의 접촉 센서의 배치를 도시하는 도면.
도 4는 발명의 몇몇 실시 형태에서 로봇의 특성 지점의 로봇의 몇몇의 기준 프레임 내에서 위치를 연산하기 위해 사용된 직접적 기하학적 모델을 도시하는 도면.
도 5a, 5b 및 도 5c는 발명의 몇몇 실시 형태에서 로봇의 넘어짐을 관리하는 연산 모드를 도시하는 도면.
도 6은 발명의 몇몇 실시 형태에서 로봇에 대한 가상 지지 다각형을 결정하기 위하여 이용되는 프로세싱의 흐름도.
도 7은 본 발명의 몇몇 실시 형태에서 로봇의 진행 평면 내에서 휴머노이드 로봇의 무게 중심의 이탈을 결정하기 위하여 고려되어야 하는 휴머노이드 로봇의 자세를 도시하는 도면.
도 8은 발명의 몇몇 실시 형태에서 로봇의 진행 평면 내에서 휴머노이드 로봇의 무게 중심의 이탈을 결정하기 위하여 이용되는 프로세싱의 흐름도.
도 9a 내지 도 9i는 발명의 몇몇 실시 형태에서 로봇의 넘어짐 상태를 감지하기 전에 필터링될 수 있는 로봇의 일부 자세를 도시하는 도면.
도 10은 일련의 가능한 위치에서 로봇의 자세를 특정하기 위하여 이용되는 프로세싱의 흐름도.
도 11은 본 발명의 몇몇 실시 형태에서 넘어짐의 결과를 최소화하기 위하여 로봇의 자세를 관리하는데 이용되는 프로세싱의 흐름도.
도 12는 본 발명의 몇몇 실시 형태에서 넘어짐의 결과를 최소화하는데 이용되는 동작 선택의 모달리티를 결정하는 원리를 도시하는 도면.
도 13a, 13b 및 13c는 본 발명의 몇몇 실시 형태에서 넘어짐의 결과를 최소화하는데 이용되는 자세의 예를 도시하는 도면.
도 14는 본 발명의 몇몇 실시 형태에서 물리적 및 기능적 예의 도면.
도 1a, 1b, 1c, 1d, 1e 및 1f에는 종래 기술에 따르는 로봇의 넘어짐(fall)을 예견하기 위한 연산 원리가 도시된다.
지면에 배치된 입방체(solid)의 안정성은 통상적으로 지면 상에 있는 이의 지지 다각형(support polygon)에 대한 지면 상에 있는 입방체의 무게 중심의 이탈(projection)의 위치에 의해 정해진다.
도 1a, 1c 및 1e에 도시된 바와 같이, 발로 반듯이 서 있는 휴머노이드 로봇의 경우, 지지 다각형은 발 내부의 영역과 발의 바닥(sole)의 결합에 의해 정해진다. 도 1a, 1c 및 1e에 도시된 로봇의 자세에 해당하는 지지 다각형은 각각 도 1b, 1d, 및 1f로 도시된다. 이들 3가지의 경우에, 로봇의 발은 로봇의 진행 표면과 완벽히 접촉하지 않으며, 이는 종래 기술의 문제점 중 하나이고, 지지 다각형은 로봇로봇의 발들 중 하나의 바닥의 표면으로 감소되며, 두번째 발은 움직인다. 도 1a 및 도 1b의 경우에, 로봇은 보행하고, 발(110a)은 지면상에 놓이지만 발(120a)은 지면 상에 재차 놓이기 전에 공중에 떠 있는다. 지면에 대한 발의 위치가 통상적으로 로봇 발의 바닥에 배치된 압력 센서에 의해 정해지는 경우, 지지 다각형(110b)은 지면과 단독으로 접촉하는 발(110a)의 바닥으로 감소된다. 보행은 ZMP가 항시 로봇의 지지 다각형 내에 있는 것을 보장하는 동적 현상이지만 보행은 무게 중심이 상기 다각형 내에 있는 것을 보장하지 못한다. 예를 들어, 로봇의 무게 중심은 다각형(110b) 외부에 있는 지점(120b)에서 이탈될 수 있다. 넘어짐의 감지는 단순히 다각형(110b) 외부에 있는 지점(120b)의 상대 배치로 종속되는 경우에, 넘어짐 관리 기구는 각각의 보폭에서 트리거될 수 있으며, 로봇은 보행할 수 없을 것이다.
무게 중심(120d, 120f)의 이탈은 또한 도 1c, 1d, 1e 및 1f에 의해 도시된 경우에 지지 다각형(110d, 110f)의 외부에 있을 것이다. 게다가, 이들 경우에, 발(120c)들 중 하나의 발이 지면과 접촉하지 않는 자체를 취하며, 이 발의 압력 센서는 지면과 접촉하지 않고 아이템의 정보를 전달하며, 이는 모든 센서가 지면과 접촉하지 않기 때문이며, 심지어 발이 부분적으로 접촉하는 경우 이 넘어짐 감지가 트리거될 것이다.
도 1e 및 도 1f에 도시된 경우에, NAO는 앉는 것(sit down)에 관한 것이다. 양 발은 지면과 접촉하고, 로봇은 후방을 향하여 기울어지거나 넘어질 것이지만 이 넘어짐은 고의적인 것이며, 이의 오른 손(130e)은 이 넘어짐을 제동할 것이며, 로롯이 완전히 넘어지지 않도록 보장한다. 이들 3가지의 경우에, 따라서 넘어짐 감지는 적절하지 못하게 트리거될 것이다.
본 발명은 종래 기술의 이 단점을 해결한다.
도 2는 종래 기술에 따른 로봇의 넘어짐을 관리하는 모드의 연산의 기본적인 도면이다.
종래 기술에 따라서, 도 1a 내지 도 1f에 따라 전술된 원리에 따라 넘어짐 상태(fall condition)가 감지되면, 이 구조에 따라 상이할 수 있는 민감한 부분을 보호함으로써 로봇에 대한 가능한 손상을 최소화하는 목적으로 넘어짐 관리 전략이 이용된다.
종래 기술의 넘어짐 관리 기구는 2003년 10월의 미국 네바다 라스베가스 및 2002년 10월의 스위스 라우산에서의 "Intelligent Robots and Systems, EPFL" 회의에서 후지와라(Fusiwara) 등의 "Falling Motion Control to Minimize Damage to Biped Humanoid Robot" 및 "The First Human-size Humanoid that can Fall Over Safely and Stand-up Again"에 기재된다. 이들 기구는 지면에 대하여 수직에 대한 로봇의 수직 축의 경사(θ)와 먼저 지면과 접촉하는 로봇의 일부를 예견하기 위하여 로봇의 무게 중심의 속도(VCdm)의 측정치를 이용한다. 이들 측정치는 지면에 대해 수직 방향으로 진동하는 역 진자(inverse pendulum)와 같이 로봇의 움직임을 모델링함으로써 동적 방식으로 수행된다. 수행되는 연산은 연산력(computation power)에 대해 특히 집중되고, 이에 따라 말하기 및 거동을 관리하는 것과 같은 유용한 임무 또는 관절 운동을 관리하는 것과 같은 영구적 임무에 대해 특정 방식으로 연산 능력이 할당되는 로봇 내에서 이 연산을 사용하는 것이 제한된다. 본 발명에 따라 이 제한을 배제될 수 있다.
도 3은 본 발명의 하나의 실시 형태에 따르는 휴머노이드 로봇의 물리적 아키텍처를 도시한다. 이러한 로봇은 2009년 10월 15일자로 공개된 특허 출원 WO2009/124951에 개시되어 있다. 이 플랫폼이 본 발명에 이르기 위한 개선점의 기초로서 역할했다. 다음의 기재에서, 이 휴머노이드 로봇은 이 일반 용어로, 또는 그 상표명 NAO™로 지칭될 수 있으며, 이로 인해, 지칭되는 것의 보편성이 변하는 것은 아니다.
이 로봇은 센서와 관절을 구동하는 액추에이터를 제어하기 위한 유형의 전자 카드를 약 24개 포함한다. 관절은 통상 적어도 2의 자유도(degree of freedom)를 가지며 따라서 2개의 모터를 가진다. 각각의 모터는 각도의 관점에서 구동된다. 관절은 또한 수 개의 위치 센서, 특히 자기 회전식 인코더(Magnetic Rotary Encoder, MRE)를 포함한다. 전자 제어 카드는 기성제품 마이크로제어기를 포함한다. 상기 마이크로제어기는 예컨대 마이크로칩(Microchip)사가 시판 중인 DSPICTM일 수 있다. 이는 DSP에 연결된 16-비트(bit) MCU이다. 이 MCU는 1 ms의 루프 종속 사이클(looped slaving cycle)을 가진다. 로봇은 또한 또 다른 유형의 작동기, 특히 그 색상 및 강도가 로봇의 감정을 전달할 수 있는 발광 다이오드(Light-emitting diode, LED)를 포함할 수 있다. 후자는 또한 또 다른 유형의 위치 센서, 특히 관성 유닛(inertial unit), 지상 압력 센서(Ground pressure sensor, FSR), 등을 포함할 수 있다. 이들 FSR(310)은 본 발명에서 이용하기 위해 특히 유용하다. FSR은 지면 또는 로봇의 임의의 그 외의 다른 진행 표면과의 각각의 발의 접촉을 감지하는 것으로 이 문헌에서 의도된다. 이 목적에 따라 예를 들어, 압전 저항 가요성 재료의 적어도 두 층을 갖는 테이프로 구성된 텍스칸(Tekscan)TM로부터의 플렉시포스(FlexiForce)TM(상표명)를 이용할 수 있다. 테이프의 전기 저항은 테이프가 배치되는 표면에 가해진 수직 압력의 함수로서 감소한다. 전류의 측정에 따라 교정 이후에 압력을 측정할 수 있다. 몇몇의 센서, 예를 들어, 4개의 센서가 각각의 발의 바닥에 대해 바람직하게 적용된다.
머리는 로봇의 지능, 특히, 로봇에 부여된 임무를 로봇이 달성하도록 하는 상위-수준 기능을 실행하는 카드를 포함한다. 카드의 프로세서는 기성품 x86 프로세서일 수 있다. AMD사에서 시판중인 GeodeTM(32 bits, 500 MHz)와 같은 저-소비 프로세서가 바람직한 방식에서 선택될 수 있다. 카드는 또한 한 세트의 RAM 및 플래시 메모리들을 포함할 수 있다. 이 카드는 또한 통상 WiFi, WiMax 전송 계층 상에서, 선택사항으로 선택적으로 VPN 내에 캡슐화된(encapsulated) 표준 프로토콜에 의해 데이터의 모바일 통신을 위한 공용 네트워크 상에서, 로봇과 외부 개체(거동 서버, 또 다른 로봇 등)와의 통신을 관리할 수 있다. 프로세서는 통상 표준 OS에 의해 구동되며 이에 따라 통상적인 상위-수준 언어(C, C++, Python, 등) 또는 상위-수준 기능을 프로그래밍하기 위한 URBI(로봇 공학을 위한 전문 프로그래밍 언어)와 같은 인공 지능을 위한 특수 언어를 사용할 수 있다.
카드는 로봇의 몸통에 수용된다. 여기에 카드에 의해 연산된 명령이 카드로 전송되는 것을 보장하는 컴퓨터가 위치한다. 이 카드의 컴퓨터는 또한 기성품 프로세서이다. 바람직하게는, 상기 컴퓨터는 100MHz로 클러킹된 ARM 9 타입의 32-비트 프로세서일 수 있다. 프로세서의 유형, 온/오프 버튼에 가까운 상기 프로세서의 중심 위치, 상기 프로세서의 전력 공급의 제어부로의 링크로 인해, 로봇의 전력 공급을 관리하기(대기 모드, 긴급 차단, 등)에 적합해진다. 또한 카드는 RAM과 플래시 메모리의 세트도 포함한다.
도 4에 관해 하기에서 기술된 바와 같이, 로봇의 기준 프레임에서 이펙터(effector)로 불리는 로봇의 특성 지점(characteristic point)의 위치를 연산할 수 있다. 이들 이펙터는 예를 들어, 로봇의 등부분(320), 팔꿈치의 관절(330), 어께의 관절(340) 또는 손가락의 관절(350)의 지점에 있을 수 있다. 따라서, 이 직접적 기하학적 모델의 연산은 로봇의 모폴리지의 함수로서 한계점(threshold)을 선택함으로써 상기 이펙터의 지면에 대한 근접부를 감지하는 수단으로서 사용될 수 있다.
도 4에는 본 발명의 몇몇 실시 형태에서 로봇의 특성 지점의 로봇의 몇몇 기준 프레임에서 위치를 연산하기 위해 사용된 직접적인 기하학적 모델(direct geometric model)이 도시된다. 주어진 경우에, 로봇의 각각의 관절의 각도는 로봇의 중앙 시스템으로 알려졌다. 따라서, 그 외의 다른 모든 것에 대한 각각의 관절의 상대 위치가 용이하게 연산될 수 있으며, 이는 사실상 관절형 체인(articulated chain)의 모든 자유도가 정해지고 알려진 관절형 체인을 수반하기 때문이다. 지점(a)의 기준 프레임에서 지점(b)의 위치를 용이하게 연산하기 위하여, 3x1 크기의 병진 행렬(translation matrix)과 3x3 크기의 회전 행렬(rotation matrix)로 구성되는 유형(aHb)의 4x4 균일 변환 행렬의 행렬이 이용된다. 균일 변환 행렬은 특히 하기 특성을 갖는다:
-이 행렬은 가역가능하고, aHb -1은 bHa와 동일하며,
-aHb X bHa = aHc이다.
몸통의 기준 프레임은 일반적으로 로봇의 주요 기준 프레임으로서 사용된다. 이 기준 프레임에서 왼손 및 오른손(각각 410, 420)과 왼발 및 오른발(각각 430, 440)의 위치는 행렬 0H1, 0H2, 0H3, 0H4로서 주어진다. 회전 각은 관절 내 거리에 이한 병진 거리와 관절의 모터의 각으로서 주어진다.
지면, 즉 도 4의 형상에서 오른발(440)에 대한 왼손(410)의 위치를 연산하기 위하여, 이에 따라 행렬 4H1을 연산할 필요가 있다. 상기 공식을 적용함으로써, 행렬 변환(matrix inversion) 및 행렬 곱셈(matrix multiplication)이 유도된다:
4H1 = 0H4 -1 x 0H1.
이 계획은 절대 기준 프레임 내에, 특히 예컨대, 기준(320)(둔부), (330)(팔꿈치), (340)(어깨) 및 (350)(손가락)에 대해 도 3에 배치된 것들과 같은 임의의 이펙터 내에서 로봇의 임의의 지점의 위치를 연산하는 데 사용될 수 있다.
도 5a, 5b 및 5c에는 본 발명의 몇몇 실시 형태에서 로봇의 넘어짐을 예상하기 위한 제어 원리가 도시된다. 본 발명의 원리는 이에 따라 통상 로봇의 안정성을 보장하기 위하여 지면에 근접한 이펙터를 고려하는 가상 또는 이탈된 지지 다각형으로 구성된다.
다각형(510a, 510b, 510c)은 도 1b, 1d 및 1f의 다각형(110b, 110d, 110f)에 각각 대응된다. 도 6에 대해 하기에서 설명된 수단에 의해, 압력 센서가 지면과 접촉하는 위치에 있지 않는 것으로 나타내지는 제2 발(120a, 120c) 및 손(130e)이 지면에 실제로 근접한지를 결정하고, 상대 근접 한계점은 로봇의 모폴로지에 따른 값으로 조절될 수 있다. 이 한계점 값은 키가 60 cm인 NAO 로봇의 경우 예를 들어, 4 cm 내지 5 cm일 수 있다. 더 키가 큰 로봇의 경우, 이 한계점 값은 증가될 것이다. 게다가, 높이의 관점에서(예를 들어, 계단을 오르는 이의 능력) 로봇의 보폭(stride)의 동역학이 고려되어야 한다. 이 제2 발의 영역은 본 경우에 물리적 실체에 해당하는 실제 다각형이 아닌 경우에 "가상(virtual)"에 관해 새로운 지지 다각형(530a, 530b, 530c)을 제시하기 위하여 미리 정해진 지지 다각형에 추가된다.
무게 중심(520a, 520b, 520c)은 각각의 경우 가상 지지 다각형 내에 위치되고, 넘어짐 감지 알고리즘은 넘어짐 관리 기구를 트리거할 요인이 없는 것을 결정하며, 반면 종래 기술의 알고리즘은 도 1a 내지 1f에 대해 도시된 바와 같이 트리거될 것이다.
도 6은 본 발명의 몇몇 실시 형태에서 로봇을 위한 가상 지지 다각형을 경정하기 위해 이용되는 프로세싱의 흐름도이다. 도 6에 도시된 흐름도에 따라서, 이펙터에 대한 정적 안정성의 위치가 물리적 실체(physical reality)에 해당하는 상태에서 단계(610)에서 지지 다각형의 연산을 개시하기 위하여 임의의 유형의 이펙터로 도 5a 내지 도 5c에 도시된 경우를 일반화할 수 있다(generalize). 따라서, 로봇이 이의 손, 등으로 보행하는 것을 상상할 수 있다. 압력 센서(310)는 질문 "이펙터가 접촉하고 있나?"에 대한 답변을 할 수 있다. 이들 압력 센서는 로봇의 전진 표면과 이펙터의 접촉을 가능하게 하는 임의의 수단으로 교체될 수 있다. 제1 다각형이 연산되면(단계 620), 또한 도 5a 내지 도 5c에 예시된 경우를 지지 다각형을 보완하기 위해 임의의 개수(n-1)의 상보적인 이펙터로 일반화할 수 있다. 그 외의 다른 발과 2개의 손이 조직적으로 시험된다. 또한, 등, 발꿈치 및 어깨를 추가할지를 결정할 수 있다. 시험(630)("이펙터(i)의 높이가 한계점(h0) 미만인가?"는 각각의 이펙터의 위치의 직접적 기하학적 형상에 의해 연산을 요청하고, 밝혀진 위치는 전술된 바와 같이 정해진 한계점 미만으로 지면에 근접한 것으로 나타난다. 시험이 능동적인 경우, 이펙터(i)는 다각형에 추가된다(단계 640). 연산은 미리선택된 이펙터가 규명될 때까지 지속된다.
도 7은 본 발명의 몇몇 실시 형태에서 로봇의 진행 평면 내에서 휴머노이드 로봇의 무게 중심의 이탈을 상대적인 방식으로 결정하기 위해 고려되어야 하는 휴머노이드 로봇의 자세가 도시된다.
도면에서, 로봇의 발은 지면 상에서 평평하게 놓여지고 지면과 각(θ)을 형성하며, 발의 수직선이 무게 중심의 이탈인 것으로 고려될 수 없다. 관절 변수로서 제시된 로봇의 배향은 그 뒤에 정확하지 않을 것이다. 따라서, 이를 교정할 필요가 있다. 이를 위해, 관성 측정 유닛의 데이터가 도 8에 대해 후술된 바와 같이 연산에 포함될 것이다.
도 8은 본 발명의 몇몇 실시 형태에서 로봇의 진행 평면에서 휴머노이드 로봇의 무게 중심의 이탈을 결정하기 위해 이용되는 프로세싱의 흐름도이다. 알고리즘은 관성 측정 유닛의 위치 측정 시에 몸통의 배향을 리셋팅하는 것으로 구성된다. 관성 측정 유닛은 2개의 자이로스코프 및 3개의 가속도계의 측정을 기초로 2개의 회전 각을 전달한다. 리그(rig) 자체가 연속적으로 리셋팅된다. 2개의 측정치 간에 오프셋이 있는 경우, 발은 지면과 0이 아닌 각(θ)을 형성하고, θ는 연산되며, 이 각도는 리그에 의해 제시된 수직선과 발-몸통 축에 의해 형성된 각도와 동일하다.
도 9a 내지 도 9i에는 본 발명의 몇몇 실시 형태에서 로봇의 넘어짐의 구현 상태를 감지하기 전에 필터링될 수 있는 로봇의 몇몇 자세가 도시된다.
도 6에 관하여 전술된 바와 같이, 로봇의 실제 자세에 가장 잘 대응되는 가상 지지 다각형을 결정하기 위해 몇몇의 이펙터를 추가할 수 있다. 그러나, 다수의 이펙터를 추가하는 것은 넘어짐 감지 공정을 더디게 할 것이다. 따라서, 상기 자세들을 필터링하기 전에 넘어짐 감지를 수행하기 위해 필요한 자세 및 상기 감지를 수행하기 위해 필요가 없는 자세를 추출하는 것이 선호될 수 있다. 또한, 인식되는 자세 유형의 함수로서, 감지 연산을 수행하기 위해 시험되는 이펙터가 결정되는 것을 상상할 수 있다.
도 9a 및 도 9b에는 넘어짐 감지 메커니즘을 적용하기 위해 필요한 "직립" 및 "웅쿠린" 자체 각각이 도시된다. 도 9c 내지 도 9i에는 "개구리형(frog)", "무릎을 꿇고 있는", "팔이 앞에 있는 상태로 앉은", "팔이 뒤에 있는 상태로 앉은", 뒤로 누운", "옆으로 누운" 및 "알려지지 않은" 자세가 각각 도시된다. 도 9i에서 로봇은 제3자가 잡고 있으며, 어느 이펙터도 지면과 접촉하지 않는다. 도 9c 내지 도 9i의 경우에, 넘어짐 감지 연산이 수행되지 않는다.
도 10에는 일련의 가능 위치에서 로봇의 자세를 특정화하기 위하여 이용되는 프로세싱의 흐름도이다. 로봇 자세의 필터링은 관절의 각도 값, 발 접촉 센서의 출력, 및 관성 측정 유닛의 측정치를 사용하여 수행된다. 필터링되는 자세의 데이터는 데이터베이스 내에 저장된 기준 자세의 데이터와 비교된다. 거리 최소화 원리(예를 들어, 해당 기준 데이터에 대해 필터링되는 각각의 데이터의 상대적 차이의 합)가 이 비교를 위해 사용된다. 이 기준에 따른 거리 측정이 실험 결과치의 함수로서 그리고 데이터의 개수의 함수로서 정해진 한계점과 비교된다.
이 함수는 하기에서 언급된 도 14에 도시된 예시적인 실시 형태에서 모듈 알로봇포즈(ALRobotPose)에 의해 이용된다.
도 11은 본 발명의 몇몇 실시 형태에서 넘어짐의 결과를 최소화하기 위하여 로봇의 자세를 관리하도록 이용되는 프로세싱의 흐름도이다. 도 6에 따라 전술된 수단에 의해 넘어짐 상태가 감지될 때, 로봇의 민감한 구역, 특히 통상적으로 복합적이고 깨지기 쉬운 관절을 포함하는 골반, 깨지기 쉬운 센서 및 프로세서를 포함하는 이의 머리를 보호하기 위하여 상기 수단이 이용된다. 특히 다리관절(골반의 것들이 아님)의 종속성이 제거될 것이며, 수행되는 보호 동작은 도 12에 관하여 후술된 바와 같이 정해진 넘어짐 각도에 따를 것이다. 게다가, 이 보호 동작이 수행되면, 팔, 머리 및 골반의 관절의 종속성이 제거된다. 이들 동작은 매우 신속히 수행되고 로봇의 원래의 모습(genuine reflex)으로 구성될 수 있어야 한다.
도 12에는 본 발명의 몇몇 실시 형태의 넘어짐 결과를 최소화하기 위하여 이용되는 동작을 선택하는 모달리티의 원리가 도시된다. 넘어짐 상태가 도 6에 관해 전술된 수단에 의해 감지될 때, 지면의 평면에서 넘어짐 각도가 정해진다. 따라서, 지면 상에서 기준 프레임(소위 SPACE_NAO)이 이용된다. 이는 소위 자기중심적 기준 프레임을 수반하고, 이는 이 기준 프레임에서 로봇의 무게 중심이 이탈되는 위치를 인지함으로써 로봇의 방향(전방)으로 항시 x 축이 배향되는 것을 특징으로 하며, 이탈 각도는 단순한 기하학적 형상에 의해 추정된다. 각도는 능동적으로 시계 방향으로 로봇의 진행 축에 대해 계산된다. -60° 내지 +60° 사이에서 앞으로 넘어지는 것으로 고려되고, +60° 내지 +120° 사이에서 우측으로, +120° 내지 -120° 사이에서 뒤로, -120° 내지 -60° 사이에서 좌측으로 넘어지는 것으로 고려된다.
보호 전략의 선택의 관점으로부터, 우측 및 좌측 섹터는 동일하다. 도면에 도시된 실시 형태 내에서, 넘어짐 각도에 따라 도 13a 내지 도 13c에 대해 후술된 3가지의 상이한 전략의 선택을 유도하는 3개의 섹터를 결정할 수 있다. 그러나, 3개 초과의 섹터, 이에 따라 3개 초과의 보호 전략을 결정할 수 있다. 본 발명의 원리는 예를 들어, 도 2에 관해 설명된 바와 같이 역 진자의 모델을 적용함으로써 정확히 연산된 넘어짐 동역학(fall dynamics)에 따른 넘어짐 자세를 정확히 연산하기 위함은 아니다. 게다가, 이는 넘어지는 방향이 보호 전략에 영향을 미치는 방식으로 그리고 로봇의 민감성에 따른 위험 부류의 함수로서 정해지는 몇몇 유형의 보호 전략들 간의 선택을 수반한다. 예를 들어, 종래 기술에서와 같이 로봇의 다리의 동작 생성은 움직임이 상당한 관성을 생성하기 때문에 지면에서의 충격을 증가시킬 수 있다. 따라서, 로봇의 관절의 종속성을 불가능하게 함으로써 로봇은 로봇 자체 중량에 따라 넘어질 수 있으며, 이에 따라 넘어지는 속도와 충격이 증가되지 않을 수 있다.
도 13a, 13b 및 13c는 본 발명의 몇몇 실시 형태에서 넘어짐의 결과를 최소화하기 위해 선택된 자세의 예시이다.
도 13a는 앞으로 넘어지는 경우가 예시되며, 이들 경우에 보호 몸짓은 예를 들어, 다음으로 구성된다:
-머리를 후방을 향하여 둠으로써 머리를 보호함;
-머리를 보호하고 넘어짐을 약화시키기 위해 팔을 앞을 향하여 둠;
-로봇의 다리를 함께 모으기 위해 골반을 닫음.
도 13b는 우측 또는 좌측으로 넘어지는 경우가 예시되며, 이들 경우에 보호 몸짓은 예를 들어, 다음으로 구성된다:
-예를 들어, 앞으로 그리고 우측으로의 머리의 가능한 이탈을 고려한 자세로 머리를 둠으로써 머리를 보호함(예를 들어, 이더넷 케이블(Ethernet cable), 등의 존재 시에);
-몸을 향하여 팔을 모음;
-지면과의 충돌 지점이 등이고 골반이 아니도록 로봇이 회전하도록 하여 골반을 개방함.
도 13c는 뒤로 넘어지는 경우가 예시되며, 이들 경우에 보호 몸짓은 예를 들어, 다음으로 구성된다:
--예를 들어, 앞으로 그리고 우측으로의 머리의 가능한 이탈을 고려한 자세로 머리를 둠으로써 머리를 보호함(예를 들어, 이더넷 케이블, 등의 존재 시에);
-로봇을 고정하기 위해 팔을 후방을 향하여 둠; 이 동작은 로봇이 이의 등으로 구르고 이의 목이 잘려지는 것을 방지하기 위해 의도됨;
-로봇의 다리를 함께 모으기 위해 골반을 닫음.
도 14는 본 발명의 몇몇 실시 형태에서 이용될 수 있는 물리적 및 기능적 구조의 도면이다. NAO와 같은 로봇은 바람직하게는 본 발명의 실시 형태에서 로봇의 기능을 조종할 수 있는 상위-수준 소프트웨어가 제공된다. NAOQI로 불리는 이러한 유형의 소프트웨어 구조는 특히 2009.10.15. 공개된 특허 출원 WO2009/124955에 개시되어 있다. 이는 로봇과 PC 또는 원격 사이트 사이의 통신을 관리하기 위한 그리고 본 발명의 실행을 위하여 필수적인 소프트웨어 인프라구조를 제공하는 소프트웨어를 교환하기 위한 기초 기능들을 포함한다.
NAOQI는 로봇 응용에 대해 최적화된 프레임워크이며, 이는 몇몇의 언어, 특히 C++, 파이썬(Python) 및 우비(Urbi)를 지원한다.
본 발명의 문헌 내에서, NAOQI의 하기 모듈이 특히 유용하다:
-NAOQI의 다양한 모듈들 간에 공유된 메모리를 관리하는 모듈 알메모리(ALMemory; 1410);
-물리적 로봇(모터, 센서)과의 통신을 관리하는 모듈 DCM(1420);
-기준 자세와 비교함으로써 로봇의 현재의 자세를 연산하는 모듈 알로봇포즈(ALRobotPose, 1430);
-로봇의 동작을 관리하는 알모션 모듈(ALMotion module, 1440); 이 모듈 내에서 본 발명의 넘어짐을 감지 및 관리하기 위한 기능부가 장착됨.
이들 4개의 모듈은 바람직하게는 C++로 코딩된다. 도면은 또한 모듈들 간의 데이터 흐름을 나타낸다.
특히, 넘어짐 관리 기능을 이용하기 위해 필요한 입력은:
-센서의 값(예를 들어, 발 압력 센서, 관성 측정 유닛);
-로봇의 자세.
넘어짐을 감지하는 경우에, 넘어짐 관리 기능은 특히 관절을 비활성화시키고 구부러짐 보호 동작을 수행하기 위해 관절을 업데이팅하는 명령을 제공한다. 단지 예시로서 도면에 또한 도시된 바와 같이, 각각의 모듈에 의해 처리되는 데이터에 대한 리프레쉬 사이클(refresh cycle)의 값은 로봇 자세의 업데이팅의 경우 20 ms 및 센서 값에 대해서는 10 ms이다.
넘어짐 관리 기능은 특성 센서, 예를 들어, MRE 센서의 열악한 작동에 의해 트리거될 수 있다. 이 경우에, 하나 이상의 관절의 비정상적 움직임이 발생될 것이며, 오류가 가상 지지 다각형으로부터 무게 중심의 이탈을 야기하는 경우, 보호 위치로의 배치가 트리거될 것이다. 따라서, 넘어짐 관리는 로봇의 오류 관리를 위한 기능을 보조한다.
본 명세서에 기재된 예는 본 발명의 실시 형태의 예시로서 주어진다. 이는 하기 청구항에 의해 정해진 본 발명의 범위를 임의의 방식으로 제한하지 않는다.

Claims (15)

  1. 로봇(110a, 110b, 110c)의 하나 이상의 제1 말단과 표면의 접촉을 감지하기 위한 하나 이상의 모듈 및 상기 하나 이상의 말단으로 구성된 제1 지지 다각형(110b, 110d, 110f)에 대해 로봇의 무게 중심의 이탈 지점의 위치(120b, 120d, 120f)을 포함하는, 표면 상에서 이동할 수 있는 휴머노이드 로봇으로서,
    상기 표면과 상기 로봇의 하나 이상의 제2 말단(120a, 120b, 120c, 320, 330, 340, 350)의 근접을 감지하기 위한 하나 이상의 모듈을 추가로 포함하고, 제1 지지 다각형에 대해 상기 로봇의 무게 중심의 이탈 지점의 위치를 연산하기 위한 모듈은 또한 제2 지지 다각형(530a, 530b, 530c)에 대해 상기 로봇의 무게 중심의 이탈 위치를 연산할 수 있으며, 상기 제2 다각형은 상기 표면과 거의 접촉함에 따라 감지된 말단들에 속한 상기 로봇의 상기 제2 말단의 상기 표면 상에서 이탈 지점에 제1 다각형을 추가함으로써 제1 다각형으로부터 추정되는 휴머노이드 로봇.
  2. 제1항에 있어서, 상기 표면과 상기 하나 이상의 제2 말단의 근접을 감지하기 위한 모듈은 상기 표면에 대해 상기 하나 이상의 제2 말단의 위치에 대한 입력으로서 수신되고, 상기 위치는 로봇의 기준 프레임에서 상기 말단의 공간 내의 위치를 포함하는 로봇의 기하학적 모델의 출력으로서 제공되는 휴머노이드 로봇.
  3. 제2항에 있어서, 로봇의 제2 말단이 상기 표면과 거의 접촉하는 상태는 로봇의 크기 및 로봇의 하지의 높이에서 스윙하는 최대치를 포함하는 기준의 그룹에 속한 기준의 함수로서 선택된 거리 한계점을 특징으로 하는 휴머노이드 로봇.
  4. 제1항 내지 제3항 중 어느 한 한에 있어서, 상기 하나 이상의 제1 말단은 로봇의 발 중 하나이고, 상기 발에는 하나 이상의 압력 센서가 제공되는 휴머노이드 로봇.
  5. 제1항 내지 제4항 중 어느 한 한에 있어서, 하나 이상의 제2 말단은 로봇의 손 중 하나인 휴머노이드 로봇.
  6. 제1항 내지 제5항 중 어느 한 한에 있어서, 지지 다각형에 대해 상기 로봇의 무게 중심의 이탈 지점의 위치를 연산하기 위한 상기 모듈의 압력으로서 기준 자세의 기하학적 모델과 로봇 자세의 기하학적 모델 간의 거리의 소정의 기준에 따른 비교에 의해 로봇의 자세를 필터링하기 위한 모듈을 추가로 포함하는 휴머노이드 로봇.
  7. 제1항 내지 제6항 중 어느 한 한에 있어서, 수직 축과 로봇의 무게 중심의 이탈 지점의 위치를 연산하기 위한 모듈을 제공하는 관성 리그를 추가로 포함하고, 지면과 접촉하는 로봇의 발 중 하나와 흉부를 연결하는 축과의 상기 리그의 각도는 로봇의 무게 중심의 이탈 축에 적용된 회전 각을 제공하는 휴머노이드 로봇.
  8. 제1항 내지 제6항 중 어느 한 한에 있어서, 지지 다각형에 대해 상기 로봇의 무게 중심의 이탈 지점의 위치를 연산하기 위한 모듈의 출력으로서 넘어짐을 보호하기 위한 동작의 그룹을 모니터링하는 모듈을 추가로 포함하고, 로봇의 무게 중심의 이탈 지점이 제2 지지 다각형의 외부에 있는 로봇의 넘어진 상태의 하나 이상의 출력을 연산 모듈이 제공할 때 하나 이상의 동작의 그룹이 트리거되는 휴머노이드 로봇.
  9. 제8항에 있어서, 보호 동작의 그룹은 로봇의 발 관절의 종속을 불가능하게 하는 것, 머리, 팔 및 골반을 포함하는 그룹에 속한 하나 이상의 요소의 보호 자세로 배치되는 것 및 상기 그룹에 속한 하나 이상의 요소의 관절을 무능하게 하는 것을 포함하는 휴머노이드 로봇.
  10. 제8항 또는 제9항에 있어서, 상기 연산 모듈은 로봇의 넘어짐 상태의 상태 특성에 대하여 넘어짐에 대한 보호를 위한 동작의 그룹을 모니터링하기 위한 모듈에 로봇의 기준 프레임에서 넘어짐 방향의 각 특성을 추가로 제공하고, 선택된 기준 값에 대한 상기 넘어짐의 각도 값은 수행되는 넘어짐에 대하여 보호를 위한 동작의 그룹의 보호 동작의 선택을 결정하는 휴머노이드 로봇.
  11. 제9항 또는 제10항에 있어서, 넘어지는 각도가 앞으로 넘어지는 것을 결정할 때, 머리의 보호 자세를 취하는 것은 실질적으로 머리를 뒤로 두는 것이며, 팔의 보호 자세를 취하는 것은 실질적으로 팔을 앞으로 두는 것이고 골반의 보호 자세를 취하는 것은 골반을 인접하게 모으는 것인 휴머노이드 로봇.
  12. 제9항 또는 제10항에 있어서, 넘어지는 각도가 좌측 또는 우측으로 넘어지는 것을 결정할 때, 머리의 보호 자세를 취하는 것은 실질적으로 머리를 앞으로 두는 것이며, 팔의 보호 자세를 취하는 것은 실질적으로 팔을 몸의 앞에 두는 것이고 골반의 보호 자세를 취하는 것은 골반을 개방하는 것인 휴머노이드 로봇.
  13. 제9항 또는 제10항에 있어서, 넘어지는 각도가 뒤로 넘어지는 것을 결정할 때, 머리의 보호 자세를 취하는 것은 실질적으로 머리를 앞으로 두는 것이며, 팔의 보호 자세를 취하는 것은 실질적으로 팔을 뒤로 두는 것이고 골반의 보호 자세를 취하는 것은 골반을 인접하게 모으는 것인 휴머노이드 로봇.
  14. 로봇의 하나 이상의 제1 말단과 표면의 접촉을 감지하기 위한 하나 이상의 모듈 및 상기 표면 상에서 이동할 수 있는 휴머노이드 로봇의 넘어짐을 관리하기 위한 방법으로서, 상기 방법은 상기 하나 이상의 말단으로 구성된 제1 지지 다각형에 대해 상기 로봇의 무게 중심의 이탈 지점의 위치를 연산하기 위한 단계를 포함하고, 상기 방법은 상기 표면과 상기 로봇의 하나 이상의 제2 말단의 근접을 감지하기 위한 하나 이상 단계 및 제2 지지 다각형에 대해 상기 로봇의 무게 중심의 이탈 지점의 위치를 연산하기 위한 단계를 추가로 포함하며, 상기 제2 다각형은 상기 표면과 거의 접촉함에 따라 감지된 말단들에 속한 상기 로봇의 상기 제2 말단의 상기 표면 상에서 이탈 지점에 제1 다각형을 추가함으로써 제1 다각형으로부터 추정되는 방법.
  15. 프로그램이 컴퓨터에서 실행될 때 제14항에 따른 방법을 실시할 수 있는 프로그램 코드 지시를 포함하는 컴퓨터 프로그램으로서, 상기 프로그램은 로봇의 하나 이상의 제1 말단과 표면의 접촉을 감지하기 위한 하나 이상의 모듈을 포함하고 및 상기 표면 상에서 이동할 수 있는 휴머노이드 로봇의 넘어짐을 관리하며, 상기 프로그램은 제1 지지 다각형에 대해 상기 로봇의 무게 중심의 이탈 지점의 위치를 연산하기 위한 모듈을 포함하고, 상기 프로그램은 상기 표면과 상기 로봇의 하나 이상의 제2 말단의 근접을 감지하는 데이터용 하나 이상의 입력 모듈과 제2 지지 다각형에 대해 상기 로봇의 무게 중심의 이탈 지점의 위치를 연산하기 위한 모듈을 추가로 포함하며, 상기 제2 다각형은 상기 표면과 거의 접촉함에 따라 감지된 말단들에 속한 상기 로봇의 상기 제2 말단의 상기 표면 상에서 이탈 지점에 제1 다각형을 추가함으로써 제1 다각형으로부터 추정되는 컴퓨터 프로그램.
KR1020137007601A 2010-08-27 2011-08-11 넘어짐 관리 능력을 갖는 휴머노이드 로봇 및 상기 넘어짐을 관리하기 위한 방법 KR101882532B1 (ko)

Applications Claiming Priority (3)

Application Number Priority Date Filing Date Title
FR1056798 2010-08-27
FR1056798A FR2964055B1 (fr) 2010-08-27 2010-08-27 Robot humanoide dote de capacites de gestion de chutes et methode de gestion desdites chutes
PCT/EP2011/063801 WO2012025387A1 (fr) 2010-08-27 2011-08-11 Robot humanoide dote de capacites de gestion de chutes et methode de gestion desdites chutes

Publications (2)

Publication Number Publication Date
KR20140037786A true KR20140037786A (ko) 2014-03-27
KR101882532B1 KR101882532B1 (ko) 2018-07-26

Family

ID=43829315

Family Applications (1)

Application Number Title Priority Date Filing Date
KR1020137007601A KR101882532B1 (ko) 2010-08-27 2011-08-11 넘어짐 관리 능력을 갖는 휴머노이드 로봇 및 상기 넘어짐을 관리하기 위한 방법

Country Status (9)

Country Link
US (1) US9429948B2 (ko)
EP (1) EP2608997B1 (ko)
JP (1) JP6007908B2 (ko)
KR (1) KR101882532B1 (ko)
CN (1) CN103124669B (ko)
BR (1) BR112013004674A2 (ko)
ES (1) ES2454554T3 (ko)
FR (1) FR2964055B1 (ko)
WO (1) WO2012025387A1 (ko)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016014202A1 (en) * 2014-07-24 2016-01-28 Google Inc. Systems and methods for robotic self-right
CN113120109A (zh) * 2021-04-12 2021-07-16 北京理工大学 一种轮足复合仿人机器人的辅助支撑结构及其控制方法

Families Citing this family (24)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2969026B1 (fr) 2010-12-17 2013-02-01 Aldebaran Robotics Robot humanoide dote d'un gestionnaire de ses ressources physiques et virtuelles, procedes d'utilisation et de programmation
US9412010B2 (en) * 2011-07-15 2016-08-09 Panasonic Corporation Posture estimation device, posture estimation method, and posture estimation program
US9499219B1 (en) * 2014-08-25 2016-11-22 Google Inc. Touch-down sensing for robotic devices
JP6228097B2 (ja) * 2014-10-06 2017-11-08 本田技研工業株式会社 移動ロボット
US9555846B1 (en) 2015-03-20 2017-01-31 Google Inc. Pelvis structure for humanoid robot
CN104932254B (zh) * 2015-05-12 2017-07-21 北京理工大学 一种仿人机器人的前摔保护控制策略
US9594377B1 (en) * 2015-05-12 2017-03-14 Google Inc. Auto-height swing adjustment
EP3358546A4 (en) * 2015-09-29 2019-05-01 Sony Corporation INFORMATION PROCESSING DEVICE, INFORMATION PROCESSING METHOD, AND PROGRAM
GB2565959B (en) * 2016-07-11 2021-10-13 Groove X Inc Autonomously acting robot
CN106564055B (zh) * 2016-10-31 2019-08-27 金阳娃 仿真人机器人稳定性运动规划方法及控制装置
CN106737682B (zh) * 2016-12-31 2019-08-16 深圳市优必选科技有限公司 机器人掉电防摔方法和装置及掉电防摔机器人
WO2018198480A1 (ja) * 2017-04-28 2018-11-01 ソニー株式会社 制御装置、および制御方法
CN108724170B (zh) * 2017-08-15 2021-04-16 北京猎户星空科技有限公司 防止机器人倾倒的方法、装置、机器人及存储介质
CN109693234B (zh) * 2017-10-20 2021-08-27 深圳市优必选科技有限公司 机器人跌倒预测方法、装置、终端设备及计算机存储介质
US10807246B2 (en) * 2018-01-08 2020-10-20 Beijing Jingdong Shangke Information Technology Co., Ltd. Mobile robotic device and method of controlling the same manipulator for locomotion and manipulation
CN110053039B (zh) * 2018-01-17 2021-10-29 深圳市优必选科技有限公司 一种机器人行走中重力补偿的方法、装置及机器人
CN109849999B (zh) * 2019-03-29 2020-11-20 联想(北京)有限公司 一种可移动装置及处理方法
CN110936380B (zh) * 2019-12-11 2024-01-16 桂林凯歌信息科技有限公司 碰撞防摔机器人及其控制方法
US11407109B2 (en) * 2020-04-16 2022-08-09 Boston Dynamics, Inc. Global arm path planning with roadmaps and precomputed domains
CN111730605B (zh) * 2020-08-04 2020-12-15 深圳市优必选科技股份有限公司 一种机器人姿态控制方法、装置、可读存储介质及机器人
CN112859904A (zh) * 2021-01-25 2021-05-28 乐聚(深圳)机器人技术有限公司 机器人站立姿态的恢复方法、装置、设备及存储介质
CN113146621B (zh) * 2021-03-17 2022-07-15 深圳市优必选科技股份有限公司 机器人控制方法、装置、机器人及计算机可读存储介质
CN113858207B (zh) * 2021-10-27 2023-06-09 乐聚(深圳)机器人技术有限公司 人形机器人的倒地控制方法、装置、电子设备及存储介质
WO2023082013A1 (en) * 2021-11-12 2023-05-19 Sanctuary Cognitive Systems Corporation Robots and methods for protecting fragile components thereof

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20040176875A1 (en) * 2002-12-16 2004-09-09 Sony Corporation Legged mobile robot

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4541771A (en) * 1983-03-31 1985-09-17 At&T Bell Laboratories Robot having magnetic proximity sensor and manufacturing method using same
JP3528171B2 (ja) * 1999-11-12 2004-05-17 ソニー株式会社 移動ロボット装置及び移動ロボット装置の転倒制御方法
KR100977348B1 (ko) * 2002-03-15 2010-08-20 소니 주식회사 다리식 이동 로봇의 동작 제어 장치 및 동작 제어 방법 및 로봇 장치
JP4029152B2 (ja) * 2003-01-08 2008-01-09 独立行政法人産業技術総合研究所 脚式移動ロボット及び制御方法
TR200300265A2 (tr) * 2003-03-04 2003-06-23 Necati̇@Hacikadi̇roğlu İki ya da çok bacaklı robotlar için dengeleme sistemi.
US7761184B2 (en) * 2003-03-23 2010-07-20 Sony Corporation Robot apparatus and control method thereof
JP4971977B2 (ja) * 2004-03-31 2012-07-11 本田技研工業株式会社 角運動量の変化率に基づいて脚式ロボットを制御する方法
JP4559803B2 (ja) * 2004-09-14 2010-10-13 敏男 福田 関節角の受動変化を利用して歩行するロボットとその制御方法
JP4886201B2 (ja) * 2005-03-14 2012-02-29 株式会社日立製作所 移動ロボット
US7313463B2 (en) * 2005-03-31 2007-12-25 Massachusetts Institute Of Technology Biomimetic motion and balance controllers for use in prosthetics, orthotics and robotics
FR2929873B1 (fr) 2008-04-09 2010-09-03 Aldebaran Robotics Architecture de controle-commande d'un robot mobile utilisant des membres articules
FR2930108B1 (fr) 2008-04-09 2010-07-30 Aldebaran Robotics Systeme et procede de communication distribue comprenant au moins un serveur, au moins un terminal distant, et au moins un terminal mobile capable de communiquer avec le terminal distant relie en reseau audit serveur
US8369991B2 (en) * 2008-12-19 2013-02-05 Honda Motor Co., Ltd. Humanoid fall direction change among multiple objects

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20040176875A1 (en) * 2002-12-16 2004-09-09 Sony Corporation Legged mobile robot

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016014202A1 (en) * 2014-07-24 2016-01-28 Google Inc. Systems and methods for robotic self-right
CN113120109A (zh) * 2021-04-12 2021-07-16 北京理工大学 一种轮足复合仿人机器人的辅助支撑结构及其控制方法
CN113120109B (zh) * 2021-04-12 2022-04-08 北京理工大学 一种轮足复合仿人机器人的辅助支撑结构及其控制方法

Also Published As

Publication number Publication date
CN103124669B (zh) 2016-06-29
US20130231822A1 (en) 2013-09-05
ES2454554T3 (es) 2014-04-10
FR2964055A1 (fr) 2012-03-02
JP2013540057A (ja) 2013-10-31
WO2012025387A1 (fr) 2012-03-01
CN103124669A (zh) 2013-05-29
US9429948B2 (en) 2016-08-30
FR2964055B1 (fr) 2012-08-17
EP2608997B1 (fr) 2013-12-25
EP2608997A1 (fr) 2013-07-03
JP6007908B2 (ja) 2016-10-19
KR101882532B1 (ko) 2018-07-26
BR112013004674A2 (pt) 2024-01-16

Similar Documents

Publication Publication Date Title
KR20140037786A (ko) 넘어짐 관리 능력을 갖는 휴머노이드 로봇 및 상기 넘어짐을 관리하기 위한 방법
US6802382B2 (en) Robot moving on legs and control method therefor, and relative movement measuring sensor for robot moving on legs
ES2659053T3 (es) Robot con articulaciones de rigidez variable y procedimiento de cálculo de dicha rigidez optimizada
US11045945B2 (en) Method for controlling walking of robot and robot
US8352077B2 (en) Inertia shaping for humanoid fall direction change
Fumagalli et al. Force feedback exploiting tactile and proximal force/torque sensing: Theory and implementation on the humanoid robot iCub
US8396595B2 (en) Real-time self collision and obstacle avoidance using weighting matrix
KR102363857B1 (ko) 로봇에 의한 충돌 처리
US8818559B2 (en) Robot apparatus and control method therefor
WO2017201184A1 (en) Continuous robotic knee joint system
Chen et al. Real-time walking gait estimation for construction workers using a single wearable inertial measurement unit (IMU)
Nori et al. Simultaneous state and dynamics estimation in articulated structures
Watanabe et al. Self-contained kinematic calibration of a novel whole-body artificial skin for human-robot collaboration
Chavez et al. Contact force and joint torque estimation using skin
Lancaster et al. Optical proximity sensing for pose estimation during in-hand manipulation
Čížek et al. Online foot-strike detection using inertial measurements for multi-legged walking robots
Lu et al. An Electronic Travel Aid based on multi-sensor fusion using extended Kalman filter
KR102018950B1 (ko) 하지부 기구학 보정 장치 및 이를 이용한 하지부 자세정보 보정 방법
CN113485309B (zh) 机器人测试方法、装置、系统、机器人控制器及介质
Bratta Model-Based Motion Planning for Quadruped Robots: from simulation to hardware implementation
Luo et al. A non-linear kinematics and dynamics estimator based on unscented kalman filter with angular momentum for humanoid compliant walking
Lubbe State estimation of a hexapod robot using a proprioceptive sensory system
Einstein Predictive Dynamics

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