Subversion Repositories NaviCtrl

Rev

Rev 254 | Rev 267 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1 ingob 1
/*#######################################################################################*/
2
/* !!! THIS IS NOT FREE SOFTWARE !!!                                                     */
3
/*#######################################################################################*/
4
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
5
// + Copyright (c) 2008 Ingo Busker, Holger Buss
171 ingob 6
// + Nur für den privaten Gebrauch / NON-COMMERCIAL USE ONLY
1 ingob 7
// + FOR NON COMMERCIAL USE ONLY
8
// + www.MikroKopter.com
9
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
41 ingob 10
// + Es gilt für das gesamte Projekt (Hardware, Software, Binärfiles, Sourcecode und Dokumentation),
11
// + dass eine Nutzung (auch auszugsweise) nur für den privaten (nicht-kommerziellen) Gebrauch zulässig ist.
12
// + Sollten direkte oder indirekte kommerzielle Absichten verfolgt werden, ist mit uns (info@mikrokopter.de) Kontakt
13
// + bzgl. der Nutzungsbedingungen aufzunehmen.
1 ingob 14
// + Eine kommerzielle Nutzung ist z.B.Verkauf von MikroKoptern, Bestückung und Verkauf von Platinen oder Bausätzen,
15
// + Verkauf von Luftbildaufnahmen, usw.
16
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
41 ingob 17
// + Werden Teile des Quellcodes (mit oder ohne Modifikation) weiterverwendet oder veröffentlicht,
1 ingob 18
// + unterliegen sie auch diesen Nutzungsbedingungen und diese Nutzungsbedingungen incl. Copyright müssen dann beiliegen
19
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
20
// + Sollte die Software (auch auszugesweise) oder sonstige Informationen des MikroKopter-Projekts
21
// + auf anderen Webseiten oder sonstigen Medien veröffentlicht werden, muss unsere Webseite "http://www.mikrokopter.de"
22
// + eindeutig als Ursprung verlinkt werden
23
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
24
// + Keine Gewähr auf Fehlerfreiheit, Vollständigkeit oder Funktion
25
// + Benutzung auf eigene Gefahr
26
// + Wir übernehmen keinerlei Haftung für direkte oder indirekte Personen- oder Sachschäden
27
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
171 ingob 28
// + Die Portierung oder Nutzung der Software (oder Teile davon) auf andere Systeme (ausser der Hardware von www.mikrokopter.de) ist nur
1 ingob 29
// + mit unserer Zustimmung zulässig
30
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
31
// + Die Funktion printf_P() unterliegt ihrer eigenen Lizenz und ist hiervon nicht betroffen
32
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
41 ingob 33
// + Redistributions of source code (with or without modifications) must retain the above copyright notice,
1 ingob 34
// + this list of conditions and the following disclaimer.
35
// +   * Neither the name of the copyright holders nor the names of contributors may be used to endorse or promote products derived
36
// +     from this software without specific prior written permission.
41 ingob 37
// +   * The use of this project (hardware, software, binary files, sources and documentation) is only permitted
1 ingob 38
// +     for non-commercial use (directly or indirectly)
41 ingob 39
// +     Commercial use (for excample: selling of MikroKopters, selling of PCBs, assembly, ...) is only permitted
1 ingob 40
// +     with our written permission
41 ingob 41
// +   * If sources or documentations are redistributet on other webpages, out webpage (http://www.MikroKopter.de) must be
42
// +     clearly linked as origin
171 ingob 43
// +   * porting the sources to other systems or using the software on other systems (except hardware from www.mikrokopter.de) is not allowed
1 ingob 44
//
45
// +  THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
46
// +  AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
47
// +  IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
48
// +  ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
49
// +  LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
50
// +  CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
51
// +  SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
52
// +  INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
53
// +  CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
54
// +  ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
41 ingob 55
// +  POSSIBILITY OF SUCH DAMAGE.
1 ingob 56
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
41 ingob 57
#include <stdlib.h>
58
#include "91x_lib.h"
1 ingob 59
#include "main.h"
264 killagreg 60
#include "led.h"
41 ingob 61
#include "ubx.h"
62
#include "GPS.h"
119 killagreg 63
#include "timer1.h"
242 killagreg 64
#include "compass.h"
41 ingob 65
#include "spi_slave.h"
66
#include "menu.h"
67
#include "uart1.h"
1 ingob 68
 
