409 lines
12 KiB
C
409 lines
12 KiB
C
/**
|
|
* Copyright (c)
|
|
* 2022 Ithinx GmbH
|
|
* 2023 Amrith Venkat Kesavamoorthi <amrith@mr-beam.org>
|
|
* 2023 Mr Beam Lasers GmbH.
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* @see https://www.nxp.com/docs/en/data-sheet/PCF8575.pdf
|
|
* @see https://www.nxp.com/docs/en/data-sheet/PCF8574_PCF8574A.pdf
|
|
*/
|
|
|
|
#define DT_DRV_COMPAT nxp_pcf857x
|
|
|
|
#include <zephyr/drivers/gpio/gpio_utils.h>
|
|
|
|
#include <zephyr/drivers/gpio.h>
|
|
#include <zephyr/drivers/i2c.h>
|
|
#include <zephyr/kernel.h>
|
|
#include <zephyr/logging/log.h>
|
|
#include <zephyr/sys/byteorder.h>
|
|
|
|
LOG_MODULE_REGISTER(pcf857x, CONFIG_GPIO_LOG_LEVEL);
|
|
|
|
struct pcf857x_pins_cfg {
|
|
uint16_t configured_as_outputs; /* 0 for input, 1 for output */
|
|
uint16_t outputs_state;
|
|
};
|
|
|
|
/** Runtime driver data of the pcf857x*/
|
|
struct pcf857x_drv_data {
|
|
/* gpio_driver_data needs to be first */
|
|
struct gpio_driver_data common;
|
|
struct pcf857x_pins_cfg pins_cfg;
|
|
sys_slist_t callbacks;
|
|
struct k_sem lock;
|
|
struct k_work work;
|
|
const struct device *dev;
|
|
struct gpio_callback int_gpio_cb;
|
|
uint16_t input_port_last;
|
|
int num_bytes;
|
|
};
|
|
|
|
/** Configuration data*/
|
|
struct pcf857x_drv_cfg {
|
|
/* gpio_driver_config needs to be first */
|
|
struct gpio_driver_config common;
|
|
struct i2c_dt_spec i2c;
|
|
struct gpio_dt_spec gpio_int;
|
|
};
|
|
|
|
/**
|
|
* @brief Reads the value of the pins from pcf857x respectively from a connected device.
|
|
*
|
|
* @param dev Pointer to the device structure of the driver instance.
|
|
* @param value Pointer to the input value. It contains the received Bytes(receives 2 Bytes for P0
|
|
* and P1).
|
|
*
|
|
* @retval 0 If successful.
|
|
* @retval Negative value for error code.
|
|
*/
|
|
static int pcf857x_process_input(const struct device *dev, gpio_port_value_t *value)
|
|
{
|
|
const struct pcf857x_drv_cfg *drv_cfg = dev->config;
|
|
struct pcf857x_drv_data *drv_data = dev->data;
|
|
int rc = 0;
|
|
uint8_t rx_buf[2] = {0};
|
|
|
|
rc = i2c_read_dt(&drv_cfg->i2c, rx_buf, drv_data->num_bytes);
|
|
if (rc != 0) {
|
|
LOG_ERR("%s: failed to read from device: %d", dev->name, rc);
|
|
return -EIO;
|
|
}
|
|
|
|
if (value) {
|
|
*value = sys_get_le16(rx_buf); /*format P17-P10..P07-P00 (bit15-bit8..bit7-bit0)*/
|
|
}
|
|
|
|
drv_data->input_port_last = sys_get_le16(rx_buf);
|
|
|
|
return rc;
|
|
}
|
|
|
|
/** Register the read-task as work*/
|
|
static void pcf857x_work_handler(struct k_work *work)
|
|
{
|
|
struct pcf857x_drv_data *drv_data = CONTAINER_OF(work, struct pcf857x_drv_data, work);
|
|
|
|
k_sem_take(&drv_data->lock, K_FOREVER);
|
|
|
|
uint32_t changed_pins;
|
|
uint16_t input_port_last_temp = drv_data->input_port_last;
|
|
int rc = pcf857x_process_input(drv_data->dev, &changed_pins);
|
|
|
|
if (rc) {
|
|
LOG_ERR("Failed to read interrupt sources: %d", rc);
|
|
}
|
|
k_sem_give(&drv_data->lock);
|
|
if (input_port_last_temp != (uint16_t)changed_pins && !rc) {
|
|
|
|
/** Find changed bits*/
|
|
changed_pins ^= input_port_last_temp;
|
|
gpio_fire_callbacks(&drv_data->callbacks, drv_data->dev, changed_pins);
|
|
}
|
|
}
|
|
|
|
/** Callback for interrupt through some level changes on pcf857x pins*/
|
|
static void pcf857x_int_gpio_handler(const struct device *dev, struct gpio_callback *gpio_cb,
|
|
uint32_t pins)
|
|
{
|
|
ARG_UNUSED(dev);
|
|
ARG_UNUSED(pins);
|
|
|
|
struct pcf857x_drv_data *drv_data =
|
|
CONTAINER_OF(gpio_cb, struct pcf857x_drv_data, int_gpio_cb);
|
|
|
|
k_work_submit(&drv_data->work);
|
|
}
|
|
|
|
/**
|
|
* @brief This function reads a value from the connected device
|
|
*
|
|
* @param dev Pointer to the device structure of a port.
|
|
* @param value Pointer to a variable where pin values will be stored.
|
|
*
|
|
* @retval 0 If successful.
|
|
* @retval Negative value for error code.
|
|
*/
|
|
static int pcf857x_port_get_raw(const struct device *dev, gpio_port_value_t *value)
|
|
{
|
|
struct pcf857x_drv_data *drv_data = dev->data;
|
|
int rc;
|
|
|
|
if (k_is_in_isr()) {
|
|
return -EWOULDBLOCK;
|
|
}
|
|
|
|
if ((~drv_data->pins_cfg.configured_as_outputs & (uint16_t)*value) != (uint16_t)*value) {
|
|
LOG_ERR("Pin(s) is/are configured as output which should be input.");
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
k_sem_take(&drv_data->lock, K_FOREVER);
|
|
|
|
/**
|
|
* Reading of the input port also clears the generated interrupt,
|
|
* thus the configured callbacks must be fired also here if needed.
|
|
*/
|
|
rc = pcf857x_process_input(dev, value);
|
|
|
|
k_sem_give(&drv_data->lock);
|
|
|
|
return rc;
|
|
}
|
|
|
|
/**
|
|
* @brief This function realizes the write connection to the i2c device.
|
|
*
|
|
* @param dev A pointer to the device structure
|
|
* @param mask A mask of bits to set some bits to LOW or HIGH
|
|
* @param value The value which is written via i2c to the pcf857x's output pins
|
|
* @param toggle A way to toggle some bits with xor
|
|
*
|
|
* @retval 0 If successful.
|
|
* @retval Negative value for error code.
|
|
*/
|
|
static int pcf857x_port_set_raw(const struct device *dev, uint16_t mask, uint16_t value,
|
|
uint16_t toggle)
|
|
{
|
|
const struct pcf857x_drv_cfg *drv_cfg = dev->config;
|
|
struct pcf857x_drv_data *drv_data = dev->data;
|
|
int rc = 0;
|
|
uint16_t tx_buf;
|
|
uint8_t tx_buf_p[2];
|
|
|
|
if (k_is_in_isr()) {
|
|
return -EWOULDBLOCK;
|
|
}
|
|
|
|
if ((drv_data->pins_cfg.configured_as_outputs & value) != value) {
|
|
LOG_ERR("Pin(s) is/are configured as input which should be output.");
|
|
return -EOPNOTSUPP;
|
|
}
|
|
|
|
tx_buf = (drv_data->pins_cfg.outputs_state & ~mask);
|
|
tx_buf |= (value & mask);
|
|
tx_buf ^= toggle;
|
|
sys_put_le16(tx_buf, tx_buf_p);
|
|
|
|
rc = i2c_write_dt(&drv_cfg->i2c, tx_buf_p, drv_data->num_bytes);
|
|
if (rc != 0) {
|
|
LOG_ERR("%s: failed to write output port: %d", dev->name, rc);
|
|
return -EIO;
|
|
}
|
|
k_sem_take(&drv_data->lock, K_FOREVER);
|
|
drv_data->pins_cfg.outputs_state = tx_buf;
|
|
k_sem_give(&drv_data->lock);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* @brief This function fills a dummy because the pcf857x has no pins to configure.
|
|
* You can use it to set some pins permanent to HIGH or LOW until reset. It uses the port_set_raw
|
|
* function to set the pins of pcf857x directly.
|
|
*
|
|
* @param dev Pointer to the device structure for the driver instance.
|
|
* @param pin The bit in the io register which is set to high
|
|
* @param flags Flags like the GPIO direction or the state
|
|
*
|
|
* @retval 0 If successful.
|
|
* @retval Negative value for error.
|
|
*/
|
|
static int pcf857x_pin_configure(const struct device *dev, gpio_pin_t pin, gpio_flags_t flags)
|
|
{
|
|
struct pcf857x_drv_data *drv_data = dev->data;
|
|
int ret = 0;
|
|
uint16_t temp_pins = drv_data->pins_cfg.outputs_state;
|
|
uint16_t temp_outputs = drv_data->pins_cfg.configured_as_outputs;
|
|
|
|
if (flags & (GPIO_PULL_UP | GPIO_PULL_DOWN | GPIO_DISCONNECTED | GPIO_SINGLE_ENDED)) {
|
|
return -ENOTSUP;
|
|
}
|
|
if (flags & GPIO_INPUT) {
|
|
temp_outputs &= ~BIT(pin);
|
|
temp_pins &= ~(1 << pin);
|
|
} else if (flags & GPIO_OUTPUT) {
|
|
drv_data->pins_cfg.configured_as_outputs |= BIT(pin);
|
|
temp_outputs = drv_data->pins_cfg.configured_as_outputs;
|
|
}
|
|
if (flags & GPIO_OUTPUT_INIT_HIGH) {
|
|
temp_pins |= (1 << pin);
|
|
}
|
|
if (flags & GPIO_OUTPUT_INIT_LOW) {
|
|
temp_pins &= ~(1 << pin);
|
|
}
|
|
|
|
ret = pcf857x_port_set_raw(dev, drv_data->pins_cfg.configured_as_outputs, temp_pins, 0);
|
|
|
|
if (ret == 0) {
|
|
k_sem_take(&drv_data->lock, K_FOREVER);
|
|
drv_data->pins_cfg.outputs_state = temp_pins;
|
|
drv_data->pins_cfg.configured_as_outputs = temp_outputs;
|
|
k_sem_give(&drv_data->lock);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* @brief Sets a value to the pins of pcf857x
|
|
*
|
|
* @param dev Pointer to the device structure for the driver instance.
|
|
* @param mask The bit mask which bits should be set
|
|
* @param value The value which should be set
|
|
*
|
|
* @retval 0 If successful.
|
|
* @retval Negative value for error.
|
|
*/
|
|
static int pcf857x_port_set_masked_raw(const struct device *dev, gpio_port_pins_t mask,
|
|
gpio_port_value_t value)
|
|
{
|
|
return pcf857x_port_set_raw(dev, (uint16_t)mask, (uint16_t)value, 0);
|
|
}
|
|
|
|
/**
|
|
* @brief Sets some output pins of the pcf857x
|
|
*
|
|
* @param dev Pointer to the device structure for the driver instance.
|
|
* @param pins The pin(s) which will be set in a range from P17-P10..P07-P00
|
|
*
|
|
* @retval 0 If successful.
|
|
* @retval Negative value for error.
|
|
*/
|
|
static int pcf857x_port_set_bits_raw(const struct device *dev, gpio_port_pins_t pins)
|
|
{
|
|
return pcf857x_port_set_raw(dev, (uint16_t)pins, (uint16_t)pins, 0);
|
|
}
|
|
|
|
/**
|
|
* @brief clear some bits
|
|
*
|
|
* @param dev Pointer to the device structure for the driver instance.
|
|
* @param pins Pins which will be cleared
|
|
*
|
|
* @retval 0 If successful.
|
|
* @retval Negative value for error.
|
|
*/
|
|
static int pcf857x_port_clear_bits_raw(const struct device *dev, gpio_port_pins_t pins)
|
|
{
|
|
return pcf857x_port_set_raw(dev, (uint16_t)pins, 0, 0);
|
|
}
|
|
|
|
/**
|
|
* @brief Toggle some bits
|
|
*
|
|
* @param dev Pointer to the device structure for the driver instance.
|
|
* @param pins Pins which will be toggled
|
|
*
|
|
* @retval 0 If successful.
|
|
* @retval Negative value for error.
|
|
*/
|
|
static int pcf857x_port_toggle_bits(const struct device *dev, gpio_port_pins_t pins)
|
|
{
|
|
return pcf857x_port_set_raw(dev, 0, 0, (uint16_t)pins);
|
|
}
|
|
|
|
/* Each pin gives an interrupt at pcf857x. In this function the configuration is checked. */
|
|
static int pcf857x_pin_interrupt_configure(const struct device *dev, gpio_pin_t pin,
|
|
enum gpio_int_mode mode, enum gpio_int_trig trig)
|
|
{
|
|
const struct pcf857x_drv_cfg *drv_cfg = dev->config;
|
|
|
|
if (!drv_cfg->gpio_int.port) {
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
/* This device supports only edge-triggered interrupts. */
|
|
if (mode == GPIO_INT_MODE_LEVEL) {
|
|
return -ENOTSUP;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/** Register the callback in the callback list */
|
|
static int pcf857x_manage_callback(const struct device *dev, struct gpio_callback *callback,
|
|
bool set)
|
|
{
|
|
struct pcf857x_drv_data *drv_data = dev->data;
|
|
|
|
return gpio_manage_callback(&drv_data->callbacks, callback, set);
|
|
}
|
|
|
|
/** Initialize the pcf857x */
|
|
static int pcf857x_init(const struct device *dev)
|
|
{
|
|
const struct pcf857x_drv_cfg *drv_cfg = dev->config;
|
|
struct pcf857x_drv_data *drv_data = dev->data;
|
|
int rc;
|
|
|
|
if (!device_is_ready(drv_cfg->i2c.bus)) {
|
|
LOG_ERR("%s is not ready", drv_cfg->i2c.bus->name);
|
|
return -ENODEV;
|
|
}
|
|
|
|
/* If the INT line is available, configure the callback for it. */
|
|
if (drv_cfg->gpio_int.port) {
|
|
if (!gpio_is_ready_dt(&drv_cfg->gpio_int)) {
|
|
LOG_ERR("Port is not ready");
|
|
return -ENODEV;
|
|
}
|
|
|
|
rc = gpio_pin_configure_dt(&drv_cfg->gpio_int, GPIO_INPUT);
|
|
if (rc != 0) {
|
|
LOG_ERR("%s: failed to configure INT line: %d", dev->name, rc);
|
|
return -EIO;
|
|
}
|
|
|
|
rc = gpio_pin_interrupt_configure_dt(&drv_cfg->gpio_int, GPIO_INT_EDGE_TO_ACTIVE);
|
|
if (rc != 0) {
|
|
LOG_ERR("%s: failed to configure INT interrupt: %d", dev->name, rc);
|
|
return -EIO;
|
|
}
|
|
|
|
gpio_init_callback(&drv_data->int_gpio_cb, pcf857x_int_gpio_handler,
|
|
BIT(drv_cfg->gpio_int.pin));
|
|
rc = gpio_add_callback(drv_cfg->gpio_int.port, &drv_data->int_gpio_cb);
|
|
if (rc != 0) {
|
|
LOG_ERR("%s: failed to add INT callback: %d", dev->name, rc);
|
|
return -EIO;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/** Realizes the functions of gpio.h for pcf857x*/
|
|
static const struct gpio_driver_api pcf857x_drv_api = {
|
|
.pin_configure = pcf857x_pin_configure,
|
|
.port_get_raw = pcf857x_port_get_raw,
|
|
.port_set_masked_raw = pcf857x_port_set_masked_raw,
|
|
.port_set_bits_raw = pcf857x_port_set_bits_raw,
|
|
.port_clear_bits_raw = pcf857x_port_clear_bits_raw,
|
|
.port_toggle_bits = pcf857x_port_toggle_bits,
|
|
.pin_interrupt_configure = pcf857x_pin_interrupt_configure,
|
|
.manage_callback = pcf857x_manage_callback,
|
|
};
|
|
|
|
#define GPIO_PCF857X_INST(idx) \
|
|
static const struct pcf857x_drv_cfg pcf857x_cfg##idx = { \
|
|
.common = \
|
|
{ \
|
|
.port_pin_mask = GPIO_PORT_PIN_MASK_FROM_DT_INST(idx), \
|
|
}, \
|
|
.gpio_int = GPIO_DT_SPEC_INST_GET_OR(idx, int_gpios, {0}), \
|
|
.i2c = I2C_DT_SPEC_INST_GET(idx), \
|
|
}; \
|
|
static struct pcf857x_drv_data pcf857x_data##idx = { \
|
|
.lock = Z_SEM_INITIALIZER(pcf857x_data##idx.lock, 1, 1), \
|
|
.work = Z_WORK_INITIALIZER(pcf857x_work_handler), \
|
|
.dev = DEVICE_DT_INST_GET(idx), \
|
|
.num_bytes = DT_INST_ENUM_IDX(idx, ngpios) + 1, \
|
|
}; \
|
|
DEVICE_DT_INST_DEFINE(idx, pcf857x_init, NULL, &pcf857x_data##idx, &pcf857x_cfg##idx, \
|
|
POST_KERNEL, CONFIG_GPIO_PCF857X_INIT_PRIORITY, &pcf857x_drv_api);
|
|
|
|
DT_INST_FOREACH_STATUS_OKAY(GPIO_PCF857X_INST);
|