Add GPS code to the FollowMe class.
Add guided mode packet code.

Working on  issue #2