Added URControllerManager

This is an interface for the controller manager which keeps
persistent connections to the services and also provides utilities
for dealing with joint command modes