Subversion Repositories FlightCtrl

Rev

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

Rev 2440 Rev 2475
Line 99... Line 99...
99 
unsigned char ToNC_SpeakHoTT = 0, ShowSettingNameTime = 0;
 99 
unsigned char ToNC_SpeakHoTT = 0, ShowSettingNameTime = 0;
100 
int HoTTVarioMeter = 0;
 100 
int HoTTVarioMeter = 0;
101 
const char PROGMEM MIKROKOPTER[] =      {"     MikroKopter     "};
 101 
const char PROGMEM MIKROKOPTER[] =      {"     MikroKopter     "};
102 
const char PROGMEM UNDERVOLTAGE[] =     {" !! LiPo voltage !!  "};
 102 
const char PROGMEM UNDERVOLTAGE[] =     {" !! LiPo voltage !!  "};
103 
const char PROGMEM LANDING[] =      {" !!   LANDING    !!  "};
 103 
const char PROGMEM LANDING[] =      {" !!   LANDING    !!  "};
- 
 
 104 
const char PROGMEM SIMULATION[] =       {"  SIMULATION active  "};
- 
 
 105 
const char PROGMEM BOAT_MODE[] =        {" MikroKopter (Boat)  "};
104 
const char PROGMEM SETTING[] =  {"Set  :"};
 106 
const char PROGMEM SETTING[] =  {"Set  :"};
105 
const char PROGMEM NC_ERROR_TEXT[MAX_ERR_NUMBER][17] =
 107 
const char PROGMEM NC_ERROR_TEXT[MAX_ERR_NUMBER][17] =
106 
{
 108 
{
107 
//0123456789123456
 109 
//0123456789123456
108 
 "No Error        \0",  // 0
 110 
 "No Error        \0",  // 0
Line 336... Line 338...
336 
}
 338 
}
Line 337... Line 339...
337 
 
 339 
 
338 
//---------------------------------------------------------------
 340 
//---------------------------------------------------------------
339 
unsigned char HoTT_Telemety(unsigned char packet_request)
 341 
unsigned char HoTT_Telemety(unsigned char packet_request)
340 
{
 342 
{
341 
 unsigned char i;
 343 
 unsigned char i = 0;
Line 342... Line 344...
342 
  //Debug("rqst: %02X",packet_request);
 344 
  //Debug("rqst: %02X",packet_request);
343 
 
 345 
 
344 
 switch(packet_request)
 346 
 switch(packet_request)
Line 373... Line 375...
373 
         if(ShowSettingNameTime) // no Error
 375 
         if(ShowSettingNameTime) // no Error
374 
         {                  
 376 
         {                  
375 
          for(i=0; i<sizeof(SETTING);i++) VarioPacket.Text[i] = pgm_read_byte(&SETTING[i]);
 377 
          for(i=0; i<sizeof(SETTING);i++) VarioPacket.Text[i] = pgm_read_byte(&SETTING[i]);
376 
      VarioPacket.Text[4] = '0' + ActiveParamSet;
 378 
      VarioPacket.Text[4] = '0' + ActiveParamSet;
377 
          for(i=0; i<sizeof(EE_Parameter.Name);i++) VarioPacket.Text[i+7] = EE_Parameter.Name[i]; // no Error
 379 
          for(i=0; i<sizeof(EE_Parameter.Name);i++) VarioPacket.Text[i+7] = EE_Parameter.Name[i]; // no Error
- 
 
 380 
      if(FC_StatusFlags3 & FC_STATUS3_BOAT)
- 
 
 381 
                {
- 
 
 382 
         VarioPacket.Text[17] = 'B';
- 
 
 383 
         VarioPacket.Text[18] = 'O';
- 
 
 384 
         VarioPacket.Text[19] = 'A';
- 
 
 385 
         VarioPacket.Text[20] = 'T';
- 
 
 386 
                }
- 
 
 387 
          else
- 
 
 388 
                {
378 
      VarioPacket.Text[18] = ' ';
 389 
         VarioPacket.Text[18] = ' ';
379 
      VarioPacket.Text[19] = ' ';
 390 
         VarioPacket.Text[19] = ' ';
380 
      VarioPacket.Text[20] = ' ';
 391 
         VarioPacket.Text[20] = ' ';
- 
 
 392 
                }
381 
         }
 393 
         }
382 
         else    
 394 
         else    
383 
     if(NaviData_WaypointNumber)
 395 
     if(NaviData_WaypointNumber)
384 
         {    
 396 
         {    
385 
          unsigned int tmp_int;
 397 
          unsigned int tmp_int;
Line 408... Line 420...
408 
      VarioPacket.Text[18] = 's';
 420 
      VarioPacket.Text[18] = 's';
409 
      VarioPacket.Text[19] = ' ';
 421 
      VarioPacket.Text[19] = ' ';
410 
      VarioPacket.Text[20] = ' ';
 422 
      VarioPacket.Text[20] = ' ';
411 
         }
 423 
         }
412 
         else
 424 
         else
- 
 
 425 
         if(NC_To_FC_Flags & NC_TO_FC_SIMULATION_ACTIVE)
- 
 
 426 
         {
- 
 
 427 
          for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&SIMULATION[i]);
- 
 
 428 
         }
- 
 
 429 
         else
413 
         if(!CalibrationDone)
 430 
         if(!CalibrationDone)
414 
         {
 431 
         {
415 
          for(i=0; i<17;i++) VarioPacket.Text[i] = pgm_read_byte(&MIKROKOPTER[i+2]); // no Error and not calibrated
 432 
          for(i=0; i<17;i++) VarioPacket.Text[i] = pgm_read_byte(&MIKROKOPTER[i+2]); // no Error and not calibrated
416 
      VarioPacket.Text[16] = '0'+VERSION_MAJOR;
 433 
      VarioPacket.Text[16] = '0'+VERSION_MAJOR;
417 
      VarioPacket.Text[17] = '.';
 434 
      VarioPacket.Text[17] = '.';
Line 419... Line 436...
419 
      VarioPacket.Text[19] = '0'+VERSION_MINOR%10;
 436 
      VarioPacket.Text[19] = '0'+VERSION_MINOR%10;
420 
      VarioPacket.Text[20] = 'a'+VERSION_PATCH;
 437 
      VarioPacket.Text[20] = 'a'+VERSION_PATCH;
421 
         }
 438 
         }
422 
         else
 439 
         else
423 
         {
 440 
         {
- 
 
 441 
          if(FC_StatusFlags3 & FC_STATUS3_BOAT) for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&BOAT_MODE[i]); // no Error
424 
          for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&MIKROKOPTER[i]); // no Error
 442 
          else  for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&MIKROKOPTER[i]); // no Error
425 
if(RedundanceBlOperation) VarioPacket.Text[0] = 'R';
 443 
          if(FC_StatusFlags3 & FC_STATUS3_REDUNDANCE)  VarioPacket.Text[0] = 'R';
426 
         }
 444 
         }
427 
                return(sizeof(VarioPacket));
 445 
                return(sizeof(VarioPacket));
428 
                break;
 446 
                break;
Line 429... Line 447...
429 
 
 447