[deliverable/linux.git] / arch / arm / mach-ux500 / modem-irq-db5500.c

/*
 * Copyright (C) ST-Ericsson SA 2010
 * Author: Stefan Nilsson <stefan.xk.nilsson@stericsson.com> for ST-Ericsson.
 * Author: Martin Persson <martin.persson@stericsson.com> for ST-Ericsson.
 * License terms: GNU General Public License (GPL), version 2.
 */

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/irq.h>
#include <linux/interrupt.h>
#include <linux/io.h>
#include <linux/slab.h>

#include <mach/id.h>

#define MODEM_INTCON_BASE_ADDR 0xBFFD3000
#define MODEM_INTCON_SIZE 0xFFF

#define DEST_IRQ41_OFFSET 0x2A4
#define DEST_IRQ43_OFFSET 0x2AC
#define DEST_IRQ45_OFFSET 0x2B4

#define PRIO_IRQ41_OFFSET 0x6A4
#define PRIO_IRQ43_OFFSET 0x6AC
#define PRIO_IRQ45_OFFSET 0x6B4

#define ALLOW_IRQ_OFFSET 0x104

#define MODEM_INTCON_CPU_NBR 0x1
#define MODEM_INTCON_PRIO_HIGH 0x0

#define MODEM_INTCON_ALLOW_IRQ41 0x0200
#define MODEM_INTCON_ALLOW_IRQ43 0x0800
#define MODEM_INTCON_ALLOW_IRQ45 0x2000

#define MODEM_IRQ_REG_OFFSET 0x4

struct modem_irq {
	void __iomem *modem_intcon_base;
};


static void setup_modem_intcon(void __iomem *modem_intcon_base)
{
	/* IC_DESTINATION_BASE_ARRAY - Which CPU to receive the IRQ */
	writel(MODEM_INTCON_CPU_NBR, modem_intcon_base + DEST_IRQ41_OFFSET);
	writel(MODEM_INTCON_CPU_NBR, modem_intcon_base + DEST_IRQ43_OFFSET);
	writel(MODEM_INTCON_CPU_NBR, modem_intcon_base + DEST_IRQ45_OFFSET);

	/* IC_PRIORITY_BASE_ARRAY - IRQ priority in modem IRQ controller */
	writel(MODEM_INTCON_PRIO_HIGH, modem_intcon_base + PRIO_IRQ41_OFFSET);
	writel(MODEM_INTCON_PRIO_HIGH, modem_intcon_base + PRIO_IRQ43_OFFSET);
	writel(MODEM_INTCON_PRIO_HIGH, modem_intcon_base + PRIO_IRQ45_OFFSET);

	/* IC_ALLOW_ARRAY - IRQ enable */
	writel(MODEM_INTCON_ALLOW_IRQ41 |
		   MODEM_INTCON_ALLOW_IRQ43 |
		   MODEM_INTCON_ALLOW_IRQ45,
		   modem_intcon_base + ALLOW_IRQ_OFFSET);
}

static irqreturn_t modem_cpu_irq_handler(int irq, void *data)
{
	int real_irq;
	int virt_irq;
	struct modem_irq *mi = (struct modem_irq *)data;

	/* Read modem side IRQ number from modem IRQ controller */
	real_irq = readl(mi->modem_intcon_base + MODEM_IRQ_REG_OFFSET) & 0xFF;
	virt_irq = IRQ_MODEM_EVENTS_BASE + real_irq;

	pr_debug("modem_irq: Worker read addr 0x%X and got value 0x%X "
		 "which will be 0x%X (%d) which translates to "
		 "virtual IRQ 0x%X (%d)!\n",
		   (u32)mi->modem_intcon_base + MODEM_IRQ_REG_OFFSET,
		   real_irq,
		   real_irq & 0xFF,
		   real_irq & 0xFF,
		   virt_irq,
		   virt_irq);

	if (virt_irq != 0)
		generic_handle_irq(virt_irq);

	pr_debug("modem_irq: Done handling virtual IRQ %d!\n", virt_irq);

	return IRQ_HANDLED;
}

static void create_virtual_irq(int irq, struct irq_chip *modem_irq_chip)
{
	irq_set_chip_and_handler(irq, modem_irq_chip, handle_simple_irq);
	set_irq_flags(irq, IRQF_VALID);

	pr_debug("modem_irq: Created virtual IRQ %d\n", irq);
}

