Subversion Repositories NaviCtrl

Rev

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

Rev 472 Rev 473
Line 73... Line 73...
73 
u8 DispPtr = 0;
 73 
u8 DispPtr = 0;
74 
s8 DisplayBuff[DISPLAYBUFFSIZE];
 74 
s8 DisplayBuff[DISPLAYBUFFSIZE];
Line 75... Line 75...
75 
 
 75 
 
76 
 
 76 
 
Line 77... Line 77...
77 
u8 MenuItem = 0;
 77 
u8 MenuItem = 0;
78 
u8 MaxMenuItem = 22;
 78 
u8 MaxMenuItem = 23;
79 
 
 79 
 
80 
void Menu_Putchar(char c)
 80 
void Menu_Putchar(char c)
Line 356... Line 356...
356 
                        break;
 356 
                        break;
357 
                case 14: // gyros from FC
 357 
                case 14: // gyros from FC
358 
                        LCD_printfxy(0,0,"GyroNick:  %4i", FromFlightCtrl.GyroNick);
 358 
                        LCD_printfxy(0,0,"GyroNick:  %4i", FromFlightCtrl.GyroNick);
359 
            LCD_printfxy(0,1,"GyroRoll:  %4i", FromFlightCtrl.GyroRoll);
 359 
            LCD_printfxy(0,1,"GyroRoll:  %4i", FromFlightCtrl.GyroRoll);
360 
                        LCD_printfxy(0,2,"GyroYaw:   %4i", FromFlightCtrl.GyroYaw);
 360 
                        LCD_printfxy(0,2,"GyroYaw:   %4i", FromFlightCtrl.GyroYaw);
- 
 
 361 
                        if(FC_is_Calibrated) LCD_printfxy(0,3,"Calibrated    ") else LCD_printfxy(0,3,"not calibrated");
361 
                        break;
 362 
                        break;
362 
                case 15:
 363 
                case 15:
363 
                        LCD_printfxy(0,0,"Ubat:   %2i.%1i V", FC.BAT_Voltage/10, FC.BAT_Voltage%10);
 364 
                        LCD_printfxy(0,0,"Ubat:   %2i.%1i V", FC.BAT_Voltage/10, FC.BAT_Voltage%10);
364 
                        LCD_printfxy(0,1,"Compass:      %3i", Compass_Heading);
 365 
                        LCD_printfxy(0,1,"Compass:      %3i", Compass_Heading);
365 
                        if(GeoMagDec < 0) sign = '-';
 366 
                        if(GeoMagDec < 0) sign = '-';
Line 416... Line 417...
416 
                                LCD_printfxy(0,0,"Magnetic Field");
 417 
                                LCD_printfxy(0,0,"Magnetic Field");
417 
                                LCD_printfxy(0,1,"X:%5i",MagVector.X);
 418 
                                LCD_printfxy(0,1,"X:%5i",MagVector.X);
418 
                                LCD_printfxy(0,2,"Y:%5i",MagVector.Y);
 419 
                                LCD_printfxy(0,2,"Y:%5i",MagVector.Y);
419 
                                LCD_printfxy(0,3,"Z:%5i",MagVector.Z);
 420 
                                LCD_printfxy(0,3,"Z:%5i",MagVector.Z);
420 
                                LCD_printfxy(8,1,"Field:%3i",EarthMagneticField/5);
 421 
                                LCD_printfxy(8,1,"Field:%3i",EarthMagneticField/5);
421 
                                if(I2C_CompassPort == I2C_EXTERN_0) LCD_printfxy(12,2,"Extern") else LCD_printfxy(12,2,"Intern");
 422 
                                if(I2C_CompassPort == I2C_EXTERN_0) LCD_printfxy(11,2,"Extern %d",ExtCompassOrientation) else LCD_printfxy(11,2,"Intern");
422 
//                              LCD_printfxy(8,2,"Dec:%c%i.%1i", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10);
 423 
//                              LCD_printfxy(8,2,"Dec:%c%i.%1i", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10);
423 
//                              LCD_printfxy(8,3,"Inc:%2i", EarthMagneticInclination);
 424 
//                              LCD_printfxy(8,3,"Inc:%2i", EarthMagneticInclination);
424 
                                LCD_printfxy(15,3,"(CAL)");
 425 
                                LCD_printfxy(15,3,"(CAL)");
425 
                        }
 426 
                        }
426 
                        if(Keys & KEY4) //  next step
 427 
                        if(Keys & KEY4) //  next step
Line 455... Line 456...
455 
                   for(i1 = 0; i1 < 3; i1++)
 456 
                   for(i1 = 0; i1 < 3; i1++)
456 
                    {
 457 
                    {
457 
                     LCD_printfxy(0,i1+1,"%3d %3d %3d %3d ",BL3_Current(i1*4),BL3_Current(i1*4+1),BL3_Current(i1*4+2),BL3_Current(i1*4+3));
 458 
                     LCD_printfxy(0,i1+1,"%3d %3d %3d %3d ",BL3_Current(i1*4),BL3_Current(i1*4+1),BL3_Current(i1*4+2),BL3_Current(i1*4+3));
458 
                         if(Motor[4 + i1 * 4].State == 0) break;
 459 
                         if(Motor[4 + i1 * 4].State == 0) break;
459 
                        }                      
 460 
                        }                      
- 
 
 461 
                        break;
- 
 
 462 
                case 23:
- 
 
 463 
           LCD_printfxy(0,0,"Ext. Compass" );
- 
 
 464 
                          if(I2C_CompassPort == I2C_EXTERN_0)
460 
 
 465 
                           {
- 
 
 466 
                             u8 tmp;
- 
 
 467 
                         LCD_printfxy(0,1,"ACC X      Y      Z");
- 
 
 468 
                         LCD_printfxy(0,2," %5d  %5d  %5d",AccRawVector.X,AccRawVector.Y,AccRawVector.Z);
- 
 
 469 
                                 tmp = GetExtCompassOrientation();
- 
 
 470 
                                 LCD_printfxy(0,3,"Orientat.: ");
- 
 
 471 
                                 if(!tmp) LCD_printfxy(11,3,"??") else LCD_printfxy(11,3,"%2d",tmp);
- 
 
 472 
                           }
- 
 
 473 
                           else
- 
 
 474 
                           {
- 
 
 475 
                            LCD_printfxy(0,1,"Not connected");
- 
 
 476 
                           }
461 
                        break;
 477 
                        break;
462 
                default:
 478 
                default:
463 
                        //MaxMenuItem = MenuItem - 1;
 479 
                        //MaxMenuItem = MenuItem - 1;
464 
                        MenuItem = 0;
 480 
                        MenuItem = 0;
465 
                        break;
 481 
                        break;