| // SPDX-License-Identifier: GPL-2.0+ | |
| /* | |
| * (C) Copyright 2000-2004 | |
| * Wolfgang Denk, DENX Software Engineering, wd@denx.de. | |
| * | |
| * (C) Copyright 2007 Freescale Semiconductor, Inc. | |
| * TsiChung Liew (Tsi-Chung.Liew@freescale.com) | |
| * | |
| * Conversion to DM | |
| * (C) 2019 Angelo Dureghello <angelo.dureghello@timesys.com> | |
| */ | |
| #include <config.h> | |
| #include <cpu_func.h> | |
| #include <env.h> | |
| #include <hang.h> | |
| #include <malloc.h> | |
| #include <command.h> | |
| #include <net.h> | |
| #include <miiphy.h> | |
| #include <asm/fec.h> | |
| #include <asm/global_data.h> | |
| #include <asm/immap.h> | |
| #include <linux/delay.h> | |
| #include <linux/mii.h> | |
| #undef ET_DEBUG | |
| #undef MII_DEBUG | |
| /* Ethernet Transmit and Receive Buffers */ | |
| #define DBUF_LENGTH 1520 | |
| #define TX_BUF_CNT 2 | |
| #define PKT_MAXBUF_SIZE 1518 | |
| #define PKT_MAXBLR_SIZE 1520 | |
| #define LAST_PKTBUFSRX PKTBUFSRX - 1 | |
| #define BD_ENET_RX_W_E (BD_ENET_RX_WRAP | BD_ENET_RX_EMPTY) | |
| #define BD_ENET_TX_RDY_LST (BD_ENET_TX_READY | BD_ENET_TX_LAST) | |
| DECLARE_GLOBAL_DATA_PTR; | |
| static void init_eth_info(struct fec_info_s *info) | |
| { | |
| #ifdef CFG_SYS_FEC_BUF_USE_SRAM | |
| static u32 tmp; | |
| if (info->index == 0) | |
| tmp = CFG_SYS_INIT_RAM_ADDR + 0x1000; | |
| else | |
| info->rxbd = (cbd_t *)DBUF_LENGTH; | |
| /* setup Receive and Transmit buffer descriptor */ | |
| info->rxbd = (cbd_t *)((u32)info->rxbd + tmp); | |
| tmp = (u32)info->rxbd; | |
| info->txbd = | |
| (cbd_t *)((u32)info->txbd + tmp + | |
| (PKTBUFSRX * sizeof(cbd_t))); | |
| tmp = (u32)info->txbd; | |
| info->txbuf = | |
| (char *)((u32)info->txbuf + tmp + | |
| (CFG_SYS_TX_ETH_BUFFER * sizeof(cbd_t))); | |
| tmp = (u32)info->txbuf; | |
| #else | |
| info->rxbd = | |
| (cbd_t *)memalign(CONFIG_SYS_CACHELINE_SIZE, | |
| (PKTBUFSRX * sizeof(cbd_t))); | |
| info->txbd = | |
| (cbd_t *)memalign(CONFIG_SYS_CACHELINE_SIZE, | |
| (TX_BUF_CNT * sizeof(cbd_t))); | |
| info->txbuf = | |
| (char *)memalign(CONFIG_SYS_CACHELINE_SIZE, DBUF_LENGTH); | |
| #endif | |
| #ifdef ET_DEBUG | |
| printf("rxbd %x txbd %x\n", (int)info->rxbd, (int)info->txbd); | |
| #endif | |
| info->phy_name = (char *)memalign(CONFIG_SYS_CACHELINE_SIZE, 32); | |
| } | |
| static void fec_reset(struct fec_info_s *info) | |
| { | |
| volatile fec_t *fecp = (fec_t *)(info->iobase); | |
| int i; | |
| fecp->ecr = FEC_ECR_RESET; | |
| for (i = 0; (fecp->ecr & FEC_ECR_RESET) && (i < FEC_RESET_DELAY); ++i) | |
| udelay(1); | |
| if (i == FEC_RESET_DELAY) | |
| printf("FEC_RESET_DELAY timeout\n"); | |
| } | |
| static void set_fec_duplex_speed(volatile fec_t *fecp, int dup_spd) | |
| { | |
| struct bd_info *bd = gd->bd; | |
| if ((dup_spd >> 16) == FULL) { | |
| /* Set maximum frame length */ | |
| fecp->rcr = FEC_RCR_MAX_FL(PKT_MAXBUF_SIZE) | FEC_RCR_MII_MODE | | |
| FEC_RCR_PROM | 0x100; | |
| fecp->tcr = FEC_TCR_FDEN; | |
| } else { | |
| /* Half duplex mode */ | |
| fecp->rcr = FEC_RCR_MAX_FL(PKT_MAXBUF_SIZE) | | |
| FEC_RCR_MII_MODE | FEC_RCR_DRT; | |
| fecp->tcr &= ~FEC_TCR_FDEN; | |
| } | |
| if ((dup_spd & 0xFFFF) == _100BASET) { | |
| #ifdef MII_DEBUG | |
| printf("100Mbps\n"); | |
| #endif | |
| bd->bi_ethspeed = 100; | |
| } else { | |
| #ifdef MII_DEBUG | |
| printf("10Mbps\n"); | |
| #endif | |
| bd->bi_ethspeed = 10; | |
| } | |
| } | |
| #ifdef ET_DEBUG | |
| static void dbg_fec_regs(struct udevice *dev) | |
| { | |
| struct fec_info_s *info = dev_get_priv(dev); | |
| volatile fec_t *fecp = (fec_t *)(info->iobase); | |
| printf("=====\n"); | |
| printf("ievent %x - %x\n", (int)&fecp->eir, fecp->eir); | |
| printf("imask %x - %x\n", (int)&fecp->eimr, fecp->eimr); | |
| printf("r_des_active %x - %x\n", (int)&fecp->rdar, fecp->rdar); | |
| printf("x_des_active %x - %x\n", (int)&fecp->tdar, fecp->tdar); | |
| printf("ecntrl %x - %x\n", (int)&fecp->ecr, fecp->ecr); | |
| printf("mii_mframe %x - %x\n", (int)&fecp->mmfr, fecp->mmfr); | |
| printf("mii_speed %x - %x\n", (int)&fecp->mscr, fecp->mscr); | |
| printf("mii_ctrlstat %x - %x\n", (int)&fecp->mibc, fecp->mibc); | |
| printf("r_cntrl %x - %x\n", (int)&fecp->rcr, fecp->rcr); | |
| printf("x_cntrl %x - %x\n", (int)&fecp->tcr, fecp->tcr); | |
| printf("padr_l %x - %x\n", (int)&fecp->palr, fecp->palr); | |
| printf("padr_u %x - %x\n", (int)&fecp->paur, fecp->paur); | |
| printf("op_pause %x - %x\n", (int)&fecp->opd, fecp->opd); | |
| printf("iadr_u %x - %x\n", (int)&fecp->iaur, fecp->iaur); | |
| printf("iadr_l %x - %x\n", (int)&fecp->ialr, fecp->ialr); | |
| printf("gadr_u %x - %x\n", (int)&fecp->gaur, fecp->gaur); | |
| printf("gadr_l %x - %x\n", (int)&fecp->galr, fecp->galr); | |
| printf("x_wmrk %x - %x\n", (int)&fecp->tfwr, fecp->tfwr); | |
| printf("r_bound %x - %x\n", (int)&fecp->frbr, fecp->frbr); | |
| printf("r_fstart %x - %x\n", (int)&fecp->frsr, fecp->frsr); | |
| printf("r_drng %x - %x\n", (int)&fecp->erdsr, fecp->erdsr); | |
| printf("x_drng %x - %x\n", (int)&fecp->etdsr, fecp->etdsr); | |
| printf("r_bufsz %x - %x\n", (int)&fecp->emrbr, fecp->emrbr); | |
| printf("\n"); | |
| printf("rmon_t_drop %x - %x\n", (int)&fecp->rmon_t_drop, | |
| fecp->rmon_t_drop); | |
| printf("rmon_t_packets %x - %x\n", (int)&fecp->rmon_t_packets, | |
| fecp->rmon_t_packets); | |
| printf("rmon_t_bc_pkt %x - %x\n", (int)&fecp->rmon_t_bc_pkt, | |
| fecp->rmon_t_bc_pkt); | |
| printf("rmon_t_mc_pkt %x - %x\n", (int)&fecp->rmon_t_mc_pkt, | |
| fecp->rmon_t_mc_pkt); | |
| printf("rmon_t_crc_align %x - %x\n", (int)&fecp->rmon_t_crc_align, | |
| fecp->rmon_t_crc_align); | |
| printf("rmon_t_undersize %x - %x\n", (int)&fecp->rmon_t_undersize, | |
| fecp->rmon_t_undersize); | |
| printf("rmon_t_oversize %x - %x\n", (int)&fecp->rmon_t_oversize, | |
| fecp->rmon_t_oversize); | |
| printf("rmon_t_frag %x - %x\n", (int)&fecp->rmon_t_frag, | |
| fecp->rmon_t_frag); | |
| printf("rmon_t_jab %x - %x\n", (int)&fecp->rmon_t_jab, | |
| fecp->rmon_t_jab); | |
| printf("rmon_t_col %x - %x\n", (int)&fecp->rmon_t_col, | |
| fecp->rmon_t_col); | |
| printf("rmon_t_p64 %x - %x\n", (int)&fecp->rmon_t_p64, | |
| fecp->rmon_t_p64); | |
| printf("rmon_t_p65to127 %x - %x\n", (int)&fecp->rmon_t_p65to127, | |
| fecp->rmon_t_p65to127); | |
| printf("rmon_t_p128to255 %x - %x\n", (int)&fecp->rmon_t_p128to255, | |
| fecp->rmon_t_p128to255); | |
| printf("rmon_t_p256to511 %x - %x\n", (int)&fecp->rmon_t_p256to511, | |
| fecp->rmon_t_p256to511); | |
| printf("rmon_t_p512to1023 %x - %x\n", (int)&fecp->rmon_t_p512to1023, | |
| fecp->rmon_t_p512to1023); | |
| printf("rmon_t_p1024to2047 %x - %x\n", (int)&fecp->rmon_t_p1024to2047, | |
| fecp->rmon_t_p1024to2047); | |
| printf("rmon_t_p_gte2048 %x - %x\n", (int)&fecp->rmon_t_p_gte2048, | |
| fecp->rmon_t_p_gte2048); | |
| printf("rmon_t_octets %x - %x\n", (int)&fecp->rmon_t_octets, | |
| fecp->rmon_t_octets); | |
| printf("\n"); | |
| printf("ieee_t_drop %x - %x\n", (int)&fecp->ieee_t_drop, | |
| fecp->ieee_t_drop); | |
| printf("ieee_t_frame_ok %x - %x\n", (int)&fecp->ieee_t_frame_ok, | |
| fecp->ieee_t_frame_ok); | |
| printf("ieee_t_1col %x - %x\n", (int)&fecp->ieee_t_1col, | |
| fecp->ieee_t_1col); | |
| printf("ieee_t_mcol %x - %x\n", (int)&fecp->ieee_t_mcol, | |
| fecp->ieee_t_mcol); | |
| printf("ieee_t_def %x - %x\n", (int)&fecp->ieee_t_def, | |
| fecp->ieee_t_def); | |
| printf("ieee_t_lcol %x - %x\n", (int)&fecp->ieee_t_lcol, | |
| fecp->ieee_t_lcol); | |
| printf("ieee_t_excol %x - %x\n", (int)&fecp->ieee_t_excol, | |
| fecp->ieee_t_excol); | |
| printf("ieee_t_macerr %x - %x\n", (int)&fecp->ieee_t_macerr, | |
| fecp->ieee_t_macerr); | |
| printf("ieee_t_cserr %x - %x\n", (int)&fecp->ieee_t_cserr, | |
| fecp->ieee_t_cserr); | |
| printf("ieee_t_sqe %x - %x\n", (int)&fecp->ieee_t_sqe, | |
| fecp->ieee_t_sqe); | |
| printf("ieee_t_fdxfc %x - %x\n", (int)&fecp->ieee_t_fdxfc, | |
| fecp->ieee_t_fdxfc); | |
| printf("ieee_t_octets_ok %x - %x\n", (int)&fecp->ieee_t_octets_ok, | |
| fecp->ieee_t_octets_ok); | |
| printf("\n"); | |
| printf("rmon_r_drop %x - %x\n", (int)&fecp->rmon_r_drop, | |
| fecp->rmon_r_drop); | |
| printf("rmon_r_packets %x - %x\n", (int)&fecp->rmon_r_packets, | |
| fecp->rmon_r_packets); | |
| printf("rmon_r_bc_pkt %x - %x\n", (int)&fecp->rmon_r_bc_pkt, | |
| fecp->rmon_r_bc_pkt); | |
| printf("rmon_r_mc_pkt %x - %x\n", (int)&fecp->rmon_r_mc_pkt, | |
| fecp->rmon_r_mc_pkt); | |
| printf("rmon_r_crc_align %x - %x\n", (int)&fecp->rmon_r_crc_align, | |
| fecp->rmon_r_crc_align); | |
| printf("rmon_r_undersize %x - %x\n", (int)&fecp->rmon_r_undersize, | |
| fecp->rmon_r_undersize); | |
| printf("rmon_r_oversize %x - %x\n", (int)&fecp->rmon_r_oversize, | |
| fecp->rmon_r_oversize); | |
| printf("rmon_r_frag %x - %x\n", (int)&fecp->rmon_r_frag, | |
| fecp->rmon_r_frag); | |
| printf("rmon_r_jab %x - %x\n", (int)&fecp->rmon_r_jab, | |
| fecp->rmon_r_jab); | |
| printf("rmon_r_p64 %x - %x\n", (int)&fecp->rmon_r_p64, | |
| fecp->rmon_r_p64); | |
| printf("rmon_r_p65to127 %x - %x\n", (int)&fecp->rmon_r_p65to127, | |
| fecp->rmon_r_p65to127); | |
| printf("rmon_r_p128to255 %x - %x\n", (int)&fecp->rmon_r_p128to255, | |
| fecp->rmon_r_p128to255); | |
| printf("rmon_r_p256to511 %x - %x\n", (int)&fecp->rmon_r_p256to511, | |
| fecp->rmon_r_p256to511); | |
| printf("rmon_r_p512to1023 %x - %x\n", (int)&fecp->rmon_r_p512to1023, | |
| fecp->rmon_r_p512to1023); | |
| printf("rmon_r_p1024to2047 %x - %x\n", (int)&fecp->rmon_r_p1024to2047, | |
| fecp->rmon_r_p1024to2047); | |
| printf("rmon_r_p_gte2048 %x - %x\n", (int)&fecp->rmon_r_p_gte2048, | |
| fecp->rmon_r_p_gte2048); | |
| printf("rmon_r_octets %x - %x\n", (int)&fecp->rmon_r_octets, | |
| fecp->rmon_r_octets); | |
| printf("\n"); | |
| printf("ieee_r_drop %x - %x\n", (int)&fecp->ieee_r_drop, | |
| fecp->ieee_r_drop); | |
| printf("ieee_r_frame_ok %x - %x\n", (int)&fecp->ieee_r_frame_ok, | |
| fecp->ieee_r_frame_ok); | |
| printf("ieee_r_crc %x - %x\n", (int)&fecp->ieee_r_crc, | |
| fecp->ieee_r_crc); | |
| printf("ieee_r_align %x - %x\n", (int)&fecp->ieee_r_align, | |
| fecp->ieee_r_align); | |
| printf("ieee_r_macerr %x - %x\n", (int)&fecp->ieee_r_macerr, | |
| fecp->ieee_r_macerr); | |
| printf("ieee_r_fdxfc %x - %x\n", (int)&fecp->ieee_r_fdxfc, | |
| fecp->ieee_r_fdxfc); | |
| printf("ieee_r_octets_ok %x - %x\n", (int)&fecp->ieee_r_octets_ok, | |
| fecp->ieee_r_octets_ok); | |
| printf("\n\n\n"); | |
| } | |
| #endif | |
| int mcffec_init(struct udevice *dev) | |
| { | |
| struct fec_info_s *info = dev_get_priv(dev); | |
| volatile fec_t *fecp = (fec_t *) (info->iobase); | |
| int rval, i; | |
| uchar ea[6]; | |
| fecpin_setclear(info, 1); | |
| fec_reset(info); | |
| mii_init(); | |
| set_fec_duplex_speed(fecp, info->dup_spd); | |
| /* We use strictly polling mode only */ | |
| fecp->eimr = 0; | |
| /* Clear any pending interrupt */ | |
| fecp->eir = 0xffffffff; | |
| /* Set station address */ | |
| if (info->index == 0) | |
| rval = eth_env_get_enetaddr("ethaddr", ea); | |
| else | |
| rval = eth_env_get_enetaddr("eth1addr", ea); | |
| if (!rval) { | |
| puts("Please set a valid MAC address\n"); | |
| return -EINVAL; | |
| } | |
| fecp->palr = | |
| (ea[0] << 24) | (ea[1] << 16) | (ea[2] << 8) | (ea[3]); | |
| fecp->paur = (ea[4] << 24) | (ea[5] << 16); | |
| /* Clear unicast address hash table */ | |
| fecp->iaur = 0; | |
| fecp->ialr = 0; | |
| /* Clear multicast address hash table */ | |
| fecp->gaur = 0; | |
| fecp->galr = 0; | |
| /* Set maximum receive buffer size. */ | |
| fecp->emrbr = PKT_MAXBLR_SIZE; | |
| /* | |
| * Setup Buffers and Buffer Descriptors | |
| */ | |
| info->rx_idx = 0; | |
| info->tx_idx = 0; | |
| /* | |
| * Setup Receiver Buffer Descriptors (13.14.24.18) | |
| * Settings: | |
| * Empty, Wrap | |
| */ | |
| for (i = 0; i < PKTBUFSRX; i++) { | |
| info->rxbd[i].cbd_sc = BD_ENET_RX_EMPTY; | |
| info->rxbd[i].cbd_datlen = 0; /* Reset */ | |
| info->rxbd[i].cbd_bufaddr = (uint) net_rx_packets[i]; | |
| } | |
| info->rxbd[PKTBUFSRX - 1].cbd_sc |= BD_ENET_RX_WRAP; | |
| /* | |
| * Setup Ethernet Transmitter Buffer Descriptors (13.14.24.19) | |
| * Settings: | |
| * Last, Tx CRC | |
| */ | |
| for (i = 0; i < TX_BUF_CNT; i++) { | |
| info->txbd[i].cbd_sc = BD_ENET_TX_LAST | BD_ENET_TX_TC; | |
| info->txbd[i].cbd_datlen = 0; /* Reset */ | |
| info->txbd[i].cbd_bufaddr = (uint) (&info->txbuf[0]); | |
| } | |
| info->txbd[TX_BUF_CNT - 1].cbd_sc |= BD_ENET_TX_WRAP; | |
| /* Set receive and transmit descriptor base */ | |
| fecp->erdsr = (unsigned int)(&info->rxbd[0]); | |
| fecp->etdsr = (unsigned int)(&info->txbd[0]); | |
| /* Now enable the transmit and receive processing */ | |
| fecp->ecr |= FEC_ECR_ETHER_EN; | |
| /* And last, try to fill Rx Buffer Descriptors | |
| * Descriptor polling active | |
| */ | |
| fecp->rdar = 0x01000000; | |
| return 0; | |
| } | |
| static int mcffec_send(struct udevice *dev, void *packet, int length) | |
| { | |
| struct fec_info_s *info = dev_get_priv(dev); | |
| volatile fec_t *fecp = (fec_t *)info->iobase; | |
| int j, rc; | |
| u16 phy_status; | |
| miiphy_read(dev->name, info->phy_addr, MII_BMSR, &phy_status); | |
| /* section 16.9.23.3 | |
| * Wait for ready | |
| */ | |
| j = 0; | |
| while ((info->txbd[info->tx_idx].cbd_sc & BD_ENET_TX_READY) && | |
| (j < info->to_loop)) { | |
| udelay(1); | |
| j++; | |
| } | |
| if (j >= info->to_loop) | |
| printf("TX not ready\n"); | |
| info->txbd[info->tx_idx].cbd_bufaddr = (uint)packet; | |
| info->txbd[info->tx_idx].cbd_datlen = length; | |
| info->txbd[info->tx_idx].cbd_sc |= BD_ENET_TX_RDY_LST; | |
| /* Activate transmit Buffer Descriptor polling */ | |
| fecp->tdar = 0x01000000; /* Descriptor polling active */ | |
| #ifndef CFG_SYS_FEC_BUF_USE_SRAM | |
| /* | |
| * FEC unable to initial transmit data packet. | |
| * A nop will ensure the descriptor polling active completed. | |
| * CF Internal RAM has shorter cycle access than DRAM. If use | |
| * DRAM as Buffer descriptor and data, a nop is a must. | |
| * Affect only V2 and V3. | |
| */ | |
| __asm__ ("nop"); | |
| #endif | |
| #ifdef CONFIG_SYS_UNIFY_CACHE | |
| invalidate_icache_all(); | |
| #endif | |
| j = 0; | |
| while ((info->txbd[info->tx_idx].cbd_sc & BD_ENET_TX_READY) && | |
| (j < info->to_loop)) { | |
| udelay(1); | |
| j++; | |
| } | |
| if (j >= info->to_loop) | |
| printf("TX timeout\n"); | |
| #ifdef ET_DEBUG | |
| printf("%s[%d] %s: cycles: %d status: %x retry cnt: %d\n", | |
| __FILE__, __LINE__, __func__, j, | |
| info->txbd[info->tx_idx].cbd_sc, | |
| (info->txbd[info->tx_idx].cbd_sc & 0x003C) >> 2); | |
| #endif | |
| /* return only status bits */ | |
| rc = (info->txbd[info->tx_idx].cbd_sc & BD_ENET_TX_STATS); | |
| info->tx_idx = (info->tx_idx + 1) % TX_BUF_CNT; | |
| return rc; | |
| } | |
| static int mcffec_recv(struct udevice *dev, int flags, uchar **packetp) | |
| { | |
| struct fec_info_s *info = dev_get_priv(dev); | |
| volatile fec_t *fecp = (fec_t *)info->iobase; | |
| int length = -1; | |
| for (;;) { | |
| #ifdef CONFIG_SYS_UNIFY_CACHE | |
| invalidate_icache_all(); | |
| #endif | |
| /* If nothing received - leave for() loop */ | |
| if (info->rxbd[info->rx_idx].cbd_sc & BD_ENET_RX_EMPTY) | |
| break; | |
| length = info->rxbd[info->rx_idx].cbd_datlen; | |
| if (info->rxbd[info->rx_idx].cbd_sc & 0x003f) { | |
| printf("%s[%d] err: %x\n", | |
| __func__, __LINE__, | |
| info->rxbd[info->rx_idx].cbd_sc); | |
| } else { | |
| length -= 4; | |
| /* | |
| * Pass the buffer ptr up to the protocol layers. | |
| */ | |
| *packetp = net_rx_packets[info->rx_idx]; | |
| fecp->eir |= FEC_EIR_RXF; | |
| } | |
| /* Give the buffer back to the FEC. */ | |
| info->rxbd[info->rx_idx].cbd_datlen = 0; | |
| /* wrap around buffer index when necessary */ | |
| if (info->rx_idx == LAST_PKTBUFSRX) { | |
| info->rxbd[PKTBUFSRX - 1].cbd_sc = BD_ENET_RX_W_E; | |
| info->rx_idx = 0; | |
| } else { | |
| info->rxbd[info->rx_idx].cbd_sc = BD_ENET_RX_EMPTY; | |
| info->rx_idx++; | |
| } | |
| /* Try to fill Buffer Descriptors | |
| * Descriptor polling active | |
| */ | |
| fecp->rdar = 0x01000000; | |
| } | |
| return length; | |
| } | |
| static void mcffec_halt(struct udevice *dev) | |
| { | |
| struct fec_info_s *info = dev_get_priv(dev); | |
| fec_reset(info); | |
| fecpin_setclear(info, 0); | |
| info->rx_idx = 0; | |
| info->tx_idx = 0; | |
| memset(info->rxbd, 0, PKTBUFSRX * sizeof(cbd_t)); | |
| memset(info->txbd, 0, TX_BUF_CNT * sizeof(cbd_t)); | |
| memset(info->txbuf, 0, DBUF_LENGTH); | |
| } | |
| static const struct eth_ops mcffec_ops = { | |
| .start = mcffec_init, | |
| .send = mcffec_send, | |
| .recv = mcffec_recv, | |
| .stop = mcffec_halt, | |
| }; | |
| /* | |
| * Boot sequence, called just after mcffec_of_to_plat, | |
| * as DM way, it replaces old mcffec_initialize. | |
| */ | |
| static int mcffec_probe(struct udevice *dev) | |
| { | |
| struct eth_pdata *pdata = dev_get_plat(dev); | |
| struct fec_info_s *info = dev_get_priv(dev); | |
| int node = dev_of_offset(dev); | |
| int retval, fec_idx; | |
| const u32 *val; | |
| info->index = dev_seq(dev); | |
| info->iobase = pdata->iobase; | |
| info->phy_addr = -1; | |
| val = fdt_getprop(gd->fdt_blob, node, "mii-base", NULL); | |
| if (val) { | |
| u32 fec_iobase; | |
| fec_idx = fdt32_to_cpu(*val); | |
| if (fec_idx == info->index) { | |
| fec_iobase = info->iobase; | |
| } else { | |
| printf("mii base != base address, fec_idx %d\n", | |
| fec_idx); | |
| retval = fec_get_base_addr(fec_idx, &fec_iobase); | |
| if (retval) | |
| return retval; | |
| } | |
| info->miibase = fec_iobase; | |
| } | |
| val = fdt_getprop(gd->fdt_blob, node, "phy-addr", NULL); | |
| if (val) | |
| info->phy_addr = fdt32_to_cpu(*val); | |
| val = fdt_getprop(gd->fdt_blob, node, "timeout-loop", NULL); | |
| if (val) | |
| info->to_loop = fdt32_to_cpu(*val); | |
| init_eth_info(info); | |
| #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII) | |
| info->bus = mdio_alloc(); | |
| if (!info->bus) | |
| return -ENOMEM; | |
| strcpy(info->bus->name, dev->name); | |
| info->bus->read = mcffec_miiphy_read; | |
| info->bus->write = mcffec_miiphy_write; | |
| retval = mdio_register(info->bus); | |
| if (retval < 0) | |
| return retval; | |
| #endif | |
| return 0; | |
| } | |
| static int mcffec_remove(struct udevice *dev) | |
| { | |
| struct fec_info_s *priv = dev_get_priv(dev); | |
| mdio_unregister(priv->bus); | |
| mdio_free(priv->bus); | |
| return 0; | |
| } | |
| /* | |
| * Boot sequence, called 1st | |
| */ | |
| static int mcffec_of_to_plat(struct udevice *dev) | |
| { | |
| struct eth_pdata *pdata = dev_get_plat(dev); | |
| const u32 *val; | |
| pdata->iobase = dev_read_addr(dev); | |
| /* Default to 10Mbit/s */ | |
| pdata->max_speed = 10; | |
| val = fdt_getprop(gd->fdt_blob, dev_of_offset(dev), | |
| "max-speed", NULL); | |
| if (val) | |
| pdata->max_speed = fdt32_to_cpu(*val); | |
| return 0; | |
| } | |
| static const struct udevice_id mcffec_ids[] = { | |
| { .compatible = "fsl,mcf-fec" }, | |
| { } | |
| }; | |
| U_BOOT_DRIVER(mcffec) = { | |
| .name = "mcffec", | |
| .id = UCLASS_ETH, | |
| .of_match = mcffec_ids, | |
| .of_to_plat = mcffec_of_to_plat, | |
| .probe = mcffec_probe, | |
| .remove = mcffec_remove, | |
| .ops = &mcffec_ops, | |
| .priv_auto = sizeof(struct fec_info_s), | |
| .plat_auto = sizeof(struct eth_pdata), | |
| }; |