Subversion Repositories NaviCtrl

Rev

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

Rev 686 Rev 688
Line 74... Line 74...
74 
u8 DispPtr = 0;
 74 
u8 DispPtr = 0;
75 
s8 DisplayBuff[DISPLAYBUFFSIZE];
 75 
s8 DisplayBuff[DISPLAYBUFFSIZE];
Line 76... Line 76...
76 
 
 76 
 
77 
 
 77 
 
Line 78... Line 78...
78 
u8 MenuItem = 0;
 78 
u8 MenuItem = 0;
79 
u8 MaxMenuItem = 27;
 79 
u8 MaxMenuItem = 28;
80 
 
 80 
 
81 
void Menu_Putchar(char c)
 81 
void Menu_Putchar(char c)
Line 349... Line 349...
349 
                        if(FromFlightCtrl.AngleRoll < 0) sign = '-';
 349 
                        if(FromFlightCtrl.AngleRoll < 0) sign = '-';
350 
                        else sign = '+';
 350 
                        else sign = '+';
351 
                        i1 = abs(FromFlightCtrl.AngleRoll)/10;
 351 
                        i1 = abs(FromFlightCtrl.AngleRoll)/10;
352 
                        i2 = abs(FromFlightCtrl.AngleRoll)%10;
 352 
                        i2 = abs(FromFlightCtrl.AngleRoll)%10;
353 
            LCD_printfxy(0,1,"GyroRoll:%c%03ld.%01ld", sign, i1, i2);
 353 
            LCD_printfxy(0,1,"GyroRoll:%c%03ld.%01ld", sign, i1, i2);
354 
                        if(FromFlightCtrl.AccNick < 0) sign = '-';
 354 
                        if(FromFlightCtrl_AccNick < 0) sign = '-';
355 
                        else sign = '+';
 355 
                        else sign = '+';
356 
                        i1 = abs(FromFlightCtrl.AccNick)/10;
 356 
                        i1 = abs(FromFlightCtrl_AccNick)/10;
357 
                        i2 = abs(FromFlightCtrl.AccNick)%10;
 357 
                        i2 = abs(FromFlightCtrl_AccNick)%10;
358 
                        LCD_printfxy(0,2," AccNick:%c%03ld.%01ld", sign, i1, i2);
 358 
                        LCD_printfxy(0,2," AccNick:%c%03ld.%01ld", sign, i1, i2);
359 
                        if(FromFlightCtrl.AccRoll < 0) sign = '-';
 359 
                        if(FromFlightCtrl_AccRoll < 0) sign = '-';
360 
                        else sign = '+';
 360 
                        else sign = '+';
361 
                        i1 = abs(FromFlightCtrl.AccRoll)/10;
 361 
                        i1 = abs(FromFlightCtrl_AccRoll)/10;
362 
                        i2 = abs(FromFlightCtrl.AccRoll)%10;
 362 
                        i2 = abs(FromFlightCtrl_AccRoll)%10;
363 
            LCD_printfxy(0,3," AccRoll:%c%03ld.%01ld", sign, i1, i2);
 363 
            LCD_printfxy(0,3," AccRoll:%c%03ld.%01ld", sign, i1, i2);
364 
                        break;
 364 
                        break;
365 
                case 14: // gyros from FC
 365 
                case 14:
366 
                        LCD_printfxy(0,0,"GyroNick:  %4i", FromFlightCtrl.GyroNick);
 366 
                        LCD_printfxy(0,0,"Analog inputs");
367 
            LCD_printfxy(0,1,"GyroRoll:  %4i", FromFlightCtrl.GyroRoll);
 367 
                        LCD_printfxy(0,1,"A5:%3i  ",AnalogData.Ch5);
368 
                        LCD_printfxy(0,2,"GyroYaw:   %4i", FromFlightCtrl.GyroYaw);
 368 
                        LCD_printfxy(0,2,"A6:%3i  ",AnalogData.Ch6);
