[deliverable/linux.git] / arch / arm / plat-mxc / 3ds_debugboard.c

/*
 * Copyright 2008-2009 Freescale Semiconductor, Inc. All Rights Reserved.
 * Copyright (C) 2010 Jason Wang <jason77.wang@gmail.com>
 *
 * The code contained herein is licensed under the GNU General Public
 * License. You may obtain a copy of the GNU General Public License
 * Version 2 or later at the following locations:
 *
 * http://www.opensource.org/licenses/gpl-license.html
 * http://www.gnu.org/copyleft/gpl.html
 */

#include <linux/interrupt.h>
#include <linux/irq.h>
#include <linux/io.h>
#include <linux/platform_device.h>
#include <linux/gpio.h>
#include <linux/smsc911x.h>

#include <mach/hardware.h>

/* LAN9217 ethernet base address */
#define LAN9217_BASE_ADDR(n)	(n + 0x0)
/* External UART */
#define UARTA_BASE_ADDR(n)	(n + 0x8000)
#define UARTB_BASE_ADDR(n)	(n + 0x10000)

#define BOARD_IO_ADDR(n)	(n + 0x20000)
/* LED switchs */
#define LED_SWITCH_REG		0x00
/* buttons */
#define SWITCH_BUTTONS_REG	0x08
/* status, interrupt */
#define INTR_STATUS_REG	0x10
#define INTR_MASK_REG		0x38
#define INTR_RESET_REG		0x20
/* magic word for debug CPLD */
#define MAGIC_NUMBER1_REG	0x40
#define MAGIC_NUMBER2_REG	0x48
/* CPLD code version */
#define CPLD_CODE_VER_REG	0x50
/* magic word for debug CPLD */
#define MAGIC_NUMBER3_REG	0x58
/* module reset register*/
#define MODULE_RESET_REG	0x60
/* CPU ID and Personality ID */
#define MCU_BOARD_ID_REG	0x68

#define MXC_IRQ_TO_EXPIO(irq)   ((irq) - MXC_BOARD_IRQ_START)
#define MXC_IRQ_TO_GPIO(irq)	((irq) - MXC_INTERNAL_IRQS)

#define MXC_EXP_IO_BASE		(MXC_BOARD_IRQ_START)
#define MXC_MAX_EXP_IO_LINES	16

/* interrupts like external uart , external ethernet etc*/
#define EXPIO_INT_ENET		(MXC_BOARD_IRQ_START + 0)
#define EXPIO_INT_XUART_A	(MXC_BOARD_IRQ_START + 1)
#define EXPIO_INT_XUART_B	(MXC_BOARD_IRQ_START + 2)
#define EXPIO_INT_BUTTON_A	(MXC_BOARD_IRQ_START + 3)
#define EXPIO_INT_BUTTON_B	(MXC_BOARD_IRQ_START + 4)

static void __iomem *brd_io;

static struct resource smsc911x_resources[] = {
	{
		.flags = IORESOURCE_MEM,
	} , {
		.start = EXPIO_INT_ENET,
		.end = EXPIO_INT_ENET,
		.flags = IORESOURCE_IRQ,
	},
};

static struct smsc911x_platform_config smsc911x_config = {
	.irq_polarity = SMSC911X_IRQ_POLARITY_ACTIVE_LOW,
	.flags = SMSC911X_USE_32BIT | SMSC911X_FORCE_INTERNAL_PHY,
};

static struct platform_device smsc_lan9217_device = {
	.name = "smsc911x",
	.id = 0,
	.dev = {
		.platform_data = &smsc911x_config,
	},
	.num_resources = ARRAY_SIZE(smsc911x_resources),
	.resource = smsc911x_resources,
};

static void mxc_expio_irq_handler(u32 irq, struct irq_desc *desc)
{
	u32 imr_val;
	u32 int_valid;
	u32 expio_irq;

	/* irq = gpio irq number */
	desc->irq_data.chip->irq_mask(&desc->irq_data);

	imr_val = __raw_readw(brd_io + INTR_MASK_REG);
	int_valid = __raw_readw(brd_io + INTR_STATUS_REG) & ~imr_val;

	expio_irq = MXC_BOARD_IRQ_START;
	for (; int_valid != 0; int_valid >>= 1, expio_irq++) {
		if ((int_valid & 1) == 0)
			continue;
		generic_handle_irq(expio_irq);
	}

	desc->irq_data.chip->irq_ack(&desc->irq_data);
	desc->irq_data.chip->irq_unmask(&desc->irq_data);
}

