For #21 - Started working on reading gps output and writting kml files. Currently experiencing some catkin errors that are preventing compilation.