WebSVN - FlightCtrl - Blame - Rev 1939 - /branches/V2.08a_Rens

Rev	Author	Line No.	Line
1917	holgerb	1	#include "libfc.h"
		2	#include "printf_P.h"
		3	#include "main.h"
		4	#include "spi.h"
		5	#include "capacity.h"
		6
1925	holgerb	7	#if (defined(__AVR_ATmega1284__) \|\| defined(__AVR_ATmega1284P__))
		8
1920	holgerb	9	#define HoTT_printf(format, args...) { _printf_P(&LIBFC_HoTT_Putchar, PSTR(format) , ## args);}
		10	#define HoTT_printfxy(x,y,format, args...) { LIBFC_HoTT_SetPos(y * 21 + x); _printf_P(&LIBFC_HoTT_Putchar, PSTR(format) , ## args);}
		11	#define HoTT_printfxy_INV(x,y,format, args...) { LIBFC_HoTT_SetPos(y * 21 + x); _printf_P(&LIBFC_HoTT_Putchar_INV, PSTR(format) , ## args);}
		12	#define HoTT_printfxy_BLINK(x,y,format, args...) { LIBFC_HoTT_SetPos(y * 21 + x); _printf_P(&LIBFC_HoTT_Putchar_BLINK, PSTR(format) , ## args);}
1921	holgerb	13	#define HoTT_printf_BLINK(format, args...) { _printf_P(&LIBFC_HoTT_Putchar_BLINK, PSTR(format) , ## args);}
		14	#define HoTT_printf_INV(format, args...) { _printf_P(&LIBFC_HoTT_Putchar_INV, PSTR(format) , ## args);}
1917	holgerb	15
1919	holgerb	16	#define VOICE_MINIMALE_EINGANSSPANNUNG 16
		17	#define VOICE_BEEP 5
1920	holgerb	18	#define HoTT_GRAD 96
		19	#define HoTT_LINKS 123
		20	#define HoTT_RECHTS 124
		21	#define HoTT_OBEN 125
		22	#define HoTT_UNTEN 126
1917	holgerb	23
1930	holgerb	24	const char PROGMEM NC_ERROR_TEXT[MAX_ERR_NUMBER][17] =
		25	{
		26	//0123456789123456
		27	"No Error \0", // 0
		28	"Not compatible \0", // 1
		29	"MK3Mag not compa\0", // 2
		30	"No FC communicat\0", // 3
		31	"MK3Mag communica\0", // 4
		32	"GPS communicatio\0", // 5
		33	"compass value \0", // 6
		34	"RC Signal lost \0", // 7
		35	"FC spi rx error \0", // 8
		36	"No NC communicat\0", // 9
		37	"FC Nick Gyro \0", // 10
		38	"FC Roll Gyro \0", // 11
		39	"FC Yaw Gyro \0", // 12
		40	"FC Nick ACC \0", // 13
		41	"FC Roll ACC \0", // 14
		42	"FC Z-ACC \0", // 15
		43	"Pressure sensor \0", // 16
1936	holgerb	44	"I2C FC->BL-Ctrl \0", // 17
1930	holgerb	45	"Bl Missing \0", // 18
		46	"Mixer Error \0", // 19
1937	holgerb	47	"Carefree Error \0", // 20
		48	"GPS Fix lost \0" // 21
1930	holgerb	49	};
1919	holgerb	50
		51	//---------------------------------------------------------------
1917	holgerb	52	void Hott_ClearLine(unsigned char line)
		53	{
		54	HoTT_printfxy(0,line," ");
		55	}
