TsiChung Liew | 8e585f0 | 2007-06-18 13:50:13 -0500 | [diff] [blame^] | 1 | /* |
| 2 | * (C) Copyright 2000-2004 |
| 3 | * Wolfgang Denk, DENX Software Engineering, wd@denx.de. |
| 4 | * |
| 5 | * (C) Copyright 2007 |
| 6 | * TsiChung Liew (Tsi-Chung.Liew@freescale.com) |
| 7 | * |
| 8 | * See file CREDITS for list of people who contributed to this |
| 9 | * project. |
| 10 | * |
| 11 | * This program is free software; you can redistribute it and/or |
| 12 | * modify it under the terms of the GNU General Public License as |
| 13 | * published by the Free Software Foundation; either version 2 of |
| 14 | * the License, or (at your option) any later version. |
| 15 | * |
| 16 | * This program is distributed in the hope that it will be useful, |
| 17 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 18 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 19 | * GNU General Public License for more details. |
| 20 | * |
| 21 | * You should have received a copy of the GNU General Public License |
| 22 | * along with this program; if not, write to the Free Software |
| 23 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
| 24 | * MA 02111-1307 USA |
| 25 | */ |
| 26 | |
| 27 | #include <common.h> |
| 28 | #include <malloc.h> |
| 29 | |
| 30 | #include <asm/fec.h> |
| 31 | #include <asm/m5329.h> |
| 32 | #include <asm/immap_5329.h> |
| 33 | |
| 34 | #include <command.h> |
| 35 | #include <config.h> |
| 36 | #include <net.h> |
| 37 | #include <miiphy.h> |
| 38 | |
| 39 | #ifdef CONFIG_MCFFEC |
| 40 | #undef ET_DEBUG |
| 41 | #undef MII_DEBUG |
| 42 | |
| 43 | /* Ethernet Transmit and Receive Buffers */ |
| 44 | #define DBUF_LENGTH 1520 |
| 45 | |
| 46 | #define TX_BUF_CNT 2 |
| 47 | |
| 48 | /* |
| 49 | NOTE: PKT_MAXBUF_SIZE must be larger or equal to PKT_MAXBLR_SIZE, |
| 50 | see M54455 User Manual for MAX_FL of Receive Control Register for more |
| 51 | description. If PKT_MAXBUF_SIZE set to 1518, the FEC bandwidth will |
| 52 | reduce to about 20~40% of normal bandwidth. Changing PKT_MAXBLR_SIZE |
| 53 | will not make any improvement on speed |
| 54 | */ |
| 55 | #define PKT_MAXBUF_SIZE 1518 |
| 56 | #define PKT_MINBUF_SIZE 64 |
| 57 | #define PKT_MAXBLR_SIZE 1520 |
| 58 | #define LAST_PKTBUFSRX PKTBUFSRX - 1 |
| 59 | #define BD_ENET_RX_W_E (BD_ENET_RX_WRAP | BD_ENET_RX_EMPTY) |
| 60 | #define BD_ENET_TX_RDY_LST (BD_ENET_TX_READY | BD_ENET_TX_LAST) |
| 61 | |
| 62 | DECLARE_GLOBAL_DATA_PTR; |
| 63 | |
| 64 | #if (CONFIG_COMMANDS & CFG_CMD_NET) && defined(CONFIG_NET_MULTI) |
| 65 | |
| 66 | struct fec_info_s fec_info[] = { |
| 67 | #ifdef CFG_FEC0_IOBASE |
| 68 | { |
| 69 | 0, /* index */ |
| 70 | CFG_FEC0_IOBASE, /* io base */ |
| 71 | CFG_FEC0_PINMUX, /* gpio pin muxing */ |
| 72 | CFG_FEC0_MIIBASE, /* mii base */ |
| 73 | -1, /* phy_addr */ |
| 74 | 0, /* duplex and speed */ |
| 75 | 0, /* phy name */ |
| 76 | 0, /* phyname init */ |
| 77 | 0, /* RX BD */ |
| 78 | 0, /* TX BD */ |
| 79 | 0, /* rx Index */ |
| 80 | 0, /* tx Index */ |
| 81 | 0, /* tx buffer */ |
| 82 | 0, /* initialized flag */ |
| 83 | }, |
| 84 | #endif |
| 85 | #ifdef CFG_FEC1_IOBASE |
| 86 | { |
| 87 | 1, /* index */ |
| 88 | CFG_FEC1_IOBASE, /* io base */ |
| 89 | CFG_FEC1_PINMUX, /* gpio pin muxing */ |
| 90 | CFG_FEC1_MIIBASE, /* mii base */ |
| 91 | -1, /* phy_addr */ |
| 92 | 0, /* duplex and speed */ |
| 93 | 0, /* phy name */ |
| 94 | 0, /* phy name init */ |
| 95 | 0, /* RX BD */ |
| 96 | 0, /* TX BD */ |
| 97 | 0, /* rx Index */ |
| 98 | 0, /* tx Index */ |
| 99 | 0, /* tx buffer */ |
| 100 | 0, /* initialized flag */ |
| 101 | } |
| 102 | #endif |
| 103 | }; |
| 104 | |
| 105 | /* |
| 106 | * FEC Ethernet Tx and Rx buffer descriptors allocated at the |
| 107 | * immr->udata_bd address on Dual-Port RAM |
| 108 | * Provide for Double Buffering |
| 109 | */ |
| 110 | |
| 111 | int fec_send(struct eth_device *dev, volatile void *packet, int length); |
| 112 | int fec_recv(struct eth_device *dev); |
| 113 | int fec_init(struct eth_device *dev, bd_t * bd); |
| 114 | void fec_halt(struct eth_device *dev); |
| 115 | void fec_reset(struct eth_device *dev); |
| 116 | |
| 117 | extern int fecpin_setclear(struct eth_device *dev, int setclear); |
| 118 | |
| 119 | #ifdef CFG_DISCOVER_PHY |
| 120 | extern void mii_init(void); |
| 121 | extern uint mii_send(uint mii_cmd); |
| 122 | extern int mii_discover_phy(struct eth_device *dev); |
| 123 | extern int mcffec_miiphy_read(char *devname, unsigned char addr, |
| 124 | unsigned char reg, unsigned short *value); |
| 125 | extern int mcffec_miiphy_write(char *devname, unsigned char addr, |
| 126 | unsigned char reg, unsigned short value); |
| 127 | #endif |
| 128 | |
| 129 | void setFecDuplexSpeed(volatile fec_t * fecp, bd_t * bd, int dup_spd) |
| 130 | { |
| 131 | if ((dup_spd >> 16) == FULL) { |
| 132 | /* Set maximum frame length */ |
| 133 | fecp->rcr = FEC_RCR_MAX_FL(PKT_MAXBUF_SIZE) | FEC_RCR_MII_MODE | |
| 134 | FEC_RCR_PROM | 0x100; |
| 135 | fecp->tcr = FEC_TCR_FDEN; |
| 136 | } else { |
| 137 | /* Half duplex mode */ |
| 138 | fecp->rcr = FEC_RCR_MAX_FL(PKT_MAXBUF_SIZE) | |
| 139 | FEC_RCR_MII_MODE | FEC_RCR_DRT; |
| 140 | fecp->tcr &= ~FEC_TCR_FDEN; |
| 141 | } |
| 142 | |
| 143 | if ((dup_spd & 0xFFFF) == _100BASET) { |
| 144 | #ifdef MII_DEBUG |
| 145 | printf("100Mbps\n"); |
| 146 | #endif |
| 147 | bd->bi_ethspeed = 100; |
| 148 | } else { |
| 149 | #ifdef MII_DEBUG |
| 150 | printf("10Mbps\n"); |
| 151 | #endif |
| 152 | bd->bi_ethspeed = 10; |
| 153 | } |
| 154 | } |
| 155 | |
| 156 | int fec_send(struct eth_device *dev, volatile void *packet, int length) |
| 157 | { |
| 158 | struct fec_info_s *info = dev->priv; |
| 159 | volatile fec_t *fecp = (fec_t *) (info->iobase); |
| 160 | int j, rc; |
| 161 | u16 phyStatus; |
| 162 | |
| 163 | miiphy_read(dev->name, info->phy_addr, PHY_BMSR, &phyStatus); |
| 164 | |
| 165 | /* section 16.9.23.3 |
| 166 | * Wait for ready |
| 167 | */ |
| 168 | j = 0; |
| 169 | while ((info->txbd[info->txIdx].cbd_sc & BD_ENET_TX_READY) && |
| 170 | (j < MCFFEC_TOUT_LOOP)) { |
| 171 | udelay(1); |
| 172 | j++; |
| 173 | } |
| 174 | if (j >= MCFFEC_TOUT_LOOP) { |
| 175 | printf("TX not ready\n"); |
| 176 | } |
| 177 | |
| 178 | info->txbd[info->txIdx].cbd_bufaddr = (uint) packet; |
| 179 | info->txbd[info->txIdx].cbd_datlen = length; |
| 180 | info->txbd[info->txIdx].cbd_sc |= BD_ENET_TX_RDY_LST; |
| 181 | |
| 182 | /* Activate transmit Buffer Descriptor polling */ |
| 183 | fecp->tdar = 0x01000000; /* Descriptor polling active */ |
| 184 | |
| 185 | j = 0; |
| 186 | while ((info->txbd[info->txIdx].cbd_sc & BD_ENET_TX_READY) && |
| 187 | (j < MCFFEC_TOUT_LOOP)) { |
| 188 | udelay(1); |
| 189 | j++; |
| 190 | } |
| 191 | if (j >= MCFFEC_TOUT_LOOP) { |
| 192 | printf("TX timeout\n"); |
| 193 | } |
| 194 | #ifdef ET_DEBUG |
| 195 | printf("%s[%d] %s: cycles: %d status: %x retry cnt: %d\n", |
| 196 | __FILE__, __LINE__, __FUNCTION__, j, |
| 197 | info->txbd[info->txIdx].cbd_sc, |
| 198 | (info->txbd[info->txIdx].cbd_sc & 0x003C) >> 2); |
| 199 | #endif |
| 200 | |
| 201 | /* return only status bits */ ; |
| 202 | rc = (info->txbd[info->txIdx].cbd_sc & BD_ENET_TX_STATS); |
| 203 | info->txIdx = (info->txIdx + 1) % TX_BUF_CNT; |
| 204 | |
| 205 | return rc; |
| 206 | } |
| 207 | |
| 208 | int fec_recv(struct eth_device *dev) |
| 209 | { |
| 210 | struct fec_info_s *info = dev->priv; |
| 211 | volatile fec_t *fecp = (fec_t *) (info->iobase); |
| 212 | int length; |
| 213 | |
| 214 | for (;;) { |
| 215 | /* section 16.9.23.2 */ |
| 216 | if (info->rxbd[info->rxIdx].cbd_sc & BD_ENET_RX_EMPTY) { |
| 217 | length = -1; |
| 218 | break; /* nothing received - leave for() loop */ |
| 219 | } |
| 220 | |
| 221 | length = info->rxbd[info->rxIdx].cbd_datlen; |
| 222 | |
| 223 | if (info->rxbd[info->rxIdx].cbd_sc & 0x003f) { |
| 224 | printf("%s[%d] err: %x\n", |
| 225 | __FUNCTION__, __LINE__, |
| 226 | info->rxbd[info->rxIdx].cbd_sc); |
| 227 | #ifdef ET_DEBUG |
| 228 | printf("%s[%d] err: %x\n", |
| 229 | __FUNCTION__, __LINE__, |
| 230 | info->rxbd[info->rxIdx].cbd_sc); |
| 231 | #endif |
| 232 | } else { |
| 233 | |
| 234 | length -= 4; |
| 235 | /* Pass the packet up to the protocol layers. */ |
| 236 | NetReceive(NetRxPackets[info->rxIdx], length); |
| 237 | |
| 238 | fecp->eir |= FEC_EIR_RXF; |
| 239 | } |
| 240 | |
| 241 | /* Give the buffer back to the FEC. */ |
| 242 | info->rxbd[info->rxIdx].cbd_datlen = 0; |
| 243 | |
| 244 | /* wrap around buffer index when necessary */ |
| 245 | if (info->rxIdx == LAST_PKTBUFSRX) { |
| 246 | info->rxbd[PKTBUFSRX - 1].cbd_sc = BD_ENET_RX_W_E; |
| 247 | info->rxIdx = 0; |
| 248 | } else { |
| 249 | info->rxbd[info->rxIdx].cbd_sc = BD_ENET_RX_EMPTY; |
| 250 | info->rxIdx++; |
| 251 | } |
| 252 | |
| 253 | /* Try to fill Buffer Descriptors */ |
| 254 | fecp->rdar = 0x01000000; /* Descriptor polling active */ |
| 255 | } |
| 256 | |
| 257 | return length; |
| 258 | } |
| 259 | |
| 260 | /************************************************************** |
| 261 | * |
| 262 | * FEC Ethernet Initialization Routine |
| 263 | * |
| 264 | *************************************************************/ |
| 265 | |
| 266 | #ifdef ET_DEBUG |
| 267 | void dbgFecRegs(struct eth_device *dev) |
| 268 | { |
| 269 | struct fec_info_s *info = dev->priv; |
| 270 | volatile fec_t *fecp = (fec_t *) (info->iobase); |
| 271 | |
| 272 | printf("=====\n"); |
| 273 | printf("ievent %x - %x\n", (int)&fecp->eir, fecp->eir); |
| 274 | printf("imask %x - %x\n", (int)&fecp->eimr, fecp->eimr); |
| 275 | printf("r_des_active %x - %x\n", (int)&fecp->rdar, fecp->rdar); |
| 276 | printf("x_des_active %x - %x\n", (int)&fecp->tdar, fecp->tdar); |
| 277 | printf("ecntrl %x - %x\n", (int)&fecp->ecr, fecp->ecr); |
| 278 | printf("mii_mframe %x - %x\n", (int)&fecp->mmfr, fecp->mmfr); |
| 279 | printf("mii_speed %x - %x\n", (int)&fecp->mscr, fecp->mscr); |
| 280 | printf("mii_ctrlstat %x - %x\n", (int)&fecp->mibc, fecp->mibc); |
| 281 | printf("r_cntrl %x - %x\n", (int)&fecp->rcr, fecp->rcr); |
| 282 | printf("x_cntrl %x - %x\n", (int)&fecp->tcr, fecp->tcr); |
| 283 | printf("padr_l %x - %x\n", (int)&fecp->palr, fecp->palr); |
| 284 | printf("padr_u %x - %x\n", (int)&fecp->paur, fecp->paur); |
| 285 | printf("op_pause %x - %x\n", (int)&fecp->opd, fecp->opd); |
| 286 | printf("iadr_u %x - %x\n", (int)&fecp->iaur, fecp->iaur); |
| 287 | printf("iadr_l %x - %x\n", (int)&fecp->ialr, fecp->ialr); |
| 288 | printf("gadr_u %x - %x\n", (int)&fecp->gaur, fecp->gaur); |
| 289 | printf("gadr_l %x - %x\n", (int)&fecp->galr, fecp->galr); |
| 290 | printf("x_wmrk %x - %x\n", (int)&fecp->tfwr, fecp->tfwr); |
| 291 | printf("r_bound %x - %x\n", (int)&fecp->frbr, fecp->frbr); |
| 292 | printf("r_fstart %x - %x\n", (int)&fecp->frsr, fecp->frsr); |
| 293 | printf("r_drng %x - %x\n", (int)&fecp->erdsr, fecp->erdsr); |
| 294 | printf("x_drng %x - %x\n", (int)&fecp->etdsr, fecp->etdsr); |
| 295 | printf("r_bufsz %x - %x\n", (int)&fecp->emrbr, fecp->emrbr); |
| 296 | |
| 297 | printf("\n"); |
| 298 | printf("rmon_t_drop %x - %x\n", (int)&fecp->rmon_t_drop, |
| 299 | fecp->rmon_t_drop); |
| 300 | printf("rmon_t_packets %x - %x\n", (int)&fecp->rmon_t_packets, |
| 301 | fecp->rmon_t_packets); |
| 302 | printf("rmon_t_bc_pkt %x - %x\n", (int)&fecp->rmon_t_bc_pkt, |
| 303 | fecp->rmon_t_bc_pkt); |
| 304 | printf("rmon_t_mc_pkt %x - %x\n", (int)&fecp->rmon_t_mc_pkt, |
| 305 | fecp->rmon_t_mc_pkt); |
| 306 | printf("rmon_t_crc_align %x - %x\n", (int)&fecp->rmon_t_crc_align, |
| 307 | fecp->rmon_t_crc_align); |
| 308 | printf("rmon_t_undersize %x - %x\n", (int)&fecp->rmon_t_undersize, |
| 309 | fecp->rmon_t_undersize); |
| 310 | printf("rmon_t_oversize %x - %x\n", (int)&fecp->rmon_t_oversize, |
| 311 | fecp->rmon_t_oversize); |
| 312 | printf("rmon_t_frag %x - %x\n", (int)&fecp->rmon_t_frag, |
| 313 | fecp->rmon_t_frag); |
| 314 | printf("rmon_t_jab %x - %x\n", (int)&fecp->rmon_t_jab, |
| 315 | fecp->rmon_t_jab); |
| 316 | printf("rmon_t_col %x - %x\n", (int)&fecp->rmon_t_col, |
| 317 | fecp->rmon_t_col); |
| 318 | printf("rmon_t_p64 %x - %x\n", (int)&fecp->rmon_t_p64, |
| 319 | fecp->rmon_t_p64); |
| 320 | printf("rmon_t_p65to127 %x - %x\n", (int)&fecp->rmon_t_p65to127, |
| 321 | fecp->rmon_t_p65to127); |
| 322 | printf("rmon_t_p128to255 %x - %x\n", (int)&fecp->rmon_t_p128to255, |
| 323 | fecp->rmon_t_p128to255); |
| 324 | printf("rmon_t_p256to511 %x - %x\n", (int)&fecp->rmon_t_p256to511, |
| 325 | fecp->rmon_t_p256to511); |
| 326 | printf("rmon_t_p512to1023 %x - %x\n", (int)&fecp->rmon_t_p512to1023, |
| 327 | fecp->rmon_t_p512to1023); |
| 328 | printf("rmon_t_p1024to2047 %x - %x\n", (int)&fecp->rmon_t_p1024to2047, |
| 329 | fecp->rmon_t_p1024to2047); |
| 330 | printf("rmon_t_p_gte2048 %x - %x\n", (int)&fecp->rmon_t_p_gte2048, |
| 331 | fecp->rmon_t_p_gte2048); |
| 332 | printf("rmon_t_octets %x - %x\n", (int)&fecp->rmon_t_octets, |
| 333 | fecp->rmon_t_octets); |
| 334 | |
| 335 | printf("\n"); |
| 336 | printf("ieee_t_drop %x - %x\n", (int)&fecp->ieee_t_drop, |
| 337 | fecp->ieee_t_drop); |
| 338 | printf("ieee_t_frame_ok %x - %x\n", (int)&fecp->ieee_t_frame_ok, |
| 339 | fecp->ieee_t_frame_ok); |
| 340 | printf("ieee_t_1col %x - %x\n", (int)&fecp->ieee_t_1col, |
| 341 | fecp->ieee_t_1col); |
| 342 | printf("ieee_t_mcol %x - %x\n", (int)&fecp->ieee_t_mcol, |
| 343 | fecp->ieee_t_mcol); |
| 344 | printf("ieee_t_def %x - %x\n", (int)&fecp->ieee_t_def, |
| 345 | fecp->ieee_t_def); |
| 346 | printf("ieee_t_lcol %x - %x\n", (int)&fecp->ieee_t_lcol, |
| 347 | fecp->ieee_t_lcol); |
| 348 | printf("ieee_t_excol %x - %x\n", (int)&fecp->ieee_t_excol, |
| 349 | fecp->ieee_t_excol); |
| 350 | printf("ieee_t_macerr %x - %x\n", (int)&fecp->ieee_t_macerr, |
| 351 | fecp->ieee_t_macerr); |
| 352 | printf("ieee_t_cserr %x - %x\n", (int)&fecp->ieee_t_cserr, |
| 353 | fecp->ieee_t_cserr); |
| 354 | printf("ieee_t_sqe %x - %x\n", (int)&fecp->ieee_t_sqe, |
| 355 | fecp->ieee_t_sqe); |
| 356 | printf("ieee_t_fdxfc %x - %x\n", (int)&fecp->ieee_t_fdxfc, |
| 357 | fecp->ieee_t_fdxfc); |
| 358 | printf("ieee_t_octets_ok %x - %x\n", (int)&fecp->ieee_t_octets_ok, |
| 359 | fecp->ieee_t_octets_ok); |
| 360 | |
| 361 | printf("\n"); |
| 362 | printf("rmon_r_drop %x - %x\n", (int)&fecp->rmon_r_drop, |
| 363 | fecp->rmon_r_drop); |
| 364 | printf("rmon_r_packets %x - %x\n", (int)&fecp->rmon_r_packets, |
| 365 | fecp->rmon_r_packets); |
| 366 | printf("rmon_r_bc_pkt %x - %x\n", (int)&fecp->rmon_r_bc_pkt, |
| 367 | fecp->rmon_r_bc_pkt); |
| 368 | printf("rmon_r_mc_pkt %x - %x\n", (int)&fecp->rmon_r_mc_pkt, |
| 369 | fecp->rmon_r_mc_pkt); |
| 370 | printf("rmon_r_crc_align %x - %x\n", (int)&fecp->rmon_r_crc_align, |
| 371 | fecp->rmon_r_crc_align); |
| 372 | printf("rmon_r_undersize %x - %x\n", (int)&fecp->rmon_r_undersize, |
| 373 | fecp->rmon_r_undersize); |
| 374 | printf("rmon_r_oversize %x - %x\n", (int)&fecp->rmon_r_oversize, |
| 375 | fecp->rmon_r_oversize); |
| 376 | printf("rmon_r_frag %x - %x\n", (int)&fecp->rmon_r_frag, |
| 377 | fecp->rmon_r_frag); |
| 378 | printf("rmon_r_jab %x - %x\n", (int)&fecp->rmon_r_jab, |
| 379 | fecp->rmon_r_jab); |
| 380 | printf("rmon_r_p64 %x - %x\n", (int)&fecp->rmon_r_p64, |
| 381 | fecp->rmon_r_p64); |
| 382 | printf("rmon_r_p65to127 %x - %x\n", (int)&fecp->rmon_r_p65to127, |
| 383 | fecp->rmon_r_p65to127); |
| 384 | printf("rmon_r_p128to255 %x - %x\n", (int)&fecp->rmon_r_p128to255, |
| 385 | fecp->rmon_r_p128to255); |
| 386 | printf("rmon_r_p256to511 %x - %x\n", (int)&fecp->rmon_r_p256to511, |
| 387 | fecp->rmon_r_p256to511); |
| 388 | printf("rmon_r_p512to1023 %x - %x\n", (int)&fecp->rmon_r_p512to1023, |
| 389 | fecp->rmon_r_p512to1023); |
| 390 | printf("rmon_r_p1024to2047 %x - %x\n", (int)&fecp->rmon_r_p1024to2047, |
| 391 | fecp->rmon_r_p1024to2047); |
| 392 | printf("rmon_r_p_gte2048 %x - %x\n", (int)&fecp->rmon_r_p_gte2048, |
| 393 | fecp->rmon_r_p_gte2048); |
| 394 | printf("rmon_r_octets %x - %x\n", (int)&fecp->rmon_r_octets, |
| 395 | fecp->rmon_r_octets); |
| 396 | |
| 397 | printf("\n"); |
| 398 | printf("ieee_r_drop %x - %x\n", (int)&fecp->ieee_r_drop, |
| 399 | fecp->ieee_r_drop); |
| 400 | printf("ieee_r_frame_ok %x - %x\n", (int)&fecp->ieee_r_frame_ok, |
| 401 | fecp->ieee_r_frame_ok); |
| 402 | printf("ieee_r_crc %x - %x\n", (int)&fecp->ieee_r_crc, |
| 403 | fecp->ieee_r_crc); |
| 404 | printf("ieee_r_align %x - %x\n", (int)&fecp->ieee_r_align, |
| 405 | fecp->ieee_r_align); |
| 406 | printf("ieee_r_macerr %x - %x\n", (int)&fecp->ieee_r_macerr, |
| 407 | fecp->ieee_r_macerr); |
| 408 | printf("ieee_r_fdxfc %x - %x\n", (int)&fecp->ieee_r_fdxfc, |
| 409 | fecp->ieee_r_fdxfc); |
| 410 | printf("ieee_r_octets_ok %x - %x\n", (int)&fecp->ieee_r_octets_ok, |
| 411 | fecp->ieee_r_octets_ok); |
| 412 | |
| 413 | printf("\n\n\n"); |
| 414 | } |
| 415 | #endif |
| 416 | |
| 417 | int fec_init(struct eth_device *dev, bd_t * bd) |
| 418 | { |
| 419 | struct fec_info_s *info = dev->priv; |
| 420 | volatile fec_t *fecp = (fec_t *) (info->iobase); |
| 421 | int i; |
| 422 | u8 *ea; |
| 423 | |
| 424 | fecpin_setclear(dev, 1); |
| 425 | |
| 426 | fec_reset(dev); |
| 427 | |
| 428 | #if (CONFIG_COMMANDS & CFG_CMD_MII) || defined (CONFIG_MII) || \ |
| 429 | defined (CFG_DISCOVER_PHY) |
| 430 | |
| 431 | mii_init(); |
| 432 | |
| 433 | setFecDuplexSpeed(fecp, bd, info->dup_spd); |
| 434 | #else |
| 435 | #ifndef CFG_DISCOVER_PHY |
| 436 | setFecDuplexSpeed(fecp, bd, (FECDUPLEX << 16) | FECSPEED); |
| 437 | #endif /* ifndef CFG_DISCOVER_PHY */ |
| 438 | #endif /* CFG_CMD_MII || CONFIG_MII */ |
| 439 | |
| 440 | /* We use strictly polling mode only */ |
| 441 | fecp->eimr = 0; |
| 442 | |
| 443 | /* Clear any pending interrupt */ |
| 444 | fecp->eir = 0xffffffff; |
| 445 | |
| 446 | /* Set station address */ |
| 447 | if ((u32) fecp == CFG_FEC0_IOBASE) { |
| 448 | ea = &bd->bi_enetaddr[0]; |
| 449 | } else { |
| 450 | #ifdef CFG_FEC1_IOBASE |
| 451 | ea = &bd->bi_enet1addr[0]; |
| 452 | #endif |
| 453 | } |
| 454 | |
| 455 | fecp->palr = (ea[0] << 24) | (ea[1] << 16) | (ea[2] << 8) | (ea[3]); |
| 456 | fecp->paur = (ea[4] << 24) | (ea[5] << 16); |
| 457 | #ifdef ET_DEBUG |
| 458 | printf("Eth Addrs: %02x:%02x:%02x:%02x:%02x:%02x\n", |
| 459 | ea[0], ea[1], ea[2], ea[3], ea[4], ea[5]); |
| 460 | #endif |
| 461 | |
| 462 | /* Clear unicast address hash table */ |
| 463 | fecp->iaur = 0; |
| 464 | fecp->ialr = 0; |
| 465 | |
| 466 | /* Clear multicast address hash table */ |
| 467 | fecp->gaur = 0; |
| 468 | fecp->galr = 0; |
| 469 | |
| 470 | /* Set maximum receive buffer size. */ |
| 471 | fecp->emrbr = PKT_MAXBLR_SIZE; |
| 472 | |
| 473 | /* |
| 474 | * Setup Buffers and Buffer Desriptors |
| 475 | */ |
| 476 | info->rxIdx = 0; |
| 477 | info->txIdx = 0; |
| 478 | |
| 479 | /* |
| 480 | * Setup Receiver Buffer Descriptors (13.14.24.18) |
| 481 | * Settings: |
| 482 | * Empty, Wrap |
| 483 | */ |
| 484 | for (i = 0; i < PKTBUFSRX; i++) { |
| 485 | info->rxbd[i].cbd_sc = BD_ENET_RX_EMPTY; |
| 486 | info->rxbd[i].cbd_datlen = 0; /* Reset */ |
| 487 | info->rxbd[i].cbd_bufaddr = (uint) NetRxPackets[i]; |
| 488 | } |
| 489 | info->rxbd[PKTBUFSRX - 1].cbd_sc |= BD_ENET_RX_WRAP; |
| 490 | |
| 491 | /* |
| 492 | * Setup Ethernet Transmitter Buffer Descriptors (13.14.24.19) |
| 493 | * Settings: |
| 494 | * Last, Tx CRC |
| 495 | */ |
| 496 | for (i = 0; i < TX_BUF_CNT; i++) { |
| 497 | info->txbd[i].cbd_sc = BD_ENET_TX_LAST | BD_ENET_TX_TC; |
| 498 | info->txbd[i].cbd_datlen = 0; /* Reset */ |
| 499 | info->txbd[i].cbd_bufaddr = (uint) (&info->txbuf[0]); |
| 500 | } |
| 501 | info->txbd[TX_BUF_CNT - 1].cbd_sc |= BD_ENET_TX_WRAP; |
| 502 | |
| 503 | /* Set receive and transmit descriptor base */ |
| 504 | fecp->erdsr = (unsigned int)(&info->rxbd[0]); |
| 505 | fecp->etdsr = (unsigned int)(&info->txbd[0]); |
| 506 | |
| 507 | /* Now enable the transmit and receive processing */ |
| 508 | fecp->ecr |= FEC_ECR_ETHER_EN; |
| 509 | |
| 510 | /* And last, try to fill Rx Buffer Descriptors */ |
| 511 | fecp->rdar = 0x01000000; /* Descriptor polling active */ |
| 512 | |
| 513 | return 1; |
| 514 | } |
| 515 | |
| 516 | void fec_reset(struct eth_device *dev) |
| 517 | { |
| 518 | struct fec_info_s *info = dev->priv; |
| 519 | volatile fec_t *fecp = (fec_t *) (info->iobase); |
| 520 | int i; |
| 521 | |
| 522 | fecp->ecr = FEC_ECR_RESET; |
| 523 | for (i = 0; (fecp->ecr & FEC_ECR_RESET) && (i < FEC_RESET_DELAY); ++i) { |
| 524 | udelay(1); |
| 525 | } |
| 526 | if (i == FEC_RESET_DELAY) { |
| 527 | printf("FEC_RESET_DELAY timeout\n"); |
| 528 | } |
| 529 | } |
| 530 | |
| 531 | void fec_halt(struct eth_device *dev) |
| 532 | { |
| 533 | struct fec_info_s *info = dev->priv; |
| 534 | |
| 535 | fec_reset(dev); |
| 536 | |
| 537 | fecpin_setclear(dev, 0); |
| 538 | |
| 539 | info->rxIdx = info->txIdx = 0; |
| 540 | memset(info->rxbd, 0, PKTBUFSRX * sizeof(cbd_t)); |
| 541 | memset(info->txbd, 0, TX_BUF_CNT * sizeof(cbd_t)); |
| 542 | memset(info->txbuf, 0, DBUF_LENGTH); |
| 543 | } |
| 544 | |
| 545 | int mcffec_initialize(bd_t * bis) |
| 546 | { |
| 547 | struct eth_device *dev; |
| 548 | int i; |
| 549 | |
| 550 | for (i = 0; i < sizeof(fec_info) / sizeof(fec_info[0]); i++) { |
| 551 | |
| 552 | dev = (struct eth_device *)malloc(sizeof *dev); |
| 553 | if (dev == NULL) |
| 554 | hang(); |
| 555 | |
| 556 | memset(dev, 0, sizeof(*dev)); |
| 557 | |
| 558 | sprintf(dev->name, "FEC%d", fec_info[i].index); |
| 559 | |
| 560 | dev->priv = &fec_info[i]; |
| 561 | dev->init = fec_init; |
| 562 | dev->halt = fec_halt; |
| 563 | dev->send = fec_send; |
| 564 | dev->recv = fec_recv; |
| 565 | |
| 566 | /* setup Receive and Transmit buffer descriptor */ |
| 567 | fec_info[i].rxbd = |
| 568 | (cbd_t *) memalign(32, (PKTBUFSRX * sizeof(cbd_t) + 31)); |
| 569 | fec_info[i].txbd = |
| 570 | (cbd_t *) memalign(32, (TX_BUF_CNT * sizeof(cbd_t) + 31)); |
| 571 | fec_info[i].txbuf = (char *)memalign(32, DBUF_LENGTH + 31); |
| 572 | #ifdef ET_DEBUG |
| 573 | printf("rxbd %x txbd %x\n", |
| 574 | (int)fec_info[i].rxbd, (int)fec_info[i].txbd); |
| 575 | #endif |
| 576 | |
| 577 | fec_info[i].phy_name = (char *)malloc(32); |
| 578 | |
| 579 | eth_register(dev); |
| 580 | |
| 581 | #if defined(CONFIG_MII) || (CONFIG_COMMANDS & CFG_CMD_MII) |
| 582 | miiphy_register(dev->name, |
| 583 | mcffec_miiphy_read, mcffec_miiphy_write); |
| 584 | #endif |
| 585 | } |
| 586 | |
| 587 | /* default speed */ |
| 588 | bis->bi_ethspeed = 10; |
| 589 | |
| 590 | return 1; |
| 591 | } |
| 592 | |
| 593 | #endif /* CFG_CMD_NET, FEC_ENET & NET_MULTI */ |
| 594 | #endif /* CONFIG_MCFFEC */ |