Subversion Repositories FlightCtrl

Rev

Rev 1944 | Rev 1949 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1944 Rev 1948
1
#include "libfc.h"
1
#include "libfc.h"
2
#include "printf_P.h"
2
#include "printf_P.h"
3
#include "main.h"
3
#include "main.h"
4
#include "spi.h"
4
#include "spi.h"
5
#include "capacity.h"
5
#include "capacity.h"
6
 
6
 
7
#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))
7
#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))
8
 
8
 
9
#define HoTT_printf(format, args...)                    {  _printf_P(&LIBFC_HoTT_Putchar, PSTR(format) , ## args);}
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);}
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);}
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);}
12
#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);}
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);}
14
#define HoTT_printf_INV(format, args...)                        { _printf_P(&LIBFC_HoTT_Putchar_INV, PSTR(format) , ## args);}
15
 
15
 
16
#define VOICE_MINIMALE_EINGANSSPANNUNG    16
16
#define VOICE_MINIMALE_EINGANSSPANNUNG    16
17
#define VOICE_BEEP                         5
17
#define VOICE_BEEP                         5
18
#define HoTT_GRAD       96
18
#define HoTT_GRAD       96
19
#define HoTT_LINKS      123
19
#define HoTT_LINKS      123
20
#define HoTT_RECHTS 124
20
#define HoTT_RECHTS 124
21
#define HoTT_OBEN       125
21
#define HoTT_OBEN       125
22
#define HoTT_UNTEN      126
22
#define HoTT_UNTEN      126
23
 
23
 
24
GPSPacket_t GPSPacket;
24
GPSPacket_t GPSPacket;
25
VarioPacket_t VarioPacket;
25
VarioPacket_t VarioPacket;
26
ASCIIPacket_t ASCIIPacket;
26
ASCIIPacket_t ASCIIPacket;
27
ElectricAirPacket_t ElectricAirPacket;
27
ElectricAirPacket_t ElectricAirPacket;
28
HoTTGeneral_t HoTTGeneral;
28
HoTTGeneral_t HoTTGeneral;
29
int HoTTVarioMeter = 0;
29
int HoTTVarioMeter = 0;
30
 
30
 
31
const char PROGMEM NC_ERROR_TEXT[MAX_ERR_NUMBER][17] =
31
const char PROGMEM NC_ERROR_TEXT[MAX_ERR_NUMBER][17] =
32
{
32
{
33
//0123456789123456
33
//0123456789123456
34
 "No Error        \0",  // 0
34
 "No Error        \0",  // 0
35
 "Not compatible  \0",  // 1
35
 "Not compatible  \0",  // 1
36
 "MK3Mag not compa\0",  // 2
36
 "MK3Mag not compa\0",  // 2
37
 "No FC communicat\0",  // 3
37
 "No FC communicat\0",  // 3
38
 "MK3Mag communica\0",  // 4
38
 "MK3Mag communica\0",  // 4
39
 "GPS communicatio\0",  // 5
39
 "GPS communicatio\0",  // 5
40
 "compass value   \0",  // 6
40
 "compass value   \0",  // 6
41
 "RC Signal lost  \0",  // 7
41
 "RC Signal lost  \0",  // 7
42
 "FC spi rx error \0",  // 8
42
 "FC spi rx error \0",  // 8
43
 "No NC communicat\0",  // 9
43
 "No NC communicat\0",  // 9
44
 "FC Nick Gyro    \0",  // 10
44
 "FC Nick Gyro    \0",  // 10
45
 "FC Roll Gyro    \0",  // 11
45
 "FC Roll Gyro    \0",  // 11
46
 "FC Yaw Gyro     \0",  // 12
46
 "FC Yaw Gyro     \0",  // 12
47
 "FC Nick ACC     \0",  // 13
47
 "FC Nick ACC     \0",  // 13
48
 "FC Roll ACC     \0",  // 14
48
 "FC Roll ACC     \0",  // 14
49
 "FC Z-ACC        \0",  // 15
49
 "FC Z-ACC        \0",  // 15
50
 "Pressure sensor \0",  // 16
50
 "Pressure sensor \0",  // 16
51
 "I2C FC->BL-Ctrl \0",  // 17
51
 "I2C FC->BL-Ctrl \0",  // 17
52
 "Bl Missing      \0",  // 18
52
 "Bl Missing      \0",  // 18
53
 "Mixer Error     \0",  // 19
53
 "Mixer Error     \0",  // 19
54
 "Carefree Error  \0",  // 20
54
 "Carefree Error  \0",  // 20
55
 "GPS Fix lost    \0",  // 21
55
 "GPS Fix lost    \0",  // 21
56
 "Magnet Error    \0"   // 22
56
 "Magnet Error    \0",  // 22
-
 
57
 "Motor restart   \0",  // 23
-
 
58
 "BL Limitation   \0"   // 24
57
};
59
};
58
 
60
 
59
unsigned char MaxBlTempertaure = 0;
61
unsigned char MaxBlTempertaure = 0;
60
unsigned char MinBlTempertaure = 0;
62
unsigned char MinBlTempertaure = 0;
61
unsigned char HottestBl = 0;
63
unsigned char HottestBl = 0;
62
 
64
 
63
void GetHottestBl(void)
65
void GetHottestBl(void)
64
{
66
{
65
 static unsigned char search = 0,tmp_max,tmp_min,who;
67
 static unsigned char search = 0,tmp_max,tmp_min,who;
66
                if(Motor[search].Temperature > tmp_max) { tmp_max = Motor[search].Temperature; who = search;}
68
                if(Motor[search].Temperature > tmp_max) { tmp_max = Motor[search].Temperature; who = search;}
67
                else
69
                else
68
                if(Motor[search].Temperature) if(Motor[search].Temperature < tmp_min) tmp_min = Motor[search].Temperature;
70
                if(Motor[search].Temperature) if(Motor[search].Temperature < tmp_min) tmp_min = Motor[search].Temperature;
69
                if(++search > MAX_MOTORS)
71
                if(++search > MAX_MOTORS)
70
                {
72
                {
71
                 search = 0;
73
                 search = 0;
72
                 if(tmp_min != 255) MinBlTempertaure = tmp_min; else MinBlTempertaure = 0;
74
                 if(tmp_min != 255) MinBlTempertaure = tmp_min; else MinBlTempertaure = 0;
73
                 MaxBlTempertaure = tmp_max;
75
                 MaxBlTempertaure = tmp_max;
74
                 HottestBl = who;
76
                 HottestBl = who;
75
                 tmp_min = 255;
77
                 tmp_min = 255;
76
                 tmp_max = 0;
78
                 tmp_max = 0;
77
                 who = 0;
79
                 who = 0;
78
                 }
80
                 }
79
}
81
}
80
 
82
 
