WebSVN - FlightCtrl - Diff - Rev 1740 and 1742 - /branches/MartinW


#include "jetimenu.h"
#include "libfc.h"
#include "printf_P.h"
#include "main.h"
#include "spi.h"
#include "capacity.h"
 
#define JETIBOX_KEY_RIGHT       0x1F
#define JETIBOX_KEY_UP          0x2F
#define JETIBOX_KEY_DOWN        0x4F
#define JETIBOX_KEY_LEFT        0x8F
#define JETIBOX_KEY_NONE        0x0F
#define JETIBOX_KEY_UNDEF       0x00
 
#define JetiBox_printfxy(x,y,format, args...)  { LIBFC_JetiBox_SetPos(y * 16 + x); _printf_P(&LIBFC_JetiBox_Putchar, PSTR(format) , ## args);}
#define JetiBox_printf(format, args...)        {  _printf_P(&LIBFC_JetiBox_Putchar, PSTR(format) , ## args);}
 
// -----------------------------------------------------------
// the menu functions
// -----------------------------------------------------------
 
void Menu_Status(uint8_t key)
{                                               //0123456789ABCDEF
        JetiBox_printfxy(0,0,"%2i.%1iV",UBat/10, UBat%10);
        if(NaviDataOkay)
        {
//              JetiBox_printfxy(6,0,"%03dm %03d%c", GPSInfo.HomeDistance/10,GPSInfo.HomeBearing, 0xDF);
                JetiBox_printfxy(6,0,"%3d%c %03dm",(int)(ErsatzKompass / GIER_GRAD_FAKTOR), 0xDF, GPSInfo.HomeDistance/10);
        }
        else
        {
                JetiBox_printfxy(6,0,"Status");
        }
        if(NC_ErrorCode) JetiBox_printfxy(6,0,"ERROR: %2d",NC_ErrorCode);
        JetiBox_printfxy(0,1,"%4i %2i:%02i",Capacity.UsedCapacity,FlugSekunden/60,FlugSekunden%60);
        if(EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)
        {
                JetiBox_printfxy(10,1,"%4im%c", (int16_t)(HoehenWert/100),VarioCharacter);
        }
}
 
 
void Menu_Temperature(uint8_t key)
{                       //0123456789ABCDEF
  JetiBox_printfxy(0,0,"%3i %3i %3i %3i", Motor[0].Temperature, Motor[1].Temperature, Motor[2].Temperature, Motor[3].Temperature);
  JetiBox_printfxy(0,1,"%3i %3i %3i %3i", Motor[4].Temperature, Motor[5].Temperature, Motor[6].Temperature, Motor[7].Temperature);
  if(RequiredMotors <= 4)
        {
         JetiBox_printfxy(0,1,"Temperatures    ");
    }
        else
    if(RequiredMotors <= 6)
        {
         JetiBox_printfxy(8,1,"\%cC     ",0xdf);
        }
 
}
 
void Menu_Battery(uint8_t key)
{                       //0123456789ABCDEF
        JetiBox_printfxy(0,0,"%2i.%1iV  %3i.%1iA", UBat/10, UBat%10, Capacity.ActualCurrent/10, Capacity.ActualCurrent%10);
        //1
        JetiBox_printfxy(0,1,"%4iW %6imAH",Capacity.ActualPower, Capacity.UsedCapacity);
        //1
}
 
 
void Menu_PosInfo(uint8_t key)
{
        if(NaviDataOkay)
        {
                JetiBox_printfxy(0,0,"%2um/s Sat:%d ",GPSInfo.Speed,GPSInfo.NumOfSats);
                switch (GPSInfo.SatFix)
                {
                        case SATFIX_3D:
                                JetiBox_printfxy(12,0,"  3D");
                                break;
 
                        case SATFIX_2D:
                        case SATFIX_NONE:
                        default:
                                JetiBox_printfxy(12,0,"NoFx");
                                break;
                }
                if(GPSInfo.Flags & FLAG_DIFFSOLN)
                {
                        JetiBox_printfxy(12,0,"DGPS");
                }
                JetiBox_printfxy(0,1,"Home:%3dm %3d%c", GPSInfo.HomeDistance/10, GPSInfo.HomeBearing, 0xDF);
        }
        else
        {                     //0123456789ABCDEF
                JetiBox_printfxy(2,0,"No NaviCtrl!");
        }
}
 
