A Planning And Control Framework For Humanoid Systems : Robust, Optimal, And Real-Time Performance