static int modem_irq_init(void)
{
	int err;
	static struct irq_chip  modem_irq_chip;
	struct modem_irq *mi;

	if (!cpu_is_u5500())
		return -ENODEV;

	pr_info("modem_irq: Set up IRQ handler for incoming modem IRQ %d\n",
		   IRQ_DB5500_MODEM);

	mi = kmalloc(sizeof(struct modem_irq), GFP_KERNEL);
	if (!mi) {
		pr_err("modem_irq: Could not allocate device\n");
		return -ENOMEM;
	}

	mi->modem_intcon_base =
		ioremap(MODEM_INTCON_BASE_ADDR, MODEM_INTCON_SIZE);
	pr_debug("modem_irq: ioremapped modem_intcon_base from "
		 "phy 0x%x to virt 0x%x\n", MODEM_INTCON_BASE_ADDR,
		 (u32)mi->modem_intcon_base);

	setup_modem_intcon(mi->modem_intcon_base);

	modem_irq_chip = dummy_irq_chip;
	modem_irq_chip.name = "modem_irq";

	/* Create the virtual IRQ:s needed */
	create_virtual_irq(MBOX_PAIR0_VIRT_IRQ, &modem_irq_chip);
	create_virtual_irq(MBOX_PAIR1_VIRT_IRQ, &modem_irq_chip);
	create_virtual_irq(MBOX_PAIR2_VIRT_IRQ, &modem_irq_chip);

	err = request_threaded_irq(IRQ_DB5500_MODEM, NULL,
				   modem_cpu_irq_handler, IRQF_ONESHOT,
				   "modem_irq", mi);
	if (err)
		pr_err("modem_irq: Could not register IRQ %d\n",
		       IRQ_DB5500_MODEM);

	return 0;
}

arch_initcall(modem_irq_init);
Commit	Line	Data
b84ccd77 LW	1	/*
	2	* Copyright (C) ST-Ericsson SA 2010
	3	* Author: Stefan Nilsson <stefan.xk.nilsson@stericsson.com> for ST-Ericsson.
	4	* Author: Martin Persson <martin.persson@stericsson.com> for ST-Ericsson.
	5	* License terms: GNU General Public License (GPL), version 2.
	6	*/
	7
	8	#include <linux/module.h>
	9	#include <linux/kernel.h>
	10	#include <linux/irq.h>
	11	#include <linux/interrupt.h>
	12	#include <linux/io.h>
	13	#include <linux/slab.h>
	14
