cregit-Linux how code gets into the kernel

Release 4.11 drivers/gpio/gpio-sodaville.c

Directory: drivers/gpio
/*
 *  GPIO interface for Intel Sodaville SoCs.
 *
 *  Copyright (c) 2010, 2011 Intel Corporation
 *
 *  Author: Hans J. Koch <hjk@linutronix.de>
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License 2 as published
 *  by the Free Software Foundation.
 *
 */

#include <linux/errno.h>
#include <linux/init.h>
#include <linux/io.h>
#include <linux/irq.h>
#include <linux/interrupt.h>
#include <linux/kernel.h>
#include <linux/pci.h>
#include <linux/platform_device.h>
#include <linux/of_irq.h>
#include <linux/gpio/driver.h>


#define DRV_NAME		"sdv_gpio"

#define SDV_NUM_PUB_GPIOS	12

#define PCI_DEVICE_ID_SDV_GPIO	0x2e67

#define GPIO_BAR		0


#define GPOUTR		0x00

#define GPOER		0x04

#define GPINR		0x08


#define GPSTR		0x0c

#define GPIT1R0		0x10

#define GPIO_INT	0x14

#define GPIT1R1		0x18


#define GPMUXCTL	0x1c


struct sdv_gpio_chip_data {
	
int irq_base;
	
void __iomem *gpio_pub_base;
	
struct irq_domain *id;
	
struct irq_chip_generic *gc;
	
struct gpio_chip chip;
};


