機器人裝置及其姿態控制方法

專利名稱：機器人裝置及其姿態控制方法
技術領域：
本發明涉及機器人裝置及其姿態控制方法，該機器人裝置具有從翻倒狀態等異常姿勢狀態獨立地復原為正常姿勢狀態的功能。
背景技術：
以往所見的多是通過輪子轉動實現滑行的輪式機器人和2足或4足的獨立式步行機器人等具有不同形式的結構系統的各種形態的機器人裝置。
此類機器人裝置在各個規定的位置上設置著具有一定自由度的傳動器及檢測特定物理量的傳感器等結構系統。通過裝有微電腦的控制部按照各種傳感器的輸出及控制程序對各種傳動器進行個別的驅動控制，使自行或規定執行的動作得以實現。又，此類機器人裝置的軀干部、腳部及頭部等各部位以具有各種預定的相關關系的狀態結合而成，并由此裝配成規定的形態。
具有2只或2只以上的多只的多足步行機器人中，有像貓、狗式的動物類形態的機器人。此種形態的多足步行機器人，以具有4只足的為例，各只足上都裝有一定數量的關節部。對此類機器人的足關節進行控制的方法，有將位置信息、速度信息通過示教進行記錄和再現的方法，還有采用運動模型將位置信息、速度信息通過運算生成執行的方法。
以往對機器人裝置的控制，不論是采用示教法還是運動模型法，都是以設計者預想環境下的動作為前提。因此，在使用環境變化后，裝置的姿態出現意外狀況的情形時有發生。由于異常姿態對裝置的功能和結構造成危害、故障或對使用環境造成危害的可能亦隨之而生。
發明的公開鑒于上述以往機器人裝置的實際情況，本發明的目的在于防止在翻倒狀態等異常姿勢狀態時使用的機器人裝置發生故障和事故。
本發明的目的還在于提供一種機器人裝置及其姿態控制方法，它能使機器人裝置從翻倒狀態等異常姿勢狀態獨立地復原到正常的姿勢狀態。
與本發明相關的機器人裝置的特征在于具有下列裝置，即確認裝置主體的姿態并將確認結果進行輸出的姿態確認裝置；基于所述確認結果對前述裝置主體成為某種規定姿態進行判別的姿態判別裝置；在由所述姿態判別裝置進行前述規定姿態的判定后，將前述裝置主體的姿態進行修正的姿態修正裝置。
與本發明相關的機器人裝置的姿態控制方法的特征在于確認裝置主體的姿態，根據該確認結果對所述裝置主體成為某種規定的姿態進行判別，在判定了所述規定的姿態后，將所述裝置主體的姿態進行修正。
附圖的簡要說明

