Subversion Repositories NaviCtrl

Rev

Rev 532 | Rev 548 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 532 Rev 547
Line 360... Line 360...
360 
                                 sprintf(string, "lon=\"%c%ld.%07ld\">\r\n",u8_1, i32_1, i32_2);
 360 
                                 sprintf(string, "lon=\"%c%ld.%07ld\">\r\n",u8_1, i32_1, i32_2);
361 
                            } else sprintf(string, "<trkpt lat=\"\" lon=\"\">");
 361 
                            } else sprintf(string, "<trkpt lat=\"\" lon=\"\">");
362 
                           fputs_(string, doc->file);
 362 
                           fputs_(string, doc->file);
363 
                           break;
 363 
                           break;
364 
                           case 1:
 364 
                           case 1:
365 
                                // write <ele> taga
 365 
                                // write <ele> tag
366 
                                i32_2 = GPSData.Position.Altitude - NaviData.HomePosition.Altitude;
 366 
                                i32_2 = abs(GPSData.Position.Altitude - NaviData.HomePosition.Altitude);
367 
                    if(GPSData.Position.Status == INVALID) i32_2 = 0;
 367 
                    if(GPSData.Position.Status == INVALID) i32_2 = 0;
368 
                                if(i32_2 < 0) i32_2 = 0; // avoid negative altitudes in log
 - 
 
369 
                                i32_1 = i32_2/1000L;
 368 
                                i32_1 = i32_2/1000L;
370 
                                i32_2 = i32_2%1000L;
 369 
                                i32_2 = i32_2%1000L;
- 
 
 370 
                                if(GPSData.Position.Altitude < 0) i32_1 *= -1;
371 
                                sprintf(string,"<ele>%ld.%03ld</ele>\r\n",i32_1, i32_2);
 371 
                                sprintf(string,"<ele>%ld.%03ld</ele>\r\n",i32_1, i32_2);
372 
                                fputs_(string, doc->file);
 372 
                                fputs_(string, doc->file);
373 
                                // write <time> tag     only at a resolution of one second
 373 
                                // write <time> tag     only at a resolution of one second
374 
//                              sprintf(string, "<time>%04d-%02d-%02dT%02d:%02d:%02dZ</time>\r\n",SystemTime.Year, SystemTime.Month, SystemTime.Day, SystemTime.Hour, SystemTime.Min, SystemTime.Sec);
 374 
//                              sprintf(string, "<time>%04d-%02d-%02dT%02d:%02d:%02dZ</time>\r\n",SystemTime.Year, SystemTime.Month, SystemTime.Day, SystemTime.Hour, SystemTime.Min, SystemTime.Sec);
375 
                                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);
 375 
                                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);
Line 548... Line 548...
548 
                                fputs_(string, doc->file);
 548 
                                fputs_(string, doc->file);
549 
                                // Navigation Update speed (in 0.1Hz)
 549 
                                // Navigation Update speed (in 0.1Hz)
550 
//                              sprintf(string, "<NaviUpdate>%d,%d</NaviUpdate>\r\n",FreqGpsProcessedIn5Sec,FreqNewGpsDataIn5Sec);
 550 
//                              sprintf(string, "<NaviUpdate>%d,%d</NaviUpdate>\r\n",FreqGpsProcessedIn5Sec,FreqNewGpsDataIn5Sec);
551 
//                              fputs_(string, doc->file);
 551 
//                              fputs_(string, doc->file);
552 
                                // eof extensions
 552 
                                // eof extensions
- 
 
 553 
                                i32_2 = abs(GPSData.Position.Altitude);
- 
 
 554 
                    if(GPSData.Position.Status == INVALID) i32_2 = 0;
- 
 
 555 
                                i32_1 = i32_2/1000L;
- 
 
 556 
                                i32_2 = i32_2%1000L;
- 
 
 557 
                                if(GPSData.Position.Altitude < 0) i32_1 *= -1;
- 
 
 558 
                                sprintf(string,"<ele_raw>%ld.%03ld</ele_raw>\r\n",i32_1, i32_2);
- 
 
 559 
                                fputs_(string, doc->file);
- 
 
 560 
 
553 
                                sprintf(string, "</extensions>\r\n");
 561 
                                sprintf(string, "</extensions>\r\n");
554 
                                fputs_(string, doc->file);
 562 
                                fputs_(string, doc->file);
555 
                                sprintf(string, "</trkpt>\r\n");
 563 
                                sprintf(string, "</trkpt>\r\n");
556 
                                fputs_(string, doc->file);
 564 
                                fputs_(string, doc->file);
557 
                           break;
 565 
                           break;