diff options
Diffstat (limited to 'cpukit/dev/i2c/sensor-lm75a.c')
| -rw-r--r-- | cpukit/dev/i2c/sensor-lm75a.c | 198 |
1 files changed, 198 insertions, 0 deletions
diff --git a/cpukit/dev/i2c/sensor-lm75a.c b/cpukit/dev/i2c/sensor-lm75a.c new file mode 100644 index 0000000000..4cc1ae681e --- /dev/null +++ b/cpukit/dev/i2c/sensor-lm75a.c @@ -0,0 +1,198 @@ +/** + * @file + * + * @brief Temperature Sensor LM75A Driver Implementation + * + * @ingroup I2CSensorLM75A + */ + +/* + * Copyright (c) 2017 embedded brains GmbH. All rights reserved. + * + * embedded brains GmbH + * Dornierstr. 4 + * 82178 Puchheim + * Germany + * <rtems@embedded-brains.de> + * + * The license and distribution terms for this file may be + * found in the file LICENSE in this distribution or at + * http://www.rtems.org/license/LICENSE. + */ + +#if HAVE_CONFIG_H +#include "config.h" +#endif + +#include <dev/i2c/sensor-lm75a.h> + +typedef enum { + SENSOR_LM75A_PTR_TEMP, + SENSOR_LM75A_PTR_CONF, + SENSOR_LM75A_PTR_THYST, + SENSOR_LM75A_PTR_TOS +} sensor_lm75a_ptr; + +static int sensor_lm75a_get_reg_8( + i2c_dev *dev, + sensor_lm75a_ptr ptr, + uint8_t *val +) +{ + uint8_t out[1] = { ptr }; + uint8_t in[sizeof(*val)]; + i2c_msg msgs[2] = { + { + .addr = dev->address, + .flags = 0, + .len = (uint16_t) sizeof(out), + .buf = &out[0] + }, { + .addr = dev->address, + .flags = I2C_M_RD, + .len = (uint16_t) sizeof(in), + .buf = &in[0] + } + }; + int err; + + err = i2c_bus_transfer(dev->bus, &msgs[0], RTEMS_ARRAY_SIZE(msgs)); + *val = in[0]; + + return err; +} + +static int sensor_lm75a_set_reg_8( + i2c_dev *dev, + sensor_lm75a_ptr ptr, + uint8_t val +) +{ + uint8_t out[2] = { ptr, val }; + i2c_msg msgs[1] = { + { + .addr = dev->address, + .flags = 0, + .len = (uint16_t) sizeof(out), + .buf = &out[0] + } + }; + + return i2c_bus_transfer(dev->bus, &msgs[0], RTEMS_ARRAY_SIZE(msgs)); +} + +static int sensor_lm75a_get_reg_16( + i2c_dev *dev, + sensor_lm75a_ptr ptr, + uint16_t *val +) +{ + uint8_t out[1] = { ptr }; + uint8_t in[sizeof(*val)]; + i2c_msg msgs[2] = { + { + .addr = dev->address, + .flags = 0, + .len = (uint16_t) sizeof(out), + .buf = &out[0] + }, { + .addr = dev->address, + .flags = I2C_M_RD, + .len = (uint16_t) sizeof(in), + .buf = &in[0] + } + }; + int err; + + err = i2c_bus_transfer(dev->bus, &msgs[0], RTEMS_ARRAY_SIZE(msgs)); + *val = (in[0] << 8) | in[1]; + + return err; +} + +static int sensor_lm75a_set_reg_16( + i2c_dev *dev, + sensor_lm75a_ptr ptr, + uint16_t val +) +{ + uint8_t out[3] = { ptr, (uint8_t) (val >> 8), (uint8_t) val }; + i2c_msg msgs[1] = { + { + .addr = dev->address, + .flags = 0, + .len = (uint16_t) sizeof(out), + .buf = &out[0] + } + }; + + return i2c_bus_transfer(dev->bus, &msgs[0], RTEMS_ARRAY_SIZE(msgs)); +} + +static int sensor_lm75a_ioctl( + i2c_dev *dev, + ioctl_command_t command, + void *arg +) +{ + uint8_t v8 = (uint8_t) (uintptr_t) arg; + uint16_t v16 = (uint16_t) (uintptr_t) arg; + int err; + + switch (command) { + case SENSOR_LM75A_GET_CONF: + err = sensor_lm75a_get_reg_8(dev, SENSOR_LM75A_PTR_CONF, arg); + break; + case SENSOR_LM75A_SET_CONF: + err = sensor_lm75a_set_reg_8(dev, SENSOR_LM75A_PTR_CONF, v8); + break; + case SENSOR_LM75A_CLEAR_AND_SET_CONF: + i2c_bus_obtain(dev->bus); + err = sensor_lm75a_get_reg_8(dev, SENSOR_LM75A_PTR_CONF, &v8); + if (err == 0) { + v8 &= ~((uint8_t) v16); + v8 |= (uint8_t) (v16 >> 8); + err = sensor_lm75a_set_reg_8(dev, SENSOR_LM75A_PTR_CONF, v8); + } + i2c_bus_release(dev->bus); + break; + case SENSOR_LM75A_GET_TEMP: + err = sensor_lm75a_get_reg_16(dev, SENSOR_LM75A_PTR_TEMP, arg); + break; + case SENSOR_LM75A_GET_TOS: + err = sensor_lm75a_get_reg_16(dev, SENSOR_LM75A_PTR_TOS, arg); + break; + case SENSOR_LM75A_SET_TOS: + err = sensor_lm75a_set_reg_16(dev, SENSOR_LM75A_PTR_TOS, v16); + break; + case SENSOR_LM75A_GET_THYST: + err = sensor_lm75a_get_reg_16(dev, SENSOR_LM75A_PTR_THYST, arg); + break; + case SENSOR_LM75A_SET_THYST: + err = sensor_lm75a_set_reg_16(dev, SENSOR_LM75A_PTR_THYST, v16); + break; + default: + err = -ENOTTY; + break; + } + + return err; +} + +int i2c_dev_register_sensor_lm75a( + const char *bus_path, + const char *dev_path, + uint16_t address +) +{ + i2c_dev *dev; + + dev = i2c_dev_alloc_and_init(sizeof(*dev), bus_path, address); + if (dev == NULL) { + return -1; + } + + dev->ioctl = sensor_lm75a_ioctl; + + return i2c_dev_register(dev, dev_path); +} |