1c916d7c9SKumar Gala /* 2111fd19eSRoy Zang * Copyright 2009-2012 Freescale Semiconductor, Inc. 3c916d7c9SKumar Gala * Dave Liu <daveliu@freescale.com> 4c916d7c9SKumar Gala * 51a459660SWolfgang Denk * SPDX-License-Identifier: GPL-2.0+ 6c916d7c9SKumar Gala */ 7c916d7c9SKumar Gala #include <common.h> 8c916d7c9SKumar Gala #include <asm/io.h> 9c916d7c9SKumar Gala #include <malloc.h> 10c916d7c9SKumar Gala #include <net.h> 11c916d7c9SKumar Gala #include <hwconfig.h> 12c916d7c9SKumar Gala #include <fm_eth.h> 13c916d7c9SKumar Gala #include <fsl_mdio.h> 14c916d7c9SKumar Gala #include <miiphy.h> 15c916d7c9SKumar Gala #include <phy.h> 16c916d7c9SKumar Gala #include <asm/fsl_dtsec.h> 17c916d7c9SKumar Gala #include <asm/fsl_tgec.h> 18111fd19eSRoy Zang #include <asm/fsl_memac.h> 19c916d7c9SKumar Gala 20c916d7c9SKumar Gala #include "fm.h" 21c916d7c9SKumar Gala 22c916d7c9SKumar Gala static struct eth_device *devlist[NUM_FM_PORTS]; 23c916d7c9SKumar Gala static int num_controllers; 24c916d7c9SKumar Gala 25c916d7c9SKumar Gala #if defined(CONFIG_MII) || defined(CONFIG_CMD_MII) && !defined(BITBANGMII) 26c916d7c9SKumar Gala 27c916d7c9SKumar Gala #define TBIANA_SETTINGS (TBIANA_ASYMMETRIC_PAUSE | TBIANA_SYMMETRIC_PAUSE | \ 28c916d7c9SKumar Gala TBIANA_FULL_DUPLEX) 29c916d7c9SKumar Gala 30c916d7c9SKumar Gala #define TBIANA_SGMII_ACK 0x4001 31c916d7c9SKumar Gala 32c916d7c9SKumar Gala #define TBICR_SETTINGS (TBICR_ANEG_ENABLE | TBICR_RESTART_ANEG | \ 33c916d7c9SKumar Gala TBICR_FULL_DUPLEX | TBICR_SPEED1_SET) 34c916d7c9SKumar Gala 35c916d7c9SKumar Gala /* Configure the TBI for SGMII operation */ 36960d70c6SKim Phillips static void dtsec_configure_serdes(struct fm_eth *priv) 37c916d7c9SKumar Gala { 38111fd19eSRoy Zang #ifdef CONFIG_SYS_FMAN_V3 39111fd19eSRoy Zang u32 value; 40111fd19eSRoy Zang struct mii_dev bus; 41111fd19eSRoy Zang bus.priv = priv->mac->phyregs; 42111fd19eSRoy Zang 43111fd19eSRoy Zang /* SGMII IF mode + AN enable */ 44111fd19eSRoy Zang value = PHY_SGMII_IF_MODE_AN | PHY_SGMII_IF_MODE_SGMII; 45111fd19eSRoy Zang memac_mdio_write(&bus, 0, MDIO_DEVAD_NONE, 0x14, value); 46111fd19eSRoy Zang 47111fd19eSRoy Zang /* Dev ability according to SGMII specification */ 48111fd19eSRoy Zang value = PHY_SGMII_DEV_ABILITY_SGMII; 49111fd19eSRoy Zang memac_mdio_write(&bus, 0, MDIO_DEVAD_NONE, 0x4, value); 50111fd19eSRoy Zang 51111fd19eSRoy Zang /* Adjust link timer for SGMII - 52111fd19eSRoy Zang 1.6 ms in units of 8 ns = 2 * 10^5 = 0x30d40 */ 53111fd19eSRoy Zang memac_mdio_write(&bus, 0, MDIO_DEVAD_NONE, 0x13, 0x3); 54111fd19eSRoy Zang memac_mdio_write(&bus, 0, MDIO_DEVAD_NONE, 0x12, 0xd40); 55111fd19eSRoy Zang 56111fd19eSRoy Zang /* Restart AN */ 57111fd19eSRoy Zang value = PHY_SGMII_CR_DEF_VAL | PHY_SGMII_CR_RESET_AN; 58111fd19eSRoy Zang memac_mdio_write(&bus, 0, MDIO_DEVAD_NONE, 0, value); 59111fd19eSRoy Zang #else 60c916d7c9SKumar Gala struct dtsec *regs = priv->mac->base; 61c916d7c9SKumar Gala struct tsec_mii_mng *phyregs = priv->mac->phyregs; 62c916d7c9SKumar Gala 63c916d7c9SKumar Gala /* 64c916d7c9SKumar Gala * Access TBI PHY registers at given TSEC register offset as 65c916d7c9SKumar Gala * opposed to the register offset used for external PHY accesses 66c916d7c9SKumar Gala */ 67c916d7c9SKumar Gala tsec_local_mdio_write(phyregs, in_be32(®s->tbipa), 0, TBI_TBICON, 68c916d7c9SKumar Gala TBICON_CLK_SELECT); 69c916d7c9SKumar Gala tsec_local_mdio_write(phyregs, in_be32(®s->tbipa), 0, TBI_ANA, 70c916d7c9SKumar Gala TBIANA_SGMII_ACK); 71c916d7c9SKumar Gala tsec_local_mdio_write(phyregs, in_be32(®s->tbipa), 0, 72c916d7c9SKumar Gala TBI_CR, TBICR_SETTINGS); 73111fd19eSRoy Zang #endif 74c916d7c9SKumar Gala } 75c916d7c9SKumar Gala 76c916d7c9SKumar Gala static void dtsec_init_phy(struct eth_device *dev) 77c916d7c9SKumar Gala { 78c916d7c9SKumar Gala struct fm_eth *fm_eth = dev->priv; 79111fd19eSRoy Zang #ifndef CONFIG_SYS_FMAN_V3 801f3bd3e2Sshaohui xie struct dtsec *regs = (struct dtsec *)CONFIG_SYS_FSL_FM1_DTSEC1_ADDR; 811f3bd3e2Sshaohui xie 82c916d7c9SKumar Gala /* Assign a Physical address to the TBI */ 83c916d7c9SKumar Gala out_be32(®s->tbipa, CONFIG_SYS_TBIPA_VALUE); 84111fd19eSRoy Zang #endif 85c916d7c9SKumar Gala 86c916d7c9SKumar Gala if (fm_eth->enet_if == PHY_INTERFACE_MODE_SGMII) 87c916d7c9SKumar Gala dtsec_configure_serdes(fm_eth); 88c916d7c9SKumar Gala } 89c916d7c9SKumar Gala 90c916d7c9SKumar Gala static int tgec_is_fibre(struct eth_device *dev) 91c916d7c9SKumar Gala { 92c916d7c9SKumar Gala struct fm_eth *fm = dev->priv; 93c916d7c9SKumar Gala char phyopt[20]; 94c916d7c9SKumar Gala 95c916d7c9SKumar Gala sprintf(phyopt, "fsl_fm%d_xaui_phy", fm->fm_index + 1); 96c916d7c9SKumar Gala 97c916d7c9SKumar Gala return hwconfig_arg_cmp(phyopt, "xfi"); 98c916d7c9SKumar Gala } 99c916d7c9SKumar Gala #endif 100c916d7c9SKumar Gala 101c916d7c9SKumar Gala static u16 muram_readw(u16 *addr) 102c916d7c9SKumar Gala { 103c916d7c9SKumar Gala u32 base = (u32)addr & ~0x3; 104c916d7c9SKumar Gala u32 val32 = *(u32 *)base; 105c916d7c9SKumar Gala int byte_pos; 106c916d7c9SKumar Gala u16 ret; 107c916d7c9SKumar Gala 108c916d7c9SKumar Gala byte_pos = (u32)addr & 0x3; 109c916d7c9SKumar Gala if (byte_pos) 110c916d7c9SKumar Gala ret = (u16)(val32 & 0x0000ffff); 111c916d7c9SKumar Gala else 112c916d7c9SKumar Gala ret = (u16)((val32 & 0xffff0000) >> 16); 113c916d7c9SKumar Gala 114c916d7c9SKumar Gala return ret; 115c916d7c9SKumar Gala } 116c916d7c9SKumar Gala 117c916d7c9SKumar Gala static void muram_writew(u16 *addr, u16 val) 118c916d7c9SKumar Gala { 119c916d7c9SKumar Gala u32 base = (u32)addr & ~0x3; 120c916d7c9SKumar Gala u32 org32 = *(u32 *)base; 121c916d7c9SKumar Gala u32 val32; 122c916d7c9SKumar Gala int byte_pos; 123c916d7c9SKumar Gala 124c916d7c9SKumar Gala byte_pos = (u32)addr & 0x3; 125c916d7c9SKumar Gala if (byte_pos) 126c916d7c9SKumar Gala val32 = (org32 & 0xffff0000) | val; 127c916d7c9SKumar Gala else 128c916d7c9SKumar Gala val32 = (org32 & 0x0000ffff) | ((u32)val << 16); 129c916d7c9SKumar Gala 130c916d7c9SKumar Gala *(u32 *)base = val32; 131c916d7c9SKumar Gala } 132c916d7c9SKumar Gala 133c916d7c9SKumar Gala static void bmi_rx_port_disable(struct fm_bmi_rx_port *rx_port) 134c916d7c9SKumar Gala { 135c916d7c9SKumar Gala int timeout = 1000000; 136c916d7c9SKumar Gala 137c916d7c9SKumar Gala clrbits_be32(&rx_port->fmbm_rcfg, FMBM_RCFG_EN); 138c916d7c9SKumar Gala 139c916d7c9SKumar Gala /* wait until the rx port is not busy */ 140c916d7c9SKumar Gala while ((in_be32(&rx_port->fmbm_rst) & FMBM_RST_BSY) && timeout--) 141c916d7c9SKumar Gala ; 142c916d7c9SKumar Gala } 143c916d7c9SKumar Gala 144c916d7c9SKumar Gala static void bmi_rx_port_init(struct fm_bmi_rx_port *rx_port) 145c916d7c9SKumar Gala { 146c916d7c9SKumar Gala /* set BMI to independent mode, Rx port disable */ 147c916d7c9SKumar Gala out_be32(&rx_port->fmbm_rcfg, FMBM_RCFG_IM); 148c916d7c9SKumar Gala /* clear FOF in IM case */ 149c916d7c9SKumar Gala out_be32(&rx_port->fmbm_rim, 0); 150c916d7c9SKumar Gala /* Rx frame next engine -RISC */ 151c916d7c9SKumar Gala out_be32(&rx_port->fmbm_rfne, NIA_ENG_RISC | NIA_RISC_AC_IM_RX); 152c916d7c9SKumar Gala /* Rx command attribute - no order, MR[3] = 1 */ 153c916d7c9SKumar Gala clrbits_be32(&rx_port->fmbm_rfca, FMBM_RFCA_ORDER | FMBM_RFCA_MR_MASK); 154c916d7c9SKumar Gala setbits_be32(&rx_port->fmbm_rfca, FMBM_RFCA_MR(4)); 155c916d7c9SKumar Gala /* enable Rx statistic counters */ 156c916d7c9SKumar Gala out_be32(&rx_port->fmbm_rstc, FMBM_RSTC_EN); 157c916d7c9SKumar Gala /* disable Rx performance counters */ 158c916d7c9SKumar Gala out_be32(&rx_port->fmbm_rpc, 0); 159c916d7c9SKumar Gala } 160c916d7c9SKumar Gala 161c916d7c9SKumar Gala static void bmi_tx_port_disable(struct fm_bmi_tx_port *tx_port) 162c916d7c9SKumar Gala { 163c916d7c9SKumar Gala int timeout = 1000000; 164c916d7c9SKumar Gala 165c916d7c9SKumar Gala clrbits_be32(&tx_port->fmbm_tcfg, FMBM_TCFG_EN); 166c916d7c9SKumar Gala 167c916d7c9SKumar Gala /* wait until the tx port is not busy */ 168c916d7c9SKumar Gala while ((in_be32(&tx_port->fmbm_tst) & FMBM_TST_BSY) && timeout--) 169c916d7c9SKumar Gala ; 170c916d7c9SKumar Gala } 171c916d7c9SKumar Gala 172c916d7c9SKumar Gala static void bmi_tx_port_init(struct fm_bmi_tx_port *tx_port) 173c916d7c9SKumar Gala { 174c916d7c9SKumar Gala /* set BMI to independent mode, Tx port disable */ 175c916d7c9SKumar Gala out_be32(&tx_port->fmbm_tcfg, FMBM_TCFG_IM); 176c916d7c9SKumar Gala /* Tx frame next engine -RISC */ 177c916d7c9SKumar Gala out_be32(&tx_port->fmbm_tfne, NIA_ENG_RISC | NIA_RISC_AC_IM_TX); 178c916d7c9SKumar Gala out_be32(&tx_port->fmbm_tfene, NIA_ENG_RISC | NIA_RISC_AC_IM_TX); 179c916d7c9SKumar Gala /* Tx command attribute - no order, MR[3] = 1 */ 180c916d7c9SKumar Gala clrbits_be32(&tx_port->fmbm_tfca, FMBM_TFCA_ORDER | FMBM_TFCA_MR_MASK); 181c916d7c9SKumar Gala setbits_be32(&tx_port->fmbm_tfca, FMBM_TFCA_MR(4)); 182c916d7c9SKumar Gala /* enable Tx statistic counters */ 183c916d7c9SKumar Gala out_be32(&tx_port->fmbm_tstc, FMBM_TSTC_EN); 184c916d7c9SKumar Gala /* disable Tx performance counters */ 185c916d7c9SKumar Gala out_be32(&tx_port->fmbm_tpc, 0); 186c916d7c9SKumar Gala } 187c916d7c9SKumar Gala 188c916d7c9SKumar Gala static int fm_eth_rx_port_parameter_init(struct fm_eth *fm_eth) 189c916d7c9SKumar Gala { 190c916d7c9SKumar Gala struct fm_port_global_pram *pram; 191c916d7c9SKumar Gala u32 pram_page_offset; 192c916d7c9SKumar Gala void *rx_bd_ring_base; 193c916d7c9SKumar Gala void *rx_buf_pool; 194c916d7c9SKumar Gala struct fm_port_bd *rxbd; 195c916d7c9SKumar Gala struct fm_port_qd *rxqd; 196c916d7c9SKumar Gala struct fm_bmi_rx_port *bmi_rx_port = fm_eth->rx_port; 197c916d7c9SKumar Gala int i; 198c916d7c9SKumar Gala 199c916d7c9SKumar Gala /* alloc global parameter ram at MURAM */ 200c916d7c9SKumar Gala pram = (struct fm_port_global_pram *)fm_muram_alloc(fm_eth->fm_index, 201c916d7c9SKumar Gala FM_PRAM_SIZE, FM_PRAM_ALIGN); 202c916d7c9SKumar Gala fm_eth->rx_pram = pram; 203c916d7c9SKumar Gala 204c916d7c9SKumar Gala /* parameter page offset to MURAM */ 205c916d7c9SKumar Gala pram_page_offset = (u32)pram - fm_muram_base(fm_eth->fm_index); 206c916d7c9SKumar Gala 207c916d7c9SKumar Gala /* enable global mode- snooping data buffers and BDs */ 208c916d7c9SKumar Gala pram->mode = PRAM_MODE_GLOBAL; 209c916d7c9SKumar Gala 210c916d7c9SKumar Gala /* init the Rx queue descriptor pionter */ 211c916d7c9SKumar Gala pram->rxqd_ptr = pram_page_offset + 0x20; 212c916d7c9SKumar Gala 213c916d7c9SKumar Gala /* set the max receive buffer length, power of 2 */ 214c916d7c9SKumar Gala muram_writew(&pram->mrblr, MAX_RXBUF_LOG2); 215c916d7c9SKumar Gala 216c916d7c9SKumar Gala /* alloc Rx buffer descriptors from main memory */ 217c916d7c9SKumar Gala rx_bd_ring_base = malloc(sizeof(struct fm_port_bd) 218c916d7c9SKumar Gala * RX_BD_RING_SIZE); 219c916d7c9SKumar Gala if (!rx_bd_ring_base) 220c916d7c9SKumar Gala return 0; 221c916d7c9SKumar Gala memset(rx_bd_ring_base, 0, sizeof(struct fm_port_bd) 222c916d7c9SKumar Gala * RX_BD_RING_SIZE); 223c916d7c9SKumar Gala 224c916d7c9SKumar Gala /* alloc Rx buffer from main memory */ 225c916d7c9SKumar Gala rx_buf_pool = malloc(MAX_RXBUF_LEN * RX_BD_RING_SIZE); 226c916d7c9SKumar Gala if (!rx_buf_pool) 227c916d7c9SKumar Gala return 0; 228c916d7c9SKumar Gala memset(rx_buf_pool, 0, MAX_RXBUF_LEN * RX_BD_RING_SIZE); 229c916d7c9SKumar Gala 230c916d7c9SKumar Gala /* save them to fm_eth */ 231c916d7c9SKumar Gala fm_eth->rx_bd_ring = rx_bd_ring_base; 232c916d7c9SKumar Gala fm_eth->cur_rxbd = rx_bd_ring_base; 233c916d7c9SKumar Gala fm_eth->rx_buf = rx_buf_pool; 234c916d7c9SKumar Gala 235c916d7c9SKumar Gala /* init Rx BDs ring */ 236c916d7c9SKumar Gala rxbd = (struct fm_port_bd *)rx_bd_ring_base; 237c916d7c9SKumar Gala for (i = 0; i < RX_BD_RING_SIZE; i++) { 238c916d7c9SKumar Gala rxbd->status = RxBD_EMPTY; 239c916d7c9SKumar Gala rxbd->len = 0; 240c916d7c9SKumar Gala rxbd->buf_ptr_hi = 0; 241c916d7c9SKumar Gala rxbd->buf_ptr_lo = (u32)rx_buf_pool + i * MAX_RXBUF_LEN; 242c916d7c9SKumar Gala rxbd++; 243c916d7c9SKumar Gala } 244c916d7c9SKumar Gala 245c916d7c9SKumar Gala /* set the Rx queue descriptor */ 246c916d7c9SKumar Gala rxqd = &pram->rxqd; 247c916d7c9SKumar Gala muram_writew(&rxqd->gen, 0); 248c916d7c9SKumar Gala muram_writew(&rxqd->bd_ring_base_hi, 0); 249c916d7c9SKumar Gala rxqd->bd_ring_base_lo = (u32)rx_bd_ring_base; 250c916d7c9SKumar Gala muram_writew(&rxqd->bd_ring_size, sizeof(struct fm_port_bd) 251c916d7c9SKumar Gala * RX_BD_RING_SIZE); 252c916d7c9SKumar Gala muram_writew(&rxqd->offset_in, 0); 253c916d7c9SKumar Gala muram_writew(&rxqd->offset_out, 0); 254c916d7c9SKumar Gala 255c916d7c9SKumar Gala /* set IM parameter ram pointer to Rx Frame Queue ID */ 256c916d7c9SKumar Gala out_be32(&bmi_rx_port->fmbm_rfqid, pram_page_offset); 257c916d7c9SKumar Gala 258c916d7c9SKumar Gala return 1; 259c916d7c9SKumar Gala } 260c916d7c9SKumar Gala 261c916d7c9SKumar Gala static int fm_eth_tx_port_parameter_init(struct fm_eth *fm_eth) 262c916d7c9SKumar Gala { 263c916d7c9SKumar Gala struct fm_port_global_pram *pram; 264c916d7c9SKumar Gala u32 pram_page_offset; 265c916d7c9SKumar Gala void *tx_bd_ring_base; 266c916d7c9SKumar Gala struct fm_port_bd *txbd; 267c916d7c9SKumar Gala struct fm_port_qd *txqd; 268c916d7c9SKumar Gala struct fm_bmi_tx_port *bmi_tx_port = fm_eth->tx_port; 269c916d7c9SKumar Gala int i; 270c916d7c9SKumar Gala 271c916d7c9SKumar Gala /* alloc global parameter ram at MURAM */ 272c916d7c9SKumar Gala pram = (struct fm_port_global_pram *)fm_muram_alloc(fm_eth->fm_index, 273c916d7c9SKumar Gala FM_PRAM_SIZE, FM_PRAM_ALIGN); 274c916d7c9SKumar Gala fm_eth->tx_pram = pram; 275c916d7c9SKumar Gala 276c916d7c9SKumar Gala /* parameter page offset to MURAM */ 277c916d7c9SKumar Gala pram_page_offset = (u32)pram - fm_muram_base(fm_eth->fm_index); 278c916d7c9SKumar Gala 279c916d7c9SKumar Gala /* enable global mode- snooping data buffers and BDs */ 280c916d7c9SKumar Gala pram->mode = PRAM_MODE_GLOBAL; 281c916d7c9SKumar Gala 282c916d7c9SKumar Gala /* init the Tx queue descriptor pionter */ 283c916d7c9SKumar Gala pram->txqd_ptr = pram_page_offset + 0x40; 284c916d7c9SKumar Gala 285c916d7c9SKumar Gala /* alloc Tx buffer descriptors from main memory */ 286c916d7c9SKumar Gala tx_bd_ring_base = malloc(sizeof(struct fm_port_bd) 287c916d7c9SKumar Gala * TX_BD_RING_SIZE); 288c916d7c9SKumar Gala if (!tx_bd_ring_base) 289c916d7c9SKumar Gala return 0; 290c916d7c9SKumar Gala memset(tx_bd_ring_base, 0, sizeof(struct fm_port_bd) 291c916d7c9SKumar Gala * TX_BD_RING_SIZE); 292c916d7c9SKumar Gala /* save it to fm_eth */ 293c916d7c9SKumar Gala fm_eth->tx_bd_ring = tx_bd_ring_base; 294c916d7c9SKumar Gala fm_eth->cur_txbd = tx_bd_ring_base; 295c916d7c9SKumar Gala 296c916d7c9SKumar Gala /* init Tx BDs ring */ 297c916d7c9SKumar Gala txbd = (struct fm_port_bd *)tx_bd_ring_base; 298c916d7c9SKumar Gala for (i = 0; i < TX_BD_RING_SIZE; i++) { 299c916d7c9SKumar Gala txbd->status = TxBD_LAST; 300c916d7c9SKumar Gala txbd->len = 0; 301c916d7c9SKumar Gala txbd->buf_ptr_hi = 0; 302c916d7c9SKumar Gala txbd->buf_ptr_lo = 0; 303c916d7c9SKumar Gala } 304c916d7c9SKumar Gala 305c916d7c9SKumar Gala /* set the Tx queue decriptor */ 306c916d7c9SKumar Gala txqd = &pram->txqd; 307c916d7c9SKumar Gala muram_writew(&txqd->bd_ring_base_hi, 0); 308c916d7c9SKumar Gala txqd->bd_ring_base_lo = (u32)tx_bd_ring_base; 309c916d7c9SKumar Gala muram_writew(&txqd->bd_ring_size, sizeof(struct fm_port_bd) 310c916d7c9SKumar Gala * TX_BD_RING_SIZE); 311c916d7c9SKumar Gala muram_writew(&txqd->offset_in, 0); 312c916d7c9SKumar Gala muram_writew(&txqd->offset_out, 0); 313c916d7c9SKumar Gala 314c916d7c9SKumar Gala /* set IM parameter ram pointer to Tx Confirmation Frame Queue ID */ 315c916d7c9SKumar Gala out_be32(&bmi_tx_port->fmbm_tcfqid, pram_page_offset); 316c916d7c9SKumar Gala 317c916d7c9SKumar Gala return 1; 318c916d7c9SKumar Gala } 319c916d7c9SKumar Gala 320c916d7c9SKumar Gala static int fm_eth_init(struct fm_eth *fm_eth) 321c916d7c9SKumar Gala { 322c916d7c9SKumar Gala 323c916d7c9SKumar Gala if (!fm_eth_rx_port_parameter_init(fm_eth)) 324c916d7c9SKumar Gala return 0; 325c916d7c9SKumar Gala 326c916d7c9SKumar Gala if (!fm_eth_tx_port_parameter_init(fm_eth)) 327c916d7c9SKumar Gala return 0; 328c916d7c9SKumar Gala 329c916d7c9SKumar Gala return 1; 330c916d7c9SKumar Gala } 331c916d7c9SKumar Gala 332c916d7c9SKumar Gala static int fm_eth_startup(struct fm_eth *fm_eth) 333c916d7c9SKumar Gala { 334c916d7c9SKumar Gala struct fsl_enet_mac *mac; 335c916d7c9SKumar Gala mac = fm_eth->mac; 336c916d7c9SKumar Gala 337c916d7c9SKumar Gala /* Rx/TxBDs, Rx/TxQDs, Rx buff and parameter ram init */ 338c916d7c9SKumar Gala if (!fm_eth_init(fm_eth)) 339c916d7c9SKumar Gala return 0; 340c916d7c9SKumar Gala /* setup the MAC controller */ 341c916d7c9SKumar Gala mac->init_mac(mac); 342c916d7c9SKumar Gala 343c916d7c9SKumar Gala /* For some reason we need to set SPEED_100 */ 3441c68d01eSShaohui Xie if (((fm_eth->enet_if == PHY_INTERFACE_MODE_SGMII) || 3451c68d01eSShaohui Xie (fm_eth->enet_if == PHY_INTERFACE_MODE_QSGMII)) && 3461c68d01eSShaohui Xie mac->set_if_mode) 347c916d7c9SKumar Gala mac->set_if_mode(mac, fm_eth->enet_if, SPEED_100); 348c916d7c9SKumar Gala 349c916d7c9SKumar Gala /* init bmi rx port, IM mode and disable */ 350c916d7c9SKumar Gala bmi_rx_port_init(fm_eth->rx_port); 351c916d7c9SKumar Gala /* init bmi tx port, IM mode and disable */ 352c916d7c9SKumar Gala bmi_tx_port_init(fm_eth->tx_port); 353c916d7c9SKumar Gala 354c916d7c9SKumar Gala return 1; 355c916d7c9SKumar Gala } 356c916d7c9SKumar Gala 357c916d7c9SKumar Gala static void fmc_tx_port_graceful_stop_enable(struct fm_eth *fm_eth) 358c916d7c9SKumar Gala { 359c916d7c9SKumar Gala struct fm_port_global_pram *pram; 360c916d7c9SKumar Gala 361c916d7c9SKumar Gala pram = fm_eth->tx_pram; 362c916d7c9SKumar Gala /* graceful stop transmission of frames */ 363c916d7c9SKumar Gala pram->mode |= PRAM_MODE_GRACEFUL_STOP; 364c916d7c9SKumar Gala sync(); 365c916d7c9SKumar Gala } 366c916d7c9SKumar Gala 367c916d7c9SKumar Gala static void fmc_tx_port_graceful_stop_disable(struct fm_eth *fm_eth) 368c916d7c9SKumar Gala { 369c916d7c9SKumar Gala struct fm_port_global_pram *pram; 370c916d7c9SKumar Gala 371c916d7c9SKumar Gala pram = fm_eth->tx_pram; 372c916d7c9SKumar Gala /* re-enable transmission of frames */ 373c916d7c9SKumar Gala pram->mode &= ~PRAM_MODE_GRACEFUL_STOP; 374c916d7c9SKumar Gala sync(); 375c916d7c9SKumar Gala } 376c916d7c9SKumar Gala 377c916d7c9SKumar Gala static int fm_eth_open(struct eth_device *dev, bd_t *bd) 378c916d7c9SKumar Gala { 379c916d7c9SKumar Gala struct fm_eth *fm_eth; 380c916d7c9SKumar Gala struct fsl_enet_mac *mac; 38111af8d65STimur Tabi #ifdef CONFIG_PHYLIB 38211af8d65STimur Tabi int ret; 38311af8d65STimur Tabi #endif 384c916d7c9SKumar Gala 385c916d7c9SKumar Gala fm_eth = (struct fm_eth *)dev->priv; 386c916d7c9SKumar Gala mac = fm_eth->mac; 387c916d7c9SKumar Gala 388c916d7c9SKumar Gala /* setup the MAC address */ 389c916d7c9SKumar Gala if (dev->enetaddr[0] & 0x01) { 390c916d7c9SKumar Gala printf("%s: MacAddress is multcast address\n", __func__); 391c916d7c9SKumar Gala return 1; 392c916d7c9SKumar Gala } 393c916d7c9SKumar Gala mac->set_mac_addr(mac, dev->enetaddr); 394c916d7c9SKumar Gala 395c916d7c9SKumar Gala /* enable bmi Rx port */ 396c916d7c9SKumar Gala setbits_be32(&fm_eth->rx_port->fmbm_rcfg, FMBM_RCFG_EN); 397c916d7c9SKumar Gala /* enable MAC rx/tx port */ 398c916d7c9SKumar Gala mac->enable_mac(mac); 399c916d7c9SKumar Gala /* enable bmi Tx port */ 400c916d7c9SKumar Gala setbits_be32(&fm_eth->tx_port->fmbm_tcfg, FMBM_TCFG_EN); 401c916d7c9SKumar Gala /* re-enable transmission of frame */ 402c916d7c9SKumar Gala fmc_tx_port_graceful_stop_disable(fm_eth); 403c916d7c9SKumar Gala 404c916d7c9SKumar Gala #ifdef CONFIG_PHYLIB 40511af8d65STimur Tabi ret = phy_startup(fm_eth->phydev); 40611af8d65STimur Tabi if (ret) { 40711af8d65STimur Tabi printf("%s: Could not initialize\n", fm_eth->phydev->dev->name); 40811af8d65STimur Tabi return ret; 40911af8d65STimur Tabi } 410c916d7c9SKumar Gala #else 411c916d7c9SKumar Gala fm_eth->phydev->speed = SPEED_1000; 412c916d7c9SKumar Gala fm_eth->phydev->link = 1; 413c916d7c9SKumar Gala fm_eth->phydev->duplex = DUPLEX_FULL; 414c916d7c9SKumar Gala #endif 415c916d7c9SKumar Gala 416c916d7c9SKumar Gala /* set the MAC-PHY mode */ 417c916d7c9SKumar Gala mac->set_if_mode(mac, fm_eth->enet_if, fm_eth->phydev->speed); 418c916d7c9SKumar Gala 419c916d7c9SKumar Gala if (!fm_eth->phydev->link) 420c916d7c9SKumar Gala printf("%s: No link.\n", fm_eth->phydev->dev->name); 421c916d7c9SKumar Gala 422c916d7c9SKumar Gala return fm_eth->phydev->link ? 0 : -1; 423c916d7c9SKumar Gala } 424c916d7c9SKumar Gala 425c916d7c9SKumar Gala static void fm_eth_halt(struct eth_device *dev) 426c916d7c9SKumar Gala { 427c916d7c9SKumar Gala struct fm_eth *fm_eth; 428c916d7c9SKumar Gala struct fsl_enet_mac *mac; 429c916d7c9SKumar Gala 430c916d7c9SKumar Gala fm_eth = (struct fm_eth *)dev->priv; 431c916d7c9SKumar Gala mac = fm_eth->mac; 432c916d7c9SKumar Gala 433c916d7c9SKumar Gala /* graceful stop the transmission of frames */ 434c916d7c9SKumar Gala fmc_tx_port_graceful_stop_enable(fm_eth); 435c916d7c9SKumar Gala /* disable bmi Tx port */ 436c916d7c9SKumar Gala bmi_tx_port_disable(fm_eth->tx_port); 437c916d7c9SKumar Gala /* disable MAC rx/tx port */ 438c916d7c9SKumar Gala mac->disable_mac(mac); 439c916d7c9SKumar Gala /* disable bmi Rx port */ 440c916d7c9SKumar Gala bmi_rx_port_disable(fm_eth->rx_port); 441c916d7c9SKumar Gala 442c916d7c9SKumar Gala phy_shutdown(fm_eth->phydev); 443c916d7c9SKumar Gala } 444c916d7c9SKumar Gala 445e9df2018SJoe Hershberger static int fm_eth_send(struct eth_device *dev, void *buf, int len) 446c916d7c9SKumar Gala { 447c916d7c9SKumar Gala struct fm_eth *fm_eth; 448c916d7c9SKumar Gala struct fm_port_global_pram *pram; 449c916d7c9SKumar Gala struct fm_port_bd *txbd, *txbd_base; 450c916d7c9SKumar Gala u16 offset_in; 451c916d7c9SKumar Gala int i; 452c916d7c9SKumar Gala 453c916d7c9SKumar Gala fm_eth = (struct fm_eth *)dev->priv; 454c916d7c9SKumar Gala pram = fm_eth->tx_pram; 455c916d7c9SKumar Gala txbd = fm_eth->cur_txbd; 456c916d7c9SKumar Gala 457c916d7c9SKumar Gala /* find one empty TxBD */ 458c916d7c9SKumar Gala for (i = 0; txbd->status & TxBD_READY; i++) { 459c916d7c9SKumar Gala udelay(100); 460c916d7c9SKumar Gala if (i > 0x1000) { 461c916d7c9SKumar Gala printf("%s: Tx buffer not ready\n", dev->name); 462c916d7c9SKumar Gala return 0; 463c916d7c9SKumar Gala } 464c916d7c9SKumar Gala } 465c916d7c9SKumar Gala /* setup TxBD */ 466c916d7c9SKumar Gala txbd->buf_ptr_hi = 0; 467c916d7c9SKumar Gala txbd->buf_ptr_lo = (u32)buf; 468c916d7c9SKumar Gala txbd->len = len; 469c916d7c9SKumar Gala sync(); 470c916d7c9SKumar Gala txbd->status = TxBD_READY | TxBD_LAST; 471c916d7c9SKumar Gala sync(); 472c916d7c9SKumar Gala 473c916d7c9SKumar Gala /* update TxQD, let RISC to send the packet */ 474c916d7c9SKumar Gala offset_in = muram_readw(&pram->txqd.offset_in); 475c916d7c9SKumar Gala offset_in += sizeof(struct fm_port_bd); 476c916d7c9SKumar Gala if (offset_in >= muram_readw(&pram->txqd.bd_ring_size)) 477c916d7c9SKumar Gala offset_in = 0; 478c916d7c9SKumar Gala muram_writew(&pram->txqd.offset_in, offset_in); 479c916d7c9SKumar Gala sync(); 480c916d7c9SKumar Gala 481c916d7c9SKumar Gala /* wait for buffer to be transmitted */ 482c916d7c9SKumar Gala for (i = 0; txbd->status & TxBD_READY; i++) { 483c916d7c9SKumar Gala udelay(100); 484c916d7c9SKumar Gala if (i > 0x10000) { 485c916d7c9SKumar Gala printf("%s: Tx error\n", dev->name); 486c916d7c9SKumar Gala return 0; 487c916d7c9SKumar Gala } 488c916d7c9SKumar Gala } 489c916d7c9SKumar Gala 490c916d7c9SKumar Gala /* advance the TxBD */ 491c916d7c9SKumar Gala txbd++; 492c916d7c9SKumar Gala txbd_base = (struct fm_port_bd *)fm_eth->tx_bd_ring; 493c916d7c9SKumar Gala if (txbd >= (txbd_base + TX_BD_RING_SIZE)) 494c916d7c9SKumar Gala txbd = txbd_base; 495c916d7c9SKumar Gala /* update current txbd */ 496c916d7c9SKumar Gala fm_eth->cur_txbd = (void *)txbd; 497c916d7c9SKumar Gala 498c916d7c9SKumar Gala return 1; 499c916d7c9SKumar Gala } 500c916d7c9SKumar Gala 501c916d7c9SKumar Gala static int fm_eth_recv(struct eth_device *dev) 502c916d7c9SKumar Gala { 503c916d7c9SKumar Gala struct fm_eth *fm_eth; 504c916d7c9SKumar Gala struct fm_port_global_pram *pram; 505c916d7c9SKumar Gala struct fm_port_bd *rxbd, *rxbd_base; 506c916d7c9SKumar Gala u16 status, len; 507c916d7c9SKumar Gala u8 *data; 508c916d7c9SKumar Gala u16 offset_out; 509c916d7c9SKumar Gala 510c916d7c9SKumar Gala fm_eth = (struct fm_eth *)dev->priv; 511c916d7c9SKumar Gala pram = fm_eth->rx_pram; 512c916d7c9SKumar Gala rxbd = fm_eth->cur_rxbd; 513c916d7c9SKumar Gala status = rxbd->status; 514c916d7c9SKumar Gala 515c916d7c9SKumar Gala while (!(status & RxBD_EMPTY)) { 516c916d7c9SKumar Gala if (!(status & RxBD_ERROR)) { 517c916d7c9SKumar Gala data = (u8 *)rxbd->buf_ptr_lo; 518c916d7c9SKumar Gala len = rxbd->len; 519c916d7c9SKumar Gala NetReceive(data, len); 520c916d7c9SKumar Gala } else { 521c916d7c9SKumar Gala printf("%s: Rx error\n", dev->name); 522c916d7c9SKumar Gala return 0; 523c916d7c9SKumar Gala } 524c916d7c9SKumar Gala 525c916d7c9SKumar Gala /* clear the RxBDs */ 526c916d7c9SKumar Gala rxbd->status = RxBD_EMPTY; 527c916d7c9SKumar Gala rxbd->len = 0; 528c916d7c9SKumar Gala sync(); 529c916d7c9SKumar Gala 530c916d7c9SKumar Gala /* advance RxBD */ 531c916d7c9SKumar Gala rxbd++; 532c916d7c9SKumar Gala rxbd_base = (struct fm_port_bd *)fm_eth->rx_bd_ring; 533c916d7c9SKumar Gala if (rxbd >= (rxbd_base + RX_BD_RING_SIZE)) 534c916d7c9SKumar Gala rxbd = rxbd_base; 535c916d7c9SKumar Gala /* read next status */ 536c916d7c9SKumar Gala status = rxbd->status; 537c916d7c9SKumar Gala 538c916d7c9SKumar Gala /* update RxQD */ 539c916d7c9SKumar Gala offset_out = muram_readw(&pram->rxqd.offset_out); 540c916d7c9SKumar Gala offset_out += sizeof(struct fm_port_bd); 541c916d7c9SKumar Gala if (offset_out >= muram_readw(&pram->rxqd.bd_ring_size)) 542c916d7c9SKumar Gala offset_out = 0; 543c916d7c9SKumar Gala muram_writew(&pram->rxqd.offset_out, offset_out); 544c916d7c9SKumar Gala sync(); 545c916d7c9SKumar Gala } 546c916d7c9SKumar Gala fm_eth->cur_rxbd = (void *)rxbd; 547c916d7c9SKumar Gala 548c916d7c9SKumar Gala return 1; 549c916d7c9SKumar Gala } 550c916d7c9SKumar Gala 551c916d7c9SKumar Gala static int fm_eth_init_mac(struct fm_eth *fm_eth, struct ccsr_fman *reg) 552c916d7c9SKumar Gala { 553c916d7c9SKumar Gala struct fsl_enet_mac *mac; 554c916d7c9SKumar Gala int num; 555c916d7c9SKumar Gala void *base, *phyregs = NULL; 556c916d7c9SKumar Gala 557c916d7c9SKumar Gala num = fm_eth->num; 558c916d7c9SKumar Gala 559111fd19eSRoy Zang #ifdef CONFIG_SYS_FMAN_V3 560*82a55c1eSShengzhou Liu if (fm_eth->type == FM_ETH_10G_E) { 561*82a55c1eSShengzhou Liu /* 10GEC1/10GEC2 use mEMAC9/mEMAC10 562*82a55c1eSShengzhou Liu * 10GEC3/10GEC4 use mEMAC1/mEMAC2 563*82a55c1eSShengzhou Liu * so it needs to change the num. 564*82a55c1eSShengzhou Liu */ 565*82a55c1eSShengzhou Liu if (fm_eth->num >= 2) 566*82a55c1eSShengzhou Liu num -= 2; 567*82a55c1eSShengzhou Liu else 568944b6ccfSShaohui Xie num += 8; 569*82a55c1eSShengzhou Liu } 570111fd19eSRoy Zang base = ®->memac[num].fm_memac; 571111fd19eSRoy Zang phyregs = ®->memac[num].fm_memac_mdio; 572111fd19eSRoy Zang #else 573c916d7c9SKumar Gala /* Get the mac registers base address */ 574c916d7c9SKumar Gala if (fm_eth->type == FM_ETH_1G_E) { 575c916d7c9SKumar Gala base = ®->mac_1g[num].fm_dtesc; 57630381716STimur Tabi phyregs = ®->mac_1g[num].fm_mdio.miimcfg; 577c916d7c9SKumar Gala } else { 578c916d7c9SKumar Gala base = ®->mac_10g[num].fm_10gec; 579c916d7c9SKumar Gala phyregs = ®->mac_10g[num].fm_10gec_mdio; 580c916d7c9SKumar Gala } 581111fd19eSRoy Zang #endif 582c916d7c9SKumar Gala 583c916d7c9SKumar Gala /* alloc mac controller */ 584c916d7c9SKumar Gala mac = malloc(sizeof(struct fsl_enet_mac)); 585c916d7c9SKumar Gala if (!mac) 586c916d7c9SKumar Gala return 0; 587c916d7c9SKumar Gala memset(mac, 0, sizeof(struct fsl_enet_mac)); 588c916d7c9SKumar Gala 589c916d7c9SKumar Gala /* save the mac to fm_eth struct */ 590c916d7c9SKumar Gala fm_eth->mac = mac; 591c916d7c9SKumar Gala 592111fd19eSRoy Zang #ifdef CONFIG_SYS_FMAN_V3 593111fd19eSRoy Zang init_memac(mac, base, phyregs, MAX_RXBUF_LEN); 594111fd19eSRoy Zang #else 595c916d7c9SKumar Gala if (fm_eth->type == FM_ETH_1G_E) 59630381716STimur Tabi init_dtsec(mac, base, phyregs, MAX_RXBUF_LEN); 597c916d7c9SKumar Gala else 598c916d7c9SKumar Gala init_tgec(mac, base, phyregs, MAX_RXBUF_LEN); 599111fd19eSRoy Zang #endif 600c916d7c9SKumar Gala 601c916d7c9SKumar Gala return 1; 602c916d7c9SKumar Gala } 603c916d7c9SKumar Gala 604c916d7c9SKumar Gala static int init_phy(struct eth_device *dev) 605c916d7c9SKumar Gala { 606c916d7c9SKumar Gala struct fm_eth *fm_eth = dev->priv; 607c916d7c9SKumar Gala struct phy_device *phydev = NULL; 608c916d7c9SKumar Gala u32 supported; 609c916d7c9SKumar Gala 610c916d7c9SKumar Gala #ifdef CONFIG_PHYLIB 611c916d7c9SKumar Gala if (fm_eth->type == FM_ETH_1G_E) 612c916d7c9SKumar Gala dtsec_init_phy(dev); 613c916d7c9SKumar Gala 614c916d7c9SKumar Gala if (fm_eth->bus) { 615c916d7c9SKumar Gala phydev = phy_connect(fm_eth->bus, fm_eth->phyaddr, dev, 616c916d7c9SKumar Gala fm_eth->enet_if); 617c916d7c9SKumar Gala } 618c916d7c9SKumar Gala 619c916d7c9SKumar Gala if (!phydev) { 620c916d7c9SKumar Gala printf("Failed to connect\n"); 621c916d7c9SKumar Gala return -1; 622c916d7c9SKumar Gala } 623c916d7c9SKumar Gala 624c916d7c9SKumar Gala if (fm_eth->type == FM_ETH_1G_E) { 625c916d7c9SKumar Gala supported = (SUPPORTED_10baseT_Half | 626c916d7c9SKumar Gala SUPPORTED_10baseT_Full | 627c916d7c9SKumar Gala SUPPORTED_100baseT_Half | 628c916d7c9SKumar Gala SUPPORTED_100baseT_Full | 629c916d7c9SKumar Gala SUPPORTED_1000baseT_Full); 630c916d7c9SKumar Gala } else { 631c916d7c9SKumar Gala supported = SUPPORTED_10000baseT_Full; 632c916d7c9SKumar Gala 633c916d7c9SKumar Gala if (tgec_is_fibre(dev)) 634c916d7c9SKumar Gala phydev->port = PORT_FIBRE; 635c916d7c9SKumar Gala } 636c916d7c9SKumar Gala 637c916d7c9SKumar Gala phydev->supported &= supported; 638c916d7c9SKumar Gala phydev->advertising = phydev->supported; 639c916d7c9SKumar Gala 640c916d7c9SKumar Gala fm_eth->phydev = phydev; 641c916d7c9SKumar Gala 642c916d7c9SKumar Gala phy_config(phydev); 643c916d7c9SKumar Gala #endif 644c916d7c9SKumar Gala 645c916d7c9SKumar Gala return 0; 646c916d7c9SKumar Gala } 647c916d7c9SKumar Gala 648c916d7c9SKumar Gala int fm_eth_initialize(struct ccsr_fman *reg, struct fm_eth_info *info) 649c916d7c9SKumar Gala { 650c916d7c9SKumar Gala struct eth_device *dev; 651c916d7c9SKumar Gala struct fm_eth *fm_eth; 652c916d7c9SKumar Gala int i, num = info->num; 653c916d7c9SKumar Gala 654c916d7c9SKumar Gala /* alloc eth device */ 655c916d7c9SKumar Gala dev = (struct eth_device *)malloc(sizeof(struct eth_device)); 656c916d7c9SKumar Gala if (!dev) 657c916d7c9SKumar Gala return 0; 658c916d7c9SKumar Gala memset(dev, 0, sizeof(struct eth_device)); 659c916d7c9SKumar Gala 660c916d7c9SKumar Gala /* alloc the FMan ethernet private struct */ 661c916d7c9SKumar Gala fm_eth = (struct fm_eth *)malloc(sizeof(struct fm_eth)); 662c916d7c9SKumar Gala if (!fm_eth) 663c916d7c9SKumar Gala return 0; 664c916d7c9SKumar Gala memset(fm_eth, 0, sizeof(struct fm_eth)); 665c916d7c9SKumar Gala 666c916d7c9SKumar Gala /* save off some things we need from the info struct */ 667c916d7c9SKumar Gala fm_eth->fm_index = info->index - 1; /* keep as 0 based for muram */ 668c916d7c9SKumar Gala fm_eth->num = num; 669c916d7c9SKumar Gala fm_eth->type = info->type; 670c916d7c9SKumar Gala 671c916d7c9SKumar Gala fm_eth->rx_port = (void *)®->port[info->rx_port_id - 1].fm_bmi; 672c916d7c9SKumar Gala fm_eth->tx_port = (void *)®->port[info->tx_port_id - 1].fm_bmi; 673c916d7c9SKumar Gala 674c916d7c9SKumar Gala /* set the ethernet max receive length */ 675c916d7c9SKumar Gala fm_eth->max_rx_len = MAX_RXBUF_LEN; 676c916d7c9SKumar Gala 677c916d7c9SKumar Gala /* init global mac structure */ 678c916d7c9SKumar Gala if (!fm_eth_init_mac(fm_eth, reg)) 679c916d7c9SKumar Gala return 0; 680c916d7c9SKumar Gala 681c916d7c9SKumar Gala /* keep same as the manual, we call FMAN1, FMAN2, DTSEC1, DTSEC2, etc */ 682c916d7c9SKumar Gala if (fm_eth->type == FM_ETH_1G_E) 683c916d7c9SKumar Gala sprintf(dev->name, "FM%d@DTSEC%d", info->index, num + 1); 684c916d7c9SKumar Gala else 685c916d7c9SKumar Gala sprintf(dev->name, "FM%d@TGEC%d", info->index, num + 1); 686c916d7c9SKumar Gala 687c916d7c9SKumar Gala devlist[num_controllers++] = dev; 688c916d7c9SKumar Gala dev->iobase = 0; 689c916d7c9SKumar Gala dev->priv = (void *)fm_eth; 690c916d7c9SKumar Gala dev->init = fm_eth_open; 691c916d7c9SKumar Gala dev->halt = fm_eth_halt; 692c916d7c9SKumar Gala dev->send = fm_eth_send; 693c916d7c9SKumar Gala dev->recv = fm_eth_recv; 694c916d7c9SKumar Gala fm_eth->dev = dev; 695c916d7c9SKumar Gala fm_eth->bus = info->bus; 696c916d7c9SKumar Gala fm_eth->phyaddr = info->phy_addr; 697c916d7c9SKumar Gala fm_eth->enet_if = info->enet_if; 698c916d7c9SKumar Gala 699c916d7c9SKumar Gala /* startup the FM im */ 700c916d7c9SKumar Gala if (!fm_eth_startup(fm_eth)) 701c916d7c9SKumar Gala return 0; 702c916d7c9SKumar Gala 703c916d7c9SKumar Gala if (init_phy(dev)) 704c916d7c9SKumar Gala return 0; 705c916d7c9SKumar Gala 706c916d7c9SKumar Gala /* clear the ethernet address */ 707c916d7c9SKumar Gala for (i = 0; i < 6; i++) 708c916d7c9SKumar Gala dev->enetaddr[i] = 0; 709c916d7c9SKumar Gala eth_register(dev); 710c916d7c9SKumar Gala 711c916d7c9SKumar Gala return 1; 712c916d7c9SKumar Gala } 713