Update auto_docking_ros.cpp

- Added error management