Fixed function getHDop, but it still doesn't work. I think, somethng bad in
calculateNewton function