81
//---------------------------------------------------------------
83
//---------------------------------------------------------------
82
void Hott_ClearLine(unsigned char line)
84
void Hott_ClearLine(unsigned char line)
83
{
85
{
84
 HoTT_printfxy(0,line,"                     ");
86
 HoTT_printfxy(0,line,"                     ");
85
}
87
}
86
//---------------------------------------------------------------
88
//---------------------------------------------------------------
87
 
89
 
88
unsigned char HoTT_Waring(void)
90
unsigned char HoTT_Waring(void)
89
{
91
{
90
  if(FC_StatusFlags & FC_STATUS_LOWBAT) return(VOICE_MINIMALE_EINGANSSPANNUNG);
92
  if(FC_StatusFlags & FC_STATUS_LOWBAT) return(VOICE_MINIMALE_EINGANSSPANNUNG);
91
  if(MotorenEin && NC_ErrorCode)                return(VOICE_BEEP);
93
  if(MotorenEin && NC_ErrorCode)                return(VOICE_BEEP);
92
  return(0);
94
  return(0);
93
}
95
}
94
 
96
 
95
//---------------------------------------------------------------
97
//---------------------------------------------------------------
96
void NC_Fills_HoTT_Telemety(void)
98
void NC_Fills_HoTT_Telemety(void)
97
{
99
{
98
 unsigned char *ptr;
100
 unsigned char *ptr;
99
 unsigned char max = 0,i,z;
101
 unsigned char max = 0,i,z;
100
 switch(FromNaviCtrl.Param.Byte[11])
102
 switch(FromNaviCtrl.Param.Byte[11])
101
  {
103
  {
102
   case HOTT_VARIO_PACKET_ID:
104
   case HOTT_VARIO_PACKET_ID:
103
                ptr = (unsigned char *) &VarioPacket;
105
                ptr = (unsigned char *) &VarioPacket;
104
                max = sizeof(VarioPacket);
106
                max = sizeof(VarioPacket);
105
                break;
107
                break;
106
   case HOTT_GPS_PACKET_ID:
108
   case HOTT_GPS_PACKET_ID:
107
                ptr = (unsigned char *) &GPSPacket;
109
                ptr = (unsigned char *) &GPSPacket;
108
                max = sizeof(GPSPacket);
110
                max = sizeof(GPSPacket);
109
                break;
111
                break;
110
   case HOTT_ELECTRIC_AIR_PACKET_ID:
112
   case HOTT_ELECTRIC_AIR_PACKET_ID:
111
                ptr = (unsigned char *) &ElectricAirPacket;
113
                ptr = (unsigned char *) &ElectricAirPacket;
112
                max = sizeof(ElectricAirPacket);
114
                max = sizeof(ElectricAirPacket);
113
                break;
115
                break;
114
   case HOTT_GENERAL_PACKET_ID:
116
   case HOTT_GENERAL_PACKET_ID:
115
                ptr = (unsigned char *) &HoTTGeneral;
117
                ptr = (unsigned char *) &HoTTGeneral;
116
                max = sizeof(HoTTGeneral);
118
                max = sizeof(HoTTGeneral);
117
                break;
119
                break;
118
  }
120
  }
119
 z = FromNaviCtrl.Param.Byte[0]; // Data allocation
121
 z = FromNaviCtrl.Param.Byte[0]; // Data allocation
120
 
122
 
121
 for(i=0; i < FromNaviCtrl.Param.Byte[1]; i++)
123
 for(i=0; i < FromNaviCtrl.Param.Byte[1]; i++)
122
  {
124
  {
123
   if(z >= max) break;
125
   if(z >= max) break;
124
   ptr[z] = FromNaviCtrl.Param.Byte[2+i];
126
   ptr[z] = FromNaviCtrl.Param.Byte[2+i];
125
   z++;
127
   z++;
126
  }
128
  }
127
}
129
}
128
 
130
 
129
unsigned int BuildHoTT_Vario(void)
131
unsigned int BuildHoTT_Vario(void)
130
{
132
{
131
 unsigned int tmp = 30000;
133
 unsigned int tmp = 30000;
132
 if(VarioCharacter == '+' || VarioCharacter == '-')
134
 if(VarioCharacter == '+' || VarioCharacter == '-')
133
  {
135
  {
134
   tmp = 30000 + (AltitudeSetpointTrimming * EE_Parameter.Hoehe_Verstaerkung) / 3;
136
   tmp = 30000 + (AltitudeSetpointTrimming * EE_Parameter.Hoehe_Verstaerkung) / 3;
135
   if(tmp < 30000 && tmp > 30000 - 50) tmp = 30000 - 50; // weil es sonst erst bei < 0,5m/sek piept
137
   if(tmp < 30000 && tmp > 30000 - 50) tmp = 30000 - 50; // weil es sonst erst bei < 0,5m/sek piept
136
  }
138
  }
137
 else
139
 else
138
 if((VarioCharacter == ' ') && (FC_StatusFlags & FC_STATUS_FLY))
140
 if((VarioCharacter == ' ') && (FC_StatusFlags & FC_STATUS_FLY))
139
  {
141
  {
140
   tmp = 30000 + HoTTVarioMeter;
142
   tmp = 30000 + HoTTVarioMeter;
141
   if(tmp > 30000)
143
   if(tmp > 30000)
142
    {
144
    {
143
     if(tmp < 30000 + 100) tmp = 30000;
145
     if(tmp < 30000 + 100) tmp = 30000;
144
         else tmp -= 100;
146
         else tmp -= 100;
145
        }
147
        }
146
   if(tmp < 30000)
148
   if(tmp < 30000)
147
    {
149
    {
148
     if(tmp > 30000 - 100) tmp = 30000;
150
     if(tmp > 30000 - 100) tmp = 30000;
149
         else tmp += 100;
151
         else tmp += 100;
150
        }
152
        }
151
  }
153
  }
152
 else
154
 else
153
 if(VarioCharacter == '^') tmp = 30000 + FromNC_AltitudeSpeed * 10;
155
 if(VarioCharacter == '^') tmp = 30000 + FromNC_AltitudeSpeed * 10;
154
 else
156
 else
155
 if(VarioCharacter == 'v') tmp = 30000 - FromNC_AltitudeSpeed * 10;
157
 if(VarioCharacter == 'v') tmp = 30000 - FromNC_AltitudeSpeed * 10;
156
 
158
 
157
 return(tmp);
159
 return(tmp);
158
}
160
}
159
 
161
 
160
 
162
 
