More RosTcp support for services. Still incomplete. Exposed the method for testing.