1919	holgerb	56	//---------------------------------------------------------------
1917	holgerb	57
1919	holgerb	58	unsigned char HoTT_Waring(void)
		59	{
		60	if(FC_StatusFlags & FC_STATUS_LOWBAT) return(VOICE_MINIMALE_EINGANSSPANNUNG);
1933	holgerb	61	if(MotorenEin && NC_ErrorCode) return(VOICE_BEEP);
1919	holgerb	62	return(0);
		63	}
		64
		65	//---------------------------------------------------------------
		66	unsigned char HoTT_Telemety(unsigned char packet_request)
		67	{
		68	switch(packet_request)
		69	{
		70	case HOTT_VARIO_PACKET_ID:
1921	holgerb	71	VarioPacket.Altitude = HoehenWert/100 + 500;
1919	holgerb	72	if (VarioPacket.Altitude < VarioPacket.MinAltitude) VarioPacket.MinAltitude = VarioPacket.Altitude;
		73	if (VarioPacket.Altitude > VarioPacket.MaxAltitude) VarioPacket.MaxAltitude = VarioPacket.Altitude;
		74	VarioPacket.WarnBeep = HoTT_Waring();
		75	HoTT_DataPointer = (unsigned char *) &VarioPacket;
		76	return(sizeof(VarioPacket));
		77	break;
1921	holgerb	78
1919	holgerb	79	case HOTT_GPS_PACKET_ID:
1921	holgerb	80	GPSPacket.Altitude = HoehenWert/100 + 500;
1919	holgerb	81	GPSPacket.Distance = GPSInfo.HomeDistance/10;
1921	holgerb	82	GPSPacket.Heading = KompassValue/2;
		83	GPSPacket.Speed = (GPSInfo.Speed * 36) / 10;
		84	GPSPacket.m_sec = GPSInfo.Speed+120;
		85	GPSPacket.m_3sec = 120;
		86	GPSPacket.m_10sec = 0;
1919	holgerb	87	GPSPacket.WarnBeep = HoTT_Waring();
		88	HoTT_DataPointer = (unsigned char *) &GPSPacket;
		89	return(sizeof(GPSPacket));
		90	break;
		91	case HOTT_ELECTRIC_AIR_PACKET_ID:
1921	holgerb	92	ElectricAirPacket.Altitude = HoehenWert/1000 + 500; ;
		93	ElectricAirPacket.Battery1 = UBat;
		94	ElectricAirPacket.Capacity = Capacity.UsedCapacity;
1919	holgerb	95	ElectricAirPacket.WarnBeep = HoTT_Waring();
		96	HoTT_DataPointer = (unsigned char *) &ElectricAirPacket;
		97	return(sizeof(ElectricAirPacket));
		98	break;
		99	default: return(0);
		100	}
		101	}
		102
		103	//---------------------------------------------------------------