161
//---------------------------------------------------------------
163
//---------------------------------------------------------------
162
unsigned char HoTT_Telemety(unsigned char packet_request)
164
unsigned char HoTT_Telemety(unsigned char packet_request)
163
{
165
{
164
 switch(packet_request)
166
 switch(packet_request)
165
 {
167
 {
166
  case HOTT_VARIO_PACKET_ID:
168
  case HOTT_VARIO_PACKET_ID:
167
                VarioPacket.Altitude = HoehenWert/100 + 500;  
169
                VarioPacket.Altitude = HoehenWert/100 + 500;  
168
                VarioPacket.m_sec = BuildHoTT_Vario();
170
                VarioPacket.m_sec = BuildHoTT_Vario();
169
                VarioPacket.m_3sec = VarioPacket.m_sec;
171
                VarioPacket.m_3sec = VarioPacket.m_sec;
170
                VarioPacket.m_10sec = VarioPacket.m_sec;
172
                VarioPacket.m_10sec = VarioPacket.m_sec;
171
                if (VarioPacket.Altitude < VarioPacket.MinAltitude) VarioPacket.MinAltitude = VarioPacket.Altitude;
173
                if (VarioPacket.Altitude < VarioPacket.MinAltitude) VarioPacket.MinAltitude = VarioPacket.Altitude;
172
                if (VarioPacket.Altitude > VarioPacket.MaxAltitude) VarioPacket.MaxAltitude = VarioPacket.Altitude;            
174
                if (VarioPacket.Altitude > VarioPacket.MaxAltitude) VarioPacket.MaxAltitude = VarioPacket.Altitude;            
173
                VarioPacket.WarnBeep = HoTT_Waring();
175
                VarioPacket.WarnBeep = HoTT_Waring();
174
                HoTT_DataPointer = (unsigned char *) &VarioPacket;
176
                HoTT_DataPointer = (unsigned char *) &VarioPacket;
175
                return(sizeof(VarioPacket));
177
                return(sizeof(VarioPacket));
176
                break;
178
                break;
177
 
179
 
178
  case HOTT_GPS_PACKET_ID:
180
  case HOTT_GPS_PACKET_ID:
179
                GPSPacket.Altitude = HoehenWert/100 + 500;  
181
                GPSPacket.Altitude = HoehenWert/100 + 500;  
180
//              GPSPacket.Distance = GPSInfo.HomeDistance/10;  // macht die NC
182
//              GPSPacket.Distance = GPSInfo.HomeDistance/10;  // macht die NC
181
//              GPSPacket.Heading = GPSInfo.HomeBearing/2;     // macht die NC
183
//              GPSPacket.Heading = GPSInfo.HomeBearing/2;     // macht die NC
182
//              GPSPacket.Speed = (GPSInfo.Speed * 36) / 10;   // macht die NC
184
//              GPSPacket.Speed = (GPSInfo.Speed * 36) / 10;   // macht die NC
183
                GPSPacket.m_sec = BuildHoTT_Vario();
185
                GPSPacket.m_sec = BuildHoTT_Vario();
184
                GPSPacket.m_3sec = 120;
186
                GPSPacket.m_3sec = 120;
185
                GPSPacket.m_10sec = 0;
187
                GPSPacket.m_10sec = 0;
186
                GPSPacket.WarnBeep = HoTT_Waring();
188
                GPSPacket.WarnBeep = HoTT_Waring();
187
                HoTT_DataPointer = (unsigned char *) &GPSPacket;
189
                HoTT_DataPointer = (unsigned char *) &GPSPacket;
188
                return(sizeof(GPSPacket));  
190
                return(sizeof(GPSPacket));  
189
                break;
191
                break;
190
  case HOTT_ELECTRIC_AIR_PACKET_ID:
192
  case HOTT_ELECTRIC_AIR_PACKET_ID:
191
                GetHottestBl();
193
                GetHottestBl();
192
                ElectricAirPacket.Altitude = HoehenWert/100 + 500;
194
                ElectricAirPacket.Altitude = HoehenWert/100 + 500;
193
                ElectricAirPacket.Battery1 = UBat;
195
                ElectricAirPacket.Battery1 = UBat;
194
                ElectricAirPacket.Battery2 = UBat;
196
                ElectricAirPacket.Battery2 = UBat;
195
                ElectricAirPacket.VoltageCell1 = ErsatzKompassInGrad / 2;
197
                ElectricAirPacket.VoltageCell1 = ErsatzKompassInGrad / 2;
196
                ElectricAirPacket.VoltageCell8 = ElectricAirPacket.VoltageCell1;
198
                ElectricAirPacket.VoltageCell8 = ElectricAirPacket.VoltageCell1;
197
                ElectricAirPacket.VoltageCell6 = GPSInfo.HomeBearing / 2;
199
                ElectricAirPacket.VoltageCell6 = GPSInfo.HomeBearing / 2;
198
                ElectricAirPacket.VoltageCell7 = GPSInfo.HomeDistance/20;
200
                ElectricAirPacket.VoltageCell7 = GPSInfo.HomeDistance/20;
199
                ElectricAirPacket.VoltageCell13 = ElectricAirPacket.VoltageCell6;
201
                ElectricAirPacket.VoltageCell13 = ElectricAirPacket.VoltageCell6;
200
                ElectricAirPacket.VoltageCell14 = ElectricAirPacket.VoltageCell7;
202
                ElectricAirPacket.VoltageCell14 = ElectricAirPacket.VoltageCell7;
201
                ElectricAirPacket.m_sec = BuildHoTT_Vario();
203
                ElectricAirPacket.m_sec = BuildHoTT_Vario();
202
                ElectricAirPacket.m_3sec = 120;
204
                ElectricAirPacket.m_3sec = 120;
203
                ElectricAirPacket.InputVoltage = UBat;
205
                ElectricAirPacket.InputVoltage = UBat;
204
                ElectricAirPacket.Temperature1 = MinBlTempertaure + 20;
206
                ElectricAirPacket.Temperature1 = MinBlTempertaure + 20;
205
                ElectricAirPacket.Temperature2 = MaxBlTempertaure + 20;
207
                ElectricAirPacket.Temperature2 = MaxBlTempertaure + 20;
206
                ElectricAirPacket.Capacity = Capacity.UsedCapacity/10;
208
                ElectricAirPacket.Capacity = Capacity.UsedCapacity/10;
207
                ElectricAirPacket.WarnBeep = HoTT_Waring();
209
                ElectricAirPacket.WarnBeep = HoTT_Waring();
208
                ElectricAirPacket.Current = Capacity.ActualCurrent;
210
                ElectricAirPacket.Current = Capacity.ActualCurrent;
209
                HoTT_DataPointer = (unsigned char *) &ElectricAirPacket;
211
                HoTT_DataPointer = (unsigned char *) &ElectricAirPacket;
210
                return(sizeof(ElectricAirPacket));
212
                return(sizeof(ElectricAirPacket));
211
                break;
213
                break;
212
  case HOTT_GENERAL_PACKET_ID:
214
  case HOTT_GENERAL_PACKET_ID:
213
                GetHottestBl();
215
                GetHottestBl();
214
                HoTTGeneral.Rpm = GPSInfo.HomeDistance/100;
216
                HoTTGeneral.Rpm = GPSInfo.HomeDistance/100;
215
                HoTTGeneral.VoltageCell1 = ErsatzKompassInGrad / 2;
217
                HoTTGeneral.VoltageCell1 = ErsatzKompassInGrad / 2;
216
                HoTTGeneral.VoltageCell6 = GPSInfo.HomeBearing / 2;
218
                HoTTGeneral.VoltageCell6 = GPSInfo.HomeBearing / 2;
217
                if(UBat > BattLowVoltageWarning + 5) HoTTGeneral.FuelPercent = (UBat - (BattLowVoltageWarning + 6)) * 3;
219
                if(UBat > BattLowVoltageWarning + 5) HoTTGeneral.FuelPercent = (UBat - (BattLowVoltageWarning + 6)) * 3;
218
                else HoTTGeneral.FuelPercent = 0;
220
                else HoTTGeneral.FuelPercent = 0;
219
                HoTTGeneral.FuelCapacity = HoehenWert/100;
221
                HoTTGeneral.FuelCapacity = HoehenWert/100;
220
                if(HoTTGeneral.FuelCapacity < 0) HoTTGeneral.FuelCapacity = 0;
222
                if(HoTTGeneral.FuelCapacity < 0) HoTTGeneral.FuelCapacity = 0;
221
                HoTTGeneral.Altitude = HoehenWert/100 + 500;
223
                HoTTGeneral.Altitude = HoehenWert/100 + 500;
222
                HoTTGeneral.Battery1 = UBat;
224
                HoTTGeneral.Battery1 = UBat;
223
                HoTTGeneral.Battery2 = UBat;
225
                HoTTGeneral.Battery2 = UBat;
224
                HoTTGeneral.m_sec =  BuildHoTT_Vario();
226
                HoTTGeneral.m_sec =  BuildHoTT_Vario();
225
                HoTTGeneral.m_3sec = 120;
227
                HoTTGeneral.m_3sec = 120;
226
                HoTTGeneral.InputVoltage = UBat;
228
                HoTTGeneral.InputVoltage = UBat;
227
                HoTTGeneral.Temperature1 = MinBlTempertaure + 20;
229
                HoTTGeneral.Temperature1 = MinBlTempertaure + 20;
228
                HoTTGeneral.Temperature2 = MaxBlTempertaure + 20;
230
                HoTTGeneral.Temperature2 = MaxBlTempertaure + 20;
229
                HoTTGeneral.Capacity = Capacity.UsedCapacity/10;
231
                HoTTGeneral.Capacity = Capacity.UsedCapacity/10;
230
                HoTTGeneral.WarnBeep = HoTT_Waring();
232
                HoTTGeneral.WarnBeep = HoTT_Waring();
231
                HoTTGeneral.Current = Capacity.ActualCurrent;
233
                HoTTGeneral.Current = Capacity.ActualCurrent;
232
                HoTT_DataPointer = (unsigned char *) &HoTTGeneral;
234
                HoTT_DataPointer = (unsigned char *) &HoTTGeneral;
233
                return(sizeof(HoTTGeneral));
235
                return(sizeof(HoTTGeneral));
234
                break;
236
                break;
235
  default: return(0);
237
  default: return(0);
236
  }            
238
  }            
237
}
239
}
238
 