static int sdv_gpio_pub_set_type(struct irq_data *d, unsigned int type) { struct irq_chip_generic *gc = irq_data_get_irq_chip_data(d); struct sdv_gpio_chip_data *sd = gc->private; void __iomem *type_reg; u32 reg; if (d->hwirq < 8) type_reg = sd->gpio_pub_base + GPIT1R0; else type_reg = sd->gpio_pub_base + GPIT1R1; reg = readl(type_reg); switch (type) { case IRQ_TYPE_LEVEL_HIGH: reg &= ~BIT(4 * (d->hwirq % 8)); break; case IRQ_TYPE_LEVEL_LOW: reg |= BIT(4 * (d->hwirq % 8)); break; default: return -EINVAL; } writel(reg, type_reg); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Sebastian Andrzej Siewior12593.28%150.00%
Grant C. Likely96.72%150.00%
Total134100.00%2100.00%


static irqreturn_t sdv_gpio_pub_irq_handler(int irq, void *data) { struct sdv_gpio_chip_data *sd = data; u32 irq_stat = readl(sd->gpio_pub_base + GPSTR); irq_stat &= readl(sd->gpio_pub_base + GPIO_INT); if (!irq_stat) return IRQ_NONE; while (irq_stat) { u32 irq_bit = __fls(irq_stat); irq_stat &= ~BIT(irq_bit); generic_handle_irq(irq_find_mapping(sd->id, irq_bit)); } return IRQ_HANDLED; }

Contributors

PersonTokensPropCommitsCommitProp
Sebastian Andrzej Siewior8394.32%150.00%
Grant C. Likely55.68%150.00%
Total88100.00%2100.00%


static int sdv_xlate(struct irq_domain *h, struct device_node *node, const u32 *intspec, u32 intsize, irq_hw_number_t *out_hwirq, u32 *out_type) { u32 line, type; if (node != irq_domain_get_of_node(h)) return -EINVAL; if (intsize < 2) return -EINVAL; line = *intspec; *out_hwirq = line; intspec++; type = *intspec; switch (type) { case IRQ_TYPE_LEVEL_LOW: case IRQ_TYPE_LEVEL_HIGH: *out_type = type; break; default: return -EINVAL; } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Sebastian Andrzej Siewior10197.12%150.00%
Marc Zyngier32.88%150.00%
Total104100.00%2100.00%

static const struct irq_domain_ops irq_domain_sdv_ops = { .xlate = sdv_xlate, };
static int sdv_register_irqsupport(struct sdv_gpio_chip_data *sd, struct pci_dev *pdev) { struct irq_chip_type *ct; int ret; sd->irq_base = irq_alloc_descs(-1, 0, SDV_NUM_PUB_GPIOS, -1); if (sd->irq_base < 0) return sd->irq_base; /* mask + ACK all interrupt sources */ writel(0, sd->gpio_pub_base + GPIO_INT); writel((1 << 11) - 1, sd->gpio_pub_base + GPSTR); ret = request_irq(pdev->irq, sdv_gpio_pub_irq_handler, IRQF_SHARED, "sdv_gpio", sd); if (ret) goto out_free_desc; /* * This gpio irq controller latches level irqs. Testing shows that if * we unmask & ACK the IRQ before the source of the interrupt is gone * then the interrupt is active again. */ sd->gc = irq_alloc_generic_chip("sdv-gpio", 1, sd->irq_base, sd->gpio_pub_base, handle_fasteoi_irq); if (!sd->gc) { ret = -ENOMEM; goto out_free_irq; } sd->gc->private = sd; ct = sd->gc->chip_types; ct->type = IRQ_TYPE_LEVEL_HIGH | IRQ_TYPE_LEVEL_LOW; ct->regs.eoi = GPSTR; ct->regs.mask = GPIO_INT; ct->chip.irq_mask = irq_gc_mask_clr_bit; ct->chip.irq_unmask = irq_gc_mask_set_bit; ct->chip.irq_eoi = irq_gc_eoi; ct->chip.irq_set_type = sdv_gpio_pub_set_type; irq_setup_generic_chip(sd->gc, IRQ_MSK(SDV_NUM_PUB_GPIOS), IRQ_GC_INIT_MASK_CACHE, IRQ_NOREQUEST, IRQ_LEVEL | IRQ_NOPROBE); sd->id = irq_domain_add_legacy(pdev->dev.of_node, SDV_NUM_PUB_GPIOS, sd->irq_base, 0, &irq_domain_sdv_ops, sd); if (!sd->id) { ret = -ENODEV; goto out_free_irq; } return 0; out_free_irq: free_irq(pdev->irq, sd); out_free_desc: irq_free_descs(sd->irq_base, SDV_NUM_PUB_GPIOS); return ret; }

Contributors

PersonTokensPropCommitsCommitProp
Sebastian Andrzej Siewior27187.70%133.33%
Grant C. Likely3110.03%133.33%
Wei Yongjun72.27%133.33%
Total309100.00%3100.00%


static int sdv_gpio_probe(struct pci_dev *pdev, const struct pci_device_id *pci_id) { struct sdv_gpio_chip_data *sd; unsigned long addr; const void *prop; int len; int ret; u32 mux_val; sd = kzalloc(sizeof(struct sdv_gpio_chip_data), GFP_KERNEL); if (!sd) return -ENOMEM; ret = pci_enable_device(pdev); if (ret) { dev_err(&pdev->dev, "can't enable device.\n"); goto done; } ret = pci_request_region(pdev, GPIO_BAR, DRV_NAME); if (ret) { dev_err(&pdev->dev, "can't alloc PCI BAR #%d\n", GPIO_BAR); goto disable_pci; } addr = pci_resource_start(pdev, GPIO_BAR); if (!addr) { ret = -ENODEV; goto release_reg; } sd->gpio_pub_base = ioremap(addr, pci_resource_len(pdev, GPIO_BAR)); prop = of_get_property(pdev->dev.of_node, "intel,muxctl", &len); if (prop && len == 4) { mux_val = of_read_number(prop, 1); writel(mux_val, sd->gpio_pub_base + GPMUXCTL); } ret = bgpio_init(&sd->chip, &pdev->dev, 4, sd->gpio_pub_base + GPINR, sd->gpio_pub_base + GPOUTR, NULL, sd->gpio_pub_base + GPOER, NULL, 0); if (ret) goto unmap; sd->chip.ngpio = SDV_NUM_PUB_GPIOS; ret = gpiochip_add_data(&sd->chip, sd); if (ret < 0) { dev_err(&pdev->dev, "gpiochip_add() failed.\n"); goto unmap; } ret = sdv_register_irqsupport(sd, pdev); if (ret) goto unmap; pci_set_drvdata(pdev, sd); dev_info(&pdev->dev, "Sodaville GPIO driver registered.\n"); return 0; unmap: iounmap(sd->gpio_pub_base); release_reg: pci_release_region(pdev, GPIO_BAR); disable_pci: pci_disable_device(pdev); done: kfree(sd); return ret; }

Contributors

PersonTokensPropCommitsCommitProp
Sebastian Andrzej Siewior35296.17%125.00%
Wei Yongjun71.91%125.00%
Linus Walleij61.64%125.00%
Shawn Guo10.27%125.00%
Total366100.00%4100.00%

static const struct pci_device_id sdv_gpio_pci_ids[] = { { PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_SDV_GPIO) }, { 0, }, }; static struct pci_driver sdv_gpio_driver = { .driver = { .suppress_bind_attrs = true, }, .name = DRV_NAME, .id_table = sdv_gpio_pci_ids, .probe = sdv_gpio_probe, }; builtin_pci_driver(sdv_gpio_driver);

Overall Contributors

PersonTokensPropCommitsCommitProp
Sebastian Andrzej Siewior108692.11%111.11%
Grant C. Likely473.99%111.11%
Wei Yongjun141.19%111.11%
Paul Gortmaker121.02%111.11%
Linus Walleij90.76%111.11%
Jingoo Han60.51%111.11%
Marc Zyngier30.25%111.11%
Shawn Guo10.08%111.11%
Krzysztof Kozlowski10.08%111.11%
Axel Lin0.00%00.00%
Total1179100.00%9100.00%
Directory: drivers/gpio
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.