Rev 1916 | Rev 1931 | Go to most recent revision | Show entire file | Regard 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) |