xref: /openbmc/u-boot/drivers/net/mpc8xx_fec.c (revision b529993e)
1 /*
2  * (C) Copyright 2000
3  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
4  *
5  * SPDX-License-Identifier:	GPL-2.0+
6  */
7 
8 #include <common.h>
9 #include <command.h>
10 #include <commproc.h>
11 #include <malloc.h>
12 #include <net.h>
13 #include <netdev.h>
14 #include <asm/io.h>
15 
16 #include <phy.h>
17 
18 DECLARE_GLOBAL_DATA_PTR;
19 
20 /* define WANT_MII when MII support is required */
21 #if defined(CONFIG_SYS_DISCOVER_PHY) || defined(CONFIG_FEC1_PHY) || defined(CONFIG_FEC2_PHY)
22 #define WANT_MII
23 #else
24 #undef WANT_MII
25 #endif
26 
27 #if defined(WANT_MII)
28 #include <miiphy.h>
29 
30 #if !(defined(CONFIG_MII) || defined(CONFIG_CMD_MII))
31 #error "CONFIG_MII has to be defined!"
32 #endif
33 
34 #endif
35 
36 #if defined(CONFIG_RMII) && !defined(WANT_MII)
37 #error RMII support is unusable without a working PHY.
38 #endif
39 
40 #ifdef CONFIG_SYS_DISCOVER_PHY
41 static int mii_discover_phy(struct eth_device *dev);
42 #endif
43 
44 int fec8xx_miiphy_read(struct mii_dev *bus, int addr, int devad, int reg);
45 int fec8xx_miiphy_write(struct mii_dev *bus, int addr, int devad, int reg,
46 			u16 value);
47 
48 static struct ether_fcc_info_s
49 {
50 	int ether_index;
51 	int fecp_offset;
52 	int phy_addr;
53 	int actual_phy_addr;
54 	int initialized;
55 }
56 	ether_fcc_info[] = {
57 #if defined(CONFIG_ETHER_ON_FEC1)
58 	{
59 		0,
60 		offsetof(immap_t, im_cpm.cp_fec1),
61 		CONFIG_FEC1_PHY,
62 		-1,
63 		0,
64 
65 	},
66 #endif
67 #if defined(CONFIG_ETHER_ON_FEC2)
68 	{
69 		1,
70 		offsetof(immap_t, im_cpm.cp_fec2),
71 		CONFIG_FEC2_PHY,
72 		-1,
73 		0,
74 	},
75 #endif
76 };
77 
78 /* Ethernet Transmit and Receive Buffers */
79 #define DBUF_LENGTH  1520
80 
81 #define TX_BUF_CNT 2
82 
83 #define TOUT_LOOP 100
84 
85 #define PKT_MAXBUF_SIZE		1518
86 #define PKT_MINBUF_SIZE		64
87 #define PKT_MAXBLR_SIZE		1520
88 
89 #ifdef __GNUC__
90 static char txbuf[DBUF_LENGTH] __aligned(8);
91 #else
92 #error txbuf must be aligned.
93 #endif
94 
95 static uint rxIdx;	/* index of the current RX buffer */
96 static uint txIdx;	/* index of the current TX buffer */
97 
98 /*
99   * FEC Ethernet Tx and Rx buffer descriptors allocated at the
100   *  immr->udata_bd address on Dual-Port RAM
101   * Provide for Double Buffering
102   */
103 
104 struct common_buf_desc {
105 	cbd_t rxbd[PKTBUFSRX];		/* Rx BD */
106 	cbd_t txbd[TX_BUF_CNT];		/* Tx BD */
107 };
108 
109 static struct common_buf_desc __iomem *rtx;
110 
111 static int fec_send(struct eth_device *dev, void *packet, int length);
112 static int fec_recv(struct eth_device *dev);
113 static int fec_init(struct eth_device *dev, bd_t *bd);
114 static void fec_halt(struct eth_device *dev);
115 #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
116 static void __mii_init(void);
117 #endif
118 
119 int fec_initialize(bd_t *bis)
120 {
121 	struct eth_device *dev;
122 	struct ether_fcc_info_s *efis;
123 	int             i;
124 
125 	for (i = 0; i < ARRAY_SIZE(ether_fcc_info); i++) {
126 		dev = malloc(sizeof(*dev));
127 		if (dev == NULL)
128 			hang();
129 
130 		memset(dev, 0, sizeof(*dev));
131 
132 		/* for FEC1 make sure that the name of the interface is the same
133 		   as the old one for compatibility reasons */
134 		if (i == 0)
135 			strcpy(dev->name, "FEC");
136 		else
137 			sprintf(dev->name, "FEC%d",
138 				ether_fcc_info[i].ether_index + 1);
139 
140 		efis = &ether_fcc_info[i];
141 
142 		/*
143 		 * reset actual phy addr
144 		 */
145 		efis->actual_phy_addr = -1;
146 
147 		dev->priv = efis;
148 		dev->init = fec_init;
149 		dev->halt = fec_halt;
150 		dev->send = fec_send;
151 		dev->recv = fec_recv;
152 
153 		eth_register(dev);
154 
155 #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
156 		int retval;
157 		struct mii_dev *mdiodev = mdio_alloc();
158 		if (!mdiodev)
159 			return -ENOMEM;
160 		strncpy(mdiodev->name, dev->name, MDIO_NAME_LEN);
161 		mdiodev->read = fec8xx_miiphy_read;
162 		mdiodev->write = fec8xx_miiphy_write;
163 
164 		retval = mdio_register(mdiodev);
165 		if (retval < 0)
166 			return retval;
167 #endif
168 	}
169 	return 1;
170 }
171 
172 static int fec_send(struct eth_device *dev, void *packet, int length)
173 {
174 	int j, rc;
175 	struct ether_fcc_info_s *efis = dev->priv;
176 	fec_t __iomem *fecp =
177 			(fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
178 
179 	/* section 16.9.23.3
180 	 * Wait for ready
181 	 */
182 	j = 0;
183 	while ((in_be16(&rtx->txbd[txIdx].cbd_sc) & BD_ENET_TX_READY) &&
184 	       (j < TOUT_LOOP)) {
185 		udelay(1);
186 		j++;
187 	}
188 	if (j >= TOUT_LOOP)
189 		printf("TX not ready\n");
190 
191 	out_be32(&rtx->txbd[txIdx].cbd_bufaddr, (uint)packet);
192 	out_be16(&rtx->txbd[txIdx].cbd_datlen, length);
193 	setbits_be16(&rtx->txbd[txIdx].cbd_sc,
194 		     BD_ENET_TX_READY | BD_ENET_TX_LAST);
195 
196 	/* Activate transmit Buffer Descriptor polling */
197 	/* Descriptor polling active	*/
198 	out_be32(&fecp->fec_x_des_active, 0x01000000);
199 
200 	j = 0;
201 	while ((in_be16(&rtx->txbd[txIdx].cbd_sc) & BD_ENET_TX_READY) &&
202 	       (j < TOUT_LOOP)) {
203 		udelay(1);
204 		j++;
205 	}
206 	if (j >= TOUT_LOOP)
207 		printf("TX timeout\n");
208 
209 	/* return only status bits */;
210 	rc = in_be16(&rtx->txbd[txIdx].cbd_sc) & BD_ENET_TX_STATS;
211 
212 	txIdx = (txIdx + 1) % TX_BUF_CNT;
213 
214 	return rc;
215 }
216 
217 static int fec_recv(struct eth_device *dev)
218 {
219 	struct ether_fcc_info_s *efis = dev->priv;
220 	fec_t __iomem *fecp =
221 			(fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
222 	int length;
223 
224 	for (;;) {
225 		/* section 16.9.23.2 */
226 		if (in_be16(&rtx->rxbd[rxIdx].cbd_sc) & BD_ENET_RX_EMPTY) {
227 			length = -1;
228 			break;	/* nothing received - leave for() loop */
229 		}
230 
231 		length = in_be16(&rtx->rxbd[rxIdx].cbd_datlen);
232 
233 		if (!(in_be16(&rtx->rxbd[rxIdx].cbd_sc) & 0x003f)) {
234 			uchar *rx = net_rx_packets[rxIdx];
235 
236 			length -= 4;
237 
238 #if defined(CONFIG_CMD_CDP)
239 			if ((rx[0] & 1) != 0 &&
240 			    memcmp((uchar *)rx, net_bcast_ethaddr, 6) != 0 &&
241 			    !is_cdp_packet((uchar *)rx))
242 				rx = NULL;
243 #endif
244 			/*
245 			 * Pass the packet up to the protocol layers.
246 			 */
247 			if (rx != NULL)
248 				net_process_received_packet(rx, length);
249 		}
250 
251 		/* Give the buffer back to the FEC. */
252 		out_be16(&rtx->rxbd[rxIdx].cbd_datlen, 0);
253 
254 		/* wrap around buffer index when necessary */
255 		if ((rxIdx + 1) >= PKTBUFSRX) {
256 			out_be16(&rtx->rxbd[PKTBUFSRX - 1].cbd_sc,
257 				 BD_ENET_RX_WRAP | BD_ENET_RX_EMPTY);
258 			rxIdx = 0;
259 		} else {
260 			out_be16(&rtx->rxbd[rxIdx].cbd_sc, BD_ENET_RX_EMPTY);
261 			rxIdx++;
262 		}
263 
264 		/* Try to fill Buffer Descriptors */
265 		/* Descriptor polling active    */
266 		out_be32(&fecp->fec_r_des_active, 0x01000000);
267 	}
268 
269 	return length;
270 }
271 
272 /**************************************************************
273  *
274  * FEC Ethernet Initialization Routine
275  *
276  *************************************************************/
277 
278 #define	FEC_ECNTRL_PINMUX	0x00000004
279 #define FEC_ECNTRL_ETHER_EN	0x00000002
280 #define FEC_ECNTRL_RESET	0x00000001
281 
282 #define FEC_RCNTRL_BC_REJ	0x00000010
283 #define FEC_RCNTRL_PROM		0x00000008
284 #define FEC_RCNTRL_MII_MODE	0x00000004
285 #define FEC_RCNTRL_DRT		0x00000002
286 #define FEC_RCNTRL_LOOP		0x00000001
287 
288 #define FEC_TCNTRL_FDEN		0x00000004
289 #define FEC_TCNTRL_HBC		0x00000002
290 #define FEC_TCNTRL_GTS		0x00000001
291 
292 #define	FEC_RESET_DELAY		50
293 
294 #if defined(CONFIG_RMII)
295 
296 static inline void fec_10Mbps(struct eth_device *dev)
297 {
298 	struct ether_fcc_info_s *efis = dev->priv;
299 	int fecidx = efis->ether_index;
300 	uint mask = (fecidx == 0) ? 0x0000010 : 0x0000008;
301 	immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
302 
303 	if ((unsigned int)fecidx >= 2)
304 		hang();
305 
306 	setbits_be32(&immr->im_cpm.cp_cptr, mask);
307 }
308 
309 static inline void fec_100Mbps(struct eth_device *dev)
310 {
311 	struct ether_fcc_info_s *efis = dev->priv;
312 	int fecidx = efis->ether_index;
313 	uint mask = (fecidx == 0) ? 0x0000010 : 0x0000008;
314 	immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
315 
316 	if ((unsigned int)fecidx >= 2)
317 		hang();
318 
319 	clrbits_be32(&immr->im_cpm.cp_cptr, mask);
320 }
321 
322 #endif
323 
324 static inline void fec_full_duplex(struct eth_device *dev)
325 {
326 	struct ether_fcc_info_s *efis = dev->priv;
327 	fec_t __iomem *fecp =
328 			(fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
329 
330 	clrbits_be32(&fecp->fec_r_cntrl, FEC_RCNTRL_DRT);
331 	setbits_be32(&fecp->fec_x_cntrl,  FEC_TCNTRL_FDEN);	/* FD enable */
332 }
333 
334 static inline void fec_half_duplex(struct eth_device *dev)
335 {
336 	struct ether_fcc_info_s *efis = dev->priv;
337 	fec_t __iomem *fecp =
338 			(fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
339 
340 	setbits_be32(&fecp->fec_r_cntrl, FEC_RCNTRL_DRT);
341 	clrbits_be32(&fecp->fec_x_cntrl,  FEC_TCNTRL_FDEN);	/* FD disable */
342 }
343 
344 static void fec_pin_init(int fecidx)
345 {
346 	bd_t           *bd = gd->bd;
347 	immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
348 
349 	/*
350 	 * Set MII speed to 2.5 MHz or slightly below.
351 	 *
352 	 * According to the MPC860T (Rev. D) Fast ethernet controller user
353 	 * manual (6.2.14),
354 	 * the MII management interface clock must be less than or equal
355 	 * to 2.5 MHz.
356 	 * This MDC frequency is equal to system clock / (2 * MII_SPEED).
357 	 * Then MII_SPEED = system_clock / 2 * 2,5 MHz.
358 	 *
359 	 * All MII configuration is done via FEC1 registers:
360 	 */
361 	out_be32(&immr->im_cpm.cp_fec1.fec_mii_speed,
362 		 ((bd->bi_intfreq + 4999999) / 5000000) << 1);
363 
364 #if defined(CONFIG_MPC885) && defined(WANT_MII)
365 	/* use MDC for MII */
366 	setbits_be16(&immr->im_ioport.iop_pdpar, 0x0080);
367 	clrbits_be16(&immr->im_ioport.iop_pddir, 0x0080);
368 #endif
369 
370 	if (fecidx == 0) {
371 #if defined(CONFIG_ETHER_ON_FEC1)
372 
373 #if defined(CONFIG_MPC885) /* MPC87x/88x have got 2 FECs and different pinout */
374 
375 #if !defined(CONFIG_RMII)
376 
377 		setbits_be16(&immr->im_ioport.iop_papar, 0xf830);
378 		setbits_be16(&immr->im_ioport.iop_padir, 0x0830);
379 		clrbits_be16(&immr->im_ioport.iop_padir, 0xf000);
380 
381 		setbits_be32(&immr->im_cpm.cp_pbpar, 0x00001001);
382 		clrbits_be32(&immr->im_cpm.cp_pbdir, 0x00001001);
383 
384 		setbits_be16(&immr->im_ioport.iop_pcpar, 0x000c);
385 		clrbits_be16(&immr->im_ioport.iop_pcdir, 0x000c);
386 
387 		setbits_be32(&immr->im_cpm.cp_pepar, 0x00000003);
388 		setbits_be32(&immr->im_cpm.cp_pedir, 0x00000003);
389 		clrbits_be32(&immr->im_cpm.cp_peso, 0x00000003);
390 
391 		clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000100);
392 
393 #else
394 
395 #if !defined(CONFIG_FEC1_PHY_NORXERR)
396 		setbits_be16(&immr->im_ioport.iop_papar, 0x1000);
397 		clrbits_be16(&immr->im_ioport.iop_padir, 0x1000);
398 #endif
399 		setbits_be16(&immr->im_ioport.iop_papar, 0xe810);
400 		setbits_be16(&immr->im_ioport.iop_padir, 0x0810);
401 		clrbits_be16(&immr->im_ioport.iop_padir, 0xe000);
402 
403 		setbits_be32(&immr->im_cpm.cp_pbpar, 0x00000001);
404 		clrbits_be32(&immr->im_cpm.cp_pbdir, 0x00000001);
405 
406 		setbits_be32(&immr->im_cpm.cp_cptr, 0x00000100);
407 		clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000050);
408 
409 #endif /* !CONFIG_RMII */
410 
411 #else
412 		/*
413 		 * Configure all of port D for MII.
414 		 */
415 		out_be16(&immr->im_ioport.iop_pdpar, 0x1fff);
416 		out_be16(&immr->im_ioport.iop_pddir, 0x1fff);
417 
418 #if defined(CONFIG_TARGET_MCR3000)
419 		out_be16(&immr->im_ioport.iop_papar, 0xBBFF);
420 		out_be16(&immr->im_ioport.iop_padir, 0x04F0);
421 		out_be16(&immr->im_ioport.iop_paodr, 0x0000);
422 
423 		out_be32(&immr->im_cpm.cp_pbpar, 0x000133FF);
424 		out_be32(&immr->im_cpm.cp_pbdir, 0x0003BF0F);
425 		out_be16(&immr->im_cpm.cp_pbodr, 0x0000);
426 
427 		out_be16(&immr->im_ioport.iop_pcpar, 0x0400);
428 		out_be16(&immr->im_ioport.iop_pcdir, 0x0080);
429 		out_be16(&immr->im_ioport.iop_pcso , 0x0D53);
430 		out_be16(&immr->im_ioport.iop_pcint, 0x0000);
431 
432 		out_be16(&immr->im_ioport.iop_pdpar, 0x03FE);
433 		out_be16(&immr->im_ioport.iop_pddir, 0x1C09);
434 
435 		setbits_be32(&immr->im_ioport.utmode, 0x80);
436 #endif
437 #endif
438 
439 #endif	/* CONFIG_ETHER_ON_FEC1 */
440 	} else if (fecidx == 1) {
441 #if defined(CONFIG_ETHER_ON_FEC2)
442 
443 #if defined(CONFIG_MPC885) /* MPC87x/88x have got 2 FECs and different pinout */
444 
445 #if !defined(CONFIG_RMII)
446 		setbits_be32(&immr->im_cpm.cp_pepar, 0x0003fffc);
447 		setbits_be32(&immr->im_cpm.cp_pedir, 0x0003fffc);
448 		clrbits_be32(&immr->im_cpm.cp_peso, 0x000087fc);
449 		setbits_be32(&immr->im_cpm.cp_peso, 0x00037800);
450 
451 		clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000080);
452 #else
453 
454 #if !defined(CONFIG_FEC2_PHY_NORXERR)
455 		setbits_be32(&immr->im_cpm.cp_pepar, 0x00000010);
456 		setbits_be32(&immr->im_cpm.cp_pedir, 0x00000010);
457 		clrbits_be32(&immr->im_cpm.cp_peso, 0x00000010);
458 #endif
459 		setbits_be32(&immr->im_cpm.cp_pepar, 0x00039620);
460 		setbits_be32(&immr->im_cpm.cp_pedir, 0x00039620);
461 		setbits_be32(&immr->im_cpm.cp_peso, 0x00031000);
462 		clrbits_be32(&immr->im_cpm.cp_peso, 0x00008620);
463 
464 		setbits_be32(&immr->im_cpm.cp_cptr, 0x00000080);
465 		clrbits_be32(&immr->im_cpm.cp_cptr, 0x00000028);
466 #endif /* CONFIG_RMII */
467 
468 #endif /* CONFIG_MPC885 */
469 
470 #endif /* CONFIG_ETHER_ON_FEC2 */
471 	}
472 }
473 
474 static int fec_reset(fec_t __iomem *fecp)
475 {
476 	int i;
477 
478 	/* Whack a reset.
479 	 * A delay is required between a reset of the FEC block and
480 	 * initialization of other FEC registers because the reset takes
481 	 * some time to complete. If you don't delay, subsequent writes
482 	 * to FEC registers might get killed by the reset routine which is
483 	 * still in progress.
484 	 */
485 
486 	out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_RESET);
487 	for (i = 0; (in_be32(&fecp->fec_ecntrl) & FEC_ECNTRL_RESET) &&
488 	     (i < FEC_RESET_DELAY); ++i)
489 		udelay(1);
490 
491 	if (i == FEC_RESET_DELAY)
492 		return -1;
493 
494 	return 0;
495 }
496 
497 static int fec_init(struct eth_device *dev, bd_t *bd)
498 {
499 	struct ether_fcc_info_s *efis = dev->priv;
500 	immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
501 	fec_t __iomem *fecp =
502 			(fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
503 	int i;
504 
505 #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
506 	/* the MII interface is connected to FEC1
507 	 * so for the miiphy_xxx function to work we must
508 	 * call mii_init since fec_halt messes the thing up
509 	 */
510 	if (efis->ether_index != 0)
511 		__mii_init();
512 #endif
513 
514 	if (fec_reset(fecp) < 0)
515 		printf("FEC_RESET_DELAY timeout\n");
516 
517 	/* We use strictly polling mode only
518 	 */
519 	out_be32(&fecp->fec_imask, 0);
520 
521 	/* Clear any pending interrupt
522 	 */
523 	out_be32(&fecp->fec_ievent, 0xffc0);
524 
525 	/* No need to set the IVEC register */
526 
527 	/* Set station address
528 	 */
529 #define ea dev->enetaddr
530 	out_be32(&fecp->fec_addr_low, (ea[0] << 24) | (ea[1] << 16) |
531 				      (ea[2] << 8) | ea[3]);
532 	out_be16(&fecp->fec_addr_high, (ea[4] << 8) | ea[5]);
533 #undef ea
534 
535 #if defined(CONFIG_CMD_CDP)
536 	/*
537 	 * Turn on multicast address hash table
538 	 */
539 	out_be32(&fecp->fec_hash_table_high, 0xffffffff);
540 	out_be32(&fecp->fec_hash_table_low, 0xffffffff);
541 #else
542 	/* Clear multicast address hash table
543 	 */
544 	out_be32(&fecp->fec_hash_table_high, 0);
545 	out_be32(&fecp->fec_hash_table_low, 0);
546 #endif
547 
548 	/* Set maximum receive buffer size.
549 	 */
550 	out_be32(&fecp->fec_r_buff_size, PKT_MAXBLR_SIZE);
551 
552 	/* Set maximum frame length
553 	 */
554 	out_be32(&fecp->fec_r_hash, PKT_MAXBUF_SIZE);
555 
556 	/*
557 	 * Setup Buffers and Buffer Descriptors
558 	 */
559 	rxIdx = 0;
560 	txIdx = 0;
561 
562 	if (!rtx)
563 		rtx = (struct common_buf_desc __iomem *)
564 		      (immr->im_cpm.cp_dpmem + CPM_FEC_BASE);
565 	/*
566 	 * Setup Receiver Buffer Descriptors (13.14.24.18)
567 	 * Settings:
568 	 *     Empty, Wrap
569 	 */
570 	for (i = 0; i < PKTBUFSRX; i++) {
571 		out_be16(&rtx->rxbd[i].cbd_sc, BD_ENET_RX_EMPTY);
572 		out_be16(&rtx->rxbd[i].cbd_datlen, 0);	/* Reset */
573 		out_be32(&rtx->rxbd[i].cbd_bufaddr, (uint)net_rx_packets[i]);
574 	}
575 	setbits_be16(&rtx->rxbd[PKTBUFSRX - 1].cbd_sc, BD_ENET_RX_WRAP);
576 
577 	/*
578 	 * Setup Ethernet Transmitter Buffer Descriptors (13.14.24.19)
579 	 * Settings:
580 	 *    Last, Tx CRC
581 	 */
582 	for (i = 0; i < TX_BUF_CNT; i++) {
583 		out_be16(&rtx->txbd[i].cbd_sc, BD_ENET_TX_LAST | BD_ENET_TX_TC);
584 		out_be16(&rtx->txbd[i].cbd_datlen, 0);	/* Reset */
585 		out_be32(&rtx->txbd[i].cbd_bufaddr, (uint)txbuf);
586 	}
587 	setbits_be16(&rtx->txbd[TX_BUF_CNT - 1].cbd_sc, BD_ENET_TX_WRAP);
588 
589 	/* Set receive and transmit descriptor base
590 	 */
591 	out_be32(&fecp->fec_r_des_start, (__force unsigned int)rtx->rxbd);
592 	out_be32(&fecp->fec_x_des_start, (__force unsigned int)rtx->txbd);
593 
594 	/* Enable MII mode
595 	 */
596 	/* Half duplex mode */
597 	out_be32(&fecp->fec_r_cntrl, FEC_RCNTRL_MII_MODE | FEC_RCNTRL_DRT);
598 	out_be32(&fecp->fec_x_cntrl, 0);
599 
600 	/* Enable big endian and don't care about SDMA FC.
601 	 */
602 	out_be32(&fecp->fec_fun_code, 0x78000000);
603 
604 	/*
605 	 * Setup the pin configuration of the FEC
606 	 */
607 	fec_pin_init(efis->ether_index);
608 
609 	rxIdx = 0;
610 	txIdx = 0;
611 
612 	/*
613 	 * Now enable the transmit and receive processing
614 	 */
615 	out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_ETHER_EN);
616 
617 	if (efis->phy_addr == -1) {
618 #ifdef CONFIG_SYS_DISCOVER_PHY
619 		/*
620 		 * wait for the PHY to wake up after reset
621 		 */
622 		efis->actual_phy_addr = mii_discover_phy(dev);
623 
624 		if (efis->actual_phy_addr == -1) {
625 			printf("Unable to discover phy!\n");
626 			return -1;
627 		}
628 #else
629 		efis->actual_phy_addr = -1;
630 #endif
631 	} else {
632 		efis->actual_phy_addr = efis->phy_addr;
633 	}
634 
635 #if defined(CONFIG_MII) && defined(CONFIG_RMII)
636 	/*
637 	 * adapt the RMII speed to the speed of the phy
638 	 */
639 	if (miiphy_speed(dev->name, efis->actual_phy_addr) == _100BASET)
640 		fec_100Mbps(dev);
641 	else
642 		fec_10Mbps(dev);
643 #endif
644 
645 #if defined(CONFIG_MII)
646 	/*
647 	 * adapt to the half/full speed settings
648 	 */
649 	if (miiphy_duplex(dev->name, efis->actual_phy_addr) == FULL)
650 		fec_full_duplex(dev);
651 	else
652 		fec_half_duplex(dev);
653 #endif
654 
655 	/* And last, try to fill Rx Buffer Descriptors */
656 	/* Descriptor polling active    */
657 	out_be32(&fecp->fec_r_des_active, 0x01000000);
658 
659 	efis->initialized = 1;
660 
661 	return 0;
662 }
663 
664 
665 static void fec_halt(struct eth_device *dev)
666 {
667 	struct ether_fcc_info_s *efis = dev->priv;
668 	fec_t __iomem *fecp =
669 			(fec_t __iomem *)(CONFIG_SYS_IMMR + efis->fecp_offset);
670 	int i;
671 
672 	/* avoid halt if initialized; mii gets stuck otherwise */
673 	if (!efis->initialized)
674 		return;
675 
676 	/* Whack a reset.
677 	 * A delay is required between a reset of the FEC block and
678 	 * initialization of other FEC registers because the reset takes
679 	 * some time to complete. If you don't delay, subsequent writes
680 	 * to FEC registers might get killed by the reset routine which is
681 	 * still in progress.
682 	 */
683 
684 	out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_RESET);
685 	for (i = 0; (in_be32(&fecp->fec_ecntrl) & FEC_ECNTRL_RESET) &&
686 	     (i < FEC_RESET_DELAY); ++i)
687 		udelay(1);
688 
689 	if (i == FEC_RESET_DELAY) {
690 		printf("FEC_RESET_DELAY timeout\n");
691 		return;
692 	}
693 
694 	efis->initialized = 0;
695 }
696 
697 #if defined(CONFIG_SYS_DISCOVER_PHY) || defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
698 
699 /* Make MII read/write commands for the FEC.
700 */
701 
702 #define mk_mii_read(ADDR, REG)	(0x60020000 | ((ADDR << 23) | \
703 						(REG & 0x1f) << 18))
704 
705 #define mk_mii_write(ADDR, REG, VAL)	(0x50020000 | ((ADDR << 23) | \
706 						(REG & 0x1f) << 18) | \
707 						(VAL & 0xffff))
708 
709 /* Interrupt events/masks.
710 */
711 #define FEC_ENET_HBERR	((uint)0x80000000)	/* Heartbeat error */
712 #define FEC_ENET_BABR	((uint)0x40000000)	/* Babbling receiver */
713 #define FEC_ENET_BABT	((uint)0x20000000)	/* Babbling transmitter */
714 #define FEC_ENET_GRA	((uint)0x10000000)	/* Graceful stop complete */
715 #define FEC_ENET_TXF	((uint)0x08000000)	/* Full frame transmitted */
716 #define FEC_ENET_TXB	((uint)0x04000000)	/* A buffer was transmitted */
717 #define FEC_ENET_RXF	((uint)0x02000000)	/* Full frame received */
718 #define FEC_ENET_RXB	((uint)0x01000000)	/* A buffer was received */
719 #define FEC_ENET_MII	((uint)0x00800000)	/* MII interrupt */
720 #define FEC_ENET_EBERR	((uint)0x00400000)	/* SDMA bus error */
721 
722 /* send command to phy using mii, wait for result */
723 static uint
724 mii_send(uint mii_cmd)
725 {
726 	uint mii_reply;
727 	fec_t __iomem *ep;
728 	int cnt;
729 	immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
730 
731 	ep = &immr->im_cpm.cp_fec;
732 
733 	out_be32(&ep->fec_mii_data, mii_cmd);	/* command to phy */
734 
735 	/* wait for mii complete */
736 	cnt = 0;
737 	while (!(in_be32(&ep->fec_ievent) & FEC_ENET_MII)) {
738 		if (++cnt > 1000) {
739 			printf("mii_send STUCK!\n");
740 			break;
741 		}
742 	}
743 	mii_reply = in_be32(&ep->fec_mii_data);		/* result from phy */
744 	out_be32(&ep->fec_ievent, FEC_ENET_MII);	/* clear MII complete */
745 	return mii_reply & 0xffff;		/* data read from phy */
746 }
747 #endif
748 
749 #if defined(CONFIG_SYS_DISCOVER_PHY)
750 static int mii_discover_phy(struct eth_device *dev)
751 {
752 #define MAX_PHY_PASSES 11
753 	uint phyno;
754 	int  pass;
755 	uint phytype;
756 	int phyaddr;
757 
758 	phyaddr = -1;	/* didn't find a PHY yet */
759 	for (pass = 1; pass <= MAX_PHY_PASSES && phyaddr < 0; ++pass) {
760 		if (pass > 1) {
761 			/* PHY may need more time to recover from reset.
762 			 * The LXT970 needs 50ms typical, no maximum is
763 			 * specified, so wait 10ms before try again.
764 			 * With 11 passes this gives it 100ms to wake up.
765 			 */
766 			udelay(10000);	/* wait 10ms */
767 		}
768 		for (phyno = 0; phyno < 32 && phyaddr < 0; ++phyno) {
769 			phytype = mii_send(mk_mii_read(phyno, MII_PHYSID2));
770 			if (phytype != 0xffff) {
771 				phyaddr = phyno;
772 				phytype |= mii_send(mk_mii_read(phyno,
773 								MII_PHYSID1)) << 16;
774 			}
775 		}
776 	}
777 	if (phyaddr < 0)
778 		printf("No PHY device found.\n");
779 
780 	return phyaddr;
781 }
782 #endif	/* CONFIG_SYS_DISCOVER_PHY */
783 
784 #if (defined(CONFIG_MII) || defined(CONFIG_CMD_MII)) && !defined(CONFIG_BITBANGMII)
785 
786 /****************************************************************************
787  * mii_init -- Initialize the MII via FEC 1 for MII command without ethernet
788  * This function is a subset of eth_init
789  ****************************************************************************
790  */
791 static void __mii_init(void)
792 {
793 	immap_t __iomem *immr = (immap_t __iomem *)CONFIG_SYS_IMMR;
794 	fec_t __iomem *fecp = &immr->im_cpm.cp_fec;
795 
796 	if (fec_reset(fecp) < 0)
797 		printf("FEC_RESET_DELAY timeout\n");
798 
799 	/* We use strictly polling mode only
800 	 */
801 	out_be32(&fecp->fec_imask, 0);
802 
803 	/* Clear any pending interrupt
804 	 */
805 	out_be32(&fecp->fec_ievent, 0xffc0);
806 
807 	/* Now enable the transmit and receive processing
808 	 */
809 	out_be32(&fecp->fec_ecntrl, FEC_ECNTRL_PINMUX | FEC_ECNTRL_ETHER_EN);
810 }
811 
812 void mii_init(void)
813 {
814 	int i;
815 
816 	__mii_init();
817 
818 	/* Setup the pin configuration of the FEC(s)
819 	*/
820 	for (i = 0; i < ARRAY_SIZE(ether_fcc_info); i++)
821 		fec_pin_init(ether_fcc_info[i].ether_index);
822 }
823 
824 /*****************************************************************************
825  * Read and write a MII PHY register, routines used by MII Utilities
826  *
827  * FIXME: These routines are expected to return 0 on success, but mii_send
828  *	  does _not_ return an error code. Maybe 0xFFFF means error, i.e.
829  *	  no PHY connected...
830  *	  For now always return 0.
831  * FIXME: These routines only work after calling eth_init() at least once!
832  *	  Otherwise they hang in mii_send() !!! Sorry!
833  *****************************************************************************/
834 
835 int fec8xx_miiphy_read(struct mii_dev *bus, int addr, int devad, int reg)
836 {
837 	unsigned short value = 0;
838 	short rdreg;    /* register working value */
839 
840 	rdreg = mii_send(mk_mii_read(addr, reg));
841 
842 	value = rdreg;
843 	return value;
844 }
845 
846 int fec8xx_miiphy_write(struct mii_dev *bus, int addr, int devad, int reg,
847 			u16 value)
848 {
849 	(void)mii_send(mk_mii_write(addr, reg, value));
850 
851 	return 0;
852 }
853 #endif
854