Subversion Repositories NaviCtrl

Rev

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

Rev 88 Rev 89
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
6
// + Nur für den privaten Gebrauch
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 der Software (oder Teile davon) auf andere Systeme (ausser der Hardware von www.mikrokopter.de) ist nur
28
// + Die PORTIERUNG 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 this software (or part of it) to systems (other than hardware from www.mikrokopter.de) is NOT allowed
43
// +   * PORTING this software (or part of it) to systems (other than 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 <stdio.h>
57
#include <stdio.h>
58
#include <stdlib.h>
58
#include <stdlib.h>
59
#include <string.h>
59
#include <string.h>
60
#include "91x_lib.h"
60
#include "91x_lib.h"
61
#include "fat16.h"
61
#include "fat16.h"
62
#include "settings.h"
62
#include "settings.h"
63
#include "uart1.h"
63
#include "uart1.h"
64
 
64
 
65
typedef struct
65
typedef struct
66
{
66
{
67
        ParamId_t ParamId;
67
        ParamId_t ParamId;
68
        s8  Name[16];
68
        s8  Name[16];
69
        u8  Group;   // 0 = reserved  1,2,3,4
69
        u8  Group;   // 0 = reserved  1,2,3,4
70
        u16 Value;
70
        u16 Value;
71
        u16 Default;
71
        u16 Default;
72
        u16 Min;
72
        u16 Min;
73
        u16 Max;
73
        u16 Max;
74
} __attribute__((packed)) Parameter_t;
74
} __attribute__((packed)) Parameter_t;
75
 
75
 
76
Parameter_t CFG_Parameter[] =
76
Parameter_t CFG_Parameter[] =
77
{
77
{
78
  //{PID             , "1234567890123456" , Group, Value, Default,   Min,       Max },
78
  //{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
79
        {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
80
        {PID_GPX_LOGGING , "GPXLogging      " ,     1,     0,       0,          0,      60000}   // the log interval for GPX logging, 0 = off
81
};
81
};
82
 
82
 
83
 
83
 
84
//----------------------------------------------------------------------------------
84
//----------------------------------------------------------------------------------
85
// initialize all parameters by its default value
85
// initialize all parameters by its default value
86
void Settings_SetDefaultValues(void)
86
void Settings_SetDefaultValues(void)
87
{
87
{
88
        u8 i;
88
        u8 i;
89
        // run thrue all parameters and set value to default
89
        // run thrue all parameters and set value to default
90
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
90
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
91
        {
91
        {
92
                CFG_Parameter[i].Value  = CFG_Parameter[i].Default;
92
                CFG_Parameter[i].Value  = CFG_Parameter[i].Default;
93
        }
93
        }
94
}
94
}
95
 
95
 
96
//----------------------------------------------------------------------------------
96
//----------------------------------------------------------------------------------
97
// set parameter from string based name and value
97
// set parameter from string based name and value
98
void Settings_SetParameterFromString(s8 *name, s8 *value)
98
void Settings_SetParameterFromString(s8 *name, s8 *value)
99
{
99
{
100
        u8 i;
100
        u8 i;
101
        s8 string[] = "                \0"; // null terminated string of 16 characters
101
        s8 string[] = "                \0"; // null terminated string of 16 characters
-
 
102
        s8 text[32];
102
 
103
 
103
        i = strlen(name);                                       // lenght of the parameter name
104
        i = strlen(name);                                       // lenght of the parameter name
104
        if (i > 16) i = 16;                                     // cut off at 16
105
        if (i > 16) i = 16;                                     // cut off at 16
105
 
106
 
106
        memcpy(string, name, i);                        // copy name to local buffer
107
        memcpy(string, name, i);                        // copy name to local buffer
107
        //sprintf(text,"#%s#%s#\n\r", name, string);  SerialPutString(text);
108
        //sprintf(text,"#%s#%s#\n\r", name, string);  SerialPutString(text);
108
 
109
 
109
    // search name in parameter list
110
    // search name in parameter list
110
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
111
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
111
        {
112
        {
112
                //sprintf(text,"#%s#\n\r", CFG_Parameter[i].Name);    SerialPutString(text);
113
                //sprintf(text,"#%s#\n\r", CFG_Parameter[i].Name);    SerialPutString(text);
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
                        // range within min/max
117
                        // range within min/max
117
                        if(CFG_Parameter[i].Value < CFG_Parameter[i].Min) CFG_Parameter[i].Value = CFG_Parameter[i].Min;
118
                        if(CFG_Parameter[i].Value < CFG_Parameter[i].Min) CFG_Parameter[i].Value = CFG_Parameter[i].Min;
118
 
119
 
119
                        //sprintf(text,"%s = %d\n\r", string, CFG_Parameter[i].Value);
120
                        sprintf(text,"\r\n%s = %d", string, CFG_Parameter[i].Value);
120
                        //SerialPutString(text);
121
                        SerialPutString(text);
121
                        break; // end loop
122
                        break; // end loop
122
                }
123
                }
123
        }
124
        }
124
}
125
}
125
 
