Ensure that any position error is handled correctly (ie. there will be descrepency between move planner and MLP pos)
Ensure that any position error is handled correctly (ie. there will be descrepency between move planner and MLP pos)