fix ar2312/2313 mac detection
[openwrt.git] / target / linux / atheros-2.6 / files / arch / mips / atheros / ar5312.c
1 /*
2 * This file is subject to the terms and conditions of the GNU General Public
3 * License. See the file "COPYING" in the main directory of this archive
4 * for more details.
5 *
6 * Copyright (C) 2003 Atheros Communications, Inc., All Rights Reserved.
7 * Copyright (C) 2006 FON Technology, SL.
8 * Copyright (C) 2006 Imre Kaloz <kaloz@openwrt.org>
9 * Copyright (C) 2006 Felix Fietkau <nbd@openwrt.org>
10 */
11
12 /*
13 * Platform devices for Atheros SoCs
14 */
15
16 #include <linux/autoconf.h>
17 #include <linux/init.h>
18 #include <linux/module.h>
19 #include <linux/types.h>
20 #include <linux/string.h>
21 #include <linux/mtd/physmap.h>
22 #include <linux/platform_device.h>
23 #include <linux/kernel.h>
24 #include <linux/reboot.h>
25 #include <asm/bootinfo.h>
26 #include <asm/reboot.h>
27 #include <asm/time.h>
28 #include <asm/irq.h>
29 #include <asm/io.h>
30 #include "ar531x.h"
31
32 #define NO_PHY 0x1f
33
34 static int is_5312 = 0;
35 static struct platform_device *ar5312_devs[5];
36
37 static struct resource ar5312_eth0_res[] = {
38 {
39 .name = "eth0_membase",
40 .flags = IORESOURCE_MEM,
41 .start = KSEG1ADDR(AR531X_ENET0),
42 .end = KSEG1ADDR(AR531X_ENET0 + 0x2000),
43 },
44 {
45 .name = "eth0_irq",
46 .flags = IORESOURCE_IRQ,
47 .start = AR5312_IRQ_ENET0_INTRS,
48 .end = AR5312_IRQ_ENET0_INTRS,
49 },
50 };
51 static struct ar531x_eth ar5312_eth0_data = {
52 .phy = NO_PHY,
53 .mac = 0,
54 .reset_base = AR531X_RESET,
55 .reset_mac = AR531X_RESET_ENET0,
56 .reset_phy = AR531X_RESET_EPHY0,
57 .phy_base = KSEG1ADDR(AR531X_ENET0),
58 };
59
60 static struct resource ar5312_eth1_res[] = {
61 {
62 .name = "eth1_membase",
63 .flags = IORESOURCE_MEM,
64 .start = KSEG1ADDR(AR531X_ENET1),
65 .end = KSEG1ADDR(AR531X_ENET1 + 0x2000),
66 },
67 {
68 .name = "eth1_irq",
69 .flags = IORESOURCE_IRQ,
70 .start = AR5312_IRQ_ENET1_INTRS,
71 .end = AR5312_IRQ_ENET1_INTRS,
72 },
73 };
74 static struct ar531x_eth ar5312_eth1_data = {
75 .phy = NO_PHY,
76 .mac = 1,
77 .reset_base = AR531X_RESET,
78 .reset_mac = AR531X_RESET_ENET1,
79 .reset_phy = AR531X_RESET_EPHY1,
80 .phy_base = KSEG1ADDR(AR531X_ENET1),
81 };
82
83 static struct platform_device ar5312_eth[] = {
84 {
85 .id = 0,
86 .name = "ar531x-eth",
87 .dev.platform_data = &ar5312_eth0_data,
88 .resource = ar5312_eth0_res,
89 .num_resources = ARRAY_SIZE(ar5312_eth0_res)
90 },
91 {
92 .id = 1,
93 .name = "ar531x-eth",
94 .dev.platform_data = &ar5312_eth1_data,
95 .resource = ar5312_eth1_res,
96 .num_resources = ARRAY_SIZE(ar5312_eth1_res)
97 },
98 };
99
100
101 /*
102 * AR2312/3 ethernet uses the PHY of ENET0, but the MAC
103 * of ENET1. Atheros calls it 'twisted' for a reason :)
104 */
105 static struct resource ar231x_eth0_res[] = {
106 {
107 .name = "eth0_membase",
108 .flags = IORESOURCE_MEM,
109 .start = KSEG1ADDR(AR531X_ENET1),
110 .end = KSEG1ADDR(AR531X_ENET1 + 0x2000),
111 },
112 {
113 .name = "eth0_irq",
114 .flags = IORESOURCE_IRQ,
115 .start = AR5312_IRQ_ENET1_INTRS,
116 .end = AR5312_IRQ_ENET1_INTRS,
117 },
118 };
119 static struct ar531x_eth ar231x_eth0_data = {
120 .phy = 1,
121 .mac = 1,
122 .reset_base = AR531X_RESET,
123 .reset_mac = AR531X_RESET_ENET1,
124 .reset_phy = AR531X_RESET_EPHY1,
125 .phy_base = KSEG1ADDR(AR531X_ENET0),
126 };
127 static struct platform_device ar231x_eth0 = {
128 .id = 0,
129 .name = "ar531x-eth",
130 .dev.platform_data = &ar231x_eth0_data,
131 .resource = ar231x_eth0_res,
132 .num_resources = ARRAY_SIZE(ar231x_eth0_res)
133 };
134
135
136 static struct platform_device ar5312_wmac[] = {
137 {
138 .id = 0,
139 .name = "ar531x-wmac",
140 },
141 {
142 .id = 1,
143 .name = "ar531x-wmac",
144 },
145 };
146
147 static struct physmap_flash_data ar5312_flash_data = {
148 .width = 2,
149 };
150
151 static struct resource ar5312_flash_resource = {
152 .start = AR531X_FLASH,
153 .end = AR531X_FLASH + 0x400000 - 1,
154 .flags = IORESOURCE_MEM,
155 };
156
157 static struct platform_device ar5312_physmap_flash = {
158 .name = "physmap-flash",
159 .id = 0,
160 .dev = {
161 .platform_data = &ar5312_flash_data,
162 },
163 .num_resources = 1,
164 .resource = &ar5312_flash_resource,
165 };
166
167
168 /*
169 * NB: This mapping size is larger than the actual flash size,
170 * but this shouldn't be a problem here, because the flash
171 * will simply be mapped multiple times.
172 */
173 static char __init *ar5312_flash_limit(void)
174 {
175 u32 ctl;
176 /*
177 * Configure flash bank 0.
178 * Assume 8M window size. Flash will be aliased if it's smaller
179 */
180 ctl = FLASHCTL_E |
181 FLASHCTL_AC_8M |
182 FLASHCTL_RBLE |
183 (0x01 << FLASHCTL_IDCY_S) |
184 (0x07 << FLASHCTL_WST1_S) |
185 (0x07 << FLASHCTL_WST2_S) |
186 (sysRegRead(AR531X_FLASHCTL0) & FLASHCTL_MW);
187
188 sysRegWrite(AR531X_FLASHCTL0, ctl);
189
190 /* Disable other flash banks */
191 sysRegWrite(AR531X_FLASHCTL1,
192 sysRegRead(AR531X_FLASHCTL1) & ~(FLASHCTL_E | FLASHCTL_AC));
193
194 sysRegWrite(AR531X_FLASHCTL2,
195 sysRegRead(AR531X_FLASHCTL2) & ~(FLASHCTL_E | FLASHCTL_AC));
196
197 return (char *) KSEG1ADDR(AR531X_FLASH + 0x800000);
198 }
199
200 static struct ar531x_config __init *init_wmac(int unit)
201 {
202 struct ar531x_config *config;
203
204 config = (struct ar531x_config *) kzalloc(sizeof(struct ar531x_config), GFP_KERNEL);
205 config->board = board_config;
206 config->radio = radio_config;
207 config->unit = unit;
208 config->tag = (u_int16_t) ((sysRegRead(AR531X_REV) >> AR531X_REV_WMAC_MIN_S) & AR531X_REV_CHIP);
209
210 return config;
211 }
212
213 int __init ar5312_init_devices(void)
214 {
215 struct ar531x_boarddata *bcfg;
216 char *radio, *c;
217 int dev = 0;
218
219 if (!is_5312)
220 return 0;
221
222 /* Locate board/radio config data */
223 ar531x_find_config(ar5312_flash_limit());
224 bcfg = (struct ar531x_boarddata *) board_config;
225
226
227 /*
228 * Chip IDs and hardware detection for some Atheros
229 * models are really broken!
230 *
231 * Atheros uses a disabled WMAC0 and Silicon ID of AR5312
232 * as indication for AR2312, which is otherwise
233 * indistinguishable from the real AR5312.
234 */
235 if (radio_config) {
236 radio = radio_config + AR531X_RADIO_MASK_OFF;
237 if ((*((u32 *) radio) & AR531X_RADIO0_MASK) == 0)
238 bcfg->config |= BD_ISCASPER;
239 } else
240 radio = NULL;
241
242 /* AR2313 has CPU minor rev. 10 */
243 if ((current_cpu_data.processor_id & 0xff) == 0x0a)
244 mips_machtype = MACH_ATHEROS_AR2313;
245
246 /* AR2312 shares the same Silicon ID as AR5312 */
247 else if (bcfg->config & BD_ISCASPER)
248 mips_machtype = MACH_ATHEROS_AR2312;
249
250 /* Everything else is probably AR5312 or compatible */
251 else
252 mips_machtype = MACH_ATHEROS_AR5312;
253
254 ar5312_eth0_data.board_config = board_config;
255 ar5312_eth1_data.board_config = board_config;
256 ar5312_devs[dev++] = &ar5312_physmap_flash;
257
258 if (!memcmp(bcfg->enet0Mac, "\xff\xff\xff\xff\xff\xff", 6))
259 memcpy(bcfg->enet0Mac, bcfg->enet1Mac, 6);
260
261 if (memcmp(bcfg->enet0Mac, bcfg->enet1Mac, 6) == 0) {
262 /* ENET0 and ENET1 have the same mac.
263 * Increment the one from ENET1 */
264 c = bcfg->enet1Mac + 5;
265 while ((c >= (char *) bcfg->enet1Mac) && !(++(*c)))
266 c--;
267 }
268
269 switch(mips_machtype) {
270 case MACH_ATHEROS_AR5312:
271 ar5312_eth0_data.macaddr = bcfg->enet0Mac;
272 ar5312_eth1_data.macaddr = bcfg->enet1Mac;
273 ar5312_devs[dev++] = &ar5312_eth[0];
274 ar5312_devs[dev++] = &ar5312_eth[1];
275 break;
276 case MACH_ATHEROS_AR2312:
277 case MACH_ATHEROS_AR2313:
278 ar231x_eth0_data.macaddr = bcfg->enet0Mac;
279 ar5312_devs[dev++] = &ar231x_eth0;
280 ar5312_flash_data.width = 1;
281 break;
282 }
283
284 if (radio) {
285 if (*((u32 *) radio) & AR531X_RADIO0_MASK) {
286 ar5312_wmac[0].dev.platform_data = init_wmac(0);
287 ar5312_devs[dev++] = &ar5312_wmac[0];
288 }
289 if (*((u32 *) radio) & AR531X_RADIO1_MASK) {
290 ar5312_wmac[1].dev.platform_data = init_wmac(1);
291 ar5312_devs[dev++] = &ar5312_wmac[1];
292 }
293 }
294
295 return platform_add_devices(ar5312_devs, dev);
296 }
297
298
299 /*
300 * Called when an interrupt is received, this function
301 * determines exactly which interrupt it was, and it
302 * invokes the appropriate handler.
303 *
304 * Implicitly, we also define interrupt priority by
305 * choosing which to dispatch first.
306 */
307 asmlinkage void ar5312_irq_dispatch(void)
308 {
309 int pending = read_c0_status() & read_c0_cause();
310
311 if (pending & CAUSEF_IP2)
312 do_IRQ(AR5312_IRQ_WLAN0_INTRS);
313 else if (pending & CAUSEF_IP3)
314 do_IRQ(AR5312_IRQ_ENET0_INTRS);
315 else if (pending & CAUSEF_IP4)
316 do_IRQ(AR5312_IRQ_ENET1_INTRS);
317 else if (pending & CAUSEF_IP5)
318 do_IRQ(AR5312_IRQ_WLAN1_INTRS);
319 else if (pending & CAUSEF_IP6) {
320 unsigned int ar531x_misc_intrs = sysRegRead(AR531X_ISR) & sysRegRead(AR531X_IMR);
321
322 if (ar531x_misc_intrs & AR531X_ISR_TIMER) {
323 do_IRQ(AR531X_MISC_IRQ_TIMER);
324 (void)sysRegRead(AR531X_TIMER);
325 } else if (ar531x_misc_intrs & AR531X_ISR_AHBPROC)
326 do_IRQ(AR531X_MISC_IRQ_AHB_PROC);
327 else if ((ar531x_misc_intrs & AR531X_ISR_UART0))
328 do_IRQ(AR531X_MISC_IRQ_UART0);
329 else if (ar531x_misc_intrs & AR531X_ISR_WD)
330 do_IRQ(AR531X_MISC_IRQ_WATCHDOG);
331 else
332 do_IRQ(AR531X_MISC_IRQ_NONE);
333 } else if (pending & CAUSEF_IP7) {
334 do_IRQ(AR531X_IRQ_CPU_CLOCK);
335 }
336 else
337 do_IRQ(AR531X_IRQ_NONE);
338 }
339
340 static void ar5312_halt(void)
341 {
342 while (1);
343 }
344
345 static void ar5312_power_off(void)
346 {
347 ar5312_halt();
348 }
349
350
351 static void ar5312_restart(char *command)
352 {
353 /* reset the system */
354 for(;;) sysRegWrite(AR531X_RESET, AR531X_RESET_SYSTEM);
355 }
356
357
358 /*
359 * This table is indexed by bits 5..4 of the CLOCKCTL1 register
360 * to determine the predevisor value.
361 */
362 static int __initdata CLOCKCTL1_PREDIVIDE_TABLE[4] = {
363 1,
364 2,
365 4,
366 5
367 };
368
369
370 static unsigned int __init ar5312_cpu_frequency(void)
371 {
372 unsigned int result;
373 unsigned int predivide_mask, predivide_shift;
374 unsigned int multiplier_mask, multiplier_shift;
375 unsigned int clockCtl1, preDivideSelect, preDivisor, multiplier;
376 unsigned int doubler_mask;
377 unsigned int wisoc_revision;
378
379 /* Trust the bootrom's idea of cpu frequency. */
380 if ((result = sysRegRead(AR5312_SCRATCH)))
381 return result;
382
383 wisoc_revision = (sysRegRead(AR531X_REV) & AR531X_REV_MAJ) >> AR531X_REV_MAJ_S;
384 if (wisoc_revision == AR531X_REV_MAJ_AR2313) {
385 predivide_mask = AR2313_CLOCKCTL1_PREDIVIDE_MASK;
386 predivide_shift = AR2313_CLOCKCTL1_PREDIVIDE_SHIFT;
387 multiplier_mask = AR2313_CLOCKCTL1_MULTIPLIER_MASK;
388 multiplier_shift = AR2313_CLOCKCTL1_MULTIPLIER_SHIFT;
389 doubler_mask = AR2313_CLOCKCTL1_DOUBLER_MASK;
390 } else { /* AR5312 and AR2312 */
391 predivide_mask = AR5312_CLOCKCTL1_PREDIVIDE_MASK;
392 predivide_shift = AR5312_CLOCKCTL1_PREDIVIDE_SHIFT;
393 multiplier_mask = AR5312_CLOCKCTL1_MULTIPLIER_MASK;
394 multiplier_shift = AR5312_CLOCKCTL1_MULTIPLIER_SHIFT;
395 doubler_mask = AR5312_CLOCKCTL1_DOUBLER_MASK;
396 }
397
398 /*
399 * Clocking is derived from a fixed 40MHz input clock.
400 *
401 * cpuFreq = InputClock * MULT (where MULT is PLL multiplier)
402 * sysFreq = cpuFreq / 4 (used for APB clock, serial,
403 * flash, Timer, Watchdog Timer)
404 *
405 * cntFreq = cpuFreq / 2 (use for CPU count/compare)
406 *
407 * So, for example, with a PLL multiplier of 5, we have
408 *
409 * cpuFreq = 200MHz
410 * sysFreq = 50MHz
411 * cntFreq = 100MHz
412 *
413 * We compute the CPU frequency, based on PLL settings.
414 */
415
416 clockCtl1 = sysRegRead(AR5312_CLOCKCTL1);
417 preDivideSelect = (clockCtl1 & predivide_mask) >> predivide_shift;
418 preDivisor = CLOCKCTL1_PREDIVIDE_TABLE[preDivideSelect];
419 multiplier = (clockCtl1 & multiplier_mask) >> multiplier_shift;
420
421 if (clockCtl1 & doubler_mask) {
422 multiplier = multiplier << 1;
423 }
424 return (40000000 / preDivisor) * multiplier;
425 }
426
427 static inline int ar5312_sys_frequency(void)
428 {
429 return ar5312_cpu_frequency() / 4;
430 }
431
432 static void __init ar5312_time_init(void)
433 {
434 mips_hpt_frequency = ar5312_cpu_frequency() / 2;
435 }
436
437
438 /* Enable the specified AR531X_MISC_IRQ interrupt */
439 static void
440 ar5312_misc_intr_enable(unsigned int irq)
441 {
442 unsigned int imr;
443
444 imr = sysRegRead(AR531X_IMR);
445 imr |= (1 << (irq - AR531X_MISC_IRQ_BASE - 1));
446 sysRegWrite(AR531X_IMR, imr);
447 sysRegRead(AR531X_IMR); /* flush write buffer */
448 }
449
450 /* Disable the specified AR531X_MISC_IRQ interrupt */
451 static void
452 ar5312_misc_intr_disable(unsigned int irq)
453 {
454 unsigned int imr;
455
456 imr = sysRegRead(AR531X_IMR);
457 imr &= ~(1 << (irq - AR531X_MISC_IRQ_BASE - 1));
458 sysRegWrite(AR531X_IMR, imr);
459 sysRegRead(AR531X_IMR); /* flush write buffer */
460 }
461
462 /* Turn on the specified AR531X_MISC_IRQ interrupt */
463 static unsigned int
464 ar5312_misc_intr_startup(unsigned int irq)
465 {
466 ar5312_misc_intr_enable(irq);
467 return 0;
468 }
469
470 /* Turn off the specified AR531X_MISC_IRQ interrupt */
471 static void
472 ar5312_misc_intr_shutdown(unsigned int irq)
473 {
474 ar5312_misc_intr_disable(irq);
475 }
476
477 static void
478 ar5312_misc_intr_ack(unsigned int irq)
479 {
480 ar5312_misc_intr_disable(irq);
481 }
482
483 static void
484 ar5312_misc_intr_end(unsigned int irq)
485 {
486 if (!(irq_desc[irq].status & (IRQ_DISABLED | IRQ_INPROGRESS)))
487 ar5312_misc_intr_enable(irq);
488 }
489
490 static struct irq_chip ar5312_misc_intr_controller = {
491 .typename = "AR5312 misc",
492 .startup = ar5312_misc_intr_startup,
493 .shutdown = ar5312_misc_intr_shutdown,
494 .enable = ar5312_misc_intr_enable,
495 .disable = ar5312_misc_intr_disable,
496 .ack = ar5312_misc_intr_ack,
497 .end = ar5312_misc_intr_end,
498 };
499
500 static irqreturn_t ar5312_ahb_proc_handler(int cpl, void *dev_id)
501 {
502 u32 proc1 = sysRegRead(AR531X_PROC1);
503 u32 procAddr = sysRegRead(AR531X_PROCADDR); /* clears error state */
504 u32 dma1 = sysRegRead(AR531X_DMA1);
505 u32 dmaAddr = sysRegRead(AR531X_DMAADDR); /* clears error state */
506
507 printk("AHB interrupt: PROCADDR=0x%8.8x PROC1=0x%8.8x DMAADDR=0x%8.8x DMA1=0x%8.8x\n",
508 procAddr, proc1, dmaAddr, dma1);
509
510 machine_restart("AHB error"); /* Catastrophic failure */
511 return IRQ_HANDLED;
512 }
513
514
515 static struct irqaction ar5312_ahb_proc_interrupt = {
516 .handler = ar5312_ahb_proc_handler,
517 .flags = SA_INTERRUPT,
518 .name = "ar5312_ahb_proc_interrupt",
519 };
520
521
522 static struct irqaction cascade = {
523 .handler = no_action,
524 .flags = SA_INTERRUPT,
525 .name = "cascade",
526 };
527
528 void __init ar5312_misc_intr_init(int irq_base)
529 {
530 int i;
531
532 for (i = irq_base; i < irq_base + AR531X_MISC_IRQ_COUNT; i++) {
533 irq_desc[i].status = IRQ_DISABLED;
534 irq_desc[i].action = NULL;
535 irq_desc[i].depth = 1;
536 irq_desc[i].chip = &ar5312_misc_intr_controller;
537 }
538 setup_irq(AR531X_MISC_IRQ_AHB_PROC, &ar5312_ahb_proc_interrupt);
539 setup_irq(AR5312_IRQ_MISC_INTRS, &cascade);
540 }
541
542 void __init ar5312_prom_init(void)
543 {
544 u32 memsize, memcfg, bank0AC, bank1AC;
545
546 is_5312 = 1;
547
548 /* Detect memory size */
549 memcfg = sysRegRead(AR531X_MEM_CFG1);
550 bank0AC = (memcfg & MEM_CFG1_AC0) >> MEM_CFG1_AC0_S;
551 bank1AC = (memcfg & MEM_CFG1_AC1) >> MEM_CFG1_AC1_S;
552 memsize = (bank0AC ? (1 << (bank0AC+1)) : 0)
553 + (bank1AC ? (1 << (bank1AC+1)) : 0);
554 memsize <<= 20;
555 add_memory_region(0, memsize, BOOT_MEM_RAM);
556
557 /* Initialize it to AR5312 for now. Real detection will be done
558 * in ar5312_init_devices() */
559 mips_machtype = MACH_ATHEROS_AR5312;
560 }
561
562 void __init ar5312_plat_setup(void)
563 {
564 /* Clear any lingering AHB errors */
565 sysRegRead(AR531X_PROCADDR);
566 sysRegRead(AR531X_DMAADDR);
567 sysRegWrite(AR531X_WD_CTRL, AR531X_WD_CTRL_IGNORE_EXPIRATION);
568
569 board_time_init = ar5312_time_init;
570
571 _machine_restart = ar5312_restart;
572 _machine_halt = ar5312_halt;
573 pm_power_off = ar5312_power_off;
574
575 serial_setup(KSEG1ADDR(AR531X_UART0), ar5312_sys_frequency());
576 }
577
578 arch_initcall(ar5312_init_devices);
This page took 0.070942 seconds and 5 git commands to generate.