Subversion Repositories NaviCtrl

Rev

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

Rev 247 Rev 351
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
5
// + Copyright (c) 2008 Ingo Busker, Holger Buss
6
// + Nur für den privaten Gebrauch / NON-COMMERCIAL USE ONLY
6
// + Nur für den privaten Gebrauch / NON-COMMERCIAL USE ONLY
7
// + FOR NON COMMERCIAL USE ONLY
7
// + FOR NON COMMERCIAL USE ONLY
8
// + www.MikroKopter.com
8
// + www.MikroKopter.com
9
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
9
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
10
// + Es gilt für das gesamte Projekt (Hardware, Software, Binärfiles, Sourcecode und Dokumentation),
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.
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
12
// + Sollten direkte oder indirekte kommerzielle Absichten verfolgt werden, ist mit uns (info@mikrokopter.de) Kontakt
13
// + bzgl. der Nutzungsbedingungen aufzunehmen.
13
// + bzgl. der Nutzungsbedingungen aufzunehmen.
14
// + Eine kommerzielle Nutzung ist z.B.Verkauf von MikroKoptern, Bestückung und Verkauf von Platinen oder Bausätzen,
14
// + Eine kommerzielle Nutzung ist z.B.Verkauf von MikroKoptern, Bestückung und Verkauf von Platinen oder Bausätzen,
15
// + Verkauf von Luftbildaufnahmen, usw.
15
// + Verkauf von Luftbildaufnahmen, usw.
16
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
16
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
17
// + Werden Teile des Quellcodes (mit oder ohne Modifikation) weiterverwendet oder veröffentlicht,
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
18
// + unterliegen sie auch diesen Nutzungsbedingungen und diese Nutzungsbedingungen incl. Copyright müssen dann beiliegen
19
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
19
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
20
// + Sollte die Software (auch auszugesweise) oder sonstige Informationen des MikroKopter-Projekts
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"
21
// + auf anderen Webseiten oder sonstigen Medien veröffentlicht werden, muss unsere Webseite "http://www.mikrokopter.de"
22
// + eindeutig als Ursprung verlinkt werden
22
// + eindeutig als Ursprung verlinkt werden
23
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
23
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
24
// + Keine Gewähr auf Fehlerfreiheit, Vollständigkeit oder Funktion
24
// + Keine Gewähr auf Fehlerfreiheit, Vollständigkeit oder Funktion
25
// + Benutzung auf eigene Gefahr
25
// + Benutzung auf eigene Gefahr
26
// + Wir übernehmen keinerlei Haftung für direkte oder indirekte Personen- oder Sachschäden
26
// + Wir übernehmen keinerlei Haftung für direkte oder indirekte Personen- oder Sachschäden
27
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
27
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
28
// + Die Portierung oder Nutzung der Software (oder Teile davon) auf andere Systeme (ausser der Hardware von www.mikrokopter.de) ist nur
28
// + Die Portierung oder Nutzung der Software (oder Teile davon) auf andere Systeme (ausser der Hardware von www.mikrokopter.de) ist nur
29
// + mit unserer Zustimmung zulässig
29
// + mit unserer Zustimmung zulässig
30
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
30
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
31
// + Die Funktion printf_P() unterliegt ihrer eigenen Lizenz und ist hiervon nicht betroffen
31
// + Die Funktion printf_P() unterliegt ihrer eigenen Lizenz und ist hiervon nicht betroffen
32
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
32
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
33
// + Redistributions of source code (with or without modifications) must retain the above copyright notice,
33
// + Redistributions of source code (with or without modifications) must retain the above copyright notice,
34
// + this list of conditions and the following disclaimer.
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
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.
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
37
// +   * The use of this project (hardware, software, binary files, sources and documentation) is only permitted
38
// +     for non-commercial use (directly or indirectly)
38
// +     for non-commercial use (directly or indirectly)
39
// +     Commercial use (for excample: selling of MikroKopters, selling of PCBs, assembly, ...) is only permitted
39
// +     Commercial use (for excample: selling of MikroKopters, selling of PCBs, assembly, ...) is only permitted
40
// +     with our written permission
40
// +     with our written permission
41
// +   * If sources or documentations are redistributet on other webpages, out webpage (http://www.MikroKopter.de) must be
41
// +   * If sources or documentations are redistributet on other webpages, out webpage (http://www.MikroKopter.de) must be
42
// +     clearly linked as origin
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
43
// +   * porting the sources to other systems or using the software on other systems (except hardware from www.mikrokopter.de) is not allowed
44
//
44
//
45
// +  THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
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
46
// +  AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
47
// +  IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
47
// +  IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
48
// +  ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
48
// +  ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
49
// +  LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
49
// +  LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
50
// +  CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
50
// +  CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
51
// +  SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
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
52
// +  INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
53
// +  CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
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
54
// +  ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
55
// +  POSSIBILITY OF SUCH DAMAGE.
55
// +  POSSIBILITY OF SUCH DAMAGE.
56
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
56
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
57
#include <ctype.h>
57
#include <ctype.h>
58
#include <stdio.h>
58
#include <stdio.h>
59
#include <stdlib.h>
59
#include <stdlib.h>
60
#include <string.h>
60
#include <string.h>
61
#include "91x_lib.h"
61
#include "91x_lib.h"
62
#include "fat16.h"
62
#include "fat16.h"
63
#include "settings.h"
63
#include "settings.h"
64
#include "uart1.h"
64
#include "uart1.h"
65
 
