Although precise navigation data is important for accurate reconstruction, since the time between the measurement of bathymetry and color is typically only a few seconds, sensor drift does not have any significant adverse affect on the color matching and a standard DVL and compass based INS have been found sufficiently accurate to generate consistent 3D maps.