Code for testing walking control for Atlas in simulation