Subversion Repositories NaviCtrl

Rev

Rev 515 | Rev 525 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 515 Rev 516
Line 76... Line 76...
76 
u8 MenuItem = 0;
 76 
u8 MenuItem = 0;
77 
u8 MaxMenuItem = 27;
 77 
u8 MaxMenuItem = 27;
Line 78... Line 78...
78 
 
 78 
 
79 
void Menu_Putchar(char c)
 79 
void Menu_Putchar(char c)
80 
{
 80 
{
81 
        if(DispPtr < DISPLAYBUFFSIZE) DisplayBuff[DispPtr++] = c; ;
 81 
   if(DispPtr < DISPLAYBUFFSIZE) DisplayBuff[DispPtr++] = c; ;
Line 82... Line 82...
82 
}
 82 
}
83 
 
 83 
 
84 
void Menu_Clear(void)
 84 
void Menu_Clear(void)
Line 88... Line 88...
88 
}
 88 
}
Line 89... Line 89...
89 
 
 89 
 
90 
// Display with 20 characters in 4 lines
 90 
// Display with 20 characters in 4 lines
91 
void Menu_Update(u8 Keys)
 91 
void Menu_Update(u8 Keys)
92 
{
 92 
{
93 
        s32 i1,i2;
 93 
        s32 i1,i2;
Line 94... Line 94...
94 
        u8 sign;
 94 
        u8 sign;
95 
 
 95 
 
96 
        if(Keys & KEY1) { if(MenuItem > 0) MenuItem--; else MenuItem = MaxMenuItem;}
 96 
        if(Keys & KEY1) { if(MenuItem > 0) MenuItem--; else MenuItem = MaxMenuItem;}
97 
        if(Keys & KEY2) { if(MenuItem == MaxMenuItem) MenuItem = 0; else MenuItem++;}
 97 
        if(Keys & KEY2) { if(MenuItem == MaxMenuItem) MenuItem = 0; else MenuItem++;}
98 
        if((Keys & KEY1) && (Keys & KEY2)) MenuItem = 0;
 98 
        if((Keys & KEY1) && (Keys & KEY2)) MenuItem = 0;
99 
        if(MenuItem > MaxMenuItem) MenuItem = MaxMenuItem;
 99 
        if(MenuItem > MaxMenuItem) MenuItem = MaxMenuItem;
100 
        Menu_Clear();
 100 
        Menu_Clear();
101 
        // print menu item number in the upper right corner
 101 
        // print menu item number in the upper right corner
102 
        if(MenuItem < 10)
 102 
        if(MenuItem < 10)
103 
        {
 103 
        {
104 
                LCD_printfxy(17,0,"[%i]",MenuItem);
 104 
                LCD_printfxy(17,0,"[%i]",MenuItem);
105 
        }
 105 
        }
106 
        else // Menuitem >= 10
 106 
        else // Menuitem >= 10
107 
        {
 107 
        {
Line 108... Line 108...
108 
                LCD_printfxy(16,0,"[%i]",MenuItem);
 108 
                LCD_printfxy(16,0,"[%i]",MenuItem);
109 
        }
 109 
        }
110 
 
 110 
 
111 
        switch(MenuItem)
 111 
        switch(MenuItem)
112 
        {
 112 
        {
113 
                // Version Info
 113 
                // Version Info
Line 114... Line 114...
114 
                case 0:
 114 
                case 0:
115 
                        LCD_printfxy(0,0,"++  Navi-Ctrl  ++");
 115 
                        LCD_printfxy(0,0,"++  Navi-Ctrl  ++");
116 
                        LCD_printfxy(0,1,"HW V%d.%d SW V%d.%02d%c", (Version_HW & 0x7F)/10, (Version_HW & 0x7F)%10, VERSION_MAJOR, VERSION_MINOR, 'a'+ VERSION_PATCH);
 116 
                        LCD_printfxy(0,1,"HW V%d.%d SW V%d.%02d%c", (Version_HW & 0x7F)/10, (Version_HW & 0x7F)%10, VERSION_MAJOR, VERSION_MINOR, 'a'+ VERSION_PATCH);
117 
 
 117 
 
118 
                        if(ErrorCode)
 118 
            if(ErrorCode)
119 
                        {
 119 
                        {
120 
                                LCD_printfxy(0,2,"Error: %d",ErrorCode);
 120 
                                LCD_printfxy(0,2,"Error: %d",ErrorCode);
121 
                                LCD_printfxy(0,3,"%s",ErrorMSG);
 121 
                LCD_printfxy(0,3,"%s",ErrorMSG);
122 
                        }
 122 
                        }
123 
                        else
 123 
                        else
124 
                        {
 124 
                        {
125 
                                LCD_printfxy(0,3,"(c) HiSystems GmbH");
 125 
                         LCD_printfxy(0,3,"(c) HiSystems GmbH");
126 
                                LCD_printfxy(0,2,"%s",ErrorMSG);
 126 
                         LCD_printfxy(0,2,"%s",ErrorMSG);
127 
                        }
 127 
                        }
Line 233... Line 233...
233 
                                LCD_printfxy(0,3,"Time: %02i:%02i:%02i.%03i", SystemTime.Hour, SystemTime.Min, SystemTime.Sec, SystemTime.mSec);
 233 
                                LCD_printfxy(0,3,"Time: %02i:%02i:%02i.%03i", SystemTime.Hour, SystemTime.Min, SystemTime.Sec, SystemTime.mSec);
234 
                        }
 234 
                        }
235 
                        break;
 235 
                        break;
236 
                case 4: // Navi Params 1 from FC
 236 
                case 4: // Navi Params 1 from FC
237 
                        LCD_printfxy(0,0,"NaviMode: %3i" ,  Parameter.NaviGpsModeControl);
 237 
                        LCD_printfxy(0,0,"NaviMode: %3i" ,  Parameter.NaviGpsModeControl);
238 
                        LCD_printfxy(0,1,"G  :%3i P  :%3i ",Parameter.NaviGpsGain, Parameter.NaviGpsP);
 238 
            LCD_printfxy(0,1,"G  :%3i P  :%3i ",Parameter.NaviGpsGain, Parameter.NaviGpsP);
239 
                        LCD_printfxy(0,2,"I  :%3i D  :%3i ",Parameter.NaviGpsI, Parameter.NaviGpsD);
 239 
            LCD_printfxy(0,2,"I  :%3i D  :%3i ",Parameter.NaviGpsI, Parameter.NaviGpsD);
240 
                        LCD_printfxy(0,3,"ACC:%3i SAT:%3i ",Parameter.NaviGpsACC, Parameter.NaviGpsMinSat);
 240 
                    LCD_printfxy(0,3,"ACC:%3i SAT:%3i ",Parameter.NaviGpsACC, Parameter.NaviGpsMinSat);
241 
                        break;
 241 
                        break;
242 
                case 5: // Navi Params 2 from FC
 242 
                case 5: // Navi Params 2 from FC
243 
                        LCD_printfxy(0,0,"Stick TS:  %3i", Parameter.NaviStickThreshold);
 243 
                        LCD_printfxy(0,0,"Stick TS:  %3i", Parameter.NaviStickThreshold);
244 
                        LCD_printfxy(0,1,"MaxRadius: %3im", DebugOut.Analog[4]);
 244 
            LCD_printfxy(0,1,"MaxRadius: %3im",MaxRadius_in_m);
245 
                        LCD_printfxy(0,2,"WindCorr:  %3i", Parameter.NaviWindCorrection);
 245 
            LCD_printfxy(0,2,"WindCorr:  %3i", Parameter.NaviWindCorrection);
246 
                        LCD_printfxy(0,3,"AccComp:   %3i", Parameter.NaviSpeedCompensation);
 246 
                    LCD_printfxy(0,3,"AccComp:   %3i", Parameter.NaviSpeedCompensation);
247 
                        break;
 247 
                        break;
248 
                case 6: // Navi Params 3 from FC
 248 
                case 6: // Navi Params 3 from FC
249 
                        LCD_printfxy(0,0,"Angle-Limit: %3i", Parameter.NaviAngleLimitation);
 249 
                        LCD_printfxy(0,0,"Angle-Limit: %3i", Parameter.NaviAngleLimitation);
250 
                        LCD_printfxy(0,1,"    P-Limit: %3i", Parameter.NaviGpsPLimit);
 250 
            LCD_printfxy(0,1,"    P-Limit: %3i", Parameter.NaviGpsPLimit);
251 
                        LCD_printfxy(0,2,"    I-Limit: %3i", Parameter.NaviGpsILimit);
 251 
            LCD_printfxy(0,2,"    I-Limit: %3i", Parameter.NaviGpsILimit);
252 
                        LCD_printfxy(0,3,"    D-Limit: %3i", Parameter.NaviGpsDLimit);
 252 
                    LCD_printfxy(0,3,"    D-Limit: %3i", Parameter.NaviGpsDLimit);
253 
                        break;
 253 
                        break;
254 
                case 7: // Max Ranges
 254 
                case 7: // Max Ranges
255 
                        LCD_printfxy(0,0,"Maximum flying  ");
 255 
                        LCD_printfxy(0,0,"Maximum flying  ");
256 
                        LCD_printfxy(0,1,"Range:   %4im ", AbsoluteFlyingRange);
 256 
            LCD_printfxy(0,1,"Range:   %4im ", AbsoluteFlyingRange);
257 
                        LCD_printfxy(0,2,"Descend: %4im ", AutoDescendRange);
 257 
            LCD_printfxy(0,2,"Descend: %4im ", AutoDescendRange);
258 
                        LCD_printfxy(0,3,"Altitude:%4im ", AbsoluteFlyingAltitude);
 258 
            LCD_printfxy(0,3,"Altitude:%4im ", AbsoluteFlyingAltitude);
259 
                        if(!AbsoluteFlyingRange) LCD_printfxy(9,1,"disabled");
 259 
                        if(!AbsoluteFlyingRange) LCD_printfxy(9,1,"disabled");
260 
                        if(!AutoDescendRange)    LCD_printfxy(9,2,"disabled");
 260 
                        if(!AutoDescendRange)    LCD_printfxy(9,2,"disabled");
261 
                        if(!AbsoluteFlyingAltitude) LCD_printfxy(9,3,"disabled");
 261 
                        if(!AbsoluteFlyingAltitude) LCD_printfxy(9,3,"disabled");
262 
                        break;
 262 
                        break;
263 
                case 8:
 263 
                case 8:
Line 314... Line 314...
314 
                                LCD_printfxy(0,3,"Alt:%c%04ld.%03ld m",sign, i1, i2);
 314 
                                LCD_printfxy(0,3,"Alt:%c%04ld.%03ld m",sign, i1, i2);
315 
                        }
 315 
                        }
