- if ( gnd_trk_true < 0.0 ) { gnd_trk_true += 360.0; }
- sprintf( msg_C, "C%03.0f\r\n", gnd_trk_true);
+ double gnd_trk_mag = gnd_trk_true - magdeg;
+ if ( gnd_trk_mag < 0.0 ) { gnd_trk_mag += 360.0; }
+ if ( gnd_trk_mag >= 360.0 ) { gnd_trk_mag -= 360.0; }
+ sprintf( msg_C, "C%03.0f\r\n", gnd_trk_mag);