[deliverable/linux.git] / arch / arm / mach-at91 / at91rm9200.c

/*
 * arch/arm/mach-at91/at91rm9200.c
 *
 *  Copyright (C) 2005 SAN People
 *
 * 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/module.h>

#include <asm/irq.h>
#include <asm/mach/arch.h>
#include <asm/mach/map.h>
#include <mach/at91rm9200.h>
#include <mach/at91_pmc.h>
#include <mach/at91_st.h>
#include <mach/cpu.h>

#include "soc.h"
#include "generic.h"
#include "clock.h"

static struct map_desc at91rm9200_io_desc[] __initdata = {
	{
		.virtual	= AT91_VA_BASE_EMAC,
		.pfn		= __phys_to_pfn(AT91RM9200_BASE_EMAC),
		.length		= SZ_16K,
		.type		= MT_DEVICE,
	},
};

/* --------------------------------------------------------------------
 *  Clocks
 * -------------------------------------------------------------------- */

/*
 * The peripheral clocks.
 */
static struct clk udc_clk = {
	.name		= "udc_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_UDP,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk ohci_clk = {
	.name		= "ohci_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_UHP,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk ether_clk = {
	.name		= "ether_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_EMAC,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk mmc_clk = {
	.name		= "mci_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_MCI,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk twi_clk = {
	.name		= "twi_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_TWI,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk usart0_clk = {
	.name		= "usart0_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_US0,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk usart1_clk = {
	.name		= "usart1_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_US1,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk usart2_clk = {
	.name		= "usart2_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_US2,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk usart3_clk = {
	.name		= "usart3_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_US3,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk spi_clk = {
	.name		= "spi_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_SPI,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk pioA_clk = {
	.name		= "pioA_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_PIOA,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk pioB_clk = {
	.name		= "pioB_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_PIOB,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk pioC_clk = {
	.name		= "pioC_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_PIOC,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk pioD_clk = {
	.name		= "pioD_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_PIOD,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk ssc0_clk = {
	.name		= "ssc0_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_SSC0,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk ssc1_clk = {
	.name		= "ssc1_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_SSC1,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk ssc2_clk = {
	.name		= "ssc2_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_SSC2,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk tc0_clk = {
	.name		= "tc0_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_TC0,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk tc1_clk = {
	.name		= "tc1_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_TC1,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk tc2_clk = {
	.name		= "tc2_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_TC2,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk tc3_clk = {
	.name		= "tc3_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_TC3,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk tc4_clk = {
	.name		= "tc4_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_TC4,
	.type		= CLK_TYPE_PERIPHERAL,
};
static struct clk tc5_clk = {
	.name		= "tc5_clk",
	.pmc_mask	= 1 << AT91RM9200_ID_TC5,
	.type		= CLK_TYPE_PERIPHERAL,
};

static struct clk *periph_clocks[] __initdata = {
	&pioA_clk,
	&pioB_clk,
	&pioC_clk,
	&pioD_clk,
	&usart0_clk,
	&usart1_clk,
	&usart2_clk,
	&usart3_clk,
	&mmc_clk,
	&udc_clk,
	&twi_clk,
	&spi_clk,
	&ssc0_clk,
	&ssc1_clk,
	&ssc2_clk,
	&tc0_clk,
	&tc1_clk,
	&tc2_clk,
	&tc3_clk,
	&tc4_clk,
	&tc5_clk,
	&ohci_clk,
	&ether_clk,
	// irq0 .. irq6
};

static struct clk_lookup periph_clocks_lookups[] = {
	CLKDEV_CON_DEV_ID("t0_clk", "atmel_tcb.0", &tc0_clk),
	CLKDEV_CON_DEV_ID("t1_clk", "atmel_tcb.0", &tc1_clk),
	CLKDEV_CON_DEV_ID("t2_clk", "atmel_tcb.0", &tc2_clk),
	CLKDEV_CON_DEV_ID("t0_clk", "atmel_tcb.1", &tc3_clk),
	CLKDEV_CON_DEV_ID("t1_clk", "atmel_tcb.1", &tc4_clk),
	CLKDEV_CON_DEV_ID("t2_clk", "atmel_tcb.1", &tc5_clk),
	CLKDEV_CON_DEV_ID("pclk", "ssc.0", &ssc0_clk),
	CLKDEV_CON_DEV_ID("pclk", "ssc.1", &ssc1_clk),
	CLKDEV_CON_DEV_ID("pclk", "ssc.2", &ssc2_clk),
};

