Add buoyant force to auv simulating. Z = 0 is surface level.