add conditionals to handle decomposition-disabled case.  this needs to be cleaned up and generalized
try calling stop() on motionController first, before directly asking driveHandler for (0,0) vel