avec dfu

Fork of Utils by POTLESS

Utils.cpp

Committer:
POTLESS_2
Date:
2018-03-06
Revision:
12:9dd7c462a2c0
Parent:
11:a41267cffa61
Child:
13:ff0f36a6d800

File content as of revision 12:9dd7c462a2c0:

#include "mbed.h"
#include "Utils.h"

//SDBlockDevice bd(Flash_MOSI, Flash_MISO, Flash_SCK, Flash_CS);
SPIFBlockDevice bd(Flash_MOSI, Flash_MISO, Flash_SCK, Flash_CS);

FATFileSystem Root("Root");

int Exist_Val = 0;

//Init des PIN i2c pour l'eeprom
I2C I2C_EEPROM(SDA_PIN, SCL_PIN);

void return_error(int ret_val)
{
    Exist_Val = 0;
    if (ret_val) {
        DEEP_DEBUG("  Problème Flash = %d\r\n", ret_val);
        Exist_Val = 0;
    } else {
        DEEP_DEBUG("  Flash -> OK.\r\n");
        Exist_Val = 1;
    }
    wait_ms(100);
}

void errno_error(void* ret_val)
{
    Exist_Val = 0;
    if (ret_val == NULL) {
        DEEP_DEBUG("  Problème Flash = %d \r\n", errno);
        Exist_Val = 0;
    } else {
        DEEP_DEBUG("  Flash -> OK.\r\n");
        Exist_Val = 1;
    }
    wait_ms(100);
}

void UTILS::Flash_Infos()
{
    printf("\r\n");
    printf("Flash size         : %llu Mb\r\n", bd.size() / 1048576);
    printf("Flash read size    : %llu\r\n", bd.get_read_size());
    printf("Flash program size : %llu\r\n", bd.get_program_size());
    printf("Flash erase size   : %llu\r\n", bd.get_erase_size());
}

void UTILS::Get_File_Size(char* File_Name)
{

    char filename[20];
    sprintf(filename, "/Root/%s", File_Name);

    FILE* fd = fopen(filename, "r");
    errno_error(fd);

    fseek(fd, 0, SEEK_END);
    int size = ftell(fd);
    fseek(fd, 0, SEEK_SET);

    fclose(fd);

    printf("\r\n");
    printf("  Taille du fichier %s = %d Kb\r\n", filename, size / 1024);
}

void UTILS::Store_A_Val(float Val_To_Store, char* File_Name)
{

    char filename[20];
    sprintf(filename, "/Root/%s.txt", File_Name);

    FILE* fd = fopen(filename, "w");
    errno_error(fd);
    fprintf(fd, "%f\r\n", Val_To_Store);
    fclose(fd);

    DEEP_DEBUG("  \r\n  %s sauvegardée = %f\r\n", filename, Val_To_Store);

}

float UTILS::Read_A_Val(char* File_Name)
{
    char buffer[10] = {0};
    char c = {0};
    char *token;
    int i = 0;

    char filename[20];
    sprintf(filename, "/Root/%s.txt", File_Name);

    DEEP_DEBUG("  \n  Récupération de %s...\r\n", filename);

    FILE* fd = fopen(filename, "r");
    errno_error(fd);

    while ((c != '\n') && (i < 10)) {
        c = fgetc(fd);
        buffer[i] = c;
        i++;
    }

    token = strtok(buffer, "\n");

    float val = atof(token);

    DEEP_DEBUG("  Valeur Récupérée = %f\r\n", val);

    fclose(fd);

    return val;
}


void UTILS::Write_Flash_File(char* To_Store, char* File_Name)
{
    char filename[50];
    sprintf(filename, "/Root/%s", (string)File_Name);

    FILE* fd = fopen(filename, "a");

    errno_error(fd);
    fprintf(fd, "%s\r\n", To_Store);
    fclose(fd);

    DEEP_DEBUG("  Enregistrement de %s OK\r\n\r\n", filename);
}

/*
void UTILS::Read_Flash_File(char* File_Name)
{
    char filename[20];
    sprintf(filename, "/Root/%s", File_Name);

    FILE* fd = fopen(filename, "r");
    errno_error(fd);

    //printf("  Contenu du fichier :\r\n\r\n");
    char buff[100] = {0};

    while (!feof(fd)) {
        int size = fread(&buff[0], 1, 15, fd);
        fwrite(&buff[0], 1, size, stdout);
    }
    //printf("\r\n  Fin du fichier.\r\n");
    fclose(fd);

}
*/

