drivers/net/bcm-sf2-eth.c

   1 /*
   2  * Copyright 2014 Broadcom Corporation.
   3  *
   4  * SPDX-License-Identifier:     GPL-2.0+
   5  */
   6
   7 #include <common.h>
   8 #include <malloc.h>
   9 #include <net.h>
  10 #include <config.h>
  11
  12 #include <phy.h>
  13 #include <miiphy.h>
  14
  15 #include <asm/io.h>
  16
  17 #include <netdev.h>
  18 #include "bcm-sf2-eth.h"
  19
  20 #if defined(CONFIG_BCM_SF2_ETH_GMAC)
  21 #include "bcm-sf2-eth-gmac.h"
  22 #else
  23 #error "bcm_sf2_eth: NEED to define a MAC!"
  24 #endif
  25
  26 #define BCM_NET_MODULE_DESCRIPTION      "Broadcom Starfighter2 Ethernet driver"
  27 #define BCM_NET_MODULE_VERSION          "0.1"
  28 #define BCM_SF2_ETH_DEV_NAME            "bcm_sf2"
  29
  30 static const char banner[] =
  31         BCM_NET_MODULE_DESCRIPTION " " BCM_NET_MODULE_VERSION "\n";
  32
  33 static int bcm_sf2_eth_init(struct eth_device *dev)
  34 {
  35         struct eth_info *eth = (struct eth_info *)(dev->priv);
  36         struct eth_dma *dma = &(eth->dma);
  37         struct phy_device *phydev;
  38         int rc = 0;
  39         int i;
  40
  41         rc = eth->mac_init(dev);
  42         if (rc) {
  43                 error("%s: Couldn't cofigure MAC!\n", __func__);
  44                 return rc;
  45         }
  46
  47         /* disable DMA */
  48         dma->disable_dma(dma, MAC_DMA_RX);
  49         dma->disable_dma(dma, MAC_DMA_TX);
  50
  51         eth->port_num = 0;
  52         debug("Connecting PHY 0...\n");
  53         phydev = phy_connect(miiphy_get_dev_by_name(dev->name),
  54                              0, dev, eth->phy_interface);
  55         if (phydev != NULL) {
  56                 eth->port[0] = phydev;
  57                 eth->port_num += 1;
  58         } else {
  59                 debug("No PHY found for port 0\n");
  60         }
  61
  62         for (i = 0; i < eth->port_num; i++)
  63                 phy_config(eth->port[i]);
  64
  65         return rc;
  66 }
  67
  68 /*
  69  * u-boot net functions
  70  */
  71
  72 static int bcm_sf2_eth_send(struct eth_device *dev, void *packet, int length)
  73 {
  74         struct eth_dma *dma = &(((struct eth_info *)(dev->priv))->dma);
  75         uint8_t *buf = (uint8_t *)packet;
  76         int rc = 0;
  77         int i = 0;
  78
  79         debug("%s enter\n", __func__);
  80
  81         /* load buf and start transmit */
  82         rc = dma->tx_packet(dma, buf, length);
  83         if (rc) {
  84                 debug("ERROR - Tx failed\n");
  85                 return rc;
  86         }
  87
  88         while (!(dma->check_tx_done(dma))) {
  89                 udelay(100);
  90                 debug(".");
  91                 i++;
  92                 if (i > 20) {
  93                         error("%s: Tx timeout: retried 20 times\n", __func__);
  94                         rc = -1;
  95                         break;
  96                 }
  97         }
  98
  99         debug("%s exit rc(0x%x)\n", __func__, rc);
 100         return rc;
 101 }
 102
 103 static int bcm_sf2_eth_receive(struct eth_device *dev)
 104 {
 105         struct eth_dma *dma = &(((struct eth_info *)(dev->priv))->dma);
 106         uint8_t *buf = (uint8_t *)net_rx_packets[0];
 107         int rcvlen;
 108         int rc = 0;
 109         int i = 0;
 110
 111         while (1) {
 112                 /* Poll Rx queue to get a packet */
 113                 rcvlen = dma->check_rx_done(dma, buf);
 114                 if (rcvlen < 0) {
 115                         /* No packet received */
 116                         rc = -1;
 117                         debug("\nNO More Rx\n");
 118                         break;
 119                 } else if ((rcvlen == 0) || (rcvlen > RX_BUF_SIZE)) {
 120                         error("%s: Wrong Ethernet packet size (%d B), skip!\n",
 121                               __func__, rcvlen);
 122                         break;
 123                 } else {
 124                         debug("recieved\n");
 125
 126                         /* Forward received packet to uboot network handler */
 127                         net_process_received_packet(buf, rcvlen);
 128
 129                         if (++i >= PKTBUFSRX)
 130                                 i = 0;
 131                         buf = net_rx_packets[i];
 132                 }
 133         }
 134
 135         return rc;
 136 }
 137
 138 static int bcm_sf2_eth_write_hwaddr(struct eth_device *dev)
 139 {
 140         struct eth_info *eth = (struct eth_info *)(dev->priv);
 141
 142         printf(" ETH MAC: %02x:%02x:%02x:%02x:%02x:%02x\n",
 143                dev->enetaddr[0], dev->enetaddr[1], dev->enetaddr[2],
 144                dev->enetaddr[3], dev->enetaddr[4], dev->enetaddr[5]);
 145
 146         return eth->set_mac_addr(dev->enetaddr);
 147 }
 148
 149 static int bcm_sf2_eth_open(struct eth_device *dev, bd_t *bt)
 150 {
 151         struct eth_info *eth = (struct eth_info *)(dev->priv);
 152         struct eth_dma *dma = &(eth->dma);
 153         int i;
 154
 155         debug("Enabling BCM SF2 Ethernet.\n");
 156
 157         /* Set MAC address from env */
 158         if (bcm_sf2_eth_write_hwaddr(dev) != 0) {
 159                 error("%s: MAC set error when opening !\n", __func__);
 160                 return -1;
 161         }
 162
 163         eth->enable_mac();
 164
 165         /* enable tx and rx DMA */
 166         dma->enable_dma(dma, MAC_DMA_RX);
 167         dma->enable_dma(dma, MAC_DMA_TX);
 168
 169         /*
 170          * Need to start PHY here because link speed can change
 171          * before each ethernet operation
 172          */
 173         for (i = 0; i < eth->port_num; i++) {
 174                 if (phy_startup(eth->port[i])) {
 175                         error("%s: PHY %d startup failed!\n", __func__, i);
 176                         if (i == CONFIG_BCM_SF2_ETH_DEFAULT_PORT) {
 177                                 error("%s: No default port %d!\n", __func__, i);
 178                                 return -1;
 179                         }
 180                 }
 181         }
 182
 183         /* Set MAC speed using default port */
 184         i = CONFIG_BCM_SF2_ETH_DEFAULT_PORT;
 185         debug("PHY %d: speed:%d, duplex:%d, link:%d\n", i,
 186               eth->port[i]->speed, eth->port[i]->duplex, eth->port[i]->link);
 187         eth->set_mac_speed(eth->port[i]->speed, eth->port[i]->duplex);
 188
 189         debug("Enable Ethernet Done.\n");
 190
 191         return 0;
 192 }
 193
 194 static void bcm_sf2_eth_close(struct eth_device *dev)
 195 {
 196         struct eth_info *eth = (struct eth_info *)(dev->priv);
 197         struct eth_dma *dma = &(eth->dma);
 198
 199         /* disable DMA */
 200         dma->disable_dma(dma, MAC_DMA_RX);
 201         dma->disable_dma(dma, MAC_DMA_TX);
 202
 203         eth->disable_mac();
 204 }
 205
 206 int bcm_sf2_eth_register(bd_t *bis, u8 dev_num)
 207 {
 208         struct eth_device *dev;
 209         struct eth_info *eth;
 210         int rc;
 211
 212         dev = (struct eth_device *)malloc(sizeof(struct eth_device));
 213         if (dev == NULL) {
 214                 error("%s: Not enough memory!\n", __func__);
 215                 return -1;
 216         }
 217
 218         eth = (struct eth_info *)malloc(sizeof(struct eth_info));
 219         if (eth == NULL) {
 220                 error("%s: Not enough memory!\n", __func__);
 221                 return -1;
 222         }
 223
 224         printf(banner);
 225
 226         memset(dev, 0, sizeof(*dev));
 227         sprintf(dev->name, "%s_%s-%hu", BCM_SF2_ETH_DEV_NAME,
 228                 BCM_SF2_ETH_MAC_NAME, dev_num);
 229
 230         dev->priv = (void *)eth;
 231         dev->iobase = 0;
 232
 233         dev->init = bcm_sf2_eth_open;
 234         dev->halt = bcm_sf2_eth_close;
 235         dev->send = bcm_sf2_eth_send;
 236         dev->recv = bcm_sf2_eth_receive;
 237         dev->write_hwaddr = bcm_sf2_eth_write_hwaddr;
 238
 239 #ifdef CONFIG_BCM_SF2_ETH_GMAC
 240         if (gmac_add(dev)) {
 241                 free(eth);
 242                 free(dev);
 243                 error("%s: Adding GMAC failed!\n", __func__);
 244                 return -1;
 245         }
 246 #else
 247 #error "bcm_sf2_eth: NEED to register a MAC!"
 248 #endif
 249
 250         eth_register(dev);
 251
 252 #ifdef CONFIG_CMD_MII
 253         miiphy_register(dev->name, eth->miiphy_read, eth->miiphy_write);
 254 #endif
 255
 256         /* Initialization */
 257         debug("Ethernet initialization ...");
 258
 259         rc = bcm_sf2_eth_init(dev);
 260         if (rc != 0) {
 261                 error("%s: configuration failed!\n", __func__);
 262                 return -1;
 263         }
 264
 265         printf("Basic ethernet functionality initialized\n");
 266
 267         return 0;
 268 }