69
u8 DispPtr = 0;
201 killagreg 70
s8 DisplayBuff[DISPLAYBUFFSIZE];
1 ingob 71
 
201 killagreg 72
 
41 ingob 73
u8 MenuItem = 0;
190 killagreg 74
u8 MaxMenuItem = 15;
41 ingob 75
 
203 killagreg 76
 
77
 
78
void Menu_Putchar(char c)
79
{
80
   if(DispPtr < DISPLAYBUFFSIZE) DisplayBuff[DispPtr++] = c; ;
81
}
82
 
201 killagreg 83
void Menu_Clear(void)
1 ingob 84
{
201 killagreg 85
        u8 i;
86
        for( i = 0; i < DISPLAYBUFFSIZE; i++) DisplayBuff[i] = ' ';
1 ingob 87
}
88
 
24 StephanB 89
 
41 ingob 90
// Display with 20 characters in 4 lines
201 killagreg 91
void Menu_Update(u8 Keys)
41 ingob 92
{
93
        s32 i1,i2;
51 killagreg 94
        u8 sign;
41 ingob 95
 
201 killagreg 96
        if(Keys & KEY1) { if(MenuItem > 0) MenuItem--; else MenuItem = MaxMenuItem;}
97
        if(Keys & KEY2) { if(MenuItem == MaxMenuItem) MenuItem = 0; else MenuItem++;}
98
        if((Keys & KEY1) && (Keys & KEY2)) MenuItem = 0;
41 ingob 99
        if(MenuItem > MaxMenuItem) MenuItem = MaxMenuItem;
201 killagreg 100
        Menu_Clear();
41 ingob 101
        // print menu item number in the upper right corner
102
        if(MenuItem < 10)
103
        {
104
                LCD_printfxy(17,0,"[%i]",MenuItem);
105
        }
201 killagreg 106
        else // Menuitem >= 10
41 ingob 107
        {
108
                LCD_printfxy(16,0,"[%i]",MenuItem);
109
        }
110
 
111
        switch(MenuItem)
112
        {
113
                // Version Info
114
                case 0:
115
                        LCD_printfxy(0,0,"++  Navi-Ctrl  ++");
264 killagreg 116
                        LCD_printfxy(0,1,"HW V%d.%d SW V%d.%d%c", Version_HW/10, Version_HW%10, VERSION_MAJOR, VERSION_MINOR, 'a'+ VERSION_PATCH);
117
            if(ErrorCode)
118
                        {
119
                                LCD_printfxy(0,2,"Error: %d",ErrorCode);
120
                LCD_printfxy(0,3,"%s",ErrorMSG);
121
                        }
122
                        else LCD_printfxy(0,3,"(c) Buss, Busker");
41 ingob 123
                        break;
124
                case 1:
125
                        if (GPSData.Status == INVALID)
126
                        {
127
                                LCD_printfxy(0,0,"No GPS data");
128
                                LCD_printfxy(0,1,"Lon:                ");
129
                                LCD_printfxy(0,2,"Lat:                ");
130
                                LCD_printfxy(0,3,"Alt:                ");
131
                        }
132
                        else // newdata or processed
133
                        {
122 killagreg 134
                                LCD_printfxy(0,0,"Sat:%02d ", GPSData.NumOfSats);
41 ingob 135
                                switch (GPSData.SatFix)
136
                                {
137
                                case SATFIX_NONE:
127 killagreg 138
                                        LCD_printfxy(7,0,"NoFix");
41 ingob 139
                                        break;
140
                                case SATFIX_2D:
127 killagreg 141
                                        LCD_printfxy(7,0,"2DFix");
41 ingob 142
                                        break;
143
                                case SATFIX_3D:
127 killagreg 144
                                        LCD_printfxy(7,0,"3DFix");
41 ingob 145
                                        break;
146
                                default:
127 killagreg 147
                                        LCD_printfxy(7,0,"??Fix");
41 ingob 148
                                        break;
149
                                }
121 killagreg 150
                                if(GPSData.Flags & FLAG_DIFFSOLN)
151
                                {
127 killagreg 152
                                        LCD_printfxy(12,0,"/DGPS");
121 killagreg 153
                                }
154
                                else
155
                                {
127 killagreg 156
                                        LCD_printfxy(12,0,"     ");
121 killagreg 157
                                }
158
 
51 killagreg 159
                                if(GPSData.Position.Longitude < 0) sign = '-';
160
                                else sign = '+';
53 killagreg 161
                                i1 = abs(GPSData.Position.Longitude)/10000000L;
162
                                i2 = abs(GPSData.Position.Longitude)%10000000L;
54 killagreg 163
                                LCD_printfxy(0,1,"Lon:%c%03ld.%07ld deg",sign, i1, i2);
51 killagreg 164
                                if(GPSData.Position.Latitude < 0) sign = '-';
165
                                else sign = '+';
53 killagreg 166
                                i1 = abs(GPSData.Position.Latitude)/10000000L;
167
                                i2 = abs(GPSData.Position.Latitude)%10000000L;
54 killagreg 168
                                LCD_printfxy(0,2,"Lat:%c%03ld.%07ld deg",sign, i1, i2);
51 killagreg 169
                                if(GPSData.Position.Altitude < 0) sign = '-';
170
                                else sign = '+';
53 killagreg 171
                                i1 = abs(GPSData.Position.Altitude)/1000L;
172
                                i2 = abs(GPSData.Position.Altitude)%1000L;
54 killagreg 173
                                LCD_printfxy(0,3,"Alt:%c%04ld.%03ld m", sign, i1, i2);
41 ingob 174
                        }
175
                        break;
176
                case 2:
177
                        if (GPSData.Status == INVALID)
178
                        {
179
                                LCD_printfxy(0,0,"No GPS data");
180
                                LCD_printfxy(0,1,"Speed N:            ");
181
                                LCD_printfxy(0,2,"Speed E:            ");
182
                                LCD_printfxy(0,3,"Speed T:            ");
183
                        }
184
                        else // newdata or processed
185
                        {
124 killagreg 186
                                LCD_printfxy(0,0,"Sat:%02d ", GPSData.NumOfSats);
41 ingob 187
                                switch (GPSData.SatFix)
188
                                {
189
                                case SATFIX_NONE:
127 killagreg 190
                                        LCD_printfxy(7,0,"NoFix");
41 ingob 191
                                        break;
192
                                case SATFIX_2D:
127 killagreg 193
                                        LCD_printfxy(7,0,"2DFix");
41 ingob 194
                                        break;
195
                                case SATFIX_3D:
127 killagreg 196
                                        LCD_printfxy(7,0,"3DFix");
41 ingob 197
                                        break;
198
                                default:
127 killagreg 199
                                        LCD_printfxy(7,0,"??Fix");
41 ingob 200
                                        break;
201
                                }
124 killagreg 202
                                if(GPSData.Flags & FLAG_DIFFSOLN)
203
                                {
127 killagreg 204
                                        LCD_printfxy(12,0,"/DGPS");
124 killagreg 205
                                }
206
                                else
207
                                {
127 killagreg 208
                                        LCD_printfxy(12,0,"     ");
124 killagreg 209
                                }
210
 
41 ingob 211
                                LCD_printfxy(0,1,"Speed N: %+4ld cm/s",GPSData.Speed_North);
212
                                LCD_printfxy(0,2,"Speed E: %+4ld cm/s",GPSData.Speed_East);
213
                                LCD_printfxy(0,3,"Speed T: %+4ld cm/s",GPSData.Speed_Top);
214
                        }
215
                        break;
216
                case 3:
217
                        LCD_printfxy(0,0,"GPS UTC Time");
218
                        if (!SystemTime.Valid)
219
                        {
220
                                LCD_printfxy(0,1,"                    ");
221
                                LCD_printfxy(0,2,"  No time data!     ");
222
                                LCD_printfxy(0,3,"                    ");
223
                        }
224
                        else // newdata or processed
225
                        {
226
                                LCD_printfxy(0,1,"                    ");
227
                                LCD_printfxy(0,2,"Date: %02i/%02i/%04i",SystemTime.Month, SystemTime.Day, SystemTime.Year);
228
                                LCD_printfxy(0,3,"Time: %02i:%02i:%02i.%03i", SystemTime.Hour, SystemTime.Min, SystemTime.Sec, SystemTime.mSec);
229
                        }
230
                        break;
59 killagreg 231
                case 4: // Navi Params 1 from FC
41 ingob 232
                        LCD_printfxy(0,0,"NaviMode: %3i" ,  Parameter.NaviGpsModeControl);
233
            LCD_printfxy(0,1,"G  :%3i P  :%3i ",Parameter.NaviGpsGain, Parameter.NaviGpsP);
234
            LCD_printfxy(0,2,"I  :%3i D  :%3i ",Parameter.NaviGpsI, Parameter.NaviGpsD);
235
                    LCD_printfxy(0,3,"ACC:%3i SAT:%3i ",Parameter.NaviGpsACC, Parameter.NaviGpsMinSat);
236
                        break;
59 killagreg 237
                case 5: // Navi Params 2 from FC
238
                        LCD_printfxy(0,0,"Stick TS:  %3i", Parameter.NaviStickThreshold);
213 killagreg 239
            LCD_printfxy(0,1,"MaxRadius: %3i m", NaviData.OperatingRadius);
59 killagreg 240
            LCD_printfxy(0,2,"WindCorr:  %3i", Parameter.NaviWindCorrection);
241
                    LCD_printfxy(0,3,"SpeedComp: %3i", Parameter.NaviSpeedCompensation);
242
                        break;
243
                case 6: // Navi Params 3 from FC
244
                        LCD_printfxy(0,0,"Angle-Limit: %3i", Parameter.NaviAngleLimitation);
245
            LCD_printfxy(0,1,"    P-Limit: %3i", Parameter.NaviGpsPLimit);
246
            LCD_printfxy(0,2,"    I-Limit: %3i", Parameter.NaviGpsILimit);
247
                    LCD_printfxy(0,3,"    D-Limit: %3i", Parameter.NaviGpsDLimit);
248
                        break;
249
                case 7:
41 ingob 250
                        LCD_printfxy(0,0,"Home Position");
215 killagreg 251
                        if(NaviData.HomePosition.Status == INVALID)
41 ingob 252
                        {
253
                                LCD_printfxy(0,1,"                     ");
254
                                LCD_printfxy(0,2,"    Is not set.      ");
255
                                LCD_printfxy(0,3,"                     ");
256
                        }
257
                        else
258
                        {
215 killagreg 259
                                if(NaviData.HomePosition.Longitude < 0) sign = '-';
51 killagreg 260
                                else sign = '+';
215 killagreg 261
                                i1 = abs(NaviData.HomePosition.Longitude)/10000000L;
262
                                i2 = abs(NaviData.HomePosition.Longitude)%10000000L;
55 killagreg 263
                                LCD_printfxy(0,1,"Lon:%c%03ld.%07ld deg",sign, i1, i2);
215 killagreg 264
                                if(NaviData.HomePosition.Latitude < 0) sign = '-';
51 killagreg 265
                                else sign = '+';
215 killagreg 266
                                i1 = abs(NaviData.HomePosition.Latitude)/10000000L;
267
                                i2 = abs(NaviData.HomePosition.Latitude)%10000000L;
55 killagreg 268
                                LCD_printfxy(0,2,"Lat:%c%03ld.%07ld deg",sign, i1, i2);
215 killagreg 269
                                if(NaviData.HomePosition.Altitude < 0) sign = '-';
51 killagreg 270
                                else sign = '+';
215 killagreg 271
                                i1 = abs(NaviData.HomePosition.Altitude)/1000L;
272
                                i2 = abs(NaviData.HomePosition.Altitude)%1000L;
54 killagreg 273
                                LCD_printfxy(0,3,"Alt:%c%04ld.%03ld m",sign, i1, i2);
41 ingob 274
                        }
275
                        break;
59 killagreg 276
                case 8: // RC stick controls from FC
41 ingob 277
                        LCD_printfxy(0,0,"RC-Sticks" );
278
            LCD_printfxy(0,1,"Ni:%4i  Ro:%4i ",FC.StickNick, FC.StickRoll);
279
            LCD_printfxy(0,2,"Gs:%4i  Ya:%4i ",FC.StickGas, FC.StickYaw);
280
                        break;
59 killagreg 281
                case 9: // RC poti controls from FC
190 killagreg 282
                        LCD_printfxy(0,0,"RC-Potis 1" );
283
            LCD_printfxy(0,1,"Po1:%3i  Po2:%3i ",FC.Poti[0], FC.Poti[1]);
284
            LCD_printfxy(0,2,"Po3:%3i  Po4:%3i ",FC.Poti[2], FC.Poti[3]);
41 ingob 285
                        break;
190 killagreg 286
                case 10: // RC poti controls from FC
287
                        LCD_printfxy(0,0,"RC-Potis 2" );
288
            LCD_printfxy(0,1,"Po5:%3i  Po6:%3i ",FC.Poti[4], FC.Poti[5]);
289
            LCD_printfxy(0,2,"Po7:%3i  Po8:%3i ",FC.Poti[6], FC.Poti[7]);
290
                        break;
291
                case 11: // attitude from FC
66 killagreg 292
                        if(FromFlightCtrl.AngleNick < 0) sign = '-';
293
                        else sign = '+';
294
                        i1 = abs(FromFlightCtrl.AngleNick)/10;
295
                        i2 = abs(FromFlightCtrl.AngleNick)%10;
201 killagreg 296
                        LCD_printfxy(0,0,"GyroNick:%c%03ld.%01ld", sign, i1, i2);
66 killagreg 297
                        if(FromFlightCtrl.AngleRoll < 0) sign = '-';
298
                        else sign = '+';
299
                        i1 = abs(FromFlightCtrl.AngleRoll)/10;
300
                        i2 = abs(FromFlightCtrl.AngleRoll)%10;
201 killagreg 301
            LCD_printfxy(0,1,"GyroRoll:%c%03ld.%01ld", sign, i1, i2);
67 killagreg 302
                        if(FromFlightCtrl.AccNick < 0) sign = '-';
303
                        else sign = '+';
304
                        i1 = abs(FromFlightCtrl.AccNick)/10;
305
                        i2 = abs(FromFlightCtrl.AccNick)%10;
201 killagreg 306
                        LCD_printfxy(0,2," AccNick:%c%03ld.%01ld", sign, i1, i2);
67 killagreg 307
                        if(FromFlightCtrl.AccRoll < 0) sign = '-';
308
                        else sign = '+';
309
                        i1 = abs(FromFlightCtrl.AccRoll)/10;
310
                        i2 = abs(FromFlightCtrl.AccRoll)%10;
201 killagreg 311
            LCD_printfxy(0,3," AccRoll:%c%03ld.%01ld", sign, i1, i2);
41 ingob 312
                        break;
190 killagreg 313
                case 12: // gyros from FC
41 ingob 314
                        LCD_printfxy(0,0,"GyroNick:  %4i", FromFlightCtrl.GyroNick);
315
            LCD_printfxy(0,1,"GyroRoll:  %4i", FromFlightCtrl.GyroRoll);
316
                        LCD_printfxy(0,2,"GyroYaw:   %4i", FromFlightCtrl.GyroYaw);
317
                        break;
190 killagreg 318
                case 13: // Remote Control Level from FC
41 ingob 319
            LCD_printfxy(0,0,"RC-Level:    %3i", FC.RC_Quality);
206 killagreg 320
                        LCD_printfxy(0,1,"Ubat:        %2i.%1i V", FC.BAT_Voltage/10, FC.BAT_Voltage%10);
254 killagreg 321
                        LCD_printfxy(0,2,"CompHeading: %3i", Compass_Heading);
153 killagreg 322
                        if(GeoMagDec < 0) sign = '-';
323
                        else sign = '+';
324
                        LCD_printfxy(0,3,"GeoMagDec:  %c%i.%1i", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10);
41 ingob 325
            break;
190 killagreg 326
                case 14: // User Parameter
153 killagreg 327
                        LCD_printfxy(0,0,"UP1:%3i  UP2:%3i",Parameter.User1,Parameter.User2);
328
                        LCD_printfxy(0,1,"UP3:%3i  UP4:%3i",Parameter.User3,Parameter.User4);
329
                        LCD_printfxy(0,2,"UP5:%3i  UP6:%3i",Parameter.User5,Parameter.User6);
330
                        LCD_printfxy(0,3,"UP7:%3i  UP8:%3i",Parameter.User7,Parameter.User8);
41 ingob 331
                        break;
254 killagreg 332
                case 15: // magnetic field
333
                        if(Compass_Device == COMPASS_NCMAG)
334
                        {
335
                                if(Compass_CalState)
336
                                {
337
                                        LCD_printfxy(0,0,"Calibration:");
338
                                        LCD_printfxy(0,1,"Step %d/", Compass_CalState);
339
                                        LCD_printfxy(0,2,"X %4i Y %4i Z %4i",MagVector.X,MagVector.Y,MagVector.Z);
340
                                        LCD_printfxy(9,3,"(ESC)(NEXT)");
341
                                        switch(Compass_CalState)
342
                                        {
343
                                                case 1:
344
                                                case 3:
345
                                                        LCD_printfxy(7,1,"pause");
346
                                                        break;
347
 
348
                                                case 2:
349
                                                        LCD_printfxy(7,1,"horizontal");
350
                                                        break;
351
 
352
                                                case 4:
353
                                                        LCD_printfxy(7,1,"vertical");
354
                                                        break;
355
 
356
                                                case 5:
357
                                                        LCD_printfxy(7,1,"data saved");
358
                                                        LCD_printfxy(8,3,"      (END) ");
359
                                                        break;
360
 
361
                                                default:
362
                                                        break;
363
                                        }
364
                                }
365
                                else
366
                                {
367
                                        LCD_printfxy(0,0,"Magnetic Field");
368
                                        LCD_printfxy(0,1,"X: %4i",MagVector.X);
369
                                        LCD_printfxy(0,2,"Y: %4i",MagVector.Y);
370
                                        LCD_printfxy(0,3,"Z: %4i",MagVector.Z);
371
                                        LCD_printfxy(13,3,"(CALIB)");
372
                                }
373
                                if(Keys & KEY4) //  next step
374
                                {
375
                                        if(Compass_CalState <5) Compass_SetCalState(Compass_CalState+1);
376
                                        else Compass_SetCalState(0);
377
                                }
378
                                if(Keys & KEY3)Compass_SetCalState(0);  // cancel
379
                        }
380
                        else // other compass
381
                        {
382
                                Compass_UpdateMagVector();
383
                                LCD_printfxy(0,0,"Magnetic Field");
384
                                LCD_printfxy(0,1,"X: %4i",MagVector.X);
385
                                LCD_printfxy(0,2,"Y: %4i",MagVector.Y);
386
                                LCD_printfxy(0,3,"Z: %4i",MagVector.Z);
387
                        }      
41 ingob 388
                        break;
389
                default:
201 killagreg 390
                        //MaxMenuItem = MenuItem - 1;
41 ingob 391
                        MenuItem = 0;
392
                        break;
1 ingob 393
    }
394
}