Subversion Repositories NaviCtrl

Rev

Rev 356 | Rev 361 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 356 Rev 360
1
/*#######################################################################################*/
1
/*#######################################################################################*/
2
/* !!! THIS IS NOT FREE SOFTWARE !!!                                                     */
2
/* !!! THIS IS NOT FREE SOFTWARE !!!                                                     */
3
/*#######################################################################################*/
3
/*#######################################################################################*/
4
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
4
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
5
// + Copyright (c) 2008 Ingo Busker, Holger Buss
-
 
6
// + Nur für den privaten Gebrauch / NON-COMMERCIAL USE ONLY
-
 
7
// + FOR NON COMMERCIAL USE ONLY
-
 
8
// + www.MikroKopter.com
5
// + www.MikroKopter.com
9
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
6
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
-
 
7
// + Software Nutzungsbedingungen (english version: see below)
10
// + Es gilt für das gesamte Projekt (Hardware, Software, Binärfiles, Sourcecode und Dokumentation),
8
// + der Fa. HiSystems GmbH, Flachsmeerstrasse 2, 26802 Moormerland - nachfolgend Lizenzgeber genannt -
11
// + dass eine Nutzung (auch auszugsweise) nur für den privaten (nicht-kommerziellen) Gebrauch zulässig ist.
9
// + Der Lizenzgeber räumt dem Kunden ein nicht-ausschließliches, zeitlich und räumlich* unbeschränktes Recht ein, die im den
12
// + Sollten direkte oder indirekte kommerzielle Absichten verfolgt werden, ist mit uns (info@mikrokopter.de) Kontakt
10
// + Mikrocontroller verwendete Firmware für die Hardware Flight-Ctrl, Navi-Ctrl, BL-Ctrl, MK3Mag & PC-Programm MikroKopter-Tool 
13
// + bzgl. der Nutzungsbedingungen aufzunehmen.
11
// + - nachfolgend Software genannt - nur für private Zwecke zu nutzen.
14
// + Eine kommerzielle Nutzung ist z.B.Verkauf von MikroKoptern, Bestückung und Verkauf von Platinen oder Bausätzen,
12
// + Der Einsatz dieser Software ist nur auf oder mit Produkten des Lizenzgebers zulässig.
15
// + Verkauf von Luftbildaufnahmen, usw.
-
 
16
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
13
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
17
// + Werden Teile des Quellcodes (mit oder ohne Modifikation) weiterverwendet oder veröffentlicht,
14
// + Die vom Lizenzgeber gelieferte Software ist urheberrechtlich geschützt. Alle Rechte an der Software sowie an sonstigen im
18
// + unterliegen sie auch diesen Nutzungsbedingungen und diese Nutzungsbedingungen incl. Copyright müssen dann beiliegen
15
// + Rahmen der Vertragsanbahnung und Vertragsdurchführung überlassenen Unterlagen stehen im Verhältnis der Vertragspartner ausschließlich dem Lizenzgeber zu.
19
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
16
// + Die in der Software enthaltenen Copyright-Vermerke, Markenzeichen, andere Rechtsvorbehalte, Seriennummern sowie
20
// + Sollte die Software (auch auszugesweise) oder sonstige Informationen des MikroKopter-Projekts
17
// + sonstige der Programmidentifikation dienenden Merkmale dürfen vom Kunden nicht verändert oder unkenntlich gemacht werden.
21
// + auf anderen Webseiten oder sonstigen Medien veröffentlicht werden, muss unsere Webseite "http://www.mikrokopter.de"
18
// + Der Kunde trifft angemessene Vorkehrungen für den sicheren Einsatz der Software. Er wird die Software gründlich auf deren
22
// + eindeutig als Ursprung verlinkt werden
19
// + Verwendbarkeit zu dem von ihm beabsichtigten Zweck testen, bevor er diese operativ einsetzt.
23
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
20
// + Die Haftung des Lizenzgebers wird - soweit gesetzlich zulässig - begrenzt in Höhe des typischen und vorhersehbaren
24
// + Keine Gewähr auf Fehlerfreiheit, Vollständigkeit oder Funktion
21
// + Schadens. Die gesetzliche Haftung bei Personenschäden und nach dem Produkthaftungsgesetz bleibt unberührt. Dem Lizenzgeber steht jedoch der Einwand 
25
// + Benutzung auf eigene Gefahr
22
// + des Mitverschuldens offen.
-
 
