You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
152 lines
3.4 KiB
152 lines
3.4 KiB
/* |
|
* Copyright (c) 2016 Intel Corporation |
|
* |
|
* SPDX-License-Identifier: Apache-2.0 |
|
*/ |
|
|
|
#define DT_DRV_COMPAT hoperf_th02 |
|
|
|
#include <zephyr/kernel.h> |
|
#include <zephyr/device.h> |
|
#include <zephyr/drivers/i2c.h> |
|
#include <zephyr/sys/byteorder.h> |
|
#include <zephyr/sys/util.h> |
|
#include <zephyr/drivers/sensor.h> |
|
#include <zephyr/sys/__assert.h> |
|
#include <zephyr/logging/log.h> |
|
|
|
#include "th02.h" |
|
|
|
LOG_MODULE_REGISTER(TH02, CONFIG_SENSOR_LOG_LEVEL); |
|
|
|
static uint8_t read8(const struct i2c_dt_spec *i2c, uint8_t d) |
|
{ |
|
uint8_t buf; |
|
|
|
if (i2c_reg_read_byte_dt(i2c, d, &buf) < 0) { |
|
LOG_ERR("Error reading register."); |
|
} |
|
return buf; |
|
} |
|
|
|
static int is_ready(const struct i2c_dt_spec *i2c) |
|
{ |
|
|
|
uint8_t status; |
|
|
|
if (i2c_reg_read_byte_dt(i2c, TH02_REG_STATUS, &status) < 0) { |
|
LOG_ERR("error reading status register"); |
|
} |
|
|
|
if (status & TH02_STATUS_RDY_MASK) { |
|
return 0; |
|
} else { |
|
return 1; |
|
} |
|
} |
|
|
|
static uint16_t get_humi(const struct i2c_dt_spec *i2c) |
|
{ |
|
uint16_t humidity = 0U; |
|
|
|
if (i2c_reg_write_byte_dt(i2c, TH02_REG_CONFIG, TH02_CMD_MEASURE_HUMI) < 0) { |
|
LOG_ERR("Error writing register"); |
|
return 0; |
|
} |
|
while (!is_ready(i2c)) { |
|
} |
|
|
|
humidity = read8(i2c, TH02_REG_DATA_H) << 8; |
|
humidity |= read8(i2c, TH02_REG_DATA_L); |
|
humidity >>= 4; |
|
|
|
return humidity; |
|
} |
|
|
|
uint16_t get_temp(const struct i2c_dt_spec *i2c) |
|
{ |
|
uint16_t temperature = 0U; |
|
|
|
if (i2c_reg_write_byte_dt(i2c, TH02_REG_CONFIG, TH02_CMD_MEASURE_TEMP) < 0) { |
|
LOG_ERR("Error writing register"); |
|
return 0; |
|
} |
|
while (!is_ready(i2c)) { |
|
} |
|
|
|
temperature = read8(i2c, TH02_REG_DATA_H) << 8; |
|
temperature |= read8(i2c, TH02_REG_DATA_L); |
|
temperature >>= 2; |
|
|
|
return temperature; |
|
} |
|
|
|
static int th02_sample_fetch(const struct device *dev, |
|
enum sensor_channel chan) |
|
{ |
|
struct th02_data *drv_data = dev->data; |
|
const struct th02_config *cfg = dev->config; |
|
|
|
__ASSERT_NO_MSG(chan == SENSOR_CHAN_ALL || chan == SENSOR_CHAN_AMBIENT_TEMP); |
|
|
|
drv_data->t_sample = get_temp(&cfg->i2c); |
|
LOG_INF("temp: %u", drv_data->t_sample); |
|
drv_data->rh_sample = get_humi(&cfg->i2c); |
|
LOG_INF("rh: %u", drv_data->rh_sample); |
|
|
|
return 0; |
|
} |
|
|
|
static int th02_channel_get(const struct device *dev, |
|
enum sensor_channel chan, |
|
struct sensor_value *val) |
|
{ |
|
struct th02_data *drv_data = dev->data; |
|
|
|
__ASSERT_NO_MSG(chan == SENSOR_CHAN_AMBIENT_TEMP || |
|
chan == SENSOR_CHAN_HUMIDITY); |
|
|
|
if (chan == SENSOR_CHAN_AMBIENT_TEMP) { |
|
/* val = sample / 32 - 50 */ |
|
val->val1 = drv_data->t_sample / 32U - 50; |
|
val->val2 = (drv_data->t_sample % 32) * (1000000 / 32); |
|
} else if (chan == SENSOR_CHAN_HUMIDITY) { |
|
/* val = sample / 16 -24 */ |
|
val->val1 = drv_data->rh_sample / 16U - 24; |
|
val->val2 = (drv_data->rh_sample % 16) * (1000000 / 16); |
|
} else { |
|
return -ENOTSUP; |
|
} |
|
|
|
return 0; |
|
} |
|
|
|
static DEVICE_API(sensor, th02_driver_api) = { |
|
.sample_fetch = th02_sample_fetch, |
|
.channel_get = th02_channel_get, |
|
}; |
|
|
|
static int th02_init(const struct device *dev) |
|
{ |
|
const struct th02_config *cfg = dev->config; |
|
|
|
if (!device_is_ready(cfg->i2c.bus)) { |
|
LOG_ERR("Bus device is not ready"); |
|
return -ENODEV; |
|
} |
|
|
|
return 0; |
|
} |
|
|
|
#define TH02_DEFINE(inst) \ |
|
static struct th02_data th02_data_##inst; \ |
|
\ |
|
static const struct th02_config th02_config_##inst = { \ |
|
.i2c = I2C_DT_SPEC_INST_GET(inst), \ |
|
}; \ |
|
\ |
|
SENSOR_DEVICE_DT_INST_DEFINE(inst, th02_init, NULL, \ |
|
&th02_data_##inst, &th02_config_##inst, POST_KERNEL, \ |
|
CONFIG_SENSOR_INIT_PRIORITY, &th02_driver_api); \ |
|
|
|
DT_INST_FOREACH_STATUS_OKAY(TH02_DEFINE)
|
|
|