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) |