240
 
239
//---------------------------------------------------------------
241
//---------------------------------------------------------------
240
void HoTT_Menu(void)
242
void HoTT_Menu(void)
241
{
243
{
242
 static unsigned char line, page = 0;
244
 static unsigned char line, page = 0;
243
 unsigned char tmp;
245
 unsigned char tmp;
244
 HoTTVarioMeter = (HoTTVarioMeter * 7 + VarioMeter) / 8;
246
 HoTTVarioMeter = (HoTTVarioMeter * 7 + VarioMeter) / 8;
245
 
247
 
246
 if(page == 0)
248
 if(page == 0)
247
  switch(line++)
249
  switch(line++)
248
  {
250
  {
249
        case 0:  
251
        case 0:  
250
                if(FC_StatusFlags & FC_STATUS_LOWBAT)
252
                if(FC_StatusFlags & FC_STATUS_LOWBAT)
251
                         HoTT_printfxy_BLINK(0,0,"  %2i.%1iV  ",UBat/10, UBat%10)
253
                         HoTT_printfxy_BLINK(0,0,"  %2i.%1iV  ",UBat/10, UBat%10)
252
                        else
254
                        else
253
                         HoTT_printfxy(0,0,"  %2i.%1iV  ",UBat/10, UBat%10)
255
                         HoTT_printfxy(0,0,"  %2i.%1iV  ",UBat/10, UBat%10)
254
 
256
 
255
                        if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)
257
                        if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)
256
                          {
258
                          {
257
                           if(HoehenReglerAktiv)        HoTT_printfxy_INV(10,0,"ALT:%4im %c", (int16_t)(HoehenWert/100),VarioCharacter)
259
                           if(HoehenReglerAktiv)        HoTT_printfxy_INV(10,0,"ALT:%4im %c", (int16_t)(HoehenWert/100),VarioCharacter)
258
                           else                                         HoTT_printfxy(10,0,"ALT:%4im  ", (int16_t)(HoehenWert/100))
260
                           else                                         HoTT_printfxy(10,0,"ALT:%4im  ", (int16_t)(HoehenWert/100))
259
                           }
261
                           }
260
            else    HoTT_printfxy(10,0,"ALT:---- ");
262
            else    HoTT_printfxy(10,0,"ALT:---- ");
261
                        break;
263
                        break;
262
        case 1:  
264
        case 1:  
263
                if(FC_StatusFlags & FC_STATUS_LOWBAT)
265
                if(FC_StatusFlags & FC_STATUS_LOWBAT)
264
                         HoTT_printfxy_BLINK(0,1,"  %2i:%02i  ",FlugSekunden/60,FlugSekunden%60)
266
                         HoTT_printfxy_BLINK(0,1,"  %2i:%02i  ",FlugSekunden/60,FlugSekunden%60)
265
            else   HoTT_printfxy(0,1,"  %2i:%02i  ",FlugSekunden/60,FlugSekunden%60);                      
267
            else   HoTT_printfxy(0,1,"  %2i:%02i  ",FlugSekunden/60,FlugSekunden%60);                      
266
                        HoTT_printfxy(10,1,"DIR: %3d%c",ErsatzKompassInGrad, HoTT_GRAD);
268
                        HoTT_printfxy(10,1,"DIR: %3d%c",ErsatzKompassInGrad, HoTT_GRAD);
267
                        if(FC_StatusFlags2 & FC_STATUS2_CAREFREE) HoTT_printfxy(20,1,"C") else HoTT_printfxy(20,1," ");
269
                        if(FC_StatusFlags2 & FC_STATUS2_CAREFREE) HoTT_printfxy(20,1,"C") else HoTT_printfxy(20,1," ");
268
            break;
270
            break;
269
        case 2:
271
        case 2:
270
                if(FC_StatusFlags & FC_STATUS_LOWBAT)
272
                if(FC_StatusFlags & FC_STATUS_LOWBAT)
271
                         HoTT_printfxy_BLINK(0,2,"  %5i  ",Capacity.UsedCapacity)
273
                         HoTT_printfxy_BLINK(0,2,"  %5i  ",Capacity.UsedCapacity)
272
            else   HoTT_printfxy(0,2,"  %5i  ",Capacity.UsedCapacity);                     
274
            else   HoTT_printfxy(0,2,"  %5i  ",Capacity.UsedCapacity);                     
273
                        HoTT_printfxy(12,2,"I:%2i.%1iA ",Capacity.ActualCurrent/10, Capacity.ActualCurrent%10);
275
                        HoTT_printfxy(12,2,"I:%2i.%1iA ",Capacity.ActualCurrent/10, Capacity.ActualCurrent%10);
274
                        break;
276
                        break;
275
        case 3:
277
        case 3:
276
                        HoTT_printfxy(9,0,"I");
278
                        HoTT_printfxy(9,0,"I");
277
                        HoTT_printfxy(9,1,"I");
279
                        HoTT_printfxy(9,1,"I");
278
                        HoTT_printfxy(9,2,"I");
280
                        HoTT_printfxy(9,2,"I");
279
                        HoTT_printfxy(0,3,"---------+-----------");
281
                        HoTT_printfxy(0,3,"---------+-----------");
280
                        HoTT_printfxy(0,6,"---------------------");
282
                        HoTT_printfxy(0,6,"---------------------");
281
                        break;
283
                        break;
282
        case 4:  
284
        case 4:  
283
                        if(NaviDataOkay)
285
                        if(NaviDataOkay)
284
                        {
286
                        {
285
                        HoTT_printfxy(9,4,"I");
287
                        HoTT_printfxy(9,4,"I");
286
                                HoTT_printfxy(0,4,"SAT:%2d ",GPSInfo.NumOfSats);
288
                                HoTT_printfxy(0,4,"SAT:%2d ",GPSInfo.NumOfSats);
287
                            HoTT_printfxy(10,4,"DIST:%3dm",GPSInfo.HomeDistance/10);
289
                            HoTT_printfxy(10,4,"DIST:%3dm",GPSInfo.HomeDistance/10);
288
                                switch (GPSInfo.SatFix)
290
                                switch (GPSInfo.SatFix)
289
                                {
291
                                {
290
                                        case SATFIX_3D:
292
                                        case SATFIX_3D:
291
                                                        if(GPSInfo.Flags & FLAG_DIFFSOLN) HoTT_printfxy(7,4,"D ")
293
                                                        if(GPSInfo.Flags & FLAG_DIFFSOLN) HoTT_printfxy(7,4,"D ")
292
                                                        else HoTT_printfxy(7,4,"3D");
294
                                                        else HoTT_printfxy(7,4,"3D");
293
                                                break;
295
                                                break;
294
                                        default:
296
                                        default:
295
                                                HoTT_printfxy_BLINK(7,4,"!!");
297
                                                HoTT_printfxy_BLINK(7,4,"!!");
296
                                                break;
298
                                                break;
297
                                }      
299
                                }      
298
                        }
300
                        }
299
                        else
301
                        else
300
                        {                    
302
                        {                    
301
                                Hott_ClearLine(4);
303
                                Hott_ClearLine(4);
302
                        }
304
                        }
303
                        break;
305
                        break;
304
        case 5:
306
        case 5:
305
                        if(NaviDataOkay)
307
                        if(NaviDataOkay)
306
                        {
308
                        {
307
                        HoTT_printfxy(9,5,"I");
309
                        HoTT_printfxy(9,5,"I");
308
                                HoTT_printfxy(4,5,"%2um/s",GPSInfo.Speed,GPSInfo.NumOfSats);
310
                                HoTT_printfxy(4,5,"%2um/s",GPSInfo.Speed,GPSInfo.NumOfSats);
309
                            HoTT_printfxy(12,5,"HM:%3d%c %c", GPSInfo.HomeBearing, HoTT_GRAD, NC_GPS_ModeCharacter);
311
                            HoTT_printfxy(12,5,"HM:%3d%c %c", GPSInfo.HomeBearing, HoTT_GRAD, NC_GPS_ModeCharacter);
310
            }
312
            }
311
                        else Hott_ClearLine(5);
313
                        else Hott_ClearLine(5);
312
                        break;
314
                        break;
313
        case 6:
315
        case 6:
314
                        break;
316
                        break;
315
        case 7: if(NC_ErrorCode)
317
        case 7: if(NC_ErrorCode)
316
                  {
318
                  {
317
                           if(HoTTBlink && NC_ErrorCode < MAX_ERR_NUMBER)
319
                           if(HoTTBlink && NC_ErrorCode < MAX_ERR_NUMBER)
318
                            {
320
                            {
319
                             Hott_ClearLine(7);
321
                             Hott_ClearLine(7);
320
                             HoTT_printfxy_INV(0,7,"ERR: %2d !",NC_ErrorCode);
322
                             HoTT_printfxy_INV(0,7,"ERR: %2d !",NC_ErrorCode);
321
                            }
323
                            }
322
                                else
324
                                else
323
                                {
325
                                {
324
                                 HoTT_printfxy(0,7,"ERR: ");     _printf_P(&LIBFC_HoTT_Putchar, NC_ERROR_TEXT[NC_ErrorCode] , 0);};
326
                                 HoTT_printfxy(0,7,"ERR: ");     _printf_P(&LIBFC_HoTT_Putchar, NC_ERROR_TEXT[NC_ErrorCode] , 0);};
325
                                }
327
                                }
326
                        else HoTT_printfxy(0,7," www.MikroKopter.de  ");
328
                        else HoTT_printfxy(0,7," www.MikroKopter.de  ");
327
                        break;
329
                        break;
328
        case 8: ASCIIPacket.WarnBeep = HoTT_Waring();
330
        case 8: ASCIIPacket.WarnBeep = HoTT_Waring();
329
                        // ASCIIPacket.WarnBeep = Parameter_UserParam1;
331
                        // ASCIIPacket.WarnBeep = Parameter_UserParam1;
330
        case 9:
332
        case 9:
331
        case 10:
333
        case 10:
332
        case 11:
334
        case 11:
333
        case 12:
335
        case 12:
334
        case 13:
336
        case 13:
335
        case 14:  
337
        case 14:  
336
        case 15:  
338
        case 15:  
337
        case 16:  
339
        case 16:  
338
                        if(HottKeyboard == 8) { LIBFC_HoTT_Clear(); page = 1; line = 0;};
340
                        if(HottKeyboard == 8) { LIBFC_HoTT_Clear(); page = 1; line = 0;};
339
                        HottKeyboard = 0;
341
                        HottKeyboard = 0;
340
                        break;
342
                        break;
341
   default:  line = 0;
343
   default:  line = 0;
342
                        break;
344
                        break;
343
  }
345
  }
