Change P0 to small positive value to avoid singular matrix