File content as of revision 10:488877f7f56c:

// ===================== COORDINATOR =====================
// =======================================================
#include "EthernetInterface.h"
#include "ConfigFile.h"
#include "mbed.h"
#include "rtos.h"

DigitalOut reset(p8);
EthernetInterface eth;
Serial xbee(p13, p14);   // tx, rx
Serial pc(USBTX, USBRX); // tx, rx
TCPSocketConnection sock;

uint64_t routerAddress;
uint16_t portNumber = 0;
uint16_t panId = 0;
char serverAddress[32];
char panIdChar[5];
char portNbr[5];
bool boolLED = false; 

void printBuffer(uint8_t bufferSize, uint8_t* buffer) {
    for(uint8_t k = 0; k <= bufferSize; k++) {
        pc.printf("%X-", buffer[k]);
    }
    printf("\n");
}

void readConfigFile() {
    LocalFileSystem local("local");
    ConfigFile cfg;
    char *serverAddressStr = "serverAddr";
    char *portNumberStr = "portNb";
    char *panIdStr = "panID";
    
    if (!cfg.read("/local/input.cfg")) { 
        error("Erreur dans la lecture du fichier de configuration.\n");
    } else {
        cfg.getValue(panIdStr, &panIdChar[0], sizeof(panIdChar));
        cfg.getValue(serverAddressStr, &serverAddress[0], sizeof(serverAddress));
        cfg.getValue(portNumberStr, &portNbr[0], sizeof(portNbr));

        portNumber = (uint16_t)strtol(portNbr, NULL, 10);
        panId = (uint16_t)strtol(panIdChar, NULL, 10);
        
        // printf("The server address is %s\n", serverAddress);
        // printf("The port number is %i\n", portNumber);
        // printf("The PAN ID is %i\n", panId);
    }
}

void toogleLED() {
    // Addresse 64 bits = 00 13 A2 00 40 8B 41 6E
    uint8_t high[20] = {0x7E, 0x00, 0x10, 0x17, 0x01, 0x00, 0x13, 0xA2, 0x00, 0x40, 0x8B, 0x41, 0x6E, 0xFF, 0xFE, 0x02, 0x44, 0x34, 0x05, 0x3C};
    uint8_t low[20]  = {0x7E, 0x00, 0x10, 0x17, 0x02, 0x00, 0x13, 0xA2, 0x00, 0x40, 0x8B, 0x41, 0x6E, 0xFF, 0xFE, 0x02, 0x44, 0x34, 0x04, 0x3C};

    for (uint8_t i = 0; i < 20;) {
        if (xbee.writeable()) {
            if (boolLED) {
                xbee.putc(high[i]);
            } else {
                xbee.putc(low[i]);
            }
            i++; 
        }   
    }
    
    if (boolLED) {
        pc.printf("Et un haut!\n");
    } else {
         pc.printf("Et un bas!\n");
    }
    boolLED = !boolLED;
}

void initSocket(uint16_t data) {
    /*int responseSize;
    char buffer[50];
    sprintf(buffer, "Data: %i\n", data);
    
    if (sock.connect(serverAddress, portNumber) != 0) {
        pc.printf("Erreur dans la connextion au socket.\n");
    } else {
        sock.send_all(buffer, sizeof(buffer)-1);
        responseSize = sock.receive(buffer, sizeof(buffer)-1);
        
        if (responseSize <= 0) {
            pc.printf("Error");
            //sock.close();
        }
        
        buffer[responseSize] = '\0';
        pc.printf("Received %d chars from server:\n%s\n", responseSize, buffer);
    }*/
}

void checkForError(uint8_t* buffer) {
    if (buffer[0] == 0x97) {
        if (buffer[1] == 0x02) {
            pc.printf("Erreur dans la remote AT command pour mettre la DEL a l'etat bas.\n");
        }
        else if (buffer[1] == 0x01) {
            pc.printf("Erreur dans la remote AT command pour mettre la DEL a l'etat haut\n");
        }
    }
}

bool checksumIsValid(uint8_t bufferSize, uint8_t* buffer) {
    uint32_t checkSum = 0;
    
    for (int i = 0; i < bufferSize; i++) {
        checkSum += buffer[i];
    }    
    if ((0xFF - (checkSum & 0xFF)) != buffer[bufferSize]) {
        pc.printf("Erreur dans la transmission de la trame. \n");
        return false;
    }
    return true;
}

// We are storing the 64 bits address of the router.
void readRouterAddress(uint8_t* buffer) {    
    union {
        uint64_t u64_value;
        uint8_t u8_value[8];
    } address;
    
    for(int i=0; i < 8; i++) {
        address.u8_value[i] = buffer[i + 2];
    }
    routerAddress = address.u64_value;
    
    //routerAddress = buffer[2] << 56 | buffer[3] << 48 | buffer[4] << 40 | buffer[5] << 32 | buffer[6] << 24 | buffer[7] << 16 | buffer[8] << 8 | buffer[9];
    pc.printf("The router address is %X\n", routerAddress);
}

void readRouterData(uint8_t bufferSize, uint8_t* buffer) {
    uint16_t acc[3] = {0};

    if (buffer[0] == 0x90 && bufferSize == 18) { // Accelerations (X,Y,Z)
        for (uint8_t i = 12; i < bufferSize; i += 2) {
            acc[(i/2)-6] = (buffer[i+1] << 8 ) | (buffer[i] & 0xff);
        }
        // pc.printf("Acceleration X: %d\n", acc[0]);
        // pc.printf("Acceleration Y: %d\n", acc[1]);
        // pc.printf("Acceleration Z: %d\n", acc[2]);
                
        initSocket(acc[0]);
                
    } else if (buffer[0] == 0x90 && bufferSize == 13) { // Dry contact
        // acc[0] = buffer[12];
    }
}

void readDataFromRouter(){
    while(1) {
        uint8_t bufferSize = 0;
        uint8_t buffer[104] = { 0 };
    
        if (xbee.readable() && xbee.getc() == 0x7E) {
            bufferSize = (xbee.getc() << 8 ) | (xbee.getc() & 0xff);
                        
            for (uint8_t i = 0; i <= bufferSize;) {
                if (xbee.readable()) {
                    buffer[i] = xbee.getc();
                    i++;
                }
            }
            
            printBuffer(bufferSize, buffer);
            if (checksumIsValid(bufferSize, buffer)) {
                readRouterAddress(buffer);
                readRouterData(bufferSize, buffer);
            }
        }
    }
}

int main() {
    pc.printf("Starting a coordinator... \n");
    
    reset = 0;
    wait_ms(1);
    reset = 1;
    wait_ms(1); 
    
    readConfigFile();
    
    xbee.baud(9600);                    // Set baud rate
    xbee.printf("ATID %i\r",panId);     // Set the 64-bit PAN ID
    xbee.printf("ATWR \r");             // 
    xbee.printf("ATCN \r");
    
    if (eth.init() != 0) { // Use DHCP
        pc.printf("Erreur d'initialisation du RJ45.\n");
    }
    if (eth.connect() != 0) {
        pc.printf("Erreur de connection du RJ45\n"); 
    }
    pc.printf("IP Address is %s\n", eth.getIPAddress());
    
    // Démarrage des tâches:
    Thread _readDataFromRouter(readDataFromRouter);
    //Thread _toggleRouterLed(toggleLed);
    
    while(1) {}
}