Code du projet lièvres pour LoRa

Dependencies:   SX1272Lib mbed

main.cpp

Committer:
aGoelzer
Date:
2016-10-14
Revision:
5:d28a689b1635
Parent:
4:954ae88b6664

File content as of revision 5:d28a689b1635:

#include "mbed.h"
#include "main.h"
#include "sx1272-hal.h"
#include "debug.h"

/* Set this flag to '1' to display debug messages on the console */
#define DEBUG_MESSAGE   1

/* Set this flag to '1' to use the LoRa modulation or to '0' to use FSK modulation */
#define USE_MODEM_LORA  1
#define USE_MODEM_FSK   !USE_MODEM_LORA

#define RF_FREQUENCY                                    868000000 // Hz
#define TX_OUTPUT_POWER                                 14        // 14 dBm

#if USE_MODEM_LORA == 1

#define LORA_BANDWIDTH                              2         // [0: 125 kHz,
//  1: 250 kHz,
//  2: 500 kHz,
//  3: Reserved]
#define LORA_SPREADING_FACTOR                       7         // [SF7..SF12]
#define LORA_CODINGRATE                             1         // [1: 4/5,
//  2: 4/6,
//  3: 4/7,
//  4: 4/8]
#define LORA_PREAMBLE_LENGTH                        8         // Same for Tx and Rx
#define LORA_SYMBOL_TIMEOUT                         5         // Symbols
#define LORA_FIX_LENGTH_PAYLOAD_ON                  false
#define LORA_FHSS_ENABLED                           false
#define LORA_NB_SYMB_HOP                            4
#define LORA_IQ_INVERSION_ON                        false
#define LORA_CRC_ENABLED                            true

#elif USE_MODEM_FSK == 1

#define FSK_FDEV                                    25000     // Hz
#define FSK_DATARATE                                19200     // bps
#define FSK_BANDWIDTH                               50000     // Hz
#define FSK_AFC_BANDWIDTH                           83333     // Hz
#define FSK_PREAMBLE_LENGTH                         5         // Same for Tx and Rx
#define FSK_FIX_LENGTH_PAYLOAD_ON                   false
#define FSK_CRC_ENABLED                             true

#else
#error "Please define a modem in the compiler options."
#endif

#define RX_TIMEOUT_VALUE                                3500000   // in us
#define BUFFER_SIZE                                     32        // Define the payload size here

#if( defined ( TARGET_KL25Z ) || defined ( TARGET_LPC11U6X ) )
DigitalOut led(LED2);
#else
DigitalOut led(LED1);
#endif
typedef unsigned char byte;
unsigned short crc16(byte byteArray[], int length)
{
    unsigned char x;
    unsigned short crc = 0xFFFF;
    for (int i = 0; i < length; i++) {
        x = crc >> 8 ^ byteArray[i];
        x ^= x >> 4;
        crc = (crc << 8) ^ ((unsigned short)(x << 12)) ^ ((unsigned short)(x << 5)) ^ ((unsigned short)x);
    }
    return crc;
}

void float2Bytes(float val, byte* bytes_array)
{
    union {
        float float_variable;
        byte temp_array[4];
    } u;
    u.float_variable = val;
    memcpy(bytes_array, u.temp_array, 4);
}

class Position
{
public:
    bool north;
    bool south;
    bool east;
    bool west;
    short degLon;
    short degLat;
    float minutesLong;
    float minutesLat;
    float secondesLong;
    float secondesLat;

    Position(bool north, bool south, bool east, bool west, short degLon, short degLat, float minutesLong, float minutesLat, float secondesLong, float secondesLat) {
        this->north = north;
        this->south = south;
        this->east = east;
        this->west = west;
        this->degLon = degLon;
        this->degLat = degLat;
        this->minutesLong = minutesLong;
        this->minutesLat = minutesLat;
        this->secondesLong = secondesLong;
        this->secondesLat = secondesLat;
    }

    Position(byte* posBytes) {
        this->north = (posBytes[0] & 1);
        this->south = (posBytes[0] & 2) >> 1;
        this->east = (posBytes[0] & 4) >> 2;
        this->west = (posBytes[0] & 8) >> 3;
        this->degLon = posBytes[1] * 256 + posBytes[2];
        this->degLat = posBytes[3] * 256 + posBytes[4];
        this->minutesLong = *(float *)(posBytes + 5);
        this->minutesLat = *(float *)(posBytes + 9);
        this->secondesLong = *(float *)(posBytes + 13);
        this->secondesLat = *(float *)(posBytes + 17);
    }

