Setup sonar, gps, rtcm