1 /* 2 * Arizona interrupt support 3 * 4 * Copyright 2012 Wolfson Microelectronics plc 5 * 6 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com> 7 * 8 * This program is free software; you can redistribute it and/or modify 9 * it under the terms of the GNU General Public License version 2 as 10 * published by the Free Software Foundation. 11 */ 12 13 #include <linux/delay.h> 14 #include <linux/gpio.h> 15 #include <linux/interrupt.h> 16 #include <linux/irq.h> 17 #include <linux/irqdomain.h> 18 #include <linux/module.h> 19 #include <linux/pm_runtime.h> 20 #include <linux/regmap.h> 21 #include <linux/regulator/consumer.h> 22 #include <linux/slab.h> 23 24 #include <linux/mfd/arizona/core.h> 25 #include <linux/mfd/arizona/registers.h> 26 27 #include "arizona.h" 28 29 #define ARIZONA_AOD_IRQ_INDEX 0 30 #define ARIZONA_MAIN_IRQ_INDEX 1 31 32 static int arizona_map_irq(struct arizona *arizona, int irq) 33 { 34 int ret; 35 36 if (arizona->aod_irq_chip) { 37 ret = regmap_irq_get_virq(arizona->aod_irq_chip, irq); 38 if (ret >= 0) 39 return ret; 40 } 41 42 return regmap_irq_get_virq(arizona->irq_chip, irq); 43 } 44 45 int arizona_request_irq(struct arizona *arizona, int irq, char *name, 46 irq_handler_t handler, void *data) 47 { 48 irq = arizona_map_irq(arizona, irq); 49 if (irq < 0) 50 return irq; 51 52 return request_threaded_irq(irq, NULL, handler, IRQF_ONESHOT, 53 name, data); 54 } 55 EXPORT_SYMBOL_GPL(arizona_request_irq); 56 57 void arizona_free_irq(struct arizona *arizona, int irq, void *data) 58 { 59 irq = arizona_map_irq(arizona, irq); 60 if (irq < 0) 61 return; 62 63 free_irq(irq, data); 64 } 65 EXPORT_SYMBOL_GPL(arizona_free_irq); 66 67 int arizona_set_irq_wake(struct arizona *arizona, int irq, int on) 68 { 69 irq = arizona_map_irq(arizona, irq); 70 if (irq < 0) 71 return irq; 72 73 return irq_set_irq_wake(irq, on); 74 } 75 EXPORT_SYMBOL_GPL(arizona_set_irq_wake); 76 77 static irqreturn_t arizona_boot_done(int irq, void *data) 78 { 79 struct arizona *arizona = data; 80 81 dev_dbg(arizona->dev, "Boot done\n"); 82 83 return IRQ_HANDLED; 84 } 85 86 static irqreturn_t arizona_ctrlif_err(int irq, void *data) 87 { 88 struct arizona *arizona = data; 89 90 /* 91 * For pretty much all potential sources a register cache sync 92 * won't help, we've just got a software bug somewhere. 93 */ 94 dev_err(arizona->dev, "Control interface error\n"); 95 96 return IRQ_HANDLED; 97 } 98 99 static irqreturn_t arizona_irq_thread(int irq, void *data) 100 { 101 struct arizona *arizona = data; 102 bool poll; 103 unsigned int val; 104 int ret; 105 106 ret = pm_runtime_get_sync(arizona->dev); 107 if (ret < 0) { 108 dev_err(arizona->dev, "Failed to resume device: %d\n", ret); 109 return IRQ_NONE; 110 } 111 112 do { 113 poll = false; 114 115 if (arizona->aod_irq_chip) { 116 /* 117 * Check the AOD status register to determine whether 118 * the nested IRQ handler should be called. 119 */ 120 ret = regmap_read(arizona->regmap, 121 ARIZONA_AOD_IRQ1, &val); 122 if (ret) 123 dev_warn(arizona->dev, 124 "Failed to read AOD IRQ1 %d\n", ret); 125 else if (val) 126 handle_nested_irq( 127 irq_find_mapping(arizona->virq, 0)); 128 } 129 130 /* 131 * Check if one of the main interrupts is asserted and only 132 * check that domain if it is. 133 */ 134 ret = regmap_read(arizona->regmap, ARIZONA_IRQ_PIN_STATUS, 135 &val); 136 if (ret == 0 && val & ARIZONA_IRQ1_STS) { 137 handle_nested_irq(irq_find_mapping(arizona->virq, 1)); 138 } else if (ret != 0) { 139 dev_err(arizona->dev, 140 "Failed to read main IRQ status: %d\n", ret); 141 } 142 143 /* 144 * Poll the IRQ pin status to see if we're really done 145 * if the interrupt controller can't do it for us. 146 */ 147 if (!arizona->pdata.irq_gpio) { 148 break; 149 } else if (arizona->pdata.irq_flags & IRQF_TRIGGER_RISING && 150 gpio_get_value_cansleep(arizona->pdata.irq_gpio)) { 151 poll = true; 152 } else if (arizona->pdata.irq_flags & IRQF_TRIGGER_FALLING && 153 !gpio_get_value_cansleep(arizona->pdata.irq_gpio)) { 154 poll = true; 155 } 156 } while (poll); 157 158 pm_runtime_mark_last_busy(arizona->dev); 159 pm_runtime_put_autosuspend(arizona->dev); 160 161 return IRQ_HANDLED; 162 } 163 164 static void arizona_irq_enable(struct irq_data *data) 165 { 166 } 167 168 static void arizona_irq_disable(struct irq_data *data) 169 { 170 } 171 172 static int arizona_irq_set_wake(struct irq_data *data, unsigned int on) 173 { 174 struct arizona *arizona = irq_data_get_irq_chip_data(data); 175 176 return irq_set_irq_wake(arizona->irq, on); 177 } 178 179 static struct irq_chip arizona_irq_chip = { 180 .name = "arizona", 181 .irq_disable = arizona_irq_disable, 182 .irq_enable = arizona_irq_enable, 183 .irq_set_wake = arizona_irq_set_wake, 184 }; 185 186 static struct lock_class_key arizona_irq_lock_class; 187 188 static int arizona_irq_map(struct irq_domain *h, unsigned int virq, 189 irq_hw_number_t hw) 190 { 191 struct arizona *data = h->host_data; 192 193 irq_set_chip_data(virq, data); 194 irq_set_lockdep_class(virq, &arizona_irq_lock_class); 195 irq_set_chip_and_handler(virq, &arizona_irq_chip, handle_simple_irq); 196 irq_set_nested_thread(virq, 1); 197 irq_set_noprobe(virq); 198 199 return 0; 200 } 201 202 static const struct irq_domain_ops arizona_domain_ops = { 203 .map = arizona_irq_map, 204 .xlate = irq_domain_xlate_twocell, 205 }; 206 207 int arizona_irq_init(struct arizona *arizona) 208 { 209 int flags = IRQF_ONESHOT; 210 int ret; 211 const struct regmap_irq_chip *aod, *irq; 212 struct irq_data *irq_data; 213 unsigned int virq; 214 215 arizona->ctrlif_error = true; 216 217 switch (arizona->type) { 218 #ifdef CONFIG_MFD_WM5102 219 case WM5102: 220 aod = &wm5102_aod; 221 irq = &wm5102_irq; 222 223 arizona->ctrlif_error = false; 224 break; 225 #endif 226 #ifdef CONFIG_MFD_WM5110 227 case WM5110: 228 case WM8280: 229 aod = &wm5110_aod; 230 231 switch (arizona->rev) { 232 case 0 ... 2: 233 irq = &wm5110_irq; 234 break; 235 default: 236 irq = &wm5110_revd_irq; 237 break; 238 } 239 240 arizona->ctrlif_error = false; 241 break; 242 #endif 243 #ifdef CONFIG_MFD_CS47L24 244 case WM1831: 245 case CS47L24: 246 aod = NULL; 247 irq = &cs47l24_irq; 248 249 arizona->ctrlif_error = false; 250 break; 251 #endif 252 #ifdef CONFIG_MFD_WM8997 253 case WM8997: 254 aod = &wm8997_aod; 255 irq = &wm8997_irq; 256 257 arizona->ctrlif_error = false; 258 break; 259 #endif 260 #ifdef CONFIG_MFD_WM8998 261 case WM8998: 262 case WM1814: 263 aod = &wm8998_aod; 264 irq = &wm8998_irq; 265 266 arizona->ctrlif_error = false; 267 break; 268 #endif 269 default: 270 BUG_ON("Unknown Arizona class device" == NULL); 271 return -EINVAL; 272 } 273 274 /* Disable all wake sources by default */ 275 regmap_write(arizona->regmap, ARIZONA_WAKE_CONTROL, 0); 276 277 /* Read the flags from the interrupt controller if not specified */ 278 if (!arizona->pdata.irq_flags) { 279 irq_data = irq_get_irq_data(arizona->irq); 280 if (!irq_data) { 281 dev_err(arizona->dev, "Invalid IRQ: %d\n", 282 arizona->irq); 283 return -EINVAL; 284 } 285 286 arizona->pdata.irq_flags = irqd_get_trigger_type(irq_data); 287 switch (arizona->pdata.irq_flags) { 288 case IRQF_TRIGGER_LOW: 289 case IRQF_TRIGGER_HIGH: 290 case IRQF_TRIGGER_RISING: 291 case IRQF_TRIGGER_FALLING: 292 break; 293 294 case IRQ_TYPE_NONE: 295 default: 296 /* Device default */ 297 arizona->pdata.irq_flags = IRQF_TRIGGER_LOW; 298 break; 299 } 300 } 301 302 if (arizona->pdata.irq_flags & (IRQF_TRIGGER_HIGH | 303 IRQF_TRIGGER_RISING)) { 304 ret = regmap_update_bits(arizona->regmap, ARIZONA_IRQ_CTRL_1, 305 ARIZONA_IRQ_POL, 0); 306 if (ret != 0) { 307 dev_err(arizona->dev, "Couldn't set IRQ polarity: %d\n", 308 ret); 309 goto err; 310 } 311 } 312 313 flags |= arizona->pdata.irq_flags; 314 315 /* Allocate a virtual IRQ domain to distribute to the regmap domains */ 316 arizona->virq = irq_domain_add_linear(NULL, 2, &arizona_domain_ops, 317 arizona); 318 if (!arizona->virq) { 319 dev_err(arizona->dev, "Failed to add core IRQ domain\n"); 320 ret = -EINVAL; 321 goto err; 322 } 323 324 if (aod) { 325 virq = irq_create_mapping(arizona->virq, ARIZONA_AOD_IRQ_INDEX); 326 if (!virq) { 327 dev_err(arizona->dev, "Failed to map AOD IRQs\n"); 328 ret = -EINVAL; 329 goto err_domain; 330 } 331 332 ret = regmap_add_irq_chip(arizona->regmap, virq, IRQF_ONESHOT, 333 0, aod, &arizona->aod_irq_chip); 334 if (ret != 0) { 335 dev_err(arizona->dev, 336 "Failed to add AOD IRQs: %d\n", ret); 337 goto err_map_aod; 338 } 339 } 340 341 virq = irq_create_mapping(arizona->virq, ARIZONA_MAIN_IRQ_INDEX); 342 if (!virq) { 343 dev_err(arizona->dev, "Failed to map main IRQs\n"); 344 ret = -EINVAL; 345 goto err_aod; 346 } 347 348 ret = regmap_add_irq_chip(arizona->regmap, virq, IRQF_ONESHOT, 349 0, irq, &arizona->irq_chip); 350 if (ret != 0) { 351 dev_err(arizona->dev, "Failed to add main IRQs: %d\n", ret); 352 goto err_map_main_irq; 353 } 354 355 /* Used to emulate edge trigger and to work around broken pinmux */ 356 if (arizona->pdata.irq_gpio) { 357 if (gpio_to_irq(arizona->pdata.irq_gpio) != arizona->irq) { 358 dev_warn(arizona->dev, "IRQ %d is not GPIO %d (%d)\n", 359 arizona->irq, arizona->pdata.irq_gpio, 360 gpio_to_irq(arizona->pdata.irq_gpio)); 361 arizona->irq = gpio_to_irq(arizona->pdata.irq_gpio); 362 } 363 364 ret = devm_gpio_request_one(arizona->dev, 365 arizona->pdata.irq_gpio, 366 GPIOF_IN, "arizona IRQ"); 367 if (ret != 0) { 368 dev_err(arizona->dev, 369 "Failed to request IRQ GPIO %d:: %d\n", 370 arizona->pdata.irq_gpio, ret); 371 arizona->pdata.irq_gpio = 0; 372 } 373 } 374 375 ret = request_threaded_irq(arizona->irq, NULL, arizona_irq_thread, 376 flags, "arizona", arizona); 377 378 if (ret != 0) { 379 dev_err(arizona->dev, "Failed to request primary IRQ %d: %d\n", 380 arizona->irq, ret); 381 goto err_main_irq; 382 } 383 384 /* Make sure the boot done IRQ is unmasked for resumes */ 385 ret = arizona_request_irq(arizona, ARIZONA_IRQ_BOOT_DONE, "Boot done", 386 arizona_boot_done, arizona); 387 if (ret != 0) { 388 dev_err(arizona->dev, "Failed to request boot done %d: %d\n", 389 arizona->irq, ret); 390 goto err_boot_done; 391 } 392 393 /* Handle control interface errors in the core */ 394 if (arizona->ctrlif_error) { 395 ret = arizona_request_irq(arizona, ARIZONA_IRQ_CTRLIF_ERR, 396 "Control interface error", 397 arizona_ctrlif_err, arizona); 398 if (ret != 0) { 399 dev_err(arizona->dev, 400 "Failed to request CTRLIF_ERR %d: %d\n", 401 arizona->irq, ret); 402 goto err_ctrlif; 403 } 404 } 405 406 return 0; 407 408 err_ctrlif: 409 arizona_free_irq(arizona, ARIZONA_IRQ_BOOT_DONE, arizona); 410 err_boot_done: 411 free_irq(arizona->irq, arizona); 412 err_main_irq: 413 regmap_del_irq_chip(irq_find_mapping(arizona->virq, 414 ARIZONA_MAIN_IRQ_INDEX), 415 arizona->irq_chip); 416 err_map_main_irq: 417 irq_dispose_mapping(irq_find_mapping(arizona->virq, 418 ARIZONA_MAIN_IRQ_INDEX)); 419 err_aod: 420 regmap_del_irq_chip(irq_find_mapping(arizona->virq, 421 ARIZONA_AOD_IRQ_INDEX), 422 arizona->aod_irq_chip); 423 err_map_aod: 424 irq_dispose_mapping(irq_find_mapping(arizona->virq, 425 ARIZONA_AOD_IRQ_INDEX)); 426 err_domain: 427 irq_domain_remove(arizona->virq); 428 err: 429 return ret; 430 } 431 432 int arizona_irq_exit(struct arizona *arizona) 433 { 434 unsigned int virq; 435 436 if (arizona->ctrlif_error) 437 arizona_free_irq(arizona, ARIZONA_IRQ_CTRLIF_ERR, arizona); 438 arizona_free_irq(arizona, ARIZONA_IRQ_BOOT_DONE, arizona); 439 440 virq = irq_find_mapping(arizona->virq, ARIZONA_MAIN_IRQ_INDEX); 441 regmap_del_irq_chip(virq, arizona->irq_chip); 442 irq_dispose_mapping(virq); 443 444 virq = irq_find_mapping(arizona->virq, ARIZONA_AOD_IRQ_INDEX); 445 regmap_del_irq_chip(virq, arizona->aod_irq_chip); 446 irq_dispose_mapping(virq); 447 448 irq_domain_remove(arizona->virq); 449 450 free_irq(arizona->irq, arizona); 451 452 return 0; 453 } 454