Added useful debugging method for testing series of BodyJointCommands.
Fixed merge conflicts
.
Robot is walking! Some code cleanup as well.
Added test code for protobuff sweetmove code