1
2
3
4
5
6
7#include <common.h>
8#include <command.h>
9#include <malloc.h>
10#include <net.h>
11#include <netdev.h>
12#include <asm/cpm_8xx.h>
13#include <asm/io.h>
14
15#include <phy.h>
16
17DECLARE_GLOBAL_DATA_PTR;
18
19
20#if defined(CONFIG_SYS_DISCOVER_PHY) || defined(CONFIG_FEC1_PHY) || defined(CONFIG_FEC2_PHY)
21#define WANT_MII
22#else
23#undef WANT_MII
24#endif
25
26#if defined(WANT_MII)
27#include <miiphy.h>
28
29#if !(defined(CONFIG_MII) || defined(CONFIG_CMD_MII))
30#error "CONFIG_MII has to be defined!"
31#endif
32
33#endif
34
35#if defined(CONFIG_RMII) && !defined(WANT_MII)
36#error RMII support is unusable without a working PHY.
37#endif
38
39#ifdef CONFIG_SYS_DISCOVER_PHY
40static int mii_discover_phy(struct eth_device *dev);
41#endif
42
43int fec8xx_miiphy_read(struct mii_dev *bus, int addr, int devad, int reg);
44int fec8xx_miiphy_write(struct mii_dev *bus, int addr, int devad, int reg,
45 u16 value);
46
47static struct ether_fcc_info_s
48{
49 int ether_index;
50 int fecp_offset;
51 int phy_addr;
52 int actual_phy_addr;
53 int initialized;
54}
55 ether_fcc_info[] = {
56#if defined(CONFIG_ETHER_ON_FEC1)
57 {
58 0,
59 offsetof(immap_t, im_cpm.cp_fec1),
60 CONFIG_FEC1_PHY,
61 -1,
62 0,
63
64 },
65#endif
66#if defined(CONFIG_ETHER_ON_FEC2)
67 {
68 1,
69 offsetof(immap_t, im_cpm.cp_fec2),
70 CONFIG_FEC2_PHY,
71 -1,
72 0,
73 },
74#endif
75};
76
77
78#define DBUF_LENGTH 1520
79
80#define TX_BUF_CNT 2
81
82#define TOUT_LOOP 100
83
84#define PKT_MAXBUF_SIZE 1518
85#define PKT_MINBUF_SIZE 64
86#define PKT_MAXBLR_SIZE 1520
87
88#ifdef __GNUC__
89static char txbuf[DBUF_LENGTH] __aligned(8);
90#else
91#error txbuf must be aligned.
92#endif
93
94static uint rxIdx;
95static uint txIdx;
96
97
98
99
100
101
102
103struct common_buf_desc {
104 cbd_t rxbd[PKTBUFSRX];
105 cbd_t txbd[TX_BUF_CNT];
106};
107
108static struct common_buf_desc __iomem *rtx;
109
110static int fec_send(struct eth_device *dev, void *packet, int length);
111static int fec_recv(struct eth_device *dev);
112static int fec_init(struct eth_device *dev, bd_t *bd);
113static void fec_halt(struct eth_device *dev);
114#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
115static void __mii_init(void);
116#endif
117
118int fec_initialize(bd_t *bis)
119{
120 struct eth_device *dev;
121 struct ether_fcc_info_s *efis;
122 int i;
123
124 for (i = 0; i < ARRAY_SIZE(ether_fcc_info); i++) {
125 dev = malloc(sizeof(*dev));
126 if (dev == NULL)
127 hang();
128
129 memset(dev, 0, sizeof(*dev));
130
131
132
133 if (i == 0)
134 strcpy(dev->name, "FEC");
135 else
136 sprintf(dev->name, "FEC%d",
137 ether_fcc_info[i].ether_index + 1);
138
139 efis = ðer_fcc_info[i];
140
141
142
143
144 efis->actual_phy_addr = -1;
145
146 dev->priv = efis;
147 dev->init = fec_init;
148 dev->halt = fec_halt;
149 dev->send = fec_send;
150 dev->recv = fec_recv;
151
152 eth_register(dev);
153
154#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
155 int retval;
156 struct mii_dev *mdiodev = mdio_alloc();
157 if (!mdiodev)
158 return -ENOMEM;
159 strncpy(mdiodev->name, dev->name, MDIO_NAME_LEN);
160 mdiodev->read = fec8xx_miiphy_read;
161 mdiodev->write = fec8xx_miiphy_write;
162
163 retval = mdio_register(mdiodev);
164 if (retval < 0)
165 return retval;
166#endif
167 }
168 return 1;
169}
170
171static int fec_send(struct eth_device *dev, void *packet, int length)
172{
173 int j, rc;
174 struct ether_fcc_info_s *efis = dev->priv;
175 fec_t __iomem *fecp =
176 (fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
177
178
179
180
181 j = 0;
182 while ((in_be16(&rtx->txbd[txIdx].cbd_sc) & BD_ENET_TX_READY) &&
183 (j < TOUT_LOOP)) {
184 udelay(1);
185 j++;
186 }
187 if (j >= TOUT_LOOP)
188 printf("TX not ready\n");
189
190 out_be32(&rtx->txbd[txIdx].cbd_bufaddr, (uint)packet);
191 out_be16(&rtx->txbd[txIdx].cbd_datlen, length);
192 setbits_be16(&rtx->txbd[txIdx].cbd_sc,
193 BD_ENET_TX_READY | BD_ENET_TX_LAST);
194
195
196
197 out_be32(&fecp->fec_x_des_active, 0x01000000);
198
199 j = 0;
200 while ((in_be16(&rtx->txbd[txIdx].cbd_sc) & BD_ENET_TX_READY) &&
201 (j < TOUT_LOOP)) {
202 udelay(1);
203 j++;
204 }
205 if (j >= TOUT_LOOP)
206 printf("TX timeout\n");
207
208 ;
209 rc = in_be16(&rtx->txbd[txIdx].cbd_sc) & BD_ENET_TX_STATS;
210
211 txIdx = (txIdx + 1) % TX_BUF_CNT;
212
213 return rc;
214}
215
216static int fec_recv(struct eth_device *dev)
217{
218 struct ether_fcc_info_s *efis = dev->priv;
219 fec_t __iomem *fecp =
220 (fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
221 int length;
222
223 for (;;) {
224
225 if (in_be16(&rtx->rxbd[rxIdx].cbd_sc) & BD_ENET_RX_EMPTY) {
226 length = -1;
227 break;
228 }
229
230 length = in_be16(&rtx->rxbd[rxIdx].cbd_datlen);
231
232 if (!(in_be16(&rtx->rxbd[rxIdx].cbd_sc) & 0x003f)) {
233 uchar *rx = net_rx_packets[rxIdx];
234
235 length -= 4;
236
237#if defined(CONFIG_CMD_CDP)
238 if ((rx[0] & 1) != 0 &&
239 memcmp((uchar *)rx, net_bcast_ethaddr, 6) != 0 &&
240 !is_cdp_packet((uchar *)rx))
241 rx = NULL;
242#endif
243
244
245
246 if (rx != NULL)
247 net_process_received_packet(rx, length);
248 }
249
250
251 out_be16(&rtx->rxbd[rxIdx].cbd_datlen, 0);
252
253
254 if ((rxIdx + 1) >= PKTBUFSRX) {
255 out_be16(&rtx->rxbd[PKTBUFSRX - 1].cbd_sc,
256 BD_ENET_RX_WRAP | BD_ENET_RX_EMPTY);
257 rxIdx = 0;
258 } else {
259 out_be16(&rtx->rxbd[rxIdx].cbd_sc, BD_ENET_RX_EMPTY);
260 rxIdx++;
261 }
262
263
264
265 out_be32(&fecp->fec_r_des_active, 0x01000000);
266 }
267
268 return length;
269}
270
271
272
273
274
275
276
277#define FEC_ECNTRL_PINMUX 0x00000004
278#define FEC_ECNTRL_ETHER_EN 0x00000002
279#define FEC_ECNTRL_RESET 0x00000001
280
281#define FEC_RCNTRL_BC_REJ 0x00000010
282#define FEC_RCNTRL_PROM 0x00000008
283#define FEC_RCNTRL_MII_MODE 0x00000004
284#define FEC_RCNTRL_DRT 0x00000002
285#define FEC_RCNTRL_LOOP 0x00000001
286
287#define FEC_TCNTRL_FDEN 0x00000004
288#define FEC_TCNTRL_HBC 0x00000002
289#define FEC_TCNTRL_GTS 0x00000001
290
291#define FEC_RESET_DELAY 50
292
293#if defined(CONFIG_RMII)
294
295static inline void fec_10Mbps(struct eth_device *dev)
296{
297 struct ether_fcc_info_s *efis = dev->priv;
298 int fecidx = efis->ether_index;
299 uint mask = (fecidx == 0) ? 0x0000010 : 0x0000008;
300 immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
301
302 if ((unsigned int)fecidx >= 2)
303 hang();
304
305 setbits_be32(&immr->im_cpm.cp_cptr, mask);
306}
307
308static inline void fec_100Mbps(struct eth_device *dev)
309{
310 struct ether_fcc_info_s *efis = dev->priv;
311 int fecidx = efis->ether_index;
312 uint mask = (fecidx == 0) ? 0x0000010 : 0x0000008;
313 immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
314
315 if ((unsigned int)fecidx >= 2)
316 hang();
317
318 clrbits_be32(&immr->im_cpm.cp_cptr, mask);
319}
320
321#endif
322
323static inline void fec_full_duplex(struct eth_device *dev)
324{
325 struct ether_fcc_info_s *efis = dev->priv;
326 fec_t __iomem *fecp =
327 (fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
328
329 clrbits_be32(&fecp->fec_r_cntrl, FEC_RCNTRL_DRT);
330 setbits_be32(&fecp->fec_x_cntrl, FEC_TCNTRL_FDEN);
331}
332
333static inline void fec_half_duplex(struct eth_device *dev)
334{
335 struct ether_fcc_info_s *efis = dev->priv;
336 fec_t __iomem *fecp =
337 (fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
338
339 setbits_be32(&fecp->fec_r_cntrl, FEC_RCNTRL_DRT);
340 clrbits_be32(&fecp->fec_x_cntrl, FEC_TCNTRL_FDEN);
341}
342
343static void fec_pin_init(int fecidx)
344{
345 bd_t *bd = gd->bd;
346 immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
347
348
349
350
351
352
353
354
355
356
357
358
359
360 out_be32(&immr->im_cpm.cp_fec1.fec_mii_speed,
361 ((bd->bi_intfreq + 4999999) / 5000000) << 1);
362
363#if defined(CONFIG_MPC885) && defined(WANT_MII)
364
365 setbits_be16(&immr->im_ioport.iop_pdpar, 0x0080);
366 clrbits_be16(&immr->im_ioport.iop_pddir, 0x0080);
367#endif
368
369 if (fecidx == 0) {
370#if defined(CONFIG_ETHER_ON_FEC1)
371
372#if defined(CONFIG_MPC885)
373
374#if !defined(CONFIG_RMII)
375
376 setbits_be16(&immr->im_ioport.iop_papar, 0xf830);
377 setbits_be16(&immr->im_ioport.iop_padir, 0x0830);
378 clrbits_be16(&immr->im_ioport.iop_padir, 0xf000);
379
380 setbits_be32(&immr->im_cpm.cp_pbpar, 0x00001001);
381 clrbits_be32(&immr->im_cpm.cp_pbdir, 0x00001001);
382
383 setbits_be16(&immr->im_ioport.iop_pcpar, 0x000c);
384 clrbits_be16(&immr->im_ioport.iop_pcdir, 0x000c);
385
386 setbits_be32(&immr->im_cpm.cp_pepar, 0x00000003);
387 setbits_be32(&immr->im_cpm.cp_pedir, 0x00000003);
388 clrbits_be32(&immr->im_cpm.cp_peso, 0x00000003);
389
390 clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000100);
391
392#else
393
394#if !defined(CONFIG_FEC1_PHY_NORXERR)
395 setbits_be16(&immr->im_ioport.iop_papar, 0x1000);
396 clrbits_be16(&immr->im_ioport.iop_padir, 0x1000);
397#endif
398 setbits_be16(&immr->im_ioport.iop_papar, 0xe810);
399 setbits_be16(&immr->im_ioport.iop_padir, 0x0810);
400 clrbits_be16(&immr->im_ioport.iop_padir, 0xe000);
401
402 setbits_be32(&immr->im_cpm.cp_pbpar, 0x00000001);
403 clrbits_be32(&immr->im_cpm.cp_pbdir, 0x00000001);
404
405 setbits_be32(&immr->im_cpm.cp_cptr, 0x00000100);
406 clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000050);
407
408#endif
409
410#else
411
412
413
414 out_be16(&immr->im_ioport.iop_pdpar, 0x1fff);
415 out_be16(&immr->im_ioport.iop_pddir, 0x1fff);
416
417#if defined(CONFIG_TARGET_MCR3000)
418 out_be16(&immr->im_ioport.iop_papar, 0xBBFF);
419 out_be16(&immr->im_ioport.iop_padir, 0x04F0);
420 out_be16(&immr->im_ioport.iop_paodr, 0x0000);
421
422 out_be32(&immr->im_cpm.cp_pbpar, 0x000133FF);
423 out_be32(&immr->im_cpm.cp_pbdir, 0x0003BF0F);
424 out_be16(&immr->im_cpm.cp_pbodr, 0x0000);
425
426 out_be16(&immr->im_ioport.iop_pcpar, 0x0400);
427 out_be16(&immr->im_ioport.iop_pcdir, 0x0080);
428 out_be16(&immr->im_ioport.iop_pcso , 0x0D53);
429 out_be16(&immr->im_ioport.iop_pcint, 0x0000);
430
431 out_be16(&immr->im_ioport.iop_pdpar, 0x03FE);
432 out_be16(&immr->im_ioport.iop_pddir, 0x1C09);
433
434 setbits_be32(&immr->im_ioport.utmode, 0x80);
435#endif
436#endif
437
438#endif
439 } else if (fecidx == 1) {
440#if defined(CONFIG_ETHER_ON_FEC2)
441
442#if defined(CONFIG_MPC885)
443
444#if !defined(CONFIG_RMII)
445 setbits_be32(&immr->im_cpm.cp_pepar, 0x0003fffc);
446 setbits_be32(&immr->im_cpm.cp_pedir, 0x0003fffc);
447 clrbits_be32(&immr->im_cpm.cp_peso, 0x000087fc);
448 setbits_be32(&immr->im_cpm.cp_peso, 0x00037800);
449
450 clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000080);
451#else
452
453#if !defined(CONFIG_FEC2_PHY_NORXERR)
454 setbits_be32(&immr->im_cpm.cp_pepar, 0x00000010);
455 setbits_be32(&immr->im_cpm.cp_pedir, 0x00000010);
456 clrbits_be32(&immr->im_cpm.cp_peso, 0x00000010);
457#endif
458 setbits_be32(&immr->im_cpm.cp_pepar, 0x00039620);
459 setbits_be32(&immr->im_cpm.cp_pedir, 0x00039620);
460 setbits_be32(&immr->im_cpm.cp_peso, 0x00031000);
461 clrbits_be32(&immr->im_cpm.cp_peso, 0x00008620);
462
463 setbits_be32(&immr->im_cpm.cp_cptr, 0x00000080);
464 clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000028);
465#endif
466
467#endif
468
469#endif
470 }
471}
472
473static int fec_reset(fec_t __iomem *fecp)
474{
475 int i;
476
477
478
479
480
481
482
483
484
485 out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_RESET);
486 for (i = 0; (in_be32(&fecp->fec_ecntrl) & FEC_ECNTRL_RESET) &&
487 (i < FEC_RESET_DELAY); ++i)
488 udelay(1);
489
490 if (i == FEC_RESET_DELAY)
491 return -1;
492
493 return 0;
494}
495
496static int fec_init(struct eth_device *dev, bd_t *bd)
497{
498 struct ether_fcc_info_s *efis = dev->priv;
499 immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
500 fec_t __iomem *fecp =
501 (fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
502 int i;
503
504#if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
505
506
507
508
509 if (efis->ether_index != 0)
510 __mii_init();
511#endif
512
513 if (fec_reset(fecp) < 0)
514 printf("FEC_RESET_DELAY timeout\n");
515
516
517
518 out_be32(&fecp->fec_imask, 0);
519
520
521
522 out_be32(&fecp->fec_ievent, 0xffc0);
523
524
525
526
527
528#define ea dev->enetaddr
529 out_be32(&fecp->fec_addr_low, (ea[0] << 24) | (ea[1] << 16) |
530 (ea[2] << 8) | ea[3]);
531 out_be16(&fecp->fec_addr_high, (ea[4] << 8) | ea[5]);
532#undef ea
533
534#if defined(CONFIG_CMD_CDP)
535
536
537
538 out_be32(&fecp->fec_hash_table_high, 0xffffffff);
539 out_be32(&fecp->fec_hash_table_low, 0xffffffff);
540#else
541
542
543 out_be32(&fecp->fec_hash_table_high, 0);
544 out_be32(&fecp->fec_hash_table_low, 0);
545#endif
546
547
548
549 out_be32(&fecp->fec_r_buff_size, PKT_MAXBLR_SIZE);
550
551
552
553 out_be32(&fecp->fec_r_hash, PKT_MAXBUF_SIZE);
554
555
556
557
558 rxIdx = 0;
559 txIdx = 0;
560
561 if (!rtx)
562 rtx = (struct common_buf_desc __iomem *)
563 (immr->im_cpm.cp_dpmem + CPM_FEC_BASE);
564
565
566
567
568
569 for (i = 0; i < PKTBUFSRX; i++) {
570 out_be16(&rtx->rxbd[i].cbd_sc, BD_ENET_RX_EMPTY);
571 out_be16(&rtx->rxbd[i].cbd_datlen, 0);
572 out_be32(&rtx->rxbd[i].cbd_bufaddr, (uint)net_rx_packets[i]);
573 }
574 setbits_be16(&rtx->rxbd[PKTBUFSRX - 1].cbd_sc, BD_ENET_RX_WRAP);
575
576
577
578
579
580
581 for (i = 0; i < TX_BUF_CNT; i++) {
582 out_be16(&rtx->txbd[i].cbd_sc, BD_ENET_TX_LAST | BD_ENET_TX_TC);
583 out_be16(&rtx->txbd[i].cbd_datlen, 0);
584 out_be32(&rtx->txbd[i].cbd_bufaddr, (uint)txbuf);
585 }
586 setbits_be16(&rtx->txbd[TX_BUF_CNT - 1].cbd_sc, BD_ENET_TX_WRAP);
587
588
589
590 out_be32(&fecp->fec_r_des_start, (__force unsigned int)rtx->rxbd);
591 out_be32(&fecp->fec_x_des_start, (__force unsigned int)rtx->txbd);
592
593
594
595
596 out_be32(&fecp->fec_r_cntrl, FEC_RCNTRL_MII_MODE | FEC_RCNTRL_DRT);
597 out_be32(&fecp->fec_x_cntrl, 0);
598
599
600
601 out_be32(&fecp->fec_fun_code, 0x78000000);
602
603
604
605
606 fec_pin_init(efis->ether_index);
607
608 rxIdx = 0;
609 txIdx = 0;
610
611
612
613
614 out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_ETHER_EN);
615
616 if (efis->phy_addr == -1) {
617#ifdef CONFIG_SYS_DISCOVER_PHY
618
619
620
621 efis->actual_phy_addr = mii_discover_phy(dev);
622
623 if (efis->actual_phy_addr == -1) {
624 printf("Unable to discover phy!\n");
625 return -1;
626 }
627#else
628 efis->actual_phy_addr = -1;
629#endif
630 } else {
631 efis->actual_phy_addr = efis->phy_addr;
632 }
633
634#if defined(CONFIG_MII) && defined(CONFIG_RMII)
635
636
637
638 if (miiphy_speed(dev->name, efis->actual_phy_addr) == _100BASET)
639 fec_100Mbps(dev);
640 else
641 fec_10Mbps(dev);
642#endif
643
644#if defined(CONFIG_MII)
645
646
647
648 if (miiphy_duplex(dev->name, efis->actual_phy_addr) == FULL)
649 fec_full_duplex(dev);
650 else
651 fec_half_duplex(dev);
652#endif
653
654
655
656 out_be32(&fecp->fec_r_des_active, 0x01000000);
657
658 efis->initialized = 1;
659
660 return 0;
661}
662
663
664static void fec_halt(struct eth_device *dev)
665{
666 struct ether_fcc_info_s *efis = dev->priv;
667 fec_t __iomem *fecp =
668 (fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
669 int i;
670
671
672 if (!efis->initialized)
673 return;
674
675
676
677
678
679
680
681
682
683 out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_RESET);
684 for (i = 0; (in_be32(&fecp->fec_ecntrl) & FEC_ECNTRL_RESET) &&
685 (i < FEC_RESET_DELAY); ++i)
686 udelay(1);
687
688 if (i == FEC_RESET_DELAY) {
689 printf("FEC_RESET_DELAY timeout\n");
690 return;
691 }
692
693 efis->initialized = 0;
694}
695
696#if defined(CONFIG_SYS_DISCOVER_PHY) || defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
697
698
699
700
701#define mk_mii_read(ADDR, REG) (0x60020000 | ((ADDR << 23) | \
702 (REG & 0x1f) << 18))
703
704#define mk_mii_write(ADDR, REG, VAL) (0x50020000 | ((ADDR << 23) | \
705 (REG & 0x1f) << 18) | \
706 (VAL & 0xffff))
707
708
709
710#define FEC_ENET_HBERR ((uint)0x80000000)
711#define FEC_ENET_BABR ((uint)0x40000000)
712#define FEC_ENET_BABT ((uint)0x20000000)
713#define FEC_ENET_GRA ((uint)0x10000000)
714#define FEC_ENET_TXF ((uint)0x08000000)
715#define FEC_ENET_TXB ((uint)0x04000000)
716#define FEC_ENET_RXF ((uint)0x02000000)
717#define FEC_ENET_RXB ((uint)0x01000000)
718#define FEC_ENET_MII ((uint)0x00800000)
719#define FEC_ENET_EBERR ((uint)0x00400000)
720
721
722static uint
723mii_send(uint mii_cmd)
724{
725 uint mii_reply;
726 fec_t __iomem *ep;
727 int cnt;
728 immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
729
730 ep = &immr->im_cpm.cp_fec;
731
732 out_be32(&ep->fec_mii_data, mii_cmd);
733
734
735 cnt = 0;
736 while (!(in_be32(&ep->fec_ievent) & FEC_ENET_MII)) {
737 if (++cnt > 1000) {
738 printf("mii_send STUCK!\n");
739 break;
740 }
741 }
742 mii_reply = in_be32(&ep->fec_mii_data);
743 out_be32(&ep->fec_ievent, FEC_ENET_MII);
744 return mii_reply & 0xffff;
745}
746#endif
747
748#if defined(CONFIG_SYS_DISCOVER_PHY)
749static int mii_discover_phy(struct eth_device *dev)
750{
751#define MAX_PHY_PASSES 11
752 uint phyno;
753 int pass;
754 uint phytype;
755 int phyaddr;
756
757 phyaddr = -1;
758 for (pass = 1; pass <= MAX_PHY_PASSES && phyaddr < 0; ++pass) {
759 if (pass > 1) {
760
761
762
763
764
765 udelay(10000);
766 }
767 for (phyno = 0; phyno < 32 && phyaddr < 0; ++phyno) {
768 phytype = mii_send(mk_mii_read(phyno, MII_PHYSID2));
769 if (phytype != 0xffff) {
770 phyaddr = phyno;
771 phytype |= mii_send(mk_mii_read(phyno,
772 MII_PHYSID1)) << 16;
773 }
774 }
775 }
776 if (phyaddr < 0)
777 printf("No PHY device found.\n");
778
779 return phyaddr;
780}
781#endif
782
783#if (defined(CONFIG_MII) || defined(CONFIG_CMD_MII)) && !defined(CONFIG_BITBANGMII)
784
785
786
787
788
789
790static void __mii_init(void)
791{
792 immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
793 fec_t __iomem *fecp = &immr->im_cpm.cp_fec;
794
795 if (fec_reset(fecp) < 0)
796 printf("FEC_RESET_DELAY timeout\n");
797
798
799
800 out_be32(&fecp->fec_imask, 0);
801
802
803
804 out_be32(&fecp->fec_ievent, 0xffc0);
805
806
807
808 out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_ETHER_EN);
809}
810
811void mii_init(void)
812{
813 int i;
814
815 __mii_init();
816
817
818
819 for (i = 0; i < ARRAY_SIZE(ether_fcc_info); i++)
820 fec_pin_init(ether_fcc_info[i].ether_index);
821}
822
823
824
825
826
827
828
829
830
831
832
833
834int fec8xx_miiphy_read(struct mii_dev *bus, int addr, int devad, int reg)
835{
836 unsigned short value = 0;
837 short rdreg;
838
839 rdreg = mii_send(mk_mii_read(addr, reg));
840
841 value = rdreg;
842 return value;
843}
844
845int fec8xx_miiphy_write(struct mii_dev *bus, int addr, int devad, int reg,
846 u16 value)
847{
848 (void)mii_send(mk_mii_write(addr, reg, value));
849
850 return 0;
851}
852#endif
853