WebSVN - NaviCtrl - Blame - Rev 312 - /tags/V0.15c/logging.c

Rev	Author	Line No.	Line
82	killagreg	1	/#######################################################################################/
		2	/* !!! THIS IS NOT FREE SOFTWARE !!! */
		3	/#######################################################################################/
		4	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
		5	// + Copyright (c) 2008 Ingo Busker, Holger Buss
171	ingob	6	// + Nur f�r den privaten Gebrauch / NON-COMMERCIAL USE ONLY
82	killagreg	7	// + FOR NON COMMERCIAL USE ONLY
		8	// + www.MikroKopter.com
		9	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
		10	// + Es gilt f�r das gesamte Projekt (Hardware, Software, Bin�rfiles, Sourcecode und Dokumentation),
		11	// + dass eine Nutzung (auch auszugsweise) nur f�r den privaten (nicht-kommerziellen) Gebrauch zul�ssig ist.
		12	// + Sollten direkte oder indirekte kommerzielle Absichten verfolgt werden, ist mit uns (info@mikrokopter.de) Kontakt
		13	// + bzgl. der Nutzungsbedingungen aufzunehmen.
		14	// + Eine kommerzielle Nutzung ist z.B.Verkauf von MikroKoptern, Best�ckung und Verkauf von Platinen oder Baus�tzen,
		15	// + Verkauf von Luftbildaufnahmen, usw.
		16	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
		17	// + Werden Teile des Quellcodes (mit oder ohne Modifikation) weiterverwendet oder ver�ffentlicht,
		18	// + unterliegen sie auch diesen Nutzungsbedingungen und diese Nutzungsbedingungen incl. Copyright m�ssen dann beiliegen
		19	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
		20	// + Sollte die Software (auch auszugesweise) oder sonstige Informationen des MikroKopter-Projekts
		21	// + auf anderen Webseiten oder sonstigen Medien ver�ffentlicht werden, muss unsere Webseite "http://www.mikrokopter.de"
		22	// + eindeutig als Ursprung verlinkt werden
		23	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
		24	// + Keine Gew�hr auf Fehlerfreiheit, Vollst�ndigkeit oder Funktion
		25	// + Benutzung auf eigene Gefahr
		26	// + Wir �bernehmen keinerlei Haftung f�r direkte oder indirekte Personen- oder Sachsch�den
		27	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
171	ingob	28	// + Die Portierung oder Nutzung der Software (oder Teile davon) auf andere Systeme (ausser der Hardware von www.mikrokopter.de) ist nur
82	killagreg	29	// + mit unserer Zustimmung zul�ssig
		30	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
		31	// + Die Funktion printf_P() unterliegt ihrer eigenen Lizenz und ist hiervon nicht betroffen
		32	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
		33	// + Redistributions of source code (with or without modifications) must retain the above copyright notice,
		34	// + this list of conditions and the following disclaimer.
		35	// + * Neither the name of the copyright holders nor the names of contributors may be used to endorse or promote products derived
		36	// + from this software without specific prior written permission.
		37	// + * The use of this project (hardware, software, binary files, sources and documentation) is only permitted
		38	// + for non-commercial use (directly or indirectly)
		39	// + Commercial use (for excample: selling of MikroKopters, selling of PCBs, assembly, ...) is only permitted
		40	// + with our written permission
		41	// + * If sources or documentations are redistributet on other webpages, out webpage (http://www.MikroKopter.de) must be
		42	// + clearly linked as origin
171	ingob	43	// + * porting the sources to other systems or using the software on other systems (except hardware from www.mikrokopter.de) is not allowed
82	killagreg	44	//
		45	// + THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
		46	// + AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
		47	// + IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
		48	// + ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
		49	// + LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
		50	// + CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
		51	// + SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
		52	// + INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
		53	// + CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
		54	// + ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
		55	// + POSSIBILITY OF SUCH DAMAGE.
		56	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
		57	#include <stdio.h>
		58	#include "91x_lib.h"
		59	#include "main.h"
		60	#include "timer.h"
		61	#include "uart1.h"
		62	#include "kml.h"