/*
 * Disable an expio pin's interrupt by setting the bit in the imr.
 * Irq is an expio virtual irq number
 */
static void expio_mask_irq(struct irq_data *d)
{
	u16 reg;
	u32 expio = MXC_IRQ_TO_EXPIO(d->irq);

	reg = __raw_readw(brd_io + INTR_MASK_REG);
	reg |= (1 << expio);
	__raw_writew(reg, brd_io + INTR_MASK_REG);
}

static void expio_ack_irq(struct irq_data *d)
{
	u32 expio = MXC_IRQ_TO_EXPIO(d->irq);

	__raw_writew(1 << expio, brd_io + INTR_RESET_REG);
	__raw_writew(0, brd_io + INTR_RESET_REG);
	expio_mask_irq(d);
}

static void expio_unmask_irq(struct irq_data *d)
{
	u16 reg;
	u32 expio = MXC_IRQ_TO_EXPIO(d->irq);

	reg = __raw_readw(brd_io + INTR_MASK_REG);
	reg &= ~(1 << expio);
	__raw_writew(reg, brd_io + INTR_MASK_REG);
}

static struct irq_chip expio_irq_chip = {
	.irq_ack = expio_ack_irq,
	.irq_mask = expio_mask_irq,
	.irq_unmask = expio_unmask_irq,
};

int __init mxc_expio_init(u32 base, u32 p_irq)
{
	int i;

	brd_io = ioremap(BOARD_IO_ADDR(base), SZ_4K);
	if (brd_io == NULL)
		return -ENOMEM;

	if ((__raw_readw(brd_io + MAGIC_NUMBER1_REG) != 0xAAAA) ||
	    (__raw_readw(brd_io + MAGIC_NUMBER2_REG) != 0x5555) ||
	    (__raw_readw(brd_io + MAGIC_NUMBER3_REG) != 0xCAFE)) {
		pr_info("3-Stack Debug board not detected\n");
		iounmap(brd_io);
		brd_io = NULL;
		return -ENODEV;
	}

	pr_info("3-Stack Debug board detected, rev = 0x%04X\n",
		readw(brd_io + CPLD_CODE_VER_REG));

	/*
	 * Configure INT line as GPIO input
	 */
	gpio_request(MXC_IRQ_TO_GPIO(p_irq), "expio_pirq");
	gpio_direction_input(MXC_IRQ_TO_GPIO(p_irq));

	/* disable the interrupt and clear the status */
	__raw_writew(0, brd_io + INTR_MASK_REG);
	__raw_writew(0xFFFF, brd_io + INTR_RESET_REG);
	__raw_writew(0, brd_io + INTR_RESET_REG);
	__raw_writew(0x1F, brd_io + INTR_MASK_REG);
	for (i = MXC_EXP_IO_BASE;
	     i < (MXC_EXP_IO_BASE + MXC_MAX_EXP_IO_LINES); i++) {
		set_irq_chip(i, &expio_irq_chip);
		set_irq_handler(i, handle_level_irq);
		set_irq_flags(i, IRQF_VALID);
	}
	set_irq_type(p_irq, IRQF_TRIGGER_LOW);
	set_irq_chained_handler(p_irq, mxc_expio_irq_handler);

	/* Register Lan device on the debugboard */
	smsc911x_resources[0].start = LAN9217_BASE_ADDR(base);
	smsc911x_resources[0].end = LAN9217_BASE_ADDR(base) + 0x100 - 1;
	platform_device_register(&smsc_lan9217_device);

	return 0;
}
Commit	Line	Data
fa94f8dc JW	1	/*
	2	* Copyright 2008-2009 Freescale Semiconductor, Inc. All Rights Reserved.
	3	* Copyright (C) 2010 Jason Wang <jason77.wang@gmail.com>
	4	*
	5	* The code contained herein is licensed under the GNU General Public
	6	* License. You may obtain a copy of the GNU General Public License
	7	* Version 2 or later at the following locations:
	8	*
	9	* http://www.opensource.org/licenses/gpl-license.html
	10	* http://www.gnu.org/copyleft/gpl.html
	11	*/
	12
	13	#include <linux/interrupt.h>
	14	#include <linux/irq.h>
	15	#include <linux/io.h>
	16	#include <linux/platform_device.h>
	17	#include <linux/gpio.h>
	18	#include <linux/smsc911x.h>
	19
	20	#include <mach/hardware.h>
	21
	22	/* LAN9217 ethernet base address */
	23	#define LAN9217_BASE_ADDR(n) (n + 0x0)
	24	/* External UART */
	25	#define UARTA_BASE_ADDR(n) (n + 0x8000)
	26	#define UARTB_BASE_ADDR(n) (n + 0x10000)
	27
	28	#define BOARD_IO_ADDR(n) (n + 0x20000)
	29	/* LED switchs */
	30	#define LED_SWITCH_REG 0x00
	31	/* buttons */
	32	#define SWITCH_BUTTONS_REG 0x08
	33	/* status, interrupt */
	34	#define INTR_STATUS_REG 0x10
	35	#define INTR_MASK_REG 0x38
	36	#define INTR_RESET_REG 0x20
	37	/* magic word for debug CPLD */
	38	#define MAGIC_NUMBER1_REG 0x40
	39	#define MAGIC_NUMBER2_REG 0x48
	40	/* CPLD code version */
	41	#define CPLD_CODE_VER_REG 0x50
	42	/* magic word for debug CPLD */
	43	#define MAGIC_NUMBER3_REG 0x58
	44	/* module reset register*/
	45	#define MODULE_RESET_REG 0x60
	46	/* CPU ID and Personality ID */
	47	#define MCU_BOARD_ID_REG 0x68
	48
	49	#define MXC_IRQ_TO_EXPIO(irq) ((irq) - MXC_BOARD_IRQ_START)
	50	#define MXC_IRQ_TO_GPIO(irq) ((irq) - MXC_INTERNAL_IRQS)
	51
	52	#define MXC_EXP_IO_BASE (MXC_BOARD_IRQ_START)
	53	#define MXC_MAX_EXP_IO_LINES 16
	54
	55	/* interrupts like external uart , external ethernet etc*/
	56	#define EXPIO_INT_ENET (MXC_BOARD_IRQ_START + 0)
	57	#define EXPIO_INT_XUART_A (MXC_BOARD_IRQ_START + 1)
	58	#define EXPIO_INT_XUART_B (MXC_BOARD_IRQ_START + 2)
	59	#define EXPIO_INT_BUTTON_A (MXC_BOARD_IRQ_START + 3)
	60	#define EXPIO_INT_BUTTON_B (MXC_BOARD_IRQ_START + 4)
	61
	62	static void __iomem *brd_io;