1917	holgerb	104	void HoTT_Menu(void)
		105	{
1933	holgerb	106	static unsigned char line, page = 0;
1921	holgerb	107	unsigned char tmp;
		108	if(page == 0)
1933	holgerb	109	switch(line++)
1917	holgerb	110	{
1919	holgerb	111	case 0:
1923	holgerb	112	if(FC_StatusFlags & FC_STATUS_LOWBAT)
1939	holgerb	113	HoTT_printfxy_BLINK(0,0," %2i.%1iV ",UBat/10, UBat%10)
		114	else
		115	HoTT_printfxy(0,0," %2i.%1iV ",UBat/10, UBat%10)
		116
		117	if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)
		118	{
		119	if(HoehenReglerAktiv) HoTT_printfxy_INV(10,0,"ALT:%4im %c", (int16_t)(HoehenWert/100),VarioCharacter)
		120	else HoTT_printfxy(10,0,"ALT:%4im ", (int16_t)(HoehenWert/100))
		121	}
		122	else HoTT_printfxy(10,0,"ALT:---- ");
		123	break;
		124	case 1:
		125	if(FC_StatusFlags & FC_STATUS_LOWBAT)
		126	HoTT_printfxy_BLINK(0,1," %2i:%02i ",FlugSekunden/60,FlugSekunden%60)
		127	else HoTT_printfxy(0,1," %2i:%02i ",FlugSekunden/60,FlugSekunden%60);
		128	HoTT_printfxy(10,1,"DIR: %3d%c",KompassValue, HoTT_GRAD);
		129	if(FC_StatusFlags2 & FC_STATUS2_CAREFREE) HoTT_printfxy(20,1,"C") else HoTT_printfxy(20,1," ");
		130	break;
		131	case 2:
		132	if(FC_StatusFlags & FC_STATUS_LOWBAT)
		133	HoTT_printfxy_BLINK(0,2," %5i ",Capacity.UsedCapacity)
		134	else HoTT_printfxy(0,2," %5i ",Capacity.UsedCapacity);
		135	HoTT_printfxy(12,2,"I:%2i.%1iA",Capacity.ActualCurrent/10, Capacity.ActualCurrent%10);
		136	break;
		137	case 3:
		138	HoTT_printfxy(9,0,"I");
		139	HoTT_printfxy(9,1,"I");
		140	HoTT_printfxy(9,2,"I");
		141	HoTT_printfxy(0,3,"---------+-----------");
		142	HoTT_printfxy(9,4,"I");
		143	HoTT_printfxy(9,5,"I");
		144	HoTT_printfxy(0,6,"---------------------");
		145	break;
		146	case 4:
		147	if(NaviDataOkay)
		148	{
		149	HoTT_printfxy(0,4,"SAT:%2d ",GPSInfo.NumOfSats);
		150	HoTT_printfxy(10,4,"DIST:%3dm",GPSInfo.HomeDistance/10);
		151	switch (GPSInfo.SatFix)
		152	{
		153	case SATFIX_3D:
		154	if(GPSInfo.Flags & FLAG_DIFFSOLN) HoTT_printfxy(7,4,"D ")
		155	else HoTT_printfxy(7,4,"3D");
		156	break;
		157	default:
		158	HoTT_printfxy(7,4,"! ");
		159	break;
		160	}
		161	}
		162	else
		163	{ //012345678901234567890
		164	HoTT_printfxy(0,4,"No Navi ");
		165	}
		166	break;
		167	case 5:
		168	if(NaviDataOkay)
		169	{
		170	HoTT_printfxy(4,5,"%2um/s",GPSInfo.Speed,GPSInfo.NumOfSats);
		171	HoTT_printfxy(12,5,"HM:%3d%c %c", GPSInfo.HomeBearing, HoTT_GRAD, NC_GPS_ModeCharacter);
		172	}
		173	else HoTT_printfxy(0,5," \| ");
		174	break;
		175	case 6:
		176	/*
		177	if(RequiredMotors == 4) Hott_ClearLine(6);
		178	else
		179	if(RequiredMotors == 6) HoTT_printfxy(0,6,"%3i %3i%cC ", Motor[4].Temperature, Motor[5].Temperature,HoTT_GRAD)
		180	else
		181	if(RequiredMotors > 6) HoTT_printfxy(0,6,"%3i %3i %3i %3i%cC", Motor[4].Temperature, Motor[5].Temperature, Motor[6].Temperature, Motor[7].Temperature,HoTT_GRAD);
		182	//HoTT_printfxy(15,6,"%KEY:%02x",HottKeyboard);
		183	*/
		184	break;
		185	case 7: if(NC_ErrorCode)
		186	{
		187	if(HoTTBlink && NC_ErrorCode < MAX_ERR_NUMBER)
		188	{
		189	Hott_ClearLine(7);
		190	HoTT_printfxy_INV(0,7,"ERR: %2d !",NC_ErrorCode);
		191	}
		192	else
		193	{
		194	HoTT_printfxy(0,7,"ERR: "); _printf_P(&LIBFC_HoTT_Putchar, NC_ERROR_TEXT[NC_ErrorCode] , 0);};
		195	}
		196	else HoTT_printfxy(0,7," www.MikroKopter.de ");
		197	break;
		198	case 8: ASCIIPacket.WarnBeep = HoTT_Waring();
		199	// ASCIIPacket.WarnBeep = Parameter_UserParam1;
		200	case 9:
		201	case 10:
		202	case 11:
		203	case 12:
		204	case 13:
		205	case 14:
		206	case 15:
		207	case 16:
		208	if(HottKeyboard == 8) { LIBFC_HoTT_Clear(); page = 1; line = 0;};
		209	HottKeyboard = 0;
		210	break;
		211	default: line = 0;
		212	break;
		213	}
		214	else
		215	if(page == 1)
		216	switch(line++)
		217	{
		218	case 0:
		219	if(FC_StatusFlags & FC_STATUS_LOWBAT)
1923	holgerb	220	HoTT_printfxy_BLINK(0,0," %2i:%02i %2i.%1iV %4imAh",FlugSekunden/60,FlugSekunden%60,UBat/10, UBat%10,Capacity.UsedCapacity)
		221	else HoTT_printfxy(0,0," %2i:%02i %2i.%1iV %4imAh",FlugSekunden/60,FlugSekunden%60,UBat/10, UBat%10,Capacity.UsedCapacity);
1917	holgerb	222	break;
		223	case 1:
1921	holgerb	224	HoTT_printfxy(0,1,"DIR:%3d%c",KompassValue, HoTT_GRAD);
1917	holgerb	225	if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)
1920	holgerb	226	{
		227	if(HoehenReglerAktiv) HoTT_printfxy_INV(10,1,"ALT:%4im", (int16_t)(HoehenWert/100))
		228	else HoTT_printfxy(10,1,"ALT:%4im", (int16_t)(HoehenWert/100))
		229	}
		230	else HoTT_printfxy(10,1,"ALT:---- ");
		231	HoTT_printfxy(20,1,"%c",VarioCharacter);
