File content as of revision 5:be0c602be047:

#include "LiaisonBluetooth/LiaisonBluetooth.h"

/*
if (action_robot_2) {
    char *score_char_array = convertir_int_en_4char(score_total);
    paquet_domotique_envoyer(0x30, 4, score_char_array);
    delete []score_char_array;
}
*/

LiaisonBluetooth::LiaisonBluetooth(Serial *bluetooth) : m_bluetooth(bluetooth), m_state(true)
{
}

bool LiaisonBluetooth::paquet_en_attente()
{
    char c;
    while (m_bluetooth->readable() && m_state) {
        c = m_bluetooth->getc();
        if (c == MARQUEUR_DEBUT_TRAME) {
            return true;
        }
        
    }

    return false;
}

PaquetDomotique *LiaisonBluetooth::lire()
{
    char identifiant = 0;
    
    wait_ms(10);
    
    if (m_bluetooth->readable() && m_state) {
        identifiant = m_bluetooth->getc();
    } else { return NULL; }

    char buffer_longueur_paquet[4];
    for (int i = 0 ; i < 4 ; i++) {
        if (m_bluetooth->readable() && m_state) {
            buffer_longueur_paquet[i] = m_bluetooth->getc();
        } else { return NULL; }
    }
    unsigned short longueur_paquet = atoi(buffer_longueur_paquet);
    
    m_bluetooth->printf("longueur %d\n", longueur_paquet);
    
    wait_ms(10);
    
    char buffer_data[longueur_paquet];
    int index = 0;
    while (index < longueur_paquet) {
        if (m_bluetooth->readable() && m_state) {
            char c = m_bluetooth->getc();
            
            m_bluetooth->printf("%x\n", c);
            
            if (c == MARQUEUR_FIN_TRAME) {
                return NULL;
            }

            buffer_data[index++] = c;
        } else { m_bluetooth->printf("buffer_data\n"); return NULL; }
    }

    return creer_paquetdomotique(identifiant, longueur_paquet, buffer_data);
}

void LiaisonBluetooth::envoyer(char idenfitiant, int longueur_data, char *data)
{
    if (m_state && m_bluetooth->writeable()) {
        m_bluetooth->putc(MARQUEUR_DEBUT_TRAME);
    }
    
    if (m_state && m_bluetooth->writeable()) {
        m_bluetooth->putc(idenfitiant);
    }

    char *longueur_buffer = convertir_int_en_4char(longueur_data);
    for (int i = 0 ; i < 4 ; i++) {
        if (m_state && m_bluetooth->writeable()) {
            m_bluetooth->putc(longueur_buffer[i]);
        }
    }

    for (int i = 0 ; i < longueur_data ; i++) {
        if (m_state && m_bluetooth->writeable()) {
            m_bluetooth->putc(data[i]);
        }
    }
    
    if (m_state && m_bluetooth->writeable()) {
        m_bluetooth->putc(MARQUEUR_FIN_TRAME);
    }
}


PaquetDomotique *creer_paquetdomotique(int identifiant, unsigned int longueur_data, char *data)
{
    PaquetDomotique *paquet = (PaquetDomotique*)malloc(sizeof(PaquetDomotique));
    paquet->identifiant = identifiant;

    paquet->data = (char*)malloc(sizeof(char)*longueur_data);
    memset(paquet->data, 0, longueur_data);
    strcpy(paquet->data, data);
    
    paquet->longueur = longueur_data;

    return paquet;
}
void detruire_paquetdomotique(PaquetDomotique *paquet)
{
    free(paquet->data);
    free(paquet);
}

char *convertir_int_en_4char(unsigned int integer)
{
    char *data = new char[4];

    data[3] = (integer>>24) & 0xFF;
    data[2] = (integer>>16) & 0xFF;
    data[1] = (integer>>8) & 0xFF;
    data[0] = integer & 0xFF;

    return data;
}
unsigned int convertir_4char_en_int(char data[4])
{
    return (data[3] << 24) | (data[2] << 16) | (data[1] << 8) | data[0];
}