316 
                        break;
 316 
                        break;
317 
                case 10: // RC stick controls from FC
 317 
                case 10: // RC stick controls from FC
318 
                        LCD_printfxy(0,0,"RC-Sticks" );
 318 
                        LCD_printfxy(0,0,"RC-Sticks" );
319 
                        LCD_printfxy(0,1,"Ni:%4i  Ro:%4i ",FC.StickNick, FC.StickRoll);
 319 
            LCD_printfxy(0,1,"Ni:%4i  Ro:%4i ",FC.StickNick, FC.StickRoll);
320 
                        LCD_printfxy(0,2,"Gs:%4i  Ya:%4i ",FC.StickGas, FC.StickYaw);
 320 
            LCD_printfxy(0,2,"Gs:%4i  Ya:%4i ",FC.StickGas, FC.StickYaw);
321 
                        LCD_printfxy(0,3,"RC-Level:    %3i", FC.RC_Quality); // Remote Control Level from FC
 321 
            LCD_printfxy(0,3,"RC-Level:    %3i", FC.RC_Quality); // Remote Control Level from FC
322 
                        break;
 322 
                        break;
323 
                case 11: // RC poti controls from FC
 323 
                case 11: // RC poti controls from FC
324 
                        LCD_printfxy(0,0,"RC-Potis 1" );
 324 
                        LCD_printfxy(0,0,"RC-Potis 1" );
