drivers/sensor/tmd2620/tmd2620_trigger.c

/*
 * Copyright (c) 2023 PHYTEC Messtechnik GmbH
 *
 * SPDX-License-Identifier: Apache-2.0
 */

#include <zephyr/device.h>
#include <zephyr/drivers/gpio.h>
#include <zephyr/drivers/i2c.h>
#include <zephyr/drivers/sensor.h>
#include <zephyr/kernel.h>
#include <zephyr/logging/log.h>
#include <zephyr/sys/util.h>

#include "tmd2620.h"

LOG_MODULE_DECLARE(TMD2620, CONFIG_SENSOR_LOG_LEVEL);

extern struct tmd2620_data tmd2620_driver;

void tmd2620_work_cb(struct k_work *work)
{
	LOG_DBG("Work callback was called back.");

	struct tmd2620_data *data = CONTAINER_OF(work, struct tmd2620_data, work);
	const struct device *dev = data->dev;

	if (data->p_th_handler != NULL) {
		data->p_th_handler(dev, data->p_th_trigger);
	}

	tmd2620_setup_int(dev->config, true);
}

int tmd2620_attr_set(const struct device *dev, enum sensor_channel chan, enum sensor_attribute attr,
		     const struct sensor_value *val)
{
	LOG_DBG("Setting sensor attributes.");

	const struct tmd2620_config *config = dev->config;
	int ret;

	if (chan != SENSOR_CHAN_PROX) {
		return -ENOTSUP;
	}

	if (attr == SENSOR_ATTR_UPPER_THRESH) {
		ret = i2c_reg_write_byte_dt(&config->i2c, TMD2620_PIHT_REG,
						(255 - (uint8_t)val->val1));
		if (ret < 0) {
			return ret;
		}
	}

	if (attr == SENSOR_ATTR_LOWER_THRESH) {
		return i2c_reg_write_byte_dt(&config->i2c, TMD2620_PILT_REG, (uint8_t)val->val1);
	}

	return 0;
}

int tmd2620_trigger_set(const struct device *dev, const struct sensor_trigger *trigg,
			sensor_trigger_handler_t handler)
{
	LOG_DBG("Setting trigger handler.");

	const struct tmd2620_config *config = dev->config;
	struct tmd2620_data *data = dev->data;
	int ret;

	tmd2620_setup_int(dev->config, false);

	if (trigg->type != SENSOR_TRIG_THRESHOLD) {
		return -ENOTSUP;
	}

	if (trigg->chan != SENSOR_CHAN_PROX) {
		return -ENOTSUP;
	}

	data->p_th_trigger = trigg;
	data->p_th_handler = handler;
	ret = i2c_reg_update_byte_dt(&config->i2c, TMD2620_INTENAB_REG,
				TMD2620_INTENAB_PIEN, TMD2620_INTENAB_PIEN);
	if (ret < 0) {
		return ret;
	}

	tmd2620_setup_int(config, true);
	if (gpio_pin_get_dt(&config->int_gpio) > 0) {
		k_work_submit(&data->work);
	}

	return 0;
}