Browse Source
Add GPIO driver for brcmstb, required by Raspberry Pi 5. Signed-off-by: Junho Lee <junho@tsnlab.com>pull/72015/head
5 changed files with 172 additions and 0 deletions
@ -0,0 +1,9 @@
@@ -0,0 +1,9 @@
|
||||
# Copyright (c) 2024 Junho Lee <junho@tsnlab.com> |
||||
# SPDX-License-Identifier: Apache-2.0 |
||||
|
||||
config GPIO_BRCMSTB |
||||
bool "Broadcom Set-top box SoC GPIO Driver" |
||||
default y |
||||
depends on DT_HAS_BRCM_BRCMSTB_GPIO_ENABLED |
||||
help |
||||
Enable Driver for Broadcom Set-top box SoC GPIO Banks. |
@ -0,0 +1,141 @@
@@ -0,0 +1,141 @@
|
||||
/*
|
||||
* Copyright (c) 2024 Junho Lee <junho@tsnlab.com> |
||||
* |
||||
* SPDX-License-Identifier: Apache-2.0 |
||||
*/ |
||||
|
||||
#define DT_DRV_COMPAT brcm_brcmstb_gpio |
||||
|
||||
#include <zephyr/arch/common/sys_bitops.h> |
||||
#include <zephyr/arch/cpu.h> |
||||
#include <zephyr/device.h> |
||||
#include <zephyr/drivers/gpio.h> |
||||
#include <zephyr/drivers/gpio/gpio_utils.h> |
||||
|
||||
#define GIO_DATA 0x04 |
||||
#define GIO_IODIR 0x08 |
||||
|
||||
#define DEV_CFG(dev) ((const struct gpio_brcmstb_config *)(dev)->config) |
||||
#define DEV_DATA(dev) ((struct gpio_brcmstb_data *)(dev)->data) |
||||
|
||||
struct gpio_brcmstb_config { |
||||
struct gpio_driver_config common; |
||||
|
||||
DEVICE_MMIO_NAMED_ROM(reg_base); |
||||
mem_addr_t offset; |
||||
}; |
||||
|
||||
struct gpio_brcmstb_data { |
||||
struct gpio_driver_data common; |
||||
|
||||
DEVICE_MMIO_NAMED_RAM(reg_base); |
||||
mem_addr_t base; |
||||
}; |
||||
|
||||
static int gpio_brcmstb_pin_configure(const struct device *port, gpio_pin_t pin, gpio_flags_t flags) |
||||
{ |
||||
struct gpio_brcmstb_data *data = port->data; |
||||
|
||||
if (flags & (GPIO_SINGLE_ENDED | GPIO_PULL_UP | GPIO_PULL_DOWN)) { |
||||
return -ENOTSUP; |
||||
} |
||||
|
||||
if (flags & GPIO_INPUT) { |
||||
sys_set_bit(data->base + GIO_IODIR, pin); |
||||
} else if (flags & GPIO_OUTPUT) { |
||||
sys_clear_bit(data->base + GIO_IODIR, pin); |
||||
|
||||
if (flags & GPIO_OUTPUT_INIT_HIGH) { |
||||
sys_set_bit(data->base + GIO_DATA, pin); |
||||
} else if (flags & GPIO_OUTPUT_INIT_LOW) { |
||||
sys_clear_bit(data->base + GIO_DATA, pin); |
||||
} |
||||
} |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int gpio_brcmstb_port_get_raw(const struct device *port, gpio_port_value_t *value) |
||||
{ |
||||
struct gpio_brcmstb_data *data = port->data; |
||||
|
||||
*value = sys_read32(data->base + GIO_DATA); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int gpio_brcmstb_port_set_masked_raw(const struct device *port, gpio_port_pins_t mask, |
||||
gpio_port_value_t value) |
||||
{ |
||||
struct gpio_brcmstb_data *data = port->data; |
||||
|
||||
sys_clear_bits(data->base + GIO_DATA, mask); |
||||
sys_set_bits(data->base + GIO_DATA, (value & mask)); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int gpio_brcmstb_port_set_bits_raw(const struct device *port, gpio_port_pins_t pins) |
||||
{ |
||||
struct gpio_brcmstb_data *data = port->data; |
||||
|
||||
sys_set_bits(data->base + GIO_DATA, pins); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int gpio_brcmstb_port_clear_bits_raw(const struct device *port, gpio_port_pins_t pins) |
||||
{ |
||||
struct gpio_brcmstb_data *data = port->data; |
||||
|
||||
sys_clear_bits(data->base + GIO_DATA, pins); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static int gpio_brcmstb_port_toggle_bits(const struct device *port, gpio_port_pins_t pins) |
||||
{ |
||||
struct gpio_brcmstb_data *data = port->data; |
||||
uint32_t reg_data; |
||||
|
||||
reg_data = sys_read32(data->base + GIO_DATA); |
||||
reg_data ^= pins; |
||||
sys_write32(reg_data, data->base + GIO_DATA); |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
static const struct gpio_driver_api gpio_brcmstb_api = { |
||||
.pin_configure = gpio_brcmstb_pin_configure, |
||||
.port_get_raw = gpio_brcmstb_port_get_raw, |
||||
.port_set_masked_raw = gpio_brcmstb_port_set_masked_raw, |
||||
.port_set_bits_raw = gpio_brcmstb_port_set_bits_raw, |
||||
.port_clear_bits_raw = gpio_brcmstb_port_clear_bits_raw, |
||||
.port_toggle_bits = gpio_brcmstb_port_toggle_bits, |
||||
}; |
||||
|
||||
int gpio_brcmstb_init(const struct device *port) |
||||
{ |
||||
const struct gpio_brcmstb_config *config = port->config; |
||||
struct gpio_brcmstb_data *data = port->data; |
||||
|
||||
DEVICE_MMIO_NAMED_MAP(port, reg_base, K_MEM_CACHE_NONE); |
||||
data->base = DEVICE_MMIO_NAMED_GET(port, reg_base) + config->offset; |
||||
|
||||
return 0; |
||||
} |
||||
|
||||
#define GPIO_BRCMSTB_INIT(n) \ |
||||
static struct gpio_brcmstb_data gpio_brcmstb_data_##n; \ |
||||
\ |
||||
static const struct gpio_brcmstb_config gpio_brcmstb_cfg_##n = { \ |
||||
.common = {.port_pin_mask = GPIO_PORT_PIN_MASK_FROM_DT_INST(0)}, \ |
||||
DEVICE_MMIO_NAMED_ROM_INIT(reg_base, DT_INST_PARENT(n)), \ |
||||
.offset = DT_INST_REG_ADDR(n), \ |
||||
}; \ |
||||
\ |
||||
DEVICE_DT_INST_DEFINE(n, gpio_brcmstb_init, NULL, &gpio_brcmstb_data_##n, \ |
||||
&gpio_brcmstb_cfg_##n, PRE_KERNEL_1, CONFIG_GPIO_INIT_PRIORITY, \ |
||||
&gpio_brcmstb_api); |
||||
|
||||
DT_INST_FOREACH_STATUS_OKAY(GPIO_BRCMSTB_INIT) |
@ -0,0 +1,19 @@
@@ -0,0 +1,19 @@
|
||||
# Copyright (c) 2024 Junho Lee <junho@tsnlab.com> |
||||
# SPDX-License-Identifier: Apache-2.0 |
||||
|
||||
description: BRCMSTB GPIO |
||||
|
||||
compatible: "brcm,brcmstb-gpio" |
||||
|
||||
include: [gpio-controller.yaml, base.yaml] |
||||
|
||||
properties: |
||||
reg: |
||||
required: true |
||||
|
||||
"#gpio-cells": |
||||
const: 2 |
||||
|
||||
gpio-cells: |
||||
- pin |
||||
- flags |
Loading…
Reference in new issue