一種仿人機器人步態實時控制系統的制作方法
【專利摘要】本實用新型公開了一種仿人機器人步態實時控制系統，包括機器人本體、角度傳感器和力矩傳感器，所述角度傳感器和力矩傳感器均電性連接CPU，且CPU安裝在機器人本體的內部，所述CPU分別電性連接存儲器和電機，所述電機安裝在腳踝處，所述機器人本體內設有蓄電池，所述蓄電池為角度傳感器、力矩傳感器、電機和CPU供電。該仿人機器人步態實時控制系統，首先CPU根據穩定性確定當前的步態參數，然后電機開始工作，機器人開始行走，CPU再根據各關節處角度傳感器傳過來的數據以及力矩傳感器傳過來的數據，進行逆解計算，得出各關節的運動軌跡，得出實際的ZMP，并與存儲器內設定的ZMP進行比較，得出差值以后通過電機調整步伐，從而進行實時監控和自我對比調整。
【專利說明】
一種仿人機器人步態實時控制系統
技術領域
[0001]本實用新型涉及機器人步態控制技術領域，具體為一種仿人機器人步態實時控制系統。
【背景技術】
[0002]通過規劃好髖部中心相對于左腳末端的軌跡和右腳末端相對于髖部中心的軌跡，即可計算出下肢各個關節角對應的位置軌跡，從而得到仿人機器人的步態規劃。如果機器人按照已規劃的步態行走，就確定出一條ZMP軌跡。但是，由于外界環境變化等于擾，可能導致機器人實際運動過程中，實際ZMP與規劃的ZMP軌跡偏離較大，甚至出現實際ZMP位于穩定域以外的情況。因此，在仿人機器人的實際行走過程中，需要通過安裝在腳踝的六維力/力矩傳感器進行實時檢測，采用穩定性分析，判斷實際ZMP位置是否滿足穩定步行的要求。如果檢測結果不能滿足穩定性要求，則需要對已規劃的髖部軌跡進行修難，從而調整下肢各個關節的角度輸出，這就是步態的實時控制。市場上的機器人很只是按設定的模式走，而沒有自我的實時監控和對比分析，為此，我們設計一種仿人機器人步態實時控制系統。
【實用新型內容】
[0003]本實用新型的目的在于提供一種仿人機器人步態實時控制系統，以解決上述【背景技術】中提出的問題。
[0004]為實現上述目的，本實用新型提供如下技術方案:一種仿人機器人步態實時控制系統，包括機器人本體、角度傳感器和力矩傳感器，所述角度傳感器安裝在機器人本體的關節處，所述力矩傳感器安裝在機器人腳踝關節以下且靠近腳掌的位置，所述角度傳感器和力矩傳感器均電性連接CPU，且CPU安裝在機器人本體的內部，所述CPU分別電性連接存儲器和電機，所述電機安裝在腳踝處，所述機器人本體內設有蓄電池，所述蓄電池為角度傳感器、力矩傳感器、電機和CPU供電。
[0005]優選的，所述力矩傳感器為六維力/力矩傳感器。
[0006]優選的，所述機器人本體的關節設有多處，且關節處均安裝有角度傳感器。
[0007]優選的，所述電機的轉軸上設有位移傳感器，且該位移傳感器電性連接CPU。
[0008]與現有技術相比，本實用新型的有益效果是:該仿人機器人步態實時控制系統，首先CHJ根據穩定性確定當前的步態參數，然后電機開始工作，機器人開始行走，CPU再根據各關節處角度傳感器傳過來的數據以及力矩傳感器傳過來的數據，進行逆解計算，得出各關節的運動軌跡，得出實際的ZMP，并與存儲器內設定的ZMP進行比較，得出差值以后通過電機調整步伐，從而進行實時監控和自我對比調整。
【附圖說明】

[0009]圖1為本實用新型結構不意圖；
[0010]圖2為本實用新型的步態實時控制結構圖；[0011 ]圖3為本實用新型的步態實時控制流程圖。
【具體實施方式】
[0012]下面將結合本實用新型實施例中的附圖，對本實用新型實施例中的技術方案進行清楚、完整地描述，顯然，所描述的實施例僅僅是本實用新型一部分實施例，而不是全部的實施例。基于本實用新型中的實施例，本領域普通技術人員在沒有做出創造性勞動前提下所獲得的所有其他實施例，都屬于本實用新型保護的范圍。
[0013]請參閱圖1-3，本實用新型提供一種技術方案:一種仿人機器人步態實時控制系統，包括機器人本體、角度傳感器和力矩傳感器，所述力矩傳感器為六維力/力矩傳感器，所述角度傳感器安裝在機器人本體的關節處，所述機器人本體的關節設有多處，且關節處均安裝有角度傳感器，所述力矩傳感器安裝在機器人腳踝關節以下且靠近腳掌的位置，所述角度傳感器和力矩傳感器均電性連接CPU，且CPU安裝在機器人本體的內部，所述CPU分別電性連接存儲器和電機，所述電機安裝在腳踝處，所述電機的轉軸上設有位移傳感器，且該位移傳感器電性連接CPU，所述機器人本體內設有蓄電池，所述蓄電池為角度傳感器、力矩傳感器、電機和CPU供電。
[0014]該仿人機器人步態實時控制系統，首先CPU根據穩定性確定當前的步態參數，然后電機開始工作，機器人開始行走，CPU再根據各關節處角度傳感器傳過來的數據以及力矩傳感器傳過來的數據，進行逆解計算，得出各關節的運動軌跡，得出實際的ZMP，并與存儲器內設定的ZMP進行比較，得出差值以后通過電機調整步伐，從而進行實時監控和自我對比調整。
[0015]盡管已經示出和描述了本實用新型的實施例，對于本領域的普通技術人員而言，可以理解在不脫離本實用新型的原理和精神的情況下可以對這些實施例進行多種變化、修改、替換和變型，本實用新型的范圍由所附權利要求及其等同物限定。
【主權項】
1.一種仿人機器人步態實時控制系統，包括機器人本體、角度傳感器和力矩傳感器，其特征在于:所述角度傳感器安裝在機器人本體的關節處，所述力矩傳感器安裝在機器人腳踝關節以下且靠近腳掌的位置，所述角度傳感器和力矩傳感器均電性連接CPU，且CPU安裝在機器人本體的內部，所述CPU分別電性連接存儲器和電機，所述電機安裝在腳踝處，所述機器人本體內設有蓄電池，所述蓄電池為角度傳感器、力矩傳感器、電機和CPU供電。2.根據權利要求1所述的一種仿人機器人步態實時控制系統，其特征在于:所述力矩傳感器為六維力/力矩傳感器。3.根據權利要求1所述的一種仿人機器人步態實時控制系統，其特征在于:所述機器人本體的關節設有多處，且關節處均安裝有角度傳感器。4.根據權利要求1所述的一種仿人機器人步態實時控制系統，其特征在于:所述電機的轉軸上設有位移傳感器，且該位移傳感器電性連接CPU。
【文檔編號】G05D1/02GK205721372SQ201620593655
【公開日】2016年11月23日
【申請日】2016年6月17日
【發明人】王超
【申請人】淮安信息職業技術學院