ar71xx: add a helper function to set RXDV/RXD of ETH_CFG on AR934x
[openwrt/staging/chunkeey.git] / target / linux / ar71xx / files / arch / mips / ath79 / dev-eth.c
1 /*
2 * Atheros AR71xx SoC platform devices
3 *
4 * Copyright (C) 2010-2011 Jaiganesh Narayanan <jnarayanan@atheros.com>
5 * Copyright (C) 2008-2012 Gabor Juhos <juhosg@openwrt.org>
6 * Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>
7 *
8 * Parts of this file are based on Atheros 2.6.15 BSP
9 * Parts of this file are based on Atheros 2.6.31 BSP
10 *
11 * This program is free software; you can redistribute it and/or modify it
12 * under the terms of the GNU General Public License version 2 as published
13 * by the Free Software Foundation.
14 */
15
16 #include <linux/kernel.h>
17 #include <linux/init.h>
18 #include <linux/delay.h>
19 #include <linux/etherdevice.h>
20 #include <linux/platform_device.h>
21 #include <linux/serial_8250.h>
22 #include <linux/clk.h>
23 #include <linux/sizes.h>
24
25 #include <asm/mach-ath79/ath79.h>
26 #include <asm/mach-ath79/ar71xx_regs.h>
27 #include <asm/mach-ath79/irq.h>
28
29 #include "common.h"
30 #include "dev-eth.h"
31
32 unsigned char ath79_mac_base[ETH_ALEN] __initdata;
33
34 static struct resource ath79_mdio0_resources[] = {
35 {
36 .name = "mdio_base",
37 .flags = IORESOURCE_MEM,
38 .start = AR71XX_GE0_BASE,
39 .end = AR71XX_GE0_BASE + 0x200 - 1,
40 }
41 };
42
43 struct ag71xx_mdio_platform_data ath79_mdio0_data;
44
45 struct platform_device ath79_mdio0_device = {
46 .name = "ag71xx-mdio",
47 .id = 0,
48 .resource = ath79_mdio0_resources,
49 .num_resources = ARRAY_SIZE(ath79_mdio0_resources),
50 .dev = {
51 .platform_data = &ath79_mdio0_data,
52 },
53 };
54
55 static struct resource ath79_mdio1_resources[] = {
56 {
57 .name = "mdio_base",
58 .flags = IORESOURCE_MEM,
59 .start = AR71XX_GE1_BASE,
60 .end = AR71XX_GE1_BASE + 0x200 - 1,
61 }
62 };
63
64 struct ag71xx_mdio_platform_data ath79_mdio1_data;
65
66 struct platform_device ath79_mdio1_device = {
67 .name = "ag71xx-mdio",
68 .id = 1,
69 .resource = ath79_mdio1_resources,
70 .num_resources = ARRAY_SIZE(ath79_mdio1_resources),
71 .dev = {
72 .platform_data = &ath79_mdio1_data,
73 },
74 };
75
76 static void ath79_set_pll(u32 cfg_reg, u32 pll_reg, u32 pll_val, u32 shift)
77 {
78 void __iomem *base;
79 u32 t;
80
81 base = ioremap_nocache(AR71XX_PLL_BASE, AR71XX_PLL_SIZE);
82
83 t = __raw_readl(base + cfg_reg);
84 t &= ~(3 << shift);
85 t |= (2 << shift);
86 __raw_writel(t, base + cfg_reg);
87 udelay(100);
88
89 __raw_writel(pll_val, base + pll_reg);
90
91 t |= (3 << shift);
92 __raw_writel(t, base + cfg_reg);
93 udelay(100);
94
95 t &= ~(3 << shift);
96 __raw_writel(t, base + cfg_reg);
97 udelay(100);
98
99 printk(KERN_DEBUG "ar71xx: pll_reg %#x: %#x\n",
100 (unsigned int)(base + pll_reg), __raw_readl(base + pll_reg));
101
102 iounmap(base);
103 }
104
105 static void __init ath79_mii_ctrl_set_if(unsigned int reg,
106 unsigned int mii_if)
107 {
108 void __iomem *base;
109 u32 t;
110
111 base = ioremap(AR71XX_MII_BASE, AR71XX_MII_SIZE);
112
113 t = __raw_readl(base + reg);
114 t &= ~(AR71XX_MII_CTRL_IF_MASK);
115 t |= (mii_if & AR71XX_MII_CTRL_IF_MASK);
116 __raw_writel(t, base + reg);
117
118 iounmap(base);
119 }
120
121 static void ath79_mii_ctrl_set_speed(unsigned int reg, unsigned int speed)
122 {
123 void __iomem *base;
124 unsigned int mii_speed;
125 u32 t;
126
127 switch (speed) {
128 case SPEED_10:
129 mii_speed = AR71XX_MII_CTRL_SPEED_10;
130 break;
131 case SPEED_100:
132 mii_speed = AR71XX_MII_CTRL_SPEED_100;
133 break;
134 case SPEED_1000:
135 mii_speed = AR71XX_MII_CTRL_SPEED_1000;
136 break;
137 default:
138 BUG();
139 }
140
141 base = ioremap(AR71XX_MII_BASE, AR71XX_MII_SIZE);
142
143 t = __raw_readl(base + reg);
144 t &= ~(AR71XX_MII_CTRL_SPEED_MASK << AR71XX_MII_CTRL_SPEED_SHIFT);
145 t |= mii_speed << AR71XX_MII_CTRL_SPEED_SHIFT;
146 __raw_writel(t, base + reg);
147
148 iounmap(base);
149 }
150
151 static unsigned long ar934x_get_mdio_ref_clock(void)
152 {
153 void __iomem *base;
154 unsigned long ret;
155 u32 t;
156
157 base = ioremap(AR71XX_PLL_BASE, AR71XX_PLL_SIZE);
158
159 ret = 0;
160 t = __raw_readl(base + AR934X_PLL_SWITCH_CLOCK_CONTROL_REG);
161 if (t & AR934X_PLL_SWITCH_CLOCK_CONTROL_MDIO_CLK_SEL) {
162 ret = 100 * 1000 * 1000;
163 } else {
164 struct clk *clk;
165
166 clk = clk_get(NULL, "ref");
167 if (!IS_ERR(clk))
168 ret = clk_get_rate(clk);
169 }
170
171 iounmap(base);
172
173 return ret;
174 }
175
176 void __init ath79_register_mdio(unsigned int id, u32 phy_mask)
177 {
178 struct platform_device *mdio_dev;
179 struct ag71xx_mdio_platform_data *mdio_data;
180 unsigned int max_id;
181
182 if (ath79_soc == ATH79_SOC_AR9341 ||
183 ath79_soc == ATH79_SOC_AR9342 ||
184 ath79_soc == ATH79_SOC_AR9344 ||
185 ath79_soc == ATH79_SOC_QCA9556 ||
186 ath79_soc == ATH79_SOC_QCA9558)
187 max_id = 1;
188 else
189 max_id = 0;
190
191 if (id > max_id) {
192 printk(KERN_ERR "ar71xx: invalid MDIO id %u\n", id);
193 return;
194 }
195
196 switch (ath79_soc) {
197 case ATH79_SOC_AR7241:
198 case ATH79_SOC_AR9330:
199 case ATH79_SOC_AR9331:
200 case ATH79_SOC_QCA9533:
201 mdio_dev = &ath79_mdio1_device;
202 mdio_data = &ath79_mdio1_data;
203 break;
204
205 case ATH79_SOC_AR9341:
206 case ATH79_SOC_AR9342:
207 case ATH79_SOC_AR9344:
208 case ATH79_SOC_QCA9556:
209 case ATH79_SOC_QCA9558:
210 if (id == 0) {
211 mdio_dev = &ath79_mdio0_device;
212 mdio_data = &ath79_mdio0_data;
213 } else {
214 mdio_dev = &ath79_mdio1_device;
215 mdio_data = &ath79_mdio1_data;
216 }
217 break;
218
219 case ATH79_SOC_AR7242:
220 ath79_set_pll(AR71XX_PLL_REG_SEC_CONFIG,
221 AR7242_PLL_REG_ETH0_INT_CLOCK, 0x62000000,
222 AR71XX_ETH0_PLL_SHIFT);
223 /* fall through */
224 default:
225 mdio_dev = &ath79_mdio0_device;
226 mdio_data = &ath79_mdio0_data;
227 break;
228 }
229
230 mdio_data->phy_mask = phy_mask;
231
232 switch (ath79_soc) {
233 case ATH79_SOC_AR7240:
234 mdio_data->is_ar7240 = 1;
235 /* fall through */
236 case ATH79_SOC_AR7241:
237 mdio_data->builtin_switch = 1;
238 break;
239
240 case ATH79_SOC_AR9330:
241 mdio_data->is_ar9330 = 1;
242 /* fall through */
243 case ATH79_SOC_AR9331:
244 mdio_data->builtin_switch = 1;
245 break;
246
247 case ATH79_SOC_AR9341:
248 case ATH79_SOC_AR9342:
249 case ATH79_SOC_AR9344:
250 if (id == 1) {
251 mdio_data->builtin_switch = 1;
252 mdio_data->ref_clock = ar934x_get_mdio_ref_clock();
253 mdio_data->mdio_clock = 6250000;
254 }
255 mdio_data->is_ar934x = 1;
256 break;
257
258 case ATH79_SOC_QCA9533:
259 mdio_data->builtin_switch = 1;
260 break;
261
262 case ATH79_SOC_QCA9556:
263 case ATH79_SOC_QCA9558:
264 mdio_data->is_ar934x = 1;
265 break;
266
267 default:
268 break;
269 }
270
271 platform_device_register(mdio_dev);
272 }
273
274 struct ath79_eth_pll_data ath79_eth0_pll_data;
275 struct ath79_eth_pll_data ath79_eth1_pll_data;
276
277 static u32 ath79_get_eth_pll(unsigned int mac, int speed)
278 {
279 struct ath79_eth_pll_data *pll_data;
280 u32 pll_val;
281
282 switch (mac) {
283 case 0:
284 pll_data = &ath79_eth0_pll_data;
285 break;
286 case 1:
287 pll_data = &ath79_eth1_pll_data;
288 break;
289 default:
290 BUG();
291 }
292
293 switch (speed) {
294 case SPEED_10:
295 pll_val = pll_data->pll_10;
296 break;
297 case SPEED_100:
298 pll_val = pll_data->pll_100;
299 break;
300 case SPEED_1000:
301 pll_val = pll_data->pll_1000;
302 break;
303 default:
304 BUG();
305 }
306
307 return pll_val;
308 }
309
310 static void ath79_set_speed_ge0(int speed)
311 {
312 u32 val = ath79_get_eth_pll(0, speed);
313
314 ath79_set_pll(AR71XX_PLL_REG_SEC_CONFIG, AR71XX_PLL_REG_ETH0_INT_CLOCK,
315 val, AR71XX_ETH0_PLL_SHIFT);
316 ath79_mii_ctrl_set_speed(AR71XX_MII_REG_MII0_CTRL, speed);
317 }
318
319 static void ath79_set_speed_ge1(int speed)
320 {
321 u32 val = ath79_get_eth_pll(1, speed);
322
323 ath79_set_pll(AR71XX_PLL_REG_SEC_CONFIG, AR71XX_PLL_REG_ETH1_INT_CLOCK,
324 val, AR71XX_ETH1_PLL_SHIFT);
325 ath79_mii_ctrl_set_speed(AR71XX_MII_REG_MII1_CTRL, speed);
326 }
327
328 static void ar7242_set_speed_ge0(int speed)
329 {
330 u32 val = ath79_get_eth_pll(0, speed);
331 void __iomem *base;
332
333 base = ioremap_nocache(AR71XX_PLL_BASE, AR71XX_PLL_SIZE);
334 __raw_writel(val, base + AR7242_PLL_REG_ETH0_INT_CLOCK);
335 iounmap(base);
336 }
337
338 static void ar91xx_set_speed_ge0(int speed)
339 {
340 u32 val = ath79_get_eth_pll(0, speed);
341
342 ath79_set_pll(AR913X_PLL_REG_ETH_CONFIG, AR913X_PLL_REG_ETH0_INT_CLOCK,
343 val, AR913X_ETH0_PLL_SHIFT);
344 ath79_mii_ctrl_set_speed(AR71XX_MII_REG_MII0_CTRL, speed);
345 }
346
347 static void ar91xx_set_speed_ge1(int speed)
348 {
349 u32 val = ath79_get_eth_pll(1, speed);
350
351 ath79_set_pll(AR913X_PLL_REG_ETH_CONFIG, AR913X_PLL_REG_ETH1_INT_CLOCK,
352 val, AR913X_ETH1_PLL_SHIFT);
353 ath79_mii_ctrl_set_speed(AR71XX_MII_REG_MII1_CTRL, speed);
354 }
355
356 static void ar934x_set_speed_ge0(int speed)
357 {
358 void __iomem *base;
359 u32 val = ath79_get_eth_pll(0, speed);
360
361 base = ioremap_nocache(AR71XX_PLL_BASE, AR71XX_PLL_SIZE);
362 __raw_writel(val, base + AR934X_PLL_ETH_XMII_CONTROL_REG);
363 iounmap(base);
364 }
365
366 static void qca955x_set_speed_xmii(int speed)
367 {
368 void __iomem *base;
369 u32 val = ath79_get_eth_pll(0, speed);
370
371 base = ioremap_nocache(AR71XX_PLL_BASE, AR71XX_PLL_SIZE);
372 __raw_writel(val, base + QCA955X_PLL_ETH_XMII_CONTROL_REG);
373 iounmap(base);
374 }
375
376 static void qca955x_set_speed_sgmii(int speed)
377 {
378 void __iomem *base;
379 u32 val = ath79_get_eth_pll(1, speed);
380
381 base = ioremap_nocache(AR71XX_PLL_BASE, AR71XX_PLL_SIZE);
382 __raw_writel(val, base + QCA955X_PLL_ETH_SGMII_CONTROL_REG);
383 iounmap(base);
384 }
385
386 static void ath79_set_speed_dummy(int speed)
387 {
388 }
389
390 static void ath79_ddr_no_flush(void)
391 {
392 }
393
394 static void ath79_ddr_flush_ge0(void)
395 {
396 ath79_ddr_wb_flush(AR71XX_DDR_REG_FLUSH_GE0);
397 }
398
399 static void ath79_ddr_flush_ge1(void)
400 {
401 ath79_ddr_wb_flush(AR71XX_DDR_REG_FLUSH_GE1);
402 }
403
404 static void ar724x_ddr_flush_ge0(void)
405 {
406 ath79_ddr_wb_flush(AR724X_DDR_REG_FLUSH_GE0);
407 }
408
409 static void ar724x_ddr_flush_ge1(void)
410 {
411 ath79_ddr_wb_flush(AR724X_DDR_REG_FLUSH_GE1);
412 }
413
414 static void ar91xx_ddr_flush_ge0(void)
415 {
416 ath79_ddr_wb_flush(AR913X_DDR_REG_FLUSH_GE0);
417 }
418
419 static void ar91xx_ddr_flush_ge1(void)
420 {
421 ath79_ddr_wb_flush(AR913X_DDR_REG_FLUSH_GE1);
422 }
423
424 static void ar933x_ddr_flush_ge0(void)
425 {
426 ath79_ddr_wb_flush(AR933X_DDR_REG_FLUSH_GE0);
427 }
428
429 static void ar933x_ddr_flush_ge1(void)
430 {
431 ath79_ddr_wb_flush(AR933X_DDR_REG_FLUSH_GE1);
432 }
433
434 static struct resource ath79_eth0_resources[] = {
435 {
436 .name = "mac_base",
437 .flags = IORESOURCE_MEM,
438 .start = AR71XX_GE0_BASE,
439 .end = AR71XX_GE0_BASE + 0x200 - 1,
440 }, {
441 .name = "mac_irq",
442 .flags = IORESOURCE_IRQ,
443 .start = ATH79_CPU_IRQ(4),
444 .end = ATH79_CPU_IRQ(4),
445 },
446 };
447
448 struct ag71xx_platform_data ath79_eth0_data = {
449 .reset_bit = AR71XX_RESET_GE0_MAC,
450 };
451
452 struct platform_device ath79_eth0_device = {
453 .name = "ag71xx",
454 .id = 0,
455 .resource = ath79_eth0_resources,
456 .num_resources = ARRAY_SIZE(ath79_eth0_resources),
457 .dev = {
458 .platform_data = &ath79_eth0_data,
459 },
460 };
461
462 static struct resource ath79_eth1_resources[] = {
463 {
464 .name = "mac_base",
465 .flags = IORESOURCE_MEM,
466 .start = AR71XX_GE1_BASE,
467 .end = AR71XX_GE1_BASE + 0x200 - 1,
468 }, {
469 .name = "mac_irq",
470 .flags = IORESOURCE_IRQ,
471 .start = ATH79_CPU_IRQ(5),
472 .end = ATH79_CPU_IRQ(5),
473 },
474 };
475
476 struct ag71xx_platform_data ath79_eth1_data = {
477 .reset_bit = AR71XX_RESET_GE1_MAC,
478 };
479
480 struct platform_device ath79_eth1_device = {
481 .name = "ag71xx",
482 .id = 1,
483 .resource = ath79_eth1_resources,
484 .num_resources = ARRAY_SIZE(ath79_eth1_resources),
485 .dev = {
486 .platform_data = &ath79_eth1_data,
487 },
488 };
489
490 struct ag71xx_switch_platform_data ath79_switch_data;
491
492 #define AR71XX_PLL_VAL_1000 0x00110000
493 #define AR71XX_PLL_VAL_100 0x00001099
494 #define AR71XX_PLL_VAL_10 0x00991099
495
496 #define AR724X_PLL_VAL_1000 0x00110000
497 #define AR724X_PLL_VAL_100 0x00001099
498 #define AR724X_PLL_VAL_10 0x00991099
499
500 #define AR7242_PLL_VAL_1000 0x16000000
501 #define AR7242_PLL_VAL_100 0x00000101
502 #define AR7242_PLL_VAL_10 0x00001616
503
504 #define AR913X_PLL_VAL_1000 0x1a000000
505 #define AR913X_PLL_VAL_100 0x13000a44
506 #define AR913X_PLL_VAL_10 0x00441099
507
508 #define AR933X_PLL_VAL_1000 0x00110000
509 #define AR933X_PLL_VAL_100 0x00001099
510 #define AR933X_PLL_VAL_10 0x00991099
511
512 #define AR934X_PLL_VAL_1000 0x16000000
513 #define AR934X_PLL_VAL_100 0x00000101
514 #define AR934X_PLL_VAL_10 0x00001616
515
516 static void __init ath79_init_eth_pll_data(unsigned int id)
517 {
518 struct ath79_eth_pll_data *pll_data;
519 u32 pll_10, pll_100, pll_1000;
520
521 switch (id) {
522 case 0:
523 pll_data = &ath79_eth0_pll_data;
524 break;
525 case 1:
526 pll_data = &ath79_eth1_pll_data;
527 break;
528 default:
529 BUG();
530 }
531
532 switch (ath79_soc) {
533 case ATH79_SOC_AR7130:
534 case ATH79_SOC_AR7141:
535 case ATH79_SOC_AR7161:
536 pll_10 = AR71XX_PLL_VAL_10;
537 pll_100 = AR71XX_PLL_VAL_100;
538 pll_1000 = AR71XX_PLL_VAL_1000;
539 break;
540
541 case ATH79_SOC_AR7240:
542 case ATH79_SOC_AR7241:
543 pll_10 = AR724X_PLL_VAL_10;
544 pll_100 = AR724X_PLL_VAL_100;
545 pll_1000 = AR724X_PLL_VAL_1000;
546 break;
547
548 case ATH79_SOC_AR7242:
549 pll_10 = AR7242_PLL_VAL_10;
550 pll_100 = AR7242_PLL_VAL_100;
551 pll_1000 = AR7242_PLL_VAL_1000;
552 break;
553
554 case ATH79_SOC_AR9130:
555 case ATH79_SOC_AR9132:
556 pll_10 = AR913X_PLL_VAL_10;
557 pll_100 = AR913X_PLL_VAL_100;
558 pll_1000 = AR913X_PLL_VAL_1000;
559 break;
560
561 case ATH79_SOC_AR9330:
562 case ATH79_SOC_AR9331:
563 pll_10 = AR933X_PLL_VAL_10;
564 pll_100 = AR933X_PLL_VAL_100;
565 pll_1000 = AR933X_PLL_VAL_1000;
566 break;
567
568 case ATH79_SOC_AR9341:
569 case ATH79_SOC_AR9342:
570 case ATH79_SOC_AR9344:
571 case ATH79_SOC_QCA9533:
572 case ATH79_SOC_QCA9556:
573 case ATH79_SOC_QCA9558:
574 pll_10 = AR934X_PLL_VAL_10;
575 pll_100 = AR934X_PLL_VAL_100;
576 pll_1000 = AR934X_PLL_VAL_1000;
577 break;
578
579 default:
580 BUG();
581 }
582
583 if (!pll_data->pll_10)
584 pll_data->pll_10 = pll_10;
585
586 if (!pll_data->pll_100)
587 pll_data->pll_100 = pll_100;
588
589 if (!pll_data->pll_1000)
590 pll_data->pll_1000 = pll_1000;
591 }
592
593 static int __init ath79_setup_phy_if_mode(unsigned int id,
594 struct ag71xx_platform_data *pdata)
595 {
596 unsigned int mii_if;
597
598 switch (id) {
599 case 0:
600 switch (ath79_soc) {
601 case ATH79_SOC_AR7130:
602 case ATH79_SOC_AR7141:
603 case ATH79_SOC_AR7161:
604 case ATH79_SOC_AR9130:
605 case ATH79_SOC_AR9132:
606 switch (pdata->phy_if_mode) {
607 case PHY_INTERFACE_MODE_MII:
608 mii_if = AR71XX_MII0_CTRL_IF_MII;
609 break;
610 case PHY_INTERFACE_MODE_GMII:
611 mii_if = AR71XX_MII0_CTRL_IF_GMII;
612 break;
613 case PHY_INTERFACE_MODE_RGMII:
614 mii_if = AR71XX_MII0_CTRL_IF_RGMII;
615 break;
616 case PHY_INTERFACE_MODE_RMII:
617 mii_if = AR71XX_MII0_CTRL_IF_RMII;
618 break;
619 default:
620 return -EINVAL;
621 }
622 ath79_mii_ctrl_set_if(AR71XX_MII_REG_MII0_CTRL, mii_if);
623 break;
624
625 case ATH79_SOC_AR7240:
626 case ATH79_SOC_AR7241:
627 case ATH79_SOC_AR9330:
628 case ATH79_SOC_AR9331:
629 case ATH79_SOC_QCA9533:
630 pdata->phy_if_mode = PHY_INTERFACE_MODE_MII;
631 break;
632
633 case ATH79_SOC_AR7242:
634 /* FIXME */
635
636 case ATH79_SOC_AR9341:
637 case ATH79_SOC_AR9342:
638 case ATH79_SOC_AR9344:
639 switch (pdata->phy_if_mode) {
640 case PHY_INTERFACE_MODE_MII:
641 case PHY_INTERFACE_MODE_GMII:
642 case PHY_INTERFACE_MODE_RGMII:
643 case PHY_INTERFACE_MODE_RMII:
644 break;
645 default:
646 return -EINVAL;
647 }
648 break;
649
650 case ATH79_SOC_QCA9556:
651 case ATH79_SOC_QCA9558:
652 switch (pdata->phy_if_mode) {
653 case PHY_INTERFACE_MODE_MII:
654 case PHY_INTERFACE_MODE_RGMII:
655 case PHY_INTERFACE_MODE_SGMII:
656 break;
657 default:
658 return -EINVAL;
659 }
660 break;
661
662 default:
663 BUG();
664 }
665 break;
666 case 1:
667 switch (ath79_soc) {
668 case ATH79_SOC_AR7130:
669 case ATH79_SOC_AR7141:
670 case ATH79_SOC_AR7161:
671 case ATH79_SOC_AR9130:
672 case ATH79_SOC_AR9132:
673 switch (pdata->phy_if_mode) {
674 case PHY_INTERFACE_MODE_RMII:
675 mii_if = AR71XX_MII1_CTRL_IF_RMII;
676 break;
677 case PHY_INTERFACE_MODE_RGMII:
678 mii_if = AR71XX_MII1_CTRL_IF_RGMII;
679 break;
680 default:
681 return -EINVAL;
682 }
683 ath79_mii_ctrl_set_if(AR71XX_MII_REG_MII1_CTRL, mii_if);
684 break;
685
686 case ATH79_SOC_AR7240:
687 case ATH79_SOC_AR7241:
688 case ATH79_SOC_AR9330:
689 case ATH79_SOC_AR9331:
690 case ATH79_SOC_QCA9533:
691 pdata->phy_if_mode = PHY_INTERFACE_MODE_GMII;
692 break;
693
694 case ATH79_SOC_AR7242:
695 /* FIXME */
696
697 case ATH79_SOC_AR9341:
698 case ATH79_SOC_AR9342:
699 case ATH79_SOC_AR9344:
700 switch (pdata->phy_if_mode) {
701 case PHY_INTERFACE_MODE_MII:
702 case PHY_INTERFACE_MODE_GMII:
703 break;
704 default:
705 return -EINVAL;
706 }
707 break;
708
709 case ATH79_SOC_QCA9556:
710 case ATH79_SOC_QCA9558:
711 switch (pdata->phy_if_mode) {
712 case PHY_INTERFACE_MODE_MII:
713 case PHY_INTERFACE_MODE_RGMII:
714 case PHY_INTERFACE_MODE_SGMII:
715 break;
716 default:
717 return -EINVAL;
718 }
719 break;
720
721 default:
722 BUG();
723 }
724 break;
725 }
726
727 return 0;
728 }
729
730 void __init ath79_setup_ar933x_phy4_switch(bool mac, bool mdio)
731 {
732 void __iomem *base;
733 u32 t;
734
735 base = ioremap(AR933X_GMAC_BASE, AR933X_GMAC_SIZE);
736
737 t = __raw_readl(base + AR933X_GMAC_REG_ETH_CFG);
738 t &= ~(AR933X_ETH_CFG_SW_PHY_SWAP | AR933X_ETH_CFG_SW_PHY_ADDR_SWAP);
739 if (mac)
740 t |= AR933X_ETH_CFG_SW_PHY_SWAP;
741 if (mdio)
742 t |= AR933X_ETH_CFG_SW_PHY_ADDR_SWAP;
743 __raw_writel(t, base + AR933X_GMAC_REG_ETH_CFG);
744
745 iounmap(base);
746 }
747
748 void __init ath79_setup_ar934x_eth_cfg(u32 mask)
749 {
750 void __iomem *base;
751 u32 t;
752
753 base = ioremap(AR934X_GMAC_BASE, AR934X_GMAC_SIZE);
754
755 t = __raw_readl(base + AR934X_GMAC_REG_ETH_CFG);
756
757 t &= ~(AR934X_ETH_CFG_RGMII_GMAC0 |
758 AR934X_ETH_CFG_MII_GMAC0 |
759 AR934X_ETH_CFG_GMII_GMAC0 |
760 AR934X_ETH_CFG_SW_ONLY_MODE |
761 AR934X_ETH_CFG_SW_PHY_SWAP);
762
763 t |= mask;
764
765 __raw_writel(t, base + AR934X_GMAC_REG_ETH_CFG);
766 /* flush write */
767 __raw_readl(base + AR934X_GMAC_REG_ETH_CFG);
768
769 iounmap(base);
770 }
771
772 void __init ath79_setup_ar934x_eth_rx_delay(unsigned int rxd,
773 unsigned int rxdv)
774 {
775 void __iomem *base;
776 u32 t;
777
778 rxd &= AR934X_ETH_CFG_RXD_DELAY_MASK;
779 rxdv &= AR934X_ETH_CFG_RDV_DELAY_MASK;
780
781 base = ioremap(AR934X_GMAC_BASE, AR934X_GMAC_SIZE);
782
783 t = __raw_readl(base + AR934X_GMAC_REG_ETH_CFG);
784
785 t &= ~(AR934X_ETH_CFG_RXD_DELAY_MASK << AR934X_ETH_CFG_RXD_DELAY_SHIFT |
786 AR934X_ETH_CFG_RDV_DELAY_MASK << AR934X_ETH_CFG_RDV_DELAY_SHIFT);
787
788 t |= (rxd << AR934X_ETH_CFG_RXD_DELAY_SHIFT |
789 rxdv << AR934X_ETH_CFG_RDV_DELAY_SHIFT);
790
791 __raw_writel(t, base + AR934X_GMAC_REG_ETH_CFG);
792 /* flush write */
793 __raw_readl(base + AR934X_GMAC_REG_ETH_CFG);
794
795 iounmap(base);
796 }
797
798 void __init ath79_setup_qca955x_eth_cfg(u32 mask)
799 {
800 void __iomem *base;
801 u32 t;
802
803 base = ioremap(QCA955X_GMAC_BASE, QCA955X_GMAC_SIZE);
804
805 t = __raw_readl(base + QCA955X_GMAC_REG_ETH_CFG);
806
807 t &= ~(QCA955X_ETH_CFG_RGMII_EN | QCA955X_ETH_CFG_GE0_SGMII);
808
809 t |= mask;
810
811 __raw_writel(t, base + QCA955X_GMAC_REG_ETH_CFG);
812
813 iounmap(base);
814 }
815
816 static int ath79_eth_instance __initdata;
817 void __init ath79_register_eth(unsigned int id)
818 {
819 struct platform_device *pdev;
820 struct ag71xx_platform_data *pdata;
821 int err;
822
823 if (id > 1) {
824 printk(KERN_ERR "ar71xx: invalid ethernet id %d\n", id);
825 return;
826 }
827
828 ath79_init_eth_pll_data(id);
829
830 if (id == 0)
831 pdev = &ath79_eth0_device;
832 else
833 pdev = &ath79_eth1_device;
834
835 pdata = pdev->dev.platform_data;
836
837 pdata->max_frame_len = 1540;
838 pdata->desc_pktlen_mask = 0xfff;
839
840 err = ath79_setup_phy_if_mode(id, pdata);
841 if (err) {
842 printk(KERN_ERR
843 "ar71xx: invalid PHY interface mode for GE%u\n", id);
844 return;
845 }
846
847 switch (ath79_soc) {
848 case ATH79_SOC_AR7130:
849 if (id == 0) {
850 pdata->ddr_flush = ath79_ddr_flush_ge0;
851 pdata->set_speed = ath79_set_speed_ge0;
852 } else {
853 pdata->ddr_flush = ath79_ddr_flush_ge1;
854 pdata->set_speed = ath79_set_speed_ge1;
855 }
856 break;
857
858 case ATH79_SOC_AR7141:
859 case ATH79_SOC_AR7161:
860 if (id == 0) {
861 pdata->ddr_flush = ath79_ddr_flush_ge0;
862 pdata->set_speed = ath79_set_speed_ge0;
863 } else {
864 pdata->ddr_flush = ath79_ddr_flush_ge1;
865 pdata->set_speed = ath79_set_speed_ge1;
866 }
867 pdata->has_gbit = 1;
868 break;
869
870 case ATH79_SOC_AR7242:
871 if (id == 0) {
872 pdata->reset_bit |= AR724X_RESET_GE0_MDIO |
873 AR71XX_RESET_GE0_PHY;
874 pdata->ddr_flush = ar724x_ddr_flush_ge0;
875 pdata->set_speed = ar7242_set_speed_ge0;
876 } else {
877 pdata->reset_bit |= AR724X_RESET_GE1_MDIO |
878 AR71XX_RESET_GE1_PHY;
879 pdata->ddr_flush = ar724x_ddr_flush_ge1;
880 pdata->set_speed = ath79_set_speed_dummy;
881 }
882 pdata->has_gbit = 1;
883 pdata->is_ar724x = 1;
884
885 if (!pdata->fifo_cfg1)
886 pdata->fifo_cfg1 = 0x0010ffff;
887 if (!pdata->fifo_cfg2)
888 pdata->fifo_cfg2 = 0x015500aa;
889 if (!pdata->fifo_cfg3)
890 pdata->fifo_cfg3 = 0x01f00140;
891 break;
892
893 case ATH79_SOC_AR7241:
894 if (id == 0)
895 pdata->reset_bit |= AR724X_RESET_GE0_MDIO;
896 else
897 pdata->reset_bit |= AR724X_RESET_GE1_MDIO;
898 /* fall through */
899 case ATH79_SOC_AR7240:
900 if (id == 0) {
901 pdata->reset_bit |= AR71XX_RESET_GE0_PHY;
902 pdata->ddr_flush = ar724x_ddr_flush_ge0;
903 pdata->set_speed = ath79_set_speed_dummy;
904
905 pdata->phy_mask = BIT(4);
906 } else {
907 pdata->reset_bit |= AR71XX_RESET_GE1_PHY;
908 pdata->ddr_flush = ar724x_ddr_flush_ge1;
909 pdata->set_speed = ath79_set_speed_dummy;
910
911 pdata->speed = SPEED_1000;
912 pdata->duplex = DUPLEX_FULL;
913 pdata->switch_data = &ath79_switch_data;
914
915 ath79_switch_data.phy_poll_mask |= BIT(4);
916 }
917 pdata->has_gbit = 1;
918 pdata->is_ar724x = 1;
919 if (ath79_soc == ATH79_SOC_AR7240)
920 pdata->is_ar7240 = 1;
921
922 if (!pdata->fifo_cfg1)
923 pdata->fifo_cfg1 = 0x0010ffff;
924 if (!pdata->fifo_cfg2)
925 pdata->fifo_cfg2 = 0x015500aa;
926 if (!pdata->fifo_cfg3)
927 pdata->fifo_cfg3 = 0x01f00140;
928 break;
929
930 case ATH79_SOC_AR9130:
931 if (id == 0) {
932 pdata->ddr_flush = ar91xx_ddr_flush_ge0;
933 pdata->set_speed = ar91xx_set_speed_ge0;
934 } else {
935 pdata->ddr_flush = ar91xx_ddr_flush_ge1;
936 pdata->set_speed = ar91xx_set_speed_ge1;
937 }
938 pdata->is_ar91xx = 1;
939 break;
940
941 case ATH79_SOC_AR9132:
942 if (id == 0) {
943 pdata->ddr_flush = ar91xx_ddr_flush_ge0;
944 pdata->set_speed = ar91xx_set_speed_ge0;
945 } else {
946 pdata->ddr_flush = ar91xx_ddr_flush_ge1;
947 pdata->set_speed = ar91xx_set_speed_ge1;
948 }
949 pdata->is_ar91xx = 1;
950 pdata->has_gbit = 1;
951 break;
952
953 case ATH79_SOC_AR9330:
954 case ATH79_SOC_AR9331:
955 if (id == 0) {
956 pdata->reset_bit = AR933X_RESET_GE0_MAC |
957 AR933X_RESET_GE0_MDIO;
958 pdata->ddr_flush = ar933x_ddr_flush_ge0;
959 pdata->set_speed = ath79_set_speed_dummy;
960
961 pdata->phy_mask = BIT(4);
962 } else {
963 pdata->reset_bit = AR933X_RESET_GE1_MAC |
964 AR933X_RESET_GE1_MDIO;
965 pdata->ddr_flush = ar933x_ddr_flush_ge1;
966 pdata->set_speed = ath79_set_speed_dummy;
967
968 pdata->speed = SPEED_1000;
969 pdata->has_gbit = 1;
970 pdata->duplex = DUPLEX_FULL;
971 pdata->switch_data = &ath79_switch_data;
972
973 ath79_switch_data.phy_poll_mask |= BIT(4);
974 }
975
976 pdata->is_ar724x = 1;
977
978 if (!pdata->fifo_cfg1)
979 pdata->fifo_cfg1 = 0x0010ffff;
980 if (!pdata->fifo_cfg2)
981 pdata->fifo_cfg2 = 0x015500aa;
982 if (!pdata->fifo_cfg3)
983 pdata->fifo_cfg3 = 0x01f00140;
984 break;
985
986 case ATH79_SOC_AR9341:
987 case ATH79_SOC_AR9342:
988 case ATH79_SOC_AR9344:
989 if (id == 0) {
990 pdata->reset_bit = AR934X_RESET_GE0_MAC |
991 AR934X_RESET_GE0_MDIO;
992 pdata->set_speed = ar934x_set_speed_ge0;
993 } else {
994 pdata->reset_bit = AR934X_RESET_GE1_MAC |
995 AR934X_RESET_GE1_MDIO;
996 pdata->set_speed = ath79_set_speed_dummy;
997
998 pdata->switch_data = &ath79_switch_data;
999
1000 /* reset the built-in switch */
1001 ath79_device_reset_set(AR934X_RESET_ETH_SWITCH);
1002 ath79_device_reset_clear(AR934X_RESET_ETH_SWITCH);
1003 }
1004
1005 pdata->ddr_flush = ath79_ddr_no_flush;
1006 pdata->has_gbit = 1;
1007 pdata->is_ar724x = 1;
1008
1009 pdata->max_frame_len = SZ_16K - 1;
1010 pdata->desc_pktlen_mask = SZ_16K - 1;
1011
1012 if (!pdata->fifo_cfg1)
1013 pdata->fifo_cfg1 = 0x0010ffff;
1014 if (!pdata->fifo_cfg2)
1015 pdata->fifo_cfg2 = 0x015500aa;
1016 if (!pdata->fifo_cfg3)
1017 pdata->fifo_cfg3 = 0x01f00140;
1018 break;
1019
1020 case ATH79_SOC_QCA9533:
1021 if (id == 0) {
1022 pdata->reset_bit = AR933X_RESET_GE0_MAC |
1023 AR933X_RESET_GE0_MDIO;
1024 pdata->set_speed = ath79_set_speed_dummy;
1025
1026 pdata->phy_mask = BIT(4);
1027 } else {
1028 pdata->reset_bit = AR933X_RESET_GE1_MAC |
1029 AR933X_RESET_GE1_MDIO;
1030 pdata->set_speed = ath79_set_speed_dummy;
1031
1032 pdata->speed = SPEED_1000;
1033 pdata->duplex = DUPLEX_FULL;
1034 pdata->switch_data = &ath79_switch_data;
1035
1036 ath79_switch_data.phy_poll_mask |= BIT(4);
1037 }
1038
1039 pdata->ddr_flush = ath79_ddr_no_flush;
1040 pdata->has_gbit = 1;
1041 pdata->is_ar724x = 1;
1042
1043 if (!pdata->fifo_cfg1)
1044 pdata->fifo_cfg1 = 0x0010ffff;
1045 if (!pdata->fifo_cfg2)
1046 pdata->fifo_cfg2 = 0x015500aa;
1047 if (!pdata->fifo_cfg3)
1048 pdata->fifo_cfg3 = 0x01f00140;
1049 break;
1050
1051 case ATH79_SOC_QCA9556:
1052 case ATH79_SOC_QCA9558:
1053 if (id == 0) {
1054 pdata->reset_bit = QCA955X_RESET_GE0_MAC |
1055 QCA955X_RESET_GE0_MDIO;
1056 pdata->set_speed = qca955x_set_speed_xmii;
1057 } else {
1058 pdata->reset_bit = QCA955X_RESET_GE1_MAC |
1059 QCA955X_RESET_GE1_MDIO;
1060 pdata->set_speed = qca955x_set_speed_sgmii;
1061 }
1062
1063 pdata->ddr_flush = ath79_ddr_no_flush;
1064 pdata->has_gbit = 1;
1065 pdata->is_ar724x = 1;
1066
1067 /*
1068 * Limit the maximum frame length to 4095 bytes.
1069 * Although the documentation says that the hardware
1070 * limit is 16383 bytes but that does not work in
1071 * practice. It seems that the hardware only updates
1072 * the lowest 12 bits of the packet length field
1073 * in the RX descriptor.
1074 */
1075 pdata->max_frame_len = SZ_4K - 1;
1076 pdata->desc_pktlen_mask = SZ_16K - 1;
1077
1078 if (!pdata->fifo_cfg1)
1079 pdata->fifo_cfg1 = 0x0010ffff;
1080 if (!pdata->fifo_cfg2)
1081 pdata->fifo_cfg2 = 0x015500aa;
1082 if (!pdata->fifo_cfg3)
1083 pdata->fifo_cfg3 = 0x01f00140;
1084 break;
1085
1086 default:
1087 BUG();
1088 }
1089
1090 switch (pdata->phy_if_mode) {
1091 case PHY_INTERFACE_MODE_GMII:
1092 case PHY_INTERFACE_MODE_RGMII:
1093 case PHY_INTERFACE_MODE_SGMII:
1094 if (!pdata->has_gbit) {
1095 printk(KERN_ERR "ar71xx: no gbit available on eth%d\n",
1096 id);
1097 return;
1098 }
1099 /* fallthrough */
1100 default:
1101 break;
1102 }
1103
1104 if (!is_valid_ether_addr(pdata->mac_addr)) {
1105 random_ether_addr(pdata->mac_addr);
1106 printk(KERN_DEBUG
1107 "ar71xx: using random MAC address for eth%d\n",
1108 ath79_eth_instance);
1109 }
1110
1111 if (pdata->mii_bus_dev == NULL) {
1112 switch (ath79_soc) {
1113 case ATH79_SOC_AR9341:
1114 case ATH79_SOC_AR9342:
1115 case ATH79_SOC_AR9344:
1116 if (id == 0)
1117 pdata->mii_bus_dev = &ath79_mdio0_device.dev;
1118 else
1119 pdata->mii_bus_dev = &ath79_mdio1_device.dev;
1120 break;
1121
1122 case ATH79_SOC_AR7241:
1123 case ATH79_SOC_AR9330:
1124 case ATH79_SOC_AR9331:
1125 case ATH79_SOC_QCA9533:
1126 pdata->mii_bus_dev = &ath79_mdio1_device.dev;
1127 break;
1128
1129 case ATH79_SOC_QCA9556:
1130 case ATH79_SOC_QCA9558:
1131 /* don't assign any MDIO device by default */
1132 break;
1133
1134 default:
1135 pdata->mii_bus_dev = &ath79_mdio0_device.dev;
1136 break;
1137 }
1138 }
1139
1140 /* Reset the device */
1141 ath79_device_reset_set(pdata->reset_bit);
1142 msleep(100);
1143
1144 ath79_device_reset_clear(pdata->reset_bit);
1145 msleep(100);
1146
1147 platform_device_register(pdev);
1148 ath79_eth_instance++;
1149 }
1150
1151 void __init ath79_set_mac_base(unsigned char *mac)
1152 {
1153 memcpy(ath79_mac_base, mac, ETH_ALEN);
1154 }
1155
1156 void __init ath79_parse_ascii_mac(char *mac_str, u8 *mac)
1157 {
1158 int t;
1159
1160 t = sscanf(mac_str, "%02hhx:%02hhx:%02hhx:%02hhx:%02hhx:%02hhx",
1161 &mac[0], &mac[1], &mac[2], &mac[3], &mac[4], &mac[5]);
1162
1163 if (t != ETH_ALEN)
1164 t = sscanf(mac_str, "%02hhx.%02hhx.%02hhx.%02hhx.%02hhx.%02hhx",
1165 &mac[0], &mac[1], &mac[2], &mac[3], &mac[4], &mac[5]);
1166
1167 if (t != ETH_ALEN || !is_valid_ether_addr(mac)) {
1168 memset(mac, 0, ETH_ALEN);
1169 printk(KERN_DEBUG "ar71xx: invalid mac address \"%s\"\n",
1170 mac_str);
1171 }
1172 }
1173
1174 static void __init ath79_set_mac_base_ascii(char *str)
1175 {
1176 u8 mac[ETH_ALEN];
1177
1178 ath79_parse_ascii_mac(str, mac);
1179 ath79_set_mac_base(mac);
1180 }
1181
1182 static int __init ath79_ethaddr_setup(char *str)
1183 {
1184 ath79_set_mac_base_ascii(str);
1185 return 1;
1186 }
1187 __setup("ethaddr=", ath79_ethaddr_setup);
1188
1189 static int __init ath79_kmac_setup(char *str)
1190 {
1191 ath79_set_mac_base_ascii(str);
1192 return 1;
1193 }
1194 __setup("kmac=", ath79_kmac_setup);
1195
1196 void __init ath79_init_mac(unsigned char *dst, const unsigned char *src,
1197 int offset)
1198 {
1199 int t;
1200
1201 if (!dst)
1202 return;
1203
1204 if (!src || !is_valid_ether_addr(src)) {
1205 memset(dst, '\0', ETH_ALEN);
1206 return;
1207 }
1208
1209 t = (((u32) src[3]) << 16) + (((u32) src[4]) << 8) + ((u32) src[5]);
1210 t += offset;
1211
1212 dst[0] = src[0];
1213 dst[1] = src[1];
1214 dst[2] = src[2];
1215 dst[3] = (t >> 16) & 0xff;
1216 dst[4] = (t >> 8) & 0xff;
1217 dst[5] = t & 0xff;
1218 }
1219
1220 void __init ath79_init_local_mac(unsigned char *dst, const unsigned char *src)
1221 {
1222 int i;
1223
1224 if (!dst)
1225 return;
1226
1227 if (!src || !is_valid_ether_addr(src)) {
1228 memset(dst, '\0', ETH_ALEN);
1229 return;
1230 }
1231
1232 for (i = 0; i < ETH_ALEN; i++)
1233 dst[i] = src[i];
1234 dst[0] |= 0x02;
1235 }