325 
                        LCD_printfxy(0,1,"Po1:%3i  Po2:%3i ",FC.Poti[0], FC.Poti[1]);
 325 
            LCD_printfxy(0,1,"Po1:%3i  Po2:%3i ",FC.Poti[0], FC.Poti[1]);
326 
                        LCD_printfxy(0,2,"Po3:%3i  Po4:%3i ",FC.Poti[2], FC.Poti[3]);
 326 
            LCD_printfxy(0,2,"Po3:%3i  Po4:%3i ",FC.Poti[2], FC.Poti[3]);
327 
                        break;
 327 
                        break;
328 
                case 12: // RC poti controls from FC
 328 
                case 12: // RC poti controls from FC
329 
                        LCD_printfxy(0,0,"RC-Potis 2" );
 329 
                        LCD_printfxy(0,0,"RC-Potis 2" );
330 
                        LCD_printfxy(0,1,"Po5:%3i  Po6:%3i ",FC.Poti[4], FC.Poti[5]);
 330 
            LCD_printfxy(0,1,"Po5:%3i  Po6:%3i ",FC.Poti[4], FC.Poti[5]);
331 
                        LCD_printfxy(0,2,"Po7:%3i  Po8:%3i ",FC.Poti[6], FC.Poti[7]);
 331 
            LCD_printfxy(0,2,"Po7:%3i  Po8:%3i ",FC.Poti[6], FC.Poti[7]);
