Rev 530 | Rev 532 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 530 | Rev 531 | ||
---|---|---|---|
Line 337... | Line 337... | ||
337 | i32_1 = i32_2/1000L; |
337 | i32_1 = i32_2/1000L; |
338 | i32_2 = i32_2%1000L; |
338 | i32_2 = i32_2%1000L; |
339 | sprintf(string,"<ele>%ld.%03ld</ele>\r\n",i32_1, i32_2); |
339 | sprintf(string,"<ele>%ld.%03ld</ele>\r\n",i32_1, i32_2); |
340 | fputs_(string, doc->file); |
340 | fputs_(string, doc->file); |
341 | // write <time> tag only at a resolution of one second |
341 | // write <time> tag only at a resolution of one second |
342 | sprintf(string, "<time>%04d-%02d-%02dT%02d:%02d:%02dZ</time>\r\n",SystemTime.Year, SystemTime.Month, SystemTime.Day, SystemTime.Hour, SystemTime.Min, SystemTime.Sec); |
342 | // sprintf(string, "<time>%04d-%02d-%02dT%02d:%02d:%02dZ</time>\r\n",SystemTime.Year, SystemTime.Month, SystemTime.Day, SystemTime.Hour, SystemTime.Min, SystemTime.Sec); |
- | 343 | sprintf(string, "<time>%04d-%02d-%02dT%02d:%02d:%02d.%dZ</time>\r\n",SystemTime.Year, SystemTime.Month, SystemTime.Day, SystemTime.Hour, SystemTime.Min, SystemTime.Sec,SystemTime.mSec/100); |
|
343 | fputs_(string, doc->file); |
344 | fputs_(string, doc->file); |
344 | // write <sat> tag |
345 | // write <sat> tag |
345 | sprintf(string, "<sat>%d</sat>\r\n", NaviData.SatsInUse); |
346 | sprintf(string, "<sat>%d</sat>\r\n", NaviData.SatsInUse); |
346 | fputs_(string, doc->file); |
347 | fputs_(string, doc->file); |
347 | // todo: add <extensions> tag with additional data to be logged |
348 | // todo: add <extensions> tag with additional data to be logged |
Line 404... | Line 405... | ||
404 | fputs_(string, doc->file); |
405 | fputs_(string, doc->file); |
405 | // magnetic inclination & error |
406 | // magnetic inclination & error |
406 | sprintf(string, "<MagnetInclination>%02d,%02d</MagnetInclination>\r\n",(s16)EarthMagneticInclinationFiltered/10,(s16)(EarthMagneticInclinationFiltered/10 - EarthMagneticInclinationTheoretic)); |
407 | sprintf(string, "<MagnetInclination>%02d,%02d</MagnetInclination>\r\n",(s16)EarthMagneticInclinationFiltered/10,(s16)(EarthMagneticInclinationFiltered/10 - EarthMagneticInclinationTheoretic)); |
407 | fputs_(string, doc->file); |
408 | fputs_(string, doc->file); |
408 | // Nick Angle ind deg |
409 | // Nick Angle ind deg |
- | 410 | i16_1 = abs(FromFlightCtrl.AngleNick); |
|
- | 411 | if(FromFlightCtrl.AngleNick < 0) sprintf(string, "<NickAngle>-%d.%d</NickAngle>\r\n",i16_1/10,i16_1%10); |
|
409 | sprintf(string, "<NickAngle>%03d</NickAngle>\r\n", NaviData.AngleNick); |
412 | else sprintf(string, "<NickAngle>%d.%d</NickAngle>\r\n",i16_1/10,i16_1%10); |
410 | fputs_(string, doc->file); |
413 | fputs_(string, doc->file); |
411 | // Roll Angle in deg |
414 | // Roll Angle in deg |
- | 415 | i16_1 = abs(FromFlightCtrl.AngleRoll); |
|
- | 416 | if(FromFlightCtrl.AngleRoll < 0) sprintf(string, "<RollAngle>-%d.%d</RollAngle>\r\n",i16_1/10,i16_1%10); |
|
412 | sprintf(string, "<RollAngle>%03d</RollAngle>\r\n", NaviData.AngleRoll); |
417 | else sprintf(string, "<RollAngle>%d.%d</RollAngle>\r\n",i16_1/10,i16_1%10); |
413 | fputs_(string, doc->file); |
418 | fputs_(string, doc->file); |
414 | break; |
419 | break; |
415 | case 5: |
420 | case 5: |
416 | // BL Information |
421 | // BL Information |
417 | switch(AmountOfMotors) |
422 | switch(AmountOfMotors) |