Forgot to change calls for Trajectory in LegMotion.cpp plus started integrating compensation offsets