WebSVN - NaviCtrl - Diff - Rev 486 and 489

 #include "menu.h"
 #include "uart1.h"
 #include "ncmag.h"
 #include "logging.h"
 #include "settings.h"
-#include "gpx.h"
 u8 DispPtr = 0;
+{
         u8 i;
         for( i = 0; i < DISPLAYBUFFSIZE; i++) DisplayBuff[i] = ' ';
+}
 // Display with 20 characters in 4 lines
 void Menu_Update(u8 Keys)
+{
         s32 i1,i2;
         switch(MenuItem)
+        {
                 // Version Info
                 case 0:
                         LCD_printfxy(0,0,"++  Navi-Ctrl  ++");
-                        LCD_printfxy(0,1,"HW V%d.%d SW V%d.%02d%c", (Version_HW & 0x7f)/10, (Version_HW & 0x7f)%10, VERSION_MAJOR, VERSION_MINOR, 'a'+ VERSION_PATCH);
+                        LCD_printfxy(0,1,"HW V%d.%d SW V%d.%02d%c", (Version_HW & 0x7F)/10, (Version_HW & 0x7F)%10, VERSION_MAJOR, VERSION_MINOR, 'a'+ VERSION_PATCH);
             if(ErrorCode)
+                        {
                                 LCD_printfxy(0,2,"Error: %d",ErrorCode);
                 LCD_printfxy(0,3,"%s",ErrorMSG);
                         }
                         else
+                        {
                          LCD_printfxy(0,3,"(c) HiSystems GmbH");
                          LCD_printfxy(0,2,"%s",ErrorMSG);
+                        }
                         break;
                         break;
                 case 14: // gyros from FC
                         LCD_printfxy(0,0,"GyroNick:  %4i", FromFlightCtrl.GyroNick);
             LCD_printfxy(0,1,"GyroRoll:  %4i", FromFlightCtrl.GyroRoll);
                         LCD_printfxy(0,2,"GyroYaw:   %4i", FromFlightCtrl.GyroYaw);
-                        if(FC_is_Calibrated) LCD_printfxy(0,3,"Calibrated    ") else LCD_printfxy(0,3,"not calibrated");
+                        if(FC_is_Calibrated)    LCD_printfxy(0,3,"Calibrated    ")
+                        else                                    LCD_printfxy(0,3,"not calibrated");
                         break;
                 case 15:
 //                      LCD_printfxy(0,0,"Ubat:   %2i.%1i V", FC.BAT_Voltage/10, FC.BAT_Voltage%10);
                         LCD_printfxy(0,0,"Compass:    %3i", FromFlightCtrl.GyroHeading / 10);
                         LCD_printfxy(0,1,"Man.-Offset:%3i", FC.FromFC_CompassOffset / 10);
                         if(FC.FromFC_DisableDeclination)
+                        {
-                         LCD_printfxy(0,2,"Mag.Declinat.:disabl");
+                                LCD_printfxy(0,2,"Mag.Declinat.:disabl");
+                        }
                         else
+                        {
-                         if(GeoMagDec < 0) sign = '-';
+                                if(GeoMagDec < 0) sign = '-';
-                         else sign = '+';
+                                else sign = '+';
-                         LCD_printfxy(0,2,"Mag.Declinat.:%c%i.%1i", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10);
+                                LCD_printfxy(0,2,"Mag.Declinat.:%c%i.%1i", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10);
+                        }
                         LCD_printfxy(0,3,"True Compass: %3i", GyroCompassCorrected/10);
             break;
                 case 16: // User Parameter
                         LCD_printfxy(0,0,"UP1:%3i  UP2:%3i",Parameter.User1,Parameter.User2);
                                         case 5:
                                                 LCD_printfxy(7,1,"data saved");
                                                 LCD_printfxy(8,3,"      (END) ");
                                                 break;
                                         default:
                                                 break;
+                                }
+                        }
                                 LCD_printfxy(0,0,"Magnetic Field");
                                 LCD_printfxy(0,1,"X:%5i",MagVector.X);
                                 LCD_printfxy(0,2,"Y:%5i",MagVector.Y);
                                 LCD_printfxy(0,3,"Z:%5i",MagVector.Z);
                                 LCD_printfxy(8,1,"Field:%3i",EarthMagneticField/5);