369 
                        if(FC_is_Calibrated)    LCD_printfxy(0,3,"Calibrated    ")
 - 
 
370 
                        else                                    LCD_printfxy(0,3,"not calibrated");
 369 
                        LCD_printfxy(0,3,"A7:%3i  ",AnalogData.Ch7);
371 
                        break;
 370 
                        break;
372 
                case 15:
 371 
                case 15:
373 
                        LCD_printfxy(0,0,"Compass:    %3i", FromFlightCtrl.GyroHeading / 10);
 372 
                        LCD_printfxy(0,0,"Compass:    %3i", FromFlightCtrl.GyroHeading / 10);
374 
                        LCD_printfxy(0,1,"Man.-Offset:%3i", FC.FromFC_CompassOffset / 10);
 373 
                        LCD_printfxy(0,1,"Man.-Offset:%3i", FC.FromFC_CompassOffset / 10);
375 
                        if(FC.FromFC_DisableDeclination)
 374 
                        if(FC.FromFC_DisableDeclination)
Line 578... Line 577...
578 
                        LCD_printfxy(0,1,"A2:%3i  A3:%3i",AnalogData.Ch2,AnalogData.Ch3);
 577 
                        LCD_printfxy(0,1,"A2:%3i  A3:%3i",AnalogData.Ch2,AnalogData.Ch3);
579 
                        LCD_printfxy(0,2,"A4:%3i  A5:%3i",AnalogData.Ch4,AnalogData.Ch5);
 578 
                        LCD_printfxy(0,2,"A4:%3i  A5:%3i",AnalogData.Ch4,AnalogData.Ch5);
580 
                        LCD_printfxy(0,3,"A6:%3i  A7:%3i",AnalogData.Ch6,AnalogData.Ch7);
 579 
                        LCD_printfxy(0,3,"A6:%3i  A7:%3i",AnalogData.Ch6,AnalogData.Ch7);
581 
                        break;
 580 
                        break;
582 
*/
 581 
*/
- 
 
 582 
 
- 
 
 583 
                case 28:
- 
 
 584 
//                      LCD_printfxy(0,0,"PPM Input");
- 
 
 585 
/*
- 
 
 586 
                        LCD_printfxy(0,0,"%4i %4i %4i %4i",PPM_In[1],PPM_In[2],PPM_In[3],PPM_In[4]);
- 
 
 587 
                        LCD_printfxy(0,1,"%4i %4i %4i %4i",PPM_In[5],PPM_In[6],PPM_In[7],PPM_In[8]);
- 
 
 588 
                        LCD_printfxy(0,2,"%4i %4i %4i %4i",PPM_In[9],PPM_In[10],PPM_In[11],PPM_In[12]);
- 
 
 589 
                        LCD_printfxy(0,3,"%4i %4i %4i %4i",PPM_In[13],PPM_In[14],PPM_In[15],PPM_In[16]);
- 
 
 590 
*/
- 
 
 591 
                        LCD_printfxy(0,0,"%4i %4i %4i %4i",PPM_In[17],PPM_In[18],PPM_In[19],PPM_In[20]);
- 
 
 592 
                        LCD_printfxy(0,1,"%4i %4i %4i %4i",PPM_In[21],PPM_In[22],PPM_In[23],PPM_In[24]);
- 
 
 593 
                        LCD_printfxy(0,2,"%4i %4i %4i %4i",PPM_In[25],PPM_In[26],PPM_In[27],PPM_In[28]);
- 
 
 594 
                        LCD_printfxy(0,3,"%4i %4i %4i %4i",PPM_In[29],PPM_In[30],PPM_In[31],PPM_In[32]);
- 
 
 595 
                        break;
583 
                default:
 596 
                default:
584 
                        //MaxMenuItem = MenuItem - 1;
 597 
                        //MaxMenuItem = MenuItem - 1;
585 
                        MenuItem = 0;
 598 
                        MenuItem = 0;
586 
                        break;
 599 
                        break;
587 
    }
 600 
    }