1917	holgerb	232	break;
		233	case 2:
		234	if(NaviDataOkay)
		235	{
1923	holgerb	236	HoTT_printfxy(1,2,"HM:%3d%c DIST:%3dm %c", GPSInfo.HomeBearing, HoTT_GRAD, GPSInfo.HomeDistance/10, NC_GPS_ModeCharacter);
1917	holgerb	237	}
		238	else
		239	{
1923	holgerb	240	Hott_ClearLine(2);
1917	holgerb	241	}
		242	break;
1923	holgerb	243	case 3:
		244	HoTT_printfxy(0,3,"PWR:%2i.%1iA (%iW) ",Capacity.ActualCurrent/10, Capacity.ActualCurrent%10,Capacity.ActualPower);
		245	break;
1917	holgerb	246	case 4:
		247	if(NaviDataOkay)
		248	{
1919	holgerb	249	HoTT_printfxy(0,4,"GPS:%2um/s SAT:%d ",GPSInfo.Speed,GPSInfo.NumOfSats);
1917	holgerb	250	switch (GPSInfo.SatFix)
		251	{
		252	case SATFIX_3D:
		253	HoTT_printfxy(16,4," 3D ");
		254	break;
1925	holgerb	255	//case SATFIX_2D:
		256	//case SATFIX_NONE:
1917	holgerb	257	default:
1925	holgerb	258	HoTT_printfxy_BLINK(16,4,"NOFIX");
1917	holgerb	259	break;
		260	}
		261	if(GPSInfo.Flags & FLAG_DIFFSOLN)
		262	{
		263	HoTT_printfxy(16,4,"DGPS ");
		264	}
		265	}
		266	else
		267	{ //012345678901234567890
1930	holgerb	268	HoTT_printfxy(0,4," No NaviCtrl ");
1917	holgerb	269	}
		270	break;
		271	case 5:
