clean up and fix bugs to get quadruped demo working