2D Capture Point Planner using Model Predictive Control