圖1所示，為將應用了本發明的多足步行機器人的結構模型化的透視圖。
圖2所示，為將用于檢測所述多足步行機器人的翻倒狀態的加速度傳感器等各種傳感器的設置狀態模型化的透視圖。
圖3所示，為將所述多足步行機器人控制系統的結構模型化的方塊圖。
圖4所示，為簡化的前述多足步行機器人基本姿勢的透視圖。
圖5所示，為簡化的前述多足步行機器人由基本姿勢變為左前腳抬起狀態的透視圖。
圖6所示，為簡化的前述多足步行機器人姿勢倒塌后狀態的透視圖。
圖7所示，為簡化的前述多足步行機器人姿勢沒有倒塌狀態的透視圖。
圖8所示，為前述多足步行機器人行動模式的編輯方法案例的程序框圖。
圖9所示，為前述多足步行機器人控制部所做的翻倒判定的算法案例的程序框圖。
圖10A及圖10B所示，為以所述翻倒判定處理求得的平均加速度Acc與Y-Z平面之間的偏移角θ、平均加速度Acc向Y-Z平面的投影成分與Z軸形成的角φ之關系的模式圖。
圖11所示，為由所述多足步行機器人的形狀為制約條件而確定的步行時翻倒方向與角φ之關系的模式圖。
圖12A、圖12B、圖12C及圖12D所示，為所述多足步行機器人步行時各種翻倒狀態的側面模型圖。
圖13所示，為所述多足步行機器人從翻倒狀態復原為正常姿勢狀態的動作過程的側面模型圖。
圖14所示，為所述多足步行機器人站立姿勢時接觸傳感器的接觸檢測的狀態模型圖。
圖15所示，為所述多足步行機器人坐下姿勢時接觸傳感器的接觸檢測的狀態模型圖。
圖16所示，為所述多足步行機器人站立姿勢通過CCD攝像相獲得圖像信息的狀態模型圖。
圖17A、圖17B、圖17C及圖17D所示，為在正常姿勢及異常姿勢狀態時，CCD攝像機獲得的各圖像信息的模型圖。
圖18為根據所述CCD攝像機獲得的圖像信息判定地面狀態方法的說明圖。
圖19為作為異常姿態檢測裝置設有旋轉檢測裝置的輪式機器人裝置的模型透視圖。
圖20為作為異常姿勢檢測裝置設有地面檢測裝置的輪式機器人裝置的模型透視圖。
圖21所示，為從背部翻倒狀態起復原動作的狀態變化模型圖。
發明實施的最佳形態下面，關于本發明實施的最佳形態參照圖表加以說明。
本發明適用于圖1所示結構的多足步行機器人1。
此多足步行機器人1為多關節型機器人，呈長有4只足的動物型。多關節型機器人1有主體2、右前足3、左前足4、右后足5、左后足6、頭部7、軀干部8、尾部9等。
此多關節型機器人1右前足3、左前足4、右后足5、左后足6等的關節部10、11、12、13處設有制動機構30。利用此制動機構30的動作，操作者能夠以直接教學方式將右前足3、左前足4、右后足5、左后足6中任意動作部(腳)的相對位置關系進行位置示教。
主體2上設有右前足3、左前足4、左后足5、左后足6用的軸承架20、21、22、23。頭部7設于主體2的前上部，軀干部8設于從頭部7至后側的位置。尾部9從軀干部8的上方突出出來。
下面依次說明相對主體2設置的各個部分。
首先，右前足3上裝有腳3a、腳3b、軸承架20、關節部10、10a、制動機構30、伺服馬達3c、3d、3e等。
腳3a的上端部連接于軸承架20，腳3a能夠以中心軸CL1為中心沿等頭R1方向旋轉。腳3a和腳3b由關節部10進行連接。伺服馬達3C內藏于主體2中，伺服馬達3C工作時，軸承架20能夠以中心軸CL2為中心沿箭頭R2的方向旋轉。
伺服馬達3d工作時，腳3a能夠以中心軸CL1為中心沿箭頭R1方向旋轉。伺服電機3e工作時，腳3b相對腳3a能夠以中心軸CL3為中心沿箭頭R3方向旋轉。
左前足4上裝有腳4a、4b、軸承架21、關節部11、11a、制動機構30、伺服馬達4c、4d、4e。
腳4a連接于軸承架21，能夠以中心軸CL4為中心沿箭頭R4方向旋轉。腳4b通過關節部11與腳4a相連。伺服馬達4c內藏于主體2中，伺服馬達4C工作時，軸承架21以中心軸CL5為中心沿箭頭R5方向旋轉。伺服馬達4d工作時，腳4a相對軸承架21以中心軸CL4為中心沿箭頭R4方向旋轉。伺服馬達4e工作時，腳4b以中心軸CL6為中心沿箭頭R6方向旋轉。
右后足5上裝有腳5a、5b、軸承架22、關節部12、12a、制動機構30、伺服馬達5c、5d、5e。
腳5a的上端部連接于軸承架22。伺服馬達5e工作時，軸承架22能夠以中心軸CL7為中心沿箭頭R7方向旋轉。伺服馬達5d工作時，腳5a能夠以中心軸CL8為中心沿箭頭R8方向旋轉。伺服馬達5e工作時，腳5d能夠以中心軸CL9為中心沿箭頭R9方向旋轉。
左后足6上裝有腳6a、6b、軸承架23、關節部13、13a、制動機構30、伺服馬達6c、6d、6e。
伺服馬達6c工作時，軸承架23能夠以中心軸CL10為中心沿箭頭R10方向旋轉。伺服馬達6d工作時，腳6a能夠以中心軸CL11為中心沿箭頭R11方向旋轉。伺服馬達6e工作時，腳6b能夠以中心軸CL12為中心沿箭頭R12方向旋轉。
如上所述，右前足3、左前足4、右后足5、右后足6分別由各自的3自由度結構的腳部件組成，并能夠以多個軸為中心由伺服馬達進行驅動。
頭部7上裝有伺服馬達7a、7b、7c、伺服馬達7a工作時，能夠以中心軸CL20為中心沿箭頭R20方向擺動。伺服馬達7b工作時，頭部7以中心軸CL21為中心沿箭頭R21方向擺動。伺服馬達7C工作時，頭部7能夠以中心軸CL22為中心沿箭頭R22方向擺動。也就是說，此頭部7為3自由度結構。
軀干部8上裝有伺服馬達8a，此伺服馬達8a工作時，尾部9以中心軸CL23為中心沿箭頭R23方向擺動。
如圖2所示，此多關節型機器人1的主體2中內藏有3軸(x，y，z)的加速度傳感器41，它能夠檢測出處于任意姿態的主體2的加速度及角速度。又，在頭部7上設有CCD攝像機43和話筒44。還在頭部、各腳尖、腹部、喉部、臀部、尾部設置了接觸傳感器45。如圖3所示，來自各傳感器的檢測輸出，經總線103送至設于此多關節型機器人1的控制部100上的CPU(中央處理器)102中。
這里以圖3說明此多關節型機器人1的控制部100與右前足3、左前足4、右后足5、左后足6、頭部7、尾部9的各關節軸驅動用伺服馬達及位置傳感器的連接關系。
控制部100包括存儲器101和CPU(中央處理器)102。CPU102的總線103連接著前述右前足3、左前足4、右后足5、左后足6、頭部7、尾部9的各部件。
右前足3上裝有伺服馬達3c、3d、3e和位置傳感器3P1、3P2、3P3，伺服馬達3c、3d、3e分別連接于驅動裝置30，同時，位置傳感器3P1、3P2、3P3也分別連接在驅動裝置3D上。各驅動裝置3D連接于總線103。
同樣，左前足4的伺服馬達4c、4d、4e、位置傳感器4P1、4P2、4P3連接在驅動裝置4D。右后足5的伺服馬達5c、5d、5e、位置傳感器5P1、5P2、5P3分別連接于驅動裝置5D。左后足6的伺服馬達6c、6d、6e、位置傳感器6P1、6P2、6P3連接于驅動裝置6D。
頭部7的伺服馬達7a、7b、7c、位置傳感器7P1、7P2、7P3連接于驅動裝置7D。尾部9的伺服馬達9a和位置傳感器9P1連接于驅動裝置9D。
右前足3的各位置傳感器3P1、3P2、3P3；左前足4的各位置傳感器4P1、4P2、4P3，右后足5的各位置傳感器5P1、5P2、5P3及左后足6的各位置傳感器6P1、6P2、6P3分別用來獲得其所在位置的位置信息。這些位置傳感器可使用關節角度檢測用的電位計等旋轉角傳感器。由此類旋轉角式位置傳感器3P1～6P3獲得的位置信息一旦反饋至CPU102，則CPU102便根據該反饋的位置信息向驅動裝置發出指令，與之相應的驅動裝置便對相應的馬達進行伺服控制，伺服馬達便旋轉到CPU102指令要求的位置。
圖4～圖7，為將圖1所示的多足步行機器人1進一步簡單化的示意圖。在軀干部8上裝有頭部7、右前足3、左前足4、右后足5、左后足6、各足3～6上分別設有關節部10、11、12、13、30、30、30、30。
圖4所示多足步行機器人1的姿勢是右前足3、左前足4、右后足5、左后足6完全伸直的基本姿勢。圖5所示，是從圖4的基本姿勢變為左前足4的關節部11和關節部30被驅動后的狀態。
圖4所示多足步行機器人1的右前足3、左前足4、右后足5、左后足6四只腳與地面300接觸。在圖5的狀態中，由于左前足4的關節部11、30被驅動，因此呈現為左前足4向前方突出的姿勢。
操作者在確定這樣的多足步行機器人1的左前足4的左足肘處的關節部11與對應左前肩的相應的關節部30的角度時，進行了下述的多足步行機器人動作模式的編輯工作。
就圖4和圖5所示的多足步行機器人1以及對這樣的關節部件11、30進行驅動的編輯作業來說，如圖2所示的控制部100的外部編輯指令電腦400能夠在軟件上算出圖5所示的多足步行機器人1的重心WO的位置，并為使多足步行人1不在該重心WO的位置翻倒，能夠將其他的左前足3、右后足5、左后足6中的至少一只足關節部的角度自動設定。此指令從所述外部編輯指令電腦400發至所述控制部的CPU102，由此，CPU102便能夠對相應足的伺服馬達發出動作指令。
此時，多足步行機器人1的各部位的重量，即軀干部8和主體2的重量、右前足3、左前足4、右后足5、左后足6、頭部7的各部位重量都預存在外部編輯指令電腦400的存儲器402中，根據這些重量數據，能夠計算出圖4所示的多足步行機器人1的重心WO的位置。
下面參照圖8，舉例說明多足步行機器人動作模式的編輯方法。
首先在步驟S1中，在所述多足步行機器人1的存儲器101中預存著所述多足步行機器人1的各結構部的重量、形狀等信息，即預存著主體2、軀干部8、頭部7、右前足3、左前足4、右后足5、左后足6、尾部9等各部件的重量、形狀的信息。然后將信息從存儲器101轉移到外部編輯指令電腦400的存儲器402中。這便是步驟S1所做的重量、形狀等的信息獲取。
接著在步驟S2中開始對所述多足步行機器人1進行姿態的編輯。即使其從圖4所示的基本姿態獲得圖5所示的左前足4向前突出的姿態。此時，對可關節部11和關節部30進行動作示教，但若不執行該動作，如圖6所示多足步行機器人1的重心將因向右前足4一側的移動造成機器人向左前方翻倒。
為防止這種多足步行機器人1向前傾倒，如圖5所示，在將左前足4向前彎曲，使關節部11、30轉動時，在步驟S3中，圖3所示的控制部100的外部編輯指令電腦400將多足步行機器人1的重心WO如圖5那樣相對主體2及軀干部8沿后方T進行新的重心W1的計算，并將其數據作為新的計算后的重心值。為要這樣將重的WO移到新的重心W1上，就要如圖7所示的那樣使右前足3、右后足5、左后足6的關節部10、12、13及關節部30、30、30轉動。驅使這一運動的便是外部編輯指令電腦400。
此時，為確實取得多足步行機器人1的平衡，對右前足3、右后足5、左后足6的關節部10、12、13及30、30、30所施加的轉動以實施步驟S4、S5為宜，即，對于多足步行機器人1的新的重心W1對觸地面300的投影點1M，恰在三角形重心位置所適范圍AR內。這個所適范圍AR是右前足3的觸地點CP1與右后足5的觸地點CP2、左后足6的觸地點CP3三點相連形成的三角型區域。
一般情況下，重心W1的投影點1M都在這一所適范圍AR之內，因此多足步行機器人1在不至翻倒的狀態能夠令右前足3、左后足5、左后足6上的關節部10、12、13及關節部30、30、30轉動，并能夠以最少的動作選擇這種穩定的姿態。
將圖5與圖7進行比較后可知，當操作者令多足步行機器人做左前足4向前突出的姿勢時，重心便自動地從WO移向W1，多足步行機器人1變為后側整體降低的狀態。這樣一來，在步驟3中進行重心位置計算后，在步驟4中對多足步行機器人1是否會翻倒進行判斷，若會翻倒，外部編輯指令電腦400便對其他關節部的轉動(角度計)進行計算或變更，然后再次回到步驟S3進行重心位置的計算。
如果步驟S4中確認為不翻倒，外部編輯指令電腦400便將其轉移到步驟S6，結束多足步行機器人1的動作模式的編輯。在結束了這種編輯后，外部編輯指令電腦400便對多足步行機器人1的CPU102進行正式的動作模式輸入(步驟7)。
此多足步行機器人1根據內藏于本體2中3軸(x，y，z)的加速度傳感器41檢測的各軸(x，y，z)方向的加速度信息AccXt、AccYt、AccZt通過所述控制部100進行翻倒檢測，在檢測到翻倒狀態時，便采取措施，進行復原為正常姿勢狀態的姿態復歸。
這里，以圖9的程序框圖來表示所述控制部100所做的位置判斷算法。
即，所述控制部100根據所述加速度傳感器41檢測到的各軸(x，y，z)方向的加速度信息AccXt、AccYt、AccZt，進行如下翻倒檢測。
首先是翻倒判斷處理，先將步驟S11中對數據緩沖器的原始加速度信息AccXt、AccYt、AccZt進行清除，并將數據緩沖器的時間標記加以變更。此多足步行機器人1中數據緩沖器的緩沖量為各軸50。
AccXk→AccXk+1(k＝0～n-1)(式1)AccYk→AccYk+1(k＝0～n-1)(式2)AccZk→AccZk+1(k＝0～n-1)(式3)在下一步驟S12中，將所述加速度傳感器41測定的各軸(x，y，z)方向的加速度信息AccXt、AccYt、AccZt存入數據緩沖器。這一數據更新的比例對此多足步行機器人1來說為10ms。
AccXo→AccXt (式4)AccYo→AccYt (式5)AccZo→AccZt (式6)
在下一步驟S13中，將從數據緩沖器的數據計算出各軸(x，y，z)方向的時間平均加速度AccXt、AccYt、AccZt。
AccX＝∑AccXk/n(k＝0～n)(式7)AccY＝∑AccYk/n(k＝0～n)(式8)AccZ＝∑AccZk/n(k＝0～n)(式9)在下一步驟S14中，求出平均加速度Acc與Y-Z平面之間的偏角θ、平均加速度Acc向Y-Z平面的投影成分與Z軸形成的角φ(參見圖10A及圖10B)。
Acc＝(AccX2+AccY2+AccZ2)1/2(式10)θ＝asin(AccY/((AccY2+AccZ2)1/2))(式11)φ＝asin(AccZ/Acc)(式12)在下一步驟S15中，對平均加速度(歐幾里得距離)Acc是否在允許誤差(ΔAcc)范圍之內進行判斷。若在誤差范圍之外時，則認為由于受到拿起等從外部施加的強力，便從翻倒判斷處理狀態退出。
Acc＞1.0+ΔAcc[G]或Acc＜1.0-ΔAcc[G]→處理例外(式13)
在下列步驟S16中，平均加速度Acc與Y-Z平面之間的偏角θ、以及平均加速度Acc向Y-Z平面的投影成分與Z軸形成的角φ，和以當前姿勢狀態為基準的平均加速度Acc與Y-Z平面之間的基準偏角以及平均加速度Acc向Y-Z平面的投影成分與Z軸的基準角φm相比較，若分別在允許誤差(Δθm，Δφm)范圍之內，便視為姿態正常；超出范圍之外時，則判斷為翻倒或異常姿態，處于步行狀態時，θ＝-π/2、φ＝任意。
θ＞θm+Δθm or θ＜θm-Δθm(式14)φ＞φm+Δφm or φ＜φm-Δφm(式15)這里所謂翻倒現象是指對于角速度的取樣周期呈極低頻率的現象。因此，作為翻倒檢測的數據，使用數據緩沖器的獲取某一時間的平均值，能夠減少因瞬間性的干擾造成的誤判。此方法在進行數據處理時與數字濾波器等低通濾波處理相比，具有負荷小的優點。
在所述由翻倒判斷處理檢測出翻倒時(步驟S17)，轉向翻倒復歸步驟S18，進行如下恢復正常姿態的姿態轉變。
即，在姿態轉變處理中，先根據翻倒檢測時算出的平均加速度Acc與Y-Z平面之間的偏角θ、平均加速度Acc的Y-Z投影成分與Z軸形成的角φ進行翻倒方向的判斷。在此多足步行機器人1中，因受形狀的制約，其步行時的翻倒僅預設圖11的(A)、(B)、(C)、(D)所示的4個方向，由0＜φ＜(1/4)π或-(1/4)π＜φ＜0 (式16)判斷圖12A所示的前方倒狀態(head Side Down)是否存在，由(1/4)π＜φ＜(3/4)π (式17)判斷圖12B所示的右側翻倒狀態(Right Side Down)是否存在，由-(1/4)π＞φ＞-(3/4)π(式18)判斷圖12C所示的左側翻倒狀態(Left Side Down)是否存在，再由(3/4)π＜φorφ＞-(3/4)π (式19)判斷圖12D所示的后方翻倒狀態(Tail Side Down)是否存在。
然后，為從預存在存儲器101中的所述4個翻倒狀態(Head SideDown，Right Side Down，Left Side Down，Tail Side Down)進行姿態復原，通過采用軌道計劃數據的回放進行向正常姿勢的復原。同樣，在實行所述翻倒復原動作過程中，存在著翻倒狀態發生變化的情況。如，本是前方低下且翻倒了的前方翻倒狀態(Head Side Down)，在翻倒復原動作開始執行后又變成了側面翻倒狀態。出現這種情況時，機器人能夠迅速終止當前執行中的翻倒復原動作，通過再次執行檢測翻倒復原動作，迅速執行從翻倒狀態起的復原動作。
這里，圖13所示，為模式化的前方翻倒狀態(Head Side Down)向正常姿態的復原動作的過程。
為實行從所述前方翻倒狀態起姿態復原的軌道計劃數據，可由操作者采用所述的直接教學方式預先將此多關節型機器人1的右前足3、左前足4、右后足5、左后足6的相對位置通過位置示教生成后存儲在所述存儲器101中。
需要說明的是，此多關節機器人1根據內藏于主體2中的3軸(x，y，z)的加速度傳感器41產生的加速度信息由所述控制部100進行翻倒判斷，并完成了從所述4種翻倒狀態(Head Side Down，RightSide Down，Left Side Down，Tail Side Down)復原到正常姿勢狀態的復原動作。其實，所述控制部100也可以根據所述內藏于主體2中的角速度傳感器、角加速度傳感器、傾斜傳感器等的檢測輸出進行翻倒判斷，并完成復原到正常姿勢狀態的復原動作。再則，所述控制部100還可以綜合利用各種傳感器的檢測輸出進行翻倒判斷，并完成復原到正常姿勢狀態的復原動作。
作為4腳型的機器人裝置，可以通過內部的姿態模型同設于腳尖、主體各部位的接觸傳感器的輸出相比較，進行異常狀態的檢測。
比如圖14所示的站立姿勢，接觸傳感器45A、45B、45C中只有腳尖的接觸傳感器45A、45B檢測為接觸狀態，而在圖15所示的坐姿并用手時，后腳尖的接觸傳感器45B和尾部設置的接觸傳感器45C檢測為接觸狀態。于是，將機器人裝置執行著的姿勢和當時接觸傳感器45的理想狀態預存在裝置主體內，通過對姿態執行中的接觸傳感器45的輸出進行比較，能夠實現異常姿態的檢測。
又，設有圖像輸入裝置的機器人裝置能夠通過識別路面取得其位置與裝置當前欲做姿勢的關系，實現對異常姿態的檢測。
即，當所述多關節型機器人1如圖16所示將站立姿勢作為正常狀態時，對應CCD攝像機43的攝像輸出，其正常姿勢時得到的是圖17A所示的地面F呈水平狀態的圖像。相反，在異常姿勢時得到的是圖1 7B所示的地面F的天地顛倒了的圖像或圖17C、圖17D所示的地面F傾斜了的圖像。因此，通過對所述CCD攝像機43攝像輸出得到的圖像中地面F的狀態進行判斷，就能夠檢測出異常姿勢狀態。
為判斷所述圖像中地面F的狀態，如圖18所示，先返復檢測圖像坐標系中Y方向的邊緣，再由求得的多個檢測位置坐標求出線段，最后由求得的線段求出所述地面F的橫向邊緣。同樣，由X方向的邊緣檢測的結果得到的檢測位置坐標求出所述地面F的縱向邊緣。進一步，最好通過二者的結合，進行傾斜后的地面F的線段檢測。
在利用車輪做移動機構的輪機器人裝置中，使用環境限定為車輪與地面接觸狀態，所以最好用下列方法進行異常姿態的檢測。
即，如圖19所示，由安裝在非驅動軸上的旋轉檢測裝置RD檢測到的旋轉狀態與旋轉輸出裝置RO要求的旋轉不同時，測出這一狀態，就能夠進行異常姿態的檢測。
或如圖20所示，通過設置地面檢測裝置FD，能夠對翻倒等異常姿態進行檢測。作為所述地面檢測裝置FD，也可使用具有發光與受光部的非接觸型傳感器或微動開關等接觸式傳感器裝置。
這里，在以回放方式進行翻倒復原動作時，根據機器人裝置的形狀，從翻倒狀態起的復原動作限定為某種特定的狀態轉變。作為所述多關節型機器人1類的4腳型機器人裝置，存在著6種狀態，即前述的4種翻倒狀態(Head Side Down，Right Side Down，Left Side Down，Tail Side Down)以及后背著地的背部翻倒狀態(Back Side Down)還有腹部著地的伏臥狀態(stomach Side Down)。從翻倒到復原，必定經過伏臥狀態(Stomach Side Down)。當處于背部翻倒狀態(BookSide Down)時，如圖21所示，在到達伏臥狀態(Stomach Side Down)之前，必定要經過前述4種翻倒狀態(Head Side Down，Right SideDown，Left Side Down，Tail Side Down)中的某一種狀態。利用這一性質，在以檢測翻倒時采用將翻倒的復原動作加以細化、生成回放的動作數據，再結合翻倒狀態的變化進行再生的方法對機器人裝置進行控制的話，當遇到無法預測的外因翻倒狀態發生變化時，能夠立即進行翻倒復原動作的切換，再則，這樣做能夠將各種復原動作進行分割后再生成復原動作數據，使動作數據的生成變得很容易。
相反，不采用這種方法，遇到諸如把從背部翻倒狀態(Book SideDown)起的復原動作作為一個動作并生成復原動作數據并再生時，將產生下列幾個問題。
1.即使由于外部作業發生強制性使姿勢向正常的狀態變化，也非要等到復原動作執行完了才能轉變為下一動作。
2.當所述復原動作數據比如是以經由左側翻倒狀態(Left SideDown)為準而生成的時，一旦由于外部原因(如地面有凸起等)變為其他的狀態(如右側翻倒狀態(Right Side Down))，就無法依靠復原動作進行復原，形成無效作業。
3.采用這些方法，當翻倒狀態暫時變化時，若先停止執行中的作業，再將動作重新糾正的話，由于產生不連貫的動作，增加了關節部的負荷。
綜上所述，本發明涉及的機器人裝置，能夠識別裝置主體的姿勢，并根據該識別結果判斷所述裝置主體已完成的規定的姿勢。在判斷到所述規定的姿勢后，通過對所述裝置主體的姿勢進行修正，能夠從異常的姿勢狀態自動地復原到正常的姿勢狀態。
因此，本發明可以提供一種能夠從翻倒狀態等異常的姿勢狀態獨立地復原成通常的姿勢狀態的機器人裝置。
由于本發明涉及的機器人裝置具有從異常的姿勢狀態獨立地復原為正常的姿勢狀態的功能，因此能夠防止在翻倒狀態等異常姿勢狀態下使用造成的機器人裝置的故障及事故的發生。
并且它能夠防止使用環境遭到破壞，還能夠將使用者從姿勢復原的作業中解放出來。
權利要求
1.一種機器人裝置，其特征在于具有識別裝置主體的姿勢并輸出識別結果的姿勢識別裝置；根據所述識別結果，判別所述裝置主體已成為規定姿勢的姿勢判別裝置；在由所述姿勢判別裝置判別到所述規定的姿勢時，對所述裝置主體的姿勢進行修正的姿勢修正裝置。
2.權利要求1所述的機器人裝置，其特征在于所述姿勢識別裝置是傳感器；所述姿勢修正裝置根據所述姿勢判別裝置的判別結果進行與所述判別結果相應的姿勢修正。
3.權利要求2所述的機器人裝置，其特征在于所述姿勢判斷裝置判斷的所述規定的姿勢是所述裝置主體的翻倒姿勢。
4.權利要求3所述的機器人裝置，其特征在于所述翻倒姿勢至少為前方的翻倒姿勢、后方翻倒姿勢、右側翻倒姿勢、左側翻倒姿勢中的一種。
5.權利要求2所述的機器人裝置，其特征在于所述傳感器為圖像識別傳感器。
6.權利要求2所述的機器裝置，其特征在于所述傳感器為接觸傳感器。
7.權利要求6所述的機器人裝置，其特征在于所述裝置主體具有步行裝置；所述接觸傳感器設置于所述步行裝置的底面附近。
8.權利要求2所述的機器人裝置，其特征在于所述傳感器為加速度傳感器；所述姿勢判別裝置至少根據所述加速度傳感器輸出的大小及/或根據由所述加速度傳感器輸出算出的加速度方向對所述規定的姿勢進行判斷。
9.權利要求8所述的機器人裝置，其特征在于所述姿勢判別裝置判斷的所述規定姿勢是所述裝置方體的翻倒姿勢。
10.權利要求9所述的機器人裝置，其特征在于所述翻倒姿勢至少為前方翻倒姿勢、后方翻倒姿勢、右側翻倒姿勢、左側翻倒姿勢中的一種。
11.權利要求2所述的機器人裝置，其特征在于具有存儲與所述裝置主體的姿勢相應的姿勢修正動作信息的存儲裝置；由所述存儲裝置讀出所述姿勢修正信息的讀出裝置；所述姿勢修正裝置根據讀出的所述姿勢修正動作信息對所述裝置主體的姿勢進行修正。
12.權利要求11所述的機器人裝置，其特征在于在所述存儲裝置中存儲著多個所述姿勢修正動作信息；所述讀出裝置讀出在多個所述姿勢修正動作信息中與所述判斷裝置的判斷結果相應的姿勢修正動作信息。
13.權利要求12所述的機器人裝置，其特征在于所述姿勢判別裝置的判斷結果是所述裝置主體的翻倒姿勢。
14.權利要求13所述的機器人裝置，其特征在于所述翻倒姿勢至少是前方翻倒姿勢、后方翻倒姿勢、右側翻倒姿勢、右側翻倒姿勢的一種。
15.一種機器人裝置的姿態控制方法，其特征在于識別裝置主體的姿勢，根據其識別結果判別所述裝置主體已成為規定的姿勢；在判斷出所述規定的姿勢時，將所述裝置主體的姿勢進行修正。
全文摘要
根據加速度傳感器41的檢測輸出獲得的加速度信息通過CPU102對裝置主體的姿勢狀態為與正常的姿勢狀態不同的異常的姿勢狀態進行識別,使用預先生成并存儲在存儲器101中的由某種翻倒狀態起進行姿勢復原的軌道計劃數據,通過回放,控制各種驅動裝置30～70,完成向正常姿勢狀態的復原動作。
文檔編號G06F19/00GK1274310SQ9980131
公開日2000年11月22日 申請日期1999年6月9日 優先權日1998年6月9日
發明者山本隆司 申請人:索尼公司