344
  else
346
  else
345
  if(page == 1)
347
  if(page == 1)
346
  switch(line++)
348
  switch(line++)
347
  {
349
  {
348
        case 0:  
350
        case 0:  
349
                if(FC_StatusFlags & FC_STATUS_LOWBAT)
351
                if(FC_StatusFlags & FC_STATUS_LOWBAT)
350
                         HoTT_printfxy_BLINK(0,0," %2i:%02i  %2i.%1iV %4imAh",FlugSekunden/60,FlugSekunden%60,UBat/10, UBat%10,Capacity.UsedCapacity)
352
                         HoTT_printfxy_BLINK(0,0," %2i:%02i  %2i.%1iV %4imAh",FlugSekunden/60,FlugSekunden%60,UBat/10, UBat%10,Capacity.UsedCapacity)
351
            else   HoTT_printfxy(0,0," %2i:%02i  %2i.%1iV %4imAh",FlugSekunden/60,FlugSekunden%60,UBat/10, UBat%10,Capacity.UsedCapacity);                         
353
            else   HoTT_printfxy(0,0," %2i:%02i  %2i.%1iV %4imAh",FlugSekunden/60,FlugSekunden%60,UBat/10, UBat%10,Capacity.UsedCapacity);                         
352
                        break;
354
                        break;
353
        case 1:  
355
        case 1:  
354
                        HoTT_printfxy(0,1,"DIR:%3d%c",KompassValue, HoTT_GRAD);
356
                        HoTT_printfxy(0,1,"DIR:%3d%c",KompassValue, HoTT_GRAD);
355
                        if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)
357
                        if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)
