| 1 | |
| 2 | |
| 3 | * GPIO driver for AMD
|
| 4 | *
|
| 5 | * Copyright (c) 2014,2015 AMD Corporation.
|
| 6 | * Authors: Ken Xue <[email protected]>
|
| 7 | * Wu, Jeff <[email protected]>
|
| 8 | *
|
| 9 |
|
| 10 |
|
| 11 | #include <linux/err.h>
|
| 12 | #include <linux/bug.h>
|
| 13 | #include <linux/kernel.h>
|
| 14 | #include <linux/module.h>
|
| 15 | #include <linux/spinlock.h>
|
| 16 | #include <linux/compiler.h>
|
| 17 | #include <linux/types.h>
|
| 18 | #include <linux/errno.h>
|
| 19 | #include <linux/log2.h>
|
| 20 | #include <linux/io.h>
|
| 21 | #include <linux/gpio/driver.h>
|
| 22 | #include <linux/slab.h>
|
| 23 | #include <linux/platform_device.h>
|
| 24 | #include <linux/acpi.h>
|
| 25 | #include <linux/seq_file.h>
|
| 26 | #include <linux/interrupt.h>
|
| 27 | #include <linux/bitops.h>
|
| 28 | #include <linux/pinctrl/pinconf.h>
|
| 29 | #include <linux/pinctrl/pinconf-generic.h>
|
| 30 | #include <linux/pinctrl/pinmux.h>
|
| 31 | #include <linux/string_choices.h>
|
| 32 | #include <linux/suspend.h>
|
| 33 |
|
| 34 | #include "core.h"
|
| 35 | #include "pinctrl-utils.h"
|
| 36 | #include "pinctrl-amd.h"
|
| 37 |
|
| 38 | #ifdef CONFIG_SUSPEND
|
| 39 | static struct amd_gpio *pinctrl_dev;
|
| 40 | #endif
|
| 41 |
|
| 42 | static int amd_gpio_get_direction(struct gpio_chip *gc, unsigned offset)
|
| 43 | {
|
| 44 | unsigned long flags;
|
| 45 | u32 pin_reg;
|
| 46 | struct amd_gpio *gpio_dev = gpiochip_get_data(gc);
|
| 47 |
|
| 48 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 49 | pin_reg = readl(gpio_dev->base + offset * 4);
|
| 50 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 51 |
|
| 52 | if (pin_reg & BIT(OUTPUT_ENABLE_OFF))
|
| 53 | return GPIO_LINE_DIRECTION_OUT;
|
| 54 |
|
| 55 | return GPIO_LINE_DIRECTION_IN;
|
| 56 | }
|
| 57 |
|
| 58 | static int amd_gpio_direction_input(struct gpio_chip *gc, unsigned offset)
|
| 59 | {
|
| 60 | unsigned long flags;
|
| 61 | u32 pin_reg;
|
| 62 | struct amd_gpio *gpio_dev = gpiochip_get_data(gc);
|
| 63 |
|
| 64 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 65 | pin_reg = readl(gpio_dev->base + offset * 4);
|
| 66 | pin_reg &= ~BIT(OUTPUT_ENABLE_OFF);
|
| 67 | writel(pin_reg, gpio_dev->base + offset * 4);
|
| 68 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 69 |
|
| 70 | return 0;
|
| 71 | }
|
| 72 |
|
| 73 | static int amd_gpio_direction_output(struct gpio_chip *gc, unsigned offset,
|
| 74 | int value)
|
| 75 | {
|
| 76 | u32 pin_reg;
|
| 77 | unsigned long flags;
|
| 78 | struct amd_gpio *gpio_dev = gpiochip_get_data(gc);
|
| 79 |
|
| 80 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 81 | pin_reg = readl(gpio_dev->base + offset * 4);
|
| 82 | pin_reg |= BIT(OUTPUT_ENABLE_OFF);
|
| 83 | if (value)
|
| 84 | pin_reg |= BIT(OUTPUT_VALUE_OFF);
|
| 85 | else
|
| 86 | pin_reg &= ~BIT(OUTPUT_VALUE_OFF);
|
| 87 | writel(pin_reg, gpio_dev->base + offset * 4);
|
| 88 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 89 |
|
| 90 | return 0;
|
| 91 | }
|
| 92 |
|
| 93 | static int amd_gpio_get_value(struct gpio_chip *gc, unsigned offset)
|
| 94 | {
|
| 95 | u32 pin_reg;
|
| 96 | unsigned long flags;
|
| 97 | struct amd_gpio *gpio_dev = gpiochip_get_data(gc);
|
| 98 |
|
| 99 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 100 | pin_reg = readl(gpio_dev->base + offset * 4);
|
| 101 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 102 |
|
| 103 | return !!(pin_reg & BIT(PIN_STS_OFF));
|
| 104 | }
|
| 105 |
|
| 106 | static int amd_gpio_set_value(struct gpio_chip *gc, unsigned int offset,
|
| 107 | int value)
|
| 108 | {
|
| 109 | u32 pin_reg;
|
| 110 | unsigned long flags;
|
| 111 | struct amd_gpio *gpio_dev = gpiochip_get_data(gc);
|
| 112 |
|
| 113 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 114 | pin_reg = readl(gpio_dev->base + offset * 4);
|
| 115 | if (value)
|
| 116 | pin_reg |= BIT(OUTPUT_VALUE_OFF);
|
| 117 | else
|
| 118 | pin_reg &= ~BIT(OUTPUT_VALUE_OFF);
|
| 119 | writel(pin_reg, gpio_dev->base + offset * 4);
|
| 120 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 121 |
|
| 122 | return 0;
|
| 123 | }
|
| 124 |
|
| 125 | static int amd_gpio_set_debounce(struct amd_gpio *gpio_dev, unsigned int offset,
|
| 126 | unsigned int debounce)
|
| 127 | {
|
| 128 | u32 time;
|
| 129 | u32 pin_reg;
|
| 130 | int ret = 0;
|
| 131 |
|
| 132 |
|
| 133 | if (offset == 0) {
|
| 134 | pin_reg = readl(gpio_dev->base + WAKE_INT_MASTER_REG);
|
| 135 | if (pin_reg & INTERNAL_GPIO0_DEBOUNCE)
|
| 136 | debounce = 0;
|
| 137 | }
|
| 138 |
|
| 139 | pin_reg = readl(gpio_dev->base + offset * 4);
|
| 140 |
|
| 141 | if (debounce) {
|
| 142 | pin_reg |= DB_TYPE_REMOVE_GLITCH << DB_CNTRL_OFF;
|
| 143 | pin_reg &= ~DB_TMR_OUT_MASK;
|
| 144 | |
| 145 | Debounce Debounce Timer Max
|
| 146 | TmrLarge TmrOutUnit Unit Debounce
|
| 147 | Time
|
| 148 | 0 0 61 usec (2 RtcClk) 976 usec
|
| 149 | 0 1 244 usec (8 RtcClk) 3.9 msec
|
| 150 | 1 0 15.6 msec (512 RtcClk) 250 msec
|
| 151 | 1 1 62.5 msec (2048 RtcClk) 1 sec
|
| 152 |
|
| 153 |
|
| 154 | if (debounce < 61) {
|
| 155 | pin_reg |= 1;
|
| 156 | pin_reg &= ~BIT(DB_TMR_OUT_UNIT_OFF);
|
| 157 | pin_reg &= ~BIT(DB_TMR_LARGE_OFF);
|
| 158 | } else if (debounce < 976) {
|
| 159 | time = debounce / 61;
|
| 160 | pin_reg |= time & DB_TMR_OUT_MASK;
|
| 161 | pin_reg &= ~BIT(DB_TMR_OUT_UNIT_OFF);
|
| 162 | pin_reg &= ~BIT(DB_TMR_LARGE_OFF);
|
| 163 | } else if (debounce < 3900) {
|
| 164 | time = debounce / 244;
|
| 165 | pin_reg |= time & DB_TMR_OUT_MASK;
|
| 166 | pin_reg |= BIT(DB_TMR_OUT_UNIT_OFF);
|
| 167 | pin_reg &= ~BIT(DB_TMR_LARGE_OFF);
|
| 168 | } else if (debounce < 250000) {
|
| 169 | time = debounce / 15625;
|
| 170 | pin_reg |= time & DB_TMR_OUT_MASK;
|
| 171 | pin_reg &= ~BIT(DB_TMR_OUT_UNIT_OFF);
|
| 172 | pin_reg |= BIT(DB_TMR_LARGE_OFF);
|
| 173 | } else if (debounce < 1000000) {
|
| 174 | time = debounce / 62500;
|
| 175 | pin_reg |= time & DB_TMR_OUT_MASK;
|
| 176 | pin_reg |= BIT(DB_TMR_OUT_UNIT_OFF);
|
| 177 | pin_reg |= BIT(DB_TMR_LARGE_OFF);
|
| 178 | } else {
|
| 179 | pin_reg &= ~(DB_CNTRl_MASK << DB_CNTRL_OFF);
|
| 180 | ret = -EINVAL;
|
| 181 | }
|
| 182 | } else {
|
| 183 | pin_reg &= ~BIT(DB_TMR_OUT_UNIT_OFF);
|
| 184 | pin_reg &= ~BIT(DB_TMR_LARGE_OFF);
|
| 185 | pin_reg &= ~DB_TMR_OUT_MASK;
|
| 186 | pin_reg &= ~(DB_CNTRl_MASK << DB_CNTRL_OFF);
|
| 187 | }
|
| 188 | writel(pin_reg, gpio_dev->base + offset * 4);
|
| 189 |
|
| 190 | return ret;
|
| 191 | }
|
| 192 |
|
| 193 | #ifdef CONFIG_DEBUG_FS
|
| 194 | static void amd_gpio_dbg_show(struct seq_file *s, struct gpio_chip *gc)
|
| 195 | {
|
| 196 | u32 pin_reg;
|
| 197 | u32 db_cntrl;
|
| 198 | unsigned long flags;
|
| 199 | unsigned int bank, i, pin_num;
|
| 200 | struct amd_gpio *gpio_dev = gpiochip_get_data(gc);
|
| 201 |
|
| 202 | bool tmr_out_unit;
|
| 203 | bool tmr_large;
|
| 204 |
|
| 205 | char *level_trig;
|
| 206 | char *active_level;
|
| 207 | char *interrupt_mask;
|
| 208 | char *wake_cntrl0;
|
| 209 | char *wake_cntrl1;
|
| 210 | char *wake_cntrl2;
|
| 211 | char *pin_sts;
|
| 212 | char *interrupt_sts;
|
| 213 | char *wake_sts;
|
| 214 | char *orientation;
|
| 215 | char debounce_value[40];
|
| 216 | char *debounce_enable;
|
| 217 | char *wake_cntrlz;
|
| 218 |
|
| 219 | seq_printf(s, "WAKE_INT_MASTER_REG: 0x%08x\n", readl(gpio_dev->base + WAKE_INT_MASTER_REG));
|
| 220 | for (bank = 0; bank < gpio_dev->hwbank_num; bank++) {
|
| 221 | unsigned int time = 0;
|
| 222 | unsigned int unit = 0;
|
| 223 |
|
| 224 | switch (bank) {
|
| 225 | case 0:
|
| 226 | i = 0;
|
| 227 | pin_num = AMD_GPIO_PINS_BANK0;
|
| 228 | break;
|
| 229 | case 1:
|
| 230 | i = 64;
|
| 231 | pin_num = AMD_GPIO_PINS_BANK1 + i;
|
| 232 | break;
|
| 233 | case 2:
|
| 234 | i = 128;
|
| 235 | pin_num = AMD_GPIO_PINS_BANK2 + i;
|
| 236 | break;
|
| 237 | case 3:
|
| 238 | i = 192;
|
| 239 | pin_num = AMD_GPIO_PINS_BANK3 + i;
|
| 240 | break;
|
| 241 | default:
|
| 242 |
|
| 243 | continue;
|
| 244 | }
|
| 245 | seq_printf(s, "GPIO bank%d\n", bank);
|
| 246 | seq_puts(s, "gpio\t int|active|trigger|S0i3| S3|S4/S5| Z|wake|pull| orient| debounce|reg\n");
|
| 247 | for (; i < pin_num; i++) {
|
| 248 | seq_printf(s, "#%d\t", i);
|
| 249 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 250 | pin_reg = readl(gpio_dev->base + i * 4);
|
| 251 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 252 |
|
| 253 | if (pin_reg & BIT(INTERRUPT_ENABLE_OFF)) {
|
| 254 | u8 level = (pin_reg >> ACTIVE_LEVEL_OFF) &
|
| 255 | ACTIVE_LEVEL_MASK;
|
| 256 |
|
| 257 | if (level == ACTIVE_LEVEL_HIGH)
|
| 258 | active_level = "↑";
|
| 259 | else if (level == ACTIVE_LEVEL_LOW)
|
| 260 | active_level = "↓";
|
| 261 | else if (!(pin_reg & BIT(LEVEL_TRIG_OFF)) &&
|
| 262 | level == ACTIVE_LEVEL_BOTH)
|
| 263 | active_level = "b";
|
| 264 | else
|
| 265 | active_level = "?";
|
| 266 |
|
| 267 | if (pin_reg & BIT(LEVEL_TRIG_OFF))
|
| 268 | level_trig = "level";
|
| 269 | else
|
| 270 | level_trig = " edge";
|
| 271 |
|
| 272 | if (pin_reg & BIT(INTERRUPT_MASK_OFF))
|
| 273 | interrupt_mask = "😛";
|
| 274 | else
|
| 275 | interrupt_mask = "😷";
|
| 276 |
|
| 277 | if (pin_reg & BIT(INTERRUPT_STS_OFF))
|
| 278 | interrupt_sts = "🔥";
|
| 279 | else
|
| 280 | interrupt_sts = " ";
|
| 281 |
|
| 282 | seq_printf(s, "%s %s| %s| %s|",
|
| 283 | interrupt_sts,
|
| 284 | interrupt_mask,
|
| 285 | active_level,
|
| 286 | level_trig);
|
| 287 | } else
|
| 288 | seq_puts(s, " ∅| | |");
|
| 289 |
|
| 290 | if (pin_reg & BIT(WAKE_CNTRL_OFF_S0I3))
|
| 291 | wake_cntrl0 = "⏰";
|
| 292 | else
|
| 293 | wake_cntrl0 = " ";
|
| 294 | seq_printf(s, " %s| ", wake_cntrl0);
|
| 295 |
|
| 296 | if (pin_reg & BIT(WAKE_CNTRL_OFF_S3))
|
| 297 | wake_cntrl1 = "⏰";
|
| 298 | else
|
| 299 | wake_cntrl1 = " ";
|
| 300 | seq_printf(s, "%s|", wake_cntrl1);
|
| 301 |
|
| 302 | if (pin_reg & BIT(WAKE_CNTRL_OFF_S4))
|
| 303 | wake_cntrl2 = "⏰";
|
| 304 | else
|
| 305 | wake_cntrl2 = " ";
|
| 306 | seq_printf(s, " %s|", wake_cntrl2);
|
| 307 |
|
| 308 | if (pin_reg & BIT(WAKECNTRL_Z_OFF))
|
| 309 | wake_cntrlz = "⏰";
|
| 310 | else
|
| 311 | wake_cntrlz = " ";
|
| 312 | seq_printf(s, "%s|", wake_cntrlz);
|
| 313 |
|
| 314 | if (pin_reg & BIT(WAKE_STS_OFF))
|
| 315 | wake_sts = "🔥";
|
| 316 | else
|
| 317 | wake_sts = " ";
|
| 318 | seq_printf(s, " %s|", wake_sts);
|
| 319 |
|
| 320 | if (pin_reg & BIT(PULL_UP_ENABLE_OFF)) {
|
| 321 | seq_puts(s, " ↑ |");
|
| 322 | } else if (pin_reg & BIT(PULL_DOWN_ENABLE_OFF)) {
|
| 323 | seq_puts(s, " ↓ |");
|
| 324 | } else {
|
| 325 | seq_puts(s, " |");
|
| 326 | }
|
| 327 |
|
| 328 | if (pin_reg & BIT(OUTPUT_ENABLE_OFF)) {
|
| 329 | pin_sts = "output";
|
| 330 | if (pin_reg & BIT(OUTPUT_VALUE_OFF))
|
| 331 | orientation = "↑";
|
| 332 | else
|
| 333 | orientation = "↓";
|
| 334 | } else {
|
| 335 | pin_sts = "input ";
|
| 336 | if (pin_reg & BIT(PIN_STS_OFF))
|
| 337 | orientation = "↑";
|
| 338 | else
|
| 339 | orientation = "↓";
|
| 340 | }
|
| 341 | seq_printf(s, "%s %s|", pin_sts, orientation);
|
| 342 |
|
| 343 | db_cntrl = (DB_CNTRl_MASK << DB_CNTRL_OFF) & pin_reg;
|
| 344 | if (db_cntrl) {
|
| 345 | tmr_out_unit = pin_reg & BIT(DB_TMR_OUT_UNIT_OFF);
|
| 346 | tmr_large = pin_reg & BIT(DB_TMR_LARGE_OFF);
|
| 347 | time = pin_reg & DB_TMR_OUT_MASK;
|
| 348 | if (tmr_large) {
|
| 349 | if (tmr_out_unit)
|
| 350 | unit = 62500;
|
| 351 | else
|
| 352 | unit = 15625;
|
| 353 | } else {
|
| 354 | if (tmr_out_unit)
|
| 355 | unit = 244;
|
| 356 | else
|
| 357 | unit = 61;
|
| 358 | }
|
| 359 | if ((DB_TYPE_REMOVE_GLITCH << DB_CNTRL_OFF) == db_cntrl)
|
| 360 | debounce_enable = "b";
|
| 361 | else if ((DB_TYPE_PRESERVE_LOW_GLITCH << DB_CNTRL_OFF) == db_cntrl)
|
| 362 | debounce_enable = "↓";
|
| 363 | else
|
| 364 | debounce_enable = "↑";
|
| 365 | snprintf(debounce_value, sizeof(debounce_value), "%06u", time * unit);
|
| 366 | seq_printf(s, "%s (🕑 %sus)|", debounce_enable, debounce_value);
|
| 367 | } else {
|
| 368 | seq_puts(s, " |");
|
| 369 | }
|
| 370 | seq_printf(s, "0x%x\n", pin_reg);
|
| 371 | }
|
| 372 | }
|
| 373 | }
|
| 374 | #else
|
| 375 | #define amd_gpio_dbg_show NULL
|
| 376 | #endif
|
| 377 |
|
| 378 | static void amd_gpio_irq_enable(struct irq_data *d)
|
| 379 | {
|
| 380 | u32 pin_reg;
|
| 381 | unsigned long flags;
|
| 382 | struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
|
| 383 | struct amd_gpio *gpio_dev = gpiochip_get_data(gc);
|
| 384 | irq_hw_number_t hwirq = irqd_to_hwirq(d);
|
| 385 |
|
| 386 | gpiochip_enable_irq(gc, hwirq);
|
| 387 |
|
| 388 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 389 | pin_reg = readl(gpio_dev->base + hwirq * 4);
|
| 390 | pin_reg |= BIT(INTERRUPT_ENABLE_OFF);
|
| 391 | pin_reg |= BIT(INTERRUPT_MASK_OFF);
|
| 392 | writel(pin_reg, gpio_dev->base + hwirq * 4);
|
| 393 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 394 | }
|
| 395 |
|
| 396 | static void amd_gpio_irq_disable(struct irq_data *d)
|
| 397 | {
|
| 398 | u32 pin_reg;
|
| 399 | unsigned long flags;
|
| 400 | struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
|
| 401 | struct amd_gpio *gpio_dev = gpiochip_get_data(gc);
|
| 402 | irq_hw_number_t hwirq = irqd_to_hwirq(d);
|
| 403 |
|
| 404 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 405 | pin_reg = readl(gpio_dev->base + hwirq * 4);
|
| 406 | pin_reg &= ~BIT(INTERRUPT_ENABLE_OFF);
|
| 407 | pin_reg &= ~BIT(INTERRUPT_MASK_OFF);
|
| 408 | writel(pin_reg, gpio_dev->base + hwirq * 4);
|
| 409 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 410 |
|
| 411 | gpiochip_disable_irq(gc, hwirq);
|
| 412 | }
|
| 413 |
|
| 414 | static void amd_gpio_irq_mask(struct irq_data *d)
|
| 415 | {
|
| 416 | u32 pin_reg;
|
| 417 | unsigned long flags;
|
| 418 | struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
|
| 419 | struct amd_gpio *gpio_dev = gpiochip_get_data(gc);
|
| 420 | irq_hw_number_t hwirq = irqd_to_hwirq(d);
|
| 421 |
|
| 422 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 423 | pin_reg = readl(gpio_dev->base + hwirq * 4);
|
| 424 | pin_reg &= ~BIT(INTERRUPT_MASK_OFF);
|
| 425 | writel(pin_reg, gpio_dev->base + hwirq * 4);
|
| 426 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 427 | }
|
| 428 |
|
| 429 | static void amd_gpio_irq_unmask(struct irq_data *d)
|
| 430 | {
|
| 431 | u32 pin_reg;
|
| 432 | unsigned long flags;
|
| 433 | struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
|
| 434 | struct amd_gpio *gpio_dev = gpiochip_get_data(gc);
|
| 435 | irq_hw_number_t hwirq = irqd_to_hwirq(d);
|
| 436 |
|
| 437 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 438 | pin_reg = readl(gpio_dev->base + hwirq * 4);
|
| 439 | pin_reg |= BIT(INTERRUPT_MASK_OFF);
|
| 440 | writel(pin_reg, gpio_dev->base + hwirq * 4);
|
| 441 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 442 | }
|
| 443 |
|
| 444 | static int amd_gpio_irq_set_wake(struct irq_data *d, unsigned int on)
|
| 445 | {
|
| 446 | u32 pin_reg;
|
| 447 | unsigned long flags;
|
| 448 | struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
|
| 449 | struct amd_gpio *gpio_dev = gpiochip_get_data(gc);
|
| 450 | u32 wake_mask = BIT(WAKE_CNTRL_OFF_S0I3) | BIT(WAKE_CNTRL_OFF_S3);
|
| 451 | irq_hw_number_t hwirq = irqd_to_hwirq(d);
|
| 452 | int err;
|
| 453 |
|
| 454 | pm_pr_dbg("Setting wake for GPIO %lu to %s\n",
|
| 455 | hwirq, str_enable_disable(on));
|
| 456 |
|
| 457 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 458 | pin_reg = readl(gpio_dev->base + hwirq * 4);
|
| 459 |
|
| 460 | if (on)
|
| 461 | pin_reg |= wake_mask;
|
| 462 | else
|
| 463 | pin_reg &= ~wake_mask;
|
| 464 |
|
| 465 | writel(pin_reg, gpio_dev->base + hwirq * 4);
|
| 466 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 467 |
|
| 468 | if (on)
|
| 469 | err = enable_irq_wake(gpio_dev->irq);
|
| 470 | else
|
| 471 | err = disable_irq_wake(gpio_dev->irq);
|
| 472 |
|
| 473 | if (err)
|
| 474 | dev_err(&gpio_dev->pdev->dev, "failed to %s wake-up interrupt\n",
|
| 475 | str_enable_disable(on));
|
| 476 |
|
| 477 | return 0;
|
| 478 | }
|
| 479 |
|
| 480 | static void amd_gpio_irq_eoi(struct irq_data *d)
|
| 481 | {
|
| 482 | u32 reg;
|
| 483 | unsigned long flags;
|
| 484 | struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
|
| 485 | struct amd_gpio *gpio_dev = gpiochip_get_data(gc);
|
| 486 |
|
| 487 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 488 | reg = readl(gpio_dev->base + WAKE_INT_MASTER_REG);
|
| 489 | reg |= EOI_MASK;
|
| 490 | writel(reg, gpio_dev->base + WAKE_INT_MASTER_REG);
|
| 491 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 492 | }
|
| 493 |
|
| 494 | static int amd_gpio_irq_set_type(struct irq_data *d, unsigned int type)
|
| 495 | {
|
| 496 | int ret = 0;
|
| 497 | u32 pin_reg, pin_reg_irq_en, mask;
|
| 498 | unsigned long flags;
|
| 499 | struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
|
| 500 | struct amd_gpio *gpio_dev = gpiochip_get_data(gc);
|
| 501 | irq_hw_number_t hwirq = irqd_to_hwirq(d);
|
| 502 |
|
| 503 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 504 | pin_reg = readl(gpio_dev->base + hwirq * 4);
|
| 505 |
|
| 506 | switch (type & IRQ_TYPE_SENSE_MASK) {
|
| 507 | case IRQ_TYPE_EDGE_RISING:
|
| 508 | pin_reg &= ~BIT(LEVEL_TRIG_OFF);
|
| 509 | pin_reg &= ~(ACTIVE_LEVEL_MASK << ACTIVE_LEVEL_OFF);
|
| 510 | pin_reg |= ACTIVE_HIGH << ACTIVE_LEVEL_OFF;
|
| 511 | irq_set_handler_locked(d, handle_edge_irq);
|
| 512 | break;
|
| 513 |
|
| 514 | case IRQ_TYPE_EDGE_FALLING:
|
| 515 | pin_reg &= ~BIT(LEVEL_TRIG_OFF);
|
| 516 | pin_reg &= ~(ACTIVE_LEVEL_MASK << ACTIVE_LEVEL_OFF);
|
| 517 | pin_reg |= ACTIVE_LOW << ACTIVE_LEVEL_OFF;
|
| 518 | irq_set_handler_locked(d, handle_edge_irq);
|
| 519 | break;
|
| 520 |
|
| 521 | case IRQ_TYPE_EDGE_BOTH:
|
| 522 | pin_reg &= ~BIT(LEVEL_TRIG_OFF);
|
| 523 | pin_reg &= ~(ACTIVE_LEVEL_MASK << ACTIVE_LEVEL_OFF);
|
| 524 | pin_reg |= BOTH_EDGES << ACTIVE_LEVEL_OFF;
|
| 525 | irq_set_handler_locked(d, handle_edge_irq);
|
| 526 | break;
|
| 527 |
|
| 528 | case IRQ_TYPE_LEVEL_HIGH:
|
| 529 | pin_reg |= LEVEL_TRIGGER << LEVEL_TRIG_OFF;
|
| 530 | pin_reg &= ~(ACTIVE_LEVEL_MASK << ACTIVE_LEVEL_OFF);
|
| 531 | pin_reg |= ACTIVE_HIGH << ACTIVE_LEVEL_OFF;
|
| 532 | irq_set_handler_locked(d, handle_level_irq);
|
| 533 | break;
|
| 534 |
|
| 535 | case IRQ_TYPE_LEVEL_LOW:
|
| 536 | pin_reg |= LEVEL_TRIGGER << LEVEL_TRIG_OFF;
|
| 537 | pin_reg &= ~(ACTIVE_LEVEL_MASK << ACTIVE_LEVEL_OFF);
|
| 538 | pin_reg |= ACTIVE_LOW << ACTIVE_LEVEL_OFF;
|
| 539 | irq_set_handler_locked(d, handle_level_irq);
|
| 540 | break;
|
| 541 |
|
| 542 | case IRQ_TYPE_NONE:
|
| 543 | break;
|
| 544 |
|
| 545 | default:
|
| 546 | dev_err(&gpio_dev->pdev->dev, "Invalid type value\n");
|
| 547 | ret = -EINVAL;
|
| 548 | }
|
| 549 |
|
| 550 | pin_reg |= CLR_INTR_STAT << INTERRUPT_STS_OFF;
|
| 551 | |
| 552 | * If WAKE_INT_MASTER_REG.MaskStsEn is set, a software write to the
|
| 553 | * debounce registers of any GPIO will block wake/interrupt status
|
| 554 | * generation for *all* GPIOs for a length of time that depends on
|
| 555 | * WAKE_INT_MASTER_REG.MaskStsLength[11:0]. During this period the
|
| 556 | * INTERRUPT_ENABLE bit will read as 0.
|
| 557 | *
|
| 558 | * We temporarily enable irq for the GPIO whose configuration is
|
| 559 | * changing, and then wait for it to read back as 1 to know when
|
| 560 | * debounce has settled and then disable the irq again.
|
| 561 | * We do this polling with the spinlock held to ensure other GPIO
|
| 562 | * access routines do not read an incorrect value for the irq enable
|
| 563 | * bit of other GPIOs. We keep the GPIO masked while polling to avoid
|
| 564 | * spurious irqs, and disable the irq again after polling.
|
| 565 |
|
| 566 | mask = BIT(INTERRUPT_ENABLE_OFF);
|
| 567 | pin_reg_irq_en = pin_reg;
|
| 568 | pin_reg_irq_en |= mask;
|
| 569 | pin_reg_irq_en &= ~BIT(INTERRUPT_MASK_OFF);
|
| 570 | writel(pin_reg_irq_en, gpio_dev->base + hwirq * 4);
|
| 571 | while ((readl(gpio_dev->base + hwirq * 4) & mask) != mask)
|
| 572 | continue;
|
| 573 | writel(pin_reg, gpio_dev->base + hwirq * 4);
|
| 574 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 575 |
|
| 576 | return ret;
|
| 577 | }
|
| 578 |
|
| 579 | static void amd_irq_ack(struct irq_data *d)
|
| 580 | {
|
| 581 | |
| 582 | * based on HW design,there is no need to ack HW
|
| 583 | * before handle current irq. But this routine is
|
| 584 | * necessary for handle_edge_irq
|
| 585 |
|
| 586 | }
|
| 587 |
|
| 588 | static const struct irq_chip amd_gpio_irqchip = {
|
| 589 | .name = "amd_gpio",
|
| 590 | .irq_ack = amd_irq_ack,
|
| 591 | .irq_enable = amd_gpio_irq_enable,
|
| 592 | .irq_disable = amd_gpio_irq_disable,
|
| 593 | .irq_mask = amd_gpio_irq_mask,
|
| 594 | .irq_unmask = amd_gpio_irq_unmask,
|
| 595 | .irq_set_wake = amd_gpio_irq_set_wake,
|
| 596 | .irq_eoi = amd_gpio_irq_eoi,
|
| 597 | .irq_set_type = amd_gpio_irq_set_type,
|
| 598 | |
| 599 | * We need to set IRQCHIP_ENABLE_WAKEUP_ON_SUSPEND so that a wake event
|
| 600 | * also generates an IRQ. We need the IRQ so the irq_handler can clear
|
| 601 | * the wake event. Otherwise the wake event will never clear and
|
| 602 | * prevent the system from suspending.
|
| 603 |
|
| 604 | .flags = IRQCHIP_ENABLE_WAKEUP_ON_SUSPEND | IRQCHIP_IMMUTABLE,
|
| 605 | GPIOCHIP_IRQ_RESOURCE_HELPERS,
|
| 606 | };
|
| 607 |
|
| 608 | #define PIN_IRQ_PENDING (BIT(INTERRUPT_STS_OFF) | BIT(WAKE_STS_OFF))
|
| 609 |
|
| 610 | static bool do_amd_gpio_irq_handler(int irq, void *dev_id)
|
| 611 | {
|
| 612 | struct amd_gpio *gpio_dev = dev_id;
|
| 613 | struct gpio_chip *gc = &gpio_dev->gc;
|
| 614 | unsigned int i, irqnr;
|
| 615 | unsigned long flags;
|
| 616 | u32 __iomem *regs;
|
| 617 | bool ret = false;
|
| 618 | u32 regval;
|
| 619 | u64 status, mask;
|
| 620 |
|
| 621 |
|
| 622 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 623 | status = readl(gpio_dev->base + WAKE_INT_STATUS_REG1);
|
| 624 | status <<= 32;
|
| 625 | status |= readl(gpio_dev->base + WAKE_INT_STATUS_REG0);
|
| 626 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 627 |
|
| 628 |
|
| 629 | status &= (1ULL << 46) - 1;
|
| 630 | regs = gpio_dev->base;
|
| 631 | for (mask = 1, irqnr = 0; status; mask <<= 1, regs += 4, irqnr += 4) {
|
| 632 | if (!(status & mask))
|
| 633 | continue;
|
| 634 | status &= ~mask;
|
| 635 |
|
| 636 |
|
| 637 | for (i = 0; i < 4; i++) {
|
| 638 | regval = readl(regs + i);
|
| 639 |
|
| 640 | if (regval & PIN_IRQ_PENDING)
|
| 641 | pm_pr_dbg("GPIO %d is active: 0x%x",
|
| 642 | irqnr + i, regval);
|
| 643 |
|
| 644 |
|
| 645 | if (irq < 0 && (regval & BIT(WAKE_STS_OFF)))
|
| 646 | return true;
|
| 647 |
|
| 648 | if (!(regval & PIN_IRQ_PENDING) ||
|
| 649 | !(regval & BIT(INTERRUPT_MASK_OFF)))
|
| 650 | continue;
|
| 651 | generic_handle_domain_irq_safe(gc->irq.domain, irqnr + i);
|
| 652 |
|
| 653 | |
| 654 | * We must read the pin register again, in case the
|
| 655 | * value was changed while executing
|
| 656 | * generic_handle_domain_irq() above.
|
| 657 | * If the line is not an irq, disable it in order to
|
| 658 | * avoid a system hang caused by an interrupt storm.
|
| 659 |
|
| 660 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 661 | regval = readl(regs + i);
|
| 662 | if (!gpiochip_line_is_irq(gc, irqnr + i)) {
|
| 663 | regval &= ~BIT(INTERRUPT_MASK_OFF);
|
| 664 | dev_dbg(&gpio_dev->pdev->dev,
|
| 665 | "Disabling spurious GPIO IRQ %d\n",
|
| 666 | irqnr + i);
|
| 667 | } else {
|
| 668 | ret = true;
|
| 669 | }
|
| 670 | writel(regval, regs + i);
|
| 671 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 672 | }
|
| 673 | }
|
| 674 |
|
| 675 | if (irq < 0)
|
| 676 | return false;
|
| 677 |
|
| 678 |
|
| 679 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 680 | regval = readl(gpio_dev->base + WAKE_INT_MASTER_REG);
|
| 681 | regval |= EOI_MASK;
|
| 682 | writel(regval, gpio_dev->base + WAKE_INT_MASTER_REG);
|
| 683 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 684 |
|
| 685 | return ret;
|
| 686 | }
|
| 687 |
|
| 688 | static irqreturn_t amd_gpio_irq_handler(int irq, void *dev_id)
|
| 689 | {
|
| 690 | return IRQ_RETVAL(do_amd_gpio_irq_handler(irq, dev_id));
|
| 691 | }
|
| 692 |
|
| 693 | static bool __maybe_unused amd_gpio_check_wake(void *dev_id)
|
| 694 | {
|
| 695 | return do_amd_gpio_irq_handler(-1, dev_id);
|
| 696 | }
|
| 697 |
|
| 698 | static int amd_get_groups_count(struct pinctrl_dev *pctldev)
|
| 699 | {
|
| 700 | struct amd_gpio *gpio_dev = pinctrl_dev_get_drvdata(pctldev);
|
| 701 |
|
| 702 | return gpio_dev->ngroups;
|
| 703 | }
|
| 704 |
|
| 705 | static const char *amd_get_group_name(struct pinctrl_dev *pctldev,
|
| 706 | unsigned group)
|
| 707 | {
|
| 708 | struct amd_gpio *gpio_dev = pinctrl_dev_get_drvdata(pctldev);
|
| 709 |
|
| 710 | return gpio_dev->groups[group].name;
|
| 711 | }
|
| 712 |
|
| 713 | static int amd_get_group_pins(struct pinctrl_dev *pctldev,
|
| 714 | unsigned group,
|
| 715 | const unsigned **pins,
|
| 716 | unsigned *num_pins)
|
| 717 | {
|
| 718 | struct amd_gpio *gpio_dev = pinctrl_dev_get_drvdata(pctldev);
|
| 719 |
|
| 720 | *pins = gpio_dev->groups[group].pins;
|
| 721 | *num_pins = gpio_dev->groups[group].npins;
|
| 722 | return 0;
|
| 723 | }
|
| 724 |
|
| 725 | static const struct pinctrl_ops amd_pinctrl_ops = {
|
| 726 | .get_groups_count = amd_get_groups_count,
|
| 727 | .get_group_name = amd_get_group_name,
|
| 728 | .get_group_pins = amd_get_group_pins,
|
| 729 | #ifdef CONFIG_OF
|
| 730 | .dt_node_to_map = pinconf_generic_dt_node_to_map_group,
|
| 731 | .dt_free_map = pinctrl_utils_free_map,
|
| 732 | #endif
|
| 733 | };
|
| 734 |
|
| 735 | static int amd_pinconf_get(struct pinctrl_dev *pctldev,
|
| 736 | unsigned int pin,
|
| 737 | unsigned long *config)
|
| 738 | {
|
| 739 | u32 pin_reg;
|
| 740 | unsigned arg;
|
| 741 | unsigned long flags;
|
| 742 | struct amd_gpio *gpio_dev = pinctrl_dev_get_drvdata(pctldev);
|
| 743 | enum pin_config_param param = pinconf_to_config_param(*config);
|
| 744 |
|
| 745 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 746 | pin_reg = readl(gpio_dev->base + pin*4);
|
| 747 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 748 | switch (param) {
|
| 749 | case PIN_CONFIG_INPUT_DEBOUNCE:
|
| 750 | arg = pin_reg & DB_TMR_OUT_MASK;
|
| 751 | break;
|
| 752 |
|
| 753 | case PIN_CONFIG_BIAS_PULL_DOWN:
|
| 754 | arg = (pin_reg >> PULL_DOWN_ENABLE_OFF) & BIT(0);
|
| 755 | break;
|
| 756 |
|
| 757 | case PIN_CONFIG_BIAS_PULL_UP:
|
| 758 | arg = (pin_reg >> PULL_UP_ENABLE_OFF) & BIT(0);
|
| 759 | break;
|
| 760 |
|
| 761 | case PIN_CONFIG_DRIVE_STRENGTH:
|
| 762 | arg = (pin_reg >> DRV_STRENGTH_SEL_OFF) & DRV_STRENGTH_SEL_MASK;
|
| 763 | break;
|
| 764 |
|
| 765 | default:
|
| 766 | dev_dbg(&gpio_dev->pdev->dev, "Invalid config param %04x\n",
|
| 767 | param);
|
| 768 | return -ENOTSUPP;
|
| 769 | }
|
| 770 |
|
| 771 | *config = pinconf_to_config_packed(param, arg);
|
| 772 |
|
| 773 | return 0;
|
| 774 | }
|
| 775 |
|
| 776 | static int amd_pinconf_set(struct pinctrl_dev *pctldev, unsigned int pin,
|
| 777 | unsigned long *configs, unsigned int num_configs)
|
| 778 | {
|
| 779 | int i;
|
| 780 | u32 arg;
|
| 781 | int ret = 0;
|
| 782 | u32 pin_reg;
|
| 783 | unsigned long flags;
|
| 784 | enum pin_config_param param;
|
| 785 | struct amd_gpio *gpio_dev = pinctrl_dev_get_drvdata(pctldev);
|
| 786 |
|
| 787 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 788 | for (i = 0; i < num_configs; i++) {
|
| 789 | param = pinconf_to_config_param(configs[i]);
|
| 790 | arg = pinconf_to_config_argument(configs[i]);
|
| 791 | pin_reg = readl(gpio_dev->base + pin*4);
|
| 792 |
|
| 793 | switch (param) {
|
| 794 | case PIN_CONFIG_INPUT_DEBOUNCE:
|
| 795 | ret = amd_gpio_set_debounce(gpio_dev, pin, arg);
|
| 796 | goto out_unlock;
|
| 797 |
|
| 798 | case PIN_CONFIG_BIAS_PULL_DOWN:
|
| 799 | pin_reg &= ~BIT(PULL_DOWN_ENABLE_OFF);
|
| 800 | pin_reg |= (arg & BIT(0)) << PULL_DOWN_ENABLE_OFF;
|
| 801 | break;
|
| 802 |
|
| 803 | case PIN_CONFIG_BIAS_PULL_UP:
|
| 804 | pin_reg &= ~BIT(PULL_UP_ENABLE_OFF);
|
| 805 | pin_reg |= (arg & BIT(0)) << PULL_UP_ENABLE_OFF;
|
| 806 | break;
|
| 807 |
|
| 808 | case PIN_CONFIG_DRIVE_STRENGTH:
|
| 809 | pin_reg &= ~(DRV_STRENGTH_SEL_MASK
|
| 810 | << DRV_STRENGTH_SEL_OFF);
|
| 811 | pin_reg |= (arg & DRV_STRENGTH_SEL_MASK)
|
| 812 | << DRV_STRENGTH_SEL_OFF;
|
| 813 | break;
|
| 814 |
|
| 815 | default:
|
| 816 | dev_dbg(&gpio_dev->pdev->dev,
|
| 817 | "Invalid config param %04x\n", param);
|
| 818 | ret = -ENOTSUPP;
|
| 819 | }
|
| 820 |
|
| 821 | writel(pin_reg, gpio_dev->base + pin*4);
|
| 822 | }
|
| 823 | out_unlock:
|
| 824 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 825 |
|
| 826 | return ret;
|
| 827 | }
|
| 828 |
|
| 829 | static int amd_pinconf_group_get(struct pinctrl_dev *pctldev,
|
| 830 | unsigned int group,
|
| 831 | unsigned long *config)
|
| 832 | {
|
| 833 | const unsigned *pins;
|
| 834 | unsigned npins;
|
| 835 | int ret;
|
| 836 |
|
| 837 | ret = amd_get_group_pins(pctldev, group, &pins, &npins);
|
| 838 | if (ret)
|
| 839 | return ret;
|
| 840 |
|
| 841 | if (amd_pinconf_get(pctldev, pins[0], config))
|
| 842 | return -ENOTSUPP;
|
| 843 |
|
| 844 | return 0;
|
| 845 | }
|
| 846 |
|
| 847 | static int amd_pinconf_group_set(struct pinctrl_dev *pctldev,
|
| 848 | unsigned group, unsigned long *configs,
|
| 849 | unsigned num_configs)
|
| 850 | {
|
| 851 | const unsigned *pins;
|
| 852 | unsigned npins;
|
| 853 | int i, ret;
|
| 854 |
|
| 855 | ret = amd_get_group_pins(pctldev, group, &pins, &npins);
|
| 856 | if (ret)
|
| 857 | return ret;
|
| 858 | for (i = 0; i < npins; i++) {
|
| 859 | if (amd_pinconf_set(pctldev, pins[i], configs, num_configs))
|
| 860 | return -ENOTSUPP;
|
| 861 | }
|
| 862 | return 0;
|
| 863 | }
|
| 864 |
|
| 865 | static int amd_gpio_set_config(struct gpio_chip *gc, unsigned int pin,
|
| 866 | unsigned long config)
|
| 867 | {
|
| 868 | struct amd_gpio *gpio_dev = gpiochip_get_data(gc);
|
| 869 |
|
| 870 | return amd_pinconf_set(gpio_dev->pctrl, pin, &config, 1);
|
| 871 | }
|
| 872 |
|
| 873 | static const struct pinconf_ops amd_pinconf_ops = {
|
| 874 | .pin_config_get = amd_pinconf_get,
|
| 875 | .pin_config_set = amd_pinconf_set,
|
| 876 | .pin_config_group_get = amd_pinconf_group_get,
|
| 877 | .pin_config_group_set = amd_pinconf_group_set,
|
| 878 | };
|
| 879 |
|
| 880 | static void amd_gpio_irq_init(struct amd_gpio *gpio_dev)
|
| 881 | {
|
| 882 | const struct pinctrl_desc *desc = gpio_dev->pctrl->desc;
|
| 883 | unsigned long flags;
|
| 884 | u32 pin_reg, mask;
|
| 885 | int i;
|
| 886 |
|
| 887 | mask = BIT(WAKE_CNTRL_OFF_S0I3) | BIT(WAKE_CNTRL_OFF_S3);
|
| 888 |
|
| 889 | #ifdef CONFIG_ACPI
|
| 890 | |
| 891 | * Platforms without _AEI leave GPIO wake sources to firmware, so
|
| 892 | * preserve their S4 wake bits.
|
| 893 |
|
| 894 | if (acpi_has_method(ACPI_HANDLE(&gpio_dev->pdev->dev), "_AEI"))
|
| 895 | mask |= BIT(WAKE_CNTRL_OFF_S4);
|
| 896 | #endif
|
| 897 |
|
| 898 | for (i = 0; i < desc->npins; i++) {
|
| 899 | int pin = desc->pins[i].number;
|
| 900 | const struct pin_desc *pd = pin_desc_get(gpio_dev->pctrl, pin);
|
| 901 |
|
| 902 | if (!pd)
|
| 903 | continue;
|
| 904 |
|
| 905 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 906 |
|
| 907 | pin_reg = readl(gpio_dev->base + pin * 4);
|
| 908 | pin_reg &= ~mask;
|
| 909 | writel(pin_reg, gpio_dev->base + pin * 4);
|
| 910 |
|
| 911 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 912 | }
|
| 913 | }
|
| 914 |
|
| 915 | #if defined(CONFIG_SUSPEND) && defined(CONFIG_ACPI)
|
| 916 | static void amd_gpio_check_pending(void)
|
| 917 | {
|
| 918 | struct amd_gpio *gpio_dev = pinctrl_dev;
|
| 919 | const struct pinctrl_desc *desc = gpio_dev->pctrl->desc;
|
| 920 | int i;
|
| 921 |
|
| 922 | if (!pm_debug_messages_on)
|
| 923 | return;
|
| 924 |
|
| 925 | for (i = 0; i < desc->npins; i++) {
|
| 926 | int pin = desc->pins[i].number;
|
| 927 | u32 tmp;
|
| 928 |
|
| 929 | tmp = readl(gpio_dev->base + pin * 4);
|
| 930 | if (tmp & PIN_IRQ_PENDING)
|
| 931 | pm_pr_dbg("%s: GPIO %d is active: 0x%x.\n", __func__, pin, tmp);
|
| 932 | }
|
| 933 | }
|
| 934 |
|
| 935 | static struct acpi_s2idle_dev_ops pinctrl_amd_s2idle_dev_ops = {
|
| 936 | .check = amd_gpio_check_pending,
|
| 937 | };
|
| 938 |
|
| 939 | static void amd_gpio_register_s2idle_ops(void)
|
| 940 | {
|
| 941 | acpi_register_lps0_dev(&pinctrl_amd_s2idle_dev_ops);
|
| 942 | }
|
| 943 |
|
| 944 | static void amd_gpio_unregister_s2idle_ops(void)
|
| 945 | {
|
| 946 | acpi_unregister_lps0_dev(&pinctrl_amd_s2idle_dev_ops);
|
| 947 | }
|
| 948 | #else
|
| 949 | static inline void amd_gpio_register_s2idle_ops(void) {}
|
| 950 | static inline void amd_gpio_unregister_s2idle_ops(void) {}
|
| 951 | #endif
|
| 952 |
|
| 953 | #ifdef CONFIG_PM_SLEEP
|
| 954 | static bool amd_gpio_should_save(struct amd_gpio *gpio_dev, unsigned int pin)
|
| 955 | {
|
| 956 | const struct pin_desc *pd = pin_desc_get(gpio_dev->pctrl, pin);
|
| 957 |
|
| 958 | if (!pd)
|
| 959 | return false;
|
| 960 |
|
| 961 | |
| 962 | * Only restore the pin if it is actually in use by the kernel (or
|
| 963 | * by userspace).
|
| 964 |
|
| 965 | if (pd->mux_owner || pd->gpio_owner ||
|
| 966 | gpiochip_line_is_irq(&gpio_dev->gc, pin))
|
| 967 | return true;
|
| 968 |
|
| 969 | return false;
|
| 970 | }
|
| 971 |
|
| 972 | static int amd_gpio_suspend_hibernate_common(struct device *dev, bool is_suspend)
|
| 973 | {
|
| 974 | struct amd_gpio *gpio_dev = dev_get_drvdata(dev);
|
| 975 | const struct pinctrl_desc *desc = gpio_dev->pctrl->desc;
|
| 976 | unsigned long flags;
|
| 977 | int i;
|
| 978 | u32 wake_mask = is_suspend ? WAKE_SOURCE_SUSPEND : WAKE_SOURCE_HIBERNATE;
|
| 979 |
|
| 980 | for (i = 0; i < desc->npins; i++) {
|
| 981 | int pin = desc->pins[i].number;
|
| 982 |
|
| 983 | if (!amd_gpio_should_save(gpio_dev, pin))
|
| 984 | continue;
|
| 985 |
|
| 986 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 987 | gpio_dev->saved_regs[i] = readl(gpio_dev->base + pin * 4) & ~PIN_IRQ_PENDING;
|
| 988 |
|
| 989 |
|
| 990 | if (!(gpio_dev->saved_regs[i] & wake_mask)) {
|
| 991 | writel(gpio_dev->saved_regs[i] & ~BIT(INTERRUPT_MASK_OFF),
|
| 992 | gpio_dev->base + pin * 4);
|
| 993 | pm_pr_dbg("Disabling GPIO #%d interrupt for %s.\n",
|
| 994 | pin, is_suspend ? "suspend" : "hibernate");
|
| 995 | }
|
| 996 |
|
| 997 | |
| 998 | * debounce enabled over suspend has shown issues with a GPIO
|
| 999 | * being unable to wake the system, as we're only interested in
|
| 1000 | * the actual wakeup event, clear it.
|
| 1001 |
|
| 1002 | if (gpio_dev->saved_regs[i] & (DB_CNTRl_MASK << DB_CNTRL_OFF)) {
|
| 1003 | amd_gpio_set_debounce(gpio_dev, pin, 0);
|
| 1004 | pm_pr_dbg("Clearing debounce for GPIO #%d during %s.\n",
|
| 1005 | pin, is_suspend ? "suspend" : "hibernate");
|
| 1006 | }
|
| 1007 |
|
| 1008 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 1009 | }
|
| 1010 |
|
| 1011 | return 0;
|
| 1012 | }
|
| 1013 |
|
| 1014 | static int amd_gpio_suspend(struct device *dev)
|
| 1015 | {
|
| 1016 | #ifdef CONFIG_SUSPEND
|
| 1017 | pinctrl_dev = dev_get_drvdata(dev);
|
| 1018 | #endif
|
| 1019 | return amd_gpio_suspend_hibernate_common(dev, true);
|
| 1020 | }
|
| 1021 |
|
| 1022 | static int amd_gpio_hibernate(struct device *dev)
|
| 1023 | {
|
| 1024 | return amd_gpio_suspend_hibernate_common(dev, false);
|
| 1025 | }
|
| 1026 |
|
| 1027 | static int amd_gpio_resume(struct device *dev)
|
| 1028 | {
|
| 1029 | struct amd_gpio *gpio_dev = dev_get_drvdata(dev);
|
| 1030 | const struct pinctrl_desc *desc = gpio_dev->pctrl->desc;
|
| 1031 | unsigned long flags;
|
| 1032 | int i;
|
| 1033 |
|
| 1034 | for (i = 0; i < desc->npins; i++) {
|
| 1035 | int pin = desc->pins[i].number;
|
| 1036 |
|
| 1037 | if (!amd_gpio_should_save(gpio_dev, pin))
|
| 1038 | continue;
|
| 1039 |
|
| 1040 | raw_spin_lock_irqsave(&gpio_dev->lock, flags);
|
| 1041 | gpio_dev->saved_regs[i] |= readl(gpio_dev->base + pin * 4) & PIN_IRQ_PENDING;
|
| 1042 | writel(gpio_dev->saved_regs[i], gpio_dev->base + pin * 4);
|
| 1043 | raw_spin_unlock_irqrestore(&gpio_dev->lock, flags);
|
| 1044 | }
|
| 1045 |
|
| 1046 | return 0;
|
| 1047 | }
|
| 1048 |
|
| 1049 | static const struct dev_pm_ops amd_gpio_pm_ops = {
|
| 1050 | .suspend_late = amd_gpio_suspend,
|
| 1051 | .resume_early = amd_gpio_resume,
|
| 1052 | .freeze_late = amd_gpio_hibernate,
|
| 1053 | .thaw_early = amd_gpio_resume,
|
| 1054 | .poweroff_late = amd_gpio_hibernate,
|
| 1055 | .restore_early = amd_gpio_resume,
|
| 1056 | };
|
| 1057 | #endif
|
| 1058 |
|
| 1059 | static int amd_get_functions_count(struct pinctrl_dev *pctldev)
|
| 1060 | {
|
| 1061 | return ARRAY_SIZE(pmx_functions);
|
| 1062 | }
|
| 1063 |
|
| 1064 | static const char *amd_get_fname(struct pinctrl_dev *pctrldev, unsigned int selector)
|
| 1065 | {
|
| 1066 | return pmx_functions[selector].name;
|
| 1067 | }
|
| 1068 |
|
| 1069 | static int amd_get_groups(struct pinctrl_dev *pctrldev, unsigned int selector,
|
| 1070 | const char * const **groups,
|
| 1071 | unsigned int * const num_groups)
|
| 1072 | {
|
| 1073 | struct amd_gpio *gpio_dev = pinctrl_dev_get_drvdata(pctrldev);
|
| 1074 |
|
| 1075 | if (!gpio_dev->iomux_base) {
|
| 1076 | dev_err(&gpio_dev->pdev->dev, "iomux function %d group not supported\n", selector);
|
| 1077 | return -EINVAL;
|
| 1078 | }
|
| 1079 |
|
| 1080 | *groups = pmx_functions[selector].groups;
|
| 1081 | *num_groups = pmx_functions[selector].ngroups;
|
| 1082 | return 0;
|
| 1083 | }
|
| 1084 |
|
| 1085 | static int amd_set_mux(struct pinctrl_dev *pctrldev, unsigned int function, unsigned int group)
|
| 1086 | {
|
| 1087 | struct amd_gpio *gpio_dev = pinctrl_dev_get_drvdata(pctrldev);
|
| 1088 | struct device *dev = &gpio_dev->pdev->dev;
|
| 1089 | struct pin_desc *pd;
|
| 1090 | int ind, index;
|
| 1091 |
|
| 1092 | if (!gpio_dev->iomux_base)
|
| 1093 | return -EINVAL;
|
| 1094 |
|
| 1095 | for (index = 0; index < NSELECTS; index++) {
|
| 1096 | if (strcmp(gpio_dev->groups[group].name, pmx_functions[function].groups[index]))
|
| 1097 | continue;
|
| 1098 |
|
| 1099 | if (readb(gpio_dev->iomux_base + pmx_functions[function].index) ==
|
| 1100 | FUNCTION_INVALID) {
|
| 1101 | dev_err(dev, "IOMUX_GPIO 0x%x not present or supported\n",
|
| 1102 | pmx_functions[function].index);
|
| 1103 | return -EINVAL;
|
| 1104 | }
|
| 1105 |
|
| 1106 | writeb(index, gpio_dev->iomux_base + pmx_functions[function].index);
|
| 1107 |
|
| 1108 | if (index != (readb(gpio_dev->iomux_base + pmx_functions[function].index) &
|
| 1109 | FUNCTION_MASK)) {
|
| 1110 | dev_err(dev, "IOMUX_GPIO 0x%x not present or supported\n",
|
| 1111 | pmx_functions[function].index);
|
| 1112 | return -EINVAL;
|
| 1113 | }
|
| 1114 |
|
| 1115 | for (ind = 0; ind < gpio_dev->groups[group].npins; ind++) {
|
| 1116 | if (strncmp(gpio_dev->groups[group].name, "IMX_F", strlen("IMX_F")))
|
| 1117 | continue;
|
| 1118 |
|
| 1119 | pd = pin_desc_get(gpio_dev->pctrl, gpio_dev->groups[group].pins[ind]);
|
| 1120 | pd->mux_owner = gpio_dev->groups[group].name;
|
| 1121 | }
|
| 1122 | break;
|
| 1123 | }
|
| 1124 |
|
| 1125 | return 0;
|
| 1126 | }
|
| 1127 |
|
| 1128 | static const struct pinmux_ops amd_pmxops = {
|
| 1129 | .get_functions_count = amd_get_functions_count,
|
| 1130 | .get_function_name = amd_get_fname,
|
| 1131 | .get_function_groups = amd_get_groups,
|
| 1132 | .set_mux = amd_set_mux,
|
| 1133 | };
|
| 1134 |
|
| 1135 | static struct pinctrl_desc amd_pinctrl_desc = {
|
| 1136 | .pins = kerncz_pins,
|
| 1137 | .npins = ARRAY_SIZE(kerncz_pins),
|
| 1138 | .pctlops = &amd_pinctrl_ops,
|
| 1139 | .pmxops = &amd_pmxops,
|
| 1140 | .confops = &amd_pinconf_ops,
|
| 1141 | .owner = THIS_MODULE,
|
| 1142 | };
|
| 1143 |
|
| 1144 | static void amd_get_iomux_res(struct amd_gpio *gpio_dev)
|
| 1145 | {
|
| 1146 | struct pinctrl_desc *desc = &amd_pinctrl_desc;
|
| 1147 | struct device *dev = &gpio_dev->pdev->dev;
|
| 1148 | int index;
|
| 1149 |
|
| 1150 | index = device_property_match_string(dev, "pinctrl-resource-names", "iomux");
|
| 1151 | if (index < 0) {
|
| 1152 | dev_dbg(dev, "iomux not supported\n");
|
| 1153 | goto out_no_pinmux;
|
| 1154 | }
|
| 1155 |
|
| 1156 | gpio_dev->iomux_base = devm_platform_ioremap_resource(gpio_dev->pdev, index);
|
| 1157 | if (IS_ERR(gpio_dev->iomux_base)) {
|
| 1158 | dev_dbg(dev, "iomux not supported %d io resource\n", index);
|
| 1159 | goto out_no_pinmux;
|
| 1160 | }
|
| 1161 |
|
| 1162 | return;
|
| 1163 |
|
| 1164 | out_no_pinmux:
|
| 1165 | desc->pmxops = NULL;
|
| 1166 | }
|
| 1167 |
|
| 1168 | static int amd_gpio_probe(struct platform_device *pdev)
|
| 1169 | {
|
| 1170 | int ret = 0;
|
| 1171 | struct resource *res;
|
| 1172 | struct amd_gpio *gpio_dev;
|
| 1173 | struct gpio_irq_chip *girq;
|
| 1174 |
|
| 1175 | gpio_dev = devm_kzalloc(&pdev->dev,
|
| 1176 | sizeof(struct amd_gpio), GFP_KERNEL);
|
| 1177 | if (!gpio_dev)
|
| 1178 | return -ENOMEM;
|
| 1179 |
|
| 1180 | raw_spin_lock_init(&gpio_dev->lock);
|
| 1181 |
|
| 1182 | gpio_dev->base = devm_platform_get_and_ioremap_resource(pdev, 0, &res);
|
| 1183 | if (IS_ERR(gpio_dev->base)) {
|
| 1184 | dev_err(&pdev->dev, "Failed to get gpio io resource.\n");
|
| 1185 | return PTR_ERR(gpio_dev->base);
|
| 1186 | }
|
| 1187 |
|
| 1188 | gpio_dev->irq = platform_get_irq(pdev, 0);
|
| 1189 | if (gpio_dev->irq < 0)
|
| 1190 | return gpio_dev->irq;
|
| 1191 |
|
| 1192 | #ifdef CONFIG_SUSPEND
|
| 1193 | gpio_dev->saved_regs = devm_kcalloc(&pdev->dev, amd_pinctrl_desc.npins,
|
| 1194 | sizeof(*gpio_dev->saved_regs),
|
| 1195 | GFP_KERNEL);
|
| 1196 | if (!gpio_dev->saved_regs)
|
| 1197 | return -ENOMEM;
|
| 1198 | #endif
|
| 1199 |
|
| 1200 | gpio_dev->pdev = pdev;
|
| 1201 | gpio_dev->gc.get_direction = amd_gpio_get_direction;
|
| 1202 | gpio_dev->gc.direction_input = amd_gpio_direction_input;
|
| 1203 | gpio_dev->gc.direction_output = amd_gpio_direction_output;
|
| 1204 | gpio_dev->gc.get = amd_gpio_get_value;
|
| 1205 | gpio_dev->gc.set = amd_gpio_set_value;
|
| 1206 | gpio_dev->gc.set_config = amd_gpio_set_config;
|
| 1207 | gpio_dev->gc.dbg_show = amd_gpio_dbg_show;
|
| 1208 |
|
| 1209 | gpio_dev->gc.base = -1;
|
| 1210 | gpio_dev->gc.label = pdev->name;
|
| 1211 | gpio_dev->gc.owner = THIS_MODULE;
|
| 1212 | gpio_dev->gc.parent = &pdev->dev;
|
| 1213 | gpio_dev->gc.ngpio = resource_size(res) / 4;
|
| 1214 |
|
| 1215 | gpio_dev->hwbank_num = gpio_dev->gc.ngpio / 64;
|
| 1216 | gpio_dev->groups = kerncz_groups;
|
| 1217 | gpio_dev->ngroups = ARRAY_SIZE(kerncz_groups);
|
| 1218 |
|
| 1219 | amd_pinctrl_desc.name = dev_name(&pdev->dev);
|
| 1220 | amd_get_iomux_res(gpio_dev);
|
| 1221 | gpio_dev->pctrl = devm_pinctrl_register(&pdev->dev, &amd_pinctrl_desc,
|
| 1222 | gpio_dev);
|
| 1223 | if (IS_ERR(gpio_dev->pctrl)) {
|
| 1224 | dev_err(&pdev->dev, "Couldn't register pinctrl driver\n");
|
| 1225 | return PTR_ERR(gpio_dev->pctrl);
|
| 1226 | }
|
| 1227 |
|
| 1228 |
|
| 1229 | amd_gpio_irq_init(gpio_dev);
|
| 1230 |
|
| 1231 | girq = &gpio_dev->gc.irq;
|
| 1232 | gpio_irq_chip_set_chip(girq, &amd_gpio_irqchip);
|
| 1233 |
|
| 1234 | girq->parent_handler = NULL;
|
| 1235 | girq->num_parents = 0;
|
| 1236 | girq->parents = NULL;
|
| 1237 | girq->default_type = IRQ_TYPE_NONE;
|
| 1238 | girq->handler = handle_simple_irq;
|
| 1239 |
|
| 1240 | ret = gpiochip_add_data(&gpio_dev->gc, gpio_dev);
|
| 1241 | if (ret)
|
| 1242 | return ret;
|
| 1243 |
|
| 1244 | ret = gpiochip_add_pin_range(&gpio_dev->gc, dev_name(&pdev->dev),
|
| 1245 | 0, 0, gpio_dev->gc.ngpio);
|
| 1246 | if (ret) {
|
| 1247 | dev_err(&pdev->dev, "Failed to add pin range\n");
|
| 1248 | goto out2;
|
| 1249 | }
|
| 1250 |
|
| 1251 | ret = devm_request_irq(&pdev->dev, gpio_dev->irq, amd_gpio_irq_handler,
|
| 1252 | IRQF_SHARED | IRQF_COND_ONESHOT, KBUILD_MODNAME, gpio_dev);
|
| 1253 | if (ret)
|
| 1254 | goto out2;
|
| 1255 |
|
| 1256 | platform_set_drvdata(pdev, gpio_dev);
|
| 1257 | acpi_register_wakeup_handler(gpio_dev->irq, amd_gpio_check_wake, gpio_dev);
|
| 1258 | amd_gpio_register_s2idle_ops();
|
| 1259 |
|
| 1260 | dev_dbg(&pdev->dev, "amd gpio driver loaded\n");
|
| 1261 | return ret;
|
| 1262 |
|
| 1263 | out2:
|
| 1264 | gpiochip_remove(&gpio_dev->gc);
|
| 1265 |
|
| 1266 | return ret;
|
| 1267 | }
|
| 1268 |
|
| 1269 | static void amd_gpio_remove(struct platform_device *pdev)
|
| 1270 | {
|
| 1271 | struct amd_gpio *gpio_dev;
|
| 1272 |
|
| 1273 | gpio_dev = platform_get_drvdata(pdev);
|
| 1274 |
|
| 1275 | gpiochip_remove(&gpio_dev->gc);
|
| 1276 | acpi_unregister_wakeup_handler(amd_gpio_check_wake, gpio_dev);
|
| 1277 | amd_gpio_unregister_s2idle_ops();
|
| 1278 | }
|
| 1279 |
|
| 1280 | #ifdef CONFIG_ACPI
|
| 1281 | static const struct acpi_device_id amd_gpio_acpi_match[] = {
|
| 1282 | { "AMD0030", 0 },
|
| 1283 | { "AMDI0030", 0},
|
| 1284 | { "AMDI0031", 0},
|
| 1285 | { "AMDI0033", 0},
|
| 1286 | { },
|
| 1287 | };
|
| 1288 | MODULE_DEVICE_TABLE(acpi, amd_gpio_acpi_match);
|
| 1289 | #endif
|
| 1290 |
|
| 1291 | static struct platform_driver amd_gpio_driver = {
|
| 1292 | .driver = {
|
| 1293 | .name = "amd_gpio",
|
| 1294 | .acpi_match_table = ACPI_PTR(amd_gpio_acpi_match),
|
| 1295 | #ifdef CONFIG_PM_SLEEP
|
| 1296 | .pm = &amd_gpio_pm_ops,
|
| 1297 | #endif
|
| 1298 | },
|
| 1299 | .probe = amd_gpio_probe,
|
| 1300 | .remove = amd_gpio_remove,
|
| 1301 | };
|
| 1302 |
|
| 1303 | module_platform_driver(amd_gpio_driver);
|
| 1304 |
|
| 1305 | MODULE_AUTHOR("Ken Xue <[email protected]>, Jeff Wu <[email protected]>");
|
| 1306 | MODULE_DESCRIPTION("AMD GPIO pinctrl driver");
|