WebSVN - FlightCtrl - Diff - Rev 2034 and 2050

Rev 2034		Rev 2050
-		1	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
-		2	// + www.MikroKopter.com
-		3	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
-		4	// + Software Nutzungsbedingungen (english version: see below)
-		5	// + der Fa. HiSystems GmbH, Flachsmeerstrasse 2, 26802 Moormerland - nachfolgend Lizenzgeber genannt -
-		6	// + Der Lizenzgeber räumt dem Kunden ein nicht-ausschließliches, zeitlich und räumlich* unbeschränktes Recht ein, die im den
-		7	// + Mikrocontroller verwendete Firmware für die Hardware Flight-Ctrl, Navi-Ctrl, BL-Ctrl, MK3Mag & PC-Programm MikroKopter-Tool
-		8	// + - nachfolgend Software genannt - nur für private Zwecke zu nutzen.
-		9	// + Der Einsatz dieser Software ist nur auf oder mit Produkten des Lizenzgebers zulässig.
-		10	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
-		11	// + Die vom Lizenzgeber gelieferte Software ist urheberrechtlich geschützt. Alle Rechte an der Software sowie an sonstigen im
-		12	// + Rahmen der Vertragsanbahnung und Vertragsdurchführung überlassenen Unterlagen stehen im Verhältnis der Vertragspartner ausschließlich dem Lizenzgeber zu.
-		13	// + Die in der Software enthaltenen Copyright-Vermerke, Markenzeichen, andere Rechtsvorbehalte, Seriennummern sowie
-		14	// + sonstige der Programmidentifikation dienenden Merkmale dürfen vom Kunden nicht verändert oder unkenntlich gemacht werden.
-		15	// + Der Kunde trifft angemessene Vorkehrungen für den sicheren Einsatz der Software. Er wird die Software gründlich auf deren
-		16	// + Verwendbarkeit zu dem von ihm beabsichtigten Zweck testen, bevor er diese operativ einsetzt.
-		17	// + Die Haftung des Lizenzgebers wird - soweit gesetzlich zulässig - begrenzt in Höhe des typischen und vorhersehbaren
-		18	// + Schadens. Die gesetzliche Haftung bei Personenschäden und nach dem Produkthaftungsgesetz bleibt unberührt. Dem Lizenzgeber steht jedoch der Einwand
-		19	// + des Mitverschuldens offen.
-		20	// + Der Kunde trifft angemessene Vorkehrungen für den Fall, dass die Software ganz oder teilweise nicht ordnungsgemäß arbeitet.
-		21	// + Er wird die Software gründlich auf deren Verwendbarkeit zu dem von ihm beabsichtigten Zweck testen, bevor er diese operativ einsetzt.
-		22	// + Der Kunde wird er seine Daten vor Einsatz der Software nach dem Stand der Technik sichern.
-		23	// + Der Kunde ist darüber unterrichtet, dass der Lizenzgeber seine Daten im zur Vertragsdurchführung erforderlichen Umfang
-		24	// + und auf Grundlage der Datenschutzvorschriften erhebt, speichert, verarbeitet und, sofern notwendig, an Dritte übermittelt.
-		25	// + *) Die räumliche Nutzung bezieht sich nur auf den Einsatzort, nicht auf die Reichweite der programmierten Software.
-		26	// + #### ENDE DER NUTZUNGSBEDINGUNGEN ####'
-		27	// + Hinweis: Informationen über erweiterte Nutzungsrechte (wie z.B. Nutzung für nicht-private Zwecke) sind auf Anfrage per Email an info(@)hisystems.de verfügbar.
-		28	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
-		29	// + Software LICENSING TERMS
-		30	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
-		31	// + of HiSystems GmbH, Flachsmeerstrasse 2, 26802 Moormerland, Germany - the Licensor -
-		32	// + The Licensor grants the customer a non-exclusive license to use the microcontroller firmware of the Flight-Ctrl, Navi-Ctrl, BL-Ctrl, and MK3Mag hardware
-		33	// + (the Software) exclusively for private purposes. The License is unrestricted with respect to time and territory*.
-		34	// + The Software may only be used with the Licensor's products.
-		35	// + The Software provided by the Licensor is protected by copyright. With respect to the relationship between the parties to this
-		36	// + agreement, all rights pertaining to the Software and other documents provided during the preparation and execution of this
-		37	// + agreement shall be the property of the Licensor.
-		38	// + The information contained in the Software copyright notices, trademarks, other legal reservations, serial numbers and other
-		39	// + features that can be used to identify the program may not be altered or defaced by the customer.
-		40	// + The customer shall be responsible for taking reasonable precautions
-		41	// + for the safe use of the Software. The customer shall test the Software thoroughly regarding its suitability for the
-		42	// + intended purpose before implementing it for actual operation. The Licensor's liability shall be limited to the extent of typical and
-		43	// + foreseeable damage to the extent permitted by law, notwithstanding statutory liability for bodily injury and product
-		44	// + liability. However, the Licensor shall be entitled to the defense of contributory negligence.
-		45	// + The customer will take adequate precautions in the case, that the software is not working properly. The customer will test
-		46	// + the software for his purpose before any operational usage. The customer will backup his data before using the software.
-		47	// + The customer understands that the Licensor collects, stores and processes, and, where required, forwards, customer data
-		48	// + to third parties to the extent necessary for executing the agreement, subject to applicable data protection and privacy regulations.
-		49	// + *) The territory aspect only refers to the place where the Software is used, not its programmed range.
-		50	// + #### END OF LICENSING TERMS ####
-		51	// + Note: For information on license extensions (e.g. commercial use), please contact us at info(@)hisystems.de.
-		52	// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
1	#include "libfc.h"	53	#include "libfc.h"
2	#include "printf_P.h"	54	#include "printf_P.h"
3	#include "main.h"	55	#include "main.h"
4	#include "spi.h"	56	#include "spi.h"
5	#include "capacity.h"	57	#include "capacity.h"
6		58
7	#if (defined(__AVR_ATmega1284__) \|\| defined(__AVR_ATmega1284P__))	59	#if (defined(__AVR_ATmega1284__) \|\| defined(__AVR_ATmega1284P__))
8		60
9	#define HoTT_printf(format, args...) { _printf_P(&LIBFC_HoTT_Putchar, PSTR(format) , ## args);}	61	#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);}	62	#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);}	63	#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);}	64	#define HoTT_printfxy_BLINK(x,y,format, args...) { LIBFC_HoTT_SetPos(y * 21 + x); _printf_P(&LIBFC_HoTT_Putchar_BLINK, PSTR(format) , ## args);}
13	#define HoTT_printf_BLINK(format, args...) { _printf_P(&LIBFC_HoTT_Putchar_BLINK, PSTR(format) , ## args);}	65	#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);}	66	#define HoTT_printf_INV(format, args...) { _printf_P(&LIBFC_HoTT_Putchar_INV, PSTR(format) , ## args);}
15		67
16	#define VOICE_MINIMALE_EINGANSSPANNUNG 16	68	#define VOICE_MINIMALE_EINGANSSPANNUNG 16
17	#define VOICE_BEEP 5	69	#define VOICE_BEEP 5
18	#define HoTT_GRAD 96	70	#define HoTT_GRAD 96
19	#define HoTT_LINKS 123	71	#define HoTT_LINKS 123
20	#define HoTT_RECHTS 124	72	#define HoTT_RECHTS 124
21	#define HoTT_OBEN 125	73	#define HoTT_OBEN 125
22	#define HoTT_UNTEN 126	74	#define HoTT_UNTEN 126
23		75
24	#define HOTT_KEY_RIGHT 1	76	#define HOTT_KEY_RIGHT 1
25	#define HOTT_KEY_DOWN 2	77	#define HOTT_KEY_DOWN 2
26	#define HOTT_KEY_UP 4	78	#define HOTT_KEY_UP 4
27	#define HOTT_KEY_SET 6	79	#define HOTT_KEY_SET 6
28	#define HOTT_KEY_LEFT 8	80	#define HOTT_KEY_LEFT 8
29		81
30	GPSPacket_t GPSPacket;	82	GPSPacket_t GPSPacket;
31	VarioPacket_t VarioPacket;	83	VarioPacket_t VarioPacket;
32	ASCIIPacket_t ASCIIPacket;	84	ASCIIPacket_t ASCIIPacket;
33	ElectricAirPacket_t ElectricAirPacket;	85	ElectricAirPacket_t ElectricAirPacket;
34	HoTTGeneral_t HoTTGeneral;	86	HoTTGeneral_t HoTTGeneral;
35	int HoTTVarioMeter = 0;	87	int HoTTVarioMeter = 0;
36		88
37	const char PROGMEM NC_ERROR_TEXT[MAX_ERR_NUMBER][17] =	89	const char PROGMEM NC_ERROR_TEXT[MAX_ERR_NUMBER][17] =
38	{	90	{
39	//0123456789123456	91	//0123456789123456
40	"No Error \0", // 0	92	"No Error \0", // 0
41	"Not compatible \0", // 1	93	"Not compatible \0", // 1
42	"MK3Mag not compa\0", // 2	94	"MK3Mag not compa\0", // 2
43	"No FC communicat\0", // 3	95	"No FC communicat\0", // 3
44	"MK3Mag communica\0", // 4	96	"MK3Mag communica\0", // 4
45	"GPS communicatio\0", // 5	97	"GPS communicatio\0", // 5
46	"compass value \0", // 6	98	"compass value \0", // 6
47	"RC Signal lost \0", // 7	99	"RC Signal lost \0", // 7
48	"FC spi rx error \0", // 8	100	"FC spi rx error \0", // 8
49	"No NC communicat\0", // 9	101	"No NC communicat\0", // 9
50	"FC Nick Gyro \0", // 10	102	"FC Nick Gyro \0", // 10
51	"FC Roll Gyro \0", // 11	103	"FC Roll Gyro \0", // 11
52	"FC Yaw Gyro \0", // 12	104	"FC Yaw Gyro \0", // 12
53	"FC Nick ACC \0", // 13	105	"FC Nick ACC \0", // 13
54	"FC Roll ACC \0", // 14	106	"FC Roll ACC \0", // 14
55	"FC Z-ACC \0", // 15	107	"FC Z-ACC \0", // 15
56	"Pressure sensor \0", // 16	108	"Pressure sensor \0", // 16
57	"I2C FC->BL-Ctrl \0", // 17	109	"I2C FC->BL-Ctrl \0", // 17
58	"Bl Missing \0", // 18	110	"Bl Missing \0", // 18
59	"Mixer Error \0", // 19	111	"Mixer Error \0", // 19
60	"Carefree Error \0", // 20	112	"Carefree Error \0", // 20
61	"GPS Fix lost \0", // 21	113	"GPS Fix lost \0", // 21
62	"Magnet Error \0", // 22	114	"Magnet Error \0", // 22
63	"Motor restart \0", // 23	115	"Motor restart \0", // 23
64	"BL Limitation \0", // 24	116	"BL Limitation \0", // 24
65	"GPS Range \0", // 25	117	"GPS Range \0", // 25
66	"No SD-Card \0", // 26	118	"No SD-Card \0", // 26
67	"SD-Logging error\0", // 27	119	"SD-Logging error\0", // 27
68	"Flying range! \0", // 28	120	"Flying range! \0", // 28
69	"Max Altitude! \0" // 29	121	"Max Altitude! \0" // 29
70	};	122	};
71		123
72	unsigned char MaxBlTempertaure = 0;	124	unsigned char MaxBlTempertaure = 0;
73	unsigned char MinBlTempertaure = 0;	125	unsigned char MinBlTempertaure = 0;
74	unsigned char HottestBl = 0;	126	unsigned char HottestBl = 0;
75		127
76	void GetHottestBl(void)	128	void GetHottestBl(void)
77	{	129	{
78	static unsigned char search = 0,tmp_max,tmp_min,who;	130	static unsigned char search = 0,tmp_max,tmp_min,who;
79	if(Motor[search].Temperature > tmp_max) { tmp_max = Motor[search].Temperature; who = search;}	131	if(Motor[search].Temperature > tmp_max) { tmp_max = Motor[search].Temperature; who = search;}
80	else	132	else
81	if(Motor[search].Temperature) if(Motor[search].Temperature < tmp_min) tmp_min = Motor[search].Temperature;	133	if(Motor[search].Temperature) if(Motor[search].Temperature < tmp_min) tmp_min = Motor[search].Temperature;
82	if(++search > MAX_MOTORS)	134	if(++search > MAX_MOTORS)
83	{	135	{
84	search = 0;	136	search = 0;
85	if(tmp_min != 255) MinBlTempertaure = tmp_min; else MinBlTempertaure = 0;	137	if(tmp_min != 255) MinBlTempertaure = tmp_min; else MinBlTempertaure = 0;
86	MaxBlTempertaure = tmp_max;	138	MaxBlTempertaure = tmp_max;
87	HottestBl = who;	139	HottestBl = who;
88	tmp_min = 255;	140	tmp_min = 255;
89	tmp_max = 0;	141	tmp_max = 0;
90	who = 0;	142	who = 0;
91	}	143	}
92	}	144	}
93		145
94	//---------------------------------------------------------------	146	//---------------------------------------------------------------
95	void Hott_ClearLine(unsigned char line)	147	void Hott_ClearLine(unsigned char line)
96	{	148	{
97	HoTT_printfxy(0,line," ");	149	HoTT_printfxy(0,line," ");
98	}	150	}
99	//---------------------------------------------------------------	151	//---------------------------------------------------------------
100		152
101	unsigned char HoTT_Waring(void)	153	unsigned char HoTT_Waring(void)
102	{	154	{
103	if(FC_StatusFlags & FC_STATUS_LOWBAT) return(VOICE_MINIMALE_EINGANSSPANNUNG);	155	if(FC_StatusFlags & FC_STATUS_LOWBAT) return(VOICE_MINIMALE_EINGANSSPANNUNG);
104	if(MotorenEin && NC_ErrorCode) return(VOICE_BEEP);	156	if(MotorenEin && NC_ErrorCode) return(VOICE_BEEP);
105	//if(Parameter_UserParam1) return(Parameter_UserParam1);	157	//if(Parameter_UserParam1) return(Parameter_UserParam1);
106	return(0);	158	return(0);
107	}	159	}
108		160
109	//---------------------------------------------------------------	161	//---------------------------------------------------------------
110	void NC_Fills_HoTT_Telemety(void)	162	void NC_Fills_HoTT_Telemety(void)
111	{	163	{
112	unsigned char *ptr = NULL;	164	unsigned char *ptr = NULL;
113	unsigned char max = 0,i,z;	165	unsigned char max = 0,i,z;
114	switch(FromNaviCtrl.Param.Byte[11])	166	switch(FromNaviCtrl.Param.Byte[11])
115	{	167	{
116	case HOTT_VARIO_PACKET_ID:	168	case HOTT_VARIO_PACKET_ID:
117	ptr = (unsigned char *) &VarioPacket;	169	ptr = (unsigned char *) &VarioPacket;
118	max = sizeof(VarioPacket);	170	max = sizeof(VarioPacket);
119	break;	171	break;
120	case HOTT_GPS_PACKET_ID:	172	case HOTT_GPS_PACKET_ID:
121	ptr = (unsigned char *) &GPSPacket;	173	ptr = (unsigned char *) &GPSPacket;
122	max = sizeof(GPSPacket);	174	max = sizeof(GPSPacket);
123	break;	175	break;
124	case HOTT_ELECTRIC_AIR_PACKET_ID:	176	case HOTT_ELECTRIC_AIR_PACKET_ID:
125	ptr = (unsigned char *) &ElectricAirPacket;	177	ptr = (unsigned char *) &ElectricAirPacket;
126	max = sizeof(ElectricAirPacket);	178	max = sizeof(ElectricAirPacket);
127	break;	179	break;
128	case HOTT_GENERAL_PACKET_ID:	180	case HOTT_GENERAL_PACKET_ID:
129	ptr = (unsigned char *) &HoTTGeneral;	181	ptr = (unsigned char *) &HoTTGeneral;
130	max = sizeof(HoTTGeneral);	182	max = sizeof(HoTTGeneral);
131	break;	183	break;
132	}	184	}
133	z = FromNaviCtrl.Param.Byte[0]; // Data allocation	185	z = FromNaviCtrl.Param.Byte[0]; // Data allocation
134		186
135	for(i=0; i < FromNaviCtrl.Param.Byte[1]; i++)	187	for(i=0; i < FromNaviCtrl.Param.Byte[1]; i++)
136	{	188	{
137	if(z >= max) break;	189	if(z >= max) break;
138	ptr[z] = FromNaviCtrl.Param.Byte[2+i];	190	ptr[z] = FromNaviCtrl.Param.Byte[2+i];
139	z++;	191	z++;
140	}	192	}
141	}	193	}
142		194
143	unsigned int BuildHoTT_Vario(void)	195	unsigned int BuildHoTT_Vario(void)
144	{	196	{
145	unsigned int tmp = 30000;	197	unsigned int tmp = 30000;
146	if(VarioCharacter == '+' \|\| VarioCharacter == '-')	198	if(VarioCharacter == '+' \|\| VarioCharacter == '-')
147	{	199	{
148	tmp = 30000 + (AltitudeSetpointTrimming * EE_Parameter.Hoehe_Verstaerkung) / 3;	200	tmp = 30000 + (AltitudeSetpointTrimming * EE_Parameter.Hoehe_Verstaerkung) / 3;
149	if(tmp < 30000 && tmp > 30000 - 50) tmp = 30000 - 50; // weil es sonst erst bei < 0,5m/sek piept	201	if(tmp < 30000 && tmp > 30000 - 50) tmp = 30000 - 50; // weil es sonst erst bei < 0,5m/sek piept
150	}	202	}
151	else	203	else
152	if((VarioCharacter == ' ') && (FC_StatusFlags & FC_STATUS_FLY))	204	if((VarioCharacter == ' ') && (FC_StatusFlags & FC_STATUS_FLY))
153	{	205	{
154	tmp = 30000 + HoTTVarioMeter;	206	tmp = 30000 + HoTTVarioMeter;
155	if(tmp > 30000)	207	if(tmp > 30000)
156	{	208	{
157	if(tmp < 30000 + 100) tmp = 30000;	209	if(tmp < 30000 + 100) tmp = 30000;
158	else tmp -= 100;	210	else tmp -= 100;
159	}	211	}
160	if(tmp < 30000)	212	if(tmp < 30000)
161	{	213	{
162	if(tmp > 30000 - 100) tmp = 30000;	214	if(tmp > 30000 - 100) tmp = 30000;
163	else tmp += 100;	215	else tmp += 100;
164	}	216	}
165	}	217	}
166	else	218	else
167	if(VarioCharacter == '^') tmp = 30000 + FromNC_AltitudeSpeed * 10;	219	if(VarioCharacter == '^') tmp = 30000 + FromNC_AltitudeSpeed * 10;
168	else	220	else
169	if(VarioCharacter == 'v') tmp = 30000 - FromNC_AltitudeSpeed * 10;	221	if(VarioCharacter == 'v') tmp = 30000 - FromNC_AltitudeSpeed * 10;
170		222
171	return(tmp);	223	return(tmp);
172	}	224	}
173		225
174		226
175	//---------------------------------------------------------------	227	//---------------------------------------------------------------
176	unsigned char HoTT_Telemety(unsigned char packet_request)	228	unsigned char HoTT_Telemety(unsigned char packet_request)
177	{	229	{
178	switch(packet_request)	230	switch(packet_request)
179	{	231	{
180	case HOTT_VARIO_PACKET_ID:	232	case HOTT_VARIO_PACKET_ID:
181	VarioPacket.Altitude = HoehenWert/100 + 500;	233	VarioPacket.Altitude = HoehenWert/100 + 500;
182	VarioPacket.m_sec = BuildHoTT_Vario();	234	VarioPacket.m_sec = BuildHoTT_Vario();
183	VarioPacket.m_3sec = VarioPacket.m_sec;	235	VarioPacket.m_3sec = VarioPacket.m_sec;
184	VarioPacket.m_10sec = VarioPacket.m_sec;	236	VarioPacket.m_10sec = VarioPacket.m_sec;
185	if (VarioPacket.Altitude < VarioPacket.MinAltitude) VarioPacket.MinAltitude = VarioPacket.Altitude;	237	if (VarioPacket.Altitude < VarioPacket.MinAltitude) VarioPacket.MinAltitude = VarioPacket.Altitude;
186	if (VarioPacket.Altitude > VarioPacket.MaxAltitude) VarioPacket.MaxAltitude = VarioPacket.Altitude;	238	if (VarioPacket.Altitude > VarioPacket.MaxAltitude) VarioPacket.MaxAltitude = VarioPacket.Altitude;
187	VarioPacket.WarnBeep = HoTT_Waring();	239	VarioPacket.WarnBeep = HoTT_Waring();
188	HoTT_DataPointer = (unsigned char *) &VarioPacket;	240	HoTT_DataPointer = (unsigned char *) &VarioPacket;
189	return(sizeof(VarioPacket));	241	return(sizeof(VarioPacket));
190	break;	242	break;
191		243
192	case HOTT_GPS_PACKET_ID:	244	case HOTT_GPS_PACKET_ID:
193	GPSPacket.Altitude = HoehenWert/100 + 500;	245	GPSPacket.Altitude = HoehenWert/100 + 500;
194	// GPSPacket.Distance = GPSInfo.HomeDistance/10; // macht die NC	246	// GPSPacket.Distance = GPSInfo.HomeDistance/10; // macht die NC
195	// GPSPacket.Heading = GPSInfo.HomeBearing/2; // macht die NC	247	// GPSPacket.Heading = GPSInfo.HomeBearing/2; // macht die NC
196	// GPSPacket.Speed = (GPSInfo.Speed * 36) / 10; // macht die NC	248	// GPSPacket.Speed = (GPSInfo.Speed * 36) / 10; // macht die NC
197	GPSPacket.m_sec = BuildHoTT_Vario();	249	GPSPacket.m_sec = BuildHoTT_Vario();
198	GPSPacket.m_3sec = 120;	250	GPSPacket.m_3sec = 120;
199	GPSPacket.m_10sec = 0;	251	GPSPacket.m_10sec = 0;
200	GPSPacket.WarnBeep = HoTT_Waring();	252	GPSPacket.WarnBeep = HoTT_Waring();
201	HoTT_DataPointer = (unsigned char *) &GPSPacket;	253	HoTT_DataPointer = (unsigned char *) &GPSPacket;
202	return(sizeof(GPSPacket));	254	return(sizeof(GPSPacket));
203	break;	255	break;
204	case HOTT_ELECTRIC_AIR_PACKET_ID:	256	case HOTT_ELECTRIC_AIR_PACKET_ID:
205	GetHottestBl();	257	GetHottestBl();
206	ElectricAirPacket.Altitude = HoehenWert/100 + 500;	258	ElectricAirPacket.Altitude = HoehenWert/100 + 500;
207	ElectricAirPacket.Battery1 = UBat;	259	ElectricAirPacket.Battery1 = UBat;
208	ElectricAirPacket.Battery2 = UBat;	260	ElectricAirPacket.Battery2 = UBat;
209	ElectricAirPacket.VoltageCell1 = ErsatzKompassInGrad / 2;	261	ElectricAirPacket.VoltageCell1 = ErsatzKompassInGrad / 2;
210	ElectricAirPacket.VoltageCell8 = ElectricAirPacket.VoltageCell1;	262	ElectricAirPacket.VoltageCell8 = ElectricAirPacket.VoltageCell1;
211	ElectricAirPacket.VoltageCell6 = GPSInfo.HomeBearing / 2;	263	ElectricAirPacket.VoltageCell6 = GPSInfo.HomeBearing / 2;
212	ElectricAirPacket.VoltageCell7 = GPSInfo.HomeDistance/20;	264	ElectricAirPacket.VoltageCell7 = GPSInfo.HomeDistance/20;
213	ElectricAirPacket.VoltageCell13 = ElectricAirPacket.VoltageCell6;	265	ElectricAirPacket.VoltageCell13 = ElectricAirPacket.VoltageCell6;
214	ElectricAirPacket.VoltageCell14 = ElectricAirPacket.VoltageCell7;	266	ElectricAirPacket.VoltageCell14 = ElectricAirPacket.VoltageCell7;
215	ElectricAirPacket.m_sec = BuildHoTT_Vario();	267	ElectricAirPacket.m_sec = BuildHoTT_Vario();
216	ElectricAirPacket.m_3sec = 120;	268	ElectricAirPacket.m_3sec = 120;
217	ElectricAirPacket.InputVoltage = UBat;	269	ElectricAirPacket.InputVoltage = UBat;
218	ElectricAirPacket.Temperature1 = MinBlTempertaure + 20;	270	ElectricAirPacket.Temperature1 = MinBlTempertaure + 20;
219	ElectricAirPacket.Temperature2 = MaxBlTempertaure + 20;	271	ElectricAirPacket.Temperature2 = MaxBlTempertaure + 20;
220	ElectricAirPacket.Capacity = Capacity.UsedCapacity/10;	272	ElectricAirPacket.Capacity = Capacity.UsedCapacity/10;
221	ElectricAirPacket.WarnBeep = HoTT_Waring();	273	ElectricAirPacket.WarnBeep = HoTT_Waring();
222	ElectricAirPacket.Current = Capacity.ActualCurrent;	274	ElectricAirPacket.Current = Capacity.ActualCurrent;
223	HoTT_DataPointer = (unsigned char *) &ElectricAirPacket;	275	HoTT_DataPointer = (unsigned char *) &ElectricAirPacket;
224	return(sizeof(ElectricAirPacket));	276	return(sizeof(ElectricAirPacket));
225	break;	277	break;
226	case HOTT_GENERAL_PACKET_ID:	278	case HOTT_GENERAL_PACKET_ID:
227	GetHottestBl();	279	GetHottestBl();
228	HoTTGeneral.Rpm = GPSInfo.HomeDistance/100;	280	HoTTGeneral.Rpm = GPSInfo.HomeDistance/100;
229	HoTTGeneral.VoltageCell1 = ErsatzKompassInGrad / 2;	281	HoTTGeneral.VoltageCell1 = ErsatzKompassInGrad / 2;
230	HoTTGeneral.VoltageCell6 = GPSInfo.HomeBearing / 2;	282	HoTTGeneral.VoltageCell6 = GPSInfo.HomeBearing / 2;
231	if(UBat > BattLowVoltageWarning + 5) HoTTGeneral.FuelPercent = (UBat - (BattLowVoltageWarning + 6)) * 3;	283	if(UBat > BattLowVoltageWarning + 5) HoTTGeneral.FuelPercent = (UBat - (BattLowVoltageWarning + 6)) * 3;
232	else HoTTGeneral.FuelPercent = 0;	284	else HoTTGeneral.FuelPercent = 0;
233	HoTTGeneral.FuelCapacity = HoehenWert/100;	285	HoTTGeneral.FuelCapacity = HoehenWert/100;
234	if(HoTTGeneral.FuelCapacity < 0) HoTTGeneral.FuelCapacity = 0;	286	if(HoTTGeneral.FuelCapacity < 0) HoTTGeneral.FuelCapacity = 0;
235	HoTTGeneral.Altitude = HoehenWert/100 + 500;	287	HoTTGeneral.Altitude = HoehenWert/100 + 500;
236	HoTTGeneral.Battery1 = UBat;	288	HoTTGeneral.Battery1 = UBat;
237	HoTTGeneral.Battery2 = UBat;	289	HoTTGeneral.Battery2 = UBat;
238	HoTTGeneral.m_sec = BuildHoTT_Vario();	290	HoTTGeneral.m_sec = BuildHoTT_Vario();
239	HoTTGeneral.m_3sec = 120;	291	HoTTGeneral.m_3sec = 120;
240	HoTTGeneral.InputVoltage = UBat;	292	HoTTGeneral.InputVoltage = UBat;
241	HoTTGeneral.Temperature1 = MinBlTempertaure + 20;	293	HoTTGeneral.Temperature1 = MinBlTempertaure + 20;
242	HoTTGeneral.Temperature2 = MaxBlTempertaure + 20;	294	HoTTGeneral.Temperature2 = MaxBlTempertaure + 20;
243	HoTTGeneral.Capacity = Capacity.UsedCapacity/10;	295	HoTTGeneral.Capacity = Capacity.UsedCapacity/10;
244	HoTTGeneral.WarnBeep = HoTT_Waring();	296	HoTTGeneral.WarnBeep = HoTT_Waring();
245	HoTTGeneral.Current = Capacity.ActualCurrent;	297	HoTTGeneral.Current = Capacity.ActualCurrent;
246	HoTT_DataPointer = (unsigned char *) &HoTTGeneral;	298	HoTT_DataPointer = (unsigned char *) &HoTTGeneral;
247	return(sizeof(HoTTGeneral));	299	return(sizeof(HoTTGeneral));
248	break;	300	break;
249	default: return(0);	301	default: return(0);
250	}	302	}
251	}	303	}
252		304
253	//---------------------------------------------------------------	305	//---------------------------------------------------------------
254	void HoTT_Menu(void)	306	void HoTT_Menu(void)
255	{	307	{
256	static unsigned char line, page = 0,show_current = 0,show_mag = 0, show_poti = 0;	308	static unsigned char line, page = 0,show_current = 0,show_mag = 0, show_poti = 0;
257	unsigned char tmp;	309	unsigned char tmp;
258	HoTTVarioMeter = (HoTTVarioMeter * 7 + VarioMeter) / 8;	310	HoTTVarioMeter = (HoTTVarioMeter * 7 + VarioMeter) / 8;
259		311
260	if(page == 0)	312	if(page == 0)
261	switch(line++)	313	switch(line++)
262	{	314	{
263	case 0:	315	case 0:
264	if(FC_StatusFlags & FC_STATUS_LOWBAT)	316	if(FC_StatusFlags & FC_STATUS_LOWBAT)
265	HoTT_printfxy_BLINK(0,0," %2i.%1iV ",UBat/10, UBat%10)	317	HoTT_printfxy_BLINK(0,0," %2i.%1iV ",UBat/10, UBat%10)
266	else	318	else
267	HoTT_printfxy(0,0," %2i.%1iV ",UBat/10, UBat%10)	319	HoTT_printfxy(0,0," %2i.%1iV ",UBat/10, UBat%10)
268		320
269	if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)	321	if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)
270	{	322	{
271	if(HoehenReglerAktiv) HoTT_printfxy_INV(10,0,"ALT:%4im %c", (int16_t)(HoehenWert/100),VarioCharacter)	323	if(HoehenReglerAktiv) HoTT_printfxy_INV(10,0,"ALT:%4im %c", (int16_t)(HoehenWert/100),VarioCharacter)
272	else HoTT_printfxy(10,0,"ALT:%4im ", (int16_t)(HoehenWert/100))	324	else HoTT_printfxy(10,0,"ALT:%4im ", (int16_t)(HoehenWert/100))
273	}	325	}
274	else HoTT_printfxy(10,0,"ALT:---- ");	326	else HoTT_printfxy(10,0,"ALT:---- ");
275	break;	327	break;
276	case 1:	328	case 1:
277	if(FC_StatusFlags & FC_STATUS_LOWBAT)	329	if(FC_StatusFlags & FC_STATUS_LOWBAT)
278	HoTT_printfxy_BLINK(0,1," %2i:%02i ",FlugSekunden/60,FlugSekunden%60)	330	HoTT_printfxy_BLINK(0,1," %2i:%02i ",FlugSekunden/60,FlugSekunden%60)
279	else HoTT_printfxy(0,1," %2i:%02i ",FlugSekunden/60,FlugSekunden%60);	331	else HoTT_printfxy(0,1," %2i:%02i ",FlugSekunden/60,FlugSekunden%60);
280	HoTT_printfxy(10,1,"DIR: %3d%c",ErsatzKompassInGrad, HoTT_GRAD);	332	HoTT_printfxy(10,1,"DIR: %3d%c",ErsatzKompassInGrad, HoTT_GRAD);
281	if(FC_StatusFlags2 & FC_STATUS2_CAREFREE) HoTT_printfxy_INV(20,1,"C") else HoTT_printfxy(20,1," ");	333	if(FC_StatusFlags2 & FC_STATUS2_CAREFREE) HoTT_printfxy_INV(20,1,"C") else HoTT_printfxy(20,1," ");
282	break;	334	break;
283	case 2:	335	case 2:
284	if(FC_StatusFlags & FC_STATUS_LOWBAT)	336	if(FC_StatusFlags & FC_STATUS_LOWBAT)
285	HoTT_printfxy_BLINK(0,2," %5i ",Capacity.UsedCapacity)	337	HoTT_printfxy_BLINK(0,2," %5i ",Capacity.UsedCapacity)
286	else HoTT_printfxy(0,2," %5i ",Capacity.UsedCapacity);	338	else HoTT_printfxy(0,2," %5i ",Capacity.UsedCapacity);
287	HoTT_printfxy(12,2,"I:%2i.%1iA ",Capacity.ActualCurrent/10, Capacity.ActualCurrent%10);	339	HoTT_printfxy(12,2,"I:%2i.%1iA ",Capacity.ActualCurrent/10, Capacity.ActualCurrent%10);
288	break;	340	break;
289	case 3:	341	case 3:
290	HoTT_printfxy(9,0,"I");	342	HoTT_printfxy(9,0,"I");
291	HoTT_printfxy(9,1,"I");	343	HoTT_printfxy(9,1,"I");
292	HoTT_printfxy(9,2,"I");	344	HoTT_printfxy(9,2,"I");
293	HoTT_printfxy(0,3,"---------+-----------");	345	HoTT_printfxy(0,3,"---------+-----------");
294	HoTT_printfxy(0,6,"---------------------");	346	HoTT_printfxy(0,6,"---------------------");
295	break;	347	break;
296	case 4:	348	case 4:
297	if(NaviDataOkay)	349	if(NaviDataOkay)
298	{	350	{
299	HoTT_printfxy(9,4,"I");	351	HoTT_printfxy(9,4,"I");
300	HoTT_printfxy(0,4,"SAT:%2d ",GPSInfo.NumOfSats);	352	HoTT_printfxy(0,4,"SAT:%2d ",GPSInfo.NumOfSats);
301	HoTT_printfxy(10,4,"DIST:%3dm",GPSInfo.HomeDistance/10);	353	HoTT_printfxy(10,4,"DIST:%3dm",GPSInfo.HomeDistance/10);
302	switch (GPSInfo.SatFix)	354	switch (GPSInfo.SatFix)
303	{	355	{
304	case SATFIX_3D:	356	case SATFIX_3D:
305	if(GPSInfo.Flags & FLAG_DIFFSOLN) HoTT_printfxy(7,4,"D ")	357	if(GPSInfo.Flags & FLAG_DIFFSOLN) HoTT_printfxy(7,4,"D ")
306	else HoTT_printfxy(7,4,"3D");	358	else HoTT_printfxy(7,4,"3D");
307	break;	359	break;
308	default:	360	default:
309	HoTT_printfxy_BLINK(7,4,"!!");	361	HoTT_printfxy_BLINK(7,4,"!!");
310	break;	362	break;
311	}	363	}
312	}	364	}
313	else	365	else
314	{	366	{
315	Hott_ClearLine(4);	367	Hott_ClearLine(4);
316	}	368	}
317	break;	369	break;
318	case 5:	370	case 5:
319	if(NaviDataOkay)	371	if(NaviDataOkay)
320	{	372	{
321	if(show_mag)	373	if(show_mag)
322	{	374	{
323	HoTT_printfxy(0,5,"MAG:%3u%% ",EarthMagneticField);	375	HoTT_printfxy(0,5,"MAG:%3u%% ",EarthMagneticField);
324	HoTT_printfxy(12,5,"HM:%3d%c %c", GPSInfo.HomeBearing, HoTT_GRAD, NC_GPS_ModeCharacter);	376	HoTT_printfxy(12,5,"HM:%3d%c %c", GPSInfo.HomeBearing, HoTT_GRAD, NC_GPS_ModeCharacter);
325	HoTT_printfxy(9,5,"incl:%2d%c(%2i)",EarthMagneticInclination, HoTT_GRAD,EarthMagneticInclinationTheoretic);	377	HoTT_printfxy(9,5,"incl:%2d%c(%2i)",EarthMagneticInclination, HoTT_GRAD,EarthMagneticInclinationTheoretic);
326	}	378	}
327	else	379	else
328	{	380	{
329	HoTT_printfxy(9,5,"I");	381	HoTT_printfxy(9,5,"I");
330	HoTT_printfxy(0,5," %2um/s",GPSInfo.Speed,GPSInfo.NumOfSats);	382	HoTT_printfxy(0,5," %2um/s",GPSInfo.Speed,GPSInfo.NumOfSats);
331	HoTT_printfxy(11,5," HM:%3d%c %c", GPSInfo.HomeBearing, HoTT_GRAD, NC_GPS_ModeCharacter);	383	HoTT_printfxy(11,5," HM:%3d%c %c", GPSInfo.HomeBearing, HoTT_GRAD, NC_GPS_ModeCharacter);
332	}	384	}
333	}	385	}
334	else Hott_ClearLine(5);	386	else Hott_ClearLine(5);
335	break;	387	break;
336	case 6:	388	case 6:
337	break;	389	break;
338	case 7: if(NC_ErrorCode)	390	case 7: if(NC_ErrorCode)
339	{	391	{
340	if(HoTTBlink && NC_ErrorCode < MAX_ERR_NUMBER)	392	if(HoTTBlink && NC_ErrorCode < MAX_ERR_NUMBER)
341	{	393	{
342	Hott_ClearLine(7);	394	Hott_ClearLine(7);
343	HoTT_printfxy_INV(0,7,"ERR: %2d !",NC_ErrorCode);	395	HoTT_printfxy_INV(0,7,"ERR: %2d !",NC_ErrorCode);
344	}	396	}
345	else	397	else
346	{	398	{
347	HoTT_printfxy(0,7,"ERR: "); _printf_P(&LIBFC_HoTT_Putchar, NC_ERROR_TEXT[NC_ErrorCode] , 0);};	399	HoTT_printfxy(0,7,"ERR: "); _printf_P(&LIBFC_HoTT_Putchar, NC_ERROR_TEXT[NC_ErrorCode] , 0);};
348	}	400	}
349	else HoTT_printfxy(0,7," www.MikroKopter.de ");	401	else HoTT_printfxy(0,7," www.MikroKopter.de ");
350	break;	402	break;
351	case 8: ASCIIPacket.WarnBeep = HoTT_Waring();	403	case 8: ASCIIPacket.WarnBeep = HoTT_Waring();
352	// ASCIIPacket.WarnBeep = Parameter_UserParam1;	404	// ASCIIPacket.WarnBeep = Parameter_UserParam1;
353	case 9:	405	case 9:
354	case 10:	406	case 10:
355	case 11:	407	case 11:
356	case 12:	408	case 12:
357	case 13:	409	case 13:
358	case 14:	410	case 14:
359	case 15:	411	case 15:
360	case 16:	412	case 16:
361	if(HottKeyboard == HOTT_KEY_SET) { if(show_mag) show_mag = 0; else show_mag = 1;}	413	if(HottKeyboard == HOTT_KEY_SET) { if(show_mag) show_mag = 0; else show_mag = 1;}
362	else	414	else
363	if(HottKeyboard == HOTT_KEY_LEFT) { LIBFC_HoTT_Clear(); page = 1; line = 0;};	415	if(HottKeyboard == HOTT_KEY_LEFT) { LIBFC_HoTT_Clear(); page = 1; line = 0;};
364	HottKeyboard = 0;	416	HottKeyboard = 0;
365	break;	417	break;
366	default: line = 0;	418	default: line = 0;
367	break;	419	break;
368	}	420	}
369	else	421	else
370	if(page == 1)	422	if(page == 1)
371	switch(line++)	423	switch(line++)
372	{	424	{
373	case 0:	425	case 0:
374	if(FC_StatusFlags & FC_STATUS_LOWBAT)	426	if(FC_StatusFlags & FC_STATUS_LOWBAT)
375	HoTT_printfxy_BLINK(0,0," %2i:%02i %2i.%1iV %4imAh",FlugSekunden/60,FlugSekunden%60,UBat/10, UBat%10,Capacity.UsedCapacity)	427	HoTT_printfxy_BLINK(0,0," %2i:%02i %2i.%1iV %4imAh",FlugSekunden/60,FlugSekunden%60,UBat/10, UBat%10,Capacity.UsedCapacity)
376	else HoTT_printfxy(0,0," %2i:%02i %2i.%1iV %4imAh",FlugSekunden/60,FlugSekunden%60,UBat/10, UBat%10,Capacity.UsedCapacity);	428	else HoTT_printfxy(0,0," %2i:%02i %2i.%1iV %4imAh",FlugSekunden/60,FlugSekunden%60,UBat/10, UBat%10,Capacity.UsedCapacity);
377	break;	429	break;
378	case 1:	430	case 1:
379	HoTT_printfxy(0,1,"DIR:%3d%c",KompassValue, HoTT_GRAD);	431	HoTT_printfxy(0,1,"DIR:%3d%c",KompassValue, HoTT_GRAD);
380	if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)	432	if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)
381	{	433	{
382	if(HoehenReglerAktiv) HoTT_printfxy_INV(10,1,"ALT:%4im", (int16_t)(HoehenWert/100))	434	if(HoehenReglerAktiv) HoTT_printfxy_INV(10,1,"ALT:%4im", (int16_t)(HoehenWert/100))
383	else HoTT_printfxy(10,1,"ALT:%4im", (int16_t)(HoehenWert/100))	435	else HoTT_printfxy(10,1,"ALT:%4im", (int16_t)(HoehenWert/100))
384	}	436	}
385	else HoTT_printfxy(10,1,"ALT:---- ");	437	else HoTT_printfxy(10,1,"ALT:---- ");
386	HoTT_printfxy(20,1,"%c",VarioCharacter);	438	HoTT_printfxy(20,1,"%c",VarioCharacter);
387	break;	439	break;
388	case 2:	440	case 2:
389	if(NaviDataOkay)	441	if(NaviDataOkay)
390	{	442	{
391	HoTT_printfxy(1,2,"HM:%3d%c DIST:%3dm %c", GPSInfo.HomeBearing, HoTT_GRAD, GPSInfo.HomeDistance/10, NC_GPS_ModeCharacter);	443	HoTT_printfxy(1,2,"HM:%3d%c DIST:%3dm %c", GPSInfo.HomeBearing, HoTT_GRAD, GPSInfo.HomeDistance/10, NC_GPS_ModeCharacter);
392	}	444	}
393	else	445	else
394	{	446	{
395	Hott_ClearLine(2);	447	Hott_ClearLine(2);
396	}	448	}
397	break;	449	break;
398	case 3:	450	case 3:
399	HoTT_printfxy(0,3,"PWR:%2i.%1iA (%iW) ",Capacity.ActualCurrent/10, Capacity.ActualCurrent%10,Capacity.ActualPower);	451	HoTT_printfxy(0,3,"PWR:%2i.%1iA (%iW) ",Capacity.ActualCurrent/10, Capacity.ActualCurrent%10,Capacity.ActualPower);
400	if(FC_StatusFlags2 & FC_STATUS2_CAREFREE) HoTT_printfxy_INV(19,3,"CF") else HoTT_printfxy(19,3," ");	452	if(FC_StatusFlags2 & FC_STATUS2_CAREFREE) HoTT_printfxy_INV(19,3,"CF") else HoTT_printfxy(19,3," ");
401	break;	453	break;
402	case 4:	454	case 4:
403	if(NaviDataOkay)	455	if(NaviDataOkay)
404	{	456	{
405	HoTT_printfxy(0,4,"GPS:%2um/s SAT:%d ",GPSInfo.Speed,GPSInfo.NumOfSats);	457	HoTT_printfxy(0,4,"GPS:%2um/s SAT:%d ",GPSInfo.Speed,GPSInfo.NumOfSats);
406	switch (GPSInfo.SatFix)	458	switch (GPSInfo.SatFix)
407	{	459	{
408	case SATFIX_3D:	460	case SATFIX_3D:
409	HoTT_printfxy(16,4," 3D ");	461	HoTT_printfxy(16,4," 3D ");
410	break;	462	break;
411	//case SATFIX_2D:	463	//case SATFIX_2D:
412	//case SATFIX_NONE:	464	//case SATFIX_NONE:
413	default:	465	default:
414	HoTT_printfxy_BLINK(16,4,"NOFIX");	466	HoTT_printfxy_BLINK(16,4,"NOFIX");
415	break;	467	break;
416	}	468	}
417	if(GPSInfo.Flags & FLAG_DIFFSOLN)	469	if(GPSInfo.Flags & FLAG_DIFFSOLN)
418	{	470	{
419	HoTT_printfxy(16,4,"DGPS ");	471	HoTT_printfxy(16,4,"DGPS ");
420	}	472	}
421	}	473	}
422	else	474	else
423	{ //012345678901234567890	475	{ //012345678901234567890
424	HoTT_printfxy(0,4," No NaviCtrl ");	476	HoTT_printfxy(0,4," No NaviCtrl ");
425	}	477	}
426	break;	478	break;
427	case 5:	479	case 5:
428	if(show_current)	480	if(show_current)
429	{	481	{
430	HoTT_printfxy(0,5,"%2i.%i %2i.%i %2i.%i %2i.%iA", Motor[0].Current/10,Motor[0].Current%10,Motor[1].Current/10,Motor[1].Current%10,Motor[2].Current/10,Motor[2].Current%10,Motor[3].Current/10,Motor[3].Current%10);	482	HoTT_printfxy(0,5,"%2i.%i %2i.%i %2i.%i %2i.%iA", Motor[0].Current/10,Motor[0].Current%10,Motor[1].Current/10,Motor[1].Current%10,Motor[2].Current/10,Motor[2].Current%10,Motor[3].Current/10,Motor[3].Current%10);
431	}	483	}
432	else	484	else
433	{	485	{
434	HoTT_printfxy(0,5,"%3i %3i %3i %3i%cC", Motor[0].Temperature, Motor[1].Temperature, Motor[2].Temperature, Motor[3].Temperature,HoTT_GRAD);	486	HoTT_printfxy(0,5,"%3i %3i %3i %3i%cC", Motor[0].Temperature, Motor[1].Temperature, Motor[2].Temperature, Motor[3].Temperature,HoTT_GRAD);
435	}	487	}
436	break;	488	break;
437	case 6:	489	case 6:
438	if(show_current)	490	if(show_current)
439	{	491	{
440	if(RequiredMotors == 4) Hott_ClearLine(6);	492	if(RequiredMotors == 4) Hott_ClearLine(6);
441	else	493	else
442	if(RequiredMotors == 6) HoTT_printfxy(0,6,"%2i.%i %2i.%iA", Motor[4].Current/10,Motor[4].Current%10,Motor[5].Current/10,Motor[5].Current%10)	494	if(RequiredMotors == 6) HoTT_printfxy(0,6,"%2i.%i %2i.%iA", Motor[4].Current/10,Motor[4].Current%10,Motor[5].Current/10,Motor[5].Current%10)
443	else	495	else
444	if(RequiredMotors > 6) HoTT_printfxy(0,6,"%2i.%i %2i.%i %2i.%i %2i.%iA", Motor[4].Current/10,Motor[4].Current%10,Motor[5].Current/10,Motor[5].Current%10,Motor[6].Current/10,Motor[6].Current%10,Motor[7].Current/10,Motor[7].Current%10);	496	if(RequiredMotors > 6) HoTT_printfxy(0,6,"%2i.%i %2i.%i %2i.%i %2i.%iA", Motor[4].Current/10,Motor[4].Current%10,Motor[5].Current/10,Motor[5].Current%10,Motor[6].Current/10,Motor[6].Current%10,Motor[7].Current/10,Motor[7].Current%10);
445	}	497	}
446	else	498	else
447	{	499	{
448	if(RequiredMotors == 4) Hott_ClearLine(6);	500	if(RequiredMotors == 4) Hott_ClearLine(6);
449	else	501	else
450	if(RequiredMotors == 6) HoTT_printfxy(0,6,"%3i %3i%cC ", Motor[4].Temperature, Motor[5].Temperature,HoTT_GRAD)	502	if(RequiredMotors == 6) HoTT_printfxy(0,6,"%3i %3i%cC ", Motor[4].Temperature, Motor[5].Temperature,HoTT_GRAD)
451	else	503	else
452	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);	504	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);
453	}	505	}
454	break;	506	break;
455	case 7: if(NC_ErrorCode)	507	case 7: if(NC_ErrorCode)
456	{	508	{
457	if(HoTTBlink && NC_ErrorCode < MAX_ERR_NUMBER)	509	if(HoTTBlink && NC_ErrorCode < MAX_ERR_NUMBER)
458	{	510	{
459	Hott_ClearLine(7);	511	Hott_ClearLine(7);
460	HoTT_printfxy_INV(0,7,"ERR: %2d !",NC_ErrorCode);	512	HoTT_printfxy_INV(0,7,"ERR: %2d !",NC_ErrorCode);
461	}	513	}
462	else	514	else
463	{	515	{
464	HoTT_printfxy(0,7,"ERR: "); _printf_P(&LIBFC_HoTT_Putchar, NC_ERROR_TEXT[NC_ErrorCode] , 0);};	516	HoTT_printfxy(0,7,"ERR: "); _printf_P(&LIBFC_HoTT_Putchar, NC_ERROR_TEXT[NC_ErrorCode] , 0);};
465	}	517	}
466	else HoTT_printfxy(0,7," www.MikroKopter.de ");	518	else HoTT_printfxy(0,7," www.MikroKopter.de ");
467	break;	519	break;
468	case 8: ASCIIPacket.WarnBeep = HoTT_Waring();	520	case 8: ASCIIPacket.WarnBeep = HoTT_Waring();
469	// ASCIIPacket.WarnBeep = Parameter_UserParam1;	521	// ASCIIPacket.WarnBeep = Parameter_UserParam1;
470	case 9:	522	case 9:
471	case 10:	523	case 10:
472	case 11:	524	case 11:
473	case 12:	525	case 12:
474	case 13:	526	case 13:
475	case 14:	527	case 14:
476	case 15:	528	case 15:
477	case 16:	529	case 16:
478	if(HottKeyboard == HOTT_KEY_SET) { if(show_current) show_current = 0; else show_current = 1; Hott_ClearLine(5); Hott_ClearLine(6);}	530	if(HottKeyboard == HOTT_KEY_SET) { if(show_current) show_current = 0; else show_current = 1; Hott_ClearLine(5); Hott_ClearLine(6);}
479	else	531	else
480	if(HottKeyboard == HOTT_KEY_LEFT) { LIBFC_HoTT_Clear(); page = 2; line = 0;}	532	if(HottKeyboard == HOTT_KEY_LEFT) { LIBFC_HoTT_Clear(); page = 2; line = 0;}
481	else	533	else
482	if(HottKeyboard == HOTT_KEY_RIGHT) { LIBFC_HoTT_Clear(); page = 0; line = 0;}	534	if(HottKeyboard == HOTT_KEY_RIGHT) { LIBFC_HoTT_Clear(); page = 0; line = 0;}
483	//if(HottKeyboard) HoTT_printfxy(15,6,"%KEY:%02x ",HottKeyboard);	535	//if(HottKeyboard) HoTT_printfxy(15,6,"%KEY:%02x ",HottKeyboard);
484	HottKeyboard = 0;	536	HottKeyboard = 0;
485	break;	537	break;
486	default: line = 0;	538	default: line = 0;
487	break;	539	break;
488	}	540	}
489	else	541	else
490	if(page == 2)	542	if(page == 2)
491	switch(line++)	543	switch(line++)
492	{	544	{
493	case 0:	545	case 0:
494	HoTT_printfxy_INV(0,0,"Setting:%u %s ",GetActiveParamSet(),EE_Parameter.Name);	546	HoTT_printfxy_INV(0,0,"Setting:%u %s ",GetActiveParamSet(),EE_Parameter.Name);
495	break;	547	break;
496	case 1: HoTT_printfxy(0,1,"Min:%2i.%1iV %s ",BattLowVoltageWarning/10, BattLowVoltageWarning%10, Mixer.Name);	548	case 1: HoTT_printfxy(0,1,"Min:%2i.%1iV %s ",BattLowVoltageWarning/10, BattLowVoltageWarning%10, Mixer.Name);
497	break;	549	break;
498	case 2: HoTT_printfxy(0,2,"ALT:");	550	case 2: HoTT_printfxy(0,2,"ALT:");
499	if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)	551	if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)
500	{	552	{
501	if(!(EE_Parameter.GlobalConfig & CFG_HOEHEN_SCHALTER)) HoTT_printf("POTI:%3u ", Parameter_HoehenSchalter)	553	if(!(EE_Parameter.GlobalConfig & CFG_HOEHEN_SCHALTER)) HoTT_printf("POTI:%3u ", Parameter_HoehenSchalter)
502	else	554	else
503	{	555	{
504	if(Parameter_HoehenSchalter > 50) HoTT_printf("(ON) ") else HoTT_printf("(OFF) ");	556	if(Parameter_HoehenSchalter > 50) HoTT_printf("(ON) ") else HoTT_printf("(OFF) ");
505	if((Parameter_ExtraConfig & CFG2_HEIGHT_LIMIT)) HoTT_printf("LIMIT", Parameter_HoehenSchalter)	557	if((Parameter_ExtraConfig & CFG2_HEIGHT_LIMIT)) HoTT_printf("LIMIT", Parameter_HoehenSchalter)
506	else HoTT_printf("VARIO", Parameter_HoehenSchalter);	558	else HoTT_printf("VARIO", Parameter_HoehenSchalter);
507	}	559	}
508	}	560	}
509	else	561	else
510	HoTT_printf("DISABLED");	562	HoTT_printf("DISABLED");
511	break;	563	break;
512	case 3: HoTT_printfxy(0,3,"CF:");	564	case 3: HoTT_printfxy(0,3,"CF:");
513	if(!EE_Parameter.CareFreeModeControl) HoTT_printf("DISABLED")	565	if(!EE_Parameter.CareFreeModeControl) HoTT_printf("DISABLED")
514	else	566	else
515	{	567	{
516	if(CareFree) HoTT_printf(" (ON) ") else HoTT_printf(" (OFF)");	568	if(CareFree) HoTT_printf(" (ON) ") else HoTT_printf(" (OFF)");
517	if(EE_Parameter.ExtraConfig & CFG_LEARNABLE_CAREFREE) HoTT_printf(" TEACH");	569	if(EE_Parameter.ExtraConfig & CFG_LEARNABLE_CAREFREE) HoTT_printf(" TEACH");
518	}	570	}
519	break;	571	break;
520	case 4: HoTT_printfxy(0,4,"GPS:");	572	case 4: HoTT_printfxy(0,4,"GPS:");
521	if(!(Parameter_GlobalConfig & CFG_GPS_AKTIV)) HoTT_printf("DISABLED")	573	if(!(Parameter_GlobalConfig & CFG_GPS_AKTIV)) HoTT_printf("DISABLED")
522	else	574	else
523	{	575	{
524	CHK_POTI(tmp,EE_Parameter.NaviGpsModeControl);	576	CHK_POTI(tmp,EE_Parameter.NaviGpsModeControl);
525	if(tmp < 50) HoTT_printf("(FREE)")	577	if(tmp < 50) HoTT_printf("(FREE)")
526	else	578	else
527	if(tmp >= 180) HoTT_printf("(HOME)")	579	if(tmp >= 180) HoTT_printf("(HOME)")
528	else	580	else
529	if(EE_Parameter.ExtraConfig & CFG_GPS_AID) HoTT_printf("(AID) ")	581	if(EE_Parameter.ExtraConfig & CFG_GPS_AID) HoTT_printf("(AID) ")
530	else HoTT_printf("(HOLD)")	582	else HoTT_printf("(HOLD)")
531	}	583	}
532	if(EE_Parameter.FailSafeTime) HoTT_printfxy(10,4," FS:%usek ",EE_Parameter.FailSafeTime)	584	if(EE_Parameter.FailSafeTime) HoTT_printfxy(10,4," FS:%usek ",EE_Parameter.FailSafeTime)
533		585
534	break;	586	break;
535	case 5: HoTT_printfxy(0,5,"HOME ALT:");	587	case 5: HoTT_printfxy(0,5,"HOME ALT:");
536	if(EE_Parameter.ComingHomeAltitude) HoTT_printf("%um",EE_Parameter.ComingHomeAltitude) else HoTT_printf("HOLD ");	588	if(EE_Parameter.ComingHomeAltitude) HoTT_printf("%um",EE_Parameter.ComingHomeAltitude) else HoTT_printf("HOLD ");
537	break;	589	break;
538	case 6:	590	case 6:
539	if(!show_poti)	591	if(!show_poti)
540	{	592	{
541	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);	593	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);
542	HoTT_printfxy(0,7,"Gs:%4i Ya:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_GAS]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]);	594	HoTT_printfxy(0,7,"Gs:%4i Ya:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_GAS]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]);
543	}	595	}
544	else	596	else
545	{	597	{
546	HoTT_printfxy(0,6,"P1:%4i P2:%4i 3:%3i",Poti1,Poti2, Poti3);	598	HoTT_printfxy(0,6,"P1:%4i P2:%4i 3:%3i",Poti1,Poti2, Poti3);
547	HoTT_printfxy(0,7,"P4:%4i P5:%4i 6:%3i",Poti4,Poti5, Poti6);	599	HoTT_printfxy(0,7,"P4:%4i P5:%4i 6:%3i",Poti4,Poti5, Poti6);
548	}	600	}
549		601
550	break;	602	break;
551	case 7: //HoTT_printfxy(0,6,"WARNINGS:");	603	case 7: //HoTT_printfxy(0,6,"WARNINGS:");
552	if(HoTTBlink)	604	if(HoTTBlink)
553	{	605	{
554	LIBFC_HoTT_SetPos(6 * 21);	606	LIBFC_HoTT_SetPos(6 * 21);
555	if(!(Parameter_GlobalConfig & CFG_ACHSENKOPPLUNG_AKTIV)) HoTT_printf_BLINK("COUPLING OFF! ");	607	if(!(Parameter_GlobalConfig & CFG_ACHSENKOPPLUNG_AKTIV)) HoTT_printf_BLINK("COUPLING OFF! ");
556	if(EE_Parameter.BitConfig & (CFG_LOOP_LINKS \| CFG_LOOP_RECHTS \| CFG_LOOP_UNTEN \| CFG_LOOP_OBEN)) HoTT_printf_BLINK("LOOPING! ");	608	if(EE_Parameter.BitConfig & (CFG_LOOP_LINKS \| CFG_LOOP_RECHTS \| CFG_LOOP_UNTEN \| CFG_LOOP_OBEN)) HoTT_printf_BLINK("LOOPING! ");
557	if(Parameter_GlobalConfig & CFG_HEADING_HOLD) HoTT_printf_BLINK("HH! ");	609	if(Parameter_GlobalConfig & CFG_HEADING_HOLD) HoTT_printf_BLINK("HH! ");
558	if(!(Parameter_GlobalConfig & CFG_KOMPASS_AKTIV)) HoTT_printf_BLINK("COMPASS OFF! ");	610	if(!(Parameter_GlobalConfig & CFG_KOMPASS_AKTIV)) HoTT_printf_BLINK("COMPASS OFF! ");
559	}	611	}
560	break;	612	break;
561	case 8: ASCIIPacket.WarnBeep = HoTT_Waring();	613	case 8: ASCIIPacket.WarnBeep = HoTT_Waring();
562	break;	614	break;
563	case 9:	615	case 9:
564	case 10:	616	case 10:
565	case 11:	617	case 11:
566	case 12:	618	case 12:
567	case 13:	619	case 13:
568	case 14:	620	case 14:
569	case 15:	621	case 15:
570	case 16:	622	case 16:
571	if(HottKeyboard == HOTT_KEY_SET) { if(show_poti) show_poti = 0; else show_poti = 1; Hott_ClearLine(6); Hott_ClearLine(7);}	623	if(HottKeyboard == HOTT_KEY_SET) { if(show_poti) show_poti = 0; else show_poti = 1; Hott_ClearLine(6); Hott_ClearLine(7);}
572	else	624	else
573	if(HottKeyboard == HOTT_KEY_RIGHT) { LIBFC_HoTT_Clear(); page = 1; line = 0;};	625	if(HottKeyboard == HOTT_KEY_RIGHT) { LIBFC_HoTT_Clear(); page = 1; line = 0;};
574	HottKeyboard = 0;	626	HottKeyboard = 0;
575	break;	627	break;
576	default: line = 0;	628	default: line = 0;
577	break;	629	break;
578	}	630	}
579	else page = 0;	631	else page = 0;
580	}	632	}
581		633
582	#endif	634	#endif
583		635
584		636
585		637
586		638

Subversion Repositories FlightCtrl

(root)/tags/V2.06e/hottmenu.c @ 2633 - Rev 2034 → 2050