Subversion Repositories FlightCtrl

Rev

Rev 624 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 624 Rev 683
Line 8... Line 8...
8 
 
 8 
 
9 
unsigned int  TestInt = 0;
 9 
unsigned int  TestInt = 0;
10 
#define ARRAYGROESSE 10
 10 
#define ARRAYGROESSE 10
11 
unsigned char Array[ARRAYGROESSE] = {1,2,3,4,5,6,7,8,9,10};
 11 
unsigned char Array[ARRAYGROESSE] = {1,2,3,4,5,6,7,8,9,10};
12 
char DisplayBuff[80] = "Hallo Welt";
 12 
char DisplayBuff[80] = "Hallo Welt";
13 
unsigned char DispPtr = 0;
 13 
unsigned char DispPtr = 0;
Line 14... Line 14...
14 
unsigned char RemoteTasten = 0;
 14 
unsigned char RemoteTasten = 0;
15 
 
 15 
 
16 
#define KEY1    0x01
 16 
#define KEY1    0x01
17 
#define KEY2    0x02
 17 
#define KEY2    0x02
18 
#define KEY3    0x04
 18 
#define KEY3    0x04
Line 19... Line 19...
19 
#define KEY4    0x08
 19 
#define KEY4    0x08
20 
#define KEY5    0x10
 20 
#define KEY5    0x10
21 
 
 21 
 
22 
void LcdClear(void)
 22 
void LcdClear(void)
23 
{
 23 
{
Line 24... Line 24...
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] = ' ';
26 
}
 26 
}
27 
 
 27 
 
28 
void Menu(void)
 28 
