cregit-Linux how code gets into the kernel

Release 4.11 drivers/irqchip/irq-clps711x.c

Directory: drivers/irqchip
/*
 *  CLPS711X IRQ driver
 *
 *  Copyright (C) 2013 Alexander Shiyan <shc_work@mail.ru>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 */

#include <linux/io.h>
#include <linux/irq.h>
#include <linux/irqchip.h>
#include <linux/irqdomain.h>
#include <linux/of_address.h>
#include <linux/of_irq.h>
#include <linux/slab.h>

#include <asm/exception.h>
#include <asm/mach/irq.h>


#define CLPS711X_INTSR1	(0x0240)

#define CLPS711X_INTMR1	(0x0280)

#define CLPS711X_BLEOI	(0x0600)

#define CLPS711X_MCEOI	(0x0640)

#define CLPS711X_TEOI	(0x0680)

#define CLPS711X_TC1EOI	(0x06c0)

#define CLPS711X_TC2EOI	(0x0700)

#define CLPS711X_RTCEOI	(0x0740)

#define CLPS711X_UMSEOI	(0x0780)

#define CLPS711X_COEOI	(0x07c0)

#define CLPS711X_INTSR2	(0x1240)

#define CLPS711X_INTMR2	(0x1280)

#define CLPS711X_SRXEOF	(0x1600)

#define CLPS711X_KBDEOI	(0x1700)

#define CLPS711X_INTSR3	(0x2240)

#define CLPS711X_INTMR3	(0x2280)

static const struct {

#define CLPS711X_FLAG_EN	(1 << 0)

#define CLPS711X_FLAG_FIQ	(1 << 1)
	
unsigned int	flags;
	
phys_addr_t	eoi;
} 
clps711x_irqs[] = {
	[1]	= { CLPS711X_FLAG_FIQ, CLPS711X_BLEOI, },
	[3]	= { CLPS711X_FLAG_FIQ, CLPS711X_MCEOI, },
	[4]	= { CLPS711X_FLAG_EN, CLPS711X_COEOI, },
	[5]	= { CLPS711X_FLAG_EN, },
	[6]	= { CLPS711X_FLAG_EN, },
	[7]	= { CLPS711X_FLAG_EN, },
	[8]	= { CLPS711X_FLAG_EN, CLPS711X_TC1EOI, },
	[9]	= { CLPS711X_FLAG_EN, CLPS711X_TC2EOI, },
	[10]	= { CLPS711X_FLAG_EN, CLPS711X_RTCEOI, },
	[11]	= { CLPS711X_FLAG_EN, CLPS711X_TEOI, },
	[12]	= { CLPS711X_FLAG_EN, },
	[13]	= { CLPS711X_FLAG_EN, },
	[14]	= { CLPS711X_FLAG_EN, CLPS711X_UMSEOI, },
	[15]	= { CLPS711X_FLAG_EN, CLPS711X_SRXEOF, },
	[16]	= { CLPS711X_FLAG_EN, CLPS711X_KBDEOI, },
	[17]	= { CLPS711X_FLAG_EN, },
	[18]	= { CLPS711X_FLAG_EN, },
	[28]	= { CLPS711X_FLAG_EN, },
	[29]	= { CLPS711X_FLAG_EN, },
	[32]	= { CLPS711X_FLAG_FIQ, },
};

static struct {
	
void __iomem		*base;
	
void __iomem		*intmr[3];
	
void __iomem		*intsr[3];
	
struct irq_domain	*domain;
	
struct irq_domain_ops	ops;
} 
*clps711x_intc;


static asmlinkage void __exception_irq_entry clps711x_irqh(struct pt_regs *regs) { u32 irqstat; do { irqstat = readw_relaxed(clps711x_intc->intmr[0]) & readw_relaxed(clps711x_intc->intsr[0]); if (irqstat) handle_domain_irq(clps711x_intc->domain, fls(irqstat) - 1, regs); irqstat = readw_relaxed(clps711x_intc->intmr[1]) & readw_relaxed(clps711x_intc->intsr[1]); if (irqstat) handle_domain_irq(clps711x_intc->domain, fls(irqstat) - 1 + 16, regs); } while (irqstat); }

Contributors

PersonTokensPropCommitsCommitProp
Alexander Shiyan10898.18%150.00%
Marc Zyngier21.82%150.00%
Total110100.00%2100.00%


static void clps711x_intc_eoi(struct irq_data *d) { irq_hw_number_t hwirq = irqd_to_hwirq(d); writel_relaxed(0, clps711x_intc->base + clps711x_irqs[hwirq].eoi); }

Contributors

PersonTokensPropCommitsCommitProp
Alexander Shiyan35100.00%1100.00%
Total35100.00%1100.00%


static void clps711x_intc_mask(struct irq_data *d) { irq_hw_number_t hwirq = irqd_to_hwirq(d); void __iomem *intmr = clps711x_intc->intmr[hwirq / 16]; u32 tmp; tmp = readl_relaxed(intmr); tmp &= ~(1 << (hwirq % 16)); writel_relaxed(tmp, intmr); }

Contributors

PersonTokensPropCommitsCommitProp
Alexander Shiyan63100.00%1100.00%
Total63100.00%1100.00%


