Subversion Repositories NaviCtrl

Rev

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

Rev 84 Rev 85
Line 58... Line 58...
58 
#include "91x_lib.h"
 58 
#include "91x_lib.h"
59 
#include "main.h"
 59 
#include "main.h"
60 
#include "timer.h"
 60 
#include "timer.h"
61 
#include "uart1.h"
 61 
#include "uart1.h"
62 
#include "kml.h"
 62 
#include "kml.h"
63 
//#include "gpx.h"
 63 
#include "gpx.h"
Line 64... Line 64...
64 
 
 64 
 
65 
typedef enum
 65 
typedef enum
66 
{
 66 
{
67 
        LOGFILE_IDLE,
 67 
        LOGFILE_IDLE,
Line 82... Line 82...
82 
} LogCfg_t;
 82 
} LogCfg_t;
Line 83... Line 83...
83 
 
 83 
 
Line 84... Line -...
84 
LogCfg_t LogCfg = {500 , 0};
 - 
 
85 
 
 84 
LogCfg_t LogCfg = {500 , 0};
86 
 
 85 
 
87 
 
 86 
 
88 
//----------------------------------------------------------------------------------------------------
 87 
//----------------------------------------------------------------------------------------------------
89 
s8* GenerateKMLLogFileName(void)
 88 
s8* GenerateKMLLogFileName(void)
Line 101... Line 100...
101 
                        LastTime.Month = SystemTime.Month;
 100 
                        LastTime.Month = SystemTime.Month;
102 
                        LastTime.Day = SystemTime.Day;
 101 
                        LastTime.Day = SystemTime.Day;
103 
                        LastTime.Valid = 1;
 102 
                        LastTime.Valid = 1;
104 
                        filenum = 0; // reset file counter
 103 
                        filenum = 0; // reset file counter
105 
                }
 104 
                }
106 
                sprintf(filename, "LOG/%04i%02i%02i/KLM/GPS%05i.KML", SystemTime.Year, SystemTime.Month, SystemTime.Day, filenum);
 105 
                sprintf(filename, "LOG/%04i%02i%02i/KML/GPS%05i.KML", SystemTime.Year, SystemTime.Month, SystemTime.Day, filenum);
107 
                filenum++;
 106 
                filenum++;
108 
                return filename;
 107 
                return filename;
109 
        }
 108 
        }
110 
        else return NULL;
 109 
        else return NULL;