23
// + Der Kunde trifft angemessene Vorkehrungen für den Fall, dass die Software ganz oder teilweise nicht ordnungsgemäß arbeitet.
-
 
24
// + Er wird die Software gründlich auf deren Verwendbarkeit zu dem von ihm beabsichtigten Zweck testen, bevor er diese operativ einsetzt.
26
// + Wir übernehmen keinerlei Haftung für direkte oder indirekte Personen- oder Sachschäden
25
// + Der Kunde wird er seine Daten vor Einsatz der Software nach dem Stand der Technik sichern.
-
 
26
// + Der Kunde ist darüber unterrichtet, dass der Lizenzgeber seine Daten im zur Vertragsdurchführung erforderlichen Umfang
27
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
27
// + und auf Grundlage der Datenschutzvorschriften erhebt, speichert, verarbeitet und, sofern notwendig, an Dritte übermittelt.
28
// + Die Portierung oder Nutzung der Software (oder Teile davon) auf andere Systeme (ausser der Hardware von www.mikrokopter.de) ist nur
28
// + *) Die räumliche Nutzung bezieht sich nur auf den Einsatzort, nicht auf die Reichweite der programmierten Software.
29
// + mit unserer Zustimmung zulässig
29
// + #### ENDE DER NUTZUNGSBEDINGUNGEN ####'
-
 
30
// +  Hinweis: Informationen über erweiterte Nutzungsrechte (wie z.B. Nutzung für nicht-private Zwecke) sind auf Anfrage per Email an info(@)hisystems.de verfügbar.
30
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
31
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
31
// + Die Funktion printf_P() unterliegt ihrer eigenen Lizenz und ist hiervon nicht betroffen
32
// + Software LICENSING TERMS
32
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
33
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
33
// + Redistributions of source code (with or without modifications) must retain the above copyright notice,
34
// + of HiSystems GmbH, Flachsmeerstrasse 2, 26802 Moormerland, Germany - the Licensor -
34
// + this list of conditions and the following disclaimer.
35
// + The Licensor grants the customer a non-exclusive license to use the microcontroller firmware of the Flight-Ctrl, Navi-Ctrl, BL-Ctrl, and MK3Mag hardware 
35
// +   * Neither the name of the copyright holders nor the names of contributors may be used to endorse or promote products derived
36
// + (the Software) exclusively for private purposes. The License is unrestricted with respect to time and territory*.
36
// +     from this software without specific prior written permission.
37
// + The Software may only be used with the Licensor's products.
37
// +   * The use of this project (hardware, software, binary files, sources and documentation) is only permitted
38
// + The Software provided by the Licensor is protected by copyright. With respect to the relationship between the parties to this
38
// +     for non-commercial use (directly or indirectly)
-
 
39
// +     Commercial use (for excample: selling of MikroKopters, selling of PCBs, assembly, ...) is only permitted
39
// + agreement, all rights pertaining to the Software and other documents provided during the preparation and execution of this
40
// +     with our written permission
40
// + agreement shall be the property of the Licensor.
41
// +   * If sources or documentations are redistributet on other webpages, out webpage (http://www.MikroKopter.de) must be
41
// + The information contained in the Software copyright notices, trademarks, other legal reservations, serial numbers and other
42
// +     clearly linked as origin
-
 
43
// +   * porting the sources to other systems or using the software on other systems (except hardware from www.mikrokopter.de) is not allowed
42
// + features that can be used to identify the program may not be altered or defaced by the customer.
44
//
-
 
45
// +  THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
43
// + The customer shall be responsible for taking reasonable precautions
46
// +  AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
44
// + for the safe use of the Software. The customer shall test the Software thoroughly regarding its suitability for the
47
// +  IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
45
// + intended purpose before implementing it for actual operation. The Licensor's liability shall be limited to the extent of typical and
48
// +  ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
46
// + foreseeable damage to the extent permitted by law, notwithstanding statutory liability for bodily injury and product
49
// +  LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
47
// + liability. However, the Licensor shall be entitled to the defense of contributory negligence.
50
// +  CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
48
// + The customer will take adequate precautions in the case, that the software is not working properly. The customer will test
51
// +  SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
49
// + the software for his purpose before any operational usage. The customer will backup his data before using the software.
52
// +  INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
50
// + The customer understands that the Licensor collects, stores and processes, and, where required, forwards, customer data
53
// +  CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
51
// + to third parties to the extent necessary for executing the agreement, subject to applicable data protection and privacy regulations.
54
// +  ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
52
// + *) The territory aspect only refers to the place where the Software is used, not its programmed range.
55
// +  POSSIBILITY OF SUCH DAMAGE.
53
// + #### END OF LICENSING TERMS ####
-
 
