drivers/mfd/arizona-irq.c

   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 }