Added Radio and fixed some of GPS.cpp

Signed-off-by: Matthew Hurley <hurleywearshurley@gmail.com>