Subversion Repositories FlightCtrl

Rev

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

Rev 2561 Rev 2570
Line 56... Line 56...
56
#include "spi.h"
56
#include "spi.h"
57
#include "capacity.h"
57
#include "capacity.h"
Line 58... Line 58...
58
 
58
 
59
unsigned char NaviData_WaypointIndex = 0;
59
unsigned char NaviData_WaypointIndex = 0;
60
unsigned char NaviData_WaypointNumber = 0, NaviData_TargetHoldTime = 0, ToNC_Load_WP_List = 0, NaviData_MaxWpListIndex = 0;
60
unsigned char NaviData_WaypointNumber = 0, NaviData_TargetHoldTime = 0, ToNC_Load_WP_List = 0, NaviData_MaxWpListIndex = 0;
61
unsigned char ToNC_Load_SingePoint = 0, ToNC_Store_SingePoint = 0;
61
unsigned char ToNC_Load_SingePoint = 0, ToNC_Store_SingePoint = 0, Show_Load = 0, Show_Store = 0;
-
 
62
char WPL_Name[10];// = {"         \0"};
62
char WPL_Name[10];// = {"         \0"};
63
 
Line 63... Line 64...
63
#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))
64
#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))
64
 
65
 
65
#define HoTT_printf(format, args...)                    {  _printf_P(&LIBFC_HoTT_Putchar, PSTR(format) , ## args);}
66
#define HoTT_printf(format, args...)                    {  _printf_P(&LIBFC_HoTT_Putchar, PSTR(format) , ## args);}
Line 101... Line 102...
101
const char PROGMEM MIKROKOPTER[] =      {"     MikroKopter     "};
102
const char PROGMEM MIKROKOPTER[] =      {"     MikroKopter     "};
102
const char PROGMEM UNDERVOLTAGE[] =     {" !! LiPo voltage !!  "};
103
const char PROGMEM UNDERVOLTAGE[] =     {" !! LiPo voltage !!  "};
103
const char PROGMEM LANDING[] =      {" !!   LANDING    !!  "};
104
const char PROGMEM LANDING[] =      {" !!   LANDING    !!  "};
104
const char PROGMEM SIMULATION[] =       {"  SIMULATION active  "};
105
const char PROGMEM SIMULATION[] =       {"  SIMULATION active  "};
105
const char PROGMEM BOAT_MODE[] =        {" MikroKopter (Boat)  "};
106
const char PROGMEM BOAT_MODE[] =        {" MikroKopter (Boat)  "};
-
 
107
const char PROGMEM STORE[] =            {" Store Position SP1  "};
-
 
108
const char PROGMEM LOAD[] =             {" Load Position SP1   "};
106
const char PROGMEM SETTING[] =  {"Set  :"};
109
const char PROGMEM SETTING[] =  {"Set  :"};
107
const char PROGMEM NC_ERROR_TEXT[MAX_ERR_NUMBER][17] =
110
const char PROGMEM NC_ERROR_TEXT[MAX_ERR_NUMBER][17] =
108
{
111
{
109
//0123456789123456
112
//0123456789123456
110
 "No Error        \0",  // 0
113
 "No Error        \0",  // 0
Line 447... Line 450...
447
         VarioPacket.Text[18] = ' ';
450
         VarioPacket.Text[18] = ' ';
448
         VarioPacket.Text[19] = ' ';
451
         VarioPacket.Text[19] = ' ';
449
         VarioPacket.Text[20] = ' ';
452
         VarioPacket.Text[20] = ' ';
450
                }
453
                }
451
         }
454
         }
-
 
455
         else
-
 
456
         if(Show_Store)
-
 
457
         {
-
 
458
          for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&STORE[i]); // no Error and not calibrated
-
 
459
         }
-
 
460
         else    
-
 
461
         if(Show_Load)
-
 
462
         {
-
 
463
          for(i=0; i<21;i++) VarioPacket.Text[i] = pgm_read_byte(&LOAD[i]); // no Error and not calibrated
-
 
464
         }
452
         else    
