Subversion Repositories NaviCtrl

Rev

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

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