Compass Biped

Caught a bug in compass biped that was calculating impacts incorrectly.
Robot is now able to walk but controller still needs fine tuning.
Also added a plot to the simulation's render to display the controller's
output.