85	killagreg	63	#include "gpx.h"
86	killagreg	64	#include "ssc.h"
88	killagreg	65	#include "settings.h"
82	killagreg	66
92	killagreg	67
		68	#define LOG_FLUSH_INTERVAL 20000 // 20s
		69
82	killagreg	70	typedef enum
		71	{
		72	LOGFILE_IDLE,
		73	LOGFILE_START,
		74	LOGFILE_CLOSED,
		75	LOGFILE_OPENED,
		76	LOGFILE_ERROR
		77	} logfilestate_t;
		78
		79	// logger handler prototypes
		80	logfilestate_t Logging_KML(u32 LogDelay);
		81	logfilestate_t Logging_GPX(u32 LogDelay);
		82
		83	typedef struct
		84	{
		85	u32 KML_Interval; // the kml-log interval (0 = off)
88	killagreg	86	u32 GPX_Interval; // the gpx-log interval (0 = off)
82	killagreg	87	} LogCfg_t;
		88
101	holgerb	89	LogCfg_t LogCfg = {500 , 1000};
82	killagreg	90
		91
		92	//----------------------------------------------------------------------------------------------------
		93	s8* GenerateKMLLogFileName(void)
		94	{
		95	static u16 filenum = 0; // file name counter
		96	static s8 filename[35];
		97	static DateTime_t LastTime = {0,0,0,0,0,0,0,0};
		98
		99	if(SystemTime.Valid)
		100	{
		101	// if the day has been changed
		102	if((LastTime.Year != SystemTime.Year) \|\| (LastTime.Month != SystemTime.Month) \|\| (LastTime.Day != SystemTime.Day))
		103	{
		104	LastTime.Year = SystemTime.Year;
		105	LastTime.Month = SystemTime.Month;
		106	LastTime.Day = SystemTime.Day;
		107	LastTime.Valid = 1;
		108	filenum = 0; // reset file counter
		109	}
85	killagreg	110	sprintf(filename, "LOG/%04i%02i%02i/KML/GPS%05i.KML", SystemTime.Year, SystemTime.Month, SystemTime.Day, filenum);
82	killagreg	111	filenum++;
		112	return filename;
		113	}
		114	else return NULL;
		115	}
		116
		117	//----------------------------------------------------------------------------------------------------
		118	s8* GenerateGPXLogFileName(void)
		119	{
		120	static u16 filenum = 0; // file name counter
		121	static s8 filename[35];
		122	static DateTime_t LastTime = {0,0,0,0,0,0,0,0};
		123
		124	if(SystemTime.Valid)
		125	{
		126	// if the day has been changed
		127	if((LastTime.Year != SystemTime.Year) \|\| (LastTime.Month != SystemTime.Month) \|\| (LastTime.Day != SystemTime.Day))
		128	{
		129	LastTime.Year = SystemTime.Year;
		130	LastTime.Month = SystemTime.Month;
		131	LastTime.Day = SystemTime.Day;
		132	LastTime.Valid = 1;
		133	filenum = 0; // reset file counter
		134	}
		135	sprintf(filename, "LOG/%04i%02i%02i/GPX/GPS%05i.GPX", SystemTime.Year, SystemTime.Month, SystemTime.Day, filenum);
		136	filenum++;
		137	return filename;
		138	}
		139	else return NULL;
		140	}
		141
		142
		143
		144	//----------------------------------------------------------------------------------------------------
		145	// logs the current gps position to a kml file
		146	logfilestate_t Logging_KML(u32 LogDelay)
		147	{
		148	static logfilestate_t logfilestate = LOGFILE_IDLE; // the current logfilestate
		149	static s8* logfilename = NULL; // the pointer to the logfilename
92	killagreg	150	static u32 logtimer = 0, flushtimer = 0; // the log update timer
82	killagreg	151	static KML_Document_t logfile; // the logfilehandle
		152
		153	// initialize if LogDelay os zero
		154	if(!LogDelay)
		155	{
		156	switch(logfilestate)
		157	{
88	killagreg	158	case LOGFILE_OPENED:
82	killagreg	159	KML_DocumentClose(&logfile); // try to close it
		160	break;
		161	default:
		162	break;
		163	}
		164	logfilestate = LOGFILE_IDLE;
		165	logfilename = NULL;
		166	KML_DocumentInit(&logfile);
		167	logtimer = SetDelay(0); // set logtimer to now
88	killagreg	168	return logfilestate;
82	killagreg	169	}
		170	// no init
		171	if(CheckDelay(logtimer))
		172	{
		173	logtimer = SetDelay(LogDelay); // standard interval
88	killagreg	174
82	killagreg	175	if(FC.MKFlags & MKFLAG_MOTOR_RUN)
		176	{
		177	switch(logfilestate)
		178	{
		179	case LOGFILE_IDLE:
		180	case LOGFILE_CLOSED:
87	killagreg	181	if((GPSData.Status != INVALID) && (GPSData.Flags & FLAG_GPSFIXOK) && (GPSData.SatFix == SATFIX_3D) && (FC.MKFlags & MKFLAG_FLY))
82	killagreg	182	{
		183	logfilestate = LOGFILE_START;
		184	}
		185	break;
		186	case LOGFILE_START:
		187	// find unused logfile name
		188	do
		189	{ // try to generate a new logfile name
		190	logfilename = GenerateKMLLogFileName();
		191	}while((logfilename != NULL) && fexist_(logfilename));
		192	// if logfilename exist
		193	if(logfilename != NULL)
		194	{
		195	// try to create the log file
		196	if(KML_DocumentOpen(logfilename, &logfile))
		197	{
92	killagreg	198	flushtimer = SetDelay(LOG_FLUSH_INTERVAL);
82	killagreg	199	logfilestate = LOGFILE_OPENED; // goto next step
		200	SerialPutString("\r\nOpening kml-file:");
		201	SerialPutString(logfilename);
		202	SerialPutString("\r\n");
		203	}
		204	else // could not be openend
		205	{
		206	logfilestate = LOGFILE_ERROR;
		207	SerialPutString("\r\nError opening kml-file: ");
		208	SerialPutString(logfilename);
		209	SerialPutString("\r\n");
		210	logtimer = SetDelay(10); // try again in open logfile in 10 mili sec
		211	}
		212	}
		213	else
		214	{
		215	logfilestate = LOGFILE_ERROR;
88	killagreg	216	SerialPutString("\r\nError getting free kml-file name\r\n");
82	killagreg	217	}
		218	// else retry in next loop
		219	break;
		220	case LOGFILE_OPENED:
		221	// append new gps log data
		222	if((GPSData.Status != INVALID) && (GPSData.Flags & FLAG_GPSFIXOK) && (GPSData.SatFix == SATFIX_3D))
		223	{
85	killagreg	224	if(!KML_LoggGPSCoordinates(&logfile))
82	killagreg	225	{ // error logging data
		226	SerialPutString("\r\nError logging to kml-file\r\n");
		227	KML_DocumentClose(&logfile);
		228	logfilestate = LOGFILE_ERROR;
		229	}
92	killagreg	230	else // sucessfully logged
		231	{
		232	if(CheckDelay(flushtimer))
		233	{
		234	flushtimer = SetDelay(LOG_FLUSH_INTERVAL);
		235	fflush_(logfile.file);
		236	}
		237	}
		238
82	killagreg	239	}
		240	break;
88	killagreg	241
82	killagreg	242	case LOGFILE_ERROR:
		243	break;
88	killagreg	244
82	killagreg	245	default:
		246	logfilestate = LOGFILE_IDLE;
		247	break;
		248	}
92	killagreg	249	} // EOF motors are not running
82	killagreg	250	else // model is not flying
		251	{ // close log file if opened
		252	if(logfilestate == LOGFILE_OPENED)
		253	{
		254	if(KML_DocumentClose(&logfile))
		255	{
		256	SerialPutString("\r\nClosing kml-file\r\n");
		257	logfilestate = LOGFILE_CLOSED;
		258	}
		259	else // could not be closed
		260	{
92	killagreg	261	SerialPutString("\r\nError closing kml-file\r\n");
82	killagreg	262	logfilestate = LOGFILE_ERROR;
		263	}
		264	}
92	killagreg	265	} //EOF motors are not running
82	killagreg	266	} // EOF Check LogTimer
		267
		268	return logfilestate;
		269	}
