Added model, urdf_path and srdf_path inside the control_thread