1 /* 2 * Copyright (C) 2003-2015 Broadcom Corporation 3 * All Rights Reserved 4 * 5 * This program is free software; you can redistribute it and/or modify 6 * it under the terms of the GNU General Public License version 2 as 7 * published by the Free Software Foundation. 8 * 9 * This program is distributed in the hope that it will be useful, 10 * but WITHOUT ANY WARRANTY; without even the implied warranty of 11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 12 * GNU General Public License for more details. 13 */ 14 15 #include <linux/gpio.h> 16 #include <linux/platform_device.h> 17 #include <linux/of_device.h> 18 #include <linux/module.h> 19 #include <linux/irq.h> 20 #include <linux/interrupt.h> 21 #include <linux/irqchip/chained_irq.h> 22 23 /* 24 * XLP GPIO has multiple 32 bit registers for each feature where each register 25 * controls 32 pins. So, pins up to 64 require 2 32-bit registers and up to 96 26 * require 3 32-bit registers for each feature. 27 * Here we only define offset of the first register for each feature. Offset of 28 * the registers for pins greater than 32 can be calculated as following(Use 29 * GPIO_INT_STAT as example): 30 * 31 * offset = (gpio / XLP_GPIO_REGSZ) * 4; 32 * reg_addr = addr + offset; 33 * 34 * where addr is base address of the that feature register and gpio is the pin. 35 */ 36 #define GPIO_OUTPUT_EN 0x00 37 #define GPIO_PADDRV 0x08 38 #define GPIO_INT_EN00 0x18 39 #define GPIO_INT_EN10 0x20 40 #define GPIO_INT_EN20 0x28 41 #define GPIO_INT_EN30 0x30 42 #define GPIO_INT_POL 0x38 43 #define GPIO_INT_TYPE 0x40 44 #define GPIO_INT_STAT 0x48 45 46 #define GPIO_9XX_BYTESWAP 0X00 47 #define GPIO_9XX_CTRL 0X04 48 #define GPIO_9XX_OUTPUT_EN 0x14 49 #define GPIO_9XX_PADDRV 0x24 50 /* 51 * Only for 4 interrupt enable reg are defined for now, 52 * total reg available are 12. 53 */ 54 #define GPIO_9XX_INT_EN00 0x44 55 #define GPIO_9XX_INT_EN10 0x54 56 #define GPIO_9XX_INT_EN20 0x64 57 #define GPIO_9XX_INT_EN30 0x74 58 #define GPIO_9XX_INT_POL 0x104 59 #define GPIO_9XX_INT_TYPE 0x114 60 #define GPIO_9XX_INT_STAT 0x124 61 62 #define GPIO_3XX_INT_EN00 0x18 63 #define GPIO_3XX_INT_EN10 0x20 64 #define GPIO_3XX_INT_EN20 0x28 65 #define GPIO_3XX_INT_EN30 0x30 66 #define GPIO_3XX_INT_POL 0x78 67 #define GPIO_3XX_INT_TYPE 0x80 68 #define GPIO_3XX_INT_STAT 0x88 69 70 /* Interrupt type register mask */ 71 #define XLP_GPIO_IRQ_TYPE_LVL 0x0 72 #define XLP_GPIO_IRQ_TYPE_EDGE 0x1 73 74 /* Interrupt polarity register mask */ 75 #define XLP_GPIO_IRQ_POL_HIGH 0x0 76 #define XLP_GPIO_IRQ_POL_LOW 0x1 77 78 #define XLP_GPIO_REGSZ 32 79 #define XLP_GPIO_IRQ_BASE 768 80 #define XLP_MAX_NR_GPIO 96 81 82 /* XLP variants supported by this driver */ 83 enum { 84 XLP_GPIO_VARIANT_XLP832 = 1, 85 XLP_GPIO_VARIANT_XLP316, 86 XLP_GPIO_VARIANT_XLP208, 87 XLP_GPIO_VARIANT_XLP980, 88 XLP_GPIO_VARIANT_XLP532 89 }; 90 91 struct xlp_gpio_priv { 92 struct gpio_chip chip; 93 DECLARE_BITMAP(gpio_enabled_mask, XLP_MAX_NR_GPIO); 94 void __iomem *gpio_intr_en; /* pointer to first intr enable reg */ 95 void __iomem *gpio_intr_stat; /* pointer to first intr status reg */ 96 void __iomem *gpio_intr_type; /* pointer to first intr type reg */ 97 void __iomem *gpio_intr_pol; /* pointer to first intr polarity reg */ 98 void __iomem *gpio_out_en; /* pointer to first output enable reg */ 99 void __iomem *gpio_paddrv; /* pointer to first pad drive reg */ 100 spinlock_t lock; 101 }; 102 103 static struct xlp_gpio_priv *gpio_chip_to_xlp_priv(struct gpio_chip *gc) 104 { 105 return container_of(gc, struct xlp_gpio_priv, chip); 106 } 107 108 static int xlp_gpio_get_reg(void __iomem *addr, unsigned gpio) 109 { 110 u32 pos, regset; 111 112 pos = gpio % XLP_GPIO_REGSZ; 113 regset = (gpio / XLP_GPIO_REGSZ) * 4; 114 return !!(readl(addr + regset) & BIT(pos)); 115 } 116 117 static void xlp_gpio_set_reg(void __iomem *addr, unsigned gpio, int state) 118 { 119 u32 value, pos, regset; 120 121 pos = gpio % XLP_GPIO_REGSZ; 122 regset = (gpio / XLP_GPIO_REGSZ) * 4; 123 value = readl(addr + regset); 124 125 if (state) 126 value |= BIT(pos); 127 else 128 value &= ~BIT(pos); 129 130 writel(value, addr + regset); 131 } 132 133 static void xlp_gpio_irq_disable(struct irq_data *d) 134 { 135 struct gpio_chip *gc = irq_data_get_irq_chip_data(d); 136 struct xlp_gpio_priv *priv = gpio_chip_to_xlp_priv(gc); 137 unsigned long flags; 138 139 spin_lock_irqsave(&priv->lock, flags); 140 xlp_gpio_set_reg(priv->gpio_intr_en, d->hwirq, 0x0); 141 __clear_bit(d->hwirq, priv->gpio_enabled_mask); 142 spin_unlock_irqrestore(&priv->lock, flags); 143 } 144 145 static void xlp_gpio_irq_mask_ack(struct irq_data *d) 146 { 147 struct gpio_chip *gc = irq_data_get_irq_chip_data(d); 148 struct xlp_gpio_priv *priv = gpio_chip_to_xlp_priv(gc); 149 unsigned long flags; 150 151 spin_lock_irqsave(&priv->lock, flags); 152 xlp_gpio_set_reg(priv->gpio_intr_en, d->hwirq, 0x0); 153 xlp_gpio_set_reg(priv->gpio_intr_stat, d->hwirq, 0x1); 154 __clear_bit(d->hwirq, priv->gpio_enabled_mask); 155 spin_unlock_irqrestore(&priv->lock, flags); 156 } 157 158 static void xlp_gpio_irq_unmask(struct irq_data *d) 159 { 160 struct gpio_chip *gc = irq_data_get_irq_chip_data(d); 161 struct xlp_gpio_priv *priv = gpio_chip_to_xlp_priv(gc); 162 unsigned long flags; 163 164 spin_lock_irqsave(&priv->lock, flags); 165 xlp_gpio_set_reg(priv->gpio_intr_en, d->hwirq, 0x1); 166 __set_bit(d->hwirq, priv->gpio_enabled_mask); 167 spin_unlock_irqrestore(&priv->lock, flags); 168 } 169 170 static int xlp_gpio_set_irq_type(struct irq_data *d, unsigned int type) 171 { 172 struct gpio_chip *gc = irq_data_get_irq_chip_data(d); 173 struct xlp_gpio_priv *priv = gpio_chip_to_xlp_priv(gc); 174 int pol, irq_type; 175 176 switch (type) { 177 case IRQ_TYPE_EDGE_RISING: 178 irq_type = XLP_GPIO_IRQ_TYPE_EDGE; 179 pol = XLP_GPIO_IRQ_POL_HIGH; 180 break; 181 case IRQ_TYPE_EDGE_FALLING: 182 irq_type = XLP_GPIO_IRQ_TYPE_EDGE; 183 pol = XLP_GPIO_IRQ_POL_LOW; 184 break; 185 case IRQ_TYPE_LEVEL_HIGH: 186 irq_type = XLP_GPIO_IRQ_TYPE_LVL; 187 pol = XLP_GPIO_IRQ_POL_HIGH; 188 break; 189 case IRQ_TYPE_LEVEL_LOW: 190 irq_type = XLP_GPIO_IRQ_TYPE_LVL; 191 pol = XLP_GPIO_IRQ_POL_LOW; 192 break; 193 default: 194 return -EINVAL; 195 } 196 197 xlp_gpio_set_reg(priv->gpio_intr_type, d->hwirq, irq_type); 198 xlp_gpio_set_reg(priv->gpio_intr_pol, d->hwirq, pol); 199 200 return 0; 201 } 202 203 static struct irq_chip xlp_gpio_irq_chip = { 204 .name = "XLP-GPIO", 205 .irq_mask_ack = xlp_gpio_irq_mask_ack, 206 .irq_disable = xlp_gpio_irq_disable, 207 .irq_set_type = xlp_gpio_set_irq_type, 208 .irq_unmask = xlp_gpio_irq_unmask, 209 .flags = IRQCHIP_ONESHOT_SAFE, 210 }; 211 212 static void xlp_gpio_generic_handler(struct irq_desc *desc) 213 { 214 struct xlp_gpio_priv *priv = irq_desc_get_handler_data(desc); 215 struct irq_chip *irqchip = irq_desc_get_chip(desc); 216 int gpio, regoff; 217 u32 gpio_stat; 218 219 regoff = -1; 220 gpio_stat = 0; 221 222 chained_irq_enter(irqchip, desc); 223 for_each_set_bit(gpio, priv->gpio_enabled_mask, XLP_MAX_NR_GPIO) { 224 if (regoff != gpio / XLP_GPIO_REGSZ) { 225 regoff = gpio / XLP_GPIO_REGSZ; 226 gpio_stat = readl(priv->gpio_intr_stat + regoff * 4); 227 } 228 229 if (gpio_stat & BIT(gpio % XLP_GPIO_REGSZ)) 230 generic_handle_irq(irq_find_mapping( 231 priv->chip.irqdomain, gpio)); 232 } 233 chained_irq_exit(irqchip, desc); 234 } 235 236 static int xlp_gpio_dir_output(struct gpio_chip *gc, unsigned gpio, int state) 237 { 238 struct xlp_gpio_priv *priv = gpio_chip_to_xlp_priv(gc); 239 240 BUG_ON(gpio >= gc->ngpio); 241 xlp_gpio_set_reg(priv->gpio_out_en, gpio, 0x1); 242 243 return 0; 244 } 245 246 static int xlp_gpio_dir_input(struct gpio_chip *gc, unsigned gpio) 247 { 248 struct xlp_gpio_priv *priv = gpio_chip_to_xlp_priv(gc); 249 250 BUG_ON(gpio >= gc->ngpio); 251 xlp_gpio_set_reg(priv->gpio_out_en, gpio, 0x0); 252 253 return 0; 254 } 255 256 static int xlp_gpio_get(struct gpio_chip *gc, unsigned gpio) 257 { 258 struct xlp_gpio_priv *priv = gpio_chip_to_xlp_priv(gc); 259 260 BUG_ON(gpio >= gc->ngpio); 261 return xlp_gpio_get_reg(priv->gpio_paddrv, gpio); 262 } 263 264 static void xlp_gpio_set(struct gpio_chip *gc, unsigned gpio, int state) 265 { 266 struct xlp_gpio_priv *priv = gpio_chip_to_xlp_priv(gc); 267 268 BUG_ON(gpio >= gc->ngpio); 269 xlp_gpio_set_reg(priv->gpio_paddrv, gpio, state); 270 } 271 272 static const struct of_device_id xlp_gpio_of_ids[] = { 273 { 274 .compatible = "netlogic,xlp832-gpio", 275 .data = (void *)XLP_GPIO_VARIANT_XLP832, 276 }, 277 { 278 .compatible = "netlogic,xlp316-gpio", 279 .data = (void *)XLP_GPIO_VARIANT_XLP316, 280 }, 281 { 282 .compatible = "netlogic,xlp208-gpio", 283 .data = (void *)XLP_GPIO_VARIANT_XLP208, 284 }, 285 { 286 .compatible = "netlogic,xlp980-gpio", 287 .data = (void *)XLP_GPIO_VARIANT_XLP980, 288 }, 289 { 290 .compatible = "netlogic,xlp532-gpio", 291 .data = (void *)XLP_GPIO_VARIANT_XLP532, 292 }, 293 { /* sentinel */ }, 294 }; 295 MODULE_DEVICE_TABLE(of, xlp_gpio_of_ids); 296 297 static int xlp_gpio_probe(struct platform_device *pdev) 298 { 299 struct gpio_chip *gc; 300 struct resource *iores; 301 struct xlp_gpio_priv *priv; 302 const struct of_device_id *of_id; 303 void __iomem *gpio_base; 304 int irq_base, irq, err; 305 int ngpio; 306 u32 soc_type; 307 308 iores = platform_get_resource(pdev, IORESOURCE_MEM, 0); 309 if (!iores) 310 return -ENODEV; 311 312 priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); 313 if (!priv) 314 return -ENOMEM; 315 316 gpio_base = devm_ioremap_resource(&pdev->dev, iores); 317 if (IS_ERR(gpio_base)) 318 return PTR_ERR(gpio_base); 319 320 irq = platform_get_irq(pdev, 0); 321 if (irq < 0) 322 return irq; 323 324 of_id = of_match_device(xlp_gpio_of_ids, &pdev->dev); 325 if (!of_id) { 326 dev_err(&pdev->dev, "Failed to get soc type!\n"); 327 return -ENODEV; 328 } 329 330 soc_type = (uintptr_t) of_id->data; 331 332 switch (soc_type) { 333 case XLP_GPIO_VARIANT_XLP832: 334 priv->gpio_out_en = gpio_base + GPIO_OUTPUT_EN; 335 priv->gpio_paddrv = gpio_base + GPIO_PADDRV; 336 priv->gpio_intr_stat = gpio_base + GPIO_INT_STAT; 337 priv->gpio_intr_type = gpio_base + GPIO_INT_TYPE; 338 priv->gpio_intr_pol = gpio_base + GPIO_INT_POL; 339 priv->gpio_intr_en = gpio_base + GPIO_INT_EN00; 340 ngpio = 41; 341 break; 342 case XLP_GPIO_VARIANT_XLP208: 343 case XLP_GPIO_VARIANT_XLP316: 344 priv->gpio_out_en = gpio_base + GPIO_OUTPUT_EN; 345 priv->gpio_paddrv = gpio_base + GPIO_PADDRV; 346 priv->gpio_intr_stat = gpio_base + GPIO_3XX_INT_STAT; 347 priv->gpio_intr_type = gpio_base + GPIO_3XX_INT_TYPE; 348 priv->gpio_intr_pol = gpio_base + GPIO_3XX_INT_POL; 349 priv->gpio_intr_en = gpio_base + GPIO_3XX_INT_EN00; 350 351 ngpio = (soc_type == XLP_GPIO_VARIANT_XLP208) ? 42 : 57; 352 break; 353 case XLP_GPIO_VARIANT_XLP980: 354 case XLP_GPIO_VARIANT_XLP532: 355 priv->gpio_out_en = gpio_base + GPIO_9XX_OUTPUT_EN; 356 priv->gpio_paddrv = gpio_base + GPIO_9XX_PADDRV; 357 priv->gpio_intr_stat = gpio_base + GPIO_9XX_INT_STAT; 358 priv->gpio_intr_type = gpio_base + GPIO_9XX_INT_TYPE; 359 priv->gpio_intr_pol = gpio_base + GPIO_9XX_INT_POL; 360 priv->gpio_intr_en = gpio_base + GPIO_9XX_INT_EN00; 361 362 ngpio = (soc_type == XLP_GPIO_VARIANT_XLP980) ? 66 : 67; 363 break; 364 default: 365 dev_err(&pdev->dev, "Unknown Processor type!\n"); 366 return -ENODEV; 367 } 368 369 bitmap_zero(priv->gpio_enabled_mask, XLP_MAX_NR_GPIO); 370 371 gc = &priv->chip; 372 373 gc->owner = THIS_MODULE; 374 gc->label = dev_name(&pdev->dev); 375 gc->base = 0; 376 gc->parent = &pdev->dev; 377 gc->ngpio = ngpio; 378 gc->of_node = pdev->dev.of_node; 379 gc->direction_output = xlp_gpio_dir_output; 380 gc->direction_input = xlp_gpio_dir_input; 381 gc->set = xlp_gpio_set; 382 gc->get = xlp_gpio_get; 383 384 spin_lock_init(&priv->lock); 385 irq_base = irq_alloc_descs(-1, XLP_GPIO_IRQ_BASE, gc->ngpio, 0); 386 if (irq_base < 0) { 387 dev_err(&pdev->dev, "Failed to allocate IRQ numbers\n"); 388 return -ENODEV; 389 } 390 391 err = gpiochip_add(gc); 392 if (err < 0) 393 goto out_free_desc; 394 395 err = gpiochip_irqchip_add(gc, &xlp_gpio_irq_chip, irq_base, 396 handle_level_irq, IRQ_TYPE_NONE); 397 if (err) { 398 dev_err(&pdev->dev, "Could not connect irqchip to gpiochip!\n"); 399 goto out_gpio_remove; 400 } 401 402 gpiochip_set_chained_irqchip(gc, &xlp_gpio_irq_chip, irq, 403 xlp_gpio_generic_handler); 404 405 dev_info(&pdev->dev, "registered %d GPIOs\n", gc->ngpio); 406 407 return 0; 408 409 out_gpio_remove: 410 gpiochip_remove(gc); 411 out_free_desc: 412 irq_free_descs(irq_base, gc->ngpio); 413 return err; 414 } 415 416 static struct platform_driver xlp_gpio_driver = { 417 .driver = { 418 .name = "xlp-gpio", 419 .of_match_table = xlp_gpio_of_ids, 420 }, 421 .probe = xlp_gpio_probe, 422 }; 423 module_platform_driver(xlp_gpio_driver); 424 425 MODULE_AUTHOR("Kamlakant Patel <kamlakant.patel@broadcom.com>"); 426 MODULE_AUTHOR("Ganesan Ramalingam <ganesanr@broadcom.com>"); 427 MODULE_DESCRIPTION("Netlogic XLP GPIO Driver"); 428 MODULE_LICENSE("GPL v2"); 429