TODOS: - [ ] Introduction - [ ] Mpc formulation - [ ] Obstacle generations - [ ] Simulation & Results - [ ] Possible Improvements and conclusion