From: Greg Ungerer Switch to platform style configuration for 5249 ColdFire UARTs. Signed-off-by: Greg Ungerer Signed-off-by: Andrew Morton --- arch/m68knommu/platform/5249/config.c | 66 ++++++++++++++++++++++-- 1 file changed, 63 insertions(+), 3 deletions(-) diff -puN arch/m68knommu/platform/5249/config.c~m68knommu-platform-setup-for-5249-coldfire-uarts arch/m68knommu/platform/5249/config.c --- a/arch/m68knommu/platform/5249/config.c~m68knommu-platform-setup-for-5249-coldfire-uarts +++ a/arch/m68knommu/platform/5249/config.c @@ -12,11 +12,12 @@ #include #include #include -#include #include +#include +#include #include #include -#include +#include /***************************************************************************/ @@ -38,6 +39,54 @@ unsigned int dma_device_address[MAX_M68K /***************************************************************************/ +static struct mcf_platform_uart m5249_uart_platform[] = { + { + .mapbase = MCF_MBAR + MCFUART_BASE1, + .irq = 73, + }, + { + .mapbase = MCF_MBAR + MCFUART_BASE2, + .irq = 74, + } +}; + +static struct platform_device m5249_uart = { + .name = "mcfuart", + .id = 0, + .dev.platform_data = m5249_uart_platform, +}; + +static struct platform_device *m5249_devices[] __initdata = { + &m5249_uart, +}; + +/***************************************************************************/ + +static void __init m5249_uart_init_line(int line, int irq) +{ + if (line == 0) { + writel(MCFSIM_ICR_LEVEL6 | MCFSIM_ICR_PRI1, MCF_MBAR + MCFSIM_UART1ICR); + writeb(irq, MCFUART_BASE1 + MCFUART_UIVR); + mcf_setimr(mcf_getimr() & ~MCFSIM_IMR_UART1); + } else if (line == 1) { + writel(MCFSIM_ICR_LEVEL6 | MCFSIM_ICR_PRI2, MCF_MBAR + MCFSIM_UART2ICR); + writeb(irq, MCFUART_BASE2 + MCFUART_UIVR); + mcf_setimr(mcf_getimr() & ~MCFSIM_IMR_UART2); + } +} + +static void __init m5249_uarts_init(void) +{ + const int nrlines = ARRAY_SIZE(m5249_uart_platform); + int line; + + for (line = 0; (line < nrlines); line++) + m5249_uart_init_line(line, m5249_uart_platform[line].irq); +} + + +/***************************************************************************/ + void mcf_autovector(unsigned int vec) { volatile unsigned char *mbar; @@ -85,10 +134,21 @@ int mcf_timerirqpending(int timer) /***************************************************************************/ -void config_BSP(char *commandp, int size) +void __init config_BSP(char *commandp, int size) { mcf_setimr(MCFSIM_IMR_MASKALL); mach_reset = coldfire_reset; } /***************************************************************************/ + +static int __init init_BSP(void) +{ + m5249_uarts_init(); + platform_add_devices(m5249_devices, ARRAY_SIZE(m5249_devices)); + return 0; +} + +arch_initcall(init_BSP); + +/***************************************************************************/ _