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; |