This project was done as my course project at UPenn for MEAM 5170: Controls and Optimization with application in AI and Robotics.
This was my first attempt at implementing MPC from scrach using Drake simulation software.
I had a hard time tuning and making it work, wasn't able to make it walk. Still, below are some decent screenshots of the working controller for basic standing with different poses.
References: