Fixed up the gps library and added a testbench.