Added a +/-1m range for altitude and equality checks between for last two fixes

This should filter down the noise a bit, when kept steady in place, gps
should not emit same fixes over and over again.