1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include <linux/init.h>
23#include <linux/string.h>
24#include <linux/kernel.h>
25
26#include <asm/bootinfo.h>
27#include <asm/gt64120.h>
28#include <asm/io.h>
29#include <asm/system.h>
30#include <asm/cacheflush.h>
31#include <asm/traps.h>
32
33#include <asm/mips-boards/prom.h>
34#include <asm/mips-boards/generic.h>
35#include <asm/mips-boards/bonito64.h>
36#include <asm/mips-boards/msc01_pci.h>
37
38#include <asm/mips-boards/malta.h>
39
40int prom_argc;
41int *_prom_argv, *_prom_envp;
42
43
44
45
46
47#define prom_envp(index) ((char *)(long)_prom_envp[(index)])
48
49int init_debug = 0;
50
51int mips_revision_corid;
52int mips_revision_sconid;
53
54
55unsigned long _pcictrl_bonito;
56unsigned long _pcictrl_bonito_pcicfg;
57
58
59unsigned long _pcictrl_gt64120;
60
61
62unsigned long _pcictrl_msc;
63
64char *prom_getenv(char *envname)
65{
66
67
68
69
70
71
72 int i, index=0;
73
74 i = strlen(envname);
75
76 while (prom_envp(index)) {
77 if(strncmp(envname, prom_envp(index), i) == 0) {
78 return(prom_envp(index+1));
79 }
80 index += 2;
81 }
82
83 return NULL;
84}
85
86static inline unsigned char str2hexnum(unsigned char c)
87{
88 if (c >= '0' && c <= '9')
89 return c - '0';
90 if (c >= 'a' && c <= 'f')
91 return c - 'a' + 10;
92 return 0;
93}
94
95static inline void str2eaddr(unsigned char *ea, unsigned char *str)
96{
97 int i;
98
99 for (i = 0; i < 6; i++) {
100 unsigned char num;
101
102 if((*str == '.') || (*str == ':'))
103 str++;
104 num = str2hexnum(*str++) << 4;
105 num |= (str2hexnum(*str++));
106 ea[i] = num;
107 }
108}
109
110int get_ethernet_addr(char *ethernet_addr)
111{
112 char *ethaddr_str;
113
114 ethaddr_str = prom_getenv("ethaddr");
115 if (!ethaddr_str) {
116 printk("ethaddr not set in boot prom\n");
117 return -1;
118 }
119 str2eaddr(ethernet_addr, ethaddr_str);
120
121 if (init_debug > 1) {
122 int i;
123 printk("get_ethernet_addr: ");
124 for (i=0; i<5; i++)
125 printk("%02x:", (unsigned char)*(ethernet_addr+i));
126 printk("%02x\n", *(ethernet_addr+i));
127 }
128
129 return 0;
130}
131
132#ifdef CONFIG_SERIAL_8250_CONSOLE
133static void __init console_config(void)
134{
135 char console_string[40];
136 int baud = 0;
137 char parity = '\0', bits = '\0', flow = '\0';
138 char *s;
139
140 if ((strstr(prom_getcmdline(), "console=")) == NULL) {
141 s = prom_getenv("modetty0");
142 if (s) {
143 while (*s >= '0' && *s <= '9')
144 baud = baud*10 + *s++ - '0';
145 if (*s == ',') s++;
146 if (*s) parity = *s++;
147 if (*s == ',') s++;
148 if (*s) bits = *s++;
149 if (*s == ',') s++;
150 if (*s == 'h') flow = 'r';
151 }
152 if (baud == 0)
153 baud = 38400;
154 if (parity != 'n' && parity != 'o' && parity != 'e')
155 parity = 'n';
156 if (bits != '7' && bits != '8')
157 bits = '8';
158 if (flow == '\0')
159 flow = 'r';
160 sprintf(console_string, " console=ttyS0,%d%c%c%c", baud, parity, bits, flow);
161 strcat(prom_getcmdline(), console_string);
162 pr_info("Config serial console:%s\n", console_string);
163 }
164}
165#endif
166
167static void __init mips_nmi_setup(void)
168{
169 void *base;
170 extern char except_vec_nmi;
171
172 base = cpu_has_veic ?
173 (void *)(CAC_BASE + 0xa80) :
174 (void *)(CAC_BASE + 0x380);
175 memcpy(base, &except_vec_nmi, 0x80);
176 flush_icache_range((unsigned long)base, (unsigned long)base + 0x80);
177}
178
179static void __init mips_ejtag_setup(void)
180{
181 void *base;
182 extern char except_vec_ejtag_debug;
183
184 base = cpu_has_veic ?
185 (void *)(CAC_BASE + 0xa00) :
186 (void *)(CAC_BASE + 0x300);
187 memcpy(base, &except_vec_ejtag_debug, 0x80);
188 flush_icache_range((unsigned long)base, (unsigned long)base + 0x80);
189}
190
191extern struct plat_smp_ops msmtc_smp_ops;
192
193void __init prom_init(void)
194{
195 prom_argc = fw_arg0;
196 _prom_argv = (int *) fw_arg1;
197 _prom_envp = (int *) fw_arg2;
198
199 mips_display_message("LINUX");
200
201
202
203
204
205 _pcictrl_bonito = (unsigned long)ioremap(BONITO_REG_BASE, BONITO_REG_SIZE);
206
207 mips_revision_corid = MIPS_REVISION_CORID;
208
209 if (mips_revision_corid == MIPS_REVISION_CORID_CORE_EMUL) {
210 if (BONITO_PCIDID == 0x0001df53 ||
211 BONITO_PCIDID == 0x0003df53)
212 mips_revision_corid = MIPS_REVISION_CORID_CORE_EMUL_BON;
213 else
214 mips_revision_corid = MIPS_REVISION_CORID_CORE_EMUL_MSC;
215 }
216
217 mips_revision_sconid = MIPS_REVISION_SCONID;
218 if (mips_revision_sconid == MIPS_REVISION_SCON_OTHER) {
219 switch (mips_revision_corid) {
220 case MIPS_REVISION_CORID_QED_RM5261:
221 case MIPS_REVISION_CORID_CORE_LV:
222 case MIPS_REVISION_CORID_CORE_FPGA:
223 case MIPS_REVISION_CORID_CORE_FPGAR2:
224 mips_revision_sconid = MIPS_REVISION_SCON_GT64120;
225 break;
226 case MIPS_REVISION_CORID_CORE_EMUL_BON:
227 case MIPS_REVISION_CORID_BONITO64:
228 case MIPS_REVISION_CORID_CORE_20K:
229 mips_revision_sconid = MIPS_REVISION_SCON_BONITO;
230 break;
231 case MIPS_REVISION_CORID_CORE_MSC:
232 case MIPS_REVISION_CORID_CORE_FPGA2:
233 case MIPS_REVISION_CORID_CORE_24K:
234
235
236
237
238 mips_revision_sconid = MIPS_REVISION_SCON_SOCIT;
239 break;
240 case MIPS_REVISION_CORID_CORE_FPGA3:
241 case MIPS_REVISION_CORID_CORE_FPGA4:
242 case MIPS_REVISION_CORID_CORE_FPGA5:
243 case MIPS_REVISION_CORID_CORE_EMUL_MSC:
244 default:
245
246 mips_revision_sconid = MIPS_REVISION_SCON_ROCIT;
247 break;
248 }
249 }
250
251 switch (mips_revision_sconid) {
252 u32 start, map, mask, data;
253
254 case MIPS_REVISION_SCON_GT64120:
255
256
257
258
259 _pcictrl_gt64120 = (unsigned long)ioremap(MIPS_GT_BASE, 0x2000);
260
261#ifdef CONFIG_CPU_LITTLE_ENDIAN
262 GT_WRITE(GT_PCI0_CMD_OFS, GT_PCI0_CMD_MBYTESWAP_BIT |
263 GT_PCI0_CMD_SBYTESWAP_BIT);
264#else
265 GT_WRITE(GT_PCI0_CMD_OFS, 0);
266#endif
267
268 start = GT_READ(GT_PCI0IOLD_OFS);
269 map = GT_READ(GT_PCI0IOREMAP_OFS);
270 if ((start & map) != 0) {
271 map &= ~start;
272 GT_WRITE(GT_PCI0IOREMAP_OFS, map);
273 }
274
275 set_io_port_base(MALTA_GT_PORT_BASE);
276 break;
277
278 case MIPS_REVISION_SCON_BONITO:
279 _pcictrl_bonito_pcicfg = (unsigned long)ioremap(BONITO_PCICFG_BASE, BONITO_PCICFG_SIZE);
280
281
282
283
284 BONITO_PCIMEMBASECFG = BONITO_PCIMEMBASECFG &
285 ~(BONITO_PCIMEMBASECFG_MEMBASE0_CACHED |
286 BONITO_PCIMEMBASECFG_MEMBASE1_CACHED);
287
288
289
290
291
292#ifdef CONFIG_CPU_LITTLE_ENDIAN
293 BONITO_BONGENCFG = BONITO_BONGENCFG &
294 ~(BONITO_BONGENCFG_MSTRBYTESWAP |
295 BONITO_BONGENCFG_BYTESWAP);
296#else
297 BONITO_BONGENCFG = BONITO_BONGENCFG |
298 BONITO_BONGENCFG_MSTRBYTESWAP |
299 BONITO_BONGENCFG_BYTESWAP;
300#endif
301
302 set_io_port_base(MALTA_BONITO_PORT_BASE);
303 break;
304
305 case MIPS_REVISION_SCON_SOCIT:
306 case MIPS_REVISION_SCON_ROCIT:
307 _pcictrl_msc = (unsigned long)ioremap(MIPS_MSC01_PCI_REG_BASE, 0x2000);
308 mips_pci_controller:
309 mb();
310 MSC_READ(MSC01_PCI_CFG, data);
311 MSC_WRITE(MSC01_PCI_CFG, data & ~MSC01_PCI_CFG_EN_BIT);
312 wmb();
313
314
315#ifdef CONFIG_CPU_LITTLE_ENDIAN
316 MSC_WRITE(MSC01_PCI_SWAP, MSC01_PCI_SWAP_NOSWAP);
317#else
318 MSC_WRITE(MSC01_PCI_SWAP,
319 MSC01_PCI_SWAP_BYTESWAP << MSC01_PCI_SWAP_IO_SHF |
320 MSC01_PCI_SWAP_BYTESWAP << MSC01_PCI_SWAP_MEM_SHF |
321 MSC01_PCI_SWAP_BYTESWAP << MSC01_PCI_SWAP_BAR0_SHF);
322#endif
323
324 MSC_READ(MSC01_PCI_BAR0, mask);
325 MSC_WRITE(MSC01_PCI_P2SCMSKL, mask & MSC01_PCI_BAR0_SIZE_MSK);
326
327
328 if ((data & MSC01_PCI_CFG_MAXRTRY_MSK) ==
329 MSC01_PCI_CFG_MAXRTRY_MSK)
330 data = (data & ~(MSC01_PCI_CFG_MAXRTRY_MSK <<
331 MSC01_PCI_CFG_MAXRTRY_SHF)) |
332 ((MSC01_PCI_CFG_MAXRTRY_MSK - 1) <<
333 MSC01_PCI_CFG_MAXRTRY_SHF);
334
335 wmb();
336 MSC_WRITE(MSC01_PCI_CFG, data);
337 mb();
338
339 set_io_port_base(MALTA_MSC_PORT_BASE);
340 break;
341
342 case MIPS_REVISION_SCON_SOCITSC:
343 case MIPS_REVISION_SCON_SOCITSCP:
344 _pcictrl_msc = (unsigned long)ioremap(MIPS_SOCITSC_PCI_REG_BASE, 0x2000);
345 goto mips_pci_controller;
346
347 default:
348
349 mips_display_message("SC Error");
350 while (1);
351 }
352 board_nmi_handler_setup = mips_nmi_setup;
353 board_ejtag_handler_setup = mips_ejtag_setup;
354
355 pr_info("\nLINUX started...\n");
356 prom_init_cmdline();
357 prom_meminit();
358#ifdef CONFIG_SERIAL_8250_CONSOLE
359 console_config();
360#endif
361#ifdef CONFIG_MIPS_CMP
362 register_smp_ops(&cmp_smp_ops);
363#endif
364#ifdef CONFIG_MIPS_MT_SMP
365 register_smp_ops(&vsmp_smp_ops);
366#endif
367#ifdef CONFIG_MIPS_MT_SMTC
368 register_smp_ops(&msmtc_smp_ops);
369#endif
370}
371