fa94f8dc JW	63
	64	static struct resource smsc911x_resources[] = {
	65	{
	66	.flags = IORESOURCE_MEM,
	67	} , {
	68	.start = EXPIO_INT_ENET,
	69	.end = EXPIO_INT_ENET,
	70	.flags = IORESOURCE_IRQ,
	71	},
	72	};
	73
	74	static struct smsc911x_platform_config smsc911x_config = {
	75	.irq_polarity = SMSC911X_IRQ_POLARITY_ACTIVE_LOW,
	76	.flags = SMSC911X_USE_32BIT \| SMSC911X_FORCE_INTERNAL_PHY,
	77	};
	78
	79	static struct platform_device smsc_lan9217_device = {
	80	.name = "smsc911x",
	81	.id = 0,
	82	.dev = {
	83	.platform_data = &smsc911x_config,
	84	},
	85	.num_resources = ARRAY_SIZE(smsc911x_resources),
	86	.resource = smsc911x_resources,
	87	};
	88
	89	static void mxc_expio_irq_handler(u32 irq, struct irq_desc *desc)
	90	{
	91	u32 imr_val;
	92	u32 int_valid;
	93	u32 expio_irq;
	94
4d93579f LB	95	/* irq = gpio irq number */
4d93579f LB	96	desc->irq_data.chip->irq_mask(&desc->irq_data);
fa94f8dc JW	97
	98	imr_val = __raw_readw(brd_io + INTR_MASK_REG);
	99	int_valid = __raw_readw(brd_io + INTR_STATUS_REG) & ~imr_val;
	100
	101	expio_irq = MXC_BOARD_IRQ_START;
	102	for (; int_valid != 0; int_valid >>= 1, expio_irq++) {
fa94f8dc JW	103	if ((int_valid & 1) == 0)
fa94f8dc JW	104	continue;
eb2d7188	105	generic_handle_irq(expio_irq);
fa94f8dc JW	106	}
fa94f8dc JW	107
4d93579f LB	108	desc->irq_data.chip->irq_ack(&desc->irq_data);
4d93579f LB	109	desc->irq_data.chip->irq_unmask(&desc->irq_data);
fa94f8dc JW	110	}
	111
	112	/*
	113	* Disable an expio pin's interrupt by setting the bit in the imr.
	114	* Irq is an expio virtual irq number
	115	*/