static struct clk_lookup usart_clocks_lookups[] = {
	CLKDEV_CON_DEV_ID("usart", "atmel_usart.0", &mck),
	CLKDEV_CON_DEV_ID("usart", "atmel_usart.1", &usart0_clk),
	CLKDEV_CON_DEV_ID("usart", "atmel_usart.2", &usart1_clk),
	CLKDEV_CON_DEV_ID("usart", "atmel_usart.3", &usart2_clk),
	CLKDEV_CON_DEV_ID("usart", "atmel_usart.4", &usart3_clk),
};

/*
 * The four programmable clocks.
 * You must configure pin multiplexing to bring these signals out.
 */
static struct clk pck0 = {
	.name		= "pck0",
	.pmc_mask	= AT91_PMC_PCK0,
	.type		= CLK_TYPE_PROGRAMMABLE,
	.id		= 0,
};
static struct clk pck1 = {
	.name		= "pck1",
	.pmc_mask	= AT91_PMC_PCK1,
	.type		= CLK_TYPE_PROGRAMMABLE,
	.id		= 1,
};
static struct clk pck2 = {
	.name		= "pck2",
	.pmc_mask	= AT91_PMC_PCK2,
	.type		= CLK_TYPE_PROGRAMMABLE,
	.id		= 2,
};
static struct clk pck3 = {
	.name		= "pck3",
	.pmc_mask	= AT91_PMC_PCK3,
	.type		= CLK_TYPE_PROGRAMMABLE,
	.id		= 3,
};

static void __init at91rm9200_register_clocks(void)
{
	int i;

	for (i = 0; i < ARRAY_SIZE(periph_clocks); i++)
		clk_register(periph_clocks[i]);

	clkdev_add_table(periph_clocks_lookups,
			 ARRAY_SIZE(periph_clocks_lookups));
	clkdev_add_table(usart_clocks_lookups,
			 ARRAY_SIZE(usart_clocks_lookups));

	clk_register(&pck0);
	clk_register(&pck1);
	clk_register(&pck2);
	clk_register(&pck3);
}

static struct clk_lookup console_clock_lookup;

void __init at91rm9200_set_console_clock(int id)
{
	if (id >= ARRAY_SIZE(usart_clocks_lookups))
		return;

	console_clock_lookup.con_id = "usart";
	console_clock_lookup.clk = usart_clocks_lookups[id].clk;
	clkdev_add(&console_clock_lookup);
}

/* --------------------------------------------------------------------
 *  GPIO
 * -------------------------------------------------------------------- */

static struct at91_gpio_bank at91rm9200_gpio[] = {
	{
		.id		= AT91RM9200_ID_PIOA,
		.offset		= AT91_PIOA,
		.clock		= &pioA_clk,
	}, {
		.id		= AT91RM9200_ID_PIOB,
		.offset		= AT91_PIOB,
		.clock		= &pioB_clk,
	}, {
		.id		= AT91RM9200_ID_PIOC,
		.offset		= AT91_PIOC,
		.clock		= &pioC_clk,
	}, {
		.id		= AT91RM9200_ID_PIOD,
		.offset		= AT91_PIOD,
		.clock		= &pioD_clk,
	}
};

static void at91rm9200_reset(void)
{
	/*
	 * Perform a hardware reset with the use of the Watchdog timer.
	 */
	at91_sys_write(AT91_ST_WDMR, AT91_ST_RSTEN | AT91_ST_EXTEN | 1);
	at91_sys_write(AT91_ST_CR, AT91_ST_WDRST);
}

/* --------------------------------------------------------------------
 *  AT91RM9200 processor initialization
 * -------------------------------------------------------------------- */