356
                          {
358
                          {
357
                           if(HoehenReglerAktiv)        HoTT_printfxy_INV(10,1,"ALT:%4im", (int16_t)(HoehenWert/100))
359
                           if(HoehenReglerAktiv)        HoTT_printfxy_INV(10,1,"ALT:%4im", (int16_t)(HoehenWert/100))
358
                           else                                         HoTT_printfxy(10,1,"ALT:%4im", (int16_t)(HoehenWert/100))
360
                           else                                         HoTT_printfxy(10,1,"ALT:%4im", (int16_t)(HoehenWert/100))
359
                           }
361
                           }
360
            else    HoTT_printfxy(10,1,"ALT:---- ");
362
            else    HoTT_printfxy(10,1,"ALT:---- ");
361
                        HoTT_printfxy(20,1,"%c",VarioCharacter);
363
                        HoTT_printfxy(20,1,"%c",VarioCharacter);
362
            break;
364
            break;
363
        case 2:
365
        case 2:
364
                        if(NaviDataOkay)
366
                        if(NaviDataOkay)
365
                        {
367
                        {
366
                          HoTT_printfxy(1,2,"HM:%3d%c  DIST:%3dm %c", GPSInfo.HomeBearing, HoTT_GRAD, GPSInfo.HomeDistance/10, NC_GPS_ModeCharacter);
368
                          HoTT_printfxy(1,2,"HM:%3d%c  DIST:%3dm %c", GPSInfo.HomeBearing, HoTT_GRAD, GPSInfo.HomeDistance/10, NC_GPS_ModeCharacter);
367
            }
369
            }
368
                        else
370
                        else
369
                        {
371
                        {
370
                         Hott_ClearLine(2);
372
                         Hott_ClearLine(2);
371
                        }
373
                        }
372
                        break;
374
                        break;
373
        case 3:
375
        case 3:
374
                        HoTT_printfxy(0,3,"PWR:%2i.%1iA (%iW) ",Capacity.ActualCurrent/10, Capacity.ActualCurrent%10,Capacity.ActualPower);
376
                        HoTT_printfxy(0,3,"PWR:%2i.%1iA (%iW) ",Capacity.ActualCurrent/10, Capacity.ActualCurrent%10,Capacity.ActualPower);
375
                        break;
377
                        break;
376
        case 4:  
378
        case 4:  
377
                        if(NaviDataOkay)
379
                        if(NaviDataOkay)
378
                        {
380
                        {
379
                                HoTT_printfxy(0,4,"GPS:%2um/s SAT:%d ",GPSInfo.Speed,GPSInfo.NumOfSats);
381
                                HoTT_printfxy(0,4,"GPS:%2um/s SAT:%d ",GPSInfo.Speed,GPSInfo.NumOfSats);
380
                                switch (GPSInfo.SatFix)
382
                                switch (GPSInfo.SatFix)
381
                                {
383
                                {
382
                                        case SATFIX_3D:
384
                                        case SATFIX_3D:
383
                                                HoTT_printfxy(16,4,"  3D ");
385
                                                HoTT_printfxy(16,4,"  3D ");
384
                                                break;
386
                                                break;
385
                                        //case SATFIX_2D:
387
                                        //case SATFIX_2D:
386
                                        //case SATFIX_NONE:
388
                                        //case SATFIX_NONE:
387
                                        default:
389
                                        default:
388
                                                HoTT_printfxy_BLINK(16,4,"NOFIX");
390
                                                HoTT_printfxy_BLINK(16,4,"NOFIX");
389
                                                break;
391
                                                break;
390
                                }      
392
                                }      
391
                                if(GPSInfo.Flags & FLAG_DIFFSOLN)
393
                                if(GPSInfo.Flags & FLAG_DIFFSOLN)
392
                                {
394
                                {
393
                                        HoTT_printfxy(16,4,"DGPS ");
395
                                        HoTT_printfxy(16,4,"DGPS ");
394
                                }
396
                                }
395
                        }
397
                        }
396
                        else
398
                        else
397
                        {                    //012345678901234567890
399
                        {                    //012345678901234567890
398
                                HoTT_printfxy(0,4,"   No NaviCtrl       ");
400
                                HoTT_printfxy(0,4,"   No NaviCtrl       ");
399
                        }
401
                        }
400
                        break;
402
                        break;
401
        case 5:
403
        case 5:
402
                        HoTT_printfxy(0,5,"%3i %3i %3i %3i%cC", Motor[0].Temperature, Motor[1].Temperature, Motor[2].Temperature, Motor[3].Temperature,HoTT_GRAD);