5ec65521 RV	15	#include <mach/id.h>
5ec65521 RV	16
b84ccd77 LW	17	#define MODEM_INTCON_BASE_ADDR 0xBFFD3000
	18	#define MODEM_INTCON_SIZE 0xFFF
	19
	20	#define DEST_IRQ41_OFFSET 0x2A4
	21	#define DEST_IRQ43_OFFSET 0x2AC
	22	#define DEST_IRQ45_OFFSET 0x2B4
	23
	24	#define PRIO_IRQ41_OFFSET 0x6A4
	25	#define PRIO_IRQ43_OFFSET 0x6AC
	26	#define PRIO_IRQ45_OFFSET 0x6B4
	27
	28	#define ALLOW_IRQ_OFFSET 0x104
	29
	30	#define MODEM_INTCON_CPU_NBR 0x1
	31	#define MODEM_INTCON_PRIO_HIGH 0x0
	32
	33	#define MODEM_INTCON_ALLOW_IRQ41 0x0200
	34	#define MODEM_INTCON_ALLOW_IRQ43 0x0800
	35	#define MODEM_INTCON_ALLOW_IRQ45 0x2000
	36
	37	#define MODEM_IRQ_REG_OFFSET 0x4
	38
	39	struct modem_irq {
	40	void __iomem *modem_intcon_base;
	41	};
	42
	43
	44	static void setup_modem_intcon(void __iomem *modem_intcon_base)
	45	{
	46	/* IC_DESTINATION_BASE_ARRAY - Which CPU to receive the IRQ */
	47	writel(MODEM_INTCON_CPU_NBR, modem_intcon_base + DEST_IRQ41_OFFSET);
	48	writel(MODEM_INTCON_CPU_NBR, modem_intcon_base + DEST_IRQ43_OFFSET);
	49	writel(MODEM_INTCON_CPU_NBR, modem_intcon_base + DEST_IRQ45_OFFSET);
	50
	51	/* IC_PRIORITY_BASE_ARRAY - IRQ priority in modem IRQ controller */
	52	writel(MODEM_INTCON_PRIO_HIGH, modem_intcon_base + PRIO_IRQ41_OFFSET);
	53	writel(MODEM_INTCON_PRIO_HIGH, modem_intcon_base + PRIO_IRQ43_OFFSET);
	54	writel(MODEM_INTCON_PRIO_HIGH, modem_intcon_base + PRIO_IRQ45_OFFSET);
	55
	56	/* IC_ALLOW_ARRAY - IRQ enable */
	57	writel(MODEM_INTCON_ALLOW_IRQ41 \|
	58	MODEM_INTCON_ALLOW_IRQ43 \|
	59	MODEM_INTCON_ALLOW_IRQ45,
	60	modem_intcon_base + ALLOW_IRQ_OFFSET);
	61	}
	62
	63	static irqreturn_t modem_cpu_irq_handler(int irq, void *data)
	64	{
	65	int real_irq;
	66	int virt_irq;
	67	struct modem_irq mi = (struct modem_irq )data;
	68
	69	/* Read modem side IRQ number from modem IRQ controller */
	70	real_irq = readl(mi->modem_intcon_base + MODEM_IRQ_REG_OFFSET) & 0xFF;
	71	virt_irq = IRQ_MODEM_EVENTS_BASE + real_irq;
	72
	73	pr_debug("modem_irq: Worker read addr 0x%X and got value 0x%X "
	74	"which will be 0x%X (%d) which translates to "
	75	"virtual IRQ 0x%X (%d)!\n",
	76	(u32)mi->modem_intcon_base + MODEM_IRQ_REG_OFFSET,
	77	real_irq,
	78	real_irq & 0xFF,
	79	real_irq & 0xFF,
	80	virt_irq,
81	virt_irq);
82
83	if (virt_irq != 0)
84	generic_handle_irq(virt_irq);
85
86	pr_debug("modem_irq: Done handling virtual IRQ %d!\n", virt_irq);
87
88	return IRQ_HANDLED;
89	}
90
91	static void create_virtual_irq(int irq, struct irq_chip *modem_irq_chip)
92	{
f38c02f3	93	irq_set_chip_and_handler(irq, modem_irq_chip, handle_simple_irq);
b84ccd77 LW	94	set_irq_flags(irq, IRQF_VALID);
	95
	96	pr_debug("modem_irq: Created virtual IRQ %d\n", irq);
	97	}
	98
	99	static int modem_irq_init(void)
	100	{
	101	int err;
	102	static struct irq_chip modem_irq_chip;
	103	struct modem_irq *mi;
	104
5ec65521 RV	105	if (!cpu_is_u5500())
	106	return -ENODEV;
	107
b84ccd77 LW	108	pr_info("modem_irq: Set up IRQ handler for incoming modem IRQ %d\n",
	109	IRQ_DB5500_MODEM);
	110
	111	mi = kmalloc(sizeof(struct modem_irq), GFP_KERNEL);
	112	if (!mi) {
	113	pr_err("modem_irq: Could not allocate device\n");
	114	return -ENOMEM;
	115	}
	116
	117	mi->modem_intcon_base =
	118	ioremap(MODEM_INTCON_BASE_ADDR, MODEM_INTCON_SIZE);
	119	pr_debug("modem_irq: ioremapped modem_intcon_base from "
	120	"phy 0x%x to virt 0x%x\n", MODEM_INTCON_BASE_ADDR,
	121	(u32)mi->modem_intcon_base);
	122
	123	setup_modem_intcon(mi->modem_intcon_base);
	124
	125	modem_irq_chip = dummy_irq_chip;
	126	modem_irq_chip.name = "modem_irq";
	127
	128	/* Create the virtual IRQ:s needed */
	129	create_virtual_irq(MBOX_PAIR0_VIRT_IRQ, &modem_irq_chip);
	130	create_virtual_irq(MBOX_PAIR1_VIRT_IRQ, &modem_irq_chip);
	131	create_virtual_irq(MBOX_PAIR2_VIRT_IRQ, &modem_irq_chip);
	132
	133	err = request_threaded_irq(IRQ_DB5500_MODEM, NULL,
	134	modem_cpu_irq_handler, IRQF_ONESHOT,
	135	"modem_irq", mi);
	136	if (err)
	137	pr_err("modem_irq: Could not register IRQ %d\n",
	138	IRQ_DB5500_MODEM);
	139
	140	return 0;
	141	}
	142
	143	arch_initcall(modem_irq_init);