Jonathan. avoidance state machine, requires integration with dio and sensors