Merge git://git.kernel.org/pub/scm/linux/kernel/git/x86/linux-2.6-x86
[linux-2.6] / arch / m68knommu / platform / 5206e / config.c
1 /***************************************************************************/
2
3 /*
4  *      linux/arch/m68knommu/platform/5206e/config.c
5  *
6  *      Copyright (C) 1999-2002, Greg Ungerer (gerg@snapgear.com)
7  */
8
9 /***************************************************************************/
10
11 #include <linux/kernel.h>
12 #include <linux/param.h>
13 #include <linux/init.h>
14 #include <linux/interrupt.h>
15 #include <linux/io.h>
16 #include <asm/machdep.h>
17 #include <asm/coldfire.h>
18 #include <asm/mcfsim.h>
19 #include <asm/mcfdma.h>
20
21 /***************************************************************************/
22
23 void coldfire_reset(void);
24
25 /***************************************************************************/
26
27 static struct mcf_platform_uart m5206e_uart_platform[] = {
28         {
29                 .mapbase        = MCF_MBAR + MCFUART_BASE1,
30                 .irq            = 73,
31         },
32         {
33                 .mapbase        = MCF_MBAR + MCFUART_BASE2,
34                 .irq            = 74,
35         },
36         { },
37 };
38
39 static struct platform_device m5206e_uart = {
40         .name                   = "mcfuart",
41         .id                     = 0,
42         .dev.platform_data      = m5206e_uart_platform,
43 };
44
45 static struct platform_device *m5206e_devices[] __initdata = {
46         &m5206e_uart,
47 };
48
49 /***************************************************************************/
50
51 static void __init m5206_uart_init_line(int line, int irq)
52 {
53         if (line == 0) {
54                 writel(MCFSIM_ICR_LEVEL6 | MCFSIM_ICR_PRI1, MCF_MBAR + MCFSIM_UART1ICR);
55                 writeb(irq, MCFUART_BASE1 + MCFUART_UIVR);
56                 mcf_setimr(mcf_getimr() & ~MCFSIM_IMR_UART1);
57         } else if (line == 1) {
58                 writel(MCFSIM_ICR_LEVEL6 | MCFSIM_ICR_PRI2, MCF_MBAR + MCFSIM_UART2ICR);
59                 writeb(irq, MCFUART_BASE2 + MCFUART_UIVR);
60                 mcf_setimr(mcf_getimr() & ~MCFSIM_IMR_UART2);
61         }
62 }
63
64 static void __init m5206e_uarts_init(void)
65 {
66         const int nrlines = ARRAY_SIZE(m5206e_uart_platform);
67         int line;
68
69         for (line = 0; (line < nrlines); line++)
70                 m5206e_uart_init_line(line, m5206e_uart_platform[line].irq);
71 }
72
73 /***************************************************************************/
74
75 void mcf_autovector(unsigned int vec)
76 {
77         volatile unsigned char  *mbar;
78         unsigned char           icr;
79
80         if ((vec >= 25) && (vec <= 31)) {
81                 vec -= 25;
82                 mbar = (volatile unsigned char *) MCF_MBAR;
83                 icr = MCFSIM_ICR_AUTOVEC | (vec << 3);
84                 *(mbar + MCFSIM_ICR1 + vec) = icr;
85                 vec = 0x1 << (vec + 1);
86                 mcf_setimr(mcf_getimr() & ~vec);
87         }
88 }
89
90 /***************************************************************************/
91
92 void mcf_settimericr(unsigned int timer, unsigned int level)
93 {
94         volatile unsigned char *icrp;
95         unsigned int icr, imr;
96
97         if (timer <= 2) {
98                 switch (timer) {
99                 case 2:  icr = MCFSIM_TIMER2ICR; imr = MCFSIM_IMR_TIMER2; break;
100                 default: icr = MCFSIM_TIMER1ICR; imr = MCFSIM_IMR_TIMER1; break;
101                 }
102
103                 icrp = (volatile unsigned char *) (MCF_MBAR + icr);
104                 *icrp = MCFSIM_ICR_AUTOVEC | (level << 2) | MCFSIM_ICR_PRI3;
105                 mcf_setimr(mcf_getimr() & ~imr);
106         }
107 }
108
109 /***************************************************************************/
110
111 void __init config_BSP(char *commandp, int size)
112 {
113         mcf_setimr(MCFSIM_IMR_MASKALL);
114
115 #if defined(CONFIG_NETtel)
116         /* Copy command line from FLASH to local buffer... */
117         memcpy(commandp, (char *) 0xf0004000, size);
118         commandp[size-1] = 0;
119 #endif /* CONFIG_NETtel */
120
121         mach_reset = coldfire_reset;
122 }
123
124 /***************************************************************************/
125
126 static int __init init_BSP(void)
127 {
128         m5206e_uarts_init();
129         platform_add_devices(m5206e_devices, ARRAY_SIZE(m5206e_devices));
130         return 0;
131 }
132
133 arch_initcall(init_BSP);
134
135 /***************************************************************************/