Subversion Repositories NaviCtrl

Rev

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

Rev 139 Rev 153
Line 314... Line 314...
314
            LCD_printfxy(0,1,"GyroRoll:  %4i", FromFlightCtrl.GyroRoll);
314
            LCD_printfxy(0,1,"GyroRoll:  %4i", FromFlightCtrl.GyroRoll);
315
                        LCD_printfxy(0,2,"GyroYaw:   %4i", FromFlightCtrl.GyroYaw);
315
                        LCD_printfxy(0,2,"GyroYaw:   %4i", FromFlightCtrl.GyroYaw);
316
                        break;
316
                        break;
317
                case 12: // Remote Control Level from FC
317
                case 12: // Remote Control Level from FC
318
            LCD_printfxy(0,0,"RC-Level:    %3i", FC.RC_Quality);
318
            LCD_printfxy(0,0,"RC-Level:    %3i", FC.RC_Quality);
319
                        LCD_printfxy(0,1,"Ubat:        %3i.%1i V", FC.UBat/10, FC.UBat%10);
319
                        LCD_printfxy(0,1,"Ubat:        %2i.%1i V", FC.UBat/10, FC.UBat%10);
320
                        LCD_printfxy(0,2,"CompHeading: %3i", I2C_Heading.Heading);
320
                        LCD_printfxy(0,2,"CompHeading: %3i", I2C_Heading.Heading);
-
 
321
                        if(GeoMagDec < 0) sign = '-';
-
 
322
                        else sign = '+';
321
                        LCD_printfxy(0,3,"GyroHeading: %3i", FromFlightCtrl.GyroHeading/10);
323
                        LCD_printfxy(0,3,"GeoMagDec:  %c%i.%1i", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10);
322
            break;
324
            break;
323
                case 13: // User Parameter
325
                case 13: // User Parameter
324
                        LCD_printfxy(0,0,"UP1:%3i  UP2:%3i ",Parameter.User1,Parameter.User2);
326
                        LCD_printfxy(0,0,"UP1:%3i  UP2:%3i",Parameter.User1,Parameter.User2);
325
                        LCD_printfxy(0,1,"UP3:%3i  UP4:%3i ",Parameter.User3,Parameter.User4);
327
                        LCD_printfxy(0,1,"UP3:%3i  UP4:%3i",Parameter.User3,Parameter.User4);
326
                        LCD_printfxy(0,2,"UP5:%3i  UP6:%3i ",Parameter.User5,Parameter.User6);
328
                        LCD_printfxy(0,2,"UP5:%3i  UP6:%3i",Parameter.User5,Parameter.User6);
327
                        LCD_printfxy(0,3,"UP7:%3i  UP8:%3i ",Parameter.User7,Parameter.User8);
329
                        LCD_printfxy(0,3,"UP7:%3i  UP8:%3i",Parameter.User7,Parameter.User8);
328
                        break;
330
                        break;
329
                case 14: // MK3MAG
331
                case 14: // MK3MAG
330
                        I2C1_SendCommand(I2C_CMD_READ_MAG);
332
                        I2C1_SendCommand(I2C_CMD_READ_MAG);
331
                        LCD_printfxy(0,0,"MK3MAG V%i.%i%c",MK3MAG_Version.Major, MK3MAG_Version.Minor, 'a'+ MK3MAG_Version.Patch);
333
                        LCD_printfxy(0,0,"MK3MAG V%i.%i%c",MK3MAG_Version.Major, MK3MAG_Version.Minor, 'a'+ MK3MAG_Version.Patch);
332
                        LCD_printfxy(0,1,"MagX: %4i  GEO:%4i",I2C_Mag.MagX, GeoMag);
334
                        LCD_printfxy(0,1,"MagX: %4i ",I2C_Mag.MagX);
333
                        LCD_printfxy(0,2,"MagY: %4i ",I2C_Mag.MagY);
335
                        LCD_printfxy(0,2,"MagY: %4i ",I2C_Mag.MagY);
334
                        LCD_printfxy(0,3,"MagZ: %4i ",I2C_Mag.MagZ);
336
                        LCD_printfxy(0,3,"MagZ: %4i ",I2C_Mag.MagZ);
335
                        break;
337
                        break;
336
                default:
338
                default:
337
                        MaxMenuItem = MenuItem - 1;
339
                        MaxMenuItem = MenuItem - 1;