static void __init at91rm9200_map_io(void)
{
	/* Map peripherals */
	at91_init_sram(0, AT91RM9200_SRAM_BASE, AT91RM9200_SRAM_SIZE);
	iotable_init(at91rm9200_io_desc, ARRAY_SIZE(at91rm9200_io_desc));
}

static void __init at91rm9200_initialize(void)
{
	at91_arch_reset = at91rm9200_reset;
	at91_extern_irq = (1 << AT91RM9200_ID_IRQ0) | (1 << AT91RM9200_ID_IRQ1)
			| (1 << AT91RM9200_ID_IRQ2) | (1 << AT91RM9200_ID_IRQ3)
			| (1 << AT91RM9200_ID_IRQ4) | (1 << AT91RM9200_ID_IRQ5)
			| (1 << AT91RM9200_ID_IRQ6);

	/* Initialize GPIO subsystem */
	at91_gpio_init(at91rm9200_gpio,
		cpu_is_at91rm9200_bga() ? AT91RM9200_BGA : AT91RM9200_PQFP);
}


/* --------------------------------------------------------------------
 *  Interrupt initialization
 * -------------------------------------------------------------------- */

/*
 * The default interrupt priority levels (0 = lowest, 7 = highest).
 */
static unsigned int at91rm9200_default_irq_priority[NR_AIC_IRQS] __initdata = {
	7,	/* Advanced Interrupt Controller (FIQ) */
	7,	/* System Peripherals */
	1,	/* Parallel IO Controller A */
	1,	/* Parallel IO Controller B */
	1,	/* Parallel IO Controller C */
	1,	/* Parallel IO Controller D */
	5,	/* USART 0 */
	5,	/* USART 1 */
	5,	/* USART 2 */
	5,	/* USART 3 */
	0,	/* Multimedia Card Interface */
	2,	/* USB Device Port */
	6,	/* Two-Wire Interface */
	5,	/* Serial Peripheral Interface */
	4,	/* Serial Synchronous Controller 0 */
	4,	/* Serial Synchronous Controller 1 */
	4,	/* Serial Synchronous Controller 2 */
	0,	/* Timer Counter 0 */
	0,	/* Timer Counter 1 */
	0,	/* Timer Counter 2 */
	0,	/* Timer Counter 3 */
	0,	/* Timer Counter 4 */
	0,	/* Timer Counter 5 */
	2,	/* USB Host port */
	3,	/* Ethernet MAC */
	0,	/* Advanced Interrupt Controller (IRQ0) */
	0,	/* Advanced Interrupt Controller (IRQ1) */
	0,	/* Advanced Interrupt Controller (IRQ2) */
	0,	/* Advanced Interrupt Controller (IRQ3) */
	0,	/* Advanced Interrupt Controller (IRQ4) */
	0,	/* Advanced Interrupt Controller (IRQ5) */
	0	/* Advanced Interrupt Controller (IRQ6) */
};

struct at91_init_soc __initdata at91rm9200_soc = {
	.map_io = at91rm9200_map_io,
	.default_irq_priority = at91rm9200_default_irq_priority,
	.register_clocks = at91rm9200_register_clocks,
	.init = at91rm9200_initialize,
};
Commit	Line	Data
73a59c1c	1	/*
9d041268	2	* arch/arm/mach-at91/at91rm9200.c
73a59c1c SP	3	*
	4	* Copyright (C) 2005 SAN People
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License as published by
	8	* the Free Software Foundation; either version 2 of the License, or
	9	* (at your option) any later version.
	10	*
	11	*/
	12
73a59c1c SP	13	#include <linux/module.h>
73a59c1c SP	14
80b02c17	15	#include <asm/irq.h>
73a59c1c SP	16	#include <asm/mach/arch.h>
73a59c1c SP	17	#include <asm/mach/map.h>
a09e64fb RK	18	#include <mach/at91rm9200.h>
	19	#include <mach/at91_pmc.h>
	20	#include <mach/at91_st.h>
