Rev 171 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 171 | Rev 215 | ||
---|---|---|---|
Line 57... | Line 57... | ||
57 | #include <stdlib.h> |
57 | #include <stdlib.h> |
58 | #include <stdio.h> |
58 | #include <stdio.h> |
59 | #include "91x_lib.h" |
59 | #include "91x_lib.h" |
60 | #include "kml.h" |
60 | #include "kml.h" |
61 | #include "kml_header.h" |
61 | #include "kml_header.h" |
- | 62 | #include "uart1.h" |
|
Line 62... | Line 63... | ||
62 | 63 | ||
63 | 64 | ||
64 | //________________________________________________________________________________________________________________________________________ |
65 | //________________________________________________________________________________________________________________________________________ |
Line 301... | Line 302... | ||
301 | s8 string[50]; |
302 | s8 string[50]; |
302 | s32 rel_altitude = 0; |
303 | s32 rel_altitude = 0; |
Line 303... | Line 304... | ||
303 | 304 | ||
Line 304... | Line 305... | ||
304 | if(doc == NULL) return(0); |
305 | if(doc == NULL) return(0); |
305 | 306 | ||
306 | if((GPSData.Position.Status != INVALID) && (GPS_HomePosition.Status != INVALID)) |
307 | if((GPSData.Position.Status != INVALID) && (NaviData.HomePosition.Status != INVALID)) |
307 | { |
308 | { |
308 | if(doc->state == KML_DOC_LINESTRING_OPENED) |
309 | if(doc->state == KML_DOC_LINESTRING_OPENED) |
309 | { |
310 | { |
Line 322... | Line 323... | ||
322 | i1 = abs(GPSData.Position.Latitude)/10000000L; |
323 | i1 = abs(GPSData.Position.Latitude)/10000000L; |
323 | i2 = abs(GPSData.Position.Latitude)%10000000L; |
324 | i2 = abs(GPSData.Position.Latitude)%10000000L; |
324 | sprintf(string,"%c%ld.%07ld,",sign, i1, i2); |
325 | sprintf(string,"%c%ld.%07ld,",sign, i1, i2); |
325 | fputs_(string, doc->file); |
326 | fputs_(string, doc->file); |
326 | // calculate relative altitude with respect to the altitude of the home position |
327 | // calculate relative altitude with respect to the altitude of the home position |
327 | rel_altitude = GPSData.Position.Altitude - GPS_HomePosition.Altitude; |
328 | rel_altitude = GPSData.Position.Altitude - NaviData.HomePosition.Altitude; |
328 | if(rel_altitude < 0) rel_altitude = 0; // avoid negative altitudes in log |
329 | if(rel_altitude < 0) rel_altitude = 0; // avoid negative altitudes in log |
329 | i1 = rel_altitude/1000L; |
330 | i1 = rel_altitude/1000L; |
330 | i2 = rel_altitude%1000L; |
331 | i2 = rel_altitude%1000L; |
331 | sprintf(string," %ld.%03ld",i1, i2); |
332 | sprintf(string," %ld.%03ld",i1, i2); |
332 | fputs_(string, doc->file); |
333 | fputs_(string, doc->file); |