    byte* GetBytes() {
        byte* posByte = (byte*)malloc(21 * sizeof(byte));
        posByte[0] = 0;
        if (this->north) {
            posByte[0] = posByte[0] | 1;
        }
        if (this->south) {
            posByte[0] = posByte[0] | 2;
        }
        if (this->east) {
            posByte[0] = posByte[0] | 4;
        }
        if (this->west) {
            posByte[0] = posByte[0] | 8;
        }
        posByte[1] = (this->degLon & 0xFF00) >> 8; //Bits de poids fort du short
        posByte[2] = (this->degLon & 0x00FF); //Bits de poids faible
        posByte[3] = (this->degLat & 0xFF00) >> 8; //Bits de poids fort du short
        posByte[4] = (this->degLat & 0x00FF); //Bits de poids faible
        float2Bytes(this->minutesLong, posByte + 5);
        float2Bytes(this->minutesLat, posByte + 9);
        float2Bytes(this->secondesLong, posByte + 13);
        float2Bytes(this->secondesLat, posByte + 17);
        return posByte;
    }
};
class Date
{
public:
    byte jour;
    byte mois;
    byte annee;
    byte heure;
    byte minutes;
    byte secondes;

    byte* GetBytes() {
        byte* dateByte = (byte*)malloc(6 * sizeof(byte));
        dateByte[0] = this->jour;
        dateByte[1] = this->mois;
        dateByte[2] = this->annee;
        dateByte[3] = this->heure;
        dateByte[4] = this->minutes;
        dateByte[5] = this->secondes;
        return dateByte;
    }

    Date(byte jour, byte mois, byte annee, byte heure, byte minutes, byte secondes) {
        this->jour = jour;
        this->mois = mois;
        this->annee = annee;
        this->heure = heure;
        this->minutes = minutes;
        this->secondes = secondes;
    }

    Date(byte* dateBytes) {
        this->jour = dateBytes[0];
        this->mois = dateBytes[1];
        this->annee = dateBytes[2];
        this->heure = dateBytes[3];
        this->minutes = dateBytes[4];
        this->secondes = dateBytes[5];
    }

};

class Content
{
public:
    short IDLapin;
    Position* positionLapin;
    Date* dateLapin;

    byte* GetBytes() {
        byte* contByte = (byte*)malloc(29 * sizeof(byte));
        contByte[0] = (this->IDLapin & 0xFF00) << 8;
        contByte[1] = (this->IDLapin & 0x00FF);
        byte* dateBytes = this->dateLapin->GetBytes();
        byte* positionBytes = this->positionLapin->GetBytes();
        memcpy(contByte + 2, dateBytes, 6);
        memcpy(contByte + 8, positionBytes, 21);
        free(positionBytes);
        free(dateBytes);
        return contByte;
    }

    Content(short IDLapin, Position* positionLapin, Date* dateLapin) {
        this->IDLapin = IDLapin;
        this->positionLapin = positionLapin;
        this->dateLapin = dateLapin;
    }

    Content(byte* contentBytes) {
        this->IDLapin = contentBytes[0] * 256 + contentBytes[1];
        byte* positionBytes = (byte*)malloc(21 * sizeof(byte));
        byte* dateBytes = (byte*)malloc(6 * sizeof(byte));
        memcpy(dateBytes, contentBytes + 2, 6);
        memcpy(positionBytes, contentBytes + 8, 21);
        this->positionLapin = (Position*)(new Position(positionBytes));
        this->dateLapin =  (Date*)(new Date(dateBytes));
        free(dateBytes);
        free(positionBytes);
    }
};

byte* CreateMessageBytes(Content* messageContent)
{
    byte* messByte = (byte*)malloc(32 * sizeof(byte));
    messByte[0] = 20;
    byte* contentBytes = messageContent->GetBytes();
    unsigned short gotHash = crc16(contentBytes, 29);
    messByte[1] = (gotHash & 0xFF00) >> 8;
    messByte[2] = (gotHash & 0x00FF);
    memcpy(messByte + 3, contentBytes, 29);
    free(contentBytes);
    return messByte;
}

enum MessageCheckResult { CORRECT = 1, CORRUPTED = 0, NOTFORUS = -1 };
MessageCheckResult IsCorrectMessage(byte* bytesReceived, int mLength)
{
    if (mLength != 32) {
        return NOTFORUS;
    }
    if (bytesReceived[0] != 20) {
        return NOTFORUS;
    }
    if (crc16(bytesReceived + 3, 29) != (bytesReceived[1] * 256 + bytesReceived[2])) {
        return CORRUPTED;
    }
    return CORRECT;
}


/*
 *  Global variables declarations
 */
typedef enum {
    LOWPOWER = 0,
    IDLE,

    RX,
    RX_TIMEOUT,
    RX_ERROR,

    TX,
    TX_TIMEOUT,

    CAD,
    CAD_DONE
} AppStates_t;

volatile AppStates_t State = LOWPOWER;

/*!
 * Radio events function pointer
 */
static RadioEvents_t RadioEvents;

/*
 *  Global variables declarations
 */
SX1272MB2xAS Radio( NULL );

uint16_t BufferSize = BUFFER_SIZE;
uint8_t Buffer[BUFFER_SIZE];

int16_t RssiValue = 0.0;
int8_t SnrValue = 0.0;

