Added GPS testing program

Totally stole it from bluetooth testing but it's fine...