avec dfu

Fork of Utils by POTLESS

Utils.cpp

Committer:
POTLESS_2
Date:
2018-02-24
Revision:
10:21f3ff5d6a3d
Parent:
9:fa2818db80cf
Child:
11:a41267cffa61

File content as of revision 10:21f3ff5d6a3d:

#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;

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

void errno_error(void* ret_val)
{
    Exist_Val = 0;
    if (ret_val == NULL) {
        DEBUG("  Problème Flash = %d \r\n", errno);
        Exist_Val = 0;
    } else {
        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::Get_File_Infos(char* File_Name) {
    
    char filename[20];
    sprintf(filename, "/Root/%s", File_Name);
    
    struct stat fileStat;
    stat(filename, &fileStat); 
    
    printf("Informations sur %s\r\n\r\n",filename);
    printf("  Taille du fichier           :  %d bytes\r\n",&fileStat.st_size);
    printf("  Heure dernier accès         :  %s\r\n",ctime(&fileStat.st_atime));
    printf("  Heure dernière modification :  %s\r\n",ctime(&fileStat.st_mtime));
    printf("  Heure dernier changement    :  %s\r\n",ctime(&fileStat.st_ctime));

  
    struct stat stat_buf;

    stat(filename, &stat_buf);
    

    stat_buf.st_size;
    stat_buf.st_dev;
    stat_buf.st_ino;
    stat_buf.st_mode;
    stat_buf.st_nlink;
    stat_buf.st_uid;
    stat_buf.st_gid;
    stat_buf.st_rdev;
    stat_buf.st_size;
    stat_buf.st_blksize;
    stat_buf.st_blocks;
    stat_buf.st_atime;
    stat_buf.st_mtime;
    stat_buf.st_ctime;

    printf("  Taille du fichier           :  %d bytes\r\n",&stat_buf.st_size);
    printf("  Heure dernier accès         :  %s\r\n",ctime(&stat_buf.st_atime));
    printf("  Heure dernière modification :  %s\r\n",ctime(&stat_buf.st_mtime));
    printf("  Heure dernier changement    :  %s\r\n",ctime(&stat_buf.st_ctime));

}    

void UTILS::Get_File_Infos_bis(char* File_Name) {
    
    char filename[20];
    sprintf(filename, "/Root/%s", File_Name);
    
    struct stat fileStat;
 
    stat(filename, &fileStat); 

    printf("Information for %s\n",filename);
    printf("---------------------------\n");
    printf("File Size: \t\t%d bytes\n",fileStat.st_size);
    printf("Number of Links: \t%d\n",fileStat.st_nlink);
    printf("File inode: \t\t%d\n",fileStat.st_ino);
 
    printf("File Permissions: \t");
    printf( (fileStat.st_mode & S_IRUSR) ? "r" : "-");
    printf( (fileStat.st_mode & S_IWUSR) ? "w" : "-");
    printf( (fileStat.st_mode & S_IXUSR) ? "x" : "-");
    printf( (fileStat.st_mode & S_IRGRP) ? "r" : "-");
    printf( (fileStat.st_mode & S_IWGRP) ? "w" : "-");
    printf( (fileStat.st_mode & S_IXGRP) ? "x" : "-");
    printf( (fileStat.st_mode & S_IROTH) ? "r" : "-");
    printf( (fileStat.st_mode & S_IWOTH) ? "w" : "-");
    printf( (fileStat.st_mode & S_IXOTH) ? "x" : "-");
    printf("\n\n");
  
}
*/

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);

    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);

    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);

    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);

    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");
    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");
    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;
    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("  Fichier 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);
    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("  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\n\r");
    printf("  COMMANDES CAPTEURS\r\n\r\n");   
    printf("  calib_O2 X       =    calibration des cellules O2 dans l'air avec X itérations.\n\r");
    printf("  check            =    sortie des valeurs de calibrations enregistrées.\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);
}