ROS Service callbacks
 / Added new GetPID service
 / Added callbacks for other services