Subversion Repositories FlightCtrl

Rev

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

Rev 2416 Rev 2426
Line 191... Line 191...
191 
                        LCD_printfxy(0,2,"Power:     %4iW",Capacity.ActualPower);
 191 
                        LCD_printfxy(0,2,"Power:     %4iW",Capacity.ActualPower);
192 
                        LCD_printfxy(0,3,"Discharge: %5imAh", Capacity.UsedCapacity);
 192 
                        LCD_printfxy(0,3,"Discharge: %5imAh", Capacity.UsedCapacity);
193 
           break;
 193 
           break;
194 
    case 8:
 194 
    case 8:
195 
           LCD_printfxy(0,0,"Receiver");
 195 
           LCD_printfxy(0,0,"Receiver");
196 
//           LCD_printfxy(0,1,"RC-RSSI:    %4i", PPM_in[0]);
 - 
 
197 
           LCD_printfxy(0,2,"RC-Quality: %4i", SenderOkay);
 196 
           LCD_printfxy(0,2,"RC-Quality: %4i", SenderOkay);
198 
           LCD_printfxy(0,3,"RC-Channels:%4i", Channels-1);
 197 
           LCD_printfxy(0,3,"RC-Channels:%4i", Channels-1);
199 
           break;
 198 
           break;
200 
    case 9:
 199 
    case 9:
201 
           LCD_printfxy(0,0,"Compass");
 200 
           LCD_printfxy(0,0,"Undervoltages  " );
202 
           LCD_printfxy(0,1,"Magnet:   %5i",KompassValue);
 201 
           LCD_printfxy(0,1,"Warn: %2d.%dV",BattLowVoltageWarning/10,BattLowVoltageWarning%10);
203 
           LCD_printfxy(0,2,"Gyro:     %5i",ErsatzKompassInGrad);
 202 
           LCD_printfxy(0,2,"Home: %2d.%dV",BattComingHomeVoltage/10,BattComingHomeVoltage%10);
204 
           LCD_printfxy(0,3,"Setpoint: %5i",KompassSollWert);
 203 
           LCD_printfxy(0,3,"Land: %2d.%dV",BattAutoLandingVoltage/10,BattAutoLandingVoltage%10);
205 
           break;
 204 
           break;
206 
    case 10:
 205 
    case 10:
207 
           for(i=0;i<4;i++) LCD_printfxy(0,i,"Poti%i:  %3i",i+1,Poti[i]);
 206 
           for(i=0;i<4;i++) LCD_printfxy(0,i,"Poti%i:  %3i",i+1,Poti[i]);
208 
           break;
 207 
           break;
209 
    case 11:
 208 
    case 11:
210 
           for(i=0;i<4;i++) LCD_printfxy(0,i,"Poti%i:  %3i",i+5,Poti[i+4]);
 209 
           for(i=0;i<4;i++) LCD_printfxy(0,i,"Poti%i:  %3i",i+5,Poti[i+4]);
211 
           break;
 210 
           break;
212 
    case 12:
 211 
    case 12:
- 
 
 212 
           LCD_printfxy(0,0,"Flight-Time  " );
- 
 
 213 
           LCD_printfxy(0,1,"Total:%5umin",FlugMinutenGesamt);
- 
 
 214 
           LCD_printfxy(0,2,"Act:  %5umin",FlugMinuten);
- 
 
 215 
           LCD_printfxy(13,3,"(reset)");
- 
 
 216 
                   if(RemoteKeys & KEY4)
- 
 
 217 
             {
- 
 
 218 
               FlugMinuten = 0;
- 
 
 219 
               SetParamWord(PID_FLIGHT_MINUTES, FlugMinuten);
- 
 
 220 
                         }
- 
 
 221 
           break;
213 
//#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))
 222 
#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))
- 
 
 223 
    case 13:
- 
 
 224 
           LCD_printfxy(0,0,"Compass");
- 
 
 225 
           LCD_printfxy(0,1,"Magnet:   %5i",KompassValue);