1923	holgerb	272	HoTT_printfxy(0,5,"%3i %3i %3i %3i%cC", Motor[0].Temperature, Motor[1].Temperature, Motor[2].Temperature, Motor[3].Temperature,HoTT_GRAD);
		273	if(FC_StatusFlags2 & FC_STATUS2_CAREFREE) HoTT_printfxy_INV(18,5,"CF") else HoTT_printfxy(18,5," ");
1917	holgerb	274	break;
		275	case 6:
		276	if(RequiredMotors == 4) Hott_ClearLine(6);
		277	else
1923	holgerb	278	if(RequiredMotors == 6) HoTT_printfxy(0,6,"%3i %3i%cC ", Motor[4].Temperature, Motor[5].Temperature,HoTT_GRAD)
1917	holgerb	279	else
1923	holgerb	280	if(RequiredMotors > 6) HoTT_printfxy(0,6,"%3i %3i %3i %3i%cC", Motor[4].Temperature, Motor[5].Temperature, Motor[6].Temperature, Motor[7].Temperature,HoTT_GRAD);
1920	holgerb	281	//HoTT_printfxy(15,6,"%KEY:%02x",HottKeyboard);
1917	holgerb	282	break;
1930	holgerb	283	case 7: if(NC_ErrorCode)
		284	{
		285	if(HoTTBlink && NC_ErrorCode < MAX_ERR_NUMBER)
		286	{
		287	Hott_ClearLine(7);
		288	HoTT_printfxy_INV(0,7,"ERR: %2d !",NC_ErrorCode);
		289	}
		290	else
		291	{
		292	HoTT_printfxy(0,7,"ERR: "); _printf_P(&LIBFC_HoTT_Putchar, NC_ERROR_TEXT[NC_ErrorCode] , 0);};
		293	}
1937	holgerb	294	else HoTT_printfxy(0,7," www.MikroKopter.de ");
1917	holgerb	295	break;
1919	holgerb	296	case 8: ASCIIPacket.WarnBeep = HoTT_Waring();
		297	// ASCIIPacket.WarnBeep = Parameter_UserParam1;
1921	holgerb	298	case 9:
1917	holgerb	299	case 10:
		300	case 11:
		301	case 12:
		302	case 13:
1919	holgerb	303	case 14:
		304	case 15:
		305	case 16:
1939	holgerb	306	if(HottKeyboard == 8) { LIBFC_HoTT_Clear(); page = 2; line = 0;};
		307	if(HottKeyboard == 1) { LIBFC_HoTT_Clear(); page = 0; line = 0;};
1921	holgerb	308	HottKeyboard = 0;
		309	break;
1933	holgerb	310	default: line = 0;
1921	holgerb	311	break;
		312	}
		313	else
1939	holgerb	314	if(page == 2)
1933	holgerb	315	switch(line++)
1921	holgerb	316	{
		317	case 0:
		318	HoTT_printfxy_INV(0,0,"Setting:%u %s ",GetActiveParamSet(),EE_Parameter.Name);
		319	break;
		320	case 1: HoTT_printfxy(0,1,"Min:%2i.%1iV %s ",BattLowVoltageWarning/10, BattLowVoltageWarning%10, Mixer.Name);
		321	break;
1923	holgerb	322	case 2: HoTT_printfxy(0,2,"ALT:");
1921	holgerb	323	if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)
		324	{
		325	if(!(EE_Parameter.GlobalConfig & CFG_HOEHEN_SCHALTER)) HoTT_printf("POTI:%3u ", Parameter_HoehenSchalter)
		326	else
		327	{
		328	if(Parameter_HoehenSchalter > 50) HoTT_printf("(ON) ") else HoTT_printf("(OFF) ");
		329	if((Parameter_ExtraConfig & CFG2_HEIGHT_LIMIT)) HoTT_printf("LIMIT", Parameter_HoehenSchalter)
		330	else HoTT_printf("VARIO", Parameter_HoehenSchalter);
		331	}
		332	}
		333	else
		334	HoTT_printf("DISABLED");
		335	break;