332 
                        break;
 332 
                        break;
333 
                case 13: // attitude from FC
 333 
                case 13: // attitude from FC
334 
                        if(FromFlightCtrl.AngleNick < 0) sign = '-';
 334 
                        if(FromFlightCtrl.AngleNick < 0) sign = '-';
335 
                        else sign = '+';
 335 
                        else sign = '+';
336 
                        i1 = abs(FromFlightCtrl.AngleNick)/10;
 336 
                        i1 = abs(FromFlightCtrl.AngleNick)/10;
Line 338... Line 338...
338 
                        LCD_printfxy(0,0,"GyroNick:%c%03ld.%01ld", sign, i1, i2);
 338 
                        LCD_printfxy(0,0,"GyroNick:%c%03ld.%01ld", sign, i1, i2);
339 
                        if(FromFlightCtrl.AngleRoll < 0) sign = '-';
 339 
                        if(FromFlightCtrl.AngleRoll < 0) sign = '-';
340 
                        else sign = '+';
 340 
                        else sign = '+';
341 
                        i1 = abs(FromFlightCtrl.AngleRoll)/10;
 341 
                        i1 = abs(FromFlightCtrl.AngleRoll)/10;
342 
                        i2 = abs(FromFlightCtrl.AngleRoll)%10;
 342 
                        i2 = abs(FromFlightCtrl.AngleRoll)%10;
343 
                        LCD_printfxy(0,1,"GyroRoll:%c%03ld.%01ld", sign, i1, i2);
 343 
            LCD_printfxy(0,1,"GyroRoll:%c%03ld.%01ld", sign, i1, i2);
344 
                        if(FromFlightCtrl.AccNick < 0) sign = '-';
 344 
                        if(FromFlightCtrl.AccNick < 0) sign = '-';
345 
                        else sign = '+';
 345 
                        else sign = '+';
346 
                        i1 = abs(FromFlightCtrl.AccNick)/10;
 346 
                        i1 = abs(FromFlightCtrl.AccNick)/10;
347 
                        i2 = abs(FromFlightCtrl.AccNick)%10;
 347 
                        i2 = abs(FromFlightCtrl.AccNick)%10;
348 
                        LCD_printfxy(0,2," AccNick:%c%03ld.%01ld", sign, i1, i2);
 348 
                        LCD_printfxy(0,2," AccNick:%c%03ld.%01ld", sign, i1, i2);
