WebSVN - NaviCtrl - Diff - Rev 190 and 201

 // +  ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 // +  POSSIBILITY OF SUCH DAMAGE.
 // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
 #include <stdlib.h>
 #include "91x_lib.h"
-#include "printf_P.h"
 #include "main.h"
 #include "ubx.h"
 #include "GPS.h"
 #include "timer1.h"
 #include "i2c.h"
 #include "spi_slave.h"
 #include "menu.h"
 #include "uart1.h"
+#include "printf_P.h"
 s8 DisplayBuff[DISPLAYBUFFSIZE] = "Hello World";
+u8 DispPtr = 0;
+s8 DisplayBuff[DISPLAYBUFFSIZE];
 u8 DispPtr = 0;
-u8 MenuItem = 0;
-u8 MaxMenuItem = 15;
-u8 RemoteKeys = 0;
-#define KEY1    0x01
-#define KEY2    0x02
-#define KEY3    0x04
-#define KEY4    0x08
-#define KEY5    0x10
-/************************************/
+u8 MenuItem = 0;
-/*        Clear LCD Buffer          */
+u8 MaxMenuItem = 15;
-/************************************/
-void LCD_Clear(void)
+void Menu_Clear(void)
+{
- u8 i;
- for( i = 0; i < DISPLAYBUFFSIZE; i++) DisplayBuff[i] = ' ';
-}
         u8 i;
+        for( i = 0; i < DISPLAYBUFFSIZE; i++) DisplayBuff[i] = ' ';
 /************************************/
 /*        Update Menu on LCD        */
 /************************************/
-// Display with 20 characters in 4 lines
-void LCD_PrintMenu(void)
-{
+// Display with 20 characters in 4 lines
+void Menu_Update(u8 Keys)
-        s32 i1,i2;
+{
-        u8 sign;
+        s32 i1,i2;
+        u8 sign;
         if(RemoteKeys & KEY1) { if(MenuItem) MenuItem--; else MenuItem = MaxMenuItem;}
-        if(RemoteKeys & KEY2) { if(MenuItem == MaxMenuItem) MenuItem = 0; else MenuItem++;}
+        if(Keys & KEY1) { if(MenuItem > 0) MenuItem--; else MenuItem = MaxMenuItem;}
-        if((RemoteKeys & KEY1) && (RemoteKeys & KEY2)) MenuItem = 0;
+        if(Keys & KEY2) { if(MenuItem == MaxMenuItem) MenuItem = 0; else MenuItem++;}
         if((Keys & KEY1) && (Keys & KEY2)) MenuItem = 0;
-        LCD_Clear();
+        if(MenuItem > MaxMenuItem) MenuItem = MaxMenuItem;
-        if(MenuItem > MaxMenuItem) MenuItem = MaxMenuItem;
+        Menu_Clear();
         // print menu item number in the upper right corner
         if(MenuItem < 10)
+        {
                 LCD_printfxy(17,0,"[%i]",MenuItem);
+        }
-        else
+        else // Menuitem >= 10
+        {
                 LCD_printfxy(16,0,"[%i]",MenuItem);
+        }
         switch(MenuItem)
+        {
                 // Version Info
                 case 0:
                         LCD_printfxy(0,0,"++  Navi-Ctrl  ++");
                         break;
                 case 3:
                         LCD_printfxy(0,0,"GPS UTC Time");
                         if (!SystemTime.Valid)
+                        {
-                                LCD_printfxy(0,0,"GPS UTC Time");
                                 LCD_printfxy(0,1,"                    ");
                                 LCD_printfxy(0,2,"  No time data!     ");
                                 LCD_printfxy(0,3,"                    ");
+                        }
                         else // newdata or processed
+                        {
                                 LCD_printfxy(0,1,"                    ");
                                 LCD_printfxy(0,2,"Date: %02i/%02i/%04i",SystemTime.Month, SystemTime.Day, SystemTime.Year);
                                 LCD_printfxy(0,3,"Time: %02i:%02i:%02i.%03i", SystemTime.Hour, SystemTime.Min, SystemTime.Sec, SystemTime.mSec);
+                        }
                         break;
                 case 4: // Navi Params 1 from FC
                         LCD_printfxy(0,0,"NaviMode: %3i" ,  Parameter.NaviGpsModeControl);
             LCD_printfxy(0,1,"G  :%3i P  :%3i ",Parameter.NaviGpsGain, Parameter.NaviGpsP);
                 case 11: // attitude from FC
                         if(FromFlightCtrl.AngleNick < 0) sign = '-';
                         else sign = '+';
                         i1 = abs(FromFlightCtrl.AngleNick)/10;
                         i2 = abs(FromFlightCtrl.AngleNick)%10;
-                        LCD_printfxy(0,0,"GyroNick:%c%03i.%01i", sign, i1, i2);
+                        LCD_printfxy(0,0,"GyroNick:%c%03ld.%01ld", sign, i1, i2);
                         if(FromFlightCtrl.AngleRoll < 0) sign = '-';
                         else sign = '+';
                         i1 = abs(FromFlightCtrl.AngleRoll)/10;
                         i2 = abs(FromFlightCtrl.AngleRoll)%10;
-            LCD_printfxy(0,1,"GyroRoll:%c%03i.%01i", sign, i1, i2);
+            LCD_printfxy(0,1,"GyroRoll:%c%03ld.%01ld", sign, i1, i2);
                         if(FromFlightCtrl.AccNick < 0) sign = '-';
                         else sign = '+';
                         i1 = abs(FromFlightCtrl.AccNick)/10;
                         i2 = abs(FromFlightCtrl.AccNick)%10;
-                        LCD_printfxy(0,2," AccNick:%c%03i.%01i", sign, i1, i2);
+                        LCD_printfxy(0,2," AccNick:%c%03ld.%01ld", sign, i1, i2);
                         if(FromFlightCtrl.AccRoll < 0) sign = '-';
                         else sign = '+';
                         i1 = abs(FromFlightCtrl.AccRoll)/10;
                         i2 = abs(FromFlightCtrl.AccRoll)%10;
-            LCD_printfxy(0,3," AccRoll:%c%03i.%01i", sign, i1, i2);
+            LCD_printfxy(0,3," AccRoll:%c%03ld.%01ld", sign, i1, i2);
                         break;
                 case 12: // 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);
                         LCD_printfxy(0,1,"MagX: %4i ",I2C_Mag.MagX);
                         LCD_printfxy(0,2,"MagY: %4i ",I2C_Mag.MagY);
                         LCD_printfxy(0,3,"MagZ: %4i ",I2C_Mag.MagZ);
                         break;
                 default:
-                        MaxMenuItem = MenuItem - 1;
+                        //MaxMenuItem = MenuItem - 1;
                         MenuItem = 0;
                         break;
+    }
-        RemoteKeys = 0;
+}

Subversion Repositories NaviCtrl

(root)/tags/V2.10b/menu.c @ 633 - Rev 190 → 201