Improve Docking AP Safe Distance and Draw Bounding box