void UTILS::Read_Flash_File(char* File_Name)
{
    char filename[20];
    sprintf(filename, "/Root/%s", File_Name);

    FILE* fd = fopen(filename, "r");
    errno_error(fd);
    char s1[100];
    printf("\r\n");
    printf("  Contenu du fichier :\r\n\r\n");
    while (!feof(fd)) {
        memset(s1, 0, sizeof(s1));
        fgets(s1, sizeof(s1), fd);
        printf("%s", s1);
        fflush(stdout);
    }
    fclose(fd);
    printf("\r\n  Fin du fichier.\r\n");
}

bool UTILS::File_Exist(string File_Name)
{
    char filename[20];
    sprintf(filename, "/Root/%s.txt", File_Name);

    FILE* fd = fopen(filename, "r");
    errno_error(fd);

    if (Exist_Val == 0) {
        DEBUG("  Le fichier %s n'existe pas....\r\n", filename);
        fclose(fd);
        return false;
    }

    if (Exist_Val == 1) {
        fclose(fd);
        return true;
    }
}

void UTILS::Delete_Flash_File(char* File_Name)
{
    char filename[20];
    sprintf(filename, "%s", File_Name);
    int error = 0;
    error = Root.remove(filename);
    return_error(error);

    DEBUG("  Fichier %s effacé.\r\n", filename);
}

void UTILS::Clean_Flash()
{
    DEBUG("  Nettoyage de la Flash.\r\n");
    //float Saved_O2 = UTILS::Read_A_Val("Calibration_O2");
    int Saved_Motor = (int)UTILS::Read_A_Val("Servo_Poumon");
    int ARNSRS_ID = (int)UTILS::Read_A_Val("ARNSRS_ID");
    UTILS::UnMount_Flash();
    UTILS::Format_Flash();
    UTILS::Mount_Flash();
    //UTILS::Store_A_Val(Saved_O2, "Calibration_O2");
    UTILS::Store_A_Val(Saved_Motor, "Servo_Poumon");
    UTILS::Store_A_Val(ARNSRS_ID, "ARNSRS_ID");
    DEBUG("  Flash nettoyée.\r\n");
    DEBUG("  Redémmarage code.\r\n");
    NVIC_SystemReset();
}

void UTILS::Rename_Flash_File(char* Old_File_Name, char* New_File_Name)
{
    char Oldfilename[20];
    sprintf(Oldfilename, "/Root/%s", Old_File_Name);
    char Newfilename[20];
    sprintf(Newfilename, "/Root/%s", New_File_Name);

    int error = 0;
    error = Root.rename(Oldfilename, Newfilename);
    return_error(error);

    DEBUG("  Fichier %s renommé en %s.\r\n", Oldfilename, Newfilename);
}

void UTILS::Mount_Flash()
{
    //Montage Flash
    DEBUG("  Montage Flash \"/Root\". \r\n\r\n");
    int error = 0;
    error = Root.mount(&bd);
    return_error(error);
    if (error > 0) {
        //On re format s'il n'y a as de file system...normalement une seul fois...
        DEBUG("Pas de File system, on format... ");
        Format_Flash();
    }
}

void UTILS::UnMount_Flash()
{
    //De Montage Flash
    DEBUG("  Demontage Flash \"/Root\". \r\n\r\n");
    int error = 0;
    error = Root.unmount();
    return_error(error);
}

void UTILS::Format_Flash()
{
    //Formatage Flash
    DEBUG("  Formatage Flash\r\n\r\n");
    int error = 0;
    error = FATFileSystem::format(&bd);
    return_error(error);
}

void UTILS::Dir_Flash(char* Dir_Name)
{
    int error = 0;
    int nb = 0;
    DEEP_DEBUG("\r\n  Ouverture du répertoire %s\r\n", Dir_Name);
    char Dirname[20];
    sprintf(Dirname, "/Root/%s", Dir_Name);

    DIR* dir = opendir(Dirname);

    struct dirent* de;
    DEBUG("  Fichiers du répertoire :\r\n\r\n");
    while((de = readdir(dir)) != NULL) {
        printf("  %s\r\n", &(de->d_name)[0]);
        fflush(stdout);
        nb++;
    }
    DEBUG("\r\n  Nombre de fichiers = %d\r\n", nb);
    DEEP_DEBUG("  Fermeture du répertoire.\r\n");
    error = closedir(dir);
    return_error(error);
}

int UTILS::File_Index()
{
    int error = 0;
    int nb = 0;

    DIR* dir = opendir("/Root/");
    struct dirent* de;
    while((de = readdir(dir)) != NULL) {
        nb++;
    }
    error = closedir(dir);
    return_error(error);

    return nb - 2;
}

