m68knommu: clean up ColdFire 528x interrupt setup
[firefly-linux-kernel-4.4.55.git] / arch / m68knommu / platform / 528x / config.c
1 /***************************************************************************/
2
3 /*
4  *      linux/arch/m68knommu/platform/528x/config.c
5  *
6  *      Sub-architcture dependant initialization code for the Freescale
7  *      5280, 5281 and 5282 CPUs.
8  *
9  *      Copyright (C) 1999-2003, Greg Ungerer (gerg@snapgear.com)
10  *      Copyright (C) 2001-2003, SnapGear Inc. (www.snapgear.com)
11  */
12
13 /***************************************************************************/
14
15 #include <linux/kernel.h>
16 #include <linux/param.h>
17 #include <linux/init.h>
18 #include <linux/platform_device.h>
19 #include <linux/io.h>
20 #include <asm/machdep.h>
21 #include <asm/coldfire.h>
22 #include <asm/mcfsim.h>
23 #include <asm/mcfuart.h>
24
25 /***************************************************************************/
26
27 static struct mcf_platform_uart m528x_uart_platform[] = {
28         {
29                 .mapbase        = MCF_MBAR + MCFUART_BASE1,
30                 .irq            = MCFINT_VECBASE + MCFINT_UART0,
31         },
32         {
33                 .mapbase        = MCF_MBAR + MCFUART_BASE2,
34                 .irq            = MCFINT_VECBASE + MCFINT_UART0 + 1,
35         },
36         {
37                 .mapbase        = MCF_MBAR + MCFUART_BASE3,
38                 .irq            = MCFINT_VECBASE + MCFINT_UART0 + 2,
39         },
40         { },
41 };
42
43 static struct platform_device m528x_uart = {
44         .name                   = "mcfuart",
45         .id                     = 0,
46         .dev.platform_data      = m528x_uart_platform,
47 };
48
49 static struct resource m528x_fec_resources[] = {
50         {
51                 .start          = MCF_MBAR + 0x1000,
52                 .end            = MCF_MBAR + 0x1000 + 0x7ff,
53                 .flags          = IORESOURCE_MEM,
54         },
55         {
56                 .start          = 64 + 23,
57                 .end            = 64 + 23,
58                 .flags          = IORESOURCE_IRQ,
59         },
60         {
61                 .start          = 64 + 27,
62                 .end            = 64 + 27,
63                 .flags          = IORESOURCE_IRQ,
64         },
65         {
66                 .start          = 64 + 29,
67                 .end            = 64 + 29,
68                 .flags          = IORESOURCE_IRQ,
69         },
70 };
71
72 static struct platform_device m528x_fec = {
73         .name                   = "fec",
74         .id                     = 0,
75         .num_resources          = ARRAY_SIZE(m528x_fec_resources),
76         .resource               = m528x_fec_resources,
77 };
78
79
80 static struct platform_device *m528x_devices[] __initdata = {
81         &m528x_uart,
82         &m528x_fec,
83 };
84
85 /***************************************************************************/
86
87 static void __init m528x_uart_init_line(int line, int irq)
88 {
89         u8 port;
90
91         if ((line < 0) || (line > 2))
92                 return;
93
94         /* make sure PUAPAR is set for UART0 and UART1 */
95         if (line < 2) {
96                 port = readb(MCF_MBAR + MCF5282_GPIO_PUAPAR);
97                 port |= (0x03 << (line * 2));
98                 writeb(port, MCF_MBAR + MCF5282_GPIO_PUAPAR);
99         }
100 }
101
102 static void __init m528x_uarts_init(void)
103 {
104         const int nrlines = ARRAY_SIZE(m528x_uart_platform);
105         int line;
106
107         for (line = 0; (line < nrlines); line++)
108                 m528x_uart_init_line(line, m528x_uart_platform[line].irq);
109 }
110
111 /***************************************************************************/
112
113 static void __init m528x_fec_init(void)
114 {
115         u16 v16;
116
117         /* Set multi-function pins to ethernet mode for fec0 */
118         v16 = readw(MCF_IPSBAR + 0x100056);
119         writew(v16 | 0xf00, MCF_IPSBAR + 0x100056);
120         writeb(0xc0, MCF_IPSBAR + 0x100058);
121 }
122
123 /***************************************************************************/
124
125 static void m528x_cpu_reset(void)
126 {
127         local_irq_disable();
128         __raw_writeb(MCF_RCR_SWRESET, MCF_IPSBAR + MCF_RCR);
129 }
130
131 /***************************************************************************/
132
133 #ifdef CONFIG_WILDFIRE
134 void wildfire_halt(void)
135 {
136         writeb(0, 0x30000007);
137         writeb(0x2, 0x30000007);
138 }
139 #endif
140
141 #ifdef CONFIG_WILDFIREMOD
142 void wildfiremod_halt(void)
143 {
144         printk(KERN_INFO "WildFireMod hibernating...\n");
145
146         /* Set portE.5 to Digital IO */
147         MCF5282_GPIO_PEPAR &= ~(1 << (5 * 2));
148
149         /* Make portE.5 an output */
150         MCF5282_GPIO_DDRE |= (1 << 5);
151
152         /* Now toggle portE.5 from low to high */
153         MCF5282_GPIO_PORTE &= ~(1 << 5);
154         MCF5282_GPIO_PORTE |= (1 << 5);
155
156         printk(KERN_EMERG "Failed to hibernate. Halting!\n");
157 }
158 #endif
159
160 void __init config_BSP(char *commandp, int size)
161 {
162 #ifdef CONFIG_WILDFIRE
163         mach_halt = wildfire_halt;
164 #endif
165 #ifdef CONFIG_WILDFIREMOD
166         mach_halt = wildfiremod_halt;
167 #endif
168 }
169
170 /***************************************************************************/
171
172 static int __init init_BSP(void)
173 {
174         mach_reset = m528x_cpu_reset;
175         m528x_uarts_init();
176         m528x_fec_init();
177         platform_add_devices(m528x_devices, ARRAY_SIZE(m528x_devices));
178         return 0;
179 }
180
181 arch_initcall(init_BSP);
182
183 /***************************************************************************/