Nav Filter : Fixed initial covariance bug on wind-speed states

Wind-speed covariance was being set to zero rather than frozen when on ground. This caused
slow wind sped identification.