65
 
66
typedef struct
66
typedef struct
67
{
67
{
68
        ParamId_t ParamId;
68
        ParamId_t ParamId;
69
        s8  Name[17]; // 0 terminator is the last byte
69
        s8  Name[17]; // 0 terminator is the last byte
70
        u8  Group;   // 0 = reserved  1,2,3,4
70
        u8  Group;   // 0 = reserved  1,2,3,4
71
        u16 Value;
71
        u16 Value;
72
        u16 Default;
72
        u16 Default;
73
        u16 Min;
73
        u16 Min;
74
        u16 Max;
74
        u16 Max;
75
} __attribute__((packed)) Parameter_t;
75
} __attribute__((packed)) Parameter_t;
76
 
76
 
77
Parameter_t CFG_Parameter[] =
77
Parameter_t CFG_Parameter[] =
78
{
78
{
79
  //{PID               , "1234567890123456" , Group, Value, Default,   Min,     Max },
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
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
81
        {PID_GPX_LOGGING                        , "GPXLOGGING      " ,     1,  1000,    1000,    0,     60000},   // the log interval for GPX logging, 0 = off
-
 
82
        {PID_ABSOLUTE_FLYING_RANGE      , "MAX_FLYING_RANGE" ,     1,     0,       0,    0,     60000},   // 
-
 
83
        {PID_AUTO_DESCEND_RANGE         , "DESCEND_RANGE   " ,     1,     0,       0,    0,     60000},   // 
82
        {PID_GPS_AUTOCONFIG, "GPSAUTOCONFIG   " ,     1,     1,       1,    0,      1}
84
        {PID_GPS_AUTOCONFIG                     , "GPSAUTOCONFIG   " ,     1,     1,       1,    0,             1}
83
};
85
};
84
 
86
 
85
 
87
 
86
//----------------------------------------------------------------------------------
88
//----------------------------------------------------------------------------------
87
// initialize all parameters by its default value
89
// initialize all parameters by its default value
88
void Settings_SetDefaultValues(void)
90
void Settings_SetDefaultValues(void)
89
{
91
{
90
        u8 i;
92
        u8 i;
91
        // run thrue all parameters and set value to default
93
        // run thrue all parameters and set value to default
92
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
94
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
93
        {
95
        {
94
                CFG_Parameter[i].Value  = CFG_Parameter[i].Default;
96
                CFG_Parameter[i].Value  = CFG_Parameter[i].Default;
95
        }
97
        }
96
}
98
}
97
 
99
 
