Subversion Repositories FlightCtrl

Rev

Rev 2146 | Rev 2183 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 2146 Rev 2178
Line 77... Line 77...
77
#define HOTT_KEY_DOWN   2
77
#define HOTT_KEY_DOWN   2
78
#define HOTT_KEY_UP     4
78
#define HOTT_KEY_UP     4
79
#define HOTT_KEY_SET    6
79
#define HOTT_KEY_SET    6
80
#define HOTT_KEY_LEFT   8
80
#define HOTT_KEY_LEFT   8
Line -... Line 81...
-
 
81
 
-
 
82
unsigned char NaviData_WaypointIndex = 0, NaviData_WaypointNumber = 0, NaviData_TargetHoldTime = 0;
-
 
83
unsigned int NaviData_TargetDistance = 0;
81
 
84
 
82
GPSPacket_t GPSPacket;
85
GPSPacket_t GPSPacket;
83
VarioPacket_t VarioPacket;
86
VarioPacket_t VarioPacket;
84
ASCIIPacket_t ASCIIPacket;
87
ASCIIPacket_t ASCIIPacket;
85
ElectricAirPacket_t ElectricAirPacket;
88
ElectricAirPacket_t ElectricAirPacket;
Line 189... Line 192...
189
{
192
{
190
 HoTT_printfxy(0,line,"                     ");
193
 HoTT_printfxy(0,line,"                     ");
191
}
194
}
192
//---------------------------------------------------------------
195
//---------------------------------------------------------------
Line -... Line 196...
-
 
196
 
193
 
197
 
194
unsigned char HoTT_Waring(void)
198
unsigned char HoTT_Waring(void)
195
{
199
{
196
  unsigned char status = 0;
200
  unsigned char status = 0;
197
  static char old_status = 0;
201
  static char old_status = 0;
Line 225... Line 229...
225
  old_status = status;
229
  old_status = status;
226
//  DebugOut.Analog[16] = status;
230
//  DebugOut.Analog[16] = status;
227
  return(status);
231
  return(status);
228
}
232
}
Line -... Line 233...
-
 
233
 
-
 
234
/*
-
 
235
unsigned char HoTTErrorCode(void)
-
 
236
{
-
 
237
 return(NC_ErrorCode);
-
 
238
}
229
 
239
*/
230
//---------------------------------------------------------------
240
//---------------------------------------------------------------
231
void NC_Fills_HoTT_Telemety(void)
241
void NC_Fills_HoTT_Telemety(void)
232
{
242
{
233
 unsigned char *ptr = NULL;
243
 unsigned char *ptr = NULL;
Line 290... Line 300...
290
 if(VarioCharacter == 'v') tmp = 30000 - FromNC_AltitudeSpeed * 10;
300
 if(VarioCharacter == 'v') tmp = 30000 - FromNC_AltitudeSpeed * 10;
Line 291... Line 301...
291
 
301
 
292
 return(tmp);
302
 return(tmp);
Line 293... Line -...
293
}
-
 
294
 
303
}
295
 
304
 
296
//---------------------------------------------------------------
305
//---------------------------------------------------------------
297
unsigned char HoTT_Telemety(unsigned char packet_request)
306
unsigned char HoTT_Telemety(unsigned char packet_request)
298
{
307
{
Line 321... Line 330...
321
                VarioPacket.Text[2] = ':';
330
                VarioPacket.Text[2] = ':';
322
         }
331
         }
323
         else
332
         else
324
         if(FC_StatusFlags & FC_STATUS_LOWBAT) for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&UNDERVOLTAGE[i]); // no Error
333
         if(FC_StatusFlags & FC_STATUS_LOWBAT) for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&UNDERVOLTAGE[i]); // no Error
325
         else    
334
         else    
-
 
335
     if(NaviData_WaypointNumber)
-
 
