1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * (C) Copyright 2000-2004
4 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
5 *
6 * (C) Copyright 2007 Freescale Semiconductor, Inc.
7 * TsiChung Liew (Tsi-Chung.Liew@freescale.com)
8 *
9 * Conversion to DM
10 * (C) 2019 Angelo Dureghello <angelo.dureghello@timesys.com>
11 */
12
13 #include <config.h>
14 #include <cpu_func.h>
15 #include <env.h>
16 #include <hang.h>
17 #include <malloc.h>
18 #include <command.h>
19 #include <net.h>
20 #include <miiphy.h>
21 #include <asm/fec.h>
22 #include <asm/global_data.h>
23 #include <asm/immap.h>
24 #include <linux/delay.h>
25 #include <linux/mii.h>
26
27 #undef ET_DEBUG
28 #undef MII_DEBUG
29
30 /* Ethernet Transmit and Receive Buffers */
31 #define DBUF_LENGTH 1520
32 #define TX_BUF_CNT 2
33 #define PKT_MAXBUF_SIZE 1518
34 #define PKT_MAXBLR_SIZE 1520
35 #define LAST_PKTBUFSRX PKTBUFSRX - 1
36 #define BD_ENET_RX_W_E (BD_ENET_RX_WRAP | BD_ENET_RX_EMPTY)
37 #define BD_ENET_TX_RDY_LST (BD_ENET_TX_READY | BD_ENET_TX_LAST)
38
39 DECLARE_GLOBAL_DATA_PTR;
40
init_eth_info(struct fec_info_s * info)41 static void init_eth_info(struct fec_info_s *info)
42 {
43 #ifdef CFG_SYS_FEC_BUF_USE_SRAM
44 static u32 tmp;
45
46 if (info->index == 0)
47 tmp = CFG_SYS_INIT_RAM_ADDR + 0x1000;
48 else
49 info->rxbd = (cbd_t *)DBUF_LENGTH;
50
51 /* setup Receive and Transmit buffer descriptor */
52 info->rxbd = (cbd_t *)((u32)info->rxbd + tmp);
53 tmp = (u32)info->rxbd;
54 info->txbd =
55 (cbd_t *)((u32)info->txbd + tmp +
56 (PKTBUFSRX * sizeof(cbd_t)));
57 tmp = (u32)info->txbd;
58 info->txbuf =
59 (char *)((u32)info->txbuf + tmp +
60 (CFG_SYS_TX_ETH_BUFFER * sizeof(cbd_t)));
61 tmp = (u32)info->txbuf;
62 #else
63 info->rxbd =
64 (cbd_t *)memalign(CONFIG_SYS_CACHELINE_SIZE,
65 (PKTBUFSRX * sizeof(cbd_t)));
66 info->txbd =
67 (cbd_t *)memalign(CONFIG_SYS_CACHELINE_SIZE,
68 (TX_BUF_CNT * sizeof(cbd_t)));
69 info->txbuf =
70 (char *)memalign(CONFIG_SYS_CACHELINE_SIZE, DBUF_LENGTH);
71 #endif
72
73 #ifdef ET_DEBUG
74 printf("rxbd %x txbd %x\n", (int)info->rxbd, (int)info->txbd);
75 #endif
76 info->phy_name = (char *)memalign(CONFIG_SYS_CACHELINE_SIZE, 32);
77 }
78
fec_reset(struct fec_info_s * info)79 static void fec_reset(struct fec_info_s *info)
80 {
81 volatile fec_t *fecp = (fec_t *)(info->iobase);
82 int i;
83
84 fecp->ecr = FEC_ECR_RESET;
85 for (i = 0; (fecp->ecr & FEC_ECR_RESET) && (i < FEC_RESET_DELAY); ++i)
86 udelay(1);
87
88 if (i == FEC_RESET_DELAY)
89 printf("FEC_RESET_DELAY timeout\n");
90 }
91
set_fec_duplex_speed(volatile fec_t * fecp,int dup_spd)92 static void set_fec_duplex_speed(volatile fec_t *fecp, int dup_spd)
93 {
94 struct bd_info *bd = gd->bd;
95
96 if ((dup_spd >> 16) == FULL) {
97 /* Set maximum frame length */
98 fecp->rcr = FEC_RCR_MAX_FL(PKT_MAXBUF_SIZE) | FEC_RCR_MII_MODE |
99 FEC_RCR_PROM | 0x100;
100 fecp->tcr = FEC_TCR_FDEN;
101 } else {
102 /* Half duplex mode */
103 fecp->rcr = FEC_RCR_MAX_FL(PKT_MAXBUF_SIZE) |
104 FEC_RCR_MII_MODE | FEC_RCR_DRT;
105 fecp->tcr &= ~FEC_TCR_FDEN;
106 }
107
108 if ((dup_spd & 0xFFFF) == _100BASET) {
109 #ifdef MII_DEBUG
110 printf("100Mbps\n");
111 #endif
112 bd->bi_ethspeed = 100;
113 } else {
114 #ifdef MII_DEBUG
115 printf("10Mbps\n");
116 #endif
117 bd->bi_ethspeed = 10;
118 }
119 }
120
121 #ifdef ET_DEBUG
dbg_fec_regs(struct udevice * dev)122 static void dbg_fec_regs(struct udevice *dev)
123 {
124 struct fec_info_s *info = dev_get_priv(dev);
125 volatile fec_t *fecp = (fec_t *)(info->iobase);
126
127 printf("=====\n");
128 printf("ievent %x - %x\n", (int)&fecp->eir, fecp->eir);
129 printf("imask %x - %x\n", (int)&fecp->eimr, fecp->eimr);
130 printf("r_des_active %x - %x\n", (int)&fecp->rdar, fecp->rdar);
131 printf("x_des_active %x - %x\n", (int)&fecp->tdar, fecp->tdar);
132 printf("ecntrl %x - %x\n", (int)&fecp->ecr, fecp->ecr);
133 printf("mii_mframe %x - %x\n", (int)&fecp->mmfr, fecp->mmfr);
134 printf("mii_speed %x - %x\n", (int)&fecp->mscr, fecp->mscr);
135 printf("mii_ctrlstat %x - %x\n", (int)&fecp->mibc, fecp->mibc);
136 printf("r_cntrl %x - %x\n", (int)&fecp->rcr, fecp->rcr);
137 printf("x_cntrl %x - %x\n", (int)&fecp->tcr, fecp->tcr);
138 printf("padr_l %x - %x\n", (int)&fecp->palr, fecp->palr);
139 printf("padr_u %x - %x\n", (int)&fecp->paur, fecp->paur);
140 printf("op_pause %x - %x\n", (int)&fecp->opd, fecp->opd);
141 printf("iadr_u %x - %x\n", (int)&fecp->iaur, fecp->iaur);
142 printf("iadr_l %x - %x\n", (int)&fecp->ialr, fecp->ialr);
143 printf("gadr_u %x - %x\n", (int)&fecp->gaur, fecp->gaur);
144 printf("gadr_l %x - %x\n", (int)&fecp->galr, fecp->galr);
145 printf("x_wmrk %x - %x\n", (int)&fecp->tfwr, fecp->tfwr);
146 printf("r_bound %x - %x\n", (int)&fecp->frbr, fecp->frbr);
147 printf("r_fstart %x - %x\n", (int)&fecp->frsr, fecp->frsr);
148 printf("r_drng %x - %x\n", (int)&fecp->erdsr, fecp->erdsr);
149 printf("x_drng %x - %x\n", (int)&fecp->etdsr, fecp->etdsr);
150 printf("r_bufsz %x - %x\n", (int)&fecp->emrbr, fecp->emrbr);
151
152 printf("\n");
153 printf("rmon_t_drop %x - %x\n", (int)&fecp->rmon_t_drop,
154 fecp->rmon_t_drop);
155 printf("rmon_t_packets %x - %x\n", (int)&fecp->rmon_t_packets,
156 fecp->rmon_t_packets);
157 printf("rmon_t_bc_pkt %x - %x\n", (int)&fecp->rmon_t_bc_pkt,
158 fecp->rmon_t_bc_pkt);
159 printf("rmon_t_mc_pkt %x - %x\n", (int)&fecp->rmon_t_mc_pkt,
160 fecp->rmon_t_mc_pkt);
161 printf("rmon_t_crc_align %x - %x\n", (int)&fecp->rmon_t_crc_align,
162 fecp->rmon_t_crc_align);
163 printf("rmon_t_undersize %x - %x\n", (int)&fecp->rmon_t_undersize,
164 fecp->rmon_t_undersize);
165 printf("rmon_t_oversize %x - %x\n", (int)&fecp->rmon_t_oversize,
166 fecp->rmon_t_oversize);
167 printf("rmon_t_frag %x - %x\n", (int)&fecp->rmon_t_frag,
168 fecp->rmon_t_frag);
169 printf("rmon_t_jab %x - %x\n", (int)&fecp->rmon_t_jab,
170 fecp->rmon_t_jab);
171 printf("rmon_t_col %x - %x\n", (int)&fecp->rmon_t_col,
172 fecp->rmon_t_col);
173 printf("rmon_t_p64 %x - %x\n", (int)&fecp->rmon_t_p64,
174 fecp->rmon_t_p64);
175 printf("rmon_t_p65to127 %x - %x\n", (int)&fecp->rmon_t_p65to127,
176 fecp->rmon_t_p65to127);
177 printf("rmon_t_p128to255 %x - %x\n", (int)&fecp->rmon_t_p128to255,
178 fecp->rmon_t_p128to255);
179 printf("rmon_t_p256to511 %x - %x\n", (int)&fecp->rmon_t_p256to511,
180 fecp->rmon_t_p256to511);
181 printf("rmon_t_p512to1023 %x - %x\n", (int)&fecp->rmon_t_p512to1023,
182 fecp->rmon_t_p512to1023);
183 printf("rmon_t_p1024to2047 %x - %x\n", (int)&fecp->rmon_t_p1024to2047,
184 fecp->rmon_t_p1024to2047);
185 printf("rmon_t_p_gte2048 %x - %x\n", (int)&fecp->rmon_t_p_gte2048,
186 fecp->rmon_t_p_gte2048);
187 printf("rmon_t_octets %x - %x\n", (int)&fecp->rmon_t_octets,
188 fecp->rmon_t_octets);
189
190 printf("\n");
191 printf("ieee_t_drop %x - %x\n", (int)&fecp->ieee_t_drop,
192 fecp->ieee_t_drop);
193 printf("ieee_t_frame_ok %x - %x\n", (int)&fecp->ieee_t_frame_ok,
194 fecp->ieee_t_frame_ok);
195 printf("ieee_t_1col %x - %x\n", (int)&fecp->ieee_t_1col,
196 fecp->ieee_t_1col);
197 printf("ieee_t_mcol %x - %x\n", (int)&fecp->ieee_t_mcol,
198 fecp->ieee_t_mcol);
199 printf("ieee_t_def %x - %x\n", (int)&fecp->ieee_t_def,
200 fecp->ieee_t_def);
201 printf("ieee_t_lcol %x - %x\n", (int)&fecp->ieee_t_lcol,
202 fecp->ieee_t_lcol);
203 printf("ieee_t_excol %x - %x\n", (int)&fecp->ieee_t_excol,
204 fecp->ieee_t_excol);
205 printf("ieee_t_macerr %x - %x\n", (int)&fecp->ieee_t_macerr,
206 fecp->ieee_t_macerr);
207 printf("ieee_t_cserr %x - %x\n", (int)&fecp->ieee_t_cserr,
208 fecp->ieee_t_cserr);
209 printf("ieee_t_sqe %x - %x\n", (int)&fecp->ieee_t_sqe,
210 fecp->ieee_t_sqe);
211 printf("ieee_t_fdxfc %x - %x\n", (int)&fecp->ieee_t_fdxfc,
212 fecp->ieee_t_fdxfc);
213 printf("ieee_t_octets_ok %x - %x\n", (int)&fecp->ieee_t_octets_ok,
214 fecp->ieee_t_octets_ok);
215
216 printf("\n");
217 printf("rmon_r_drop %x - %x\n", (int)&fecp->rmon_r_drop,
218 fecp->rmon_r_drop);
219 printf("rmon_r_packets %x - %x\n", (int)&fecp->rmon_r_packets,
220 fecp->rmon_r_packets);
221 printf("rmon_r_bc_pkt %x - %x\n", (int)&fecp->rmon_r_bc_pkt,
222 fecp->rmon_r_bc_pkt);
223 printf("rmon_r_mc_pkt %x - %x\n", (int)&fecp->rmon_r_mc_pkt,
224 fecp->rmon_r_mc_pkt);
225 printf("rmon_r_crc_align %x - %x\n", (int)&fecp->rmon_r_crc_align,
226 fecp->rmon_r_crc_align);
227 printf("rmon_r_undersize %x - %x\n", (int)&fecp->rmon_r_undersize,
228 fecp->rmon_r_undersize);
229 printf("rmon_r_oversize %x - %x\n", (int)&fecp->rmon_r_oversize,
230 fecp->rmon_r_oversize);
231 printf("rmon_r_frag %x - %x\n", (int)&fecp->rmon_r_frag,
232 fecp->rmon_r_frag);
233 printf("rmon_r_jab %x - %x\n", (int)&fecp->rmon_r_jab,
234 fecp->rmon_r_jab);
235 printf("rmon_r_p64 %x - %x\n", (int)&fecp->rmon_r_p64,
236 fecp->rmon_r_p64);
237 printf("rmon_r_p65to127 %x - %x\n", (int)&fecp->rmon_r_p65to127,
238 fecp->rmon_r_p65to127);
239 printf("rmon_r_p128to255 %x - %x\n", (int)&fecp->rmon_r_p128to255,
240 fecp->rmon_r_p128to255);
241 printf("rmon_r_p256to511 %x - %x\n", (int)&fecp->rmon_r_p256to511,
242 fecp->rmon_r_p256to511);
243 printf("rmon_r_p512to1023 %x - %x\n", (int)&fecp->rmon_r_p512to1023,
244 fecp->rmon_r_p512to1023);
245 printf("rmon_r_p1024to2047 %x - %x\n", (int)&fecp->rmon_r_p1024to2047,
246 fecp->rmon_r_p1024to2047);
247 printf("rmon_r_p_gte2048 %x - %x\n", (int)&fecp->rmon_r_p_gte2048,
248 fecp->rmon_r_p_gte2048);
249 printf("rmon_r_octets %x - %x\n", (int)&fecp->rmon_r_octets,
250 fecp->rmon_r_octets);
251
252 printf("\n");
253 printf("ieee_r_drop %x - %x\n", (int)&fecp->ieee_r_drop,
254 fecp->ieee_r_drop);
255 printf("ieee_r_frame_ok %x - %x\n", (int)&fecp->ieee_r_frame_ok,
256 fecp->ieee_r_frame_ok);
257 printf("ieee_r_crc %x - %x\n", (int)&fecp->ieee_r_crc,
258 fecp->ieee_r_crc);
259 printf("ieee_r_align %x - %x\n", (int)&fecp->ieee_r_align,
260 fecp->ieee_r_align);
261 printf("ieee_r_macerr %x - %x\n", (int)&fecp->ieee_r_macerr,
262 fecp->ieee_r_macerr);
263 printf("ieee_r_fdxfc %x - %x\n", (int)&fecp->ieee_r_fdxfc,
264 fecp->ieee_r_fdxfc);
265 printf("ieee_r_octets_ok %x - %x\n", (int)&fecp->ieee_r_octets_ok,
266 fecp->ieee_r_octets_ok);
267
268 printf("\n\n\n");
269 }
270 #endif
271
mcffec_init(struct udevice * dev)272 int mcffec_init(struct udevice *dev)
273 {
274 struct fec_info_s *info = dev_get_priv(dev);
275 volatile fec_t *fecp = (fec_t *) (info->iobase);
276 int rval, i;
277 uchar ea[6];
278
279 fecpin_setclear(info, 1);
280 fec_reset(info);
281
282 mii_init();
283
284 set_fec_duplex_speed(fecp, info->dup_spd);
285
286 /* We use strictly polling mode only */
287 fecp->eimr = 0;
288
289 /* Clear any pending interrupt */
290 fecp->eir = 0xffffffff;
291
292 /* Set station address */
293 if (info->index == 0)
294 rval = eth_env_get_enetaddr("ethaddr", ea);
295 else
296 rval = eth_env_get_enetaddr("eth1addr", ea);
297
298 if (!rval) {
299 puts("Please set a valid MAC address\n");
300 return -EINVAL;
301 }
302
303 fecp->palr =
304 (ea[0] << 24) | (ea[1] << 16) | (ea[2] << 8) | (ea[3]);
305 fecp->paur = (ea[4] << 24) | (ea[5] << 16);
306
307 /* Clear unicast address hash table */
308 fecp->iaur = 0;
309 fecp->ialr = 0;
310
311 /* Clear multicast address hash table */
312 fecp->gaur = 0;
313 fecp->galr = 0;
314
315 /* Set maximum receive buffer size. */
316 fecp->emrbr = PKT_MAXBLR_SIZE;
317
318 /*
319 * Setup Buffers and Buffer Descriptors
320 */
321 info->rx_idx = 0;
322 info->tx_idx = 0;
323
324 /*
325 * Setup Receiver Buffer Descriptors (13.14.24.18)
326 * Settings:
327 * Empty, Wrap
328 */
329 for (i = 0; i < PKTBUFSRX; i++) {
330 info->rxbd[i].cbd_sc = BD_ENET_RX_EMPTY;
331 info->rxbd[i].cbd_datlen = 0; /* Reset */
332 info->rxbd[i].cbd_bufaddr = (uint) net_rx_packets[i];
333 }
334 info->rxbd[PKTBUFSRX - 1].cbd_sc |= BD_ENET_RX_WRAP;
335
336 /*
337 * Setup Ethernet Transmitter Buffer Descriptors (13.14.24.19)
338 * Settings:
339 * Last, Tx CRC
340 */
341 for (i = 0; i < TX_BUF_CNT; i++) {
342 info->txbd[i].cbd_sc = BD_ENET_TX_LAST | BD_ENET_TX_TC;
343 info->txbd[i].cbd_datlen = 0; /* Reset */
344 info->txbd[i].cbd_bufaddr = (uint) (&info->txbuf[0]);
345 }
346 info->txbd[TX_BUF_CNT - 1].cbd_sc |= BD_ENET_TX_WRAP;
347
348 /* Set receive and transmit descriptor base */
349 fecp->erdsr = (unsigned int)(&info->rxbd[0]);
350 fecp->etdsr = (unsigned int)(&info->txbd[0]);
351
352 /* Now enable the transmit and receive processing */
353 fecp->ecr |= FEC_ECR_ETHER_EN;
354
355 /* And last, try to fill Rx Buffer Descriptors
356 * Descriptor polling active
357 */
358 fecp->rdar = 0x01000000;
359
360 return 0;
361 }
362
mcffec_send(struct udevice * dev,void * packet,int length)363 static int mcffec_send(struct udevice *dev, void *packet, int length)
364 {
365 struct fec_info_s *info = dev_get_priv(dev);
366 volatile fec_t *fecp = (fec_t *)info->iobase;
367 int j, rc;
368 u16 phy_status;
369
370 miiphy_read(dev->name, info->phy_addr, MII_BMSR, &phy_status);
371
372 /* section 16.9.23.3
373 * Wait for ready
374 */
375 j = 0;
376 while ((info->txbd[info->tx_idx].cbd_sc & BD_ENET_TX_READY) &&
377 (j < info->to_loop)) {
378 udelay(1);
379 j++;
380 }
381 if (j >= info->to_loop)
382 printf("TX not ready\n");
383
384 info->txbd[info->tx_idx].cbd_bufaddr = (uint)packet;
385 info->txbd[info->tx_idx].cbd_datlen = length;
386 info->txbd[info->tx_idx].cbd_sc |= BD_ENET_TX_RDY_LST;
387
388 /* Activate transmit Buffer Descriptor polling */
389 fecp->tdar = 0x01000000; /* Descriptor polling active */
390
391 #ifndef CFG_SYS_FEC_BUF_USE_SRAM
392 /*
393 * FEC unable to initial transmit data packet.
394 * A nop will ensure the descriptor polling active completed.
395 * CF Internal RAM has shorter cycle access than DRAM. If use
396 * DRAM as Buffer descriptor and data, a nop is a must.
397 * Affect only V2 and V3.
398 */
399 __asm__ ("nop");
400 #endif
401
402 #ifdef CONFIG_SYS_UNIFY_CACHE
403 invalidate_icache_all();
404 #endif
405
406 j = 0;
407 while ((info->txbd[info->tx_idx].cbd_sc & BD_ENET_TX_READY) &&
408 (j < info->to_loop)) {
409 udelay(1);
410 j++;
411 }
412 if (j >= info->to_loop)
413 printf("TX timeout\n");
414
415 #ifdef ET_DEBUG
416 printf("%s[%d] %s: cycles: %d status: %x retry cnt: %d\n",
417 __FILE__, __LINE__, __func__, j,
418 info->txbd[info->tx_idx].cbd_sc,
419 (info->txbd[info->tx_idx].cbd_sc & 0x003C) >> 2);
420 #endif
421
422 /* return only status bits */
423 rc = (info->txbd[info->tx_idx].cbd_sc & BD_ENET_TX_STATS);
424 info->tx_idx = (info->tx_idx + 1) % TX_BUF_CNT;
425
426 return rc;
427 }
428
mcffec_recv(struct udevice * dev,int flags,uchar ** packetp)429 static int mcffec_recv(struct udevice *dev, int flags, uchar **packetp)
430 {
431 struct fec_info_s *info = dev_get_priv(dev);
432 volatile fec_t *fecp = (fec_t *)info->iobase;
433 int length = -1;
434
435 for (;;) {
436 #ifdef CONFIG_SYS_UNIFY_CACHE
437 invalidate_icache_all();
438 #endif
439 /* If nothing received - leave for() loop */
440 if (info->rxbd[info->rx_idx].cbd_sc & BD_ENET_RX_EMPTY)
441 break;
442
443 length = info->rxbd[info->rx_idx].cbd_datlen;
444
445 if (info->rxbd[info->rx_idx].cbd_sc & 0x003f) {
446 printf("%s[%d] err: %x\n",
447 __func__, __LINE__,
448 info->rxbd[info->rx_idx].cbd_sc);
449 } else {
450 length -= 4;
451
452 /*
453 * Pass the buffer ptr up to the protocol layers.
454 */
455 *packetp = net_rx_packets[info->rx_idx];
456
457 fecp->eir |= FEC_EIR_RXF;
458 }
459
460 /* Give the buffer back to the FEC. */
461 info->rxbd[info->rx_idx].cbd_datlen = 0;
462
463 /* wrap around buffer index when necessary */
464 if (info->rx_idx == LAST_PKTBUFSRX) {
465 info->rxbd[PKTBUFSRX - 1].cbd_sc = BD_ENET_RX_W_E;
466 info->rx_idx = 0;
467 } else {
468 info->rxbd[info->rx_idx].cbd_sc = BD_ENET_RX_EMPTY;
469 info->rx_idx++;
470 }
471
472 /* Try to fill Buffer Descriptors
473 * Descriptor polling active
474 */
475 fecp->rdar = 0x01000000;
476 }
477
478 return length;
479 }
480
mcffec_halt(struct udevice * dev)481 static void mcffec_halt(struct udevice *dev)
482 {
483 struct fec_info_s *info = dev_get_priv(dev);
484
485 fec_reset(info);
486 fecpin_setclear(info, 0);
487
488 info->rx_idx = 0;
489 info->tx_idx = 0;
490
491 memset(info->rxbd, 0, PKTBUFSRX * sizeof(cbd_t));
492 memset(info->txbd, 0, TX_BUF_CNT * sizeof(cbd_t));
493 memset(info->txbuf, 0, DBUF_LENGTH);
494 }
495
496 static const struct eth_ops mcffec_ops = {
497 .start = mcffec_init,
498 .send = mcffec_send,
499 .recv = mcffec_recv,
500 .stop = mcffec_halt,
501 };
502
503 /*
504 * Boot sequence, called just after mcffec_of_to_plat,
505 * as DM way, it replaces old mcffec_initialize.
506 */
mcffec_probe(struct udevice * dev)507 static int mcffec_probe(struct udevice *dev)
508 {
509 struct eth_pdata *pdata = dev_get_plat(dev);
510 struct fec_info_s *info = dev_get_priv(dev);
511 int node = dev_of_offset(dev);
512 int retval, fec_idx;
513 const u32 *val;
514
515 info->index = dev_seq(dev);
516 info->iobase = pdata->iobase;
517 info->phy_addr = -1;
518
519 val = fdt_getprop(gd->fdt_blob, node, "mii-base", NULL);
520 if (val) {
521 u32 fec_iobase;
522
523 fec_idx = fdt32_to_cpu(*val);
524 if (fec_idx == info->index) {
525 fec_iobase = info->iobase;
526 } else {
527 printf("mii base != base address, fec_idx %d\n",
528 fec_idx);
529 retval = fec_get_base_addr(fec_idx, &fec_iobase);
530 if (retval)
531 return retval;
532 }
533 info->miibase = fec_iobase;
534 }
535
536 val = fdt_getprop(gd->fdt_blob, node, "phy-addr", NULL);
537 if (val)
538 info->phy_addr = fdt32_to_cpu(*val);
539
540 val = fdt_getprop(gd->fdt_blob, node, "timeout-loop", NULL);
541 if (val)
542 info->to_loop = fdt32_to_cpu(*val);
543
544 init_eth_info(info);
545
546 #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII)
547 info->bus = mdio_alloc();
548 if (!info->bus)
549 return -ENOMEM;
550 strcpy(info->bus->name, dev->name);
551 info->bus->read = mcffec_miiphy_read;
552 info->bus->write = mcffec_miiphy_write;
553
554 retval = mdio_register(info->bus);
555 if (retval < 0)
556 return retval;
557 #endif
558
559 return 0;
560 }
561
mcffec_remove(struct udevice * dev)562 static int mcffec_remove(struct udevice *dev)
563 {
564 struct fec_info_s *priv = dev_get_priv(dev);
565
566 mdio_unregister(priv->bus);
567 mdio_free(priv->bus);
568
569 return 0;
570 }
571
572 /*
573 * Boot sequence, called 1st
574 */
mcffec_of_to_plat(struct udevice * dev)575 static int mcffec_of_to_plat(struct udevice *dev)
576 {
577 struct eth_pdata *pdata = dev_get_plat(dev);
578 const u32 *val;
579
580 pdata->iobase = dev_read_addr(dev);
581 /* Default to 10Mbit/s */
582 pdata->max_speed = 10;
583
584 val = fdt_getprop(gd->fdt_blob, dev_of_offset(dev),
585 "max-speed", NULL);
586 if (val)
587 pdata->max_speed = fdt32_to_cpu(*val);
588
589 return 0;
590 }
591
592 static const struct udevice_id mcffec_ids[] = {
593 { .compatible = "fsl,mcf-fec" },
594 { }
595 };
596
597 U_BOOT_DRIVER(mcffec) = {
598 .name = "mcffec",
599 .id = UCLASS_ETH,
600 .of_match = mcffec_ids,
601 .of_to_plat = mcffec_of_to_plat,
602 .probe = mcffec_probe,
603 .remove = mcffec_remove,
604 .ops = &mcffec_ops,
605 .priv_auto = sizeof(struct fec_info_s),
606 .plat_auto = sizeof(struct eth_pdata),
607 };
608