WebSVN - NaviCtrl - Blame - Rev 355 - /tags/V2.10c/settings.c

Rev	Author	Line No.	Line
1	ingob	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
1	ingob	7	// + FOR NON COMMERCIAL USE ONLY
		8	// + www.MikroKopter.com
		9	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
88	killagreg	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.
1	ingob	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	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
88	killagreg	17	// + Werden Teile des Quellcodes (mit oder ohne Modifikation) weiterverwendet oder ver�ffentlicht,
1	ingob	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
1	ingob	29	// + mit unserer Zustimmung zul�ssig
		30	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
		31	// + Die Funktion printf_P() unterliegt ihrer eigenen Lizenz und ist hiervon nicht betroffen
		32	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
88	killagreg	33	// + Redistributions of source code (with or without modifications) must retain the above copyright notice,
1	ingob	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.
88	killagreg	37	// + * The use of this project (hardware, software, binary files, sources and documentation) is only permitted
1	ingob	38	// + for non-commercial use (directly or indirectly)
88	killagreg	39	// + Commercial use (for excample: selling of MikroKopters, selling of PCBs, assembly, ...) is only permitted
1	ingob	40	// + with our written permission
88	killagreg	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
1	ingob	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
88	killagreg	55	// + POSSIBILITY OF SUCH DAMAGE.
1	ingob	56	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
210	killagreg	57	#include <ctype.h>
41	ingob	58	#include <stdio.h>
		59	#include <stdlib.h>
		60	#include <string.h>
		61	#include "91x_lib.h"
		62	#include "fat16.h"
		63	#include "settings.h"
		64	#include "uart1.h"
1	ingob	65
88	killagreg	66	typedef struct
1	ingob	67	{
88	killagreg	68	ParamId_t ParamId;
90	killagreg	69	s8 Name[17]; // 0 terminator is the last byte
88	killagreg	70	u8 Group; // 0 = reserved 1,2,3,4
		71	u16 Value;
		72	u16 Default;
		73	u16 Min;
		74	u16 Max;
		75	} __attribute__((packed)) Parameter_t;
		76
		77	Parameter_t CFG_Parameter[] =
		78	{
351	holgerb	79	//{PID , "1234567890123456" , Group, Value, Default, Min, Max },
		80	{PID_KML_LOGGING , "KMLLOGGING " , 1, 500, 500, 0, 60000}, // the log interval for KML logging, 0 = off
		81	{PID_GPX_LOGGING , "GPXLOGGING " , 1, 1000, 1000, 0, 60000}, // the log interval for GPX logging, 0 = off
355	holgerb	82	{PID_ABSOLUTE_FLYING_ALT , "MAX_FLYING_ALT " , 1, 0, 0, 0, 30000}, // in [m]
		83	{PID_ABSOLUTE_FLYING_RANGE , "MAX_FLYING_RANGE" , 1, 0, 0, 0, 60000}, // in [m]
		84	{PID_AUTO_DESCEND_RANGE , "DESCEND_RANGE " , 1, 0, 0, 0, 60000}, // in [m]
351	holgerb	85	{PID_GPS_AUTOCONFIG , "GPSAUTOCONFIG " , 1, 1, 1, 0, 1}
1	ingob	86	};
		87
		88
		89	//----------------------------------------------------------------------------------
88	killagreg	90	// initialize all parameters by its default value
		91	void Settings_SetDefaultValues(void)
1	ingob	92	{
88	killagreg	93	u8 i;
		94	// run thrue all parameters and set value to default
		95	for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
		96	{
		97	CFG_Parameter[i].Value = CFG_Parameter[i].Default;
		98	}
1	ingob	99	}
		100
		101	//----------------------------------------------------------------------------------
88	killagreg	102	// set parameter from string based name and value
90	killagreg	103	u8 Settings_SetParameterFromString(s8 name, s8 value)
1	ingob	104	{
90	killagreg	105	u8 i, retval = 0;
88	killagreg	106	s8 string[] = " \0"; // null terminated string of 16 characters
1	ingob	107
90	killagreg	108	if((name == NULL) \|\| (value == NULL)) return(retval);
		109
88	killagreg	110	i = strlen(name); // lenght of the parameter name
		111	if (i > 16) i = 16; // cut off at 16
		112
		113	memcpy(string, name, i); // copy name to local buffer
		114
		115	// search name in parameter list
		116	for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
		117	{
		118	if(strncmp(string, CFG_Parameter[i].Name, 16) == 0) // names are matching
		119	{
		120	CFG_Parameter[i].Value = (u16)atoi(value); // convert string to number and set value
90	killagreg	121	// out of range ?
		122	if((CFG_Parameter[i].Value < CFG_Parameter[i].Min) \|\| (CFG_Parameter[i].Value > CFG_Parameter[i].Max))
		123	{ // print a warning
		124	sprintf(text,"\r\n%s <-- %d is out of range [%d...%d]", string, CFG_Parameter[i].Value, CFG_Parameter[i].Min, CFG_Parameter[i].Max);
110	killagreg	125	UART1_PutString(text);
90	killagreg	126	CFG_Parameter[i].Value = CFG_Parameter[i].Default; // fallback to default
		127	}
		128	retval = 1; // value in range
88	killagreg	129	break; // end loop
		130	}
		131	}
90	killagreg	132	if(!retval)
112	killagreg	133	{
90	killagreg	134	sprintf(text,"\r\n%s <-- unknown parameter\r\n", string);
110	killagreg	135	UART1_PutString(text);
90	killagreg	136	}
		137	return(retval);
1	ingob	138	}
		139
		140	//----------------------------------------------------------------------------------