- 
 
 226 
           LCD_printfxy(0,2,"Gyro:     %5i",ErsatzKompassInGrad);
- 
 
 227 
           LCD_printfxy(0,3,"Setpoint: %5i",KompassSollWert);
- 
 
 228 
           break;
- 
 
 229 
    case 14:
214 
           LCD_printfxy(0,0,"Servo  " );
 230 
           LCD_printfxy(0,0,"Servo  " );
215 
           LCD_printfxy(0,1,"Setpoint  %3i",Parameter_ServoNickControl);
 231 
           LCD_printfxy(0,1,"Setpoint  %3i",Parameter_ServoNickControl);
216 
           LCD_printfxy(0,2,"Position: %3i",ServoNickValue/4);
 232 
           LCD_printfxy(0,2,"Position: %3i",ServoNickValue/4);
217 
           LCD_printfxy(0,3,"Range:%3i-%3i",EE_Parameter.ServoNickMin,EE_Parameter.ServoNickMax);
 233 
           LCD_printfxy(0,3,"Range:%3i-%3i",EE_Parameter.ServoNickMin,EE_Parameter.ServoNickMax);
218 
           break;
 234 
           break;
219 
/*    case 13:
 - 
 
220 
           LCD_printfxy(0,0,"ExternControl  " );
 - 
 
221 
           LCD_printfxy(0,1,"Ni:%4i  Ro:%4i ",ExternControl.Nick,ExternControl.Roll);
 - 
 
222 
           LCD_printfxy(0,2,"Gs:%4i  Gi:%4i ",ExternControl.Gas,ExternControl.Gier);
 - 
 
223 
           LCD_printfxy(0,3,"Hi:%4i  Cf:%4i ",ExternControl.Hight,ExternControl.Config);
 - 
 
224 
           break;
 - 
 
225 
*/
 - 
 
226 
//#endif
 - 
 
227 
    case 13:
 235 
    case 15:
228 
           LCD_printfxy(0,0,"BL-Ctrl Errors " );
 236 
           LCD_printfxy(0,0,"BL-Ctrl Errors " );
229 
                   for(i=0;i<3;i++)                                                              
 237 
                   for(i=0;i<3;i++)                                                              
230 
                   {
 238 
                   {
231 
                    LCD_printfxy(0,i+1,"%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);
 239 
                    LCD_printfxy(0,i+1,"%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);
232 
//                      if(i*4 >= RequiredMotors) break;
 - 
 
233 
                   }   
 240 
                   }   
234 
           break;
 241 
           break;
235 
    case 14:
 242 
    case 16:
236 
           LCD_printfxy(0,0,"BL Temperature" );
 243 
           LCD_printfxy(0,0,"BL Temperature" );
237 
                   for(i=0;i<3;i++)
 244 
                   for(i=0;i<3;i++)
238 
                    {
 245 
                    {
239 
                     LCD_printfxy(0,i+1,"%3d %3d %3d %3d ",Motor[i*4].Temperature,Motor[i*4+1].Temperature,Motor[i*4+2].Temperature,Motor[i*4+3].Temperature);
 246 
                     LCD_printfxy(0,i+1,"%3d %3d %3d %3d ",Motor[i*4].Temperature,Motor[i*4+1].Temperature,Motor[i*4+2].Temperature,Motor[i*4+3].Temperature);
240 
//                       if(4 + i * 4 >= RequiredMotors) break;
 - 
 
241 
                        }                      
 247 
                        }                      
242 
           break;
 248 
           break;
243 
//#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))
 - 
 
244 
    case 15:
 249 
    case 17:
245 
           LCD_printfxy(0,0,"BL Current" );
 250 
           LCD_printfxy(0,0,"BL Current" );
246 
           LCD_printfxy(11,3,"(in 0.1A)" );
 251 
           LCD_printfxy(11,3,"(in 0.1A)" );
247 
                   for(i=0;i<3;i++)
 252 
                   for(i=0;i<3;i++)
248 
                    {
 253 
                    {
249 
//                   LCD_printfxy(0,i+1,"%3d %3d %3d %3d ",Motor[i*4].Current,Motor[i*4+1].Current,Motor[i*4+2].Current,Motor[i*4+3].Current);
 - 
 
250 
                     LCD_printfxy(0,i+1,"%3d %3d %3d %3d ",BL3_Current(i*4),BL3_Current(i*4+1),BL3_Current(i*4+2),BL3_Current(i*4+3));
 254 
                     LCD_printfxy(0,i+1,"%3d %3d %3d %3d ",BL3_Current(i*4),BL3_Current(i*4+1),BL3_Current(i*4+2),BL3_Current(i*4+3));
251 
//                   LCD_printfxy(0,i+1,"%3d %3d %3d %3d ",Motor[i*4].MaxPWM,Motor[i*4+1].MaxPWM,Motor[i*4+2].MaxPWM,Motor[i*4+3].MaxPWM);
 - 
 
252 
                         if(4 + i * 4 >= RequiredMotors) break;
 255 
                         if(4 + i * 4 >= RequiredMotors) break;
253 
                        }                      
 256 
                        }                      
254 
           break;
 257 
           break;
255 
//#endif
 - 
 
256 
    case 16:
 258 
    case 18:
257 
           LCD_printfxy(0,0,"BL-Ctrl found " );
 259 
           LCD_printfxy(0,0,"BL-Ctrl found " );
258 
                   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));
 260 
                   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));
