153 lines
3.5 KiB
C
153 lines
3.5 KiB
C
/*
|
|
* 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 const struct sensor_driver_api 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)
|