Add GPS function, should be conutinue...

Add GPS function, should be conutinue...