e57556e3	21	#include <mach/cpu.h>
73a59c1c	22
21d08b9d	23	#include "soc.h"
10e8e1fb	24	#include "generic.h"
2eeaaa21	25	#include "clock.h"
73a59c1c SP	26
	27	static struct map_desc at91rm9200_io_desc[] __initdata = {
	28	{
73a59c1c	29	.virtual = AT91_VA_BASE_EMAC,
72729910	30	.pfn = __phys_to_pfn(AT91RM9200_BASE_EMAC),
73a59c1c SP	31	.length = SZ_16K,
73a59c1c SP	32	.type = MT_DEVICE,
73a59c1c SP	33	},
	34	};
	35
2eeaaa21 AV	36	/* --------------------------------------------------------------------
	37	* Clocks
	38	* -------------------------------------------------------------------- */
	39
	40	/*
	41	* The peripheral clocks.
	42	*/
	43	static struct clk udc_clk = {
	44	.name = "udc_clk",
	45	.pmc_mask = 1 << AT91RM9200_ID_UDP,
	46	.type = CLK_TYPE_PERIPHERAL,
	47	};
	48	static struct clk ohci_clk = {
	49	.name = "ohci_clk",
	50	.pmc_mask = 1 << AT91RM9200_ID_UHP,
	51	.type = CLK_TYPE_PERIPHERAL,
	52	};
	53	static struct clk ether_clk = {
	54	.name = "ether_clk",
	55	.pmc_mask = 1 << AT91RM9200_ID_EMAC,
	56	.type = CLK_TYPE_PERIPHERAL,
	57	};
	58	static struct clk mmc_clk = {
	59	.name = "mci_clk",
	60	.pmc_mask = 1 << AT91RM9200_ID_MCI,
	61	.type = CLK_TYPE_PERIPHERAL,
	62	};
	63	static struct clk twi_clk = {
	64	.name = "twi_clk",
	65	.pmc_mask = 1 << AT91RM9200_ID_TWI,
	66	.type = CLK_TYPE_PERIPHERAL,
	67	};
	68	static struct clk usart0_clk = {
	69	.name = "usart0_clk",
	70	.pmc_mask = 1 << AT91RM9200_ID_US0,
	71	.type = CLK_TYPE_PERIPHERAL,
	72	};
	73	static struct clk usart1_clk = {
	74	.name = "usart1_clk",
	75	.pmc_mask = 1 << AT91RM9200_ID_US1,
	76	.type = CLK_TYPE_PERIPHERAL,
	77	};
	78	static struct clk usart2_clk = {
	79	.name = "usart2_clk",
	80	.pmc_mask = 1 << AT91RM9200_ID_US2,
	81	.type = CLK_TYPE_PERIPHERAL,
	82	};
	83	static struct clk usart3_clk = {
	84	.name = "usart3_clk",
	85	.pmc_mask = 1 << AT91RM9200_ID_US3,
	86	.type = CLK_TYPE_PERIPHERAL,
	87	};
	88	static struct clk spi_clk = {
	89	.name = "spi_clk",
	90	.pmc_mask = 1 << AT91RM9200_ID_SPI,
	91	.type = CLK_TYPE_PERIPHERAL,
	92	};
	93	static struct clk pioA_clk = {
	94	.name = "pioA_clk",
	95	.pmc_mask = 1 << AT91RM9200_ID_PIOA,
	96	.type = CLK_TYPE_PERIPHERAL,
	97	};
	98	static struct clk pioB_clk = {
	99	.name = "pioB_clk",
100	.pmc_mask = 1 << AT91RM9200_ID_PIOB,
101	.type = CLK_TYPE_PERIPHERAL,
102	};
103	static struct clk pioC_clk = {
104	.name = "pioC_clk",
105	.pmc_mask = 1 << AT91RM9200_ID_PIOC,
106	.type = CLK_TYPE_PERIPHERAL,
107	};
108	static struct clk pioD_clk = {
109	.name = "pioD_clk",
110	.pmc_mask = 1 << AT91RM9200_ID_PIOD,
111	.type = CLK_TYPE_PERIPHERAL,
112	};
e8788bab AV	113	static struct clk ssc0_clk = {
	114	.name = "ssc0_clk",
	115	.pmc_mask = 1 << AT91RM9200_ID_SSC0,
	116	.type = CLK_TYPE_PERIPHERAL,
	117	};
	118	static struct clk ssc1_clk = {
	119	.name = "ssc1_clk",
	120	.pmc_mask = 1 << AT91RM9200_ID_SSC1,
	121	.type = CLK_TYPE_PERIPHERAL,
	122	};
	123	static struct clk ssc2_clk = {
	124	.name = "ssc2_clk",
	125	.pmc_mask = 1 << AT91RM9200_ID_SSC2,
	126	.type = CLK_TYPE_PERIPHERAL,
	127	};
