Rev 253 | Rev 264 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 253 | Rev 254 | ||
---|---|---|---|
Line 312... | Line 312... | ||
312 | LCD_printfxy(0,2,"GyroYaw: %4i", FromFlightCtrl.GyroYaw); |
312 | LCD_printfxy(0,2,"GyroYaw: %4i", FromFlightCtrl.GyroYaw); |
313 | break; |
313 | break; |
314 | case 13: // Remote Control Level from FC |
314 | case 13: // Remote Control Level from FC |
315 | LCD_printfxy(0,0,"RC-Level: %3i", FC.RC_Quality); |
315 | LCD_printfxy(0,0,"RC-Level: %3i", FC.RC_Quality); |
316 | LCD_printfxy(0,1,"Ubat: %2i.%1i V", FC.BAT_Voltage/10, FC.BAT_Voltage%10); |
316 | LCD_printfxy(0,1,"Ubat: %2i.%1i V", FC.BAT_Voltage/10, FC.BAT_Voltage%10); |
317 | LCD_printfxy(0,2,"CompHeading: %3i", CompassHeading); |
317 | LCD_printfxy(0,2,"CompHeading: %3i", Compass_Heading); |
318 | if(GeoMagDec < 0) sign = '-'; |
318 | if(GeoMagDec < 0) sign = '-'; |
319 | else sign = '+'; |
319 | else sign = '+'; |
320 | LCD_printfxy(0,3,"GeoMagDec: %c%i.%1i", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10); |
320 | LCD_printfxy(0,3,"GeoMagDec: %c%i.%1i", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10); |
321 | break; |
321 | break; |
322 | case 14: // User Parameter |
322 | case 14: // User Parameter |
323 | LCD_printfxy(0,0,"UP1:%3i UP2:%3i",Parameter.User1,Parameter.User2); |
323 | LCD_printfxy(0,0,"UP1:%3i UP2:%3i",Parameter.User1,Parameter.User2); |
324 | LCD_printfxy(0,1,"UP3:%3i UP4:%3i",Parameter.User3,Parameter.User4); |
324 | LCD_printfxy(0,1,"UP3:%3i UP4:%3i",Parameter.User3,Parameter.User4); |
325 | LCD_printfxy(0,2,"UP5:%3i UP6:%3i",Parameter.User5,Parameter.User6); |
325 | LCD_printfxy(0,2,"UP5:%3i UP6:%3i",Parameter.User5,Parameter.User6); |
326 | LCD_printfxy(0,3,"UP7:%3i UP8:%3i",Parameter.User7,Parameter.User8); |
326 | LCD_printfxy(0,3,"UP7:%3i UP8:%3i",Parameter.User7,Parameter.User8); |
327 | break; |
327 | break; |
328 | case 15: // MK3MAG |
328 | case 15: // magnetic field |
- | 329 | if(Compass_Device == COMPASS_NCMAG) |
|
- | 330 | { |
|
- | 331 | if(Compass_CalState) |
|
- | 332 | { |
|
- | 333 | LCD_printfxy(0,0,"Calibration:"); |
|
- | 334 | LCD_printfxy(0,1,"Step %d/", Compass_CalState); |
|
- | 335 | LCD_printfxy(0,2,"X %4i Y %4i Z %4i",MagVector.X,MagVector.Y,MagVector.Z); |
|
- | 336 | LCD_printfxy(9,3,"(ESC)(NEXT)"); |
|
- | 337 | switch(Compass_CalState) |
|
- | 338 | { |
|
- | 339 | case 1: |
|
- | 340 | case 3: |
|
- | 341 | LCD_printfxy(7,1,"pause"); |
|
- | 342 | break; |
|
- | 343 | ||
- | 344 | case 2: |
|
- | 345 | LCD_printfxy(7,1,"horizontal"); |
|
- | 346 | break; |
|
- | 347 | ||
- | 348 | case 4: |
|
- | 349 | LCD_printfxy(7,1,"vertical"); |
|
- | 350 | break; |
|
- | 351 | ||
- | 352 | case 5: |
|
- | 353 | LCD_printfxy(7,1,"data saved"); |
|
- | 354 | LCD_printfxy(8,3," (END) "); |
|
- | 355 | break; |
|
- | 356 | ||
- | 357 | default: |
|
- | 358 | break; |
|
- | 359 | } |
|
- | 360 | } |
|
- | 361 | else |
|
- | 362 | { |
|
- | 363 | LCD_printfxy(0,0,"Magnetic Field"); |
|
- | 364 | LCD_printfxy(0,1,"X: %4i",MagVector.X); |
|
- | 365 | LCD_printfxy(0,2,"Y: %4i",MagVector.Y); |
|
- | 366 | LCD_printfxy(0,3,"Z: %4i",MagVector.Z); |
|
- | 367 | LCD_printfxy(13,3,"(CALIB)"); |
|
- | 368 | } |
|
- | 369 | if(Keys & KEY4) // next step |
|
- | 370 | { |
|
- | 371 | if(Compass_CalState <5) Compass_SetCalState(Compass_CalState+1); |
|
- | 372 | else Compass_SetCalState(0); |
|
- | 373 | } |
|
- | 374 | if(Keys & KEY3)Compass_SetCalState(0); // cancel |
|
- | 375 | } |
|
- | 376 | else // other compass |
|
- | 377 | { |
|
329 | Compass_UpdateMagVector(); |
378 | Compass_UpdateMagVector(); |
330 | LCD_printfxy(0,0,"Magnetic Field"); |
379 | LCD_printfxy(0,0,"Magnetic Field"); |
331 | LCD_printfxy(0,1,"MagX: %4i",MagVector.X); |
380 | LCD_printfxy(0,1,"X: %4i",MagVector.X); |
332 | LCD_printfxy(0,2,"MagY: %4i",MagVector.Y); |
381 | LCD_printfxy(0,2,"Y: %4i",MagVector.Y); |
333 | LCD_printfxy(0,3,"MagZ: %4i",MagVector.Z); |
382 | LCD_printfxy(0,3,"Z: %4i",MagVector.Z); |
- | 383 | } |
|
334 | break; |
384 | break; |
335 | default: |
385 | default: |
336 | //MaxMenuItem = MenuItem - 1; |
386 | //MaxMenuItem = MenuItem - 1; |
337 | MenuItem = 0; |
387 | MenuItem = 0; |
338 | break; |
388 | break; |