Subversion Repositories FlightCtrl

Rev

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

Rev 211 Rev 212
Line 19... Line 19...
19 
#define KEY4    0x08
 19 
#define KEY4    0x08
20 
#define KEY5    0x10
 20 
#define KEY5    0x10
Line 21... Line 21...
21 
 
 21 
 
22 
void LcdClear(void)
 22 
void LcdClear(void)
23 
{
 23 
{
24 
 unsigned char i;
 24 
 unsigned char i;
25 
 for(i=0;i<80;i++) DisplayBuff[i] = ' ';
 25 
 for(i=0;i<80;i++) DisplayBuff[i] = ' ';
Line 26... Line 26...
26 
}
 26 
}
27 
 
 27 
 
28 
void Menu(void)
 28 
void Menu(void)
29 
 {
 29 
 {
30 
  static unsigned char MaxMenue = 10,MenuePunkt=0;      
 30 
  static unsigned char MaxMenue = 10,MenuePunkt=0;
31 
 
 31 
 
32 
  if(RemoteTasten & KEY1) { if(MenuePunkt) MenuePunkt--; else MenuePunkt = MaxMenue; LcdClear(); }
 32 
  if(RemoteTasten & KEY1) { if(MenuePunkt) MenuePunkt--; else MenuePunkt = MaxMenue; LcdClear(); }
33 
  if(RemoteTasten & KEY2) { MenuePunkt++; LcdClear(); }
 33 
  if(RemoteTasten & KEY2) { MenuePunkt++; LcdClear(); }
34 
  if((RemoteTasten & KEY1) && (RemoteTasten & KEY2)) MenuePunkt = 0;
 34 
  if((RemoteTasten & KEY1) && (RemoteTasten & KEY2)) MenuePunkt = 0;
35 
  LCD_printfxy(17,0,"[%i]",MenuePunkt);
 35 
  LCD_printfxy(17,0,"[%i]",MenuePunkt);
36 
  switch(MenuePunkt)
 36 
  switch(MenuePunkt)
37 
   {
 37 
   {
38 
    case 0:
 38 
    case 0:
39 
           LCD_printfxy(0,0,"++ MikroKopter ++");
 39 
           LCD_printfxy(0,0,"++ MikroKopter ++");
40 
           LCD_printfxy(0,1,"HW:V%d.%d SW:%d.%d",PlatinenVersion/10,PlatinenVersion%10,VERSION_HAUPTVERSION, VERSION_NEBENVERSION);
 40 
           LCD_printfxy(0,1,"HW:V%d.%d SW:%d.%d",PlatinenVersion/10,PlatinenVersion%10,VERSION_HAUPTVERSION, VERSION_NEBENVERSION);
41 
           LCD_printfxy(0,2,"Setting: %d ",GetActiveParamSetNumber());
 41 
           LCD_printfxy(0,2,"Setting: %d ",GetActiveParamSetNumber());
42 
           LCD_printfxy(0,3,"(c) Holger Buss");
 42 
           LCD_printfxy(0,3,"(c) Holger Buss");
43 
//           if(RemoteTasten & KEY3) TestInt--;
 43 
//           if(RemoteTasten & KEY3) TestInt--;
44 
//           if(RemoteTasten & KEY4) TestInt++;
 44 
//           if(RemoteTasten & KEY4) TestInt++;
45 
           break;
 45 
           break;
46 
    case 1:
 46 
    case 1:
47 
          if(EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)
 47 
          if(EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)
48 
           {        
 48 
           {
49 
           LCD_printfxy(0,0,"Hoehe:     %5i",HoehenWert);
 49 
           LCD_printfxy(0,0,"Hoehe:     %5i",HoehenWert);
50 
           LCD_printfxy(0,1,"SollHoehe: %5i",SollHoehe);
 50 
           LCD_printfxy(0,1,"SollHoehe: %5i",SollHoehe);
51 
           LCD_printfxy(0,2,"Luftdruck: %5i",MessLuftdruck);
 51 
           LCD_printfxy(0,2,"Luftdruck: %5i",MessLuftdruck);
52 
           LCD_printfxy(0,3,"Off      : %5i",DruckOffsetSetting);
 52 
           LCD_printfxy(0,3,"Off      : %5i",DruckOffsetSetting);
53 
           }
 53 
           }
54 
           else
 54 
           else
55 
           {        
 55 
           {
56 
           LCD_printfxy(0,1,"Keine ");
 56 
           LCD_printfxy(0,1,"Keine ");
57 
           LCD_printfxy(0,2,"Höhenregelung");
 57 
           LCD_printfxy(0,2,"Höhenregelung");
58 
           }
 58 
           }
59 
           
 59 
 
60 
           break;
 60 
           break;
61 
    case 2:
 61 
    case 2:
62 
           LCD_printfxy(0,0,"akt. Lage");
 62 
           LCD_printfxy(0,0,"akt. Lage");
63 
           LCD_printfxy(0,1,"Nick:      %5i",IntegralNick/1024);
 63 
           LCD_printfxy(0,1,"Nick:      %5i",IntegralNick/1024);
64 
           LCD_printfxy(0,2,"Roll:      %5i",IntegralRoll/1024);
 64 
           LCD_printfxy(0,2,"Roll:      %5i",IntegralRoll/1024);
65 
           LCD_printfxy(0,3,"Kompass:   %5i",KompassValue);
 65 
           LCD_printfxy(0,3,"Kompass:   %5i",KompassValue);
66 
           break;
 66 
           break;
67 
    case 3:
 67 
    case 3:
68 
           LCD_printfxy(0,0,"K1:%4i  K2:%4i ",PPM_in[1],PPM_in[2]);
 68 
           LCD_printfxy(0,0,"K1:%4i  K2:%4i ",PPM_in[1],PPM_in[2]);
69 
           LCD_printfxy(0,1,"K3:%4i  K4:%4i ",PPM_in[3],PPM_in[4]);
 69 
           LCD_printfxy(0,1,"K3:%4i  K4:%4i ",PPM_in[3],PPM_in[4]);
70 
           LCD_printfxy(0,2,"K5:%4i  K6:%4i ",PPM_in[5],PPM_in[6]);
 70 
           LCD_printfxy(0,2,"K5:%4i  K6:%4i ",PPM_in[5],PPM_in[6]);
71 
           LCD_printfxy(0,3,"K7:%4i  K8:%4i ",PPM_in[7],PPM_in[8]);
 71 
           LCD_printfxy(0,3,"K7:%4i  K8:%4i ",PPM_in[7],PPM_in[8]);
72 
           break;
 72 
           break;
73 
    case 4:
 73 
    case 4:
74 
           LCD_printfxy(0,0,"Ni:%4i  Ro:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_NICK]],PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]]);
 74 
           LCD_printfxy(0,0,"Ni:%4i  Ro:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_NICK]],PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]]);
75 
           LCD_printfxy(0,1,"Gs:%4i  Gi:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_GAS]],PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]);
 75 
           LCD_printfxy(0,1,"Gs:%4i  Gi:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_GAS]],PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]);
76 
           LCD_printfxy(0,2,"P1:%4i  P2:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI1]],PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]]);
 76 
           LCD_printfxy(0,2,"P1:%4i  P2:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI1]],PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]]);
77 
           LCD_printfxy(0,3,"P3:%4i  P4:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI3]],PPM_in[EE_Parameter.Kanalbelegung[K_POTI4]]);
 77 
           LCD_printfxy(0,3,"P3:%4i  P4:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI3]],PPM_in[EE_Parameter.Kanalbelegung[K_POTI4]]);
78 
           break;
 78 
           break;
79 
    case 5:
 79 
    case 5:
80 
           LCD_printfxy(0,0,"Gyro - Sensor");
 80 
           LCD_printfxy(0,0,"Gyro - Sensor");
81 
           LCD_printfxy(0,1,"Nick %4i (%3i)",AccumulateNick / MessanzahlNick, AdNeutralNick);
 81 
           LCD_printfxy(0,1,"Nick %4i (%3i)",AccumulateNick / MessanzahlNick, AdNeutralNick);
82 
           LCD_printfxy(0,2,"Roll %4i (%3i)",AccumulateRoll / MessanzahlRoll, AdNeutralRoll);
 82 
           LCD_printfxy(0,2,"Roll %4i (%3i)",AccumulateRoll / MessanzahlRoll, AdNeutralRoll);
83 
           LCD_printfxy(0,3,"Gier %4i (%3i)",AccumulateGier / MessanzahlGier, AdNeutralGier);
 83 
           LCD_printfxy(0,3,"Gier %4i (%3i)",AccumulateGier / MessanzahlGier, AdNeutralGier);
84 
           break;
 84 
           break;
85 
    case 6:
 85 
    case 6:
86 
           LCD_printfxy(0,0,"ACC - Sensor");
 86 
           LCD_printfxy(0,0,"ACC - Sensor");
87 
           LCD_printfxy(0,1,"Nick %4i (%3i)",accumulate_AccNick / messanzahl_AccNick,NeutralAccX);
 87 
           LCD_printfxy(0,1,"Nick %4i (%3i)",accumulate_AccNick / messanzahl_AccNick,NeutralAccX);
88 
           LCD_printfxy(0,2,"Roll %4i (%3i)",accumulate_AccRoll / messanzahl_AccRoll,NeutralAccY);
 88 
           LCD_printfxy(0,2,"Roll %4i (%3i)",accumulate_AccRoll / messanzahl_AccRoll,NeutralAccY);
89 
           LCD_printfxy(0,3,"Hoch %4i (%3i)",Aktuell_az/*accumulate_AccHoch / messanzahl_AccHoch*/,(int)NeutralAccZ);
 89 
           LCD_printfxy(0,3,"Hoch %4i (%3i)",Aktuell_az/*accumulate_AccHoch / messanzahl_AccHoch*/,(int)NeutralAccZ);
90 
           break;
 90 
           break;
91 
    case 7:
 91 
    case 7:
92 
           LCD_printfxy(0,1,"Spannung:  %5i",UBat);
 92 
           LCD_printfxy(0,1,"Spannung:  %5i",UBat);
93 
           LCD_printfxy(0,2,"Empf.Pegel:%5i",SenderOkay);
 93 
           LCD_printfxy(0,2,"Empf.Pegel:%5i",SenderOkay);
94 
           break;
 94 
           break;
95 
    case 8:
 95 
    case 8:
96 
           LCD_printfxy(0,0,"Kompass       ");
 96 
           LCD_printfxy(0,0,"Kompass       ");
97 
           LCD_printfxy(0,1,"Richtung:  %5i",KompassRichtung);
 97 
           LCD_printfxy(0,1,"Richtung:  %5i",KompassRichtung);
98 
           LCD_printfxy(0,2,"Messwert:  %5i",KompassValue);
 98 
           LCD_printfxy(0,2,"Messwert:  %5i",KompassValue);
99 
           LCD_printfxy(0,3,"Start:     %5i",KompassStartwert);
 99 
           LCD_printfxy(0,3,"Start:     %5i",KompassStartwert);
100 
           break;
 100 
           break;
101 
    case 9:
 101 
    case 9:
102 
           LCD_printfxy(0,0,"Poti1:  %3i",Poti1);
 102 
           LCD_printfxy(0,0,"Poti1:  %3i",Poti1);
103 
           LCD_printfxy(0,1,"Poti2:  %3i",Poti2);
 103 
           LCD_printfxy(0,1,"Poti2:  %3i",Poti2);
104 
           LCD_printfxy(0,2,"Poti3:  %3i",Poti3);
 104 
           LCD_printfxy(0,2,"Poti3:  %3i",Poti3);
105 
           LCD_printfxy(0,3,"Poti4:  %3i",Poti4);
 105 
           LCD_printfxy(0,3,"Poti4:  %3i",Poti4);
106 
           break;
 106 
           break;
107 
    case 10:
 107 
    case 10:
108 
           LCD_printfxy(0,0,"Servo  " );
 108 
           LCD_printfxy(0,0,"Servo  " );
109 
           LCD_printfxy(0,1,"Setpoint  %3i",Parameter_ServoNickControl);
 109 
           LCD_printfxy(0,1,"Setpoint  %3i",Parameter_ServoNickControl);
110 
           LCD_printfxy(0,2,"Stellung: %3i",ServoValue);
 110 
           LCD_printfxy(0,2,"Stellung: %3i",ServoValue);
111 
           LCD_printfxy(0,3,"Range:%3i-%3i",EE_Parameter.ServoNickMin,EE_Parameter.ServoNickMax);
 111 
           LCD_printfxy(0,3,"Range:%3i-%3i",EE_Parameter.ServoNickMin,EE_Parameter.ServoNickMax);
112 
           break;
 112 
           break;
113 
    default: MaxMenue = MenuePunkt - 1;
 113 
    default: MaxMenue = MenuePunkt - 1;
114 
             MenuePunkt = 0;
 114 
             MenuePunkt = 0;
115 
           break;
 115 
           break;
116 
    }
 - 
 
117 
 RemoteTasten = 0;
 116 
    }
- 
 
 117 
 RemoteTasten = 0;