soc/mediatek: Move some gpio functions to common/gpio_op.c

gpio_set_pull(), gpio_set_pull_pu_pd() and gpio_set_spec_pull_pupd()
can be reused for mt8192, mt8195 and mt8186, so move it to new file
"gpio_op.c" in common folder.

TEST=build pass
BUG=b:233720142

Signed-off-by: Bo-Chen Chen <rex-bc.chen@mediatek.com>
Change-Id: I81ab9b01ee20fccf3ef29c5902597b5045d3e36a
Reviewed-on: https://review.coreboot.org/c/coreboot/+/65641
Reviewed-by: Yu-Ping Wu <yupingso@google.com>
Reviewed-by: Yidi Lin <yidilin@chromium.org>
Tested-by: build bot (Jenkins) <no-reply@coreboot.org>
This commit is contained in:
Rex-BC Chen 2022-07-04 20:53:51 +08:00 committed by Felix Held
parent 7912da87b1
commit b4c5aed0a6
8 changed files with 69 additions and 180 deletions

View File

@ -0,0 +1,62 @@
/* SPDX-License-Identifier: GPL-2.0-only */
#include <device/mmio.h>
#include <gpio.h>
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, BIT(bit));
else
clrbits32(reg1, BIT(bit));
}
if (enable == GPIO_PULL_ENABLE) {
setbits32(reg2, BIT(bit));
} else {
clrbits32(reg2, BIT(bit));
clrbits32(reg2 + 0x010, BIT(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, BIT(bit));
setbits32(reg2, BIT(bit));
} else {
clrbits32(reg2, BIT(bit));
setbits32(reg1, BIT(bit));
}
} else {
clrbits32(reg1, BIT(bit));
clrbits32(reg2, BIT(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);
}

View File

@ -42,6 +42,7 @@ struct gpio_drv_info {
void gpio_set_pull(gpio_t gpio, enum pull_enable enable,
enum pull_select select);
void gpio_set_mode(gpio_t gpio, int mode);
void *gpio_find_reg_addr(gpio_t gpio);
/* Normal driving function */
int gpio_set_driving(gpio_t gpio, uint8_t drv);

View File

@ -2,7 +2,7 @@ ifeq ($(CONFIG_SOC_MEDIATEK_MT8186),y)
# for bootblock, verstage, romstage, ramstage
all-y += ../common/flash_controller.c
all-y += ../common/gpio.c gpio.c
all-y += ../common/gpio.c ../common/gpio_op.c gpio.c
all-y += ../common/i2c.c i2c.c
all-$(CONFIG_SPI_FLASH) += ../common/spi.c spi.c
all-y += ../common/timer.c ../common/timer_prepare.c

View File

@ -223,7 +223,7 @@ static const struct gpio_drv_info gpio_driving_adv_info[GPIO_NUM] = {
[146] = { 0x20, 15, 3, },
};
static void *gpio_find_reg_addr(gpio_t gpio)
void *gpio_find_reg_addr(gpio_t gpio)
{
void *reg_addr;
switch (gpio.base & 0x0f) {
@ -253,64 +253,6 @@ static void *gpio_find_reg_addr(gpio_t gpio)
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, BIT(bit));
else
clrbits32(reg1, BIT(bit));
}
if (enable == GPIO_PULL_ENABLE) {
setbits32(reg2, 1 << bit);
} else {
clrbits32(reg2, 1 << bit);
clrbits32(reg2 + 0x010, BIT(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, BIT(bit));
setbits32(reg2, BIT(bit));
} else {
clrbits32(reg2, BIT(bit));
setbits32(reg1, BIT(bit));
}
} else {
clrbits32(reg1, BIT(bit));
clrbits32(reg2, BIT(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);
}
static inline bool is_valid_drv(uint8_t drv)
{
return drv <= GPIO_DRV_16_MA;

View File

@ -2,7 +2,7 @@ ifeq ($(CONFIG_SOC_MEDIATEK_MT8192),y)
# for bootblock, verstage, romstage, ramstage
all-y += ../common/flash_controller.c
all-y += ../common/gpio.c gpio.c
all-y += ../common/gpio.c ../common/gpio_op.c gpio.c
all-y += ../common/i2c.c i2c.c
all-$(CONFIG_SPI_FLASH) += ../common/spi.c spi.c
all-y += ../common/timer.c

View File

@ -4,7 +4,7 @@
#include <gpio.h>
#include <assert.h>
static void *gpio_find_reg_addr(gpio_t gpio)
void *gpio_find_reg_addr(gpio_t gpio)
{
void *reg_addr;
switch (gpio.base & 0x0f) {
@ -42,61 +42,3 @@ static void *gpio_find_reg_addr(gpio_t gpio)
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);
}

View File

@ -2,7 +2,7 @@ ifeq ($(CONFIG_SOC_MEDIATEK_MT8195),y)
# for bootblock, verstage, romstage, ramstage
all-y += ../common/flash_controller.c
all-y += ../common/gpio.c gpio.c
all-y += ../common/gpio.c ../common/gpio_op.c gpio.c
all-y += ../common/i2c.c i2c.c
all-$(CONFIG_SPI_FLASH) += ../common/spi.c spi.c
all-y += ../common/timer.c ../common/timer_prepare.c

View File

@ -3,7 +3,7 @@
#include <device/mmio.h>
#include <gpio.h>
static void *gpio_find_reg_addr(gpio_t gpio)
void *gpio_find_reg_addr(gpio_t gpio)
{
void *reg_addr;
switch (gpio.base & 0x0f) {
@ -32,61 +32,3 @@ static void *gpio_find_reg_addr(gpio_t gpio)
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);
}