404
                        HoTT_printfxy(0,5,"%3i %3i %3i %3i%cC", Motor[0].Temperature, Motor[1].Temperature, Motor[2].Temperature, Motor[3].Temperature,HoTT_GRAD);
403
                        if(FC_StatusFlags2 & FC_STATUS2_CAREFREE) HoTT_printfxy_INV(18,5,"CF") else HoTT_printfxy(18,5,"  ");
405
                        if(FC_StatusFlags2 & FC_STATUS2_CAREFREE) HoTT_printfxy_INV(18,5,"CF") else HoTT_printfxy(18,5,"  ");
404
                        break;
406
                        break;
405
        case 6:
407
        case 6:
406
                    if(RequiredMotors == 4) Hott_ClearLine(6);
408
                    if(RequiredMotors == 4) Hott_ClearLine(6);
407
                                else
409
                                else
408
                                if(RequiredMotors == 6)  HoTT_printfxy(0,6,"%3i %3i%cC        ", Motor[4].Temperature, Motor[5].Temperature,HoTT_GRAD)
410
                                if(RequiredMotors == 6)  HoTT_printfxy(0,6,"%3i %3i%cC        ", Motor[4].Temperature, Motor[5].Temperature,HoTT_GRAD)
409
                                else
411
                                else
410
                                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);
412
                                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);
411
//HoTT_printfxy(15,6,"%KEY:%02x",HottKeyboard);
413
//HoTT_printfxy(15,6,"%KEY:%02x",HottKeyboard);
412
                        break;
414
                        break;
413
        case 7: if(NC_ErrorCode)
415
        case 7: if(NC_ErrorCode)
414
                  {
416
                  {
415
                           if(HoTTBlink && NC_ErrorCode < MAX_ERR_NUMBER)
417
                           if(HoTTBlink && NC_ErrorCode < MAX_ERR_NUMBER)
416
                            {
418
                            {
417
                             Hott_ClearLine(7);
419
                             Hott_ClearLine(7);
418
                             HoTT_printfxy_INV(0,7,"ERR: %2d !",NC_ErrorCode);
420
                             HoTT_printfxy_INV(0,7,"ERR: %2d !",NC_ErrorCode);
419
                            }
421
                            }
420
                                else
422
                                else
421
                                {
423
                                {
422
                                 HoTT_printfxy(0,7,"ERR: ");     _printf_P(&LIBFC_HoTT_Putchar, NC_ERROR_TEXT[NC_ErrorCode] , 0);};
424
                                 HoTT_printfxy(0,7,"ERR: ");     _printf_P(&LIBFC_HoTT_Putchar, NC_ERROR_TEXT[NC_ErrorCode] , 0);};
423
                                }
425
                                }
424
                        else HoTT_printfxy(0,7," www.MikroKopter.de  ");
426
                        else HoTT_printfxy(0,7," www.MikroKopter.de  ");
425
                        break;
427
                        break;
426
        case 8: ASCIIPacket.WarnBeep = HoTT_Waring();
428
        case 8: ASCIIPacket.WarnBeep = HoTT_Waring();
427
                        // ASCIIPacket.WarnBeep = Parameter_UserParam1;
429
                        // ASCIIPacket.WarnBeep = Parameter_UserParam1;
428
        case 9:
430
        case 9:
429
        case 10:
431
        case 10:
430
        case 11:
432
        case 11:
431
        case 12:
433
        case 12:
432
        case 13:
434
        case 13:
433
        case 14:  
435
        case 14:  
434
        case 15:  
436
        case 15:  
435
        case 16:  
437
        case 16:  
436
                        if(HottKeyboard == 8) { LIBFC_HoTT_Clear(); page = 2; line = 0;};
438
                        if(HottKeyboard == 8) { LIBFC_HoTT_Clear(); page = 2; line = 0;};
437
                        if(HottKeyboard == 1) { LIBFC_HoTT_Clear(); page = 0; line = 0;};
439
                        if(HottKeyboard == 1) { LIBFC_HoTT_Clear(); page = 0; line = 0;};
438
                        HottKeyboard = 0;
440
                        HottKeyboard = 0;
439
                        break;
441
                        break;
440
   default:  line = 0;
442
   default:  line = 0;
441
                        break;
443
                        break;
442
  }
444
  }
443
  else
445
  else
444
  if(page == 2)
446
  if(page == 2)
445
  switch(line++)
447
  switch(line++)
