Update marker_localization.cpp