arduino code for follow_min_distance