Added .ubx parsing
And cleaned code using more sub-functions