drivers/bcma/driver_gpio.c

   1 /*
   2  * Broadcom specific AMBA
   3  * GPIO driver
   4  *
   5  * Copyright 2011, Broadcom Corporation
   6  * Copyright 2012, Hauke Mehrtens <hauke@hauke-m.de>
   7  *
   8  * Licensed under the GNU/GPL. See COPYING for details.
   9  */
  10
  11 #include <linux/gpio.h>
  12 #include <linux/irq.h>
  13 #include <linux/interrupt.h>
  14 #include <linux/irqdomain.h>
  15 #include <linux/export.h>
  16 #include <linux/bcma/bcma.h>
  17
  18 #include "bcma_private.h"
  19
  20 static inline struct bcma_drv_cc *bcma_gpio_get_cc(struct gpio_chip *chip)
  21 {
  22         return container_of(chip, struct bcma_drv_cc, gpio);
  23 }
  24
  25 static int bcma_gpio_get_value(struct gpio_chip *chip, unsigned gpio)
  26 {
  27         struct bcma_drv_cc *cc = bcma_gpio_get_cc(chip);
  28
  29         return !!bcma_chipco_gpio_in(cc, 1 << gpio);
  30 }
  31
  32 static void bcma_gpio_set_value(struct gpio_chip *chip, unsigned gpio,
  33                                 int value)
  34 {
  35         struct bcma_drv_cc *cc = bcma_gpio_get_cc(chip);
  36
  37         bcma_chipco_gpio_out(cc, 1 << gpio, value ? 1 << gpio : 0);
  38 }
  39
  40 static int bcma_gpio_direction_input(struct gpio_chip *chip, unsigned gpio)
  41 {
  42         struct bcma_drv_cc *cc = bcma_gpio_get_cc(chip);
  43
  44         bcma_chipco_gpio_outen(cc, 1 << gpio, 0);
  45         return 0;
  46 }
  47
  48 static int bcma_gpio_direction_output(struct gpio_chip *chip, unsigned gpio,
  49                                       int value)
  50 {
  51         struct bcma_drv_cc *cc = bcma_gpio_get_cc(chip);
  52
  53         bcma_chipco_gpio_outen(cc, 1 << gpio, 1 << gpio);
  54         bcma_chipco_gpio_out(cc, 1 << gpio, value ? 1 << gpio : 0);
  55         return 0;
  56 }
  57
  58 static int bcma_gpio_request(struct gpio_chip *chip, unsigned gpio)
  59 {
  60         struct bcma_drv_cc *cc = bcma_gpio_get_cc(chip);
  61
  62         bcma_chipco_gpio_control(cc, 1 << gpio, 0);
  63         /* clear pulldown */
  64         bcma_chipco_gpio_pulldown(cc, 1 << gpio, 0);
  65         /* Set pullup */
  66         bcma_chipco_gpio_pullup(cc, 1 << gpio, 1 << gpio);
  67
  68         return 0;
  69 }
  70
  71 static void bcma_gpio_free(struct gpio_chip *chip, unsigned gpio)
  72 {
  73         struct bcma_drv_cc *cc = bcma_gpio_get_cc(chip);
  74
  75         /* clear pullup */
  76         bcma_chipco_gpio_pullup(cc, 1 << gpio, 0);
  77 }
  78
  79 #if IS_BUILTIN(CONFIG_BCMA_HOST_SOC)
  80 static int bcma_gpio_to_irq(struct gpio_chip *chip, unsigned gpio)
  81 {
  82         struct bcma_drv_cc *cc = bcma_gpio_get_cc(chip);
  83
  84         if (cc->core->bus->hosttype == BCMA_HOSTTYPE_SOC)
  85                 return irq_find_mapping(cc->irq_domain, gpio);
  86         else
  87                 return -EINVAL;
  88 }
  89
  90 static void bcma_gpio_irq_unmask(struct irq_data *d)
  91 {
  92         struct bcma_drv_cc *cc = irq_data_get_irq_chip_data(d);
  93         int gpio = irqd_to_hwirq(d);
  94
  95         bcma_chipco_gpio_intmask(cc, BIT(gpio), BIT(gpio));
  96 }
  97
  98 static void bcma_gpio_irq_mask(struct irq_data *d)
  99 {
 100         struct bcma_drv_cc *cc = irq_data_get_irq_chip_data(d);
 101         int gpio = irqd_to_hwirq(d);
 102
 103         bcma_chipco_gpio_intmask(cc, BIT(gpio), 0);
 104 }
 105
 106 static struct irq_chip bcma_gpio_irq_chip = {
 107         .name           = "BCMA-GPIO",
 108         .irq_mask       = bcma_gpio_irq_mask,
 109         .irq_unmask     = bcma_gpio_irq_unmask,
 110 };
 111
 112 static irqreturn_t bcma_gpio_irq_handler(int irq, void *dev_id)
 113 {
 114         struct bcma_drv_cc *cc = dev_id;
 115         u32 val = bcma_cc_read32(cc, BCMA_CC_GPIOIN);
 116         u32 mask = bcma_cc_read32(cc, BCMA_CC_GPIOIRQ);
 117         u32 pol = bcma_cc_read32(cc, BCMA_CC_GPIOPOL);
 118         u32 irqs = (val ^ pol) & mask;
 119         int gpio;
 120
 121         if (!irqs)
 122                 return IRQ_NONE;
 123
 124         for_each_set_bit(gpio, (unsigned long *)&irqs, cc->gpio.ngpio)
 125                 generic_handle_irq(bcma_gpio_to_irq(&cc->gpio, gpio));
 126         bcma_chipco_gpio_polarity(cc, irqs, val & irqs);
 127
 128         return IRQ_HANDLED;
 129 }
 130
 131 static int bcma_gpio_irq_domain_init(struct bcma_drv_cc *cc)
 132 {
 133         struct gpio_chip *chip = &cc->gpio;
 134         int gpio, hwirq, err;
 135
 136         if (cc->core->bus->hosttype != BCMA_HOSTTYPE_SOC)
 137                 return 0;
 138
 139         cc->irq_domain = irq_domain_add_linear(NULL, chip->ngpio,
 140                                                &irq_domain_simple_ops, cc);
 141         if (!cc->irq_domain) {
 142                 err = -ENODEV;
 143                 goto err_irq_domain;
 144         }
 145         for (gpio = 0; gpio < chip->ngpio; gpio++) {
 146                 int irq = irq_create_mapping(cc->irq_domain, gpio);
 147
 148                 irq_set_chip_data(irq, cc);
 149                 irq_set_chip_and_handler(irq, &bcma_gpio_irq_chip,
 150                                          handle_simple_irq);
 151         }
 152
 153         hwirq = bcma_core_irq(cc->core);
 154         err = request_irq(hwirq, bcma_gpio_irq_handler, IRQF_SHARED, "gpio",
 155                           cc);
 156         if (err)
 157                 goto err_req_irq;
 158
 159         bcma_cc_set32(cc, BCMA_CC_IRQMASK, BCMA_CC_IRQ_GPIO);
 160
 161         return 0;
 162
 163 err_req_irq:
 164         for (gpio = 0; gpio < chip->ngpio; gpio++) {
 165                 int irq = irq_find_mapping(cc->irq_domain, gpio);
 166
 167                 irq_dispose_mapping(irq);
 168         }
 169         irq_domain_remove(cc->irq_domain);
 170 err_irq_domain:
 171         return err;
 172 }
 173
 174 static void bcma_gpio_irq_domain_exit(struct bcma_drv_cc *cc)
 175 {
 176         struct gpio_chip *chip = &cc->gpio;
 177         int gpio;
 178
 179         if (cc->core->bus->hosttype != BCMA_HOSTTYPE_SOC)
 180                 return;
 181
 182         bcma_cc_mask32(cc, BCMA_CC_IRQMASK, ~BCMA_CC_IRQ_GPIO);
 183         free_irq(bcma_core_irq(cc->core), cc);
 184         for (gpio = 0; gpio < chip->ngpio; gpio++) {
 185                 int irq = irq_find_mapping(cc->irq_domain, gpio);
 186
 187                 irq_dispose_mapping(irq);
 188         }
 189         irq_domain_remove(cc->irq_domain);
 190 }
 191 #else
 192 static int bcma_gpio_irq_domain_init(struct bcma_drv_cc *cc)
 193 {
 194         return 0;
 195 }
 196
 197 static void bcma_gpio_irq_domain_exit(struct bcma_drv_cc *cc)
 198 {
 199 }
 200 #endif
 201
 202 int bcma_gpio_init(struct bcma_drv_cc *cc)
 203 {
 204         struct gpio_chip *chip = &cc->gpio;
 205         int err;
 206
 207         chip->label             = "bcma_gpio";
 208         chip->owner             = THIS_MODULE;
 209         chip->request           = bcma_gpio_request;
 210         chip->free              = bcma_gpio_free;
 211         chip->get               = bcma_gpio_get_value;
 212         chip->set               = bcma_gpio_set_value;
 213         chip->direction_input   = bcma_gpio_direction_input;
 214         chip->direction_output  = bcma_gpio_direction_output;
 215 #if IS_BUILTIN(CONFIG_BCMA_HOST_SOC)
 216         chip->to_irq            = bcma_gpio_to_irq;
 217 #endif
 218         chip->ngpio             = 16;
 219         /* There is just one SoC in one device and its GPIO addresses should be
 220          * deterministic to address them more easily. The other buses could get
 221          * a random base number. */
 222         if (cc->core->bus->hosttype == BCMA_HOSTTYPE_SOC)
 223                 chip->base              = 0;
 224         else
 225                 chip->base              = -1;
 226
 227         err = bcma_gpio_irq_domain_init(cc);
 228         if (err)
 229                 return err;
 230
 231         err = gpiochip_add(chip);
 232         if (err) {
 233                 bcma_gpio_irq_domain_exit(cc);
 234                 return err;
 235         }
 236
 237         return 0;
 238 }
 239
 240 int bcma_gpio_unregister(struct bcma_drv_cc *cc)
 241 {
 242         bcma_gpio_irq_domain_exit(cc);
 243         return gpiochip_remove(&cc->gpio);
 244 }