rl_hw.c

Go to the documentation of this file.

 
#include <errno.h>
#include <stdio.h>
#include <string.h>
 
#include "calibration.h"
#include "gpio.h"
#include "log.h"
#include "pru.h"
#include "rl.h"
#include "rl_file.h"
#include "sensor/sensor.h"
 
#include "rl_hw.h"
 
gpio_t *gpio_fhr1 = NULL;
gpio_t *gpio_fhr2 = NULL;
gpio_t *gpio_led_status = NULL;
gpio_t *gpio_led_error = NULL;
 
void hw_init(rl_config_t const *const config) {
    // GPIO configuration
    gpio_init();
    // force high range (negative enable)
    gpio_fhr1 = gpio_setup(GPIO_FHR1, GPIO_MODE_OUT, "rocketlogger");
    gpio_fhr2 = gpio_setup(GPIO_FHR2, GPIO_MODE_OUT, "rocketlogger");
    gpio_set_value(gpio_fhr1, (config->channel_force_range[0] ? 0 : 1));
    gpio_set_value(gpio_fhr2, (config->channel_force_range[1] ? 0 : 1));
    // leds
    gpio_led_status =
        gpio_setup(GPIO_LED_STATUS, GPIO_MODE_OUT, "rocketlogger");
    gpio_led_error = gpio_setup(GPIO_LED_ERROR, GPIO_MODE_OUT, "rocketlogger");
    gpio_set_value(gpio_led_status, 1);
    gpio_set_value(gpio_led_error, 0);
 
    // PRU
    pru_init();
 
    // SENSORS (if enabled)
    if (config->ambient_enable) {
        sensors_init();
        rl_status.sensor_count = sensors_scan(rl_status.sensor_available);
    }
 
    // STATE
    if (config->file_enable) {
        // calculate disk use rate in bytes per second:
        // - int32_t/channel + uint32_t bytes/sample for digital at sample rate
        // - 2 timestamp at update rate
        // - int32_t/sensor channel + 2 timestamps at 1 Hz
        rl_status.disk_use_rate =
            (sizeof(int32_t) * count_channels(config->channel_enable) *
             config->sample_rate) +
            (sizeof(rl_timestamp_t) * 2 * config->update_rate) +
            (sizeof(uint32_t) * (config->digital_enable ? 1 : 0) *
             config->sample_rate) +
            (sizeof(int32_t) * rl_status.sensor_count) +
            (sizeof(rl_timestamp_t) * 2 * (rl_status.sensor_count > 0 ? 1 : 0));
    }
    rl_status_write(&rl_status);
}
 
void hw_deinit(rl_config_t const *const config) {
 
    // GPIO (set to default state only, (un)export is handled by daemon)
    // reset force high range GPIOs to force high range (negative enable)
    gpio_set_value(gpio_fhr1, 0);
    gpio_set_value(gpio_fhr2, 0);
 
    // reset status LED, leave error LED in current state
    gpio_set_value(gpio_led_status, 0);
 
    gpio_release(gpio_fhr1);
    gpio_release(gpio_fhr2);
    gpio_release(gpio_led_status);
    gpio_release(gpio_led_error);
    gpio_deinit();
 
    // PRU
    // stop first if running in background
    if (config->background_enable) {
        pru_stop();
    }
    pru_deinit();
 
    // SENSORS (if enabled)
    if (config->ambient_enable) {
        sensors_close(rl_status.sensor_available);
        sensors_deinit();
    }
 
    // RESET sampling specific state
    rl_status.disk_use_rate = 0;
    rl_status_write(&rl_status);
}
 
int hw_sample(rl_config_t const *const config) {
    int ret;
    FILE *data_file = (FILE *)-1;
    FILE *ambient_file = (FILE *)-1;
 
    // reset calibration if ignored, load otherwise
    if (config->calibration_ignore) {
        calibration_reset_offsets();
        calibration_reset_scales();
    } else {
        ret = calibration_load();
        if (ret < 0) {
            rl_log(RL_LOG_WARNING,
                   "no calibration file, returning uncalibrated values");
        }
    }
 
    // create/open measurement files
    if (config->file_enable) {
        data_file = fopen64(config->file_name, "w+");
        if (data_file == NULL) {
            rl_log(RL_LOG_ERROR,
                   "failed to open data file '%s'; %d message: %s",
                   config->file_name, errno, strerror(errno));
            return ERROR;
        }
    }
 
    if (config->ambient_enable) {
        char *ambient_file_name =
            rl_file_get_ambient_file_name(config->file_name);
        ambient_file = fopen64(ambient_file_name, "w+");
        if (data_file == NULL) {
            rl_log(RL_LOG_ERROR,
                   "failed to open ambient file '%s'; %d message: %s",
                   ambient_file, errno, strerror(errno));
            return ERROR;
        }
    }
 
    // SAMPLE
    ret = pru_sample(data_file, ambient_file, config);
    if (ret < 0) {
        // error occurred
        gpio_set_value(gpio_led_error, 1);
    }
 
    // close data files
    if (config->file_enable) {
        fclose(data_file);
    }
    if (config->ambient_enable) {
        fclose(ambient_file);
    }
 
    return SUCCESS;
}