kempld_gpio.c

Go to the documentation of this file.

/* SPDX-License-Identifier: GPL-2.0-only */
 
#include <stdint.h>
#include <arch/io.h>
 
#include "chip.h"
#include "kempld.h"
#include "kempld_internal.h"
 
enum kempld_gpio_direction {
        KEMPLD_GPIO_DIR_IN  = 0,
        KEMPLD_GPIO_DIR_OUT = 1
};
 
static void kempld_gpio_value_set(u8 pin_num, u8 value)
{
        const u8 mask = KEMPLD_GPIO_MASK(pin_num);
        u8 reg_val = kempld_read8(KEMPLD_GPIO_LVL(pin_num));
        reg_val = value ? reg_val | mask : reg_val & ~mask;
        kempld_write8(KEMPLD_GPIO_LVL(pin_num), reg_val);
}
 
static void kempld_gpio_direction_set(u8 pin_num, enum kempld_gpio_direction dir)
{
        const u8 mask = KEMPLD_GPIO_MASK(pin_num);
        u8 reg_val = kempld_read8(KEMPLD_GPIO_DIR(pin_num));
        reg_val = dir == KEMPLD_GPIO_DIR_OUT ? reg_val | mask : reg_val & ~mask;
        kempld_write8(KEMPLD_GPIO_DIR(pin_num), reg_val);
}
 
static int kempld_configure_gpio(u8 pin_num, enum kempld_gpio_mode mode)
{
        if (kempld_get_mutex(100) < 0)
                return -1;
 
        switch (mode) {
        case KEMPLD_GPIO_DEFAULT:
                break;
 
        case KEMPLD_GPIO_INPUT:
                kempld_gpio_direction_set(pin_num, KEMPLD_GPIO_DIR_IN);
                break;
 
        case KEMPLD_GPIO_OUTPUT_LOW:
                kempld_gpio_value_set(pin_num, 0);
                kempld_gpio_direction_set(pin_num, KEMPLD_GPIO_DIR_OUT);
                break;
 
        case KEMPLD_GPIO_OUTPUT_HIGH:
                kempld_gpio_value_set(pin_num, 1);
                kempld_gpio_direction_set(pin_num, KEMPLD_GPIO_DIR_OUT);
                break;
        }
 
        kempld_release_mutex();
        return 0;
}
 
int kempld_gpio_pads_config(struct device *dev)
{
        const struct ec_kontron_kempld_config *config = dev->chip_info;
 
        if (!config)
                return -1;
 
        for (u8 i = 0; i < KEMPLD_NUM_GPIOS; ++i) {
                if (kempld_configure_gpio(i, config->gpio[i]) < 0)
                        return -1;
        }
        return 0;
}