bcm-sf2-eth.c 5.8 KB

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