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