1 /*
2 * Copyright (c) 2024 Junho Lee <junho@tsnlab.com>
3 *
4 * SPDX-License-Identifier: Apache-2.0
5 */
6
7 #define DT_DRV_COMPAT brcm_brcmstb_gpio
8
9 #include <zephyr/arch/common/sys_bitops.h>
10 #include <zephyr/arch/cpu.h>
11 #include <zephyr/device.h>
12 #include <zephyr/drivers/gpio.h>
13 #include <zephyr/drivers/gpio/gpio_utils.h>
14
15 #define GIO_DATA 0x04
16 #define GIO_IODIR 0x08
17
18 #define DEV_CFG(dev) ((const struct gpio_brcmstb_config *)(dev)->config)
19 #define DEV_DATA(dev) ((struct gpio_brcmstb_data *)(dev)->data)
20
21 struct gpio_brcmstb_config {
22 struct gpio_driver_config common;
23
24 DEVICE_MMIO_NAMED_ROM(reg_base);
25 mem_addr_t offset;
26 };
27
28 struct gpio_brcmstb_data {
29 struct gpio_driver_data common;
30
31 DEVICE_MMIO_NAMED_RAM(reg_base);
32 mem_addr_t base;
33 };
34
gpio_brcmstb_pin_configure(const struct device * port,gpio_pin_t pin,gpio_flags_t flags)35 static int gpio_brcmstb_pin_configure(const struct device *port, gpio_pin_t pin, gpio_flags_t flags)
36 {
37 struct gpio_brcmstb_data *data = port->data;
38
39 if (flags & (GPIO_SINGLE_ENDED | GPIO_PULL_UP | GPIO_PULL_DOWN)) {
40 return -ENOTSUP;
41 }
42
43 if (flags & GPIO_INPUT) {
44 sys_set_bit(data->base + GIO_IODIR, pin);
45 } else if (flags & GPIO_OUTPUT) {
46 sys_clear_bit(data->base + GIO_IODIR, pin);
47
48 if (flags & GPIO_OUTPUT_INIT_HIGH) {
49 sys_set_bit(data->base + GIO_DATA, pin);
50 } else if (flags & GPIO_OUTPUT_INIT_LOW) {
51 sys_clear_bit(data->base + GIO_DATA, pin);
52 }
53 }
54
55 return 0;
56 }
57
gpio_brcmstb_port_get_raw(const struct device * port,gpio_port_value_t * value)58 static int gpio_brcmstb_port_get_raw(const struct device *port, gpio_port_value_t *value)
59 {
60 struct gpio_brcmstb_data *data = port->data;
61
62 *value = sys_read32(data->base + GIO_DATA);
63
64 return 0;
65 }
66
gpio_brcmstb_port_set_masked_raw(const struct device * port,gpio_port_pins_t mask,gpio_port_value_t value)67 static int gpio_brcmstb_port_set_masked_raw(const struct device *port, gpio_port_pins_t mask,
68 gpio_port_value_t value)
69 {
70 struct gpio_brcmstb_data *data = port->data;
71
72 sys_clear_bits(data->base + GIO_DATA, mask);
73 sys_set_bits(data->base + GIO_DATA, (value & mask));
74
75 return 0;
76 }
77
gpio_brcmstb_port_set_bits_raw(const struct device * port,gpio_port_pins_t pins)78 static int gpio_brcmstb_port_set_bits_raw(const struct device *port, gpio_port_pins_t pins)
79 {
80 struct gpio_brcmstb_data *data = port->data;
81
82 sys_set_bits(data->base + GIO_DATA, pins);
83
84 return 0;
85 }
86
gpio_brcmstb_port_clear_bits_raw(const struct device * port,gpio_port_pins_t pins)87 static int gpio_brcmstb_port_clear_bits_raw(const struct device *port, gpio_port_pins_t pins)
88 {
89 struct gpio_brcmstb_data *data = port->data;
90
91 sys_clear_bits(data->base + GIO_DATA, pins);
92
93 return 0;
94 }
95
gpio_brcmstb_port_toggle_bits(const struct device * port,gpio_port_pins_t pins)96 static int gpio_brcmstb_port_toggle_bits(const struct device *port, gpio_port_pins_t pins)
97 {
98 struct gpio_brcmstb_data *data = port->data;
99 uint32_t reg_data;
100
101 reg_data = sys_read32(data->base + GIO_DATA);
102 reg_data ^= pins;
103 sys_write32(reg_data, data->base + GIO_DATA);
104
105 return 0;
106 }
107
108 static DEVICE_API(gpio, gpio_brcmstb_api) = {
109 .pin_configure = gpio_brcmstb_pin_configure,
110 .port_get_raw = gpio_brcmstb_port_get_raw,
111 .port_set_masked_raw = gpio_brcmstb_port_set_masked_raw,
112 .port_set_bits_raw = gpio_brcmstb_port_set_bits_raw,
113 .port_clear_bits_raw = gpio_brcmstb_port_clear_bits_raw,
114 .port_toggle_bits = gpio_brcmstb_port_toggle_bits,
115 };
116
gpio_brcmstb_init(const struct device * port)117 int gpio_brcmstb_init(const struct device *port)
118 {
119 const struct gpio_brcmstb_config *config = port->config;
120 struct gpio_brcmstb_data *data = port->data;
121
122 DEVICE_MMIO_NAMED_MAP(port, reg_base, K_MEM_CACHE_NONE);
123 data->base = DEVICE_MMIO_NAMED_GET(port, reg_base) + config->offset;
124
125 return 0;
126 }
127
128 #define GPIO_BRCMSTB_INIT(n) \
129 static struct gpio_brcmstb_data gpio_brcmstb_data_##n; \
130 \
131 static const struct gpio_brcmstb_config gpio_brcmstb_cfg_##n = { \
132 .common = {.port_pin_mask = GPIO_PORT_PIN_MASK_FROM_DT_INST(0)}, \
133 DEVICE_MMIO_NAMED_ROM_INIT(reg_base, DT_INST_PARENT(n)), \
134 .offset = DT_INST_REG_ADDR(n), \
135 }; \
136 \
137 DEVICE_DT_INST_DEFINE(n, gpio_brcmstb_init, NULL, &gpio_brcmstb_data_##n, \
138 &gpio_brcmstb_cfg_##n, PRE_KERNEL_1, CONFIG_GPIO_INIT_PRIORITY, \
139 &gpio_brcmstb_api);
140
141 DT_INST_FOREACH_STATUS_OKAY(GPIO_BRCMSTB_INIT)
142
