621,7 → 621,7 |
case 4: |
// Compass in deg |
if(SimulationFlags) sprintf(string, "<Compass>%03d,%03d,%03d.%1d,%03d.0</Compass>\r\n",SimulatedDirection,SimulatedDirection,CompassSetpointCorrected/10,CompassSetpointCorrected%10,SimulatedDirection); |
else sprintf(string, "<Compass>%03d,%03d,%03d.%1d,%03d.%1d</Compass>\r\n",FromFlightCtrl.GyroHeading/10,ToFlightCtrl.CompassHeading,CompassSetpointCorrected/10,CompassSetpointCorrected%10,GyroCompassCorrected/10,GyroCompassCorrected%10); |
else sprintf(string, "<Compass>%03d,%03d,%03d.%1d,%03d.%1d</Compass>\r\n",FromFlightCtrl.GyroHeading/10,ToFlightCtrl.CompassHeading,CompassSetpointCorrected/10,CompassSetpointCorrected%10,OrientationGyroCompassCorrected/10,OrientationGyroCompassCorrected%10); |
CheckSumAndWrite(&Check16Block,string, doc->file); |
// magnetic field |
sprintf(string, "<MagnetField>%03d</MagnetField>\r\n",(u16) (EarthMagneticFieldFiltered/5)); |