479 lines · c
1/*2 * Sonics Silicon Backplane3 * GPIO driver4 *5 * Copyright 2011, Broadcom Corporation6 * Copyright 2012, Hauke Mehrtens <hauke@hauke-m.de>7 *8 * Licensed under the GNU/GPL. See COPYING for details.9 */10 11#include "ssb_private.h"12 13#include <linux/gpio/driver.h>14#include <linux/irq.h>15#include <linux/interrupt.h>16#include <linux/irqdomain.h>17#include <linux/export.h>18#include <linux/ssb/ssb.h>19 20 21/**************************************************22 * Shared23 **************************************************/24 25#if IS_ENABLED(CONFIG_SSB_EMBEDDED)26static int ssb_gpio_to_irq(struct gpio_chip *chip, unsigned int gpio)27{28 struct ssb_bus *bus = gpiochip_get_data(chip);29 30 if (bus->bustype == SSB_BUSTYPE_SSB)31 return irq_find_mapping(bus->irq_domain, gpio);32 else33 return -EINVAL;34}35#endif36 37/**************************************************38 * ChipCommon39 **************************************************/40 41static int ssb_gpio_chipco_get_value(struct gpio_chip *chip, unsigned int gpio)42{43 struct ssb_bus *bus = gpiochip_get_data(chip);44 45 return !!ssb_chipco_gpio_in(&bus->chipco, 1 << gpio);46}47 48static void ssb_gpio_chipco_set_value(struct gpio_chip *chip, unsigned int gpio,49 int value)50{51 struct ssb_bus *bus = gpiochip_get_data(chip);52 53 ssb_chipco_gpio_out(&bus->chipco, 1 << gpio, value ? 1 << gpio : 0);54}55 56static int ssb_gpio_chipco_direction_input(struct gpio_chip *chip,57 unsigned int gpio)58{59 struct ssb_bus *bus = gpiochip_get_data(chip);60 61 ssb_chipco_gpio_outen(&bus->chipco, 1 << gpio, 0);62 return 0;63}64 65static int ssb_gpio_chipco_direction_output(struct gpio_chip *chip,66 unsigned int gpio, int value)67{68 struct ssb_bus *bus = gpiochip_get_data(chip);69 70 ssb_chipco_gpio_outen(&bus->chipco, 1 << gpio, 1 << gpio);71 ssb_chipco_gpio_out(&bus->chipco, 1 << gpio, value ? 1 << gpio : 0);72 return 0;73}74 75static int ssb_gpio_chipco_request(struct gpio_chip *chip, unsigned int gpio)76{77 struct ssb_bus *bus = gpiochip_get_data(chip);78 79 ssb_chipco_gpio_control(&bus->chipco, 1 << gpio, 0);80 /* clear pulldown */81 ssb_chipco_gpio_pulldown(&bus->chipco, 1 << gpio, 0);82 /* Set pullup */83 ssb_chipco_gpio_pullup(&bus->chipco, 1 << gpio, 1 << gpio);84 85 return 0;86}87 88static void ssb_gpio_chipco_free(struct gpio_chip *chip, unsigned int gpio)89{90 struct ssb_bus *bus = gpiochip_get_data(chip);91 92 /* clear pullup */93 ssb_chipco_gpio_pullup(&bus->chipco, 1 << gpio, 0);94}95 96#if IS_ENABLED(CONFIG_SSB_EMBEDDED)97static void ssb_gpio_irq_chipco_mask(struct irq_data *d)98{99 struct ssb_bus *bus = irq_data_get_irq_chip_data(d);100 int gpio = irqd_to_hwirq(d);101 102 ssb_chipco_gpio_intmask(&bus->chipco, BIT(gpio), 0);103}104 105static void ssb_gpio_irq_chipco_unmask(struct irq_data *d)106{107 struct ssb_bus *bus = irq_data_get_irq_chip_data(d);108 int gpio = irqd_to_hwirq(d);109 u32 val = ssb_chipco_gpio_in(&bus->chipco, BIT(gpio));110 111 ssb_chipco_gpio_polarity(&bus->chipco, BIT(gpio), val);112 ssb_chipco_gpio_intmask(&bus->chipco, BIT(gpio), BIT(gpio));113}114 115static struct irq_chip ssb_gpio_irq_chipco_chip = {116 .name = "SSB-GPIO-CC",117 .irq_mask = ssb_gpio_irq_chipco_mask,118 .irq_unmask = ssb_gpio_irq_chipco_unmask,119};120 121static irqreturn_t ssb_gpio_irq_chipco_handler(int irq, void *dev_id)122{123 struct ssb_bus *bus = dev_id;124 struct ssb_chipcommon *chipco = &bus->chipco;125 u32 val = chipco_read32(chipco, SSB_CHIPCO_GPIOIN);126 u32 mask = chipco_read32(chipco, SSB_CHIPCO_GPIOIRQ);127 u32 pol = chipco_read32(chipco, SSB_CHIPCO_GPIOPOL);128 unsigned long irqs = (val ^ pol) & mask;129 int gpio;130 131 if (!irqs)132 return IRQ_NONE;133 134 for_each_set_bit(gpio, &irqs, bus->gpio.ngpio)135 generic_handle_domain_irq_safe(bus->irq_domain, gpio);136 137 ssb_chipco_gpio_polarity(chipco, irqs, val & irqs);138 139 return IRQ_HANDLED;140}141 142static int ssb_gpio_irq_chipco_domain_init(struct ssb_bus *bus)143{144 struct ssb_chipcommon *chipco = &bus->chipco;145 struct gpio_chip *chip = &bus->gpio;146 int gpio, hwirq, err;147 148 if (bus->bustype != SSB_BUSTYPE_SSB)149 return 0;150 151 bus->irq_domain = irq_domain_add_linear(NULL, chip->ngpio,152 &irq_domain_simple_ops, chipco);153 if (!bus->irq_domain) {154 err = -ENODEV;155 goto err_irq_domain;156 }157 for (gpio = 0; gpio < chip->ngpio; gpio++) {158 int irq = irq_create_mapping(bus->irq_domain, gpio);159 160 irq_set_chip_data(irq, bus);161 irq_set_chip_and_handler(irq, &ssb_gpio_irq_chipco_chip,162 handle_simple_irq);163 }164 165 hwirq = ssb_mips_irq(bus->chipco.dev) + 2;166 err = request_irq(hwirq, ssb_gpio_irq_chipco_handler, IRQF_SHARED,167 "gpio", bus);168 if (err)169 goto err_req_irq;170 171 ssb_chipco_gpio_intmask(&bus->chipco, ~0, 0);172 chipco_set32(chipco, SSB_CHIPCO_IRQMASK, SSB_CHIPCO_IRQ_GPIO);173 174 return 0;175 176err_req_irq:177 for (gpio = 0; gpio < chip->ngpio; gpio++) {178 int irq = irq_find_mapping(bus->irq_domain, gpio);179 180 irq_dispose_mapping(irq);181 }182 irq_domain_remove(bus->irq_domain);183err_irq_domain:184 return err;185}186 187static void ssb_gpio_irq_chipco_domain_exit(struct ssb_bus *bus)188{189 struct ssb_chipcommon *chipco = &bus->chipco;190 struct gpio_chip *chip = &bus->gpio;191 int gpio;192 193 if (bus->bustype != SSB_BUSTYPE_SSB)194 return;195 196 chipco_mask32(chipco, SSB_CHIPCO_IRQMASK, ~SSB_CHIPCO_IRQ_GPIO);197 free_irq(ssb_mips_irq(bus->chipco.dev) + 2, chipco);198 for (gpio = 0; gpio < chip->ngpio; gpio++) {199 int irq = irq_find_mapping(bus->irq_domain, gpio);200 201 irq_dispose_mapping(irq);202 }203 irq_domain_remove(bus->irq_domain);204}205#else206static int ssb_gpio_irq_chipco_domain_init(struct ssb_bus *bus)207{208 return 0;209}210 211static void ssb_gpio_irq_chipco_domain_exit(struct ssb_bus *bus)212{213}214#endif215 216static int ssb_gpio_chipco_init(struct ssb_bus *bus)217{218 struct gpio_chip *chip = &bus->gpio;219 int err;220 221 chip->label = "ssb_chipco_gpio";222 chip->owner = THIS_MODULE;223 chip->request = ssb_gpio_chipco_request;224 chip->free = ssb_gpio_chipco_free;225 chip->get = ssb_gpio_chipco_get_value;226 chip->set = ssb_gpio_chipco_set_value;227 chip->direction_input = ssb_gpio_chipco_direction_input;228 chip->direction_output = ssb_gpio_chipco_direction_output;229#if IS_ENABLED(CONFIG_SSB_EMBEDDED)230 chip->to_irq = ssb_gpio_to_irq;231#endif232 chip->ngpio = 16;233 /* There is just one SoC in one device and its GPIO addresses should be234 * deterministic to address them more easily. The other buses could get235 * a random base number.236 */237 if (bus->bustype == SSB_BUSTYPE_SSB)238 chip->base = 0;239 else240 chip->base = -1;241 242 err = ssb_gpio_irq_chipco_domain_init(bus);243 if (err)244 return err;245 246 err = gpiochip_add_data(chip, bus);247 if (err) {248 ssb_gpio_irq_chipco_domain_exit(bus);249 return err;250 }251 252 return 0;253}254 255/**************************************************256 * EXTIF257 **************************************************/258 259#ifdef CONFIG_SSB_DRIVER_EXTIF260 261static int ssb_gpio_extif_get_value(struct gpio_chip *chip, unsigned int gpio)262{263 struct ssb_bus *bus = gpiochip_get_data(chip);264 265 return !!ssb_extif_gpio_in(&bus->extif, 1 << gpio);266}267 268static void ssb_gpio_extif_set_value(struct gpio_chip *chip, unsigned int gpio,269 int value)270{271 struct ssb_bus *bus = gpiochip_get_data(chip);272 273 ssb_extif_gpio_out(&bus->extif, 1 << gpio, value ? 1 << gpio : 0);274}275 276static int ssb_gpio_extif_direction_input(struct gpio_chip *chip,277 unsigned int gpio)278{279 struct ssb_bus *bus = gpiochip_get_data(chip);280 281 ssb_extif_gpio_outen(&bus->extif, 1 << gpio, 0);282 return 0;283}284 285static int ssb_gpio_extif_direction_output(struct gpio_chip *chip,286 unsigned int gpio, int value)287{288 struct ssb_bus *bus = gpiochip_get_data(chip);289 290 ssb_extif_gpio_outen(&bus->extif, 1 << gpio, 1 << gpio);291 ssb_extif_gpio_out(&bus->extif, 1 << gpio, value ? 1 << gpio : 0);292 return 0;293}294 295#if IS_ENABLED(CONFIG_SSB_EMBEDDED)296static void ssb_gpio_irq_extif_mask(struct irq_data *d)297{298 struct ssb_bus *bus = irq_data_get_irq_chip_data(d);299 int gpio = irqd_to_hwirq(d);300 301 ssb_extif_gpio_intmask(&bus->extif, BIT(gpio), 0);302}303 304static void ssb_gpio_irq_extif_unmask(struct irq_data *d)305{306 struct ssb_bus *bus = irq_data_get_irq_chip_data(d);307 int gpio = irqd_to_hwirq(d);308 u32 val = ssb_extif_gpio_in(&bus->extif, BIT(gpio));309 310 ssb_extif_gpio_polarity(&bus->extif, BIT(gpio), val);311 ssb_extif_gpio_intmask(&bus->extif, BIT(gpio), BIT(gpio));312}313 314static struct irq_chip ssb_gpio_irq_extif_chip = {315 .name = "SSB-GPIO-EXTIF",316 .irq_mask = ssb_gpio_irq_extif_mask,317 .irq_unmask = ssb_gpio_irq_extif_unmask,318};319 320static irqreturn_t ssb_gpio_irq_extif_handler(int irq, void *dev_id)321{322 struct ssb_bus *bus = dev_id;323 struct ssb_extif *extif = &bus->extif;324 u32 val = ssb_read32(extif->dev, SSB_EXTIF_GPIO_IN);325 u32 mask = ssb_read32(extif->dev, SSB_EXTIF_GPIO_INTMASK);326 u32 pol = ssb_read32(extif->dev, SSB_EXTIF_GPIO_INTPOL);327 unsigned long irqs = (val ^ pol) & mask;328 int gpio;329 330 if (!irqs)331 return IRQ_NONE;332 333 for_each_set_bit(gpio, &irqs, bus->gpio.ngpio)334 generic_handle_domain_irq_safe(bus->irq_domain, gpio);335 336 ssb_extif_gpio_polarity(extif, irqs, val & irqs);337 338 return IRQ_HANDLED;339}340 341static int ssb_gpio_irq_extif_domain_init(struct ssb_bus *bus)342{343 struct ssb_extif *extif = &bus->extif;344 struct gpio_chip *chip = &bus->gpio;345 int gpio, hwirq, err;346 347 if (bus->bustype != SSB_BUSTYPE_SSB)348 return 0;349 350 bus->irq_domain = irq_domain_add_linear(NULL, chip->ngpio,351 &irq_domain_simple_ops, extif);352 if (!bus->irq_domain) {353 err = -ENODEV;354 goto err_irq_domain;355 }356 for (gpio = 0; gpio < chip->ngpio; gpio++) {357 int irq = irq_create_mapping(bus->irq_domain, gpio);358 359 irq_set_chip_data(irq, bus);360 irq_set_chip_and_handler(irq, &ssb_gpio_irq_extif_chip,361 handle_simple_irq);362 }363 364 hwirq = ssb_mips_irq(bus->extif.dev) + 2;365 err = request_irq(hwirq, ssb_gpio_irq_extif_handler, IRQF_SHARED,366 "gpio", bus);367 if (err)368 goto err_req_irq;369 370 ssb_extif_gpio_intmask(&bus->extif, ~0, 0);371 372 return 0;373 374err_req_irq:375 for (gpio = 0; gpio < chip->ngpio; gpio++) {376 int irq = irq_find_mapping(bus->irq_domain, gpio);377 378 irq_dispose_mapping(irq);379 }380 irq_domain_remove(bus->irq_domain);381err_irq_domain:382 return err;383}384 385static void ssb_gpio_irq_extif_domain_exit(struct ssb_bus *bus)386{387 struct ssb_extif *extif = &bus->extif;388 struct gpio_chip *chip = &bus->gpio;389 int gpio;390 391 if (bus->bustype != SSB_BUSTYPE_SSB)392 return;393 394 free_irq(ssb_mips_irq(bus->extif.dev) + 2, extif);395 for (gpio = 0; gpio < chip->ngpio; gpio++) {396 int irq = irq_find_mapping(bus->irq_domain, gpio);397 398 irq_dispose_mapping(irq);399 }400 irq_domain_remove(bus->irq_domain);401}402#else403static int ssb_gpio_irq_extif_domain_init(struct ssb_bus *bus)404{405 return 0;406}407 408static void ssb_gpio_irq_extif_domain_exit(struct ssb_bus *bus)409{410}411#endif412 413static int ssb_gpio_extif_init(struct ssb_bus *bus)414{415 struct gpio_chip *chip = &bus->gpio;416 int err;417 418 chip->label = "ssb_extif_gpio";419 chip->owner = THIS_MODULE;420 chip->get = ssb_gpio_extif_get_value;421 chip->set = ssb_gpio_extif_set_value;422 chip->direction_input = ssb_gpio_extif_direction_input;423 chip->direction_output = ssb_gpio_extif_direction_output;424#if IS_ENABLED(CONFIG_SSB_EMBEDDED)425 chip->to_irq = ssb_gpio_to_irq;426#endif427 chip->ngpio = 5;428 /* There is just one SoC in one device and its GPIO addresses should be429 * deterministic to address them more easily. The other buses could get430 * a random base number.431 */432 if (bus->bustype == SSB_BUSTYPE_SSB)433 chip->base = 0;434 else435 chip->base = -1;436 437 err = ssb_gpio_irq_extif_domain_init(bus);438 if (err)439 return err;440 441 err = gpiochip_add_data(chip, bus);442 if (err) {443 ssb_gpio_irq_extif_domain_exit(bus);444 return err;445 }446 447 return 0;448}449 450#else451static int ssb_gpio_extif_init(struct ssb_bus *bus)452{453 return -ENOTSUPP;454}455#endif456 457/**************************************************458 * Init459 **************************************************/460 461int ssb_gpio_init(struct ssb_bus *bus)462{463 if (ssb_chipco_available(&bus->chipco))464 return ssb_gpio_chipco_init(bus);465 else if (ssb_extif_available(&bus->extif))466 return ssb_gpio_extif_init(bus);467 return -1;468}469 470int ssb_gpio_unregister(struct ssb_bus *bus)471{472 if (ssb_chipco_available(&bus->chipco) ||473 ssb_extif_available(&bus->extif)) {474 gpiochip_remove(&bus->gpio);475 return 0;476 }477 return -1;478}479