Subversion Repositories FlightCtrl

#include "libfc.h"

#include "printf_P.h"

#include "main.h"

#include "spi.h"

#include "capacity.h"

#include "jeti_ex.h"

#include "hottmenu.h"

#if (defined(__AVR_ATmega1284__) || defined(__AVR_ATmega1284P__))

const char PROGMEM JETI_CODE[53] =

{

0, // 0

'O', // SPEAK_ERR_CALIBARTION  1

'P', // SPEAK_ERR_RECEICER       2

'Q', // SPEAK_ERR_DATABUS        3

'R', //  SPEAK_ERR_NAVI          4

'S', //  SPEAK_ERROR             5

'T', //  SPEAK_ERR_COMPASS       6

'S', //  SPEAK_ERR_SENSOR        7

'V', //  SPEAK_ERR_GPS           8

'W', //  SPEAK_ERR_MOTOR         9

'H', //  SPEAK_MAX_TEMPERAT  10

  0, //  SPEAK_ALTI_REACHED  11

'X', //  SPEAK_WP_REACHED    12

'Y', //  SPEAK_NEXT_WP       13

  0, //  SPEAK_LANDING       14

'Z', //  SPEAK_GPS_FIX       15

'U', //  SPEAK_UNDERVOLTAGE  16

'E', //  SPEAK_GPS_HOLD      17

'F', //  SPEAK_GPS_HOME      18

'G', //  SPEAK_GPS_OFF       19

'H', //  SPEAK_BEEP          20

'A', //  SPEAK_MIKROKOPTER   21

  0, //  SPEAK_CAPACITY      22

'I', //  SPEAK_CF_OFF        23

'B', //  SPEAK_CALIBRATE     24

'J', //  SPEAK_MAX_RANGE     25

'J', //  SPEAK_MAX_ALTITUD   26

  0, // 27

  0, // 28

  0, // 29

  0, // 30

  0, // 31

  0, // 32

  0, // 33

  0, // 34

  0, // 35

  0, // 36

  0, // 37

'D', //  SPEAK_MK_OFF           38

'L', //  SPEAK_ALTITUDE_ON      39

'M', //  SPEAK_ALTITUDE_OFF 40

  0, // 41

  0, // 42

  0, // 43

  0, // 44

  0, // 45

'N', //  SPEAK_CF_ON        46

  0, //  SPEAK_SINKING          47

  0, //  SPEAK_RISING           48

  0, //  SPEAK_HOLDING          49

'K', //  SPEAK_GPS_ON           50

  0, //  SPEAK_FOLLWING         51

'C' //  SPEAK_STARTING      52

};

JetiExPacket_t JetiExData[JETI_EX_PARAMETER_COUNT + 1] =                                        // Parameter count + DeviceName (ID0) 

{

        //      Label[10]               unit[3], data type,               Data , position of decimal point

   //   "1234567890",    "123", 

//      {       "-=.M_K.=-" ,   "   ",                  1,                      0       ,               0       },    // first one is device name  // datatype 1 = -8192...8192

        {       "MK        " ,   "   ",             1,                  0       ,               0       },    // first one is device name  // datatype 1 = -8192...8192

        {       "Voltage   " ,   "V  ",                 1,                      0   ,           1       },    // ID 1 

        {       "Current   " ,   "A  ",                 1,                      0       ,               1       },    // ID 2

        {       "Capacity  " ,   "Ah ",                 1,                      0       ,               2       },    // ID 3           

        {       "Altitude  " ,   "m  ",                 1,                      0       ,               0       },    // ID 4           

        {       "Compass   " ,   "°  ",                 1,                      0       ,               0       },    // ID 5

        {       "Sats      " ,   "   ",                 1,                      0       ,               0       },    // ID 6

        {       "Speed     " ,   "m/s",                 1,                      0       ,               0       },    // ID 7

        {       "Distance  " ,   "m  ",                 1,                      0       ,               0       },    // ID 8

        {       "Home-Dir  " ,   "°  ",                 1,                      0       ,               0       },    // ID 9

        {       "max.Temp. " ,   "°C ",                 1,                      0       ,               0       },    // ID 10

        {       "Magn.field" ,   "%  ",                 1,                      0       ,               0       },    // ID 11

        {       "Vario     " ,   "   ",                 1,                      0       ,               0       },    // ID 12

        {       "ErrorCode " ,   "   ",                 1,                      0       ,               0       },    // ID 13

        {       "Latitude  " ,   "   ",                 9,                      0       ,               0       },    // ID 14  special data type for coordinates   Import: fixed position in list ID 14 - DO NOT MOVE !!!

        {       "Longitude " ,   "   ",                 9,                      0       ,               0       },    // ID 15  special data type for coordinates   Import: fixed position in list ID 15 - DO NOT MOVE !!!

};

void BuildJeti_Vario(void)

{

 signed int tmp = 0;

 static signed int JetiVarioMeter = 0;

 JetiVarioMeter = (JetiVarioMeter * 3 + VarioMeter) / 4;

 if(VarioCharacter == '+')

  {

   tmp = (AltitudeSetpointTrimming * EE_Parameter.Hoehe_Verstaerkung) / 32 + 5;

  }

 else

 if(VarioCharacter == '-')

  {

   tmp = (AltitudeSetpointTrimming * EE_Parameter.Hoehe_Verstaerkung) / 32 - 5;

  }

 else

 if((VarioCharacter == ' ') && (FC_StatusFlags & FC_STATUS_FLY))

  {

   tmp = (JetiVarioMeter/32);

  }

 else

 if(VarioCharacter == '^') tmp = FromNC_AltitudeSpeed;

 else

 if(VarioCharacter == 'v') tmp = tmp - FromNC_AltitudeSpeed;

 JetiExData[12].Value = tmp;

}

// --------------------------------------------------------------------------------------------------

void JetiEX_Update(void)

{

    #define GPS_NORTH           0

        #define GPS_SOUTH       2

    #define GPS_EAST            0

        #define GPS_WEST        2

        #define GPS_LONGITUDE   1

        #define GPS_LATITUDE    0

        GetHottestBl();    

        JetiExData[1].Value  =  UBat;

        JetiExData[2].Value  =  Capacity.ActualCurrent;

        JetiExData[3].Value  =  Capacity.UsedCapacity / 10;

        JetiExData[4].Value  =  HoehenWert / 100;

        JetiExData[5].Value  =  KompassValue;

        JetiExData[6].Value  =  GPSInfo.NumOfSats;

        JetiExData[7].Value  =  GPSInfo.Speed;

        JetiExData[8].Value  =  GPSInfo.HomeDistance / 10;

        JetiExData[9].Value  =  GPSInfo.HomeBearing;

        JetiExData[10].Value  = MaxBlTemperture;

        JetiExData[11].Value  = EarthMagneticField;

//      JetiExData[12].Value  = Vario;

        JetiExData[13].Value  = NC_ErrorCode;

        JetiExData[14].Value =  53 * 0x10000 + 23467;

        JetiExData[14].DecimalPointPos = GPS_LATITUDE + GPS_NORTH;

        JetiExData[15].Value =  7 * 0x10000 +  34178;

        JetiExData[15].DecimalPointPos = GPS_LONGITUDE  + GPS_WEST ;

}

#endif