gpio.c

Go to the documentation of this file.

/* SPDX-License-Identifier: GPL-2.0-only */
 
#include <device/mmio.h>
#include <gpio.h>
#include <assert.h>
 
static void *gpio_find_reg_addr(gpio_t gpio)
{
        void *reg_addr;
        switch (gpio.base & 0x0f) {
        case 0:
                reg_addr = (void *)IOCFG_RM_BASE;
                break;
        case 1:
                reg_addr = (void *)IOCFG_BM_BASE;
                break;
        case 2:
                reg_addr = (void *)IOCFG_BL_BASE;
                break;
        case 3:
                reg_addr = (void *)IOCFG_BR_BASE;
                break;
        case 4:
                reg_addr = (void *)IOCFG_LM_BASE;
                break;
        case 5:
                reg_addr = (void *)IOCFG_LB_BASE;
                break;
        case 6:
                reg_addr = (void *)IOCFG_RT_BASE;
                break;
        case 7:
                reg_addr = (void *)IOCFG_LT_BASE;
                break;
        case 8:
                reg_addr = (void *)IOCFG_TL_BASE;
                break;
        default:
                reg_addr = NULL;
                break;
        }
 
        return reg_addr;
}
 
static void gpio_set_spec_pull_pupd(gpio_t gpio, enum pull_enable enable,
                                    enum pull_select select)
{
        void *reg1;
        void *reg2;
        int bit = gpio.bit;
 
        reg1 = gpio_find_reg_addr(gpio) + gpio.offset;
        reg2 = reg1 + (gpio.base & 0xf0);
 
        if (enable == GPIO_PULL_ENABLE) {
                if (select == GPIO_PULL_DOWN)
                        setbits32(reg1, 1 << bit);
                else
                        clrbits32(reg1, 1 << bit);
        }
 
        if (enable == GPIO_PULL_ENABLE)
                setbits32(reg2, 1 << bit);
        else {
                clrbits32(reg2, 1 << bit);
                clrbits32(reg2 + 0x010, 1 << bit);
        }
}
 
static void gpio_set_pull_pu_pd(gpio_t gpio, enum pull_enable enable,
                                enum pull_select select)
{
        void *reg1;
        void *reg2;
        int bit = gpio.bit;
 
        reg1 = gpio_find_reg_addr(gpio) + gpio.offset;
        reg2 = reg1 - (gpio.base & 0xf0);
 
        if (enable == GPIO_PULL_ENABLE) {
                if (select == GPIO_PULL_DOWN) {
                        clrbits32(reg1, 1 << bit);
                        setbits32(reg2, 1 << bit);
                } else {
                        clrbits32(reg2, 1 << bit);
                        setbits32(reg1, 1 << bit);
                }
        } else {
                clrbits32(reg1, 1 << bit);
                clrbits32(reg2, 1 << bit);
        }
}
 
void gpio_set_pull(gpio_t gpio, enum pull_enable enable,
                   enum pull_select select)
{
        if (gpio.flag)
                gpio_set_spec_pull_pupd(gpio, enable, select);
        else
                gpio_set_pull_pu_pd(gpio, enable, select);
}