//Remapping d'une valeur dans une autre échelle
float UTILS::Remap(float x, float in_min, float in_max, float out_min, float out_max)
{
    return (x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min;
}

//Contraint une valeur entre deux limites
float UTILS::constrain(float x, float a, float b)
{
    if(x < a) {
        return a;
    } else if(b < x) {
        return b;
    } else
        return x;
}

void UTILS::Help()
{
    printf("\r\n");
    printf("  COMMANDES GENERALES\r\n\r\n");
    printf("  help             =    liste des commandes.\r\n");
    printf("  start            =    démmarage des sorties moniteur.\r\n");
    printf("  stop             =    arrêt des sorties moniteur.\r\n");
    printf("  time X           =    met la RTC à l'heure, X en UNIX TIME.\n\r");
    printf("  ARNSRS_ID X      =    entrée de l'identifiant de l'appareil X.\r\n");
    printf("  sleep            =    mise en veille.\n\r");
    printf("  reset            =    reset de la carte.\n\r\n\r");
    printf("  COMMANDES MEMOIRE\r\n\r\n");
    printf("  rec              =    démarrage / arrêt enregistrement.\r\n");
    printf("  flash_i          =    informations sur la flash.\r\n");
    printf("  clean            =    nettoyage flash, suppression des fichiers LOG.\r\n");
    printf("  dir              =    liste des fichiers de la flash.\r\n");
    printf("  del X            =    effacer le fichier LOG_X.\n\r");
    printf("  get X            =    récupérer le contenu du fichier LOG_X.\n\r");
    printf("  file_s X         =    récupérer la taille du fichier LOG_X.\n\r\n\r");
    //printf("  file_i X         =    récupérer les informations sur le fichier LOG_X.\n\r\n\r");
    printf("  COMMANDES MOTEURS\r\n\r\n");
    printf("  c_pou X          =    changement consigne volet poumon à X.\n\r");
    printf("  c_fui X          =    changement consigne volet fuite à X.\n\r");
    printf("  calib_p          =    calibration à 0 du volet poumon.\n\r");
    printf("  calib_f          =    calibration à 0 du volet fuite.\n\r");
    printf("  secu             =    mise des volets en mode sécu.\n\r");
    printf("  check_F          =    sortie des valeurs 0 moteurs et ARNSRS_ID enregistrées.\n\r\n\r");
    printf("  COMMANDES CAPTEURS\r\n\r\n");
    printf("  Head_ID X        =    Numérote le numéro X d'identification de la sensor Head dans l'eeprom.\n\r");
    printf("  O2_1_ID X        =    Numérote le numéro X d'identification de la cellule O2 1 dans l'eeprom.\n\r");
    printf("  O2_2_ID X        =    Numérote le numéro X d'identification de la cellule O2 2 dans l'eeprom.\n\r");
    printf("  CO2_ID X         =    Numérote le numéro X d'identification du capteur CO2 dans l'eeprom.\n\r");
    printf("  check_E          =    sortie des valeurs de calibration enregistrées dans l'eeprom.\n\r\n\r");
    printf("  calib_O2 X       =    calibration des cellules O2 dans l'air avec X itérations.\n\r\n\r");
    
    printf("  Les commandes pour le Mini-r sont à entrer conformément à la doc. Les plus utilisée :\n\r");
    printf("  G                =    calibration du capteur CO2 dans l'air.\n\r");
    printf("  K 0              =    arrêt du capteur CO2.\n\r");
    printf("  K 1              =    capteur CO2 mode streaming.\n\r");
    printf("  K 2              =    capteur CO2 mode spooling.\n\r");
    printf("  A X              =    digi filter X. X égal à 32, 64, 128...\n\r");
    printf("\r\n\r\n");
    fflush(stdout);
}

void UTILS::clean_line_EEPROM(unsigned int eeaddress, int address)
{
    DEEP_DEBUG("  Effacage de la ligne à l'adresse %d de l'eeprom.\r\n", eeaddress);
     
    int size = 64;
    char deleteData[] = {"                                                                "};
    
    char i2cBuffer[size + 2];
    i2cBuffer[0] = (unsigned char)(eeaddress >> 8); // MSB
    i2cBuffer[1] = (unsigned char)(eeaddress & 0xFF); // LSB
 
    for (int i = 0; i < size; i++) {
        i2cBuffer[i + 2] = deleteData[i];
    }
 
    int result = I2C_EEPROM.write(address, i2cBuffer, size + 2, false);
    wait_ms(6);
    
    DEEP_DEBUG("  Ligne à l'adresse %d de l'eeprom effacée.\r\n", eeaddress);
}

//Max 63 bit en écriture
void UTILS::write_EEPROM(char *data, unsigned int eeaddress, int address)
{   
    //Nettoyage de la ligne ou on va stocker la nouvelle data
    clean_line_EEPROM(eeaddress);
    
    // On calcul de la taille de la chaine a enregistrer
    char size = 0;
    do {
        size++;
    } while (data[size]);

    char i2cBuffer[size + 2];
    i2cBuffer[0] = (unsigned char)(eeaddress >> 8); // MSB
    i2cBuffer[1] = (unsigned char)(eeaddress & 0xFF); // LSB

    for (int i = 0; i < size; i++) {
        i2cBuffer[i + 2] = data[i];
    }

    int res = I2C_EEPROM.write(address, i2cBuffer, size + 2, false);

    wait_ms(6);

    DEEP_DEBUG("  Chaine écrite à l'adresse %d de l'eeprom : %s\r\n", eeaddress , data);
}

char* UTILS::read_EEPROM(unsigned int eeaddress , int address)
{
    //On lit toute la ligne
    int size = 17;
    static char data[17];
    
    char i2cBuffer[2];
    i2cBuffer[0] = (unsigned char)(eeaddress >> 8); // MSB
    i2cBuffer[1] = (unsigned char)(eeaddress & 0xFF); // LSB
 
    // Reset eeprom pointer address
    int result = I2C_EEPROM.write(address, i2cBuffer, 2, false);
    wait_ms(6);
 
    // Read eeprom
    I2C_EEPROM.read(address, data, size);
    wait_ms(6);
    
    DEEP_DEBUG("  Char lu à l'adresse %d de l'eeprom : %s\r\n", eeaddress, &data);
    
    return data;
    }

void UTILS::read_C_EEPROM(char *data, unsigned int eeaddress ,int address)
{
    //On lit toute la ligne
    int size = 64;
    
    char i2cBuffer[2];
    i2cBuffer[0] = (unsigned char)(eeaddress >> 8); // MSB
    i2cBuffer[1] = (unsigned char)(eeaddress & 0xFF); // LSB
 
    // Reset eeprom pointer address
    int result = I2C_EEPROM.write(address, i2cBuffer, 2, false);
    wait_ms(6);
 
    // Read eeprom
    I2C_EEPROM.read(address, data, size);
    wait_ms(6);
    
    DEEP_DEBUG("  Char lu à l'adresse %d de l'eeprom : %s\r\n", eeaddress, data);
}

float UTILS::read_F_EEPROM(unsigned int eeaddress ,int address)
{
    //On lit toute la ligne
    int size = 64;
    char data[64];

    char i2cBuffer[2];
    i2cBuffer[0] = (unsigned char)(eeaddress >> 8); // MSB
    i2cBuffer[1] = (unsigned char)(eeaddress & 0xFF); // LSB

    int result = I2C_EEPROM.write(address, i2cBuffer, 2, false);
    wait_ms(6);

    I2C_EEPROM.read(address, data, size);
    wait_ms(6);

    float result_F = atof(data);
    DEEP_DEBUG("  Float lu à l'adresse %d de l'eeprom : %f\r\n", eeaddress, result_F);
    return result_F;
}


int UTILS::read_I_EEPROM(unsigned int eeaddress ,int address)
{
    //On lit toute la ligne
    int size = 64;
    char data[64];

    char i2cBuffer[2];
    i2cBuffer[0] = (unsigned char)(eeaddress >> 8); // MSB
    i2cBuffer[1] = (unsigned char)(eeaddress & 0xFF); // LSB

    int result = I2C_EEPROM.write(address, i2cBuffer, 2, false);
    wait_ms(6);

    I2C_EEPROM.read(address, data, size);
    wait_ms(6);

    int result_I = atoi(data);
    DEEP_DEBUG("  Int lu à l'adresse %d l'eeprom : %d\r\n", eeaddress, result_I);
    return result_I;
}

void UTILS::clean_EEPROM(int address)
{
    DEBUG("  Nettoyage total de l'Eeprom (64 colonnes, 4096 lignes).\r\n");
    int i;
    int pointer;
    char deleteData[] = {"                                                                "};
    for (i = 0; i < 4096; i++) {
        pointer = 64 * i;
        clean_line_EEPROM(pointer, address);
    }
    DEBUG("Eeprom néttoyée.\r\n");
}