static void clps711x_intc_unmask(struct irq_data *d) { irq_hw_number_t hwirq = irqd_to_hwirq(d); void __iomem *intmr = clps711x_intc->intmr[hwirq / 16]; u32 tmp; tmp = readl_relaxed(intmr); tmp |= 1 << (hwirq % 16); writel_relaxed(tmp, intmr); }

Contributors

PersonTokensPropCommitsCommitProp
Alexander Shiyan60100.00%1100.00%
Total60100.00%1100.00%

static struct irq_chip clps711x_intc_chip = { .name = "clps711x-intc", .irq_eoi = clps711x_intc_eoi, .irq_mask = clps711x_intc_mask, .irq_unmask = clps711x_intc_unmask, };
static int __init clps711x_intc_irq_map(struct irq_domain *h, unsigned int virq, irq_hw_number_t hw) { irq_flow_handler_t handler = handle_level_irq; unsigned int flags = 0; if (!clps711x_irqs[hw].flags) return 0; if (clps711x_irqs[hw].flags & CLPS711X_FLAG_FIQ) { handler = handle_bad_irq; flags |= IRQ_NOAUTOEN; } else if (clps711x_irqs[hw].eoi) { handler = handle_fasteoi_irq; } /* Clear down pending interrupt */ if (clps711x_irqs[hw].eoi) writel_relaxed(0, clps711x_intc->base + clps711x_irqs[hw].eoi); irq_set_chip_and_handler(virq, &clps711x_intc_chip, handler); irq_modify_status(virq, IRQ_NOPROBE, flags); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Alexander Shiyan12396.09%150.00%
Rob Herring53.91%150.00%
Total128100.00%2100.00%


static int __init _clps711x_intc_init(struct device_node *np, phys_addr_t base, resource_size_t size) { int err; clps711x_intc = kzalloc(sizeof(*clps711x_intc), GFP_KERNEL); if (!clps711x_intc) return -ENOMEM; clps711x_intc->base = ioremap(base, size); if (!clps711x_intc->base) { err = -ENOMEM; goto out_kfree; } clps711x_intc->intsr[0] = clps711x_intc->base + CLPS711X_INTSR1; clps711x_intc->intmr[0] = clps711x_intc->base + CLPS711X_INTMR1; clps711x_intc->intsr[1] = clps711x_intc->base + CLPS711X_INTSR2; clps711x_intc->intmr[1] = clps711x_intc->base + CLPS711X_INTMR2; clps711x_intc->intsr[2] = clps711x_intc->base + CLPS711X_INTSR3; clps711x_intc->intmr[2] = clps711x_intc->base + CLPS711X_INTMR3; /* Mask all interrupts */ writel_relaxed(0, clps711x_intc->intmr[0]); writel_relaxed(0, clps711x_intc->intmr[1]); writel_relaxed(0, clps711x_intc->intmr[2]); err = irq_alloc_descs(-1, 0, ARRAY_SIZE(clps711x_irqs), numa_node_id()); if (err < 0) goto out_iounmap; clps711x_intc->ops.map = clps711x_intc_irq_map; clps711x_intc->ops.xlate = irq_domain_xlate_onecell; clps711x_intc->domain = irq_domain_add_legacy(np, ARRAY_SIZE(clps711x_irqs), 0, 0, &clps711x_intc->ops, NULL); if (!clps711x_intc->domain) { err = -ENOMEM; goto out_irqfree; } irq_set_default_host(clps711x_intc->domain); set_handle_irq(clps711x_irqh); #ifdef CONFIG_FIQ init_FIQ(0); #endif return 0; out_irqfree: irq_free_descs(0, ARRAY_SIZE(clps711x_irqs)); out_iounmap: iounmap(clps711x_intc->base); out_kfree: kfree(clps711x_intc); return err; }

Contributors

PersonTokensPropCommitsCommitProp
Alexander Shiyan32599.39%150.00%
Arnd Bergmann20.61%150.00%
Total327100.00%2100.00%


void __init clps711x_intc_init(phys_addr_t base, resource_size_t size) { BUG_ON(_clps711x_intc_init(NULL, base, size)); }

Contributors

PersonTokensPropCommitsCommitProp
Alexander Shiyan24100.00%1100.00%
Total24100.00%1100.00%

#ifdef CONFIG_IRQCHIP
static int __init clps711x_intc_init_dt(struct device_node *np, struct device_node *parent) { struct resource res; int err; err = of_address_to_resource(np, 0, &res); if (err) return err; return _clps711x_intc_init(np, res.start, resource_size(&res)); }

Contributors

PersonTokensPropCommitsCommitProp
Alexander Shiyan59100.00%1100.00%
Total59100.00%1100.00%

IRQCHIP_DECLARE(clps711x, "cirrus,ep7209-intc", clps711x_intc_init_dt); #endif

Overall Contributors

PersonTokensPropCommitsCommitProp
Alexander Shiyan116998.98%233.33%
Rob Herring50.42%116.67%
Joël Porquet30.25%116.67%
Marc Zyngier20.17%116.67%
Arnd Bergmann20.17%116.67%
Total1181100.00%6100.00%
Directory: drivers/irqchip
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.