1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135 |
- // SPDX-License-Identifier: GPL-2.0+
- /*
- * Copyright 2009-2012 Freescale Semiconductor, Inc.
- * Copyright 2020 NXP
- * Dave Liu <daveliu@freescale.com>
- */
- #include <common.h>
- #include <part.h>
- #include <asm/io.h>
- #ifdef CONFIG_DM_ETH
- #include <dm.h>
- #include <dm/ofnode.h>
- #include <linux/compat.h>
- #include <phy_interface.h>
- #endif
- #include <malloc.h>
- #include <net.h>
- #include <hwconfig.h>
- #include <fm_eth.h>
- #include <fsl_mdio.h>
- #include <miiphy.h>
- #include <phy.h>
- #include <fsl_dtsec.h>
- #include <fsl_tgec.h>
- #include <fsl_memac.h>
- #include "fm.h"
- #ifndef CONFIG_DM_ETH
- static struct eth_device *devlist[NUM_FM_PORTS];
- static int num_controllers;
- #endif
- #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII) && !defined(BITBANGMII)
- #define TBIANA_SETTINGS (TBIANA_ASYMMETRIC_PAUSE | TBIANA_SYMMETRIC_PAUSE | \
- TBIANA_FULL_DUPLEX)
- #define TBIANA_SGMII_ACK 0x4001
- #define TBICR_SETTINGS (TBICR_ANEG_ENABLE | TBICR_RESTART_ANEG | \
- TBICR_FULL_DUPLEX | TBICR_SPEED1_SET)
- /* Configure the TBI for SGMII operation */
- static void dtsec_configure_serdes(struct fm_eth *priv)
- {
- #ifdef CONFIG_SYS_FMAN_V3
- u32 value;
- struct mii_dev bus;
- bool sgmii_2500 = (priv->enet_if ==
- PHY_INTERFACE_MODE_SGMII_2500) ? true : false;
- int i = 0, j;
- #ifndef CONFIG_DM_ETH
- bus.priv = priv->mac->phyregs;
- #else
- bus.priv = priv->pcs_mdio;
- #endif
- bus.read = memac_mdio_read;
- bus.write = memac_mdio_write;
- bus.reset = memac_mdio_reset;
- qsgmii_loop:
- /* SGMII IF mode + AN enable only for 1G SGMII, not for 2.5G */
- if (sgmii_2500)
- value = PHY_SGMII_CR_PHY_RESET |
- PHY_SGMII_IF_SPEED_GIGABIT |
- PHY_SGMII_IF_MODE_SGMII;
- else
- value = PHY_SGMII_IF_MODE_SGMII | PHY_SGMII_IF_MODE_AN;
- for (j = 0; j <= 3; j++)
- debug("dump PCS reg %#x: %#x\n", j,
- memac_mdio_read(&bus, i, MDIO_DEVAD_NONE, j));
- memac_mdio_write(&bus, i, MDIO_DEVAD_NONE, 0x14, value);
- /* Dev ability according to SGMII specification */
- value = PHY_SGMII_DEV_ABILITY_SGMII;
- memac_mdio_write(&bus, i, MDIO_DEVAD_NONE, 0x4, value);
- if (sgmii_2500) {
- /* Adjust link timer for 2.5G SGMII,
- * 1.6 ms in units of 3.2 ns:
- * 1.6ms / 3.2ns = 5 * 10^5 = 0x7a120.
- */
- memac_mdio_write(&bus, i, MDIO_DEVAD_NONE, 0x13, 0x0007);
- memac_mdio_write(&bus, i, MDIO_DEVAD_NONE, 0x12, 0xa120);
- } else {
- /* Adjust link timer for SGMII,
- * 1.6 ms in units of 8 ns:
- * 1.6ms / 8ns = 2 * 10^5 = 0x30d40.
- */
- memac_mdio_write(&bus, i, MDIO_DEVAD_NONE, 0x13, 0x0003);
- memac_mdio_write(&bus, i, MDIO_DEVAD_NONE, 0x12, 0x0d40);
- }
- /* Restart AN */
- value = PHY_SGMII_CR_DEF_VAL | PHY_SGMII_CR_RESET_AN;
- memac_mdio_write(&bus, i, MDIO_DEVAD_NONE, 0, value);
- if ((priv->enet_if == PHY_INTERFACE_MODE_QSGMII) && (i < 3)) {
- i++;
- goto qsgmii_loop;
- }
- #else
- struct dtsec *regs = priv->mac->base;
- struct tsec_mii_mng *phyregs = priv->mac->phyregs;
- /*
- * Access TBI PHY registers at given TSEC register offset as
- * opposed to the register offset used for external PHY accesses
- */
- tsec_local_mdio_write(phyregs, in_be32(®s->tbipa), 0, TBI_TBICON,
- TBICON_CLK_SELECT);
- tsec_local_mdio_write(phyregs, in_be32(®s->tbipa), 0, TBI_ANA,
- TBIANA_SGMII_ACK);
- tsec_local_mdio_write(phyregs, in_be32(®s->tbipa), 0,
- TBI_CR, TBICR_SETTINGS);
- #endif
- }
- static void dtsec_init_phy(struct fm_eth *fm_eth)
- {
- #ifndef CONFIG_SYS_FMAN_V3
- struct dtsec *regs = (struct dtsec *)CONFIG_SYS_FSL_FM1_DTSEC1_ADDR;
- /* Assign a Physical address to the TBI */
- out_be32(®s->tbipa, CONFIG_SYS_TBIPA_VALUE);
- #endif
- if (fm_eth->enet_if == PHY_INTERFACE_MODE_SGMII ||
- fm_eth->enet_if == PHY_INTERFACE_MODE_QSGMII ||
- fm_eth->enet_if == PHY_INTERFACE_MODE_SGMII_2500)
- dtsec_configure_serdes(fm_eth);
- }
- #ifndef CONFIG_DM_ETH
- #ifdef CONFIG_PHYLIB
- static int tgec_is_fibre(struct fm_eth *fm)
- {
- char phyopt[20];
- sprintf(phyopt, "fsl_fm%d_xaui_phy", fm->fm_index + 1);
- return hwconfig_arg_cmp(phyopt, "xfi");
- }
- #endif
- #endif /* CONFIG_DM_ETH */
- #endif
- static u16 muram_readw(u16 *addr)
- {
- ulong base = (ulong)addr & ~0x3UL;
- u32 val32 = in_be32((void *)base);
- int byte_pos;
- u16 ret;
- byte_pos = (ulong)addr & 0x3UL;
- if (byte_pos)
- ret = (u16)(val32 & 0x0000ffff);
- else
- ret = (u16)((val32 & 0xffff0000) >> 16);
- return ret;
- }
- static void muram_writew(u16 *addr, u16 val)
- {
- ulong base = (ulong)addr & ~0x3UL;
- u32 org32 = in_be32((void *)base);
- u32 val32;
- int byte_pos;
- byte_pos = (ulong)addr & 0x3UL;
- if (byte_pos)
- val32 = (org32 & 0xffff0000) | val;
- else
- val32 = (org32 & 0x0000ffff) | ((u32)val << 16);
- out_be32((void *)base, val32);
- }
- static void bmi_rx_port_disable(struct fm_bmi_rx_port *rx_port)
- {
- int timeout = 1000000;
- clrbits_be32(&rx_port->fmbm_rcfg, FMBM_RCFG_EN);
- /* wait until the rx port is not busy */
- while ((in_be32(&rx_port->fmbm_rst) & FMBM_RST_BSY) && timeout--)
- ;
- if (!timeout)
- printf("%s - timeout\n", __func__);
- }
- static void bmi_rx_port_init(struct fm_bmi_rx_port *rx_port)
- {
- /* set BMI to independent mode, Rx port disable */
- out_be32(&rx_port->fmbm_rcfg, FMBM_RCFG_IM);
- /* clear FOF in IM case */
- out_be32(&rx_port->fmbm_rim, 0);
- /* Rx frame next engine -RISC */
- out_be32(&rx_port->fmbm_rfne, NIA_ENG_RISC | NIA_RISC_AC_IM_RX);
- /* Rx command attribute - no order, MR[3] = 1 */
- clrbits_be32(&rx_port->fmbm_rfca, FMBM_RFCA_ORDER | FMBM_RFCA_MR_MASK);
- setbits_be32(&rx_port->fmbm_rfca, FMBM_RFCA_MR(4));
- /* enable Rx statistic counters */
- out_be32(&rx_port->fmbm_rstc, FMBM_RSTC_EN);
- /* disable Rx performance counters */
- out_be32(&rx_port->fmbm_rpc, 0);
- }
- static void bmi_tx_port_disable(struct fm_bmi_tx_port *tx_port)
- {
- int timeout = 1000000;
- clrbits_be32(&tx_port->fmbm_tcfg, FMBM_TCFG_EN);
- /* wait until the tx port is not busy */
- while ((in_be32(&tx_port->fmbm_tst) & FMBM_TST_BSY) && timeout--)
- ;
- if (!timeout)
- printf("%s - timeout\n", __func__);
- }
- static void bmi_tx_port_init(struct fm_bmi_tx_port *tx_port)
- {
- /* set BMI to independent mode, Tx port disable */
- out_be32(&tx_port->fmbm_tcfg, FMBM_TCFG_IM);
- /* Tx frame next engine -RISC */
- out_be32(&tx_port->fmbm_tfne, NIA_ENG_RISC | NIA_RISC_AC_IM_TX);
- out_be32(&tx_port->fmbm_tfene, NIA_ENG_RISC | NIA_RISC_AC_IM_TX);
- /* Tx command attribute - no order, MR[3] = 1 */
- clrbits_be32(&tx_port->fmbm_tfca, FMBM_TFCA_ORDER | FMBM_TFCA_MR_MASK);
- setbits_be32(&tx_port->fmbm_tfca, FMBM_TFCA_MR(4));
- /* enable Tx statistic counters */
- out_be32(&tx_port->fmbm_tstc, FMBM_TSTC_EN);
- /* disable Tx performance counters */
- out_be32(&tx_port->fmbm_tpc, 0);
- }
- static int fm_eth_rx_port_parameter_init(struct fm_eth *fm_eth)
- {
- struct fm_port_global_pram *pram;
- u32 pram_page_offset;
- void *rx_bd_ring_base;
- void *rx_buf_pool;
- u32 bd_ring_base_lo, bd_ring_base_hi;
- u32 buf_lo, buf_hi;
- struct fm_port_bd *rxbd;
- struct fm_port_qd *rxqd;
- struct fm_bmi_rx_port *bmi_rx_port = fm_eth->rx_port;
- int i;
- /* alloc global parameter ram at MURAM */
- pram = (struct fm_port_global_pram *)fm_muram_alloc(fm_eth->fm_index,
- FM_PRAM_SIZE, FM_PRAM_ALIGN);
- if (!pram) {
- printf("%s: No muram for Rx global parameter\n", __func__);
- return -ENOMEM;
- }
- fm_eth->rx_pram = pram;
- /* parameter page offset to MURAM */
- pram_page_offset = (void *)pram - fm_muram_base(fm_eth->fm_index);
- /* enable global mode- snooping data buffers and BDs */
- out_be32(&pram->mode, PRAM_MODE_GLOBAL);
- /* init the Rx queue descriptor pionter */
- out_be32(&pram->rxqd_ptr, pram_page_offset + 0x20);
- /* set the max receive buffer length, power of 2 */
- muram_writew(&pram->mrblr, MAX_RXBUF_LOG2);
- /* alloc Rx buffer descriptors from main memory */
- rx_bd_ring_base = malloc(sizeof(struct fm_port_bd)
- * RX_BD_RING_SIZE);
- if (!rx_bd_ring_base)
- return -ENOMEM;
- memset(rx_bd_ring_base, 0, sizeof(struct fm_port_bd)
- * RX_BD_RING_SIZE);
- /* alloc Rx buffer from main memory */
- rx_buf_pool = malloc(MAX_RXBUF_LEN * RX_BD_RING_SIZE);
- if (!rx_buf_pool)
- return -ENOMEM;
- memset(rx_buf_pool, 0, MAX_RXBUF_LEN * RX_BD_RING_SIZE);
- debug("%s: rx_buf_pool = %p\n", __func__, rx_buf_pool);
- /* save them to fm_eth */
- fm_eth->rx_bd_ring = rx_bd_ring_base;
- fm_eth->cur_rxbd = rx_bd_ring_base;
- fm_eth->rx_buf = rx_buf_pool;
- /* init Rx BDs ring */
- rxbd = (struct fm_port_bd *)rx_bd_ring_base;
- for (i = 0; i < RX_BD_RING_SIZE; i++) {
- muram_writew(&rxbd->status, RxBD_EMPTY);
- muram_writew(&rxbd->len, 0);
- buf_hi = upper_32_bits(virt_to_phys(rx_buf_pool +
- i * MAX_RXBUF_LEN));
- buf_lo = lower_32_bits(virt_to_phys(rx_buf_pool +
- i * MAX_RXBUF_LEN));
- muram_writew(&rxbd->buf_ptr_hi, (u16)buf_hi);
- out_be32(&rxbd->buf_ptr_lo, buf_lo);
- rxbd++;
- }
- /* set the Rx queue descriptor */
- rxqd = &pram->rxqd;
- muram_writew(&rxqd->gen, 0);
- bd_ring_base_hi = upper_32_bits(virt_to_phys(rx_bd_ring_base));
- bd_ring_base_lo = lower_32_bits(virt_to_phys(rx_bd_ring_base));
- muram_writew(&rxqd->bd_ring_base_hi, (u16)bd_ring_base_hi);
- out_be32(&rxqd->bd_ring_base_lo, bd_ring_base_lo);
- muram_writew(&rxqd->bd_ring_size, sizeof(struct fm_port_bd)
- * RX_BD_RING_SIZE);
- muram_writew(&rxqd->offset_in, 0);
- muram_writew(&rxqd->offset_out, 0);
- /* set IM parameter ram pointer to Rx Frame Queue ID */
- out_be32(&bmi_rx_port->fmbm_rfqid, pram_page_offset);
- return 0;
- }
- static int fm_eth_tx_port_parameter_init(struct fm_eth *fm_eth)
- {
- struct fm_port_global_pram *pram;
- u32 pram_page_offset;
- void *tx_bd_ring_base;
- u32 bd_ring_base_lo, bd_ring_base_hi;
- struct fm_port_bd *txbd;
- struct fm_port_qd *txqd;
- struct fm_bmi_tx_port *bmi_tx_port = fm_eth->tx_port;
- int i;
- /* alloc global parameter ram at MURAM */
- pram = (struct fm_port_global_pram *)fm_muram_alloc(fm_eth->fm_index,
- FM_PRAM_SIZE, FM_PRAM_ALIGN);
- if (!pram) {
- printf("%s: No muram for Tx global parameter\n", __func__);
- return -ENOMEM;
- }
- fm_eth->tx_pram = pram;
- /* parameter page offset to MURAM */
- pram_page_offset = (void *)pram - fm_muram_base(fm_eth->fm_index);
- /* enable global mode- snooping data buffers and BDs */
- out_be32(&pram->mode, PRAM_MODE_GLOBAL);
- /* init the Tx queue descriptor pionter */
- out_be32(&pram->txqd_ptr, pram_page_offset + 0x40);
- /* alloc Tx buffer descriptors from main memory */
- tx_bd_ring_base = malloc(sizeof(struct fm_port_bd)
- * TX_BD_RING_SIZE);
- if (!tx_bd_ring_base)
- return -ENOMEM;
- memset(tx_bd_ring_base, 0, sizeof(struct fm_port_bd)
- * TX_BD_RING_SIZE);
- /* save it to fm_eth */
- fm_eth->tx_bd_ring = tx_bd_ring_base;
- fm_eth->cur_txbd = tx_bd_ring_base;
- /* init Tx BDs ring */
- txbd = (struct fm_port_bd *)tx_bd_ring_base;
- for (i = 0; i < TX_BD_RING_SIZE; i++) {
- muram_writew(&txbd->status, TxBD_LAST);
- muram_writew(&txbd->len, 0);
- muram_writew(&txbd->buf_ptr_hi, 0);
- out_be32(&txbd->buf_ptr_lo, 0);
- txbd++;
- }
- /* set the Tx queue decriptor */
- txqd = &pram->txqd;
- bd_ring_base_hi = upper_32_bits(virt_to_phys(tx_bd_ring_base));
- bd_ring_base_lo = lower_32_bits(virt_to_phys(tx_bd_ring_base));
- muram_writew(&txqd->bd_ring_base_hi, (u16)bd_ring_base_hi);
- out_be32(&txqd->bd_ring_base_lo, bd_ring_base_lo);
- muram_writew(&txqd->bd_ring_size, sizeof(struct fm_port_bd)
- * TX_BD_RING_SIZE);
- muram_writew(&txqd->offset_in, 0);
- muram_writew(&txqd->offset_out, 0);
- /* set IM parameter ram pointer to Tx Confirmation Frame Queue ID */
- out_be32(&bmi_tx_port->fmbm_tcfqid, pram_page_offset);
- return 0;
- }
- static int fm_eth_init(struct fm_eth *fm_eth)
- {
- int ret;
- ret = fm_eth_rx_port_parameter_init(fm_eth);
- if (ret)
- return ret;
- ret = fm_eth_tx_port_parameter_init(fm_eth);
- if (ret)
- return ret;
- return 0;
- }
- static int fm_eth_startup(struct fm_eth *fm_eth)
- {
- struct fsl_enet_mac *mac;
- int ret;
- mac = fm_eth->mac;
- /* Rx/TxBDs, Rx/TxQDs, Rx buff and parameter ram init */
- ret = fm_eth_init(fm_eth);
- if (ret)
- return ret;
- /* setup the MAC controller */
- mac->init_mac(mac);
- /* For some reason we need to set SPEED_100 */
- if (((fm_eth->enet_if == PHY_INTERFACE_MODE_SGMII) ||
- (fm_eth->enet_if == PHY_INTERFACE_MODE_SGMII_2500) ||
- (fm_eth->enet_if == PHY_INTERFACE_MODE_QSGMII)) &&
- mac->set_if_mode)
- mac->set_if_mode(mac, fm_eth->enet_if, SPEED_100);
- /* init bmi rx port, IM mode and disable */
- bmi_rx_port_init(fm_eth->rx_port);
- /* init bmi tx port, IM mode and disable */
- bmi_tx_port_init(fm_eth->tx_port);
- return 0;
- }
- static void fmc_tx_port_graceful_stop_enable(struct fm_eth *fm_eth)
- {
- struct fm_port_global_pram *pram;
- pram = fm_eth->tx_pram;
- /* graceful stop transmission of frames */
- setbits_be32(&pram->mode, PRAM_MODE_GRACEFUL_STOP);
- sync();
- }
- static void fmc_tx_port_graceful_stop_disable(struct fm_eth *fm_eth)
- {
- struct fm_port_global_pram *pram;
- pram = fm_eth->tx_pram;
- /* re-enable transmission of frames */
- clrbits_be32(&pram->mode, PRAM_MODE_GRACEFUL_STOP);
- sync();
- }
- #ifndef CONFIG_DM_ETH
- static int fm_eth_open(struct eth_device *dev, bd_t *bd)
- #else
- static int fm_eth_open(struct udevice *dev)
- #endif
- {
- #ifndef CONFIG_DM_ETH
- struct fm_eth *fm_eth = dev->priv;
- #else
- struct eth_pdata *pdata = dev_get_platdata(dev);
- struct fm_eth *fm_eth = dev_get_priv(dev);
- #endif
- unsigned char *enetaddr;
- struct fsl_enet_mac *mac;
- #ifdef CONFIG_PHYLIB
- int ret;
- #endif
- mac = fm_eth->mac;
- #ifndef CONFIG_DM_ETH
- enetaddr = &dev->enetaddr[0];
- #else
- enetaddr = pdata->enetaddr;
- #endif
- /* setup the MAC address */
- if (enetaddr[0] & 0x01) {
- printf("%s: MacAddress is multicast address\n", __func__);
- enetaddr[0] = 0;
- enetaddr[5] = fm_eth->num;
- }
- mac->set_mac_addr(mac, enetaddr);
- /* enable bmi Rx port */
- setbits_be32(&fm_eth->rx_port->fmbm_rcfg, FMBM_RCFG_EN);
- /* enable MAC rx/tx port */
- mac->enable_mac(mac);
- /* enable bmi Tx port */
- setbits_be32(&fm_eth->tx_port->fmbm_tcfg, FMBM_TCFG_EN);
- /* re-enable transmission of frame */
- fmc_tx_port_graceful_stop_disable(fm_eth);
- #ifdef CONFIG_PHYLIB
- if (fm_eth->phydev) {
- ret = phy_startup(fm_eth->phydev);
- if (ret) {
- #ifndef CONFIG_DM_ETH
- printf("%s: Could not initialize\n",
- fm_eth->phydev->dev->name);
- #else
- printf("%s: Could not initialize\n", dev->name);
- #endif
- return ret;
- }
- } else {
- return 0;
- }
- #else
- fm_eth->phydev->speed = SPEED_1000;
- fm_eth->phydev->link = 1;
- fm_eth->phydev->duplex = DUPLEX_FULL;
- #endif
- /* set the MAC-PHY mode */
- mac->set_if_mode(mac, fm_eth->enet_if, fm_eth->phydev->speed);
- debug("MAC IF mode %d, speed %d, link %d\n", fm_eth->enet_if,
- fm_eth->phydev->speed, fm_eth->phydev->link);
- if (!fm_eth->phydev->link)
- printf("%s: No link.\n", fm_eth->phydev->dev->name);
- return fm_eth->phydev->link ? 0 : -1;
- }
- #ifndef CONFIG_DM_ETH
- static void fm_eth_halt(struct eth_device *dev)
- #else
- static void fm_eth_halt(struct udevice *dev)
- #endif
- {
- struct fm_eth *fm_eth;
- struct fsl_enet_mac *mac;
- fm_eth = (struct fm_eth *)dev->priv;
- mac = fm_eth->mac;
- /* graceful stop the transmission of frames */
- fmc_tx_port_graceful_stop_enable(fm_eth);
- /* disable bmi Tx port */
- bmi_tx_port_disable(fm_eth->tx_port);
- /* disable MAC rx/tx port */
- mac->disable_mac(mac);
- /* disable bmi Rx port */
- bmi_rx_port_disable(fm_eth->rx_port);
- #ifdef CONFIG_PHYLIB
- if (fm_eth->phydev)
- phy_shutdown(fm_eth->phydev);
- #endif
- }
- #ifndef CONFIG_DM_ETH
- static int fm_eth_send(struct eth_device *dev, void *buf, int len)
- #else
- static int fm_eth_send(struct udevice *dev, void *buf, int len)
- #endif
- {
- struct fm_eth *fm_eth;
- struct fm_port_global_pram *pram;
- struct fm_port_bd *txbd, *txbd_base;
- u16 offset_in;
- int i;
- fm_eth = (struct fm_eth *)dev->priv;
- pram = fm_eth->tx_pram;
- txbd = fm_eth->cur_txbd;
- /* find one empty TxBD */
- for (i = 0; muram_readw(&txbd->status) & TxBD_READY; i++) {
- udelay(100);
- if (i > 0x1000) {
- printf("%s: Tx buffer not ready, txbd->status = 0x%x\n",
- dev->name, muram_readw(&txbd->status));
- return 0;
- }
- }
- /* setup TxBD */
- muram_writew(&txbd->buf_ptr_hi, (u16)upper_32_bits(virt_to_phys(buf)));
- out_be32(&txbd->buf_ptr_lo, lower_32_bits(virt_to_phys(buf)));
- muram_writew(&txbd->len, len);
- sync();
- muram_writew(&txbd->status, TxBD_READY | TxBD_LAST);
- sync();
- /* update TxQD, let RISC to send the packet */
- offset_in = muram_readw(&pram->txqd.offset_in);
- offset_in += sizeof(struct fm_port_bd);
- if (offset_in >= muram_readw(&pram->txqd.bd_ring_size))
- offset_in = 0;
- muram_writew(&pram->txqd.offset_in, offset_in);
- sync();
- /* wait for buffer to be transmitted */
- for (i = 0; muram_readw(&txbd->status) & TxBD_READY; i++) {
- udelay(100);
- if (i > 0x10000) {
- printf("%s: Tx error, txbd->status = 0x%x\n",
- dev->name, muram_readw(&txbd->status));
- return 0;
- }
- }
- /* advance the TxBD */
- txbd++;
- txbd_base = (struct fm_port_bd *)fm_eth->tx_bd_ring;
- if (txbd >= (txbd_base + TX_BD_RING_SIZE))
- txbd = txbd_base;
- /* update current txbd */
- fm_eth->cur_txbd = (void *)txbd;
- return 1;
- }
- static struct fm_port_bd *fm_eth_free_one(struct fm_eth *fm_eth,
- struct fm_port_bd *rxbd)
- {
- struct fm_port_global_pram *pram;
- struct fm_port_bd *rxbd_base;
- u16 offset_out;
- pram = fm_eth->rx_pram;
- /* clear the RxBDs */
- muram_writew(&rxbd->status, RxBD_EMPTY);
- muram_writew(&rxbd->len, 0);
- sync();
- /* advance RxBD */
- rxbd++;
- rxbd_base = (struct fm_port_bd *)fm_eth->rx_bd_ring;
- if (rxbd >= (rxbd_base + RX_BD_RING_SIZE))
- rxbd = rxbd_base;
- /* update RxQD */
- offset_out = muram_readw(&pram->rxqd.offset_out);
- offset_out += sizeof(struct fm_port_bd);
- if (offset_out >= muram_readw(&pram->rxqd.bd_ring_size))
- offset_out = 0;
- muram_writew(&pram->rxqd.offset_out, offset_out);
- sync();
- return rxbd;
- }
- #ifndef CONFIG_DM_ETH
- static int fm_eth_recv(struct eth_device *dev)
- #else
- static int fm_eth_recv(struct udevice *dev, int flags, uchar **packetp)
- #endif
- {
- struct fm_eth *fm_eth = (struct fm_eth *)dev->priv;
- struct fm_port_bd *rxbd = fm_eth->cur_rxbd;
- u32 buf_lo, buf_hi;
- u16 status, len;
- int ret = -1;
- u8 *data;
- status = muram_readw(&rxbd->status);
- while (!(status & RxBD_EMPTY)) {
- if (!(status & RxBD_ERROR)) {
- buf_hi = muram_readw(&rxbd->buf_ptr_hi);
- buf_lo = in_be32(&rxbd->buf_ptr_lo);
- data = (u8 *)((ulong)(buf_hi << 16) << 16 | buf_lo);
- len = muram_readw(&rxbd->len);
- #ifndef CONFIG_DM_ETH
- net_process_received_packet(data, len);
- #else
- *packetp = data;
- return len;
- #endif
- } else {
- printf("%s: Rx error\n", dev->name);
- ret = 0;
- }
- /* free current bd, advance to next one */
- rxbd = fm_eth_free_one(fm_eth, rxbd);
- /* read next status */
- status = muram_readw(&rxbd->status);
- }
- fm_eth->cur_rxbd = (void *)rxbd;
- return ret;
- }
- #ifdef CONFIG_DM_ETH
- static int fm_eth_free_pkt(struct udevice *dev, uchar *packet, int length)
- {
- struct fm_eth *fm_eth = (struct fm_eth *)dev->priv;
- fm_eth->cur_rxbd = fm_eth_free_one(fm_eth, fm_eth->cur_rxbd);
- return 0;
- }
- #endif /* CONFIG_DM_ETH */
- #ifndef CONFIG_DM_ETH
- static int fm_eth_init_mac(struct fm_eth *fm_eth, struct ccsr_fman *reg)
- {
- struct fsl_enet_mac *mac;
- int num;
- void *base, *phyregs = NULL;
- num = fm_eth->num;
- #ifdef CONFIG_SYS_FMAN_V3
- #ifndef CONFIG_FSL_FM_10GEC_REGULAR_NOTATION
- if (fm_eth->type == FM_ETH_10G_E) {
- /* 10GEC1/10GEC2 use mEMAC9/mEMAC10 on T2080/T4240.
- * 10GEC3/10GEC4 use mEMAC1/mEMAC2 on T2080.
- * 10GEC1 uses mEMAC1 on T1024.
- * so it needs to change the num.
- */
- if (fm_eth->num >= 2)
- num -= 2;
- else
- num += 8;
- }
- #endif
- base = ®->memac[num].fm_memac;
- phyregs = ®->memac[num].fm_memac_mdio;
- #else
- /* Get the mac registers base address */
- if (fm_eth->type == FM_ETH_1G_E) {
- base = ®->mac_1g[num].fm_dtesc;
- phyregs = ®->mac_1g[num].fm_mdio.miimcfg;
- } else {
- base = ®->mac_10g[num].fm_10gec;
- phyregs = ®->mac_10g[num].fm_10gec_mdio;
- }
- #endif
- /* alloc mac controller */
- mac = malloc(sizeof(struct fsl_enet_mac));
- if (!mac)
- return -ENOMEM;
- memset(mac, 0, sizeof(struct fsl_enet_mac));
- /* save the mac to fm_eth struct */
- fm_eth->mac = mac;
- #ifdef CONFIG_SYS_FMAN_V3
- init_memac(mac, base, phyregs, MAX_RXBUF_LEN);
- #else
- if (fm_eth->type == FM_ETH_1G_E)
- init_dtsec(mac, base, phyregs, MAX_RXBUF_LEN);
- else
- init_tgec(mac, base, phyregs, MAX_RXBUF_LEN);
- #endif
- return 0;
- }
- #else /* CONFIG_DM_ETH */
- static int fm_eth_init_mac(struct fm_eth *fm_eth, void *reg)
- {
- #ifndef CONFIG_SYS_FMAN_V3
- void *mdio;
- #endif
- fm_eth->mac = kzalloc(sizeof(*fm_eth->mac), GFP_KERNEL);
- if (!fm_eth->mac)
- return -ENOMEM;
- #ifndef CONFIG_SYS_FMAN_V3
- mdio = fman_mdio(fm_eth->dev->parent, fm_eth->mac_type, fm_eth->num);
- debug("MDIO %d @ %p\n", fm_eth->num, mdio);
- #endif
- switch (fm_eth->mac_type) {
- #ifdef CONFIG_SYS_FMAN_V3
- case FM_MEMAC:
- init_memac(fm_eth->mac, reg, NULL, MAX_RXBUF_LEN);
- break;
- #else
- case FM_DTSEC:
- init_dtsec(fm_eth->mac, reg, mdio, MAX_RXBUF_LEN);
- break;
- case FM_TGEC:
- init_tgec(fm_eth->mac, reg, mdio, MAX_RXBUF_LEN);
- break;
- #endif
- }
- return 0;
- }
- #endif /* CONFIG_DM_ETH */
- static int init_phy(struct fm_eth *fm_eth)
- {
- #ifdef CONFIG_PHYLIB
- u32 supported = PHY_GBIT_FEATURES;
- #ifndef CONFIG_DM_ETH
- struct phy_device *phydev = NULL;
- #endif
- if (fm_eth->type == FM_ETH_10G_E)
- supported = PHY_10G_FEATURES;
- if (fm_eth->enet_if == PHY_INTERFACE_MODE_SGMII_2500)
- supported |= SUPPORTED_2500baseX_Full;
- #endif
- if (fm_eth->type == FM_ETH_1G_E)
- dtsec_init_phy(fm_eth);
- #ifdef CONFIG_DM_ETH
- #ifdef CONFIG_PHYLIB
- #ifdef CONFIG_DM_MDIO
- fm_eth->phydev = dm_eth_phy_connect(fm_eth->dev);
- if (!fm_eth->phydev)
- return -ENODEV;
- #endif
- fm_eth->phydev->advertising &= supported;
- fm_eth->phydev->supported &= supported;
- phy_config(fm_eth->phydev);
- #endif
- #else /* CONFIG_DM_ETH */
- #ifdef CONFIG_PHYLIB
- if (fm_eth->bus) {
- phydev = phy_connect(fm_eth->bus, fm_eth->phyaddr, fm_eth->dev,
- fm_eth->enet_if);
- if (!phydev) {
- printf("Failed to connect\n");
- return -1;
- }
- } else {
- return 0;
- }
- if (fm_eth->type == FM_ETH_1G_E) {
- supported = (SUPPORTED_10baseT_Half |
- SUPPORTED_10baseT_Full |
- SUPPORTED_100baseT_Half |
- SUPPORTED_100baseT_Full |
- SUPPORTED_1000baseT_Full);
- } else {
- supported = SUPPORTED_10000baseT_Full;
- if (tgec_is_fibre(fm_eth))
- phydev->port = PORT_FIBRE;
- }
- phydev->supported &= supported;
- phydev->advertising = phydev->supported;
- fm_eth->phydev = phydev;
- phy_config(phydev);
- #endif
- #endif /* CONFIG_DM_ETH */
- return 0;
- }
- #ifndef CONFIG_DM_ETH
- int fm_eth_initialize(struct ccsr_fman *reg, struct fm_eth_info *info)
- {
- struct eth_device *dev;
- struct fm_eth *fm_eth;
- int i, num = info->num;
- int ret;
- /* alloc eth device */
- dev = (struct eth_device *)malloc(sizeof(struct eth_device));
- if (!dev)
- return -ENOMEM;
- memset(dev, 0, sizeof(struct eth_device));
- /* alloc the FMan ethernet private struct */
- fm_eth = (struct fm_eth *)malloc(sizeof(struct fm_eth));
- if (!fm_eth)
- return -ENOMEM;
- memset(fm_eth, 0, sizeof(struct fm_eth));
- /* save off some things we need from the info struct */
- fm_eth->fm_index = info->index - 1; /* keep as 0 based for muram */
- fm_eth->num = num;
- fm_eth->type = info->type;
- fm_eth->rx_port = (void *)®->port[info->rx_port_id - 1].fm_bmi;
- fm_eth->tx_port = (void *)®->port[info->tx_port_id - 1].fm_bmi;
- /* set the ethernet max receive length */
- fm_eth->max_rx_len = MAX_RXBUF_LEN;
- /* init global mac structure */
- ret = fm_eth_init_mac(fm_eth, reg);
- if (ret)
- return ret;
- /* keep same as the manual, we call FMAN1, FMAN2, DTSEC1, DTSEC2, etc */
- if (fm_eth->type == FM_ETH_1G_E)
- sprintf(dev->name, "FM%d@DTSEC%d", info->index, num + 1);
- else
- sprintf(dev->name, "FM%d@TGEC%d", info->index, num + 1);
- devlist[num_controllers++] = dev;
- dev->iobase = 0;
- dev->priv = (void *)fm_eth;
- dev->init = fm_eth_open;
- dev->halt = fm_eth_halt;
- dev->send = fm_eth_send;
- dev->recv = fm_eth_recv;
- fm_eth->dev = dev;
- fm_eth->bus = info->bus;
- fm_eth->phyaddr = info->phy_addr;
- fm_eth->enet_if = info->enet_if;
- /* startup the FM im */
- ret = fm_eth_startup(fm_eth);
- if (ret)
- return ret;
- init_phy(fm_eth);
- /* clear the ethernet address */
- for (i = 0; i < 6; i++)
- dev->enetaddr[i] = 0;
- eth_register(dev);
- return 0;
- }
- #else /* CONFIG_DM_ETH */
- #ifdef CONFIG_PHYLIB
- phy_interface_t fman_read_sys_if(struct udevice *dev)
- {
- const char *if_str;
- if_str = ofnode_read_string(dev->node, "phy-connection-type");
- debug("MAC system interface mode %s\n", if_str);
- return phy_get_interface_by_name(if_str);
- }
- #endif
- static int fm_eth_bind(struct udevice *dev)
- {
- char mac_name[11];
- u32 fm, num;
- if (ofnode_read_u32(ofnode_get_parent(dev->node), "cell-index", &fm)) {
- printf("FMan node property cell-index missing\n");
- return -EINVAL;
- }
- if (dev && dev_read_u32(dev, "cell-index", &num)) {
- printf("FMan MAC node property cell-index missing\n");
- return -EINVAL;
- }
- sprintf(mac_name, "fm%d-mac%d", fm + 1, num + 1);
- device_set_name(dev, mac_name);
- debug("%s - binding %s\n", __func__, mac_name);
- return 0;
- }
- static struct udevice *fm_get_internal_mdio(struct udevice *dev)
- {
- struct ofnode_phandle_args phandle = {.node = ofnode_null()};
- struct udevice *mdiodev;
- if (dev_read_phandle_with_args(dev, "pcsphy-handle", NULL,
- 0, 0, &phandle) ||
- !ofnode_valid(phandle.node)) {
- if (dev_read_phandle_with_args(dev, "tbi-handle", NULL,
- 0, 0, &phandle) ||
- !ofnode_valid(phandle.node)) {
- printf("Issue reading pcsphy-handle/tbi-handle for MAC %s\n",
- dev->name);
- return NULL;
- }
- }
- if (uclass_get_device_by_ofnode(UCLASS_MDIO,
- ofnode_get_parent(phandle.node),
- &mdiodev)) {
- printf("can't find MDIO bus for node %s\n",
- ofnode_get_name(ofnode_get_parent(phandle.node)));
- return NULL;
- }
- debug("Found internal MDIO bus %p\n", mdiodev);
- return mdiodev;
- }
- static int fm_eth_probe(struct udevice *dev)
- {
- struct fm_eth *fm_eth = (struct fm_eth *)dev->priv;
- struct ofnode_phandle_args args;
- void *reg;
- int ret, index;
- debug("%s enter for dev %p fm_eth %p - %s\n", __func__, dev, fm_eth,
- (dev) ? dev->name : "-");
- if (fm_eth->dev) {
- printf("%s already probed, exit\n", (dev) ? dev->name : "-");
- return 0;
- }
- fm_eth->dev = dev;
- fm_eth->fm_index = fman_id(dev->parent);
- reg = (void *)(uintptr_t)dev_read_addr(dev);
- fm_eth->mac_type = dev_get_driver_data(dev);
- #ifdef CONFIG_PHYLIB
- fm_eth->enet_if = fman_read_sys_if(dev);
- #else
- fm_eth->enet_if = PHY_INTERFACE_MODE_SGMII;
- printf("%s: warning - unable to determine interface type\n", __func__);
- #endif
- switch (fm_eth->mac_type) {
- #ifndef CONFIG_SYS_FMAN_V3
- case FM_TGEC:
- fm_eth->type = FM_ETH_10G_E;
- break;
- case FM_DTSEC:
- #else
- case FM_MEMAC:
- /* default to 1G, 10G is indicated by port property in dts */
- #endif
- fm_eth->type = FM_ETH_1G_E;
- break;
- }
- if (dev_read_u32(dev, "cell-index", &fm_eth->num)) {
- printf("FMan MAC node property cell-index missing\n");
- return -EINVAL;
- }
- if (dev_read_phandle_with_args(dev, "fsl,fman-ports", NULL,
- 0, 0, &args))
- goto ports_ref_failure;
- index = ofnode_read_u32_default(args.node, "cell-index", 0);
- if (index <= 0)
- goto ports_ref_failure;
- fm_eth->rx_port = fman_port(dev->parent, index);
- if (ofnode_read_bool(args.node, "fsl,fman-10g-port"))
- fm_eth->type = FM_ETH_10G_E;
- if (dev_read_phandle_with_args(dev, "fsl,fman-ports", NULL,
- 0, 1, &args))
- goto ports_ref_failure;
- index = ofnode_read_u32_default(args.node, "cell-index", 0);
- if (index <= 0)
- goto ports_ref_failure;
- fm_eth->tx_port = fman_port(dev->parent, index);
- /* set the ethernet max receive length */
- fm_eth->max_rx_len = MAX_RXBUF_LEN;
- switch (fm_eth->enet_if) {
- case PHY_INTERFACE_MODE_QSGMII:
- /* all PCS blocks are accessed on one controller */
- if (fm_eth->num != 0)
- break;
- case PHY_INTERFACE_MODE_SGMII:
- case PHY_INTERFACE_MODE_SGMII_2500:
- fm_eth->pcs_mdio = fm_get_internal_mdio(dev);
- break;
- default:
- break;
- }
- /* init global mac structure */
- ret = fm_eth_init_mac(fm_eth, reg);
- if (ret)
- return ret;
- /* startup the FM im */
- ret = fm_eth_startup(fm_eth);
- if (!ret)
- ret = init_phy(fm_eth);
- return ret;
- ports_ref_failure:
- printf("Issue reading fsl,fman-ports for MAC %s\n", dev->name);
- return -ENOENT;
- }
- static int fm_eth_remove(struct udevice *dev)
- {
- return 0;
- }
- static const struct eth_ops fm_eth_ops = {
- .start = fm_eth_open,
- .send = fm_eth_send,
- .recv = fm_eth_recv,
- .free_pkt = fm_eth_free_pkt,
- .stop = fm_eth_halt,
- };
- static const struct udevice_id fm_eth_ids[] = {
- #ifdef CONFIG_SYS_FMAN_V3
- { .compatible = "fsl,fman-memac", .data = FM_MEMAC },
- #else
- { .compatible = "fsl,fman-dtsec", .data = FM_DTSEC },
- { .compatible = "fsl,fman-xgec", .data = FM_TGEC },
- #endif
- {}
- };
- U_BOOT_DRIVER(eth_fman) = {
- .name = "eth_fman",
- .id = UCLASS_ETH,
- .of_match = fm_eth_ids,
- .bind = fm_eth_bind,
- .probe = fm_eth_probe,
- .remove = fm_eth_remove,
- .ops = &fm_eth_ops,
- .priv_auto_alloc_size = sizeof(struct fm_eth),
- .platdata_auto_alloc_size = sizeof(struct eth_pdata),
- .flags = DM_FLAG_ALLOC_PRIV_DMA,
- };
- #endif /* CONFIG_DM_ETH */
|