336
         {    
-
 
337
          unsigned int tmp_int;
-
 
338
      unsigned char tmp;
-
 
339
      VarioPacket.Text[0] = 'W'; VarioPacket.Text[1] = 'P';
-
 
340
      VarioPacket.Text[2] = ' ';
-
 
341
      VarioPacket.Text[3] = '0'+(NaviData_WaypointIndex) / 10;
-
 
342
      VarioPacket.Text[4] = '0'+(NaviData_WaypointIndex) % 10;
-
 
343
      VarioPacket.Text[5] = '/';
-
 
344
      VarioPacket.Text[6] = '0'+(NaviData_WaypointNumber) / 10;
-
 
345
      VarioPacket.Text[7] = '0'+(NaviData_WaypointNumber) % 10;
-
 
346
      VarioPacket.Text[8] = ' ';
-
 
347
          tmp_int = NaviData_TargetDistance;
-
 
348
      if(tmp_int > 1000) { VarioPacket.Text[9] = '0'+(tmp_int) / 1000; tmp_int %= 1000;}
-
 
349
          else VarioPacket.Text[9] = ' ';
-
 
350
      if(tmp_int > 100) { VarioPacket.Text[10] = '0'+(tmp_int) / 100; tmp_int %= 100;}
-
 
351
          else VarioPacket.Text[10] = ' ';
-
 
352
      VarioPacket.Text[11] = '0'+(tmp_int) / 10;
-
 
353
      VarioPacket.Text[12] = '0'+(tmp_int) % 10;
-
 
354
      VarioPacket.Text[13] = 'm';
-
 
355
      VarioPacket.Text[14] = ' ';
-
 
356
      tmp = NaviData_TargetHoldTime;
-
 
357
          if(tmp > 100) { VarioPacket.Text[15] = '0'+(tmp) / 100; tmp %= 100;} else VarioPacket.Text[15] = ' ';
-
 
358
      VarioPacket.Text[16] = '0'+(tmp) / 10;
-
 
359
      VarioPacket.Text[17] = '0'+(tmp) % 10;
-
 
360
      VarioPacket.Text[18] = 's';
-
 
361
      VarioPacket.Text[19] = ' ';
-
 
362
//unsigned char NaviData_WaypointIndex = 0, NaviData_WaypointNumber = 0, NaviData_TargetHoldTime = 0;
-
 
363
//unsigned int NaviData_TargetDistance = 0;
-
 
364
         }
-
 
365
         else
326
         for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&MIKROKOPTER[i]); // no Error
366
         for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&MIKROKOPTER[i]); // no Error
Line 327... Line 367...
327
         
367
         
328
                return(sizeof(VarioPacket));
368
                return(sizeof(VarioPacket));
Line 329... Line 369...
329
                break;
369
                break;
330
 
370
 
-
 
371
  case HOTT_GPS_PACKET_ID:
-
 
372
//              GPSPacket.Altitude = HoehenWert/100 + 500;  
331
  case HOTT_GPS_PACKET_ID:
373
 
332
                GPSPacket.Altitude = HoehenWert/100 + 500;  
374
GPSPacket.Altitude = DebugOut.Analog[17] + 500;  
333
//              GPSPacket.Distance = GPSInfo.HomeDistance/10;  // macht die NC
375
//              GPSPacket.Distance = GPSInfo.HomeDistance/10;  // macht die NC
334
//              GPSPacket.Heading = GPSInfo.HomeBearing/2;     // macht die NC
376
//              GPSPacket.Heading = GPSInfo.HomeBearing/2;     // macht die NC
335
//              GPSPacket.Speed = (GPSInfo.Speed * 36) / 10;   // macht die NC
377
//              GPSPacket.Speed = (GPSInfo.Speed * 36) / 10;   // macht die NC
Line 389... Line 431...
389
                HoTTGeneral.Temperature1 = MinBlTempertaure + 20;
431
                HoTTGeneral.Temperature1 = MinBlTempertaure + 20;
390
                HoTTGeneral.Temperature2 = MaxBlTempertaure + 20;
432
                HoTTGeneral.Temperature2 = MaxBlTempertaure + 20;
391
                HoTTGeneral.Capacity = Capacity.UsedCapacity/10;
433
                HoTTGeneral.Capacity = Capacity.UsedCapacity/10;
392
                HoTTGeneral.WarnBeep = 0;//HoTT_Waring();
434
                HoTTGeneral.WarnBeep = 0;//HoTT_Waring();
393
                HoTTGeneral.Current = Capacity.ActualCurrent;
435
                HoTTGeneral.Current = Capacity.ActualCurrent;
-
 
436
//HoTTGeneral.ErrorNumber = HoTTErrorCode();
394
                HoTT_DataPointer = (unsigned char *) &HoTTGeneral;
437
                HoTT_DataPointer = (unsigned char *) &HoTTGeneral;
395
                return(sizeof(HoTTGeneral));
438
                return(sizeof(HoTTGeneral));
396
                break;
439
                break;
397
  default: return(0);
440
  default: return(0);
398
  }            
441
  }