88	killagreg	141	// read settings from file on sd-card
		142	void Settings_Init(void)
		143	{
		144	#define LINE_MAX 32
		145	File_t *fp;
92	killagreg	146	s8 settingsline[LINE_MAX];
89	killagreg	147	s8 name, value;
90	killagreg	148	u8 i;
210	killagreg	149	s8 filename[] = "settings.ini";
1	ingob	150
114	killagreg	151	UART1_PutString("\n\r Settings init...");
88	killagreg	152	Settings_SetDefaultValues();
112	killagreg	153
90	killagreg	154	if(Fat16_IsValid())
		155	{ // check if settings file is existing
210	killagreg	156	if(fexist_(filename))
112	killagreg	157	{
210	killagreg	158	fp = fopen_(filename, 'r'); // try to open the file
90	killagreg	159	if (fp == NULL) // could not open the file
88	killagreg	160	{
110	killagreg	161	UART1_PutString("ERROR: Opening settings file!");
90	killagreg	162	return;
1	ingob	163	}
90	killagreg	164	// read all lines from file
92	killagreg	165	while(fgets_(settingsline, LINE_MAX, fp) != 0)
90	killagreg	166	{
		167	if ( // ignorelines starting with \r,\n,' ',';','#'
92	killagreg	168	(settingsline[0] != '\n') &&
		169	(settingsline[0] != '\r') &&
		170	(settingsline[0] != ' ' ) &&
		171	(settingsline[0] != ';' ) &&
		172	(settingsline[0] != '#' )
90	killagreg	173	)
		174	{
92	killagreg	175	name = strtok(settingsline, "="); // get name
90	killagreg	176	value = strtok(NULL, "="); // get value
		177	if ((name != NULL) && (value != NULL))
		178	{
210	killagreg	179	u8 i;
		180	for(i=0; name[i]; i++) name[i] = toupper(name[i]);
90	killagreg	181	Settings_SetParameterFromString(name, value);
		182	}
		183	}
		184	}
		185	fclose_(fp);
110	killagreg	186	UART1_PutString("ok");
90	killagreg	187	return;
1	ingob	188	}
90	killagreg	189	else // settings file does not exist
		190	{ // create default settings file
		191	fp = fopen_("settings.ini", 'w'); // try to open the file
		192	if(fp == NULL)
		193	{
110	killagreg	194	UART1_PutString("ERROR: Creating default settings file!");
112	killagreg	195	return;
90	killagreg	196	}
		197	// run thrue all parameters and set value to default
		198	for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
		199	{
92	killagreg	200	sprintf(settingsline, "%s = %d\r\n", CFG_Parameter[i].Name, CFG_Parameter[i].Default);
		201	fputs_(settingsline, fp); // write to file
90	killagreg	202	}
		203	fputs_("\r\n", fp); // newline at the end of file
		204	fclose_(fp);
110	killagreg	205	UART1_PutString("Default settings file created!");
90	killagreg	206	return;
		207	}
88	killagreg	208	}
90	killagreg	209	else // no acces to fat 16 filesystem
		210	{
110	killagreg	211	UART1_PutString("Using default values!");
90	killagreg	212	return;
		213	}
1	ingob	214	}
		215
88	killagreg	216
		217	//----------------------------------------------------------------------------------
		218	// read value of a paramter identified by its id
		219	// returns 1 on success and 0 on error
		220	u8 Settings_GetParamValue(ParamId_t Pid, u16 * pValue)
		221	{
		222	u8 i, retval = 0;
		223
		224	for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
		225	{
		226	if(CFG_Parameter[i].ParamId == Pid)
		227	{
		228	*pValue = CFG_Parameter[i].Value;
		229	retval = 1;
		230	break;
		231	}
		232	}
		233	return retval;
		234	}

Subversion Repositories NaviCtrl

(root)/tags/V2.10c/settings.c @ 811 - Rev 355