//1 
void Menu_Current(uint8_t key)
{                       //0123456789ABCDEF
 
       
                JetiBox_printfxy(0,0,"%3i %3i %3i %3i", Motor[0].Current-12, Motor[1].Current-12, Motor[2].Current-12, Motor[3].Current-12);
                JetiBox_printfxy(0,1,"%3i %3i %3i %3i", Motor[4].Current-12, Motor[5].Current-12, Motor[6].Current-12, Motor[7].Current-12);
                if(RequiredMotors <= 4)
                {
                JetiBox_printfxy(0,1,"Currents    ");
                }
                else
                if(RequiredMotors <= 6)
                {
                JetiBox_printfxy(8,1,"%3i.%1iA ",Capacity.ActualCurrent/10, Capacity.ActualCurrent%10);
                }
       
 
}
//1
//1 
void Menu_SetPoint(uint8_t key)
{                       //0123456789ABCDEF
  JetiBox_printfxy(0,0,"%3i %3i %3i %3i", Motor[0].SetPoint, Motor[1].SetPoint, Motor[2].SetPoint, Motor[3].SetPoint);
  JetiBox_printfxy(0,1,"%3i %3i %3i %3i", Motor[4].SetPoint, Motor[5].SetPoint, Motor[6].SetPoint, Motor[7].SetPoint);
  if(RequiredMotors <= 4)
        {
         JetiBox_printfxy(0,1,"M SetPoint      ");
    }
        else
    if(RequiredMotors <= 6)
        {
         JetiBox_printfxy(8,1,"MSetP   ");
        }
 
}
 
void Menu_Integal(uint8_t key)
{                       //0123456789ABCDEF
int r=0;
int n=0;
int g=0;
n=SummeNick >> 9;
r=SummeRoll >> 9;
g=Mess_Integral_Gier >> 9;
 
        JetiBox_printfxy(0,0,"%3iN %3iR  +N",n, r);
        JetiBox_printfxy(0,1,"%3iG    +R -N -R",g);
        //1
       
 
}
 
void Menu_Info(uint8_t key)
{                       //0123456789ABCDEF
 
        JetiBox_printfxy(0,0,"%3i=Hovergas",HoverGas);
        JetiBox_printfxy(0,1,"%3i=HG/4 %3i=Gas",HoverGas/4,StickGas);
}
 
void Menu_spoti1(uint8_t key)
{                       //0123456789ABCDEF
 
        JetiBox_printfxy(0,0,">%3i=Serialpot1",PPM_in[13]);
        JetiBox_printfxy(0,1," %3i=Serialpot2",PPM_in[14]);
        if(key== JETIBOX_KEY_UP) PPM_in[13] = PPM_in[13]+1;
        if(key== JETIBOX_KEY_DOWN) PPM_in[13] = PPM_in[13]-1;
}
 
void Menu_spoti2(uint8_t key)
{                       //0123456789ABCDEF
 
        JetiBox_printfxy(0,0," %3i=Serialpot1",PPM_in[13]);
        JetiBox_printfxy(0,1,">%3i=Serialpot2",PPM_in[14],key);
        if(key== JETIBOX_KEY_UP) PPM_in[14] = PPM_in[14]+5;
        if(key== JETIBOX_KEY_DOWN) PPM_in[14] = PPM_in[14]-5;
}
void Menu_hoeheD(uint8_t key)
{                       //0123456789ABCDEF
 
        JetiBox_printfxy(0,0,">%3i=HD",EE_Parameter.Luftdruck_D);
        JetiBox_printfxy(0,1," %3i=HP",EE_Parameter.Hoehe_P);
        if(key== JETIBOX_KEY_UP) EE_Parameter.Luftdruck_D = EE_Parameter.Luftdruck_D+1;
        if(key== JETIBOX_KEY_DOWN) EE_Parameter.Luftdruck_D = EE_Parameter.Luftdruck_D-1;
}
void Menu_hoeheP(uint8_t key)
{                       //0123456789ABCDEF
 
        JetiBox_printfxy(0,0," %3i=HD",EE_Parameter.Luftdruck_D);
        JetiBox_printfxy(0,1,">%3i=HP",EE_Parameter.Hoehe_P);
        if(key== JETIBOX_KEY_UP) EE_Parameter.Hoehe_P = EE_Parameter.Hoehe_P+1;
        if(key== JETIBOX_KEY_DOWN) EE_Parameter.Hoehe_P = EE_Parameter.Hoehe_P-1;
}
//#define JETIBOX_KEY_UP        0x2F
//#define JETIBOX_KEY_DOWN      0x4F
//unsigned char Parameter_Luftdruck_D  = 48;      // Wert : 0-250
//unsigned char Parameter_Hoehe_P      = 16;      // Wert : 0-32
//CHK_POTI_MM(Parameter_Luftdruck_D,EE_Parameter.Luftdruck_D,0,100);
//CHK_POTI_MM(Parameter_Hoehe_P,EE_Parameter.Hoehe_P,0,100);
 
 
 