int main()
{
    // Initialize Radio driver
    RadioEvents.TxDone = OnTxDone;
    RadioEvents.RxDone = OnRxDone;
    RadioEvents.RxError = OnRxError;
    RadioEvents.TxTimeout = OnTxTimeout;
    RadioEvents.RxTimeout = OnRxTimeout;
    Radio.Init( &RadioEvents );

    // verify the connection with the board
    while( Radio.Read( REG_VERSION ) == 0x00  ) {
        debug( "Radio could not be detected!\n\r", NULL );
        wait( 1 );
    }

    debug_if( ( DEBUG_MESSAGE & ( Radio.DetectBoardType( ) == SX1272MB2XAS ) ) , "\n\r > Board Type: SX1272MB2xAS < \n\r" );

    Radio.SetChannel( RF_FREQUENCY );

#if USE_MODEM_LORA == 1

    debug_if( LORA_FHSS_ENABLED, "\n\n\r             > LORA FHSS Mode < \n\n\r");
    debug_if( !LORA_FHSS_ENABLED, "\n\n\r             > LORA Mode < \n\n\r");

    Radio.SetTxConfig( MODEM_LORA, TX_OUTPUT_POWER, 0, LORA_BANDWIDTH,
                       LORA_SPREADING_FACTOR, LORA_CODINGRATE,
                       LORA_PREAMBLE_LENGTH, LORA_FIX_LENGTH_PAYLOAD_ON,
                       LORA_CRC_ENABLED, LORA_FHSS_ENABLED, LORA_NB_SYMB_HOP,
                       LORA_IQ_INVERSION_ON, 2000000 );

    Radio.SetRxConfig( MODEM_LORA, LORA_BANDWIDTH, LORA_SPREADING_FACTOR,
                       LORA_CODINGRATE, 0, LORA_PREAMBLE_LENGTH,
                       LORA_SYMBOL_TIMEOUT, LORA_FIX_LENGTH_PAYLOAD_ON, 0,
                       LORA_CRC_ENABLED, LORA_FHSS_ENABLED, LORA_NB_SYMB_HOP,
                       LORA_IQ_INVERSION_ON, true );

#elif USE_MODEM_FSK == 1

    debug("\n\n\r              > FSK Mode < \n\n\r");
    Radio.SetTxConfig( MODEM_FSK, TX_OUTPUT_POWER, FSK_FDEV, 0,
                       FSK_DATARATE, 0,
                       FSK_PREAMBLE_LENGTH, FSK_FIX_LENGTH_PAYLOAD_ON,
                       FSK_CRC_ENABLED, 0, 0, 0, 2000000 );

    Radio.SetRxConfig( MODEM_FSK, FSK_BANDWIDTH, FSK_DATARATE,
                       0, FSK_AFC_BANDWIDTH, FSK_PREAMBLE_LENGTH,
                       0, FSK_FIX_LENGTH_PAYLOAD_ON, 0, FSK_CRC_ENABLED,
                       0, 0, false, true );

#else

#error "Please define a modem in the compiler options."

#endif

    Radio.Rx(RX_TIMEOUT_VALUE  );

    while( 1 ) {
       // Radio.Rx( 100*RX_TIMEOUT_VALUE  );
        //SendStr("Bonjour Baudouin");
    }

}

void SendStr(char* str)
{
    int len = strlen(str);
    uint8_t MyBuffer[len];
    strcpy( ( char* )MyBuffer, str );
    debug(str);
    Radio.Send(MyBuffer, len);
}

void OnTxDone( void )
{
    Radio.Sleep();
    State = TX;
    debug_if( DEBUG_MESSAGE, "\n\r> Message transmis\n\r" );
}

void OnRxDone( uint8_t *payload, uint16_t size, int16_t rssi, int8_t snr)
{
    Radio.Sleep();
    BufferSize = size;
    memcpy( Buffer, payload, BufferSize );
    RssiValue = rssi;
    SnrValue = snr;
    State = RX;
    debug_if( DEBUG_MESSAGE, "\n\r> Message recu\n\r" );
    //debug("\r\n");
    //debug("SNR = %d\r\n",snr);
    //debug("RSSI = %d\r\n",rssi);
    if (IsCorrectMessage(Buffer,BufferSize) == 1){
        Content contentReceived = Content(Buffer+3);
        debug("%d %d %d %d %d %d", contentReceived.dateLapin->jour, contentReceived.dateLapin->mois,contentReceived.dateLapin->annee ,contentReceived.dateLapin->heure, contentReceived.dateLapin->minutes, contentReceived.dateLapin->secondes);
    }
    
    Radio.Rx(RX_TIMEOUT_VALUE  );
}

void OnTxTimeout( void )
{
    Radio.Sleep( );
    State = TX_TIMEOUT;
    debug_if( DEBUG_MESSAGE, "\n\r> Delai d'attente depasse\n\r" );
}

void OnRxTimeout( void )
{
    Radio.Sleep( );
    Buffer[ BufferSize ] = 0;
    State = RX_TIMEOUT;
    debug_if( DEBUG_MESSAGE, "> OnRxTimeout\n\r" );
    Radio.Rx(RX_TIMEOUT_VALUE  );
}

void OnRxError( void )
{
    Radio.Sleep( );
    State = RX_ERROR;
    debug_if( DEBUG_MESSAGE, "> OnRxError\n\r" );
    Radio.Rx( 10*RX_TIMEOUT_VALUE  );
}