Obstacle, collision avoiding control, move so that no collision occurs