54
// + Note: For information on license extensions (e.g. commercial use), please contact us at info(@)hisystems.de.
56
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
55
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
57
#include <ctype.h>
56
#include <ctype.h>
58
#include <stdio.h>
57
#include <stdio.h>
59
#include <stdlib.h>
58
#include <stdlib.h>
60
#include <string.h>
59
#include <string.h>
61
#include "91x_lib.h"
60
#include "91x_lib.h"
62
#include "fat16.h"
61
#include "fat16.h"
63
#include "settings.h"
62
#include "settings.h"
64
#include "uart1.h"
63
#include "uart1.h"
65
 
64
 
66
typedef struct
65
typedef struct
67
{
66
{
68
        ParamId_t ParamId;
67
        ParamId_t ParamId;
69
        s8  Name[17]; // 0 terminator is the last byte
68
        s8  Name[17]; // 0 terminator is the last byte
70
        u8  Group;   // 0 = reserved  1,2,3,4
69
        u8  Group;   // 0 = reserved  1,2,3,4
71
        u16 Value;
70
        u16 Value;
72
        u16 Default;
71
        u16 Default;
73
        u16 Min;
72
        u16 Min;
74
        u16 Max;
73
        u16 Max;
75
} __attribute__((packed)) Parameter_t;
74
} __attribute__((packed)) Parameter_t;
76
 
75
 
77
Parameter_t CFG_Parameter[] =
76
Parameter_t CFG_Parameter[] =
78
{
77
{
79
  //{PID                                , "1234567890123456" , Group, Value, Default,   Min,    Max },
78
  //{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
79
        {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
80
        {PID_GPX_LOGGING                        , "GPXLOGGING      " ,     1,  1000,    1000,    0,     60000},   // the log interval for GPX logging, 0 = off
82
        {PID_ABSOLUTE_FLYING_ALT        , "MAX_FLYING_ALT  " ,     1,     0,       0,    0,     30000},   // in [m]
81
        {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]
82
        {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]
83
        {PID_AUTO_DESCEND_RANGE         , "DESCEND_RANGE   " ,     1,     0,       0,    0,     60000},   // in [m]
85
        {PID_GPS_SBAS_CONFIG            , "GPS_SBAS_DGPS_ON" ,     1,     1,       1,    0,             1},
84
        {PID_GPS_SBAS_CONFIG            , "GPS_SBAS_DGPS_ON" ,     1,     1,       1,    0,             1},
86
        {PID_GPS_AUTOCONFIG                     , "GPSAUTOCONFIG   " ,     1,     1,       1,    0,             1}
85
        {PID_GPS_AUTOCONFIG                     , "GPSAUTOCONFIG   " ,     1,     1,       1,    0,             1}
87
};
86
};
88
 
87
 
89
 
88
 
90
//----------------------------------------------------------------------------------
89
//----------------------------------------------------------------------------------
91
// initialize all parameters by its default value
90
// initialize all parameters by its default value
92
void Settings_SetDefaultValues(void)
91
void Settings_SetDefaultValues(void)
93
{
92
{
94
        u8 i;
93
        u8 i;
95
        // run thrue all parameters and set value to default
94
        // run thrue all parameters and set value to default
96
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
95
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
97
        {
96
        {
98
                CFG_Parameter[i].Value  = CFG_Parameter[i].Default;
97
                CFG_Parameter[i].Value  = CFG_Parameter[i].Default;
99
        }
98
        }
100
}
99
}
101
 
100
 
102
//----------------------------------------------------------------------------------
101
//----------------------------------------------------------------------------------
103
// set parameter from string based name and value
102
// set parameter from string based name and value
104
u8 Settings_SetParameterFromString(s8 *name, s8 *value)
103
u8 Settings_SetParameterFromString(s8 *name, s8 *value)
105
{
104
{
106
        u8 i, retval = 0;
105
        u8 i, retval = 0;
107
        s8 string[] = "                \0"; // null terminated string of 16 characters
106
        s8 string[] = "                \0"; // null terminated string of 16 characters
108
 
107
 
109
        if((name == NULL) || (value == NULL)) return(retval);
108
        if((name == NULL) || (value == NULL)) return(retval);
110
 
109
 
111
        i = strlen(name);                                       // lenght of the parameter name
110
        i = strlen(name);                                       // lenght of the parameter name
112
        if (i > 16) i = 16;                                     // cut off at 16
111
        if (i > 16) i = 16;                                     // cut off at 16
113
 
112
 
114
        memcpy(string, name, i);                        // copy name to local buffer
113
        memcpy(string, name, i);                        // copy name to local buffer
115
 
114
 
116
    // search name in parameter list
115
    // search name in parameter list
117
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
116
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
118
        {
117
        {
119
                if(strncmp(string, CFG_Parameter[i].Name, 16) == 0) // names are matching
118
                if(strncmp(string, CFG_Parameter[i].Name, 16) == 0) // names are matching
120
                {
119
                {
121
                        CFG_Parameter[i].Value = (u16)atoi(value); // convert string to number and set value
120
                        CFG_Parameter[i].Value = (u16)atoi(value); // convert string to number and set value
122
                        // out of range ?
121
                        // out of range ?
123
                        if((CFG_Parameter[i].Value < CFG_Parameter[i].Min) || (CFG_Parameter[i].Value > CFG_Parameter[i].Max))
122
                        if((CFG_Parameter[i].Value < CFG_Parameter[i].Min) || (CFG_Parameter[i].Value > CFG_Parameter[i].Max))
124
                        {       // print a warning
123
                        {       // print a warning
125
                                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);
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);
126
                                UART1_PutString(text);
125
                                UART1_PutString(text);
127
                                CFG_Parameter[i].Value = CFG_Parameter[i].Default;  // fallback to default
126
                                CFG_Parameter[i].Value = CFG_Parameter[i].Default;  // fallback to default
128
                        }
127
                        }
129
                        retval = 1; // value in range
128
                        retval = 1; // value in range
130
                        break; // end loop
129
                        break; // end loop
131
                }
130
                }
132
        }
131
        }
133
        if(!retval)
132
        if(!retval)
134
        {
133
        {
135
                sprintf(text,"\r\n%s <-- unknown parameter\r\n", string);
134
                sprintf(text,"\r\n%s <-- unknown parameter\r\n", string);
136
                UART1_PutString(text);
135
                UART1_PutString(text);
137
        }
136
        }
138
        return(retval);
137
        return(retval);
139
}
138
}
140
 