349 
                        if(FromFlightCtrl.AccRoll < 0) sign = '-';
 349 
                        if(FromFlightCtrl.AccRoll < 0) sign = '-';
350 
                        else sign = '+';
 350 
                        else sign = '+';
351 
                        i1 = abs(FromFlightCtrl.AccRoll)/10;
 351 
                        i1 = abs(FromFlightCtrl.AccRoll)/10;
352 
                        i2 = abs(FromFlightCtrl.AccRoll)%10;
 352 
                        i2 = abs(FromFlightCtrl.AccRoll)%10;
353 
                        LCD_printfxy(0,3," AccRoll:%c%03ld.%01ld", sign, i1, i2);
 353 
            LCD_printfxy(0,3," AccRoll:%c%03ld.%01ld", sign, i1, i2);
354 
                        break;
 354 
                        break;
355 
                case 14: // gyros from FC
 355 
                case 14: // gyros from FC
356 
                        LCD_printfxy(0,0,"GyroNick:  %4i", FromFlightCtrl.GyroNick);
 356 
                        LCD_printfxy(0,0,"GyroNick:  %4i", FromFlightCtrl.GyroNick);
357 
                        LCD_printfxy(0,1,"GyroRoll:  %4i", FromFlightCtrl.GyroRoll);
 357 
            LCD_printfxy(0,1,"GyroRoll:  %4i", FromFlightCtrl.GyroRoll);
358 
                        LCD_printfxy(0,2,"GyroYaw:   %4i", FromFlightCtrl.GyroYaw);
 358 
                        LCD_printfxy(0,2,"GyroYaw:   %4i", FromFlightCtrl.GyroYaw);
359 
                        if(FC_is_Calibrated)    LCD_printfxy(0,3,"Calibrated    ")
 359 
                        if(FC_is_Calibrated)    LCD_printfxy(0,3,"Calibrated    ")
360 
                        else                                    LCD_printfxy(0,3,"not calibrated");
 360 
                        else                                    LCD_printfxy(0,3,"not calibrated");
361 
                        break;
 361 
                        break;
362 
                case 15:
 362 
                case 15:
363 
                        LCD_printfxy(0,0,"Compass:    %3i", FromFlightCtrl.GyroHeading / 10);
 363 
                        LCD_printfxy(0,0,"Compass:    %3i", FromFlightCtrl.GyroHeading / 10);
364 
                        LCD_printfxy(0,1,"Man.-Offset:%3i", FC.FromFC_CompassOffset / 10);
 364 
                        LCD_printfxy(0,1,"Man.-Offset:%3i", FC.FromFC_CompassOffset / 10);
365 
                        if(FC.FromFC_DisableDeclination)
 365 
                        if(FC.FromFC_DisableDeclination)
366 
                        {
 366 
                        {
367 
                                LCD_printfxy(0,2,"Mag.Declinat.:disabl");
 367 
                                LCD_printfxy(0,2,"Mag.Declinat.:disabl");
368 
                        }
 368 
                        }
369 
                        else
 369 
                        else
370 
                        {
 370 
                        {
371 
                                if(GeoMagDec < 0) sign = '-';
 371 
                                if(GeoMagDec < 0) sign = '-';
372 
                                else sign = '+';
 372 
                                else sign = '+';
373 
                                LCD_printfxy(0,2,"Mag.Declinat.:%c%i.%1i", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10);
 373 
                                LCD_printfxy(0,2,"Mag.Declinat.:%c%i.%1i", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10);
374 
                        }
 374 
                        }
375 
                        LCD_printfxy(0,3,"True Compass: %3i", GyroCompassCorrected/10);
 375 
                        LCD_printfxy(0,3,"True Compass: %3i", GyroCompassCorrected/10);
376 
                        break;
 376 
            break;
377 
                case 16: // User Parameter
 377 
                case 16: // User Parameter
378 
                        LCD_printfxy(0,0,"UP1:%3i  UP2:%3i",Parameter.User1,Parameter.User2);
 378 
                        LCD_printfxy(0,0,"UP1:%3i  UP2:%3i",Parameter.User1,Parameter.User2);