98
//----------------------------------------------------------------------------------
100
//----------------------------------------------------------------------------------
99
// set parameter from string based name and value
101
// set parameter from string based name and value
100
u8 Settings_SetParameterFromString(s8 *name, s8 *value)
102
u8 Settings_SetParameterFromString(s8 *name, s8 *value)
101
{
103
{
102
        u8 i, retval = 0;
104
        u8 i, retval = 0;
103
        s8 string[] = "                \0"; // null terminated string of 16 characters
105
        s8 string[] = "                \0"; // null terminated string of 16 characters
104
 
106
 
105
        if((name == NULL) || (value == NULL)) return(retval);
107
        if((name == NULL) || (value == NULL)) return(retval);
106
 
108
 
107
        i = strlen(name);                                       // lenght of the parameter name
109
        i = strlen(name);                                       // lenght of the parameter name
108
        if (i > 16) i = 16;                                     // cut off at 16
110
        if (i > 16) i = 16;                                     // cut off at 16
109
 
111
 
110
        memcpy(string, name, i);                        // copy name to local buffer
112
        memcpy(string, name, i);                        // copy name to local buffer
111
 
113
 
112
    // search name in parameter list
114
    // search name in parameter list
113
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
115
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
114
        {
116
        {
115
                if(strncmp(string, CFG_Parameter[i].Name, 16) == 0) // names are matching
117
                if(strncmp(string, CFG_Parameter[i].Name, 16) == 0) // names are matching
116
                {
118
                {
117
                        CFG_Parameter[i].Value = (u16)atoi(value); // convert string to number and set value
119
                        CFG_Parameter[i].Value = (u16)atoi(value); // convert string to number and set value
118
                        // out of range ?
120
                        // out of range ?
119
                        if((CFG_Parameter[i].Value < CFG_Parameter[i].Min) || (CFG_Parameter[i].Value > CFG_Parameter[i].Max))
121
                        if((CFG_Parameter[i].Value < CFG_Parameter[i].Min) || (CFG_Parameter[i].Value > CFG_Parameter[i].Max))
120
                        {       // print a warning
122
                        {       // print a warning
121
                                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);
123
                                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);
122
                                UART1_PutString(text);
124
                                UART1_PutString(text);
123
                                CFG_Parameter[i].Value = CFG_Parameter[i].Default;  // fallback to default
125
                                CFG_Parameter[i].Value = CFG_Parameter[i].Default;  // fallback to default
124
                        }
126
                        }
125
                        retval = 1; // value in range
127
                        retval = 1; // value in range
126
                        break; // end loop
128
                        break; // end loop
127
                }
129
                }
128
        }
130
        }
129
        if(!retval)
131
        if(!retval)
130
        {
132
        {
131
                sprintf(text,"\r\n%s <-- unknown parameter\r\n", string);
133
                sprintf(text,"\r\n%s <-- unknown parameter\r\n", string);
132
                UART1_PutString(text);
134
                UART1_PutString(text);
133
        }
135
        }
134
        return(retval);
136
        return(retval);
135
}
137
}
136
 
138
 
