Returning stop primitive before unavoidable collision #3587
Description
MovePrimitive should return a StopPrimitive if there's an unavoidable collision with a high velocity. StopPrimitives are able to have the robot break to a halt faster than MovePrimitive setting the destination as the current position since the max motor deceleration that we allow is higher than the max overall robot deceleration.