Hey Dan, I added to dance mode, and commented out the stuff for testing on the old robot.