updated publisher to /dvl/position to use PoseWithCovarianceStamped for controls team (should be done)