Let it run and see how the values are changing. What is the minimum value for your accuarcy?
@pichlo By the way the altitude is nan this means the position doesn't come from the gps.