-                                if(I2C_CompassPort == I2C_EXTERN_0) LCD_printfxy(11,2,"Extern %d",ExtCompassOrientation) else LCD_printfxy(11,2,"Intern");
+                                if(Compass_I2CPort == NCMAG_PORT_EXTERN)        LCD_printfxy(11,2,"Extern")
+                                else                                                                            LCD_printfxy(11,2,"Intern");
 //                              LCD_printfxy(8,2,"Dec:%c%i.%1i", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10);
 //                              LCD_printfxy(8,3,"Inc:%2i", EarthMagneticInclination);
                                 LCD_printfxy(15,3,"(CAL)");
+                        }
                         if(Keys & KEY4) //  next step
                                 if(Compass_CalState <5) Compass_SetCalState(Compass_CalState+1);
                                 else Compass_SetCalState(0);
+                        }
                         if(Keys & KEY3)Compass_SetCalState(0);  // cancel
                         break;
                 case 19:
                         if(GeoMagDec < 0) sign = '-';
                         else sign = '+';
                                 LCD_printfxy(0,0,"Magnetic Field");
                                 LCD_printfxy(0,1,"Field:%3i (Percent)",EarthMagneticField/5);
                                 LCD_printfxy(0,2,"Declination:%c%i.%1i ", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10);
                                 LCD_printfxy(0,3,"Inclination:%2i (%2i)", EarthMagneticInclination,     EarthMagneticInclinationTheoretic);
                         break;
                 case 20:
                         LCD_printfxy(0,0,"SD-Setting      ");
                         LCD_printfxy(0,2,"WP-Dynamic:%4i ",WaypointAcceleration);
                         break;
                 case 21:
                         LCD_printfxy(0,0,"CPU Processing  ");
                         LCD_printfxy(0,2,"GPS-Data:  %2i.%iHz ",FreqNewGpsDataIn5Sec/10, FreqNewGpsDataIn5Sec%10);
                         LCD_printfxy(0,3,"GPS-Update:%2i.%iHz ",FreqGpsProcessedIn5Sec/10, FreqGpsProcessedIn5Sec%10);
                         if(FreqNewGpsDataIn5Sec >= 48 && FreqNewGpsDataIn5Sec <= 52) LCD_printfxy(18,2,"OK") else LCD_printfxy(18,2,"!!");
                         if(FreqGpsProcessedIn5Sec >= 350) LCD_printfxy(18,3,"OK") else LCD_printfxy(18,3,"!!");
                         break;
                 case 22:
-           LCD_printfxy(0,0,"BL Current" );
+                        LCD_printfxy(0,0,"BL Current" );
-           LCD_printfxy(11,3,"(in 0.1A)" );
+                        LCD_printfxy(11,3,"(in 0.1A)" );
-                   for(i1 = 0; i1 < 3; i1++)
+                        for(i1 = 0; i1 < 3; i1++)
-                    {
+                        {
                      LCD_printfxy(0,i1+1,"%3d %3d %3d %3d ",BL3_Current(i1*4),BL3_Current(i1*4+1),BL3_Current(i1*4+2),BL3_Current(i1*4+3));
                          if(Motor[4 + i1 * 4].State == 0) break;
                         }
                         break;
                 case 23:
-           LCD_printfxy(0,0,"Ext. Compass" );
+                        LCD_printfxy(0,0,"Ext. Compass" );
-                          if(I2C_CompassPort == I2C_EXTERN_0)
+                        if(Compass_I2CPort == NCMAG_PORT_EXTERN)
-                           {
+                        {
                              u8 tmp;
                          LCD_printfxy(0,1,"ACC  X      Y      Z");
-                         LCD_printfxy(0,2," %5d  %5d  %5d",AccRawVector.X/40,AccRawVector.Y/40,AccRawVector.Z/40);
+                         LCD_printfxy(0,2," %5d  %5d  %5d", AccVector.X/40, AccVector.Y/40, AccVector.Z/40);
-                                 tmp = GetExtCompassOrientation();
+                                 tmp = NCMAG_GetOrientationFromAcc();
                                  LCD_printfxy(0,3,"Orientat.: ");
                                  if(!tmp) LCD_printfxy(11,3,"??") else LCD_printfxy(11,3,"%2d",tmp);
-                                 LCD_printfxy(15,3,"(%d)",ExtCompassOrientation);
+                                 LCD_printfxy(15,3,"(%d)",NCMAG_Orientation);
-                           }
+                        }
-                           else
+                        else
-                           {
+                        {
-                            LCD_printfxy(0,1,"Not connected");
+                                LCD_printfxy(0,1,"Not connected");
-                           }
+                        }
                         break;
                 default:
                         //MaxMenuItem = MenuItem - 1;
                         MenuItem = 0;
                         break;

Subversion Repositories NaviCtrl

(root)/tags/V2.08a/menu.c @ 882 - Rev 486 → 489