tsl4531.c

Go to the documentation of this file.

#include <errno.h>

#include "sensor.h"

#include "tsl4531.h"

const int TSL4531_sensors[] = TSL4531_I2C_ADDRESSES;

enum TSL4531_range TSL4531_range[sizeof(TSL4531_sensors)] = {
    TSL4531_RANGE_AUTO};
enum TSL4531_range TSL4531_auto_range[sizeof(TSL4531_sensors)] = {
    TSL4531_RANGE_MEDIUM};
uint8_t TSL4531_multiplier[sizeof(TSL4531_sensors)] = {TSL4531_MULT_200};
int32_t TSL4531_values[sizeof(TSL4531_sensors)] = {0};

int TSL4531_init(int sensor_identifier) {
    int sensor_bus = Sensors_getSharedBus();

    if (sensor_bus < 0) {
        rl_log(ERROR, "TSL4531 I2C bus not initialized properly");
        return FAILURE;
    }

    int result = 0;

    uint8_t device_address = (uint8_t)sensor_identifier;
    result = Sensors_initSharedComm(device_address);
    if (result < 0) {
        rl_log(ERROR, "TSL4531 I2C initialization failed");
        return FAILURE;
    }

    uint8_t sensor_id = TSL4531_getID();
    if (sensor_id != TSL4531_ID) {
        rl_log(ERROR, "TSL4531 with wrong sensor ID: %d", sensor_id);
        return FAILURE;
    }

    result = TSL4531_setParameters(sensor_identifier);
    if (result < 0) {
        rl_log(ERROR, "TSL4531 setting configuraiton failed");
        return FAILURE;
    }

    return SUCCESS;
}

void TSL4531_close(int sensor_identifier) {
    (void)sensor_identifier; // suppress unused warning
}

int TSL4531_read(int sensor_identifier) {
    int sensor_index = TSL4531_getIndex(sensor_identifier);
    int sensor_bus = Sensors_getSharedBus();

    int result;

    uint8_t device_address = (uint8_t)sensor_identifier;
    result = Sensors_initSharedComm(device_address);
    if (result < 0) {
        rl_log(ERROR, "TSL4531 I2C communication failed");
        return FAILURE;
    }

    // read sensor data word
    int32_t data = i2c_smbus_read_word_data(
        sensor_bus, TSL4531_COMMAND | TSL4531_REG_DATALOW);
    if (data < 0) {
        rl_log(ERROR, "TSL4531 reading data word failed");
        return FAILURE;
    }

    TSL4531_values[sensor_index] =
        (data & 0xffff) * TSL4531_multiplier[sensor_index];

    if (TSL4531_range[sensor_index] == TSL4531_RANGE_AUTO) {
        // Auto-Range
        enum TSL4531_range range_set = TSL4531_auto_range[sensor_index];
        switch (range_set) {
        case TSL4531_RANGE_LOW:
            if (TSL4531_values[sensor_index] >= TSL4531_RANGE_LOW_MAX) {
                TSL4531_auto_range[sensor_index] = TSL4531_RANGE_MEDIUM;
            }
            break;
        case TSL4531_RANGE_MEDIUM:
            if (TSL4531_values[sensor_index] >= TSL4531_RANGE_MEDIUM_MAX) {
                TSL4531_auto_range[sensor_index] = TSL4531_RANGE_HIGH;
            } else if (TSL4531_values[sensor_index] <
                       TSL4531_RANGE_LOW_MAX - TSL4531_RANGE_HYSTERESIS) {
                TSL4531_auto_range[sensor_index] = TSL4531_RANGE_LOW;
            }
            break;
        case TSL4531_RANGE_HIGH:
            if (TSL4531_values[sensor_index] <
                TSL4531_RANGE_MEDIUM_MAX - TSL4531_RANGE_HYSTERESIS) {
                TSL4531_auto_range[sensor_index] = TSL4531_RANGE_MEDIUM;
            }
            break;
        default:
            rl_log(ERROR, "TSL4531 auto range logic failure");
            return FAILURE;
        }

        int result = TSL4531_sendRange(sensor_identifier,
                                       TSL4531_auto_range[sensor_index]);
        if (result < 0) {
            TSL4531_auto_range[sensor_index] = range_set;
            rl_log(ERROR, "TSL4531 auto range update failed");
            return FAILURE;
        }
    }

    return SUCCESS;
}

int32_t TSL4531_getValue(int sensor_identifier, int channel) {
    if (channel > 0) {
        return 0;
    }

    int sensor_index = TSL4531_getIndex(sensor_identifier);

    return TSL4531_values[sensor_index];
}

