GPS position publishing added and working