Gps test performed
Updated rviz config for gps_test
Preparing to test Pichi