446
  {
448
  {
447
        case 0:  
449
        case 0:  
448
                        HoTT_printfxy_INV(0,0,"Setting:%u %s ",GetActiveParamSet(),EE_Parameter.Name);
450
                        HoTT_printfxy_INV(0,0,"Setting:%u %s ",GetActiveParamSet(),EE_Parameter.Name);
449
                        break;
451
                        break;
450
    case 1: HoTT_printfxy(0,1,"Min:%2i.%1iV %s ",BattLowVoltageWarning/10, BattLowVoltageWarning%10, Mixer.Name);
452
    case 1: HoTT_printfxy(0,1,"Min:%2i.%1iV %s ",BattLowVoltageWarning/10, BattLowVoltageWarning%10, Mixer.Name);
451
                        break;
453
                        break;
452
    case 2:  HoTT_printfxy(0,2,"ALT:");
454
    case 2:  HoTT_printfxy(0,2,"ALT:");
453
                 if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)
455
                 if(Parameter_GlobalConfig & CFG_HOEHENREGELUNG)
454
                 {
456
                 {
455
                          if(!(EE_Parameter.GlobalConfig & CFG_HOEHEN_SCHALTER)) HoTT_printf("POTI:%3u ", Parameter_HoehenSchalter)
457
                          if(!(EE_Parameter.GlobalConfig & CFG_HOEHEN_SCHALTER)) HoTT_printf("POTI:%3u ", Parameter_HoehenSchalter)
456
                          else
458
                          else
457
                          {
459
                          {
458
                           if(Parameter_HoehenSchalter > 50) HoTT_printf("(ON)  ") else HoTT_printf("(OFF) ");
460
                           if(Parameter_HoehenSchalter > 50) HoTT_printf("(ON)  ") else HoTT_printf("(OFF) ");
459
                           if((Parameter_ExtraConfig & CFG2_HEIGHT_LIMIT)) HoTT_printf("LIMIT", Parameter_HoehenSchalter)
461
                           if((Parameter_ExtraConfig & CFG2_HEIGHT_LIMIT)) HoTT_printf("LIMIT", Parameter_HoehenSchalter)
460
                           else HoTT_printf("VARIO", Parameter_HoehenSchalter);
462
                           else HoTT_printf("VARIO", Parameter_HoehenSchalter);
461
                          }
463
                          }
462
                         }
464
                         }
463
                        else
465
                        else
464
                                HoTT_printf("DISABLED");
466
                                HoTT_printf("DISABLED");
465
                        break;
467
                        break;
466
    case 3: HoTT_printfxy(0,3,"CF:");
468
    case 3: HoTT_printfxy(0,3,"CF:");
467
                        if(!EE_Parameter.CareFreeModeControl) HoTT_printf("DISABLED")
469
                        if(!EE_Parameter.CareFreeModeControl) HoTT_printf("DISABLED")
468
                        else
470
                        else
469
                         {
471
                         {
470
                          if(CareFree)  HoTT_printf(" (ON) ") else HoTT_printf(" (OFF)");
472
                          if(CareFree)  HoTT_printf(" (ON) ") else HoTT_printf(" (OFF)");
471
                          if(EE_Parameter.ExtraConfig & CFG_LEARNABLE_CAREFREE) HoTT_printf(" TEACH");
473
                          if(EE_Parameter.ExtraConfig & CFG_LEARNABLE_CAREFREE) HoTT_printf(" TEACH");
472
                         }
474
                         }
473
                        break;
475
                        break;
474
    case 4: HoTT_printfxy(0,4,"GPS:");
476
    case 4: HoTT_printfxy(0,4,"GPS:");
475
                    if(!(Parameter_GlobalConfig & CFG_GPS_AKTIV)) HoTT_printf("DISABLED")
477
                    if(!(Parameter_GlobalConfig & CFG_GPS_AKTIV)) HoTT_printf("DISABLED")
476
                        else
478
                        else
477
                         {
479
                         {
478
                          CHK_POTI(tmp,EE_Parameter.NaviGpsModeControl);
480
                          CHK_POTI(tmp,EE_Parameter.NaviGpsModeControl);
479
                          if(tmp < 50) HoTT_printf("(FREE)")
481
                          if(tmp < 50) HoTT_printf("(FREE)")
480
                          else
482
                          else
481
                          if(tmp >= 180) HoTT_printf("(HOME)")
483
                          if(tmp >= 180) HoTT_printf("(HOME)")
482
                          else
484
                          else
483
                          if(EE_Parameter.ExtraConfig & CFG_GPS_AID) HoTT_printf("(AID) ")
485
                          if(EE_Parameter.ExtraConfig & CFG_GPS_AID) HoTT_printf("(AID) ")
484
                          else HoTT_printf("(HOLD)")
486
                          else HoTT_printf("(HOLD)")
485
                         }
487
                         }
486
                        if(EE_Parameter.FailSafeTime) HoTT_printfxy(10,4," FS:%usek ",EE_Parameter.FailSafeTime)
488
                        if(EE_Parameter.FailSafeTime) HoTT_printfxy(10,4," FS:%usek ",EE_Parameter.FailSafeTime)
487
 
489
 
488
                        break;
490
                        break;
489
    case 5: HoTT_printfxy(0,5,"HOME ALT:");
491
    case 5: HoTT_printfxy(0,5,"HOME ALT:");
490
                        if(EE_Parameter.ComingHomeAltitude) HoTT_printf("%um",EE_Parameter.ComingHomeAltitude) else HoTT_printf("HOLD ");
492
                        if(EE_Parameter.ComingHomeAltitude) HoTT_printf("%um",EE_Parameter.ComingHomeAltitude) else HoTT_printf("HOLD ");
491
                        break;
493
                        break;
492
        case 6:
494
        case 6:
493
            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);
495
            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);
494
                    HoTT_printfxy(0,7,"Gs:%4i Ya:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_GAS]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]);
496
                    HoTT_printfxy(0,7,"Gs:%4i Ya:%4i ",PPM_in[EE_Parameter.Kanalbelegung[K_GAS]]+127,PPM_in[EE_Parameter.Kanalbelegung[K_GIER]]);
495
                        break;
497
                        break;
496
    case 7: //HoTT_printfxy(0,6,"WARNINGS:");
498
    case 7: //HoTT_printfxy(0,6,"WARNINGS:");
497
                        if(HoTTBlink)
499
                        if(HoTTBlink)
498
                        {
500
                        {
499
                         LIBFC_HoTT_SetPos(6 * 21);
501
                         LIBFC_HoTT_SetPos(6 * 21);
500
                         if(!(Parameter_GlobalConfig & CFG_ACHSENKOPPLUNG_AKTIV)) HoTT_printf_BLINK("COUPLING OFF! ");
502
                         if(!(Parameter_GlobalConfig & CFG_ACHSENKOPPLUNG_AKTIV)) HoTT_printf_BLINK("COUPLING OFF! ");
501
                         if(EE_Parameter.BitConfig & (CFG_LOOP_LINKS | CFG_LOOP_RECHTS | CFG_LOOP_UNTEN | CFG_LOOP_OBEN)) HoTT_printf_BLINK("LOOPING! ");
503
                         if(EE_Parameter.BitConfig & (CFG_LOOP_LINKS | CFG_LOOP_RECHTS | CFG_LOOP_UNTEN | CFG_LOOP_OBEN)) HoTT_printf_BLINK("LOOPING! ");
502
                         if(Parameter_GlobalConfig & CFG_HEADING_HOLD) HoTT_printf_BLINK("HH! ");
504
                         if(Parameter_GlobalConfig & CFG_HEADING_HOLD) HoTT_printf_BLINK("HH! ");
503
                         if(!(Parameter_GlobalConfig & CFG_KOMPASS_AKTIV)) HoTT_printf_BLINK("COMPASS OFF! ");
505
                         if(!(Parameter_GlobalConfig & CFG_KOMPASS_AKTIV)) HoTT_printf_BLINK("COMPASS OFF! ");
504
                        }
506
                        }
505
                        break;
507
                        break;
506
    case 8: ASCIIPacket.WarnBeep = HoTT_Waring();
508
    case 8: ASCIIPacket.WarnBeep = HoTT_Waring();
507
                        break;
509
                        break;
508
    case 9:
510
    case 9:
509
    case 10:
511
    case 10:
510
    case 11:
512
    case 11:
511
    case 12:
513
    case 12:
512
    case 13:
514
    case 13:
513
    case 14:
515
    case 14:
514
    case 15:
516
    case 15:
515
    case 16:
517
    case 16:
516
                        if(HottKeyboard == 1) { LIBFC_HoTT_Clear(); page = 1; line = 0;};
518
                        if(HottKeyboard == 1) { LIBFC_HoTT_Clear(); page = 1; line = 0;};
517
                        HottKeyboard = 0;
519
                        HottKeyboard = 0;
518
                        break;
520
                        break;
519
   default:  line = 0;
521
   default:  line = 0;
520
                        break;
522
                        break;
521
  }
523
  }
522
  else page = 0;
524
  else page = 0;
523
}
525
}
524
 
526
 
525
#endif
527
#endif
526
 
528
 
527
 
529
 
528
       
530
       
529
 
531