Fixed a bug with return value of ros service