c177a1e7 AV	128	static struct clk tc0_clk = {
	129	.name = "tc0_clk",
	130	.pmc_mask = 1 << AT91RM9200_ID_TC0,
	131	.type = CLK_TYPE_PERIPHERAL,
	132	};
	133	static struct clk tc1_clk = {
	134	.name = "tc1_clk",
	135	.pmc_mask = 1 << AT91RM9200_ID_TC1,
	136	.type = CLK_TYPE_PERIPHERAL,
	137	};
	138	static struct clk tc2_clk = {
	139	.name = "tc2_clk",
	140	.pmc_mask = 1 << AT91RM9200_ID_TC2,
	141	.type = CLK_TYPE_PERIPHERAL,
	142	};
	143	static struct clk tc3_clk = {
	144	.name = "tc3_clk",
	145	.pmc_mask = 1 << AT91RM9200_ID_TC3,
	146	.type = CLK_TYPE_PERIPHERAL,
	147	};
	148	static struct clk tc4_clk = {
	149	.name = "tc4_clk",
	150	.pmc_mask = 1 << AT91RM9200_ID_TC4,
	151	.type = CLK_TYPE_PERIPHERAL,
	152	};
	153	static struct clk tc5_clk = {
	154	.name = "tc5_clk",
	155	.pmc_mask = 1 << AT91RM9200_ID_TC5,
	156	.type = CLK_TYPE_PERIPHERAL,
	157	};
2eeaaa21 AV	158
	159	static struct clk *periph_clocks[] __initdata = {
	160	&pioA_clk,
	161	&pioB_clk,
	162	&pioC_clk,
	163	&pioD_clk,
	164	&usart0_clk,
	165	&usart1_clk,
	166	&usart2_clk,
	167	&usart3_clk,
	168	&mmc_clk,
	169	&udc_clk,
	170	&twi_clk,
	171	&spi_clk,
e8788bab AV	172	&ssc0_clk,
	173	&ssc1_clk,
	174	&ssc2_clk,
c177a1e7 AV	175	&tc0_clk,
	176	&tc1_clk,
	177	&tc2_clk,
	178	&tc3_clk,
	179	&tc4_clk,
	180	&tc5_clk,
2eeaaa21 AV	181	&ohci_clk,
	182	&ether_clk,
	183	// irq0 .. irq6
	184	};
	185
bd602995 JCPV	186	static struct clk_lookup periph_clocks_lookups[] = {
	187	CLKDEV_CON_DEV_ID("t0_clk", "atmel_tcb.0", &tc0_clk),
	188	CLKDEV_CON_DEV_ID("t1_clk", "atmel_tcb.0", &tc1_clk),
	189	CLKDEV_CON_DEV_ID("t2_clk", "atmel_tcb.0", &tc2_clk),
	190	CLKDEV_CON_DEV_ID("t0_clk", "atmel_tcb.1", &tc3_clk),
	191	CLKDEV_CON_DEV_ID("t1_clk", "atmel_tcb.1", &tc4_clk),
	192	CLKDEV_CON_DEV_ID("t2_clk", "atmel_tcb.1", &tc5_clk),
c5efefac JE	193	CLKDEV_CON_DEV_ID("pclk", "ssc.0", &ssc0_clk),
	194	CLKDEV_CON_DEV_ID("pclk", "ssc.1", &ssc1_clk),
	195	CLKDEV_CON_DEV_ID("pclk", "ssc.2", &ssc2_clk),
bd602995 JCPV	196	};
	197
	198	static struct clk_lookup usart_clocks_lookups[] = {
	199	CLKDEV_CON_DEV_ID("usart", "atmel_usart.0", &mck),
	200	CLKDEV_CON_DEV_ID("usart", "atmel_usart.1", &usart0_clk),
	201	CLKDEV_CON_DEV_ID("usart", "atmel_usart.2", &usart1_clk),
	202	CLKDEV_CON_DEV_ID("usart", "atmel_usart.3", &usart2_clk),
	203	CLKDEV_CON_DEV_ID("usart", "atmel_usart.4", &usart3_clk),
	204	};
	205
