src/youbot_controller_plugin_threaded.cpp