Subversion Repositories NaviCtrl

Rev

Details | Last modification | View Log | RSS feed

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
{
79
  //{PID             , "1234567890123456" , Group, Value, Default,   Min,       Max },
210 killagreg 80
        {PID_KML_LOGGING , "KMLLOGGING      " ,     1,   500,     500,    0,    60000}, // the log interval for KML logging, 0 = off
233 holgerb 81
        {PID_GPX_LOGGING , "GPXLOGGING      " ,     1,  1000,    1000,    0,    60000}   // the log interval for GPX logging, 0 = off
1 ingob 82
};
83
 
84
 
85
//----------------------------------------------------------------------------------
88 killagreg 86
// initialize all parameters by its default value
87
void Settings_SetDefaultValues(void)
1 ingob 88
{
88 killagreg 89
        u8 i;
90
        // run thrue all parameters and set value to default
91
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
92
        {
93
                CFG_Parameter[i].Value  = CFG_Parameter[i].Default;
94
        }
1 ingob 95
}
96
 
97
//----------------------------------------------------------------------------------
88 killagreg 98
// set parameter from string based name and value
90 killagreg 99
u8 Settings_SetParameterFromString(s8 *name, s8 *value)
1 ingob 100
{
90 killagreg 101
        u8 i, retval = 0;
88 killagreg 102
        s8 string[] = "                \0"; // null terminated string of 16 characters
1 ingob 103
 
90 killagreg 104
        if((name == NULL) || (value == NULL)) return(retval);
105
 
88 killagreg 106
        i = strlen(name);                                       // lenght of the parameter name
107
        if (i > 16) i = 16;                                     // cut off at 16
108
 
109
        memcpy(string, name, i);                        // copy name to local buffer
110
 
111
    // search name in parameter list
112
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
113
        {
114
                if(strncmp(string, CFG_Parameter[i].Name, 16) == 0) // names are matching
115
                {
116
                        CFG_Parameter[i].Value = (u16)atoi(value); // convert string to number and set value
90 killagreg 117
                        // out of range ?
118
                        if((CFG_Parameter[i].Value < CFG_Parameter[i].Min) || (CFG_Parameter[i].Value > CFG_Parameter[i].Max))
119
                        {       // print a warning
120
                                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 121
                                UART1_PutString(text);
90 killagreg 122
                                CFG_Parameter[i].Value = CFG_Parameter[i].Default;  // fallback to default
123
                        }
124
                        retval = 1; // value in range
88 killagreg 125
                        break; // end loop
126
                }
127
        }
90 killagreg 128
        if(!retval)
112 killagreg 129
        {
90 killagreg 130
                sprintf(text,"\r\n%s <-- unknown parameter\r\n", string);
110 killagreg 131
                UART1_PutString(text);
90 killagreg 132
        }
133
        return(retval);
1 ingob 134
}
135
 
136
//----------------------------------------------------------------------------------
88 killagreg 137
// read settings from file on sd-card
138
void Settings_Init(void)
139
{
140
        #define LINE_MAX 32
141
        File_t *fp;
92 killagreg 142
        s8 settingsline[LINE_MAX];
89 killagreg 143
        s8 *name, *value;
90 killagreg 144
        u8 i;
210 killagreg 145
        s8 filename[] = "settings.ini";
1 ingob 146
 
114 killagreg 147
        UART1_PutString("\n\r Settings init...");
88 killagreg 148
        Settings_SetDefaultValues();
112 killagreg 149
 
90 killagreg 150
        if(Fat16_IsValid())
151
        {       // check if settings file is existing
210 killagreg 152
                if(fexist_(filename))
112 killagreg 153
                {
210 killagreg 154
                        fp = fopen_(filename, 'r');             // try to open the file
90 killagreg 155
                        if (fp == NULL)                                                 // could not open the file
88 killagreg 156
                        {
110 killagreg 157
                                UART1_PutString("ERROR: Opening settings file!");
90 killagreg 158
                                return;
1 ingob 159
                        }
90 killagreg 160
                        // read all lines from file
92 killagreg 161
                        while(fgets_(settingsline, LINE_MAX, fp) != 0)
90 killagreg 162
                        {
163
                                if ( // ignorelines starting with \r,\n,' ',';','#'
92 killagreg 164
                                        (settingsline[0] != '\n') &&
165
                                        (settingsline[0] != '\r') &&
166
                                        (settingsline[0] != ' ' ) &&
167
                                        (settingsline[0] != ';' ) &&
168
                                        (settingsline[0] != '#' )
90 killagreg 169
                                        )
170
                                {
92 killagreg 171
                                        name  = strtok(settingsline, "="); // get name
90 killagreg 172
                                        value = strtok(NULL, "="); // get value
173
                                        if ((name != NULL) && (value != NULL))
174
                                        {
210 killagreg 175
                                                u8 i;
176
                                                for(i=0; name[i]; i++) name[i] = toupper(name[i]);
90 killagreg 177
                                                Settings_SetParameterFromString(name, value);
178
                                        }
179
                                }
180
                        }
181
                        fclose_(fp);
110 killagreg 182
                        UART1_PutString("ok");
90 killagreg 183
                        return;
1 ingob 184
                }
90 killagreg 185
                else // settings file does not exist
186
                {       // create default settings file
187
                        fp = fopen_("settings.ini", 'w');               // try to open the file
188
                        if(fp == NULL)
189
                        {
110 killagreg 190
                                UART1_PutString("ERROR: Creating default settings file!");
112 killagreg 191
                                return;
90 killagreg 192
                        }
193
                        // run thrue all parameters and set value to default
194
                        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
195
                        {
92 killagreg 196
                                sprintf(settingsline, "%s = %d\r\n", CFG_Parameter[i].Name, CFG_Parameter[i].Default);
197
                                fputs_(settingsline, fp); // write to file
90 killagreg 198
                        }
199
                        fputs_("\r\n", fp); // newline at the end of file
200
                        fclose_(fp);
110 killagreg 201
                        UART1_PutString("Default settings file created!");
90 killagreg 202
                        return;
203
                }
88 killagreg 204
        }
90 killagreg 205
        else // no acces to fat 16 filesystem
206
        {
110 killagreg 207
                UART1_PutString("Using default values!");
90 killagreg 208
                return;
209
        }
1 ingob 210
}
211
 
88 killagreg 212
 
213
//----------------------------------------------------------------------------------
214
// read value of a paramter identified by its id
215
// returns 1 on success and 0 on error
216
u8 Settings_GetParamValue(ParamId_t Pid, u16 * pValue)
217
{
218
        u8 i, retval = 0;
219
 
220
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
221
        {
222
                if(CFG_Parameter[i].ParamId == Pid)
223
                {
224
                        *pValue = CFG_Parameter[i].Value;
225
                        retval = 1;
226
                        break;
227
                }
228
        }
229
        return retval;
230
}