//1
// -----------------------------------------------------------
// the menu topology
// -----------------------------------------------------------
typedef void (*pFctMenu) (uint8_t);  // the menu item handler function pointer
 
typedef struct{
  int8_t left;
  int8_t right;
  int8_t up;
  int8_t down;
  pFctMenu pHandler;
} MENU_ENTRY;
 
 
// the menu navigation structure
/*                                              |
 
3 - 0 - 1 - 2 - 3 - 0
 
*/
 
const MENU_ENTRY JetiBox_Menu[] PROGMEM=
{ // l  r  u  d  pHandler links rechts up down
        {11, 1, 0, 0, &Menu_Status },   // 0 ///
        {0, 2, 1, 1, &Menu_Temperature },       // 1
        {1, 3, 2, 2, &Menu_Battery },   // 2
        {2, 4, 3, 3, &Menu_PosInfo },   // 3
        //1
        {3, 5, 4, 4, &Menu_Current },   // 4 ///
        {4, 6, 5, 5, &Menu_SetPoint },  // 5 ///
        {5, 7, 6, 6, &Menu_Integal },   // 6 ///
        {6, 8, 7, 7, &Menu_Info },      // 7 ///
        {7, 9, 8, 8, &Menu_spoti1 },    // 8 ///
        {8, 10, 9, 9, &Menu_spoti2 },   // 9 ///
 
 
        {9, 11, 10, 10, &Menu_hoeheD }, // 10 ///
        {10, 0, 11, 11, &Menu_hoeheP }, // 11 ///
       
        //1
};
 
// -----------------------------------------------------------
// Update display buffer
// -----------------------------------------------------------
unsigned char JetiBox_Update(unsigned char key)
{
        static uint8_t item = 0, last_item = 0; // the menu item
 
        // navigate within the menu by key action
        last_item = item;
        switch(key)
        {
                case JETIBOX_KEY_LEFT:
                        if (item == 0) return (1);                                                                      // switch back to jeti expander menu
                         else item = pgm_read_byte(&JetiBox_Menu[item].left);           //trigger to left menu item
                        break;
                case JETIBOX_KEY_RIGHT:
                        item = pgm_read_byte(&JetiBox_Menu[item].right);        //trigger to right menu item
                        break;
                case JETIBOX_KEY_UP:   
 
 
 
                        item = pgm_read_byte(&JetiBox_Menu[item].up);           //trigger to up menu item
                        break;
                case JETIBOX_KEY_DOWN:
 
 
 
                        item = pgm_read_byte(&JetiBox_Menu[item].down);         //trigger to down menu item
                        break;
                default:
                        break;
        }
        // if the menu item has been changed, do not pass the key to the item handler
        // to avoid jumping over to items
        if(item != last_item) key = JETIBOX_KEY_UNDEF;
 
        LIBFC_JetiBox_Clear();
        //execute menu item handler
        ((pFctMenu)(pgm_read_word(&(JetiBox_Menu[item].pHandler))))(key);
       
        return (0);
}
 
 