259 
                   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));
 261 
                   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));
260 
                   LCD_printfxy(0,3," %c   -   -   - ",'-' + 12 * (Motor[8].State>>7));
 262 
                   LCD_printfxy(0,3," %c   -   -   - ",'-' + 12 * (Motor[8].State>>7));
261 
                   if(Motor[9].State>>7)  LCD_printfxy(4,3,"10");
 263 
                   if(Motor[9].State>>7)  LCD_printfxy(4,3,"10");
262 
                   if(Motor[10].State>>7) LCD_printfxy(8,3,"11");
 264 
                   if(Motor[10].State>>7) LCD_printfxy(8,3,"11");
263 
                   if(Motor[11].State>>7) LCD_printfxy(12,3,"12");
 265 
                   if(Motor[11].State>>7) LCD_printfxy(12,3,"12");
264 
           break;
 266 
           break;
265 
    case 17:
 - 
 
266 
           LCD_printfxy(0,0,"Flight-Time  " );
 - 
 
267 
           LCD_printfxy(0,1,"Total:%5umin",FlugMinutenGesamt);
 - 
 
268 
           LCD_printfxy(0,2,"Act:  %5umin",FlugMinuten);
 - 
 
269 
           LCD_printfxy(13,3,"(reset)");
 - 
 
270 
                   if(RemoteKeys & KEY4)
 - 
 
271 
             {
 - 
 
272 
               FlugMinuten = 0;
 - 
 
273 
               SetParamWord(PID_FLIGHT_MINUTES, FlugMinuten);
 - 
 
274 
                         }
 267 
#endif
275 
           break;
 - 
 
276 
    case 18:
 - 
 
277 
           LCD_printfxy(0,0,"Undervoltages  " );
 - 
 
278 
           LCD_printfxy(0,1,"Warn: %2d.%dV",BattLowVoltageWarning/10,BattLowVoltageWarning%10);
 - 
 
279 
           LCD_printfxy(0,2,"Home: %2d.%dV",BattComingHomeVoltage/10,BattComingHomeVoltage%10);
 - 
 
280 
           LCD_printfxy(0,3,"Land: %2d.%dV",BattAutoLandingVoltage/10,BattAutoLandingVoltage%10);
 - 
 
281 
           break;
 - 
 
282 
    default:
 268 
    default:
283 
           if(MenuePunkt == MaxMenue) MaxMenue--;
 269 
           if(MenuePunkt == MaxMenue) MaxMenue--;
284 
           MenuePunkt = 0;
 270 
           MenuePunkt = 0;
285 
           break;
 271 
           break;
286 
    }
 272 
    }