1923	holgerb	336	case 3: HoTT_printfxy(0,3,"CF:");
1921	holgerb	337	if(!EE_Parameter.CareFreeModeControl) HoTT_printf("DISABLED")
		338	else
		339	{
		340	if(CareFree) HoTT_printf(" (ON) ") else HoTT_printf(" (OFF)");
		341	if(EE_Parameter.ExtraConfig & CFG_LEARNABLE_CAREFREE) HoTT_printf(" TEACH");
		342	}
		343	break;
1923	holgerb	344	case 4: HoTT_printfxy(0,4,"GPS:");
		345	if(!(Parameter_GlobalConfig & CFG_GPS_AKTIV)) HoTT_printf("DISABLED")
		346	else
		347	{
		348	CHK_POTI(tmp,EE_Parameter.NaviGpsModeControl);
		349	if(tmp < 50) HoTT_printf("(FREE)")
		350	else
		351	if(tmp >= 180) HoTT_printf("(HOME)")
		352	else
		353	if(EE_Parameter.ExtraConfig & CFG_GPS_AID) HoTT_printf("(AID) ")
		354	else HoTT_printf("(HOLD)")
		355	}
		356	if(EE_Parameter.FailSafeTime) HoTT_printfxy(10,4," FS:%usek ",EE_Parameter.FailSafeTime)
		357
		358	break;
		359	case 5: HoTT_printfxy(0,5,"HOME ALT:");
		360	if(EE_Parameter.ComingHomeAltitude) HoTT_printf("%um",EE_Parameter.ComingHomeAltitude) else HoTT_printf("HOLD ");
		361	break;
1921	holgerb	362	case 6:
1923	holgerb	363	HoTT_printfxy(0,6,"Ni:%4i Ro:%4i C:%3i",PPM_in[EE_Parameter.Kanalbelegung[K_NICK]],PPM_in[EE_Parameter.Kanalbelegung[K_ROLL]], Parameter_ServoNickControl);
1933	holgerb	364	HoTT_printfxy(0,7,"Gs:%4i Ya:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_GAS]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]);
1921	holgerb	365	break;
		366	case 7: //HoTT_printfxy(0,6,"WARNINGS:");
		367	if(HoTTBlink)
		368	{
		369	LIBFC_HoTT_SetPos(6 * 21);
		370	if(!(Parameter_GlobalConfig & CFG_ACHSENKOPPLUNG_AKTIV)) HoTT_printf_BLINK("COUPLING OFF! ");
		371	if(EE_Parameter.BitConfig & (CFG_LOOP_LINKS \| CFG_LOOP_RECHTS \| CFG_LOOP_UNTEN \| CFG_LOOP_OBEN)) HoTT_printf_BLINK("LOOPING! ");
		372	if(Parameter_GlobalConfig & CFG_HEADING_HOLD) HoTT_printf_BLINK("HH! ");
		373	if(!(Parameter_GlobalConfig & CFG_KOMPASS_AKTIV)) HoTT_printf_BLINK("COMPASS OFF! ");
		374	}
		375	break;
		376	case 8: ASCIIPacket.WarnBeep = HoTT_Waring();
		377	break;
		378	case 9:
		379	case 10:
		380	case 11:
		381	case 12:
		382	case 13:
		383	case 14:
		384	case 15:
		385	case 16:
1939	holgerb	386	if(HottKeyboard == 1) { LIBFC_HoTT_Clear(); page = 1; line = 0;};
1921	holgerb	387	HottKeyboard = 0;
		388	break;
1933	holgerb	389	default: line = 0;
1917	holgerb	390	break;
		391	}
1921	holgerb	392	else page = 0;
1917	holgerb	393	}
		394
1925	holgerb	395	#endif
1917	holgerb	396
		397
		398

Subversion Repositories FlightCtrl

(root)/branches/V2.08a_Rens_Testversion/hottmenu.c @ 2503 - Rev 1939