4d93579f	116	static void expio_mask_irq(struct irq_data *d)
fa94f8dc JW	117	{
fa94f8dc JW	118	u16 reg;
4d93579f	119	u32 expio = MXC_IRQ_TO_EXPIO(d->irq);
fa94f8dc JW	120
	121	reg = __raw_readw(brd_io + INTR_MASK_REG);
	122	reg \|= (1 << expio);
	123	__raw_writew(reg, brd_io + INTR_MASK_REG);
	124	}
	125
4d93579f	126	static void expio_ack_irq(struct irq_data *d)
fa94f8dc	127	{
4d93579f	128	u32 expio = MXC_IRQ_TO_EXPIO(d->irq);
fa94f8dc JW	129
	130	__raw_writew(1 << expio, brd_io + INTR_RESET_REG);
	131	__raw_writew(0, brd_io + INTR_RESET_REG);
4d93579f	132	expio_mask_irq(d);
fa94f8dc JW	133	}
fa94f8dc JW	134
4d93579f	135	static void expio_unmask_irq(struct irq_data *d)
fa94f8dc JW	136	{
fa94f8dc JW	137	u16 reg;
4d93579f	138	u32 expio = MXC_IRQ_TO_EXPIO(d->irq);
fa94f8dc JW	139
	140	reg = __raw_readw(brd_io + INTR_MASK_REG);
	141	reg &= ~(1 << expio);
	142	__raw_writew(reg, brd_io + INTR_MASK_REG);
	143	}
	144
	145	static struct irq_chip expio_irq_chip = {
4d93579f LB	146	.irq_ack = expio_ack_irq,
	147	.irq_mask = expio_mask_irq,
	148	.irq_unmask = expio_unmask_irq,
fa94f8dc JW	149	};
	150
	151	int __init mxc_expio_init(u32 base, u32 p_irq)
	152	{
	153	int i;
	154
	155	brd_io = ioremap(BOARD_IO_ADDR(base), SZ_4K);
	156	if (brd_io == NULL)
	157	return -ENOMEM;
	158
	159	if ((__raw_readw(brd_io + MAGIC_NUMBER1_REG) != 0xAAAA) \|\|
	160	(__raw_readw(brd_io + MAGIC_NUMBER2_REG) != 0x5555) \|\|
	161	(__raw_readw(brd_io + MAGIC_NUMBER3_REG) != 0xCAFE)) {
	162	pr_info("3-Stack Debug board not detected\n");
	163	iounmap(brd_io);
	164	brd_io = NULL;
	165	return -ENODEV;
	166	}
	167
	168	pr_info("3-Stack Debug board detected, rev = 0x%04X\n",
	169	readw(brd_io + CPLD_CODE_VER_REG));
	170
	171	/*
	172	* Configure INT line as GPIO input
	173	*/
	174	gpio_request(MXC_IRQ_TO_GPIO(p_irq), "expio_pirq");
	175	gpio_direction_input(MXC_IRQ_TO_GPIO(p_irq));
	176
	177	/* disable the interrupt and clear the status */
	178	__raw_writew(0, brd_io + INTR_MASK_REG);
	179	__raw_writew(0xFFFF, brd_io + INTR_RESET_REG);
	180	__raw_writew(0, brd_io + INTR_RESET_REG);
	181	__raw_writew(0x1F, brd_io + INTR_MASK_REG);
	182	for (i = MXC_EXP_IO_BASE;
	183	i < (MXC_EXP_IO_BASE + MXC_MAX_EXP_IO_LINES); i++) {
	184	set_irq_chip(i, &expio_irq_chip);
	185	set_irq_handler(i, handle_level_irq);
	186	set_irq_flags(i, IRQF_VALID);
	187	}
	188	set_irq_type(p_irq, IRQF_TRIGGER_LOW);
	189	set_irq_chained_handler(p_irq, mxc_expio_irq_handler);
	190
	191	/* Register Lan device on the debugboard */
	192	smsc911x_resources[0].start = LAN9217_BASE_ADDR(base);
	193	smsc911x_resources[0].end = LAN9217_BASE_ADDR(base) + 0x100 - 1;
	194	platform_device_register(&smsc_lan9217_device);
	195
	196	return 0;
	197	}