126
 
126
//----------------------------------------------------------------------------------
127
//----------------------------------------------------------------------------------
127
// read settings from file on sd-card
128
// read settings from file on sd-card
128
void Settings_Init(void)
129
void Settings_Init(void)
129
{
130
{
130
        #define LINE_MAX 32
131
        #define LINE_MAX 32
131
        File_t *fp;
132
        File_t *fp;
132
        u8 text[LINE_MAX];
133
        s8 text[LINE_MAX];
133
        u8 *token;
134
        s8 *name, *value;
134
 
135
 
135
        Settings_SetDefaultValues();
136
        Settings_SetDefaultValues();
136
        SerialPutString("\n\rReading settings from file...\n\r");
137
        SerialPutString("\n\rReading settings from file...");
137
        fp = fopen_("settings.ini", 'r');
138
        fp = fopen_("settings.ini", 'r');
138
 
139
 
139
        if (fp == NULL) // could not open the file
140
        if (fp == NULL) // could not open the file
140
        {
141
        {
141
                SerialPutString("ERROR: File not found !");
142
                SerialPutString("ERROR: File not found !");
142
                return;
143
                return;
143
        }
144
        }
144
 
-
 
145
        // read all lines from file
145
        // read all lines from file
146
        while(fgets_(text, LINE_MAX, fp) != NULL)
146
        while(fgets_(text, LINE_MAX, fp) != 0)
147
        {
147
        {
148
                if ( // ignorelines starting with \r,\n,' ',';','#'
148
                if ( // ignorelines starting with \r,\n,' ',';','#'
149
                        (text[0] != '\n') &&
149
                        (text[0] != '\n') &&
150
                        (text[0] != '\r') &&
150
                        (text[0] != '\r') &&
151
                        (text[0] != ' ' ) &&
151
                        (text[0] != ' ' ) &&
152
                        (text[0] != ';' ) &&
152
                        (text[0] != ';' ) &&
153
                        (text[0] != '#' )
153
                        (text[0] != '#' )
154
                        )
154
                        )
155
                {
155
                {
156
                        token = strtok(text, "="); //find the '='
156
                        name  = strtok(text, "="); // get name
-
 
157
                        value = strtok(NULL, "="); // get value
157
                        if (token != NULL) // if '=' has been found
158
                        if ((name != NULL) && (value != NULL)) // if '=' has been found
158
                        {
159
                        {
159
                          //SerialPutString(token);SerialPutString(" --> ");
-
 
160
                  Settings_SetParameterFromString(token, strtok(NULL, "="));
160
                                Settings_SetParameterFromString(name, value);
161
                          //SerialPutString("\n\r");
-
 
162
                        }
161
                        }
163
                }
162
                }
164
        }
163
        }
-
 
164
 
165
        fclose_(fp);
165
        fclose_(fp);
166
        SerialPutString("ok");
166
        SerialPutString("ok");
167
}
167
}
168
 
168
 
169
 
169
 
170
//----------------------------------------------------------------------------------
170
//----------------------------------------------------------------------------------
171
// read value of a paramter identified by its id
171
// read value of a paramter identified by its id
172
// returns 1 on success and 0 on error
172
// returns 1 on success and 0 on error
173
u8 Settings_GetParamValue(ParamId_t Pid, u16 * pValue)
173
u8 Settings_GetParamValue(ParamId_t Pid, u16 * pValue)
174
{
174
{
175
        u8 i, retval = 0;
175
        u8 i, retval = 0;
176
 
176
 
177
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
177
        for (i = 0; i < sizeof(CFG_Parameter) / sizeof(Parameter_t); i++)
178
        {
178
        {
179
                if(CFG_Parameter[i].ParamId == Pid)
179
                if(CFG_Parameter[i].ParamId == Pid)
180
                {
180
                {
181
                        *pValue = CFG_Parameter[i].Value;
181
                        *pValue = CFG_Parameter[i].Value;
182
                        retval = 1;
182
                        retval = 1;
183
                        break;
183
                        break;
184
                }
184
                }
185
        }
185
        }
186
        return retval;
186
        return retval;
187
}
187
}
188
 
188