Subversion Repositories NaviCtrl

Rev

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

Rev 253 Rev 254
Line 312... Line 312...
312 
                        LCD_printfxy(0,2,"GyroYaw:   %4i", FromFlightCtrl.GyroYaw);
 312 
                        LCD_printfxy(0,2,"GyroYaw:   %4i", FromFlightCtrl.GyroYaw);
313 
                        break;
 313 
                        break;
314 
                case 13: // Remote Control Level from FC
 314 
                case 13: // Remote Control Level from FC
315 
            LCD_printfxy(0,0,"RC-Level:    %3i", FC.RC_Quality);
 315 
            LCD_printfxy(0,0,"RC-Level:    %3i", FC.RC_Quality);
316 
                        LCD_printfxy(0,1,"Ubat:        %2i.%1i V", FC.BAT_Voltage/10, FC.BAT_Voltage%10);
 316 
                        LCD_printfxy(0,1,"Ubat:        %2i.%1i V", FC.BAT_Voltage/10, FC.BAT_Voltage%10);
317 
                        LCD_printfxy(0,2,"CompHeading: %3i", CompassHeading);
 317 
                        LCD_printfxy(0,2,"CompHeading: %3i", Compass_Heading);
318 
                        if(GeoMagDec < 0) sign = '-';
 318 
                        if(GeoMagDec < 0) sign = '-';
319 
                        else sign = '+';
 319 
                        else sign = '+';
320 
                        LCD_printfxy(0,3,"GeoMagDec:  %c%i.%1i", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10);
 320 
                        LCD_printfxy(0,3,"GeoMagDec:  %c%i.%1i", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10);
321 
            break;
 321 
            break;
322 
                case 14: // User Parameter
 322 
                case 14: // User Parameter
323 
                        LCD_printfxy(0,0,"UP1:%3i  UP2:%3i",Parameter.User1,Parameter.User2);
 323 
                        LCD_printfxy(0,0,"UP1:%3i  UP2:%3i",Parameter.User1,Parameter.User2);
324 
                        LCD_printfxy(0,1,"UP3:%3i  UP4:%3i",Parameter.User3,Parameter.User4);
 324 
                        LCD_printfxy(0,1,"UP3:%3i  UP4:%3i",Parameter.User3,Parameter.User4);
325 
                        LCD_printfxy(0,2,"UP5:%3i  UP6:%3i",Parameter.User5,Parameter.User6);
 325 
                        LCD_printfxy(0,2,"UP5:%3i  UP6:%3i",Parameter.User5,Parameter.User6);
326 
                        LCD_printfxy(0,3,"UP7:%3i  UP8:%3i",Parameter.User7,Parameter.User8);
 326 
                        LCD_printfxy(0,3,"UP7:%3i  UP8:%3i",Parameter.User7,Parameter.User8);
327 
                        break;
 327 
                        break;
328 
                case 15: // MK3MAG
 328 
                case 15: // magnetic field
- 
 
 329 
                        if(Compass_Device == COMPASS_NCMAG)
- 
 
 330 
                        {
- 
 
 331 
                                if(Compass_CalState)
- 
 
 332 
                                {
- 
 
 333 
                                        LCD_printfxy(0,0,"Calibration:");
- 
 
 334 
                                        LCD_printfxy(0,1,"Step %d/", Compass_CalState);
- 
 
 335 
                                        LCD_printfxy(0,2,"X %4i Y %4i Z %4i",MagVector.X,MagVector.Y,MagVector.Z);
- 
 
 336 
                                        LCD_printfxy(9,3,"(ESC)(NEXT)");
- 
 
 337 
                                        switch(Compass_CalState)
- 
 
 338 
                                        {
- 
 
 339 
                                                case 1:
- 
 
 340 
                                                case 3:
- 
 
 341 
                                                        LCD_printfxy(7,1,"pause");
- 
 
 342 
                                                        break;
- 
 
 343 
       
- 
 
 344 
                                                case 2:
- 
 
 345 
                                                        LCD_printfxy(7,1,"horizontal");
- 
 
 346 
                                                        break;
- 
 
 347 
       
- 
 
 348 
                                                case 4:
- 
 
 349 
                                                        LCD_printfxy(7,1,"vertical");
- 
 
 350 
                                                        break;
- 
 
 351 
       
- 
 
 352 
                                                case 5:
- 
 
 353 
                                                        LCD_printfxy(7,1,"data saved");
- 
 
 354 
                                                        LCD_printfxy(8,3,"      (END) ");
- 
 
 355 
                                                        break;
- 
 
 356 
                                               
- 
 
 357 
                                                default:
- 
 
 358 
                                                        break;
- 
 
 359 
                                        }
- 
 
 360 
                                }
- 
 
 361 
                                else
- 
 
 362 
                                {
- 
 
 363 
                                        LCD_printfxy(0,0,"Magnetic Field");
- 
 
 364 
                                        LCD_printfxy(0,1,"X: %4i",MagVector.X);
- 
 
 365 
                                        LCD_printfxy(0,2,"Y: %4i",MagVector.Y);
- 
 
 366 
                                        LCD_printfxy(0,3,"Z: %4i",MagVector.Z);
- 
 
 367 
                                        LCD_printfxy(13,3,"(CALIB)");
- 
 
 368 
                                }
- 
 
 369 
                                if(Keys & KEY4) //  next step
- 
 
 370 
                                {
- 
 
 371 
                                        if(Compass_CalState <5) Compass_SetCalState(Compass_CalState+1);
- 
 
 372 
                                        else Compass_SetCalState(0);
- 
 
 373 
                                }
- 
 
 374 
                                if(Keys & KEY3)Compass_SetCalState(0);  // cancel
- 
 
 375 
                        }
- 
 
 376 
                        else // other compass
- 
 
 377 
                        {
329 
                        Compass_UpdateMagVector();
 378 
                                Compass_UpdateMagVector();
330 
                        LCD_printfxy(0,0,"Magnetic Field");
 379 
                                LCD_printfxy(0,0,"Magnetic Field");
331 
                        LCD_printfxy(0,1,"MagX: %4i",MagVector.X);
 380 
                                LCD_printfxy(0,1,"X: %4i",MagVector.X);
332 
                        LCD_printfxy(0,2,"MagY: %4i",MagVector.Y);
 381 
                                LCD_printfxy(0,2,"Y: %4i",MagVector.Y);
333 
                        LCD_printfxy(0,3,"MagZ: %4i",MagVector.Z);     
 382 
                                LCD_printfxy(0,3,"Z: %4i",MagVector.Z);
- 
 
 383 
                        }      
334 
                        break;
 384 
                        break;
335 
                default:
 385 
                default:
336 
                        //MaxMenuItem = MenuItem - 1;
 386 
                        //MaxMenuItem = MenuItem - 1;
337 
                        MenuItem = 0;
 387 
                        MenuItem = 0;
338 
                        break;
 388 
                        break;