added estimate velocity function and publisher to gui (for calculated dead reckoning)