void Menu(void)
29 
 {
 29 
 {
30 
  static unsigned char MaxMenue = 11,MenuePunkt=0;
 30 
  static unsigned char MaxMenue = 11,MenuePunkt=0;
31 
 
 31 
 
32 
  if(RemoteTasten & KEY1) { if(MenuePunkt) MenuePunkt--; else MenuePunkt = MaxMenue; LcdClear(); RemotePollDisplayLine = -1; }
 32 
  if(RemoteTasten & KEY1) { if(MenuePunkt) MenuePunkt--; else MenuePunkt = MaxMenue; LcdClear(); RemotePollDisplayLine = -1; }
33 
  if(RemoteTasten & KEY2) { MenuePunkt++; LcdClear(); RemotePollDisplayLine = -1;}
 33 
  if(RemoteTasten & KEY2) { MenuePunkt++; LcdClear(); RemotePollDisplayLine = -1;}
34 
  if((RemoteTasten & KEY1) && (RemoteTasten & KEY2)) MenuePunkt = 0;
 34 
  if((RemoteTasten & KEY1) && (RemoteTasten & KEY2)) MenuePunkt = 0;
35 
  if(MenuePunkt < 10) {LCD_printfxy(17,0,"[%i]",MenuePunkt);} else {LCD_printfxy(16,0,"[%i]",MenuePunkt);};
 35 
  if(MenuePunkt < 10) {LCD_printfxy(17,0,"[%i]",MenuePunkt);} else {LCD_printfxy(16,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%c",PlatinenVersion/10,PlatinenVersion%10,VERSION_HAUPTVERSION, VERSION_NEBENVERSION,VERSION_INDEX+'a');
 40 
           LCD_printfxy(0,1,"HW:V%d.%d SW:%d.%d%c",PlatinenVersion/10,PlatinenVersion%10,VERSION_HAUPTVERSION, VERSION_NEBENVERSION,VERSION_INDEX+'a');
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 
          if(PlatinenVersion == 10)
 81 
          if(PlatinenVersion == 10)
82 
          {
 82 
          {
83 
           LCD_printfxy(0,1,"Nick %4i (%3i)",AdWertNick - AdNeutralNick, AdNeutralNick);
 83 
           LCD_printfxy(0,1,"Nick %4i (%3i)",AdValueGyrNick - AdNeutralNick, AdNeutralNick);
84 
           LCD_printfxy(0,2,"Roll %4i (%3i)",AdWertRoll - AdNeutralRoll, AdNeutralRoll);
 84 
           LCD_printfxy(0,2,"Roll %4i (%3i)",AdValueGyrRoll - AdNeutralRoll, AdNeutralRoll);
85 
           LCD_printfxy(0,3,"Gier %4i (%3i)",MesswertGier, AdNeutralGier);
 85 
           LCD_printfxy(0,3,"Gier %4i (%3i)",MesswertGier, AdNeutralGier);
86 
          }
 86 
          }
87 
          else  
 87 
          else
88 
          {
 88 
          {
89 
           LCD_printfxy(0,1,"Nick %4i (%3i)",AdWertNick - AdNeutralNick, AdNeutralNick/2);
 89 
           LCD_printfxy(0,1,"Nick %4i (%3i)",AdValueGyrNick - AdNeutralNick, AdNeutralNick/2);
90 
           LCD_printfxy(0,2,"Roll %4i (%3i)",AdWertRoll - AdNeutralRoll, AdNeutralRoll/2);
 90 
           LCD_printfxy(0,2,"Roll %4i (%3i)",AdValueGyrRoll - AdNeutralRoll, AdNeutralRoll/2);
91 
           LCD_printfxy(0,3,"Gier %4i (%3i)",MesswertGier, AdNeutralGier/2);
 91 
           LCD_printfxy(0,3,"Gier %4i (%3i)",MesswertGier, AdNeutralGier/2);
92 
          }
 92 
          }
93 
           break;
 93 
           break;
94 
    case 6:
 94 
    case 6:
95 
           LCD_printfxy(0,0,"ACC - Sensor");
 95 
           LCD_printfxy(0,0,"ACC - Sensor");
96 
           LCD_printfxy(0,1,"Nick %4i (%3i)",AdWertAccNick,NeutralAccX);
 96 
           LCD_printfxy(0,1,"Nick %4i (%3i)",AdValueAccNick,NeutralAccX);
97 
           LCD_printfxy(0,2,"Roll %4i (%3i)",AdWertAccRoll,NeutralAccY);
 97 
           LCD_printfxy(0,2,"Roll %4i (%3i)",AdValueAccRoll,NeutralAccY);
98 
           LCD_printfxy(0,3,"Hoch %4i (%3i)",Mittelwert_AccHoch/*accumulate_AccHoch / messanzahl_AccHoch*/,(int)NeutralAccZ);
 98 
           LCD_printfxy(0,3,"Hoch %4i (%3i)",Mittelwert_AccHoch/*accumulate_AccHoch / messanzahl_AccHoch*/,(int)NeutralAccZ);
99 
           break;
 99 
           break;
100 
    case 7:
 100 
    case 7:
101 
           LCD_printfxy(0,1,"Spannung:  %5i",UBat);
 101 
           LCD_printfxy(0,1,"Spannung:  %5i",UBat);
102 
           LCD_printfxy(0,2,"Empf.Pegel:%5i",SenderOkay);
 102 
           LCD_printfxy(0,2,"Empf.Pegel:%5i",SenderOkay);
103 
           break;
 103 
           break;
104 
    case 8:
 104 
    case 8:
105 
           LCD_printfxy(0,0,"Kompass       ");
 105 
           LCD_printfxy(0,0,"Kompass       ");
106 
           LCD_printfxy(0,1,"Richtung:  %5i",KompassRichtung);
 106 
           LCD_printfxy(0,1,"Richtung:  %5i",KompassRichtung);
107 
           LCD_printfxy(0,2,"Messwert:  %5i",KompassValue);
 107 
           LCD_printfxy(0,2,"Messwert:  %5i",KompassValue);
108 
           LCD_printfxy(0,3,"Start:     %5i",KompassStartwert);
 108 
           LCD_printfxy(0,3,"Start:     %5i",KompassStartwert);
109 
           break;
 109 
           break;
110 
    case 9:
 110 
    case 9:
111 
           LCD_printfxy(0,0,"Poti1:  %3i",Poti1);
 111 
           LCD_printfxy(0,0,"Poti1:  %3i",Poti1);
112 
           LCD_printfxy(0,1,"Poti2:  %3i",Poti2);
 112 
           LCD_printfxy(0,1,"Poti2:  %3i",Poti2);
113 
           LCD_printfxy(0,2,"Poti3:  %3i",Poti3);
 113 
           LCD_printfxy(0,2,"Poti3:  %3i",Poti3);
114 
           LCD_printfxy(0,3,"Poti4:  %3i",Poti4);
 114 
           LCD_printfxy(0,3,"Poti4:  %3i",Poti4);
115 
           break;
 115 
           break;
116 
    case 10:
 116 
    case 10:
117 
           LCD_printfxy(0,0,"Servo  " );
 117 
           LCD_printfxy(0,0,"Servo  " );
118 
           LCD_printfxy(0,1,"Setpoint  %3i",Parameter_ServoNickControl);
 118 
           LCD_printfxy(0,1,"Setpoint  %3i",Parameter_ServoNickControl);
119 
           LCD_printfxy(0,2,"Stellung: %3i",ServoValue);
 119 
           LCD_printfxy(0,2,"Stellung: %3i",ServoValue);
120 
           LCD_printfxy(0,3,"Range:%3i-%3i",EE_Parameter.ServoNickMin,EE_Parameter.ServoNickMax);
 120 
           LCD_printfxy(0,3,"Range:%3i-%3i",EE_Parameter.ServoNickMin,EE_Parameter.ServoNickMax);
121 
           break;
 121 
           break;
122 
    case 11:
 122 
    case 11:
123 
           LCD_printfxy(0,0,"ExternControl  " );
 123 
           LCD_printfxy(0,0,"ExternControl  " );
124 
           LCD_printfxy(0,1,"Ni:%4i  Ro:%4i ",ExternControl.Nick,ExternControl.Roll);
 124 
           LCD_printfxy(0,1,"Ni:%4i  Ro:%4i ",ExternControl.Nick,ExternControl.Roll);
125 
           LCD_printfxy(0,2,"Gs:%4i  Gi:%4i ",ExternControl.Gas,ExternControl.Gier);
 125 
           LCD_printfxy(0,2,"Gs:%4i  Gi:%4i ",ExternControl.Gas,ExternControl.Gier);
126 
           LCD_printfxy(0,3,"Hi:%4i  Cf:%4i ",ExternControl.Hight,ExternControl.Config);
 126 
           LCD_printfxy(0,3,"Hi:%4i  Cf:%4i ",ExternControl.Hight,ExternControl.Config);
127 
           break;
 127 
           break;
128 
    default: MaxMenue = MenuePunkt - 1;
 128 
    default: MaxMenue = MenuePunkt - 1;
129 
             MenuePunkt = 0;
 129 
             MenuePunkt = 0;