updates to prototype code
Merge branch 'master' of http://github.com/gizatt/biped_robot_rbpi