Added outlier rejection for DVL measurements. Expanded the identification gui to allow yaw and depth control during identification.