Hierarchical Quadratic Programming (HQP) and Model Predictive Control (MPC)