111 
}
 110 
}
Line 172... Line 171...
172 
                {
 171 
                {
173 
                        switch(logfilestate)
 172 
                        switch(logfilestate)
174 
                        {
 173 
                        {
175 
                                case LOGFILE_IDLE:
 174 
                                case LOGFILE_IDLE:
176 
                                case LOGFILE_CLOSED:
 175 
                                case LOGFILE_CLOSED:
177 
                                        if((GPSData.Status != INVALID) && (GPSData.Flags & FLAG_GPSFIXOK) && (GPSData.SatFix == SATFIX_3D) && (FC.MKFlags & MKFLAG_FLY))
 176 
                                        if((GPSData.Status != INVALID) && (GPSData.Flags & FLAG_GPSFIXOK) && (GPSData.SatFix == SATFIX_3D))// && (FC.MKFlags & MKFLAG_FLY))
178 
                                        {
 177 
                                        {
179 
                                                logfilestate = LOGFILE_START;
 178 
                                                logfilestate = LOGFILE_START;
180 
                                        }
 179 
                                        }
181 
                                        break;
 180 
                                        break;
182 
                                case LOGFILE_START:
 181 
                                case LOGFILE_START:
Line 214... Line 213...
214 
                                        break;
 213 
                                        break;
215 
                                case LOGFILE_OPENED:
 214 
                                case LOGFILE_OPENED:
216 
                                        // append new gps log data
 215 
                                        // append new gps log data
217 
                                        if((GPSData.Status != INVALID) && (GPSData.Flags & FLAG_GPSFIXOK) && (GPSData.SatFix == SATFIX_3D))
 216 
                                        if((GPSData.Status != INVALID) && (GPSData.Flags & FLAG_GPSFIXOK) && (GPSData.SatFix == SATFIX_3D))
218 
                                        {
 217 
                                        {
219 
                                                if(!KML_LoggGPSCoordinates(&(GPSData.Position), &logfile))
 218 
                                                if(!KML_LoggGPSCoordinates(&logfile))
220 
                                                {       // error logging data
 219 
                                                {       // error logging data
221 
                                                        SerialPutString("\r\nError logging to kml-file\r\n");
 220 
                                                        SerialPutString("\r\nError logging to kml-file\r\n");
222 
                                                        KML_DocumentClose(&logfile);
 221 
                                                        KML_DocumentClose(&logfile);
223 
                                                        logfilestate = LOGFILE_ERROR;
 222 
                                                        logfilestate = LOGFILE_ERROR;
224 
                                                }
 223 
                                                }
Line 256... Line 255...
256 
 
 255 
 
257 
//----------------------------------------------------------------------------------------------------
 256 
//----------------------------------------------------------------------------------------------------
258 
// logs gps and state info to a gpx file
 257 
// logs gps and state info to a gpx file
259 
logfilestate_t Logging_GPX(u32 LogDelay)
 258 
logfilestate_t Logging_GPX(u32 LogDelay)
260 
{
 259 
{
- 
 
 260 
        static  logfilestate_t logfilestate = LOGFILE_IDLE; // the current logfilestate
- 
 
 261 
        static  s8* logfilename = NULL;                                         // the pointer to the logfilename
- 
 
 262 
        static  u32 logtimer = 0;                                               // the log update timer
- 
 
 263 
        static  GPX_Document_t logfile;                                         // the logfilehandle
- 
 
 264 
 
- 
 
 265 
        // initialize if LogDelay os zero
- 
 
 266 
        if(!LogDelay)
- 
 
 267 
        {
- 
 
 268 
                switch(logfilestate)
- 
 
 269 
                {
- 
 
 270 
                        case LOGFILE_OPENED:
- 
 
 271 
                                GPX_DocumentClose(&logfile); // try to close it
- 
 
 272 
                                break;
- 
 
 273 
                        default:
- 
 
 274 
                                break;
- 
 
 275 
                }
- 
 
 276 
                logfilestate = LOGFILE_IDLE;
- 
 
 277 
                logfilename = NULL;
- 
 
 278 
                GPX_DocumentInit(&logfile);
- 
 
 279 
                logtimer = SetDelay(0); // set logtimer to now
- 
 
 280 
                return logfilestate;   
- 
 
 281 
        }
- 
 
 282 
        // no init
- 
 
 283 
        if(CheckDelay(logtimer))
- 
 
 284 
        {
- 
 
 285 
                logtimer = SetDelay(LogDelay);  // standard interval
- 
 
 286 
       
- 
 
 287 
                if(FC.MKFlags & MKFLAG_MOTOR_RUN)
- 
 
 288 
                {
- 
 
 289 
                        switch(logfilestate)
- 
 
 290 
                        {
- 
 
 291 
                                case LOGFILE_IDLE:
- 
 
 292 
                                case LOGFILE_CLOSED:
- 
 
 293 
                                        if((GPSData.Status != INVALID) && (GPSData.Flags & FLAG_GPSFIXOK) && (GPSData.SatFix == SATFIX_3D))// && (FC.MKFlags & MKFLAG_FLY))
- 
 
 294 
                                        {
- 
 
 295 
                                                logfilestate = LOGFILE_START;
- 
 
 296 
                                        }
- 
 
 297 
                                        break;
- 
 
 298 
                                case LOGFILE_START:
- 
 
 299 
                                        // find unused logfile name
- 
 
 300 
                                        do
- 
 
 301 
                                        {        // try to generate a new logfile name
- 
 
 302 
                                                 logfilename = GenerateGPXLogFileName();
- 
 
 303 
                                        }while((logfilename != NULL) && fexist_(logfilename));
- 
 
 304 
                                        // if logfilename exist
- 
 
 305 
                                        if(logfilename != NULL)
- 
 
 306 
                                        {
- 
 
 307 
                                                // try to create the log file
- 
 
 308 
                                                if(GPX_DocumentOpen(logfilename, &logfile))
- 
 
 309 
                                                {
- 
 
 310 
                                                        logfilestate = LOGFILE_OPENED; // goto next step
- 
 
 311 
                                                        SerialPutString("\r\nOpening gpx-file:");
- 
 
 312 
                                                        SerialPutString(logfilename);
- 
 
 313 
                                                        SerialPutString("\r\n");
- 
 
 314 
                                                }
- 
 
 315 
                                                else // could not be openend
- 
 
 316 
                                                {
- 
 
 317 
                                                        logfilestate = LOGFILE_ERROR;
- 
 
 318 
                                                        SerialPutString("\r\nError opening gpx-file: ");
- 
 
 319 
                                                        SerialPutString(logfilename);
- 
 
 320 
                                                        SerialPutString("\r\n");
- 
 
 321 
                                                        logtimer = SetDelay(10);  // try again in open logfile in 10 mili sec
- 
 
 322 
                                                }
- 
 
 323 
                                        }
- 
 
 324 
                                        else
- 
 
 325 
                                        {
- 
 
 326 
                                                logfilestate = LOGFILE_ERROR;
- 
 
 327 
                                                SerialPutString("\r\nError getting free gpx-file name\r\n");   
- 
 
 328 
                                        }
- 
 
 329 
                                        // else retry in next loop
- 
 
 330 
                                        break;
- 
 
 331 
                                case LOGFILE_OPENED:
- 
 
 332 
                                        // append new gps log data
- 
 
 333 
                                        if((GPSData.Status != INVALID) && (GPSData.Flags & FLAG_GPSFIXOK) && (GPSData.SatFix == SATFIX_3D))
- 
 
 334 
                                        {
- 
 
 335 
                                                if(!GPX_LoggGPSCoordinates(&logfile))
- 
 
 336 
                                                {       // error logging data
- 
 
 337 
                                                        SerialPutString("\r\nError logging to gpx-file\r\n");
- 
 
 338 
                                                        GPX_DocumentClose(&logfile);
- 
 
 339 
                                                        logfilestate = LOGFILE_ERROR;
- 
 
 340 
                                                }
- 
 
 341 
                                        }
- 
 
 342 
                                        break;
- 
 
 343 
       
- 
 
 344 
                                case LOGFILE_ERROR:
- 
 
 345 
                                        break;
- 
 
 346 
       
- 
 
 347 
                                default:
- 
 
 348 
                                        logfilestate = LOGFILE_IDLE;
- 
 
 349 
                                        break;
- 
 
 350 
                        }
- 
 
 351 
                } // EOF model is flying
- 
 
 352 
                else // model is not flying
- 
 
 353 
                {   // close log file if opened
- 
 
 354 
                        if(logfilestate == LOGFILE_OPENED)
- 
 
 355 
                        {
- 
 
 356 
                                if(GPX_DocumentClose(&logfile))
- 
 
 357 
                                {
- 
 
 358 
                                        SerialPutString("\r\nClosing gpx-file\r\n");
- 
 
 359 
                                        logfilestate = LOGFILE_CLOSED;
- 
 
 360 
                                }
- 
 
 361 
                                else  // could not be closed
- 
 
 362 
                                {
- 
 
 363 
                                        logfilestate =  LOGFILE_ERROR;
- 
 
 364 
                                }
- 
 
 365 
                        }
- 
 
 366 
                } //EOF model is not flying
Line 261... Line 367...
261 
        static  logfilestate_t logfilestate = LOGFILE_IDLE;
 367 
        } // EOF Check LogTimer
262 
 
 368 
 
Line 263... Line 369...
263 
        return logfilestate;
 369 
        return logfilestate;