calibration.c

Go to the documentation of this file.

#include "calibration.h"

// reset calibration
void reset_offsets(void) {
    int i;
    for (i = 0; i < NUM_CHANNELS; i++) {
        calibration.offsets[i] = 0;
    }
}

void reset_scales(void) {
    int i;
    for (i = 0; i < NUM_CHANNELS; i++) {
        calibration.scales[i] = 1;
    }
}

int read_calibration(struct rl_conf* conf) {

    // open calibration file
    FILE* file = fopen(CALIBRATION_FILE, "r");
    if (file == NULL) {
        // no calibration file available
        reset_offsets();
        reset_scales();
        status.calibration_time = 0;
        return FAILURE;
    }
    // read calibration
    fread(&calibration, sizeof(struct rl_calibration), 1, file);

    // reset calibration, if ignored
    if (conf->calibration == CAL_IGNORE) {
        reset_offsets();
        reset_scales();
    }

    // store timestamp to conf and status
    status.calibration_time = calibration.time;

    // close file
    fclose(file);

    return SUCCESS;
}