made two branches, one for true positioning and one for dead reckoning. I don't know whats gonna work, so im gonna work on both