added TODO: check if service successfully registered in ros