Rev 1740	Rev 1742
1	#include "jetimenu.h"	1	#include "jetimenu.h"
2	#include "libfc.h"	2	#include "libfc.h"
3	#include "printf_P.h"	3	#include "printf_P.h"
4	#include "main.h"	4	#include "main.h"
5	#include "spi.h"	5	#include "spi.h"
6	#include "capacity.h"	6	#include "capacity.h"
7		7
8	#define JETIBOX_KEY_RIGHT 0x1F	8	#define JETIBOX_KEY_RIGHT 0x1F
9	#define JETIBOX_KEY_UP 0x2F	9	#define JETIBOX_KEY_UP 0x2F
10	#define JETIBOX_KEY_DOWN 0x4F	10	#define JETIBOX_KEY_DOWN 0x4F
11	#define JETIBOX_KEY_LEFT 0x8F	11	#define JETIBOX_KEY_LEFT 0x8F
12	#define JETIBOX_KEY_NONE 0x0F	12	#define JETIBOX_KEY_NONE 0x0F
13	#define JETIBOX_KEY_UNDEF 0x00	13	#define JETIBOX_KEY_UNDEF 0x00
14		14
15	#define JetiBox_printfxy(x,y,format, args...) { LIBFC_JetiBox_SetPos(y * 16 + x); _printf_P(&LIBFC_JetiBox_Putchar, PSTR(format) , ## args);}	15	#define JetiBox_printfxy(x,y,format, args...) { LIBFC_JetiBox_SetPos(y * 16 + x); _printf_P(&LIBFC_JetiBox_Putchar, PSTR(format) , ## args);}
16	#define JetiBox_printf(format, args...) { _printf_P(&LIBFC_JetiBox_Putchar, PSTR(format) , ## args);}	16	#define JetiBox_printf(format, args...) { _printf_P(&LIBFC_JetiBox_Putchar, PSTR(format) , ## args);}
17		17
18	// -----------------------------------------------------------	18	// -----------------------------------------------------------
19	// the menu functions	19	// the menu functions
20	// -----------------------------------------------------------	20	// -----------------------------------------------------------
21		21
22	void Menu_Status(uint8_t key)	22	void Menu_Status(uint8_t key)
23	{ //0123456789ABCDEF	23	{ //0123456789ABCDEF
24	JetiBox_printfxy(0,0,"%2i.%1iV",UBat/10, UBat%10);	24	JetiBox_printfxy(0,0,"%2i.%1iV",UBat/10, UBat%10);
25	if(NaviDataOkay)	25	if(NaviDataOkay)
26	{	26	{
27	// JetiBox_printfxy(6,0,"%03dm %03d%c", GPSInfo.HomeDistance/10,GPSInfo.HomeBearing, 0xDF);	27	// JetiBox_printfxy(6,0,"%03dm %03d%c", GPSInfo.HomeDistance/10,GPSInfo.HomeBearing, 0xDF);
28	JetiBox_printfxy(6,0,"%3d%c %03dm",(int)(ErsatzKompass / GIER_GRAD_FAKTOR), 0xDF, GPSInfo.HomeDistance/10);	28	JetiBox_printfxy(6,0,"%3d%c %03dm",(int)(ErsatzKompass / GIER_GRAD_FAKTOR), 0xDF, GPSInfo.HomeDistance/10);
29	}	29	}
30	else	30	else
31	{	31	{
32	JetiBox_printfxy(6,0,"Status");	32	JetiBox_printfxy(6,0,"Status");
33	}	33	}
34	if(NC_ErrorCode) JetiBox_printfxy(6,0,"ERROR: %2d",NC_ErrorCode);	34	if(NC_ErrorCode) JetiBox_printfxy(6,0,"ERROR: %2d",NC_ErrorCode);
35	JetiBox_printfxy(0,1,"%4i %2i:%02i",Capacity.UsedCapacity,FlugSekunden/60,FlugSekunden%60);	35	JetiBox_printfxy(0,1,"%4i %2i:%02i",Capacity.UsedCapacity,FlugSekunden/60,FlugSekunden%60);
36	if(EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)	36	if(EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)
37	{	37	{
38	JetiBox_printfxy(10,1,"%4im%c", (int16_t)(HoehenWert/100),VarioCharacter);	38	JetiBox_printfxy(10,1,"%4im%c", (int16_t)(HoehenWert/100),VarioCharacter);
39	}	39	}
40	}	40	}
41		41
42		42
43	void Menu_Temperature(uint8_t key)	43	void Menu_Temperature(uint8_t key)
44	{ //0123456789ABCDEF	44	{ //0123456789ABCDEF
45	JetiBox_printfxy(0,0,"%3i %3i %3i %3i", Motor[0].Temperature, Motor[1].Temperature, Motor[2].Temperature, Motor[3].Temperature);	45	JetiBox_printfxy(0,0,"%3i %3i %3i %3i", Motor[0].Temperature, Motor[1].Temperature, Motor[2].Temperature, Motor[3].Temperature);
46	JetiBox_printfxy(0,1,"%3i %3i %3i %3i", Motor[4].Temperature, Motor[5].Temperature, Motor[6].Temperature, Motor[7].Temperature);	46	JetiBox_printfxy(0,1,"%3i %3i %3i %3i", Motor[4].Temperature, Motor[5].Temperature, Motor[6].Temperature, Motor[7].Temperature);
47	if(RequiredMotors <= 4)	47	if(RequiredMotors <= 4)
48	{	48	{
49	JetiBox_printfxy(0,1,"Temperatures ");	49	JetiBox_printfxy(0,1,"Temperatures ");
50	}	50	}
51	else	51	else
52	if(RequiredMotors <= 6)	52	if(RequiredMotors <= 6)
53	{	53	{
54	JetiBox_printfxy(8,1,"\%cC ",0xdf);	54	JetiBox_printfxy(8,1,"\%cC ",0xdf);
55	}	55	}
56		56
57	}	57	}
58		58
59	void Menu_Battery(uint8_t key)	59	void Menu_Battery(uint8_t key)
60	{ //0123456789ABCDEF	60	{ //0123456789ABCDEF
61	JetiBox_printfxy(0,0,"%2i.%1iV %3i.%1iA", UBat/10, UBat%10, Capacity.ActualCurrent/10, Capacity.ActualCurrent%10);	61	JetiBox_printfxy(0,0,"%2i.%1iV %3i.%1iA", UBat/10, UBat%10, Capacity.ActualCurrent/10, Capacity.ActualCurrent%10);
62	//1	62	//1
63	JetiBox_printfxy(0,1,"%4iW %6imAH",Capacity.ActualPower, Capacity.UsedCapacity);	63	JetiBox_printfxy(0,1,"%4iW %6imAH",Capacity.ActualPower, Capacity.UsedCapacity);
64	//1	64	//1
65	}	65	}
66		66
67		67
68	void Menu_PosInfo(uint8_t key)	68	void Menu_PosInfo(uint8_t key)
69	{	69	{
70	if(NaviDataOkay)	70	if(NaviDataOkay)
71	{	71	{
72	JetiBox_printfxy(0,0,"%2um/s Sat:%d ",GPSInfo.Speed,GPSInfo.NumOfSats);	72	JetiBox_printfxy(0,0,"%2um/s Sat:%d ",GPSInfo.Speed,GPSInfo.NumOfSats);
73	switch (GPSInfo.SatFix)	73	switch (GPSInfo.SatFix)
74	{	74	{
75	case SATFIX_3D:	75	case SATFIX_3D:
76	JetiBox_printfxy(12,0," 3D");	76	JetiBox_printfxy(12,0," 3D");
77	break;	77	break;
78		78
79	case SATFIX_2D:	79	case SATFIX_2D:
80	case SATFIX_NONE:	80	case SATFIX_NONE:
81	default:	81	default:
82	JetiBox_printfxy(12,0,"NoFx");	82	JetiBox_printfxy(12,0,"NoFx");
83	break;	83	break;
84	}	84	}
85	if(GPSInfo.Flags & FLAG_DIFFSOLN)	85	if(GPSInfo.Flags & FLAG_DIFFSOLN)
86	{	86	{
87	JetiBox_printfxy(12,0,"DGPS");	87	JetiBox_printfxy(12,0,"DGPS");
88	}	88	}
89	JetiBox_printfxy(0,1,"Home:%3dm %3d%c", GPSInfo.HomeDistance/10, GPSInfo.HomeBearing, 0xDF);	89	JetiBox_printfxy(0,1,"Home:%3dm %3d%c", GPSInfo.HomeDistance/10, GPSInfo.HomeBearing, 0xDF);
90	}	90	}
91	else	91	else
92	{ //0123456789ABCDEF	92	{ //0123456789ABCDEF
93	JetiBox_printfxy(2,0,"No NaviCtrl!");	93	JetiBox_printfxy(2,0,"No NaviCtrl!");
94	}	94	}
95	}	95	}
96		96
97	//1	97	//1
98	void Menu_Current(uint8_t key)	98	void Menu_Current(uint8_t key)
99	{ //0123456789ABCDEF	99	{ //0123456789ABCDEF
-		100
-		101
100	JetiBox_printfxy(0,0,"%3i %3i %3i %3i", Motor[0].Current-12, Motor[1].Current-12, Motor[2].Current-12, Motor[3].Current-12);	102	JetiBox_printfxy(0,0,"%3i %3i %3i %3i", Motor[0].Current-12, Motor[1].Current-12, Motor[2].Current-12, Motor[3].Current-12);
101	JetiBox_printfxy(0,1,"%3i %3i %3i %3i", Motor[4].Current-12, Motor[5].Current-12, Motor[6].Current-12, Motor[7].Current-12);	103	JetiBox_printfxy(0,1,"%3i %3i %3i %3i", Motor[4].Current-12, Motor[5].Current-12, Motor[6].Current-12, Motor[7].Current-12);
102	if(RequiredMotors <= 4)	104	if(RequiredMotors <= 4)
103	{	105	{
104	JetiBox_printfxy(0,1,"Currents ");	106	JetiBox_printfxy(0,1,"Currents ");
105	}	107	}
106	else	108	else
107	if(RequiredMotors <= 6)	109	if(RequiredMotors <= 6)
108	{	110	{
109	JetiBox_printfxy(8,1,"%3i.%1iA ",Capacity.ActualCurrent/10, Capacity.ActualCurrent%10);	111	JetiBox_printfxy(8,1,"%3i.%1iA ",Capacity.ActualCurrent/10, Capacity.ActualCurrent%10);
110	}	112	}
-		113
111		114
112	}	115	}
113	//1	116	//1
114	//1	117	//1
115	void Menu_SetPoint(uint8_t key)	118	void Menu_SetPoint(uint8_t key)
116	{ //0123456789ABCDEF	119	{ //0123456789ABCDEF
117	JetiBox_printfxy(0,0,"%3i %3i %3i %3i", Motor[0].SetPoint, Motor[1].SetPoint, Motor[2].SetPoint, Motor[3].SetPoint);	120	JetiBox_printfxy(0,0,"%3i %3i %3i %3i", Motor[0].SetPoint, Motor[1].SetPoint, Motor[2].SetPoint, Motor[3].SetPoint);
118	JetiBox_printfxy(0,1,"%3i %3i %3i %3i", Motor[4].SetPoint, Motor[5].SetPoint, Motor[6].SetPoint, Motor[7].SetPoint);	121	JetiBox_printfxy(0,1,"%3i %3i %3i %3i", Motor[4].SetPoint, Motor[5].SetPoint, Motor[6].SetPoint, Motor[7].SetPoint);
119	if(RequiredMotors <= 4)	122	if(RequiredMotors <= 4)
120	{	123	{
121	JetiBox_printfxy(0,1,"M SetPoint ");	124	JetiBox_printfxy(0,1,"M SetPoint ");
122	}	125	}
123	else	126	else
124	if(RequiredMotors <= 6)	127	if(RequiredMotors <= 6)
125	{	128	{
126	JetiBox_printfxy(8,1,"MSetP ");	129	JetiBox_printfxy(8,1,"MSetP ");
127	}	130	}
128		131
129	}	132	}
130		133
131	void Menu_Integal(uint8_t key)	134	void Menu_Integal(uint8_t key)
132	{ //0123456789ABCDEF	135	{ //0123456789ABCDEF
133	int r=0;	136	int r=0;
134	int n=0;	137	int n=0;
135	int g=0;	138	int g=0;
136	n=SummeNick >> 9;	139	n=SummeNick >> 9;
137	r=SummeRoll >> 9;	140	r=SummeRoll >> 9;
138	g=Mess_Integral_Gier >> 9;	141	g=Mess_Integral_Gier >> 9;
139		142
140	JetiBox_printfxy(0,0,"%3iN %3iR +N",n, r);	143	JetiBox_printfxy(0,0,"%3iN %3iR +N",n, r);
141	JetiBox_printfxy(0,1,"%3iG +R -N -R",g);	144	JetiBox_printfxy(0,1,"%3iG +R -N -R",g);
142	//1	145	//1
143		146
144		147
145	}	148	}
146		149
147	void Menu_Info(uint8_t key)	150	void Menu_Info(uint8_t key)
148	{ //0123456789ABCDEF	151	{ //0123456789ABCDEF
149		152
150	JetiBox_printfxy(0,0,"%3i=Hovergas",HoverGas);	153	JetiBox_printfxy(0,0,"%3i=Hovergas",HoverGas);
151	JetiBox_printfxy(0,1,"%3i=HG/4 %3i=Gas",HoverGas/4,StickGas);	154	JetiBox_printfxy(0,1,"%3i=HG/4 %3i=Gas",HoverGas/4,StickGas);
152	}	155	}
153		156
154	void Menu_spoti1(uint8_t key)	157	void Menu_spoti1(uint8_t key)
155	{ //0123456789ABCDEF	158	{ //0123456789ABCDEF
156		159
157	JetiBox_printfxy(0,0,">%3i=Serialpot1",PPM_in[13]);	160	JetiBox_printfxy(0,0,">%3i=Serialpot1",PPM_in[13]);
158	JetiBox_printfxy(0,1," %3i=Serialpot2",PPM_in[14]);	161	JetiBox_printfxy(0,1," %3i=Serialpot2",PPM_in[14]);
159	if(key== JETIBOX_KEY_UP) PPM_in[13] = PPM_in[13]+1;	162	if(key== JETIBOX_KEY_UP) PPM_in[13] = PPM_in[13]+1;
160	if(key== JETIBOX_KEY_DOWN) PPM_in[13] = PPM_in[13]-1;	163	if(key== JETIBOX_KEY_DOWN) PPM_in[13] = PPM_in[13]-1;
161	}	164	}
162		165
163	void Menu_spoti2(uint8_t key)	166	void Menu_spoti2(uint8_t key)
164	{ //0123456789ABCDEF	167	{ //0123456789ABCDEF
165		168
166	JetiBox_printfxy(0,0," %3i=Serialpot1",PPM_in[13]);	169	JetiBox_printfxy(0,0," %3i=Serialpot1",PPM_in[13]);
167	JetiBox_printfxy(0,1,">%3i=Serialpot2",PPM_in[14],key);	170	JetiBox_printfxy(0,1,">%3i=Serialpot2",PPM_in[14],key);
168	if(key== JETIBOX_KEY_UP) PPM_in[14] = PPM_in[14]+5;	171	if(key== JETIBOX_KEY_UP) PPM_in[14] = PPM_in[14]+5;
169	if(key== JETIBOX_KEY_DOWN) PPM_in[14] = PPM_in[14]-5;	172	if(key== JETIBOX_KEY_DOWN) PPM_in[14] = PPM_in[14]-5;
170	}	173	}
-		174	void Menu_hoeheD(uint8_t key)
-		175	{ //0123456789ABCDEF
-		176
-		177	JetiBox_printfxy(0,0,">%3i=HD",EE_Parameter.Luftdruck_D);
-		178	JetiBox_printfxy(0,1," %3i=HP",EE_Parameter.Hoehe_P);
-		179	if(key== JETIBOX_KEY_UP) EE_Parameter.Luftdruck_D = EE_Parameter.Luftdruck_D+1;
-		180	if(key== JETIBOX_KEY_DOWN) EE_Parameter.Luftdruck_D = EE_Parameter.Luftdruck_D-1;
-		181	}
-		182	void Menu_hoeheP(uint8_t key)
-		183	{ //0123456789ABCDEF
-		184
-		185	JetiBox_printfxy(0,0," %3i=HD",EE_Parameter.Luftdruck_D);
-		186	JetiBox_printfxy(0,1,">%3i=HP",EE_Parameter.Hoehe_P);
-		187	if(key== JETIBOX_KEY_UP) EE_Parameter.Hoehe_P = EE_Parameter.Hoehe_P+1;
-		188	if(key== JETIBOX_KEY_DOWN) EE_Parameter.Hoehe_P = EE_Parameter.Hoehe_P-1;
171		189	}
172	//#define JETIBOX_KEY_UP 0x2F	190	//#define JETIBOX_KEY_UP 0x2F
-		191	//#define JETIBOX_KEY_DOWN 0x4F
-		192	//unsigned char Parameter_Luftdruck_D = 48; // Wert : 0-250
-		193	//unsigned char Parameter_Hoehe_P = 16; // Wert : 0-32
-		194	//CHK_POTI_MM(Parameter_Luftdruck_D,EE_Parameter.Luftdruck_D,0,100);
173	//#define JETIBOX_KEY_DOWN 0x4F	195	//CHK_POTI_MM(Parameter_Hoehe_P,EE_Parameter.Hoehe_P,0,100);
174	//1	-
175		-
176		-
177		196	//1
178	// -----------------------------------------------------------	197	// -----------------------------------------------------------
179	// the menu topology	198	// the menu topology
180	// -----------------------------------------------------------	199	// -----------------------------------------------------------
181	typedef void (*pFctMenu) (uint8_t); // the menu item handler function pointer	200	typedef void (*pFctMenu) (uint8_t); // the menu item handler function pointer
182		201
183	typedef struct{	202	typedef struct{
184	int8_t left;	203	int8_t left;
185	int8_t right;	204	int8_t right;
186	int8_t up;	205	int8_t up;
187	int8_t down;	206	int8_t down;
188	pFctMenu pHandler;	207	pFctMenu pHandler;
189	} MENU_ENTRY;	208	} MENU_ENTRY;
190		209
191		210
192	// the menu navigation structure	211	// the menu navigation structure
193	/* \|	212	/* \|
194		213
195	3 - 0 - 1 - 2 - 3 - 0	214	3 - 0 - 1 - 2 - 3 - 0
196		215
197	*/	216	*/
198		217
199	const MENU_ENTRY JetiBox_Menu[] PROGMEM=	218	const MENU_ENTRY JetiBox_Menu[] PROGMEM=
200	{ // l r u d pHandler links rechts up down	219	{ // l r u d pHandler links rechts up down
201	{9, 1, 0, 0, &Menu_Status }, // 0 ///	220	{11, 1, 0, 0, &Menu_Status }, // 0 ///
202	{0, 2, 1, 1, &Menu_Temperature }, // 1	221	{0, 2, 1, 1, &Menu_Temperature }, // 1
203	{1, 3, 2, 2, &Menu_Battery }, // 2	222	{1, 3, 2, 2, &Menu_Battery }, // 2
204	{2, 4, 3, 3, &Menu_PosInfo }, // 3	223	{2, 4, 3, 3, &Menu_PosInfo }, // 3
205	//1	224	//1
206	{3, 5, 4, 4, &Menu_Current }, // 4 ///	225	{3, 5, 4, 4, &Menu_Current }, // 4 ///
207	{4, 6, 5, 5, &Menu_SetPoint }, // 5 ///	226	{4, 6, 5, 5, &Menu_SetPoint }, // 5 ///
208	{5, 7, 6, 6, &Menu_Integal }, // 6 ///	227	{5, 7, 6, 6, &Menu_Integal }, // 6 ///
209	{6, 8, 7, 7, &Menu_Info }, // 7 ///	228	{6, 8, 7, 7, &Menu_Info }, // 7 ///
210	{7, 9, 8, 8, &Menu_spoti1 }, // 8 ///	229	{7, 9, 8, 8, &Menu_spoti1 }, // 8 ///
211	{8, 0, 9, 9, &Menu_spoti2 }, // 9 ///	230	{8, 10, 9, 9, &Menu_spoti2 }, // 9 ///
212		-
213		-
-		231	{9, 11, 10, 10, &Menu_hoeheD }, // 10 ///
-		232	{10, 0, 11, 11, &Menu_hoeheP }, // 11 ///
214		233
215	//1	234	//1
216	};	235	};
217		236
218	// -----------------------------------------------------------	237	// -----------------------------------------------------------
219	// Update display buffer	238	// Update display buffer
220	// -----------------------------------------------------------	239	// -----------------------------------------------------------
221	unsigned char JetiBox_Update(unsigned char key)	240	unsigned char JetiBox_Update(unsigned char key)
222	{	241	{
223	static uint8_t item = 0, last_item = 0; // the menu item	242	static uint8_t item = 0, last_item = 0; // the menu item
224		243
225	// navigate within the menu by key action	244	// navigate within the menu by key action
226	last_item = item;	245	last_item = item;
227	switch(key)	246	switch(key)
228	{	247	{
229	case JETIBOX_KEY_LEFT:	248	case JETIBOX_KEY_LEFT:
230	if (item == 0) return (1); // switch back to jeti expander menu	249	if (item == 0) return (1); // switch back to jeti expander menu
231	else item = pgm_read_byte(&JetiBox_Menu[item].left); //trigger to left menu item	250	else item = pgm_read_byte(&JetiBox_Menu[item].left); //trigger to left menu item
232	break;	251	break;
233	case JETIBOX_KEY_RIGHT:	252	case JETIBOX_KEY_RIGHT:
234	item = pgm_read_byte(&JetiBox_Menu[item].right); //trigger to right menu item	253	item = pgm_read_byte(&JetiBox_Menu[item].right); //trigger to right menu item
235	break;	254	break;
236	case JETIBOX_KEY_UP:	255	case JETIBOX_KEY_UP:
237		-
238	jetivalue1=jetivalue1+5;	-
239		-
240	item = pgm_read_byte(&JetiBox_Menu[item].up); //trigger to up menu item	256	item = pgm_read_byte(&JetiBox_Menu[item].up); //trigger to up menu item
241	break;	257	break;
242	case JETIBOX_KEY_DOWN:	258	case JETIBOX_KEY_DOWN:
243		-
244	jetivalue1=jetivalue1-5;	-
245		-
246	item = pgm_read_byte(&JetiBox_Menu[item].down); //trigger to down menu item	259	item = pgm_read_byte(&JetiBox_Menu[item].down); //trigger to down menu item
247	break;	260	break;
248	default:	261	default:
249	break;	262	break;
250	}	263	}
251	// if the menu item has been changed, do not pass the key to the item handler	264	// if the menu item has been changed, do not pass the key to the item handler
252	// to avoid jumping over to items	265	// to avoid jumping over to items
253	if(item != last_item) key = JETIBOX_KEY_UNDEF;	266	if(item != last_item) key = JETIBOX_KEY_UNDEF;
254		267
255	LIBFC_JetiBox_Clear();	268	LIBFC_JetiBox_Clear();
256	//execute menu item handler	269	//execute menu item handler
257	((pFctMenu)(pgm_read_word(&(JetiBox_Menu[item].pHandler))))(key);	270	((pFctMenu)(pgm_read_word(&(JetiBox_Menu[item].pHandler))))(key);
258		271
259	return (0);	272	return (0);
260	}	273	}
261		274
262		275

Subversion Repositories FlightCtrl

(root)/branches/MartinW_Jeti+/jetimenu.c - Rev 1740 → 1742