137
//----------------------------------------------------------------------------------
139
//----------------------------------------------------------------------------------
138
// read settings from file on sd-card
140
// read settings from file on sd-card
139
void Settings_Init(void)
141
void Settings_Init(void)
140
{
142
{
141
        #define LINE_MAX 32
143
        #define LINE_MAX 32
142
        File_t *fp;
144
        File_t *fp;
143
        s8 settingsline[LINE_MAX];
145
        s8 settingsline[LINE_MAX];
144
        s8 *name, *value;
146
        s8 *name, *value;
145
        u8 i;
147
        u8 i;
146
        s8 filename[] = "settings.ini";
148
        s8 filename[] = "settings.ini";
147
 
149
 
148
        UART1_PutString("\n\r Settings init...");
150
        UART1_PutString("\n\r Settings init...");
149
        Settings_SetDefaultValues();
151
        Settings_SetDefaultValues();
150
 
152
 
151
        if(Fat16_IsValid())
153
        if(Fat16_IsValid())
152
        {       // check if settings file is existing
154
        {       // check if settings file is existing
153
                if(fexist_(filename))
155
                if(fexist_(filename))
154
                {
156
                {
155
                        fp = fopen_(filename, 'r');             // try to open the file
157
                        fp = fopen_(filename, 'r');             // try to open the file
156
                        if (fp == NULL)                                                 // could not open the file
158
                        if (fp == NULL)                                                 // could not open the file
157
                        {
159
                        {
158
                                UART1_PutString("ERROR: Opening settings file!");
160
                                UART1_PutString("ERROR: Opening settings file!");
159
                                return;
161
                                return;
160
                        }
162
                        }
161
                        // read all lines from file
163
                        // read all lines from file
162
                        while(fgets_(settingsline, LINE_MAX, fp) != 0)
164
                        while(fgets_(settingsline, LINE_MAX, fp) != 0)
163
                        {
165
                        {
164
                                if ( // ignorelines starting with \r,\n,' ',';','#'
166
                                if ( // ignorelines starting with \r,\n,' ',';','#'
165
                                        (settingsline[0] != '\n') &&
167
                                        (settingsline[0] != '\n') &&
166
                                        (settingsline[0] != '\r') &&
168
                                        (settingsline[0] != '\r') &&
167
                                        (settingsline[0] != ' ' ) &&
169
                                        (settingsline[0] != ' ' ) &&
168
                                        (settingsline[0] != ';' ) &&
170
                                        (settingsline[0] != ';' ) &&
169
                                        (settingsline[0] != '#' )
171
                                        (settingsline[0] != '#' )
170
                                        )
172
                                        )
171
                                {
173
                                {
172
                                        name  = strtok(settingsline, "="); // get name
174
                                        name  = strtok(settingsline, "="); // get name
173
                                        value = strtok(NULL, "="); // get value
175
                                        value = strtok(NULL, "="); // get value
174
                                        if ((name != NULL) && (value != NULL))
176
                                        if ((name != NULL) && (value != NULL))
175
                                        {
177
                                        {
176
                                                u8 i;
178
                                                u8 i;
177
                                                for(i=0; name[i]; i++) name[i] = toupper(name[i]);
179
                                                for(i=0; name[i]; i++) name[i] = toupper(name[i]);
178
                                                Settings_SetParameterFromString(name, value);
180
                                                Settings_SetParameterFromString(name, value);
179
                                        }
181
                                        }
180
                                }
182
                                }
181
                        }
183
                        }
182
                        fclose_(fp);
184
                        fclose_(fp);
183
                        UART1_PutString("ok");
185
                        UART1_PutString("ok");
184
                        return;
186
                        return;
185
                }
187
                }
186
                else // settings file does not exist
188
                else // settings file does not exist
187
                {       // create default settings file
189
                {       // create default settings file
188
                        fp = fopen_("settings.ini", 'w');               // try to open the file
190
                        fp = fopen_("settings.ini", 'w');               // try to open the file
189
                        if(fp == NULL)
191
                        if(fp == NULL)
190
                        {
192
                        {
191
                                UART1_PutString("ERROR: Creating default settings file!");
193
                                UART1_PutString("ERROR: Creating default settings file!");
192
                                return;
194
                                return;
193
                        }
195
                        }
194
                        // run thrue all parameters and set value to default
196
                        // run thrue all parameters and set value to default
195
                        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
197
                        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
196
                        {
198
                        {
197
                                sprintf(settingsline, "%s = %d\r\n", CFG_Parameter[i].Name, CFG_Parameter[i].Default);
199
                                sprintf(settingsline, "%s = %d\r\n", CFG_Parameter[i].Name, CFG_Parameter[i].Default);
198
                                fputs_(settingsline, fp); // write to file
200
                                fputs_(settingsline, fp); // write to file
199
                        }
201
                        }
200
                        fputs_("\r\n", fp); // newline at the end of file
202
                        fputs_("\r\n", fp); // newline at the end of file
201
                        fclose_(fp);
203
                        fclose_(fp);
202
                        UART1_PutString("Default settings file created!");
204
                        UART1_PutString("Default settings file created!");
203
                        return;
205
                        return;
204
                }
206
                }
205
        }
207
        }
206
        else // no acces to fat 16 filesystem
208
        else // no acces to fat 16 filesystem
207
        {
209
        {
208
                UART1_PutString("Using default values!");
210
                UART1_PutString("Using default values!");
209
                return;
211
                return;
210
        }
212
        }
211
}
213
}
212
 
214
 
213
 
215
 
214
//----------------------------------------------------------------------------------
216
//----------------------------------------------------------------------------------
215
// read value of a paramter identified by its id
217
// read value of a paramter identified by its id
216
// returns 1 on success and 0 on error
218
// returns 1 on success and 0 on error
217
u8 Settings_GetParamValue(ParamId_t Pid, u16 * pValue)
219
u8 Settings_GetParamValue(ParamId_t Pid, u16 * pValue)
218
{
220
{
219
        u8 i, retval = 0;
221
        u8 i, retval = 0;
220
 
222
 
221
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
223
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
222
        {
224
        {
223
                if(CFG_Parameter[i].ParamId == Pid)
225
                if(CFG_Parameter[i].ParamId == Pid)
224
                {
226
                {
225
                        *pValue = CFG_Parameter[i].Value;
227
                        *pValue = CFG_Parameter[i].Value;
226
                        retval = 1;
228
                        retval = 1;
227
                        break;
229
                        break;
228
                }
230
                }
229
        }
231
        }
230
        return retval;
232
        return retval;
231
}
233
}
232
 
234