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 static int arizona_map_irq(struct arizona *arizona, int irq) 30 { 31 int ret; 32 33 ret = regmap_irq_get_virq(arizona->aod_irq_chip, irq); 34 if (ret < 0) 35 ret = regmap_irq_get_virq(arizona->irq_chip, irq); 36 37 return ret; 38 } 39 40 int arizona_request_irq(struct arizona *arizona, int irq, char *name, 41 irq_handler_t handler, void *data) 42 { 43 irq = arizona_map_irq(arizona, irq); 44 if (irq < 0) 45 return irq; 46 47 return request_threaded_irq(irq, NULL, handler, IRQF_ONESHOT, 48 name, data); 49 } 50 EXPORT_SYMBOL_GPL(arizona_request_irq); 51 52 void arizona_free_irq(struct arizona *arizona, int irq, void *data) 53 { 54 irq = arizona_map_irq(arizona, irq); 55 if (irq < 0) 56 return; 57 58 free_irq(irq, data); 59 } 60 EXPORT_SYMBOL_GPL(arizona_free_irq); 61 62 int arizona_set_irq_wake(struct arizona *arizona, int irq, int on) 63 { 64 irq = arizona_map_irq(arizona, irq); 65 if (irq < 0) 66 return irq; 67 68 return irq_set_irq_wake(irq, on); 69 } 70 EXPORT_SYMBOL_GPL(arizona_set_irq_wake); 71 72 static irqreturn_t arizona_boot_done(int irq, void *data) 73 { 74 struct arizona *arizona = data; 75 76 dev_dbg(arizona->dev, "Boot done\n"); 77 78 return IRQ_HANDLED; 79 } 80 81 static irqreturn_t arizona_ctrlif_err(int irq, void *data) 82 { 83 struct arizona *arizona = data; 84 85 /* 86 * For pretty much all potential sources a register cache sync 87 * won't help, we've just got a software bug somewhere. 88 */ 89 dev_err(arizona->dev, "Control interface error\n"); 90 91 return IRQ_HANDLED; 92 } 93 94 static irqreturn_t arizona_irq_thread(int irq, void *data) 95 { 96 struct arizona *arizona = data; 97 bool poll; 98 unsigned int val; 99 int ret; 100 101 ret = pm_runtime_get_sync(arizona->dev); 102 if (ret < 0) { 103 dev_err(arizona->dev, "Failed to resume device: %d\n", ret); 104 return IRQ_NONE; 105 } 106 107 do { 108 poll = false; 109 110 /* Always handle the AoD domain */ 111 handle_nested_irq(irq_find_mapping(arizona->virq, 0)); 112 113 /* 114 * Check if one of the main interrupts is asserted and only 115 * check that domain if it is. 116 */ 117 ret = regmap_read(arizona->regmap, ARIZONA_IRQ_PIN_STATUS, 118 &val); 119 if (ret == 0 && val & ARIZONA_IRQ1_STS) { 120 handle_nested_irq(irq_find_mapping(arizona->virq, 1)); 121 } else if (ret != 0) { 122 dev_err(arizona->dev, 123 "Failed to read main IRQ status: %d\n", ret); 124 } 125 126 /* 127 * Poll the IRQ pin status to see if we're really done 128 * if the interrupt controller can't do it for us. 129 */ 130 if (!arizona->pdata.irq_gpio) { 131 break; 132 } else if (arizona->pdata.irq_flags & IRQF_TRIGGER_RISING && 133 gpio_get_value_cansleep(arizona->pdata.irq_gpio)) { 134 poll = true; 135 } else if (arizona->pdata.irq_flags & IRQF_TRIGGER_FALLING && 136 !gpio_get_value_cansleep(arizona->pdata.irq_gpio)) { 137 poll = true; 138 } 139 } while (poll); 140 141 pm_runtime_mark_last_busy(arizona->dev); 142 pm_runtime_put_autosuspend(arizona->dev); 143 144 return IRQ_HANDLED; 145 } 146 147 static void arizona_irq_enable(struct irq_data *data) 148 { 149 } 150 151 static void arizona_irq_disable(struct irq_data *data) 152 { 153 } 154 155 static struct irq_chip arizona_irq_chip = { 156 .name = "arizona", 157 .irq_disable = arizona_irq_disable, 158 .irq_enable = arizona_irq_enable, 159 }; 160 161 static int arizona_irq_map(struct irq_domain *h, unsigned int virq, 162 irq_hw_number_t hw) 163 { 164 struct regmap_irq_chip_data *data = h->host_data; 165 166 irq_set_chip_data(virq, data); 167 irq_set_chip_and_handler(virq, &arizona_irq_chip, handle_edge_irq); 168 irq_set_nested_thread(virq, 1); 169 170 /* ARM needs us to explicitly flag the IRQ as valid 171 * and will set them noprobe when we do so. */ 172 #ifdef CONFIG_ARM 173 set_irq_flags(virq, IRQF_VALID); 174 #else 175 irq_set_noprobe(virq); 176 #endif 177 178 return 0; 179 } 180 181 static struct irq_domain_ops arizona_domain_ops = { 182 .map = arizona_irq_map, 183 .xlate = irq_domain_xlate_twocell, 184 }; 185 186 int arizona_irq_init(struct arizona *arizona) 187 { 188 int flags = IRQF_ONESHOT; 189 int ret, i; 190 const struct regmap_irq_chip *aod, *irq; 191 bool ctrlif_error = true; 192 struct irq_data *irq_data; 193 194 switch (arizona->type) { 195 #ifdef CONFIG_MFD_WM5102 196 case WM5102: 197 aod = &wm5102_aod; 198 irq = &wm5102_irq; 199 200 ctrlif_error = false; 201 break; 202 #endif 203 #ifdef CONFIG_MFD_WM5110 204 case WM5110: 205 aod = &wm5110_aod; 206 irq = &wm5110_irq; 207 208 ctrlif_error = false; 209 break; 210 #endif 211 default: 212 BUG_ON("Unknown Arizona class device" == NULL); 213 return -EINVAL; 214 } 215 216 /* Disable all wake sources by default */ 217 regmap_write(arizona->regmap, ARIZONA_WAKE_CONTROL, 0); 218 219 /* Read the flags from the interrupt controller if not specified */ 220 if (!arizona->pdata.irq_flags) { 221 irq_data = irq_get_irq_data(arizona->irq); 222 if (!irq_data) { 223 dev_err(arizona->dev, "Invalid IRQ: %d\n", 224 arizona->irq); 225 return -EINVAL; 226 } 227 228 arizona->pdata.irq_flags = irqd_get_trigger_type(irq_data); 229 switch (arizona->pdata.irq_flags) { 230 case IRQF_TRIGGER_LOW: 231 case IRQF_TRIGGER_HIGH: 232 case IRQF_TRIGGER_RISING: 233 case IRQF_TRIGGER_FALLING: 234 break; 235 236 case IRQ_TYPE_NONE: 237 default: 238 /* Device default */ 239 arizona->pdata.irq_flags = IRQF_TRIGGER_LOW; 240 break; 241 } 242 } 243 244 if (arizona->pdata.irq_flags & (IRQF_TRIGGER_HIGH | 245 IRQF_TRIGGER_RISING)) { 246 ret = regmap_update_bits(arizona->regmap, ARIZONA_IRQ_CTRL_1, 247 ARIZONA_IRQ_POL, 0); 248 if (ret != 0) { 249 dev_err(arizona->dev, "Couldn't set IRQ polarity: %d\n", 250 ret); 251 goto err; 252 } 253 } 254 255 flags |= arizona->pdata.irq_flags; 256 257 /* Allocate a virtual IRQ domain to distribute to the regmap domains */ 258 arizona->virq = irq_domain_add_linear(NULL, 2, &arizona_domain_ops, 259 arizona); 260 if (!arizona->virq) { 261 dev_err(arizona->dev, "Failed to add core IRQ domain\n"); 262 ret = -EINVAL; 263 goto err; 264 } 265 266 ret = regmap_add_irq_chip(arizona->regmap, 267 irq_create_mapping(arizona->virq, 0), 268 IRQF_ONESHOT, -1, aod, 269 &arizona->aod_irq_chip); 270 if (ret != 0) { 271 dev_err(arizona->dev, "Failed to add AOD IRQs: %d\n", ret); 272 goto err_domain; 273 } 274 275 ret = regmap_add_irq_chip(arizona->regmap, 276 irq_create_mapping(arizona->virq, 1), 277 IRQF_ONESHOT, -1, irq, 278 &arizona->irq_chip); 279 if (ret != 0) { 280 dev_err(arizona->dev, "Failed to add AOD IRQs: %d\n", ret); 281 goto err_aod; 282 } 283 284 /* Make sure the boot done IRQ is unmasked for resumes */ 285 i = arizona_map_irq(arizona, ARIZONA_IRQ_BOOT_DONE); 286 ret = request_threaded_irq(i, NULL, arizona_boot_done, IRQF_ONESHOT, 287 "Boot done", arizona); 288 if (ret != 0) { 289 dev_err(arizona->dev, "Failed to request boot done %d: %d\n", 290 arizona->irq, ret); 291 goto err_boot_done; 292 } 293 294 /* Handle control interface errors in the core */ 295 if (ctrlif_error) { 296 i = arizona_map_irq(arizona, ARIZONA_IRQ_CTRLIF_ERR); 297 ret = request_threaded_irq(i, NULL, arizona_ctrlif_err, 298 IRQF_ONESHOT, 299 "Control interface error", arizona); 300 if (ret != 0) { 301 dev_err(arizona->dev, 302 "Failed to request CTRLIF_ERR %d: %d\n", 303 arizona->irq, ret); 304 goto err_ctrlif; 305 } 306 } 307 308 /* Used to emulate edge trigger and to work around broken pinmux */ 309 if (arizona->pdata.irq_gpio) { 310 if (gpio_to_irq(arizona->pdata.irq_gpio) != arizona->irq) { 311 dev_warn(arizona->dev, "IRQ %d is not GPIO %d (%d)\n", 312 arizona->irq, arizona->pdata.irq_gpio, 313 gpio_to_irq(arizona->pdata.irq_gpio)); 314 arizona->irq = gpio_to_irq(arizona->pdata.irq_gpio); 315 } 316 317 ret = devm_gpio_request_one(arizona->dev, 318 arizona->pdata.irq_gpio, 319 GPIOF_IN, "arizona IRQ"); 320 if (ret != 0) { 321 dev_err(arizona->dev, 322 "Failed to request IRQ GPIO %d:: %d\n", 323 arizona->pdata.irq_gpio, ret); 324 arizona->pdata.irq_gpio = 0; 325 } 326 } 327 328 ret = request_threaded_irq(arizona->irq, NULL, arizona_irq_thread, 329 flags, "arizona", arizona); 330 331 if (ret != 0) { 332 dev_err(arizona->dev, "Failed to request primary IRQ %d: %d\n", 333 arizona->irq, ret); 334 goto err_main_irq; 335 } 336 337 return 0; 338 339 err_main_irq: 340 free_irq(arizona_map_irq(arizona, ARIZONA_IRQ_CTRLIF_ERR), arizona); 341 err_ctrlif: 342 free_irq(arizona_map_irq(arizona, ARIZONA_IRQ_BOOT_DONE), arizona); 343 err_boot_done: 344 regmap_del_irq_chip(irq_create_mapping(arizona->virq, 1), 345 arizona->irq_chip); 346 err_aod: 347 regmap_del_irq_chip(irq_create_mapping(arizona->virq, 0), 348 arizona->aod_irq_chip); 349 err_domain: 350 err: 351 return ret; 352 } 353 354 int arizona_irq_exit(struct arizona *arizona) 355 { 356 free_irq(arizona_map_irq(arizona, ARIZONA_IRQ_CTRLIF_ERR), arizona); 357 free_irq(arizona_map_irq(arizona, ARIZONA_IRQ_BOOT_DONE), arizona); 358 regmap_del_irq_chip(irq_create_mapping(arizona->virq, 1), 359 arizona->irq_chip); 360 regmap_del_irq_chip(irq_create_mapping(arizona->virq, 0), 361 arizona->aod_irq_chip); 362 free_irq(arizona->irq, arizona); 363 364 return 0; 365 } 366