Added services, tested xyzRPY on robot