單腿機器人及基本運動控制方法腿足穩定運動控制中一個經典且被廣泛應用的方法就是Raibert在1985年寫的《leggedrobotthatbalance》中的“三段式”運動規劃與控制方法；本次課嘗試在webots中搭建書中第6章的單腿機器人跳躍模型，構建3D空間全向跳躍的控制器，深入學習書中理論并通過仿真實踐加深腿足機器人控制的理解；1.引言2.1“三段式”控制(1)Hopping：控制系統在調節機器跳躍的高度的同時實現周期循環跳躍運動。hopping是一種由身體質量、彈性腿和重力組成的振蕩運動。在腿部支撐過程中，軀干受到彈性腿的彈力能實現騰空飛行，在飛行過程中，機器人系統沿著彈道軌跡運動。在每次支撐期間，控制系統通過支腿提供垂直推力，以維持腿部振蕩并調節其振幅。(2)ForwardSpeed:控制系統的第二部分用于調節向前運行速度和加速度。這是通過在每個循環的騰空飛行時間內，將腿移動到相對于身體的一個適當的向前位置來完成的。在落地時，腳相對于身體的位置對隨后的支撐過程有很大的影響，導致機器人的加減速。后面的學習我們會知道，相對軀干的落足位置可以實現當前機器人勻速運動、加速或者減速運動。(3)Posture?？刂葡到y的第三部分是穩定機體的俯仰角(二維平面來說，對三維空間來說就包含俯仰角和橫滾角)，使機體保持直立。如果腳和地面之間有良好的力傳遞關系，那么身體和腿之間圍繞Hip關節施加的扭矩會加速身體繞其俯仰軸運動。在每次支撐，一個執行器控制Hip關節，即可使身體恢復到直立姿勢。

這個過程總結簡化為將運動分解為(a)上下彈跳運動、(b)前進速度和(c)身體姿勢的控制。將控件劃分為這三個部分使運行更容易理解，并導致相當簡單的控制系統。軀干平衡的控制率為Hopping是一個有規律的周期運動控制，每個周期中的運動都可以歸為不同階段或者狀態，下面引入狀態機概念，狀態機調控著hoping過程的每個階段，每個階段的切換是根據當前感知數據，根據關鍵事件標志切換的。例如hopping可以劃分為：Compression、Thrust、Flight、Landing等階段，當彈簧腿的速度從負變為正即>0，則狀態機從Compression切換為Thrust，這個狀態下要采取的控制為:開始蹬腿并調整軀干姿態，完整的hopping狀態機如圖2.1狀態機中性點對稱軌跡

非對稱軌跡對于每一個向前的速度，有一個獨特的腳的位置，導致向前加速度為0，即不加速也不減速，維持恒定速度，我們稱它為中性點，記作xfo。對于Hopping無向前運動，中性點位于身體正下方，而對于非零向前速度，中性點位于身體前進方向的前方，且跑得越快，中性點越靠前2.1中性點機器人運動速度估計，其思路就是機器人腿部處于支撐相時，其足端與地面緊密接觸，假設其不會滑動，則機器人機身的運動速度與腿部的運動速度即為大小相同方向相反的量，腿上的速度可以通過運動學變換得到，變換中通過腿部安裝的關節位置傳感器測量映射為腿足末端運動速度，即可得到機器人機身的速度估計：2.1速度估計在計算前足位時，考慮了兩個因素，用實際測得的運動速度來近似地確定中性點的位置，利用前向速度與期望速度的誤差計算距離中性點的偏移量，使系統加減速，中性點和偏移量結合起來指定控制系統如何放置腳，上述表示為：2.1落足點控制根據運動學計算期望的hip角度由此可以實現軀干姿態控制

2.1姿態控制壓縮彈簧單腿簡化控制量圖2.1簡化替代模型2.1Hopping運動規劃2.1Hopping能量分析2.1Hopping能量分析2.2仿真算法2.2仿真算法3仿真實驗Webots中建立的單腿機器人模型，最上方為軀干，下面緊接著為Hip_a/a關節，負責機器人腿部左右運動，繼而為Hip_f/e關節，負責機器人腿部的前后運動，這兩個關節均為旋轉關節，在機器人支撐相時這兩個關節負責調整機器人的姿態平衡，在擺動相時調整落足位置。再下方為Knee關節，此為直線運動關節，可以上下移動，Knee_Spring關節設置為被動關節，即關節處的電機最大輸出力為0，區別于其他關節，該關節的彈性系數springConstant設置為1000，阻尼系數設置為20，即彈簧阻尼關節，模擬實際的彈簧腿3仿真實驗3仿真實驗3仿真實驗3仿真實驗編譯好代碼后進行webots仿真，選擇我們的3D_single_leg_controller控制器，點擊realtime仿真按扭，機器人開始自己建立跳躍震蕩運動，默認的參數會使得機器人正常跳躍起來，當參數不合適時候，可能無法建立有效震蕩，從而機器人會傾倒。機器人正常跳躍起來后通過鍵盤的w-s-a-d按鍵進行前-后-左-右速度調節，機器人會追蹤給定速度。調整如下參數進行仿真驗證，加深算法掌握程度：周期震蕩參數修改其中的參數*1.5，仿真驗證其正常震蕩跳躍的參數。姿態調整參數3仿真實驗修改其中RPY_Angle[0]

/

2.0和-phi_td/3.0參數，仿真驗證參數對姿態穩定性的影響。支撐擺動相參數修改以上參數，仿真驗證對機器人穩定性的影響。機器人狀體信息輸出打印足底力信息、姿態角度信息，繪制機器人完整運動的曲線圖，通過GPS信息采集機器人運動速度真值，繪制速度跟蹤曲線圖，查看機器人運動效果。3仿真實驗4思考作業4.1作