WebSVN - FlightCtrl - Blame - Rev 1703 - /branches/V0.84a_MartinW

Rev	Author	Line No.	Line
1484	killagreg	1	#include "jetimenu.h"
		2	#include "libfc.h"
		3	#include "printf_P.h"
		4	#include "main.h"
		5	#include "spi.h"
1500	killagreg	6	#include "capacity.h"
1484	killagreg	7
		8	#define JETIBOX_KEY_RIGHT 0x1F
		9	#define JETIBOX_KEY_UP 0x2F
		10	#define JETIBOX_KEY_DOWN 0x4F
		11	#define JETIBOX_KEY_LEFT 0x8F
		12	#define JETIBOX_KEY_NONE 0x0F
		13	#define JETIBOX_KEY_UNDEF 0x00
		14
		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);}
		17
		18	// -----------------------------------------------------------
		19	// the menu functions
		20	// -----------------------------------------------------------
1517	killagreg	21
		22	void Menu_Status(uint8_t key)
		23	{ //0123456789ABCDEF
1512	holgerb	24	JetiBox_printfxy(0,0,"%2i.%1iV",UBat/10, UBat%10);
		25	if(NaviDataOkay)
1484	killagreg	26	{
1694	holgerb	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);
1484	killagreg	29	}
1517	killagreg	30	else
		31	{
1591	holgerb	32	JetiBox_printfxy(6,0,"Status");
1517	killagreg	33	}
1703	holgerb	34	if(NC_ErrorCode) JetiBox_printfxy(6,0,"ERROR: %2d",NC_ErrorCode);
1591	holgerb	35	JetiBox_printfxy(0,1,"%4i %2i:%02i",Capacity.UsedCapacity,FlugSekunden/60,FlugSekunden%60);
1517	killagreg	36	if(EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG)
		37	{
1591	holgerb	38	JetiBox_printfxy(10,1,"%4im%c", (int16_t)(HoehenWert/100),VarioCharacter);
1517	killagreg	39	}
		40	}
1512	holgerb	41
1693	holgerb	42	void Menu_Temperature(uint8_t key)
1517	killagreg	43	{ //0123456789ABCDEF
1687	holgerb	44	JetiBox_printfxy(0,0,"%3i %3i %3i %3i", Motor[0].Temperature, Motor[1].Temperature, Motor[2].Temperature, Motor[3].Temperature);
1693	holgerb	45	JetiBox_printfxy(0,1,"%3i %3i %3i %3i", Motor[4].Temperature, Motor[5].Temperature, Motor[6].Temperature, Motor[7].Temperature);
1690	holgerb	46	if(RequiredMotors <= 4)
		47	{
		48	JetiBox_printfxy(0,1,"Temperatures ");
		49	}
		50	else
		51	if(RequiredMotors <= 6)
		52	{
		53	JetiBox_printfxy(8,1,"\%cC ",0xdf);
		54	}
1692	holgerb	55
1484	killagreg	56	}
1517	killagreg	57
		58	void Menu_Battery(uint8_t key)
1500	killagreg	59	{ //0123456789ABCDEF
1529	killagreg	60	JetiBox_printfxy(0,0,"%2i.%1iV %3i.%1iA", UBat/10, UBat%10, Capacity.ActualCurrent/10, Capacity.ActualCurrent%10);
		61	JetiBox_printfxy(0,1,"%4iW %6imAh",Capacity.ActualPower, Capacity.UsedCapacity);
1500	killagreg	62	}
		63
