Subversion Repositories FlightCtrl

Rev

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

Rev 1916 Rev 1925
Line 6... Line 6...
6
// + see the File "License.txt" for further Informations
6
// + see the File "License.txt" for further Informations
7
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
7
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
8
#include "main.h"
8
#include "main.h"
9
#include "eeprom.h"
9
#include "eeprom.h"
Line 10... Line 10...
10
 
10
 
11
char DisplayBuff[80] = "Hello World";
11
char DisplayBuff[80];
Line 12... Line 12...
12
unsigned char DispPtr = 0;
12
unsigned char DispPtr = 0;
13
 
13
 
14
unsigned char MaxMenue = 17;
14
unsigned char MaxMenue = 16;
Line 15... Line 15...
15
unsigned char MenuePunkt = 0;
15
unsigned char MenuePunkt = 0;
16
unsigned char RemoteKeys = 0;
16
unsigned char RemoteKeys = 0;
Line 32... Line 32...
32
        DisplayBuff[DispPtr++] = c;
32
        DisplayBuff[DispPtr++] = c;
33
}
33
}
Line 34... Line 34...
34
 
34
 
35
void Menu(void)
35
void Menu(void)
-
 
36
 {
36
 {
37
  char i;
37
  if(RemoteKeys & KEY1) { if(MenuePunkt) MenuePunkt--; else MenuePunkt = MaxMenue;}
38
  if(RemoteKeys & KEY1) { if(MenuePunkt) MenuePunkt--; else MenuePunkt = MaxMenue;}
38
  if(RemoteKeys & KEY2) { if(MenuePunkt == MaxMenue) MenuePunkt = 0; else MenuePunkt++;}
39
  if(RemoteKeys & KEY2) { if(MenuePunkt == MaxMenue) MenuePunkt = 0; else MenuePunkt++;}
39
  if((RemoteKeys & KEY1) && (RemoteKeys & KEY2)) MenuePunkt = 0;
40
  if((RemoteKeys & KEY1) && (RemoteKeys & KEY2)) MenuePunkt = 0;
40
  LcdClear();
41
  LcdClear();
Line 79... Line 80...
79
           LCD_printfxy(0,1,"Nick:      %5i",IntegralNick/1024);
80
           LCD_printfxy(0,1,"Nick:      %5i",IntegralNick/1024);
80
           LCD_printfxy(0,2,"Roll:      %5i",IntegralRoll/1024);
81
           LCD_printfxy(0,2,"Roll:      %5i",IntegralRoll/1024);
81
           LCD_printfxy(0,3,"Compass:   %5i",KompassValue);
82
           LCD_printfxy(0,3,"Compass:   %5i",KompassValue);
82
           break;
83
           break;
83
    case 3:
84
    case 3:
84
           LCD_printfxy(0,0,"K1:%4i  K2:%4i ",PPM_in[1],PPM_in[2]);
85
           for(i=0;i<8;i+=2) LCD_printfxy(0,i/2,"K%i:%4i  K%i:%4i ",i,PPM_in[1],i+1,PPM_in[2]);
85
           LCD_printfxy(0,1,"K3:%4i  K4:%4i ",PPM_in[3],PPM_in[4]);
-
 
86
           LCD_printfxy(0,2,"K5:%4i  K6:%4i ",PPM_in[5],PPM_in[6]);
-
 
87
           LCD_printfxy(0,3,"K7:%4i  K8:%4i ",PPM_in[7],PPM_in[8]);
-
 
88
           break;
86
           break;
89
    case 4:
87
    case 4:
90
           LCD_printfxy(0,0,"Ni:%4i  Ro:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_NICK]],PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]]);
88
           LCD_printfxy(0,0,"Ni:%4i  Ro:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_NICK]],PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]]);
91
           LCD_printfxy(0,1,"Gs:%4i  Gi:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_GAS]]+120,PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]);
89
           LCD_printfxy(0,1,"Gs:%4i  Gi:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_GAS]]+120,PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]);
92
           LCD_printfxy(0,2,"P1:%4i  P2:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI1]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]]+127);
90
           LCD_printfxy(0,2,"P1:%4i  P2:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_POTI1]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]]+127);
Line 138... Line 136...
138
           LCD_printfxy(0,1,"Heading:  %5i",KompassRichtung);
136
           LCD_printfxy(0,1,"Heading:  %5i",KompassRichtung);
139
           LCD_printfxy(0,2,"Value:    %5i",KompassValue);
137
           LCD_printfxy(0,2,"Value:    %5i",KompassValue);
140
           LCD_printfxy(0,3,"Soll:     %5i",KompassSollWert);
138
           LCD_printfxy(0,3,"Soll:     %5i",KompassSollWert);
141
           break;
139
           break;
142
    case 10:
140
    case 10:
143
           LCD_printfxy(0,0,"Poti1:  %3i",Poti[0]);
-
 
144
           LCD_printfxy(0,1,"Poti2:  %3i",Poti[1]);
-
 
145
           LCD_printfxy(0,2,"Poti3:  %3i",Poti[2]);
-
 
146
           LCD_printfxy(0,3,"Poti4:  %3i",Poti[3]);
141
           for(i=0;i<4;i++) LCD_printfxy(0,i,"Poti%i:  %3i",i+1,Poti[i]);
147
           break;
142
           break;
148
    case 11:
143
    case 11:
149
           LCD_printfxy(0,0,"Poti5:  %3i",Poti[4]);
144
           for(i=0;i<4;i++) LCD_printfxy(0,i,"Poti%i:  %3i",i+5,Poti[i+4]);
150
           LCD_printfxy(0,1,"Poti6:  %3i",Poti[5]);
-
 
151
           LCD_printfxy(0,2,"Poti7:  %3i",Poti[6]);
-
 
152
           LCD_printfxy(0,3,"Poti8:  %3i",Poti[7]);
-
 
153
           break;
145
           break;
154
    case 12:
146
    case 12:
155
           LCD_printfxy(0,0,"Servo  " );
147
           LCD_printfxy(0,0,"Servo  " );
156
           LCD_printfxy(0,1,"Setpoint  %3i",Parameter_ServoNickControl);
148
           LCD_printfxy(0,1,"Setpoint  %3i",Parameter_ServoNickControl);
157
           LCD_printfxy(0,2,"Position: %3i",ServoNickValue/4);
149
           LCD_printfxy(0,2,"Position: %3i",ServoNickValue/4);
158
           LCD_printfxy(0,3,"Range:%3i-%3i",EE_Parameter.ServoNickMin,EE_Parameter.ServoNickMax);
150
           LCD_printfxy(0,3,"Range:%3i-%3i",EE_Parameter.ServoNickMin,EE_Parameter.ServoNickMax);
159
           break;
151
           break;
160
    case 13:
152
/*    case 13:
161
           LCD_printfxy(0,0,"ExternControl  " );
153
           LCD_printfxy(0,0,"ExternControl  " );
162
           LCD_printfxy(0,1,"Ni:%4i  Ro:%4i ",ExternControl.Nick,ExternControl.Roll);
154
           LCD_printfxy(0,1,"Ni:%4i  Ro:%4i ",ExternControl.Nick,ExternControl.Roll);
163
           LCD_printfxy(0,2,"Gs:%4i  Gi:%4i ",ExternControl.Gas,ExternControl.Gier);
155
           LCD_printfxy(0,2,"Gs:%4i  Gi:%4i ",ExternControl.Gas,ExternControl.Gier);
164
           LCD_printfxy(0,3,"Hi:%4i  Cf:%4i ",ExternControl.Hight,ExternControl.Config);
156
           LCD_printfxy(0,3,"Hi:%4i  Cf:%4i ",ExternControl.Hight,ExternControl.Config);
165
           break;
157
           break;
-
 
158
*/
166
    case 14:
159
    case 13:
167
           LCD_printfxy(0,0,"BL-Ctrl Errors " );
160
           LCD_printfxy(0,0,"BL-Ctrl Errors " );
-
 
161
                   for(i=1;i<4;i++)
168
                   LCD_printfxy(0,1,"%3d %3d %3d %3d ",Motor[0].State & MOTOR_STATE_ERROR_MASK,Motor[1].State & MOTOR_STATE_ERROR_MASK,Motor[2].State & MOTOR_STATE_ERROR_MASK,Motor[3].State & MOTOR_STATE_ERROR_MASK);
162
                   LCD_printfxy(0,i,"%3d %3d %3d %3d ",Motor[i*4].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+1].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+2].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+3].State & MOTOR_STATE_ERROR_MASK);
169
                   LCD_printfxy(0,2,"%3d %3d %3d %3d ",Motor[4].State & MOTOR_STATE_ERROR_MASK,Motor[5].State & MOTOR_STATE_ERROR_MASK,Motor[6].State & MOTOR_STATE_ERROR_MASK,Motor[7].State & MOTOR_STATE_ERROR_MASK);
-
 
170
                   LCD_printfxy(0,3,"%3d %3d %3d %3d ",Motor[8].State & MOTOR_STATE_ERROR_MASK,Motor[9].State & MOTOR_STATE_ERROR_MASK,Motor[10].State & MOTOR_STATE_ERROR_MASK,Motor[11].State & MOTOR_STATE_ERROR_MASK);
-
 
171
           break;
163
           break;
172
    case 15:
164
    case 14:
173
           LCD_printfxy(0,0,"BL Temperature" );
165
           LCD_printfxy(0,0,"BL Temperature" );
174
                   LCD_printfxy(0,1,"%3i %3i %3i %3i ",Motor[0].Temperature,Motor[1].Temperature,Motor[2].Temperature,Motor[3].Temperature);
166
                   for(i=1;i<4;i++)
175
                   LCD_printfxy(0,2,"%3i %3i %3i %3i ",Motor[4].Temperature,Motor[5].Temperature,Motor[6].Temperature,Motor[7].Temperature);
167
                   LCD_printfxy(0,i,"%3d %3d %3d %3d ",Motor[i*4].Temperature,Motor[i*4+1].Temperature,Motor[i*4+2].Temperature,Motor[i*4+3].Temperature);
176
                   LCD_printfxy(0,3,"%3i %3i %3i %3i ",Motor[8].Temperature,Motor[9].Temperature,Motor[10].Temperature,Motor[11].Temperature);
-
 
177
           break;
168
           break;
178
    case 16:
169
    case 15:
179
           LCD_printfxy(0,0,"BL-Ctrl found " );
170
           LCD_printfxy(0,0,"BL-Ctrl found " );
180
                   LCD_printfxy(0,1," %c   %c   %c   %c ",'-' + 4 * (Motor[0].State>>7),'-' + 5 * (Motor[1].State>>7),'-' + 6 * (Motor[2].State>>7),'-' + 7 * (Motor[3].State>>7));
171
                   LCD_printfxy(0,1," %c   %c   %c   %c ",'-' + 4 * (Motor[0].State>>7),'-' + 5 * (Motor[1].State>>7),'-' + 6 * (Motor[2].State>>7),'-' + 7 * (Motor[3].State>>7));
181
                   LCD_printfxy(0,2," %c   %c   %c   %c ",'-' + 8 * (Motor[4].State>>7),'-' + 9 * (Motor[5].State>>7),'-' + 10 * (Motor[6].State>>7),'-' + 11 * (Motor[7].State>>7));
172
                   LCD_printfxy(0,2," %c   %c   %c   %c ",'-' + 8 * (Motor[4].State>>7),'-' + 9 * (Motor[5].State>>7),'-' + 10 * (Motor[6].State>>7),'-' + 11 * (Motor[7].State>>7));
182
                   LCD_printfxy(0,3," %c   -   -   - ",'-' + 12 * (Motor[8].State>>7));
173
                   LCD_printfxy(0,3," %c   -   -   - ",'-' + 12 * (Motor[8].State>>7));
183
                   if(Motor[9].State>>7)  LCD_printfxy(4,3,"10");
174
                   if(Motor[9].State>>7)  LCD_printfxy(4,3,"10");
184
                   if(Motor[10].State>>7) LCD_printfxy(8,3,"11");
175
                   if(Motor[10].State>>7) LCD_printfxy(8,3,"11");
185
                   if(Motor[11].State>>7) LCD_printfxy(12,3,"12");
176
                   if(Motor[11].State>>7) LCD_printfxy(12,3,"12");
186
           break;
177
           break;
187
    case 17:
178
    case 16:
188
           LCD_printfxy(0,0,"Flight-Time  " );
179
           LCD_printfxy(0,0,"Flight-Time  " );
189
           LCD_printfxy(0,1,"Total:%5umin",FlugMinutenGesamt);
180
           LCD_printfxy(0,1,"Total:%5umin",FlugMinutenGesamt);
190
           LCD_printfxy(0,2,"Act:  %5umin",FlugMinuten);
181
           LCD_printfxy(0,2,"Act:  %5umin",FlugMinuten);
191
           LCD_printfxy(13,3,"(reset)");
182
           LCD_printfxy(13,3,"(reset)");
192
                   if(RemoteKeys & KEY4)
183
                   if(RemoteKeys & KEY4)