Fixed issue when there is no subscriber

The gps publisher (sensor_msgs::NavSatFix) depends on the number of subscriber on the pub_navdata_gps topics, but there is no subscriber on that topic, so the gps data never gets published.