Update obstacle_detection.cpp