2eeaaa21 AV	206	/*
	207	* The four programmable clocks.
	208	* You must configure pin multiplexing to bring these signals out.
	209	*/
	210	static struct clk pck0 = {
	211	.name = "pck0",
	212	.pmc_mask = AT91_PMC_PCK0,
	213	.type = CLK_TYPE_PROGRAMMABLE,
	214	.id = 0,
	215	};
	216	static struct clk pck1 = {
	217	.name = "pck1",
	218	.pmc_mask = AT91_PMC_PCK1,
	219	.type = CLK_TYPE_PROGRAMMABLE,
	220	.id = 1,
	221	};
	222	static struct clk pck2 = {
	223	.name = "pck2",
	224	.pmc_mask = AT91_PMC_PCK2,
	225	.type = CLK_TYPE_PROGRAMMABLE,
	226	.id = 2,
	227	};
	228	static struct clk pck3 = {
	229	.name = "pck3",
	230	.pmc_mask = AT91_PMC_PCK3,
	231	.type = CLK_TYPE_PROGRAMMABLE,
	232	.id = 3,
	233	};
	234
	235	static void __init at91rm9200_register_clocks(void)
73a59c1c	236	{
2eeaaa21 AV	237	int i;
	238
	239	for (i = 0; i < ARRAY_SIZE(periph_clocks); i++)
	240	clk_register(periph_clocks[i]);
	241
bd602995 JCPV	242	clkdev_add_table(periph_clocks_lookups,
	243	ARRAY_SIZE(periph_clocks_lookups));
	244	clkdev_add_table(usart_clocks_lookups,
	245	ARRAY_SIZE(usart_clocks_lookups));
	246
2eeaaa21 AV	247	clk_register(&pck0);
	248	clk_register(&pck1);
	249	clk_register(&pck2);
	250	clk_register(&pck3);
	251	}
	252
bd602995 JCPV	253	static struct clk_lookup console_clock_lookup;
	254
	255	void __init at91rm9200_set_console_clock(int id)
	256	{
	257	if (id >= ARRAY_SIZE(usart_clocks_lookups))
	258	return;
	259
	260	console_clock_lookup.con_id = "usart";
	261	console_clock_lookup.clk = usart_clocks_lookups[id].clk;
	262	clkdev_add(&console_clock_lookup);
	263	}
	264
f2173834 AV	265	/* --------------------------------------------------------------------
	266	* GPIO
	267	* -------------------------------------------------------------------- */
	268
	269	static struct at91_gpio_bank at91rm9200_gpio[] = {
	270	{
	271	.id = AT91RM9200_ID_PIOA,
	272	.offset = AT91_PIOA,
	273	.clock = &pioA_clk,
	274	}, {
	275	.id = AT91RM9200_ID_PIOB,
	276	.offset = AT91_PIOB,
	277	.clock = &pioB_clk,
	278	}, {
	279	.id = AT91RM9200_ID_PIOC,
	280	.offset = AT91_PIOC,
	281	.clock = &pioC_clk,
	282	}, {
	283	.id = AT91RM9200_ID_PIOD,
	284	.offset = AT91_PIOD,
	285	.clock = &pioD_clk,
	286	}
	287	};
2eeaaa21	288
1f4fd0a0 AV	289	static void at91rm9200_reset(void)
	290	{
	291	/*
	292	* Perform a hardware reset with the use of the Watchdog timer.
	293	*/
	294	at91_sys_write(AT91_ST_WDMR, AT91_ST_RSTEN \| AT91_ST_EXTEN \| 1);
	295	at91_sys_write(AT91_ST_CR, AT91_ST_WDRST);
	296	}
	297
2eeaaa21 AV	298	/* --------------------------------------------------------------------
	299	* AT91RM9200 processor initialization
	300	* -------------------------------------------------------------------- */