379 
                        LCD_printfxy(0,1,"UP3:%3i  UP4:%3i",Parameter.User3,Parameter.User4);
 379 
                        LCD_printfxy(0,1,"UP3:%3i  UP4:%3i",Parameter.User3,Parameter.User4);
380 
                        LCD_printfxy(0,2,"UP5:%3i  UP6:%3i",Parameter.User5,Parameter.User6);
 380 
                        LCD_printfxy(0,2,"UP5:%3i  UP6:%3i",Parameter.User5,Parameter.User6);
381 
                        LCD_printfxy(0,3,"UP7:%3i  UP8:%3i",Parameter.User7,Parameter.User8);
 381 
                        LCD_printfxy(0,3,"UP7:%3i  UP8:%3i",Parameter.User7,Parameter.User8);
Line 388... Line 388...
388 
                case 18: // magnetic field
 388 
                case 18: // magnetic field
389 
                        if(Compass_CalState)
 389 
                        if(Compass_CalState)
390 
                        {
 390 
                        {
391 
                                LCD_printfxy(0,0,"Calibration:");
 391 
                                LCD_printfxy(0,0,"Calibration:");
392 
                                LCD_printfxy(0,1,"Step %d/", Compass_CalState);
 392 
                                LCD_printfxy(0,1,"Step %d/", Compass_CalState);
393 
                                LCD_printfxy(0,2,"X %4i Y %4i Z %4i",MagVector.X,MagVector.Y,MagVector.Z);
 393 
                                LCD_printfxy(0,2,"X %4i Y %4i Z %4i",MagVector.X,MagVector.Y,MagVector.Z);
394 
                                LCD_printfxy(9,3,"(ESC)(NEXT)");
 394 
                                LCD_printfxy(9,3,"(ESC)(NEXT)");
395 
                                switch(Compass_CalState)
 395 
                                switch(Compass_CalState)
396 
                                {
 396 
                                {
397 
                                        case 1:
 397 
                                        case 1:
398 
                                        case 3:
 398 
                                        case 3:
Line 419... Line 419...
419 
                        else
 419 
                        else
420 
                        {
 420 
                        {
421 
                                if(GeoMagDec < 0) sign = '-';
 421 
                                if(GeoMagDec < 0) sign = '-';
422 
                                else sign = '+';
 422 
                                else sign = '+';
423 
                                LCD_printfxy(0,0,"Magnetic Field");
 423 
                                LCD_printfxy(0,0,"Magnetic Field");
424 
                                LCD_printfxy(0,1,"X:%5i",MagVector.X);
 424 
                                LCD_printfxy(0,1,"X:%5i",MagVector.X);
425 
                                LCD_printfxy(0,2,"Y:%5i",MagVector.Y);
 425 
                                LCD_printfxy(0,2,"Y:%5i",MagVector.Y);
426 
                                LCD_printfxy(0,3,"Z:%5i",MagVector.Z);
 426 
                                LCD_printfxy(0,3,"Z:%5i",MagVector.Z);
427 
                                LCD_printfxy(8,1,"Field:%3i",EarthMagneticField/5);
 427 
                                LCD_printfxy(8,1,"Field:%3i",EarthMagneticField/5);
428 
                                if(Compass_I2CPort == NCMAG_PORT_EXTERN)        LCD_printfxy(11,2,"Extern")
 428 
                                if(Compass_I2CPort == NCMAG_PORT_EXTERN)        LCD_printfxy(11,2,"Extern")
429 
                                else                                                                            LCD_printfxy(11,2,"Intern");
 429 
                                else                                                                            LCD_printfxy(11,2,"Intern");
Line 469... Line 469...
469 
 
 469 
 
470 
                case 23:
 470 
                case 23:
471 
                        LCD_printfxy(0,0,"Ext. Compass" );
 471 
                        LCD_printfxy(0,0,"Ext. Compass" );
472 
                        if(Compass_I2CPort == NCMAG_PORT_EXTERN)
 472 
                        if(Compass_I2CPort == NCMAG_PORT_EXTERN)
473 
                        {
 473 
                        {
474 
                                u8 tmp;
 474 
                             u8 tmp;
475 
                                LCD_printfxy(0,1,"ACC  X      Y      Z");
 475 
                         LCD_printfxy(0,1,"ACC  X      Y      Z");
476 
                                LCD_printfxy(0,2," %5d  %5d  %5d", AccVector.X/40, AccVector.Y/40, AccVector.Z/40);
 476 
                         LCD_printfxy(0,2," %5d  %5d  %5d", AccVector.X/40, AccVector.Y/40, AccVector.Z/40);
477 
                                tmp = NCMAG_GetOrientationFromAcc();
 477 
                                 tmp = NCMAG_GetOrientationFromAcc();
478 
                                LCD_printfxy(0,3,"Orientat.: ");
 478 
                                 LCD_printfxy(0,3,"Orientat.: ");
479 
                                if(!tmp) LCD_printfxy(11,3,"??") else LCD_printfxy(11,3,"%2d",tmp);
 479 
                                 if(!tmp) LCD_printfxy(11,3,"??") else LCD_printfxy(11,3,"%2d",tmp);
480 
                                LCD_printfxy(15,3,"(%d)",NCMAG_Orientation);
 480 
                                 LCD_printfxy(15,3,"(%d)",NCMAG_Orientation);
481 
                        }
 481 
                        }
482 
                        else
 482 
                        else
483 
                        {
 483 
                        {
484 
                                LCD_printfxy(0,1,"Not connected");
 484 
                                LCD_printfxy(0,1,"Not connected");
Line 497... Line 497...
497 
                                LCD_printfxy(0,0,"Load WPL (fix)" );
 497 
                                LCD_printfxy(0,0,"Load WPL (fix)" );
498 
                                LCD_printfxy(0,1,"Name: %s", WPL_Store.Name);
 498 
                                LCD_printfxy(0,1,"Name: %s", WPL_Store.Name);
499 
                                //                12345678901234567890
 499 
                                //                12345678901234567890
500 
                                LCD_printfxy(0,2,"Points    Index     ");
 500 
                                LCD_printfxy(0,2,"Points    Index     ");
501 
                                LCD_printfxy(0,3," %3d      %3d   LOAD", PointList_GetCount(), index);
 501 
                                LCD_printfxy(0,3," %3d      %3d   LOAD", PointList_GetCount(), index);
502 
                        }
 502 
                        }                                                
503 
                        break;
 503 
                        break;
504 
                case 25:
 504 
                case 25:
505 
                        {
 505 
                        {
506 
                                static u8 index = 1;
 506 
                                static u8 index = 1;
507 
                                if(Keys & KEY3)
 507 
                                if(Keys & KEY3)
508 
                                {
 508 
                                {
509 
                                        if(index < ToFC_MaxWpListIndex) index++;
 509 
                                        if(index < ToFC_MaxWpListIndex) index++;
510 
                                        else index = 1;
 510 
                                        else index = 1;
511 
                                }
 511 
                                }
512 
                                LCD_printfxy(0,0,"Load WPL (Rel)" );
 512 
                                LCD_printfxy(0,0,"Load WPL (Rel)" );
513 
                                LCD_printfxy(0,1,"Name: %s", WPL_Store.Name);
 513 
                                LCD_printfxy(0,1,"Name: %s", WPL_Store.Name);
514 
                                //                12345678901234567890
 514 
                                //                12345678901234567890
515 
                                LCD_printfxy(0,2,"Points    Index     ");
 515 
                                LCD_printfxy(0,2,"Points    Index     ");
516 
                                if(GPSData.SatFix == SATFIX_3D)
 516 
                                if(GPSData.SatFix == SATFIX_3D)
517 
                                {
 517 
                                 {
518 
                                        LCD_printfxy(0,3," %3d      %3d   LOAD", PointList_GetCount(), index);
 518 
                                   LCD_printfxy(0,3," %3d      %3d   LOAD", PointList_GetCount(), index);
519 
                                        if(Keys & KEY4) FromFC_LoadWP_List = index | 0x80;
 519 
                                   if(Keys & KEY4) FromFC_LoadWP_List = index | 0x80;
520 
                                }
 520 
                                 }
521 
                                else LCD_printfxy(0,3," No Satfix !       ", index);
 521 
                                 else LCD_printfxy(0,3," No Satfix !       ", index);
Line 522... Line 522...
522 
 
 522 
 
523 
                        }
 523 
                        }                                                
524 
                        break;
 524 
                        break;
525 
                case 26:
 525 
                case 26:
526 
                        {
 526 
                        {
527 
                                static u8 index = 1;
 527 
                                static u8 index = 1;
528 
                                if(Keys & KEY3)
 528 
                                if(Keys & KEY3)
529 
                                {
 529 
                                {
530 
                                        if(index < ToFC_MaxWpListIndex) index++;
 530 
                                        if(index < ToFC_MaxWpListIndex) index++;
531 
                                        else index = 1;
 531 
                                        else index = 1;
532 
                                }
 532 
                                }
533 
                                if(Keys & KEY4) FromFC_Load_SinglePoint = index;
 533 
                                if(Keys & KEY4) FromFC_Load_SinglePoint = index;
534 
                                LCD_printfxy(0,0,"Load Point" );
 534 
                                LCD_printfxy(0,0,"Load Point" );
535 
                                LCD_printfxy(0,1,"Name: %s", WPL_Store.Name);
 535 
                                LCD_printfxy(0,1,"Name: %s", WPL_Store.Name);
536 
                                //                12345678901234567890
 536 
                                //                12345678901234567890
537 
//                              LCD_printfxy(0,2,"Points    Index     ");
 537 
//                              LCD_printfxy(0,2,"Points    Index     ");
538 
                                LCD_printfxy(0,3,"Number:  %3d (LOAD)", index);
 538 
                                LCD_printfxy(0,3,"Number:  %3d (LOAD)", index);
539 
                        }
 539 
                        }                                                
540 
                        break;
 540 
                        break;
541 
                case 27:
 541 
                case 27:
542 
                        {
 542 
                        {
543 
                                static u8 index = 1;
 543 
                                static u8 index = 1;
Line 548... Line 548...
548 
                                }
 548 
                                }
549 
                                LCD_printfxy(0,0,"Save Point" );
 549 
                                LCD_printfxy(0,0,"Save Point" );
550 
                                LCD_printfxy(0,1,"Alt: %3dm", NaviData.Altimeter/20);
 550 
                                LCD_printfxy(0,1,"Alt: %3dm", NaviData.Altimeter/20);
551 
                                //                12345678901234567890
 551 
                                //                12345678901234567890
552 
                                LCD_printfxy(0,2,"Dir: %3d ", CompassSetpointCorrected/10);
 552 
                                LCD_printfxy(0,2,"Dir: %3d ", CompassSetpointCorrected/10);
553 
                                if(GPSData.SatFix == SATFIX_3D)
 553 
                                if(GPSData.SatFix == SATFIX_3D)
554 
                                 {
 554 
                                 {
555 
                                   LCD_printfxy(0,3,"Number:   %3d (SAVE)", index);
 555 
                                   LCD_printfxy(0,3,"Number:   %3d (SAVE)", index);
556 
                                   if(Keys & KEY4) FromFC_Save_SinglePoint = index;
 556 
                                   if(Keys & KEY4) FromFC_Save_SinglePoint = index;
557 
                                 }
 557 
                                 }
558 
                                 else LCD_printfxy(0,3," No Satfix !       ", index);
 558 
                                 else LCD_printfxy(0,3," No Satfix !       ", index);
559 
                        }
 559 
                        }                                                
560 
                        break;
 560 
                        break;
Line 561... Line 561...
561 
 
 561 
 
562 
                default:
 562 
                default:
563 
                        //MaxMenuItem = MenuItem - 1;
 563 
                        //MaxMenuItem = MenuItem - 1;
564 
                        MenuItem = 0;
 564 
                        MenuItem = 0;
565 
                        break;
 565 
                        break;
566 
        }
 566 
    }