SafeMate Firmware with Changes for GPGGA