1 // SPDX-License-Identifier: BSD-3-Clause 2 /* 3 * Copyright (c) 2017-2019, STMicroelectronics 4 * 5 * STM32 GPIO driver is used as pin controller for stm32mp SoCs. 6 * The driver API is defined in header file stm32_gpio.h. 7 */ 8 9 #include <assert.h> 10 #include <drivers/stm32_gpio.h> 11 #include <io.h> 12 #include <kernel/dt.h> 13 #include <kernel/generic_boot.h> 14 #include <kernel/panic.h> 15 #include <kernel/spinlock.h> 16 #include <mm/core_memprot.h> 17 #include <stdbool.h> 18 #include <stm32_util.h> 19 #include <trace.h> 20 #include <util.h> 21 22 #ifdef CFG_DT 23 #include <libfdt.h> 24 #endif 25 26 #define GPIO_PIN_MAX 15 27 28 #define GPIO_MODER_OFFSET 0x00 29 #define GPIO_OTYPER_OFFSET 0x04 30 #define GPIO_OSPEEDR_OFFSET 0x08 31 #define GPIO_PUPDR_OFFSET 0x0c 32 #define GPIO_IDR_OFFSET 0x10 33 #define GPIO_ODR_OFFSET 0x14 34 #define GPIO_BSRR_OFFSET 0x18 35 #define GPIO_AFRL_OFFSET 0x20 36 #define GPIO_AFRH_OFFSET 0x24 37 #define GPIO_SECR_OFFSET 0x30 38 39 #define GPIO_ALT_LOWER_LIMIT 0x8 40 41 #define GPIO_MODE_MASK GENMASK_32(1, 0) 42 #define GPIO_OSPEED_MASK GENMASK_32(1, 0) 43 #define GPIO_PUPD_PULL_MASK GENMASK_32(1, 0) 44 #define GPIO_ALTERNATE_MASK GENMASK_32(15, 0) 45 46 #define DT_GPIO_BANK_SHIFT 12 47 #define DT_GPIO_BANK_MASK GENMASK_32(16, 12) 48 #define DT_GPIO_PIN_SHIFT 8 49 #define DT_GPIO_PIN_MASK GENMASK_32(11, 8) 50 #define DT_GPIO_MODE_MASK GENMASK_32(7, 0) 51 52 static unsigned int gpio_lock; 53 54 /* Save to output @cfg the current GPIO (@bank/@pin) configuration */ 55 static void get_gpio_cfg(uint32_t bank, uint32_t pin, struct gpio_cfg *cfg) 56 { 57 vaddr_t base = stm32_get_gpio_bank_base(bank); 58 unsigned int clock = stm32_get_gpio_bank_clock(bank); 59 60 stm32_clock_enable(clock); 61 62 /* 63 * Save GPIO configuration bits spread over the few bank registers. 64 * 1bit fields are accessed at bit position being the pin index. 65 * 2bit fields are accessed at bit position being twice the pin index. 66 * 4bit fields are accessed at bit position being fourth the pin index 67 * but accessed from 2 32bit registers at incremental addresses. 68 */ 69 cfg->mode = (io_read32(base + GPIO_MODER_OFFSET) >> (pin << 1)) & 70 GPIO_MODE_MASK; 71 72 cfg->otype = (io_read32(base + GPIO_OTYPER_OFFSET) >> pin) & 1; 73 74 cfg->ospeed = (io_read32(base + GPIO_OSPEEDR_OFFSET) >> (pin << 1)) & 75 GPIO_OSPEED_MASK; 76 77 cfg->pupd = (io_read32(base + GPIO_PUPDR_OFFSET) >> (pin << 1)) & 78 GPIO_PUPD_PULL_MASK; 79 80 cfg->od = (io_read32(base + GPIO_ODR_OFFSET) >> (pin << 1)) & 1; 81 82 if (pin < GPIO_ALT_LOWER_LIMIT) 83 cfg->af = (io_read32(base + GPIO_AFRL_OFFSET) >> (pin << 2)) & 84 GPIO_ALTERNATE_MASK; 85 else 86 cfg->af = (io_read32(base + GPIO_AFRH_OFFSET) >> 87 ((pin - GPIO_ALT_LOWER_LIMIT) << 2)) & 88 GPIO_ALTERNATE_MASK; 89 90 stm32_clock_disable(clock); 91 } 92 93 /* Apply GPIO (@bank/@pin) configuration described by @cfg */ 94 static void set_gpio_cfg(uint32_t bank, uint32_t pin, struct gpio_cfg *cfg) 95 { 96 vaddr_t base = stm32_get_gpio_bank_base(bank); 97 unsigned int clock = stm32_get_gpio_bank_clock(bank); 98 uint32_t excep = cpu_spin_lock_xsave(&gpio_lock); 99 100 stm32_clock_enable(clock); 101 102 /* Load GPIO MODE value, 2bit value shifted by twice the pin number */ 103 io_clrsetbits32(base + GPIO_MODER_OFFSET, 104 GPIO_MODE_MASK << (pin << 1), 105 cfg->mode << (pin << 1)); 106 107 /* Load GPIO Output TYPE value, 1bit shifted by pin number value */ 108 io_clrsetbits32(base + GPIO_OTYPER_OFFSET, BIT(pin), cfg->otype << pin); 109 110 /* Load GPIO Output Speed confguration, 2bit value */ 111 io_clrsetbits32(base + GPIO_OSPEEDR_OFFSET, 112 GPIO_OSPEED_MASK << (pin << 1), 113 cfg->ospeed << (pin << 1)); 114 115 /* Load GPIO pull configuration, 2bit value */ 116 io_clrsetbits32(base + GPIO_PUPDR_OFFSET, BIT(pin), 117 cfg->pupd << (pin << 1)); 118 119 /* Load pin mux Alternate Function configuration, 4bit value */ 120 if (pin < GPIO_ALT_LOWER_LIMIT) { 121 io_clrsetbits32(base + GPIO_AFRL_OFFSET, 122 GPIO_ALTERNATE_MASK << (pin << 2), 123 cfg->af << (pin << 2)); 124 } else { 125 size_t shift = (pin - GPIO_ALT_LOWER_LIMIT) << 2; 126 127 io_clrsetbits32(base + GPIO_AFRH_OFFSET, 128 GPIO_ALTERNATE_MASK << shift, 129 cfg->af << shift); 130 } 131 132 /* Load GPIO Output direction confuguration, 1bit */ 133 io_clrsetbits32(base + GPIO_ODR_OFFSET, BIT(pin), cfg->od << pin); 134 135 stm32_clock_disable(clock); 136 cpu_spin_unlock_xrestore(&gpio_lock, excep); 137 } 138 139 void stm32_pinctrl_load_active_cfg(struct stm32_pinctrl *pinctrl, size_t cnt) 140 { 141 size_t n; 142 143 for (n = 0; n < cnt; n++) 144 set_gpio_cfg(pinctrl[n].bank, pinctrl[n].pin, 145 &pinctrl[n].active_cfg); 146 } 147 148 void stm32_pinctrl_load_standby_cfg(struct stm32_pinctrl *pinctrl, size_t cnt) 149 { 150 size_t n; 151 152 for (n = 0; n < cnt; n++) 153 set_gpio_cfg(pinctrl[n].bank, pinctrl[n].pin, 154 &pinctrl[n].standby_cfg); 155 } 156 157 void stm32_pinctrl_store_standby_cfg(struct stm32_pinctrl *pinctrl, size_t cnt) 158 { 159 size_t n; 160 161 for (n = 0; n < cnt; n++) 162 get_gpio_cfg(pinctrl[n].bank, pinctrl[n].pin, 163 &pinctrl[n].standby_cfg); 164 } 165 166 #ifdef CFG_DT 167 /* Return GPIO bank node if valid and a negative libfdt error othewise */ 168 static void ckeck_gpio_bank(void *fdt, uint32_t bank, int pinctrl_node) 169 { 170 int pinctrl_subnode; 171 172 fdt_for_each_subnode(pinctrl_subnode, fdt, pinctrl_node) { 173 const fdt32_t *cuint; 174 175 if (fdt_getprop(fdt, pinctrl_subnode, 176 "gpio-controller", NULL) == NULL) 177 continue; 178 179 /* Check bank register offset matches platform assumptions */ 180 cuint = fdt_getprop(fdt, pinctrl_subnode, "reg", NULL); 181 if (!cuint) 182 panic(); 183 if (fdt32_to_cpu(*cuint) != stm32_get_gpio_bank_offset(bank)) 184 panic(); 185 186 /* Check bank clock matches platform assumptions */ 187 cuint = fdt_getprop(fdt, pinctrl_subnode, "clocks", NULL); 188 if (!cuint) 189 panic(); 190 cuint++; 191 if (fdt32_to_cpu(*cuint) != stm32_get_gpio_bank_clock(bank)) 192 panic(); 193 194 /* Check controller is enabled */ 195 if (_fdt_get_status(fdt, pinctrl_subnode) == DT_STATUS_DISABLED) 196 panic(); 197 198 return; 199 } 200 201 panic(); 202 } 203 204 /* Count pins described in the DT node and get related data if possible */ 205 static int get_pinctrl_from_fdt(void *fdt, int node, 206 struct stm32_pinctrl *pinctrl, size_t count) 207 { 208 const fdt32_t *cuint, *slewrate; 209 int len; 210 int pinctrl_node; 211 uint32_t i; 212 uint32_t speed = GPIO_OSPEED_LOW; 213 uint32_t pull = GPIO_PUPD_NO_PULL; 214 size_t found = 0; 215 216 cuint = fdt_getprop(fdt, node, "pinmux", &len); 217 if (!cuint) 218 return -FDT_ERR_NOTFOUND; 219 220 pinctrl_node = fdt_parent_offset(fdt, fdt_parent_offset(fdt, node)); 221 if (pinctrl_node < 0) 222 return -FDT_ERR_NOTFOUND; 223 224 slewrate = fdt_getprop(fdt, node, "slew-rate", NULL); 225 if (slewrate) 226 speed = fdt32_to_cpu(*slewrate); 227 228 if (fdt_getprop(fdt, node, "bias-pull-up", NULL)) 229 pull = GPIO_PUPD_PULL_UP; 230 if (fdt_getprop(fdt, node, "bias-pull-down", NULL)) 231 pull = GPIO_PUPD_PULL_DOWN; 232 233 for (i = 0; i < ((uint32_t)len / sizeof(uint32_t)); i++) { 234 uint32_t pincfg; 235 uint32_t bank; 236 uint32_t pin; 237 uint32_t mode; 238 uint32_t alternate = 0; 239 bool opendrain = false; 240 241 pincfg = fdt32_to_cpu(*cuint); 242 cuint++; 243 244 bank = (pincfg & DT_GPIO_BANK_MASK) >> DT_GPIO_BANK_SHIFT; 245 246 pin = (pincfg & DT_GPIO_PIN_MASK) >> DT_GPIO_PIN_SHIFT; 247 248 mode = pincfg & DT_GPIO_MODE_MASK; 249 250 switch (mode) { 251 case 0: 252 mode = GPIO_MODE_INPUT; 253 break; 254 case 1: 255 case 2: 256 case 3: 257 case 4: 258 case 5: 259 case 6: 260 case 7: 261 case 8: 262 case 9: 263 case 10: 264 case 11: 265 case 12: 266 case 13: 267 case 14: 268 case 15: 269 case 16: 270 alternate = mode - 1U; 271 mode = GPIO_MODE_ALTERNATE; 272 break; 273 case 17: 274 mode = GPIO_MODE_ANALOG; 275 break; 276 default: 277 mode = GPIO_MODE_OUTPUT; 278 break; 279 } 280 281 if (fdt_getprop(fdt, node, "drive-open-drain", NULL)) 282 opendrain = true; 283 284 /* Check GPIO bank clock/base address against platform */ 285 ckeck_gpio_bank(fdt, bank, pinctrl_node); 286 287 if (found < count) { 288 struct stm32_pinctrl *ref = &pinctrl[found]; 289 290 ref->bank = (uint8_t)bank; 291 ref->pin = (uint8_t)pin; 292 ref->active_cfg.mode = mode; 293 ref->active_cfg.otype = opendrain ? 1 : 0; 294 ref->active_cfg.ospeed = speed; 295 ref->active_cfg.pupd = pull; 296 ref->active_cfg.od = 0; 297 ref->active_cfg.af = alternate; 298 /* Default to analog mode for standby state */ 299 ref->standby_cfg.mode = GPIO_MODE_ANALOG; 300 ref->standby_cfg.pupd = GPIO_PUPD_NO_PULL; 301 } 302 303 found++; 304 } 305 306 return (int)found; 307 } 308 309 int stm32_pinctrl_fdt_get_pinctrl(void *fdt, int device_node, 310 struct stm32_pinctrl *pinctrl, size_t count) 311 { 312 const fdt32_t *cuint; 313 int lenp; 314 int i; 315 size_t found = 0; 316 317 cuint = fdt_getprop(fdt, device_node, "pinctrl-0", &lenp); 318 if (!cuint) 319 return -FDT_ERR_NOTFOUND; 320 321 for (i = 0; i < (lenp / 4); i++) { 322 int node; 323 int subnode; 324 325 node = fdt_node_offset_by_phandle(fdt, fdt32_to_cpu(*cuint)); 326 if (node < 0) 327 return -FDT_ERR_NOTFOUND; 328 329 fdt_for_each_subnode(subnode, fdt, node) { 330 size_t n; 331 int rc; 332 333 if (count > found) 334 n = count - found; 335 else 336 n = 0; 337 338 rc = get_pinctrl_from_fdt(fdt, subnode, 339 &pinctrl[found], n); 340 if (rc < 0) 341 return rc; 342 343 found += (size_t)rc; 344 } 345 346 cuint++; 347 } 348 349 return (int)found; 350 } 351 #endif /*CFG_DT*/ 352 353 static __maybe_unused bool valid_gpio_config(unsigned int bank, 354 unsigned int pin, bool input) 355 { 356 vaddr_t base = stm32_get_gpio_bank_base(bank); 357 uint32_t mode = (io_read32(base + GPIO_MODER_OFFSET) >> (pin << 1)) & 358 GPIO_MODE_MASK; 359 360 if (pin > GPIO_PIN_MAX) 361 return false; 362 363 if (input) 364 return mode == GPIO_MODE_INPUT; 365 else 366 return mode == GPIO_MODE_OUTPUT; 367 } 368 369 int stm32_gpio_get_input_level(unsigned int bank, unsigned int pin) 370 { 371 vaddr_t base = stm32_get_gpio_bank_base(bank); 372 unsigned int clock = stm32_get_gpio_bank_clock(bank); 373 int rc = 0; 374 375 assert(valid_gpio_config(bank, pin, true)); 376 377 stm32_clock_enable(clock); 378 379 if (io_read32(base + GPIO_IDR_OFFSET) == BIT(pin)) 380 rc = 1; 381 382 stm32_clock_disable(clock); 383 384 return rc; 385 } 386 387 void stm32_gpio_set_output_level(unsigned int bank, unsigned int pin, int level) 388 { 389 vaddr_t base = stm32_get_gpio_bank_base(bank); 390 unsigned int clock = stm32_get_gpio_bank_clock(bank); 391 392 assert(valid_gpio_config(bank, pin, false)); 393 394 stm32_clock_enable(clock); 395 396 if (level) 397 io_write32(base + GPIO_BSRR_OFFSET, BIT(pin)); 398 else 399 io_write32(base + GPIO_BSRR_OFFSET, BIT(pin + 16)); 400 401 stm32_clock_disable(clock); 402 } 403 404 void stm32_gpio_set_secure_cfg(unsigned int bank, unsigned int pin, bool secure) 405 { 406 vaddr_t base = stm32_get_gpio_bank_base(bank); 407 unsigned int clock = stm32_get_gpio_bank_clock(bank); 408 uint32_t excep = cpu_spin_lock_xsave(&gpio_lock); 409 410 stm32_clock_enable(clock); 411 412 if (secure) 413 io_setbits32(base + GPIO_SECR_OFFSET, BIT(pin)); 414 else 415 io_clrbits32(base + GPIO_SECR_OFFSET, BIT(pin)); 416 417 stm32_clock_disable(clock); 418 cpu_spin_unlock_xrestore(&gpio_lock, excep); 419 } 420