21d08b9d	301	static void __init at91rm9200_map_io(void)
2eeaaa21 AV	302	{
2eeaaa21 AV	303	/* Map peripherals */
f0051d82	304	at91_init_sram(0, AT91RM9200_SRAM_BASE, AT91RM9200_SRAM_SIZE);
73a59c1c	305	iotable_init(at91rm9200_io_desc, ARRAY_SIZE(at91rm9200_io_desc));
1b021a3b	306	}
2eeaaa21	307
46539374	308	static void __init at91rm9200_initialize(void)
1b021a3b	309	{
1f4fd0a0 AV	310	at91_arch_reset = at91rm9200_reset;
	311	at91_extern_irq = (1 << AT91RM9200_ID_IRQ0) \| (1 << AT91RM9200_ID_IRQ1)
	312	\| (1 << AT91RM9200_ID_IRQ2) \| (1 << AT91RM9200_ID_IRQ3)
	313	\| (1 << AT91RM9200_ID_IRQ4) \| (1 << AT91RM9200_ID_IRQ5)
	314	\| (1 << AT91RM9200_ID_IRQ6);
	315
f2173834	316	/* Initialize GPIO subsystem */
e57556e3 JCPV	317	at91_gpio_init(at91rm9200_gpio,
e57556e3 JCPV	318	cpu_is_at91rm9200_bga() ? AT91RM9200_BGA : AT91RM9200_PQFP);
73a59c1c SP	319	}
73a59c1c SP	320
f2173834 AV	321
	322	/* --------------------------------------------------------------------
	323	* Interrupt initialization
	324	* -------------------------------------------------------------------- */
	325
ba854e18 AV	326	/*
	327	* The default interrupt priority levels (0 = lowest, 7 = highest).
	328	*/
	329	static unsigned int at91rm9200_default_irq_priority[NR_AIC_IRQS] __initdata = {
	330	7, /* Advanced Interrupt Controller (FIQ) */
	331	7, /* System Peripherals */
7cbed2b5 AV	332	1, /* Parallel IO Controller A */
	333	1, /* Parallel IO Controller B */
	334	1, /* Parallel IO Controller C */
	335	1, /* Parallel IO Controller D */
	336	5, /* USART 0 */
	337	5, /* USART 1 */
	338	5, /* USART 2 */
	339	5, /* USART 3 */
ba854e18	340	0, /* Multimedia Card Interface */
7cbed2b5 AV	341	2, /* USB Device Port */
	342	6, /* Two-Wire Interface */
	343	5, /* Serial Peripheral Interface */
	344	4, /* Serial Synchronous Controller 0 */
	345	4, /* Serial Synchronous Controller 1 */
	346	4, /* Serial Synchronous Controller 2 */
ba854e18 AV	347	0, /* Timer Counter 0 */
	348	0, /* Timer Counter 1 */
	349	0, /* Timer Counter 2 */
	350	0, /* Timer Counter 3 */
	351	0, /* Timer Counter 4 */
	352	0, /* Timer Counter 5 */
7cbed2b5	353	2, /* USB Host port */
ba854e18 AV	354	3, /* Ethernet MAC */
	355	0, /* Advanced Interrupt Controller (IRQ0) */
	356	0, /* Advanced Interrupt Controller (IRQ1) */
	357	0, /* Advanced Interrupt Controller (IRQ2) */
	358	0, /* Advanced Interrupt Controller (IRQ3) */
	359	0, /* Advanced Interrupt Controller (IRQ4) */
	360	0, /* Advanced Interrupt Controller (IRQ5) */
	361	0 /* Advanced Interrupt Controller (IRQ6) */
	362	};
	363
8c3583b6	364	struct at91_init_soc __initdata at91rm9200_soc = {
21d08b9d	365	.map_io = at91rm9200_map_io,
92100c12	366	.default_irq_priority = at91rm9200_default_irq_priority,
51ddec76	367	.register_clocks = at91rm9200_register_clocks,
21d08b9d JCPV	368	.init = at91rm9200_initialize,
21d08b9d JCPV	369	};