465
         else    
453
     if(NaviData_WaypointNumber)
466
     if(NaviData_WaypointNumber)
454
         {    
467
         {    
455
          unsigned int tmp_int;
468
          unsigned int tmp_int;
456
      unsigned char tmp;
469
      unsigned char tmp;
Line 1067... Line 1080...
1067
                        if(HottKeyboard == HOTT_KEY_LEFT) { LIBFC_HoTT_Clear(); page++; line = 0;}
1080
                        if(HottKeyboard == HOTT_KEY_LEFT) { LIBFC_HoTT_Clear(); page++; line = 0;}
1068
                        if(HottKeyboard == HOTT_KEY_RIGHT) { LIBFC_HoTT_Clear(); page--; line = 0;};
1081
                        if(HottKeyboard == HOTT_KEY_RIGHT) { LIBFC_HoTT_Clear(); page--; line = 0;};
1069
                        HottKeyboard = 0;
1082
                        HottKeyboard = 0;
1070
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++
1083
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++
1071
// Bedienung per Taster am Sender
1084
// Bedienung per Taster am Sender
1072
  if(Parameter_UserParam5 > 120)  // 
1085
  if(PPM_in[EE_Parameter.MenuKeyChannel] > 120)  // 
1073
   {
1086
   {
1074
    hyterese = 2;
1087
    hyterese = 2;
1075
    if(CheckDelay(delay)) { wp_tmp = 0; hyterese = 1;}
1088
    if(CheckDelay(delay)) { wp_tmp = 0; hyterese = 1;}
1076
   }
1089
   }
1077
  else
1090
  else
1078
  if(Parameter_UserParam5 < 100)  
1091
  if(PPM_in[EE_Parameter.MenuKeyChannel] < 100)  
1079
   {
1092
   {
1080
        delay = SetDelay(2500);
1093
        delay = SetDelay(2500);
1081
        if(hyterese == 2 && (wp_tmp < NaviData_MaxWpListIndex))
1094
        if(hyterese == 2 && (wp_tmp < NaviData_MaxWpListIndex))
1082
         {
1095
         {
1083
          wp_tmp++;
1096
          wp_tmp++;
Line 1148... Line 1161...
1148
                        if(HottKeyboard == HOTT_KEY_LEFT) { LIBFC_HoTT_Clear(); page++; line = 0;}
1161
                        if(HottKeyboard == HOTT_KEY_LEFT) { LIBFC_HoTT_Clear(); page++; line = 0;}
1149
                        if(HottKeyboard == HOTT_KEY_RIGHT) { LIBFC_HoTT_Clear(); page--; line = 0;};
1162
                        if(HottKeyboard == HOTT_KEY_RIGHT) { LIBFC_HoTT_Clear(); page--; line = 0;};
1150
                        HottKeyboard = 0;
1163
                        HottKeyboard = 0;
1151
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++
1164
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++
1152
// Bedienung per Taster am Sender
1165
// Bedienung per Taster am Sender
1153
  if(Parameter_UserParam5 > 120)  // 
1166
  if(PPM_in[EE_Parameter.MenuKeyChannel] > 120)  // 
1154
   {
1167
   {
1155
    hyterese = 2;
1168
    hyterese = 2;
1156
    if(CheckDelay(delay)) { wp_tmp = 0; hyterese = 1;}
1169
    if(CheckDelay(delay)) { wp_tmp = 0; hyterese = 1;}
1157
   }
1170
   }
1158
  else
1171
  else
1159
  if(Parameter_UserParam5 < 100)  
1172
  if(PPM_in[EE_Parameter.MenuKeyChannel] < 100)  
1160
   {
1173
   {
1161
        delay = SetDelay(2500);
1174
        delay = SetDelay(2500);
1162
        if(hyterese == 2 && (wp_tmp < NaviData_MaxWpListIndex))
1175
        if(hyterese == 2 && (wp_tmp < NaviData_MaxWpListIndex))
1163
         {
1176
         {
1164
          wp_tmp++;
1177
          wp_tmp++;