Added navsts position publishing from USBL measurements.