LCOV - code coverage report
Current view: top level - drivers/mfd - arizona-irq.c (source / functions) Hit Total Coverage
Test: Real Lines: 0 142 0.0 %
Date: 2020-10-17 15:46:43 Functions: 0 13 0.0 %
Legend: Neither, QEMU, Real, Both Branches: 0 0 -

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

Generated by: LCOV version 1.14