Subversion Repositories FlightCtrl

Rev

Rev 1941 | Rev 1943 | Go to most recent revision | Only display areas with differences | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed

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