88	killagreg	270
82	killagreg	271	//----------------------------------------------------------------------------------------------------
		272	// logs gps and state info to a gpx file
		273	logfilestate_t Logging_GPX(u32 LogDelay)
		274	{
85	killagreg	275	static logfilestate_t logfilestate = LOGFILE_IDLE; // the current logfilestate
		276	static s8* logfilename = NULL; // the pointer to the logfilename
92	killagreg	277	static u32 logtimer = 0, flushtimer = 0; // the log update timer
85	killagreg	278	static GPX_Document_t logfile; // the logfilehandle
82	killagreg	279
85	killagreg	280	// initialize if LogDelay os zero
		281	if(!LogDelay)
		282	{
		283	switch(logfilestate)
		284	{
88	killagreg	285	case LOGFILE_OPENED:
85	killagreg	286	GPX_DocumentClose(&logfile); // try to close it
		287	break;
		288	default:
		289	break;
		290	}
		291	logfilestate = LOGFILE_IDLE;
		292	logfilename = NULL;
		293	GPX_DocumentInit(&logfile);
		294	logtimer = SetDelay(0); // set logtimer to now
88	killagreg	295	return logfilestate;
85	killagreg	296	}
		297	// no init
		298	if(CheckDelay(logtimer))
		299	{
		300	logtimer = SetDelay(LogDelay); // standard interval
88	killagreg	301
85	killagreg	302	if(FC.MKFlags & MKFLAG_MOTOR_RUN)
		303	{
		304	switch(logfilestate)
		305	{
		306	case LOGFILE_IDLE:
		307	case LOGFILE_CLOSED:
87	killagreg	308	if((GPSData.Status != INVALID) && (GPSData.Flags & FLAG_GPSFIXOK) && (GPSData.SatFix == SATFIX_3D) && (FC.MKFlags & MKFLAG_FLY))
85	killagreg	309	{
		310	logfilestate = LOGFILE_START;
		311	}
		312	break;
		313	case LOGFILE_START:
		314	// find unused logfile name
		315	do
		316	{ // try to generate a new logfile name
		317	logfilename = GenerateGPXLogFileName();
		318	}while((logfilename != NULL) && fexist_(logfilename));
		319	// if logfilename exist
		320	if(logfilename != NULL)
		321	{
		322	// try to create the log file
		323	if(GPX_DocumentOpen(logfilename, &logfile))
		324	{
92	killagreg	325	flushtimer = SetDelay(LOG_FLUSH_INTERVAL);
85	killagreg	326	logfilestate = LOGFILE_OPENED; // goto next step
		327	SerialPutString("\r\nOpening gpx-file:");
		328	SerialPutString(logfilename);
		329	SerialPutString("\r\n");
		330	}
		331	else // could not be openend
		332	{
		333	logfilestate = LOGFILE_ERROR;
		334	SerialPutString("\r\nError opening gpx-file: ");
		335	SerialPutString(logfilename);
		336	SerialPutString("\r\n");
		337	logtimer = SetDelay(10); // try again in open logfile in 10 mili sec
		338	}
		339	}
		340	else
		341	{
		342	logfilestate = LOGFILE_ERROR;
88	killagreg	343	SerialPutString("\r\nError getting free gpx-file name\r\n");
85	killagreg	344	}
		345	// else retry in next loop
		346	break;
		347	case LOGFILE_OPENED:
		348	// append new gps log data
		349	if((GPSData.Status != INVALID) && (GPSData.Flags & FLAG_GPSFIXOK) && (GPSData.SatFix == SATFIX_3D))
		350	{
		351	if(!GPX_LoggGPSCoordinates(&logfile))
		352	{ // error logging data
		353	SerialPutString("\r\nError logging to gpx-file\r\n");
		354	GPX_DocumentClose(&logfile);
		355	logfilestate = LOGFILE_ERROR;
		356	}
92	killagreg	357	else // successful log
		358	{
		359	if(CheckDelay(flushtimer))
		360	{
		361	flushtimer = SetDelay(LOG_FLUSH_INTERVAL);
		362	fflush_(logfile.file);
		363	}
		364	}
85	killagreg	365	}
		366	break;
88	killagreg	367
85	killagreg	368	case LOGFILE_ERROR:
		369	break;
88	killagreg	370
85	killagreg	371	default:
		372	logfilestate = LOGFILE_IDLE;
		373	break;
		374	}
		375	} // EOF model is flying
		376	else // model is not flying
		377	{ // close log file if opened
		378	if(logfilestate == LOGFILE_OPENED)
		379	{
		380	if(GPX_DocumentClose(&logfile))
		381	{
		382	SerialPutString("\r\nClosing gpx-file\r\n");
		383	logfilestate = LOGFILE_CLOSED;
		384	}
		385	else // could not be closed
		386	{
92	killagreg	387	SerialPutString("\r\nError closing gpx-file\r\n");
85	killagreg	388	logfilestate = LOGFILE_ERROR;
		389	}
		390	}
		391	} //EOF model is not flying
		392	} // EOF Check LogTimer
		393
82	killagreg	394	return logfilestate;
		395	}
		396
		397	//----------------------------------------------------------------------------------------------------
		398	// initialize logging
		399	void Logging_Init(void)
		400	{
88	killagreg	401	LogCfg.KML_Interval = 500; //default
		402	Settings_GetParamValue(PID_KML_LOGGING, (u16*)&LogCfg.KML_Interval); // overwrite by settings value
92	killagreg	403	Logging_KML(0); // initialize
101	holgerb	404	LogCfg.GPX_Interval = 1000; //default
88	killagreg	405	Settings_GetParamValue(PID_GPX_LOGGING, (u16*)&LogCfg.GPX_Interval); // overwrite by settings value
92	killagreg	406	Logging_GPX(0); // initialize
82	killagreg	407	}
		408
		409	//----------------------------------------------------------------------------------------------------
		410	// gobal logging handler
		411	void Logging_Update(void)
		412	{
		413	static u32 logtimer = 0;
		414	static logfilestate_t logstate = LOGFILE_IDLE;
86	killagreg	415
88	killagreg	416
92	killagreg	417	if(SD_SWITCH) // a card is in slot
84	killagreg	418	{
92	killagreg	419	if(CheckDelay(logtimer))
84	killagreg	420	{
92	killagreg	421	logtimer = SetDelay(10); // faster makes no sense
		422	// call the logger handlers if no error has occured
		423	if(logstate != LOGFILE_ERROR) logstate = Logging_KML(LogCfg.KML_Interval);
		424	if(logstate != LOGFILE_ERROR) logstate = Logging_GPX(LogCfg.GPX_Interval);
		425
		426	// a logging error has occured
		427	if(logstate == LOGFILE_ERROR)
		428	{
		429	if(Fat16_IsValid()) // wait for reinizialization of fat16 from outside
		430	{
		431	Logging_Init(); // initialize the logs
		432	logstate = LOGFILE_IDLE;
		433	logtimer = SetDelay(10); // try next log in 10 mili sec
		434	}
		435	else
		436	{ // retry in 5 seconds
		437	logtimer = SetDelay(5000); // try again in 5 sec
		438	}
		439	} //EOF logfile error
		440	} // EOF CheckDelay
		441	}// EOF Card in Slot
88	killagreg	442	}

Subversion Repositories NaviCtrl

(root)/tags/V0.15c/logging.c - Rev 312