int TSL4531_setRange(int sensor_identifier, int range) {
    int sensor_index = TSL4531_getIndex(sensor_identifier);

    int result = TSL4531_sendRange(sensor_identifier, range);
    if (result < 0) {
        rl_log(ERROR, "TSL4531 auto range update failed");
        return FAILURE;
    }

    TSL4531_range[sensor_index] = range;

    return SUCCESS;
}

int TSL4531_getRange(int sensor_identifier) {
    int sensor_index = TSL4531_getIndex(sensor_identifier);

    if (TSL4531_range[sensor_index] == TSL4531_RANGE_AUTO) {
        return TSL4531_auto_range[sensor_index];
    } else {
        return TSL4531_range[sensor_index];
    }
}

int TSL4531_getID(void) {
    int sensor_bus = Sensors_getSharedBus();

    int read_result =
        i2c_smbus_read_byte_data(sensor_bus, TSL4531_COMMAND | TSL4531_REG_ID);

    if (read_result < 0) {
        rl_log(ERROR, "TSL4531 I2C error reading ID of sensor");
    }
    return read_result;
}

int TSL4531_setParameters(int sensor_identifier) {
    int sensor_bus = Sensors_getSharedBus();

    int result;

    result = i2c_smbus_write_byte_data(sensor_bus,
                                       TSL4531_COMMAND | TSL4531_REG_CONTROL,
                                       TSL4531_SAMPLE_CONTINUOUS);
    if (result < 0) {
        rl_log(ERROR, "TSL4531 writing control register failed");
        return FAILURE;
    }

    result = TSL4531_setRange(sensor_identifier, TSL4531_RANGE_AUTO);
    if (result < 0) {
        rl_log(ERROR, "TSL4531 setting range failed");
        return FAILURE;
    }

    return SUCCESS;
}

int TSL4531_sendRange(int sensor_identifier, int range) {
    int sensor_index = TSL4531_getIndex(sensor_identifier);
    int sensor_bus = Sensors_getSharedBus();

    int result;

    switch (range) {
    case TSL4531_RANGE_LOW:
        result = i2c_smbus_write_byte_data(
            sensor_bus, TSL4531_COMMAND | TSL4531_REG_CONFIG,
            TSL4531_INT_TIME_400 | TSL4531_LOW_POWER);
        if (result < 0) {
            rl_log(ERROR, "TSL4531 writing new range configuration failed");
            return FAILURE;
        }
        TSL4531_multiplier[sensor_index] = TSL4531_MULT_400;
        break;
    case TSL4531_RANGE_MEDIUM:
        result = i2c_smbus_write_byte_data(
            sensor_bus, TSL4531_COMMAND | TSL4531_REG_CONFIG,
            TSL4531_INT_TIME_200 | TSL4531_LOW_POWER);
        if (result < 0) {
            rl_log(ERROR, "TSL4531 writing new range configuration failed");
            return FAILURE;
        }
        TSL4531_multiplier[sensor_index] = TSL4531_MULT_200;
        break;
    case TSL4531_RANGE_HIGH:
        result = i2c_smbus_write_byte_data(
            sensor_bus, TSL4531_COMMAND | TSL4531_REG_CONFIG,
            TSL4531_INT_TIME_100 | TSL4531_LOW_POWER);
        if (result < 0) {
            rl_log(ERROR, "TSL4531 writing new range configuration failed");
            return FAILURE;
        }
        TSL4531_multiplier[sensor_index] = TSL4531_MULT_100;
        break;
    case TSL4531_RANGE_AUTO:
        result = i2c_smbus_write_byte_data(
            sensor_bus, TSL4531_COMMAND | TSL4531_REG_CONFIG,
            TSL4531_INT_TIME_200 | TSL4531_LOW_POWER);
        if (result < 0) {
            rl_log(ERROR, "TSL4531 writing new range configuration failed");
            return FAILURE;
        }
        TSL4531_multiplier[sensor_index] = TSL4531_MULT_200;
        TSL4531_auto_range[sensor_index] = TSL4531_RANGE_MEDIUM;
        break;
    default:
        rl_log(ERROR, "TSL4531 invalid range");
        return FAILURE;
    }

    return SUCCESS;
}

int TSL4531_getIndex(int sensor_identifier) {
    unsigned int index = 0;
    while (index < sizeof(TSL4531_sensors)) {
        if (sensor_identifier == TSL4531_sensors[index]) {
            return (int)index;
        }
        index++;
    }
    return -1;
}