Rev 206 | Rev 233 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 206 | Rev 215 | ||
|---|---|---|---|
| Line 273... | Line 273... | ||
| 273 | u8 retvalue = 0; |
273 | u8 retvalue = 0; |
| 274 | s8 string[50]; |
274 | s8 string[50]; |
| Line 275... | Line 275... | ||
| 275 | 275 | ||
| Line 276... | Line 276... | ||
| 276 | if(doc == NULL) return(0); |
276 | if(doc == NULL) return(0); |
| 277 | 277 | ||
| 278 | if((GPSData.Position.Status != INVALID) && (GPS_HomePosition.Status != INVALID)) |
278 | if((GPSData.Position.Status != INVALID) && (NaviData.HomePosition.Status != INVALID)) |
| 279 | { |
279 | { |
| 280 | if(doc->state == GPX_DOC_TRACKSEGMENT_OPENED) |
280 | if(doc->state == GPX_DOC_TRACKSEGMENT_OPENED) |
| 281 | { |
281 | { |
| Line 296... | Line 296... | ||
| 296 | i32_1 = abs(GPSData.Position.Longitude)/10000000L; |
296 | i32_1 = abs(GPSData.Position.Longitude)/10000000L; |
| 297 | i32_2 = abs(GPSData.Position.Longitude)%10000000L; |
297 | i32_2 = abs(GPSData.Position.Longitude)%10000000L; |
| 298 | sprintf(string, "lon=\"%c%ld.%07ld\">\r\n",u8_1, i32_1, i32_2); |
298 | sprintf(string, "lon=\"%c%ld.%07ld\">\r\n",u8_1, i32_1, i32_2); |
| 299 | fputs_(string, doc->file); |
299 | fputs_(string, doc->file); |
| 300 | // write <ele> taga |
300 | // write <ele> taga |
| 301 | i32_2 = GPSData.Position.Altitude - GPS_HomePosition.Altitude; |
301 | i32_2 = GPSData.Position.Altitude - NaviData.HomePosition.Altitude; |
| 302 | if(i32_2 < 0) i32_2 = 0; // avoid negative altitudes in log |
302 | if(i32_2 < 0) i32_2 = 0; // avoid negative altitudes in log |
| 303 | i32_1 = i32_2/1000L; |
303 | i32_1 = i32_2/1000L; |
| 304 | i32_2 = i32_2%1000L; |
304 | i32_2 = i32_2%1000L; |
| 305 | sprintf(string,"<ele>%ld.%03ld</ele>\r\n",i32_1, i32_2); |
305 | sprintf(string,"<ele>%ld.%03ld</ele>\r\n",i32_1, i32_2); |
| 306 | fputs_(string, doc->file); |
306 | fputs_(string, doc->file); |
| Line 372... | Line 372... | ||
| 372 | fputs_(string, doc->file); |
372 | fputs_(string, doc->file); |
| 373 | // RC Sticks as Nick/Roll/Yaw |
373 | // RC Sticks as Nick/Roll/Yaw |
| 374 | sprintf(string, "<RCSticks>%d, %d, %d</RCSticks>\r\n", FC.StickNick,FC.StickRoll, FC.StickYaw); |
374 | sprintf(string, "<RCSticks>%d, %d, %d</RCSticks>\r\n", FC.StickNick,FC.StickRoll, FC.StickYaw); |
| 375 | fputs_(string, doc->file); |
375 | fputs_(string, doc->file); |
| 376 | // GPS Sticks as Nick/Roll/Yaw |
376 | // GPS Sticks as Nick/Roll/Yaw |
| 377 | sprintf(string, "<GPSSticks>%d, %d, %d</GPSSticks>\r\n", GPS_Stick.Nick, GPS_Stick.Roll, GPS_Stick.Yaw); |
377 | sprintf(string, "<GPSSticks>%d, %d, %d</GPSSticks>\r\n", ToFlightCtrl.GPSStick.Nick, ToFlightCtrl.GPSStick.Roll, ToFlightCtrl.GPSStick.Yaw); |
| 378 | fputs_(string, doc->file); |
378 | fputs_(string, doc->file); |
| Line 379... | Line 379... | ||
| 379 | 379 | ||
| 380 | // eof extensions |
380 | // eof extensions |
| 381 | sprintf(string, "</extensions>\r\n"); |
381 | sprintf(string, "</extensions>\r\n"); |