139
 
141
//----------------------------------------------------------------------------------
140
//----------------------------------------------------------------------------------
142
// read settings from file on sd-card
141
// read settings from file on sd-card
143
void Settings_Init(void)
142
void Settings_Init(void)
144
{
143
{
145
        #define LINE_MAX 32
144
        #define LINE_MAX 32
146
        File_t *fp;
145
        File_t *fp;
147
        s8 settingsline[LINE_MAX];
146
        s8 settingsline[LINE_MAX];
148
        s8 *name, *value;
147
        s8 *name, *value;
149
        u8 i;
148
        u8 i;
150
        s8 filename[] = "settings.ini";
149
        s8 filename[] = "settings.ini";
151
 
150
 
152
        UART1_PutString("\n\r Settings init...");
151
        UART1_PutString("\n\r Settings init...");
153
        Settings_SetDefaultValues();
152
        Settings_SetDefaultValues();
154
 
153
 
155
        if(Fat16_IsValid())
154
        if(Fat16_IsValid())
156
        {       // check if settings file is existing
155
        {       // check if settings file is existing
157
                if(fexist_(filename))
156
                if(fexist_(filename))
158
                {
157
                {
159
                        fp = fopen_(filename, 'r');             // try to open the file
158
                        fp = fopen_(filename, 'r');             // try to open the file
160
                        if (fp == NULL)                                                 // could not open the file
159
                        if (fp == NULL)                                                 // could not open the file
161
                        {
160
                        {
162
                                UART1_PutString("ERROR: Opening settings file!");
161
                                UART1_PutString("ERROR: Opening settings file!");
163
                                return;
162
                                return;
164
                        }
163
                        }
165
                        // read all lines from file
164
                        // read all lines from file
166
                        while(fgets_(settingsline, LINE_MAX, fp) != 0)
165
                        while(fgets_(settingsline, LINE_MAX, fp) != 0)
167
                        {
166
                        {
168
                                if ( // ignorelines starting with \r,\n,' ',';','#'
167
                                if ( // ignorelines starting with \r,\n,' ',';','#'
169
                                        (settingsline[0] != '\n') &&
168
                                        (settingsline[0] != '\n') &&
170
                                        (settingsline[0] != '\r') &&
169
                                        (settingsline[0] != '\r') &&
171
                                        (settingsline[0] != ' ' ) &&
170
                                        (settingsline[0] != ' ' ) &&
172
                                        (settingsline[0] != ';' ) &&
171
                                        (settingsline[0] != ';' ) &&
173
                                        (settingsline[0] != '#' )
172
                                        (settingsline[0] != '#' )
174
                                        )
173
                                        )
175
                                {
174
                                {
176
                                        name  = strtok(settingsline, "="); // get name
175
                                        name  = strtok(settingsline, "="); // get name
177
                                        value = strtok(NULL, "="); // get value
176
                                        value = strtok(NULL, "="); // get value
178
                                        if ((name != NULL) && (value != NULL))
177
                                        if ((name != NULL) && (value != NULL))
179
                                        {
178
                                        {
180
                                                u8 i;
179
                                                u8 i;
181
                                                for(i=0; name[i]; i++) name[i] = toupper(name[i]);
180
                                                for(i=0; name[i]; i++) name[i] = toupper(name[i]);
182
                                                Settings_SetParameterFromString(name, value);
181
                                                Settings_SetParameterFromString(name, value);
183
                                        }
182
                                        }
184
                                }
183
                                }
185
                        }
184
                        }
186
                        fclose_(fp);
185
                        fclose_(fp);
187
                        UART1_PutString("ok");
186
                        UART1_PutString("ok");
188
                        return;
187
                        return;
189
                }
188
                }
190
                else // settings file does not exist
189
                else // settings file does not exist
191
                {       // create default settings file
190
                {       // create default settings file
192
                        fp = fopen_("settings.ini", 'w');               // try to open the file
191
                        fp = fopen_("settings.ini", 'w');               // try to open the file
193
                        if(fp == NULL)
192
                        if(fp == NULL)
194
                        {
193
                        {
195
                                UART1_PutString("ERROR: Creating default settings file!");
194
                                UART1_PutString("ERROR: Creating default settings file!");
196
                                return;
195
                                return;
197
                        }
196
                        }
198
                        // run thrue all parameters and set value to default
197
                        // run thrue all parameters and set value to default
199
                        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
198
                        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
200
                        {
199
                        {
201
                                sprintf(settingsline, "%s = %d\r\n", CFG_Parameter[i].Name, CFG_Parameter[i].Default);
200
                                sprintf(settingsline, "%s = %d\r\n", CFG_Parameter[i].Name, CFG_Parameter[i].Default);
202
                                fputs_(settingsline, fp); // write to file
201
                                fputs_(settingsline, fp); // write to file
203
                        }
202
                        }
204
                        fputs_("\r\n", fp); // newline at the end of file
203
                        fputs_("\r\n", fp); // newline at the end of file
205
                        fclose_(fp);
204
                        fclose_(fp);
206
                        UART1_PutString("Default settings file created!");
205
                        UART1_PutString("Default settings file created!");
207
                        return;
206
                        return;
208
                }
207
                }
209
        }
208
        }
210
        else // no acces to fat 16 filesystem
209
        else // no acces to fat 16 filesystem
211
        {
210
        {
212
                UART1_PutString("Using default values!");
211
                UART1_PutString("Using default values!");
213
                return;
212
                return;
214
        }
213
        }
215
}
214
}
216
 
215
 
217
 
216
 
218
//----------------------------------------------------------------------------------
217
//----------------------------------------------------------------------------------
219
// read value of a paramter identified by its id
218
// read value of a paramter identified by its id
220
// returns 1 on success and 0 on error
219
// returns 1 on success and 0 on error
221
u8 Settings_GetParamValue(ParamId_t Pid, u16 * pValue)
220
u8 Settings_GetParamValue(ParamId_t Pid, u16 * pValue)
222
{
221
{
223
        u8 i, retval = 0;
222
        u8 i, retval = 0;
224
 
223
 
225
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
224
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
226
        {
225
        {
227
                if(CFG_Parameter[i].ParamId == Pid)
226
                if(CFG_Parameter[i].ParamId == Pid)
228
                {
227
                {
229
                        *pValue = CFG_Parameter[i].Value;
228
                        *pValue = CFG_Parameter[i].Value;
230
                        retval = 1;
229
                        retval = 1;
231
                        break;
230
                        break;
232
                }
231
                }
233
        }
232
        }
234
        return retval;
233
        return retval;
235
}
234
}
236
 
235