Modified: Motion/XWalkMC.cc
This is particularly nice when reversing direction, as gait itself reverses! :)
Modified: Motion/{XWalkMC.cc, XWalkMC.h}
Modified: Motion/XWalkMC.h
still may have problems with leg collision or range limitation...
We'll worry about automatically adapting to other IK solvers later