File content as of revision 13:3868cbdfa5ce:

#include "log.h"

Timer t_loggingTimer;
int i_logging_duration;
int i_last_log;
bool b_LOG_READY = false;
Serial rs_LOG(PC_10, PC_11,115200);
//odroid(PC_10, PC_11);
//pc(USBTX, USBRX);


s_Sample s_LOG_history[LOG_SIZE];
int i_LOG_index_data = 0;
bool b_LOG_flag = false;

void log_start(int duration_ms)
{
    b_LOG_flag = true;
    b_LOG_READY = false;
    t_loggingTimer.start();
    i_logging_duration = duration_ms;
    t_loggingTimer.reset();
}

void log_check()
{
    if(t_loggingTimer.read_ms() > i_logging_duration || i_LOG_index_data >= LOG_SIZE) {
        b_LOG_READY = true;
        b_LOG_flag = false;
        t_loggingTimer.stop();
        t_loggingTimer.reset();
    }
    if(b_LOG_flag && i_LOG_index_data < LOG_SIZE && (t_loggingTimer.read_ms()-i_last_log) >= LOG_PERIOD_MS) {
        i_last_log = t_loggingTimer.read_ms();
        s_LOG_history[i_LOG_index_data].timestamp = i_last_log;
        i_LOG_index_data ++;
        //rs_LOG_pc.printf("i_LOG_index_data:%d\r\n",i_LOG_index_data);
    }

}
void log_stop()
{
    b_LOG_READY = true;
    b_LOG_flag = false;
    t_loggingTimer.stop();
    t_loggingTimer.reset();
}

void log_pc()
{
    rs_LOG.printf("timestamp;left_90;right_90;left_45;right_45;pwm_dir_prec;odom;speed;angle_bord0;angle_bord1;angle_bord2;angle_bord3;angle_bord4;angle_bord5;angle_pos;angle;distParcourue;\r\n");
    for(int i = 0; i<i_LOG_index_data; i++) {
        rs_LOG.printf("%d;%f;%f;%f;%f;%d;%f;%f;%f;%f;%f;%f;%f;%f;%f;%f;%f\r\n",s_LOG_history[i].timestamp,s_LOG_history[i].left_90,s_LOG_history[i].right_90,s_LOG_history[i].left_45,s_LOG_history[i].right_45,s_LOG_history[i].pwm_dir,s_LOG_history[i].odom,s_LOG_history[i].speed,s_LOG_history[i].angle_bord0,s_LOG_history[i].angle_bord1,s_LOG_history[i].angle_bord2,s_LOG_history[i].angle_bord3,s_LOG_history[i].angle_bord4,s_LOG_history[i].angle_bord5,s_LOG_history[i].angle_pos,s_LOG_history[i].angle,s_LOG_history[i].distParcourue);

        s_LOG_history[i].left_90 = 0.0;
        s_LOG_history[i].right_90 = 0.0;
        s_LOG_history[i].left_45 = 0.0;
        s_LOG_history[i].right_45 = 0.0;
        s_LOG_history[i].odom = 0.0;
        s_LOG_history[i].speed = 0.0;
        s_LOG_history[i].timestamp = 0;
        s_LOG_history[i].pwm_dir = 0;
        s_LOG_history[i].angle_bord0 = 0.0;
        s_LOG_history[i].angle_bord1 = 0.0;
        s_LOG_history[i].angle_bord2 = 0.0;
        s_LOG_history[i].angle_bord3 = 0.0;
        s_LOG_history[i].angle_bord4 = 0.0;
        s_LOG_history[i].angle_bord5 = 0.0;
        s_LOG_history[i].angle_pos = 0;
        s_LOG_history[i].angle = 0;
        s_LOG_history[i].distParcourue = 0;


    }
    i_LOG_index_data = 0;
    b_LOG_READY = false;
}