Added GPS test functionality, needs to be tested.