Changed state handling, and played with controller targets.
Commented out swing controller. Added fancy magic walking numbers.
Changed timestep slightly