1680	holgerb	64
1517	killagreg	65	void Menu_PosInfo(uint8_t key)
1484	killagreg	66	{
		67	if(NaviDataOkay)
		68	{
1690	holgerb	69	JetiBox_printfxy(0,0,"%2um/s Sat:%d ",GPSInfo.Speed,GPSInfo.NumOfSats);
1517	killagreg	70	switch (GPSInfo.SatFix)
		71	{
1690	holgerb	72	case SATFIX_3D:
		73	JetiBox_printfxy(12,0," 3D");
1517	killagreg	74	break;
1690	holgerb	75
1517	killagreg	76	case SATFIX_2D:
1690	holgerb	77	case SATFIX_NONE:
1517	killagreg	78	default:
1690	holgerb	79	JetiBox_printfxy(12,0,"NoFx");
1517	killagreg	80	break;
		81	}
		82	if(GPSInfo.Flags & FLAG_DIFFSOLN)
		83	{
1690	holgerb	84	JetiBox_printfxy(12,0,"DGPS");
1517	killagreg	85	}
1690	holgerb	86	JetiBox_printfxy(0,1,"Home:%3dm %3d%c", GPSInfo.HomeDistance/10, GPSInfo.HomeBearing, 0xDF);
1484	killagreg	87	}
		88	else
1517	killagreg	89	{ //0123456789ABCDEF
		90	JetiBox_printfxy(2,0,"No NaviCtrl!");
1484	killagreg	91	}
		92	}
		93
1517	killagreg	94
1484	killagreg	95	// -----------------------------------------------------------
		96	// the menu topology
		97	// -----------------------------------------------------------
		98	typedef void (*pFctMenu) (uint8_t); // the menu item handler function pointer
		99
		100	typedef struct{
		101	int8_t left;
		102	int8_t right;
		103	int8_t up;
		104	int8_t down;
		105	pFctMenu pHandler;
		106	} MENU_ENTRY;
		107
		108
		109	// the menu navigation structure
1517	killagreg	110	/* \|
1484	killagreg	111
1517	killagreg	112	3 - 0 - 1 - 2 - 3 - 0
		113
1484	killagreg	114	*/
		115
		116	const MENU_ENTRY JetiBox_Menu[] PROGMEM=
		117	{ // l r u d pHandler
1517	killagreg	118	{3, 1, 0, 0, &Menu_Status }, // 0
1693	holgerb	119	{0, 2, 1, 1, &Menu_Temperature }, // 1
1517	killagreg	120	{1, 3, 2, 2, &Menu_Battery }, // 2
		121	{2, 0, 3, 3, &Menu_PosInfo }, // 3
1484	killagreg	122	};
		123
		124	// -----------------------------------------------------------
		125	// Update display buffer
		126	// -----------------------------------------------------------
1583	ingob	127	unsigned char JetiBox_Update(unsigned char key)
1484	killagreg	128	{
		129	static uint8_t item = 0, last_item = 0; // the menu item
		130
		131	// navigate within the menu by key action
		132	last_item = item;
		133	switch(key)
		134	{
		135	case JETIBOX_KEY_LEFT:
1583	ingob	136	if (item == 0) return (1); // switch back to jeti expander menu
		137	else item = pgm_read_byte(&JetiBox_Menu[item].left); //trigger to left menu item
1484	killagreg	138	break;
		139	case JETIBOX_KEY_RIGHT:
		140	item = pgm_read_byte(&JetiBox_Menu[item].right); //trigger to right menu item
		141	break;
		142	case JETIBOX_KEY_UP:
		143	item = pgm_read_byte(&JetiBox_Menu[item].up); //trigger to up menu item
		144	break;
		145	case JETIBOX_KEY_DOWN:
		146	item = pgm_read_byte(&JetiBox_Menu[item].down); //trigger to down menu item
		147	break;
		148	default:
		149	break;
		150	}
		151	// if the menu item has been changed, do not pass the key to the item handler
		152	// to avoid jumping over to items
		153	if(item != last_item) key = JETIBOX_KEY_UNDEF;
		154
		155	LIBFC_JetiBox_Clear();
		156	//execute menu item handler
		157	((pFctMenu)(pgm_read_word(&(JetiBox_Menu[item].pHandler))))(key);
1583	ingob	158
		159	return (0);
1484	killagreg	160	}
		161

Subversion Repositories FlightCtrl

(root)/branches/V0.84a_MartinW_Jeti+/jetimenu.c @ 1897 - Rev 1703