memac.c 3.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Copyright 2012 Freescale Semiconductor, Inc.
  4. * Roy Zang <tie-fei.zang@freescale.com>
  5. */
  6. /* MAXFRM - maximum frame length */
  7. #define MAXFRM_MASK 0x0000ffff
  8. #include <common.h>
  9. #include <log.h>
  10. #include <phy.h>
  11. #include <asm/types.h>
  12. #include <asm/io.h>
  13. #include <fsl_memac.h>
  14. #include "fm.h"
  15. static void memac_init_mac(struct fsl_enet_mac *mac)
  16. {
  17. struct memac *regs = mac->base;
  18. /* mask all interrupt */
  19. out_be32(&regs->imask, IMASK_MASK_ALL);
  20. /* clear all events */
  21. out_be32(&regs->ievent, IEVENT_CLEAR_ALL);
  22. /* set the max receive length */
  23. out_be32(&regs->maxfrm, mac->max_rx_len & MAXFRM_MASK);
  24. /* multicast frame reception for the hash entry disable */
  25. out_be32(&regs->hashtable_ctrl, 0);
  26. }
  27. static void memac_enable_mac(struct fsl_enet_mac *mac)
  28. {
  29. struct memac *regs = mac->base;
  30. setbits_be32(&regs->command_config,
  31. MEMAC_CMD_CFG_RXTX_EN | MEMAC_CMD_CFG_NO_LEN_CHK);
  32. }
  33. static void memac_disable_mac(struct fsl_enet_mac *mac)
  34. {
  35. struct memac *regs = mac->base;
  36. clrbits_be32(&regs->command_config, MEMAC_CMD_CFG_RXTX_EN);
  37. }
  38. static void memac_set_mac_addr(struct fsl_enet_mac *mac, u8 *mac_addr)
  39. {
  40. struct memac *regs = mac->base;
  41. u32 mac_addr0, mac_addr1;
  42. /*
  43. * if a station address of 0x12345678ABCD, perform a write to
  44. * MAC_ADDR0 of 0x78563412, MAC_ADDR1 of 0x0000CDAB
  45. */
  46. mac_addr0 = (mac_addr[3] << 24) | (mac_addr[2] << 16) | \
  47. (mac_addr[1] << 8) | (mac_addr[0]);
  48. out_be32(&regs->mac_addr_0, mac_addr0);
  49. mac_addr1 = ((mac_addr[5] << 8) | mac_addr[4]) & 0x0000ffff;
  50. out_be32(&regs->mac_addr_1, mac_addr1);
  51. }
  52. static void memac_set_interface_mode(struct fsl_enet_mac *mac,
  53. phy_interface_t type, int speed)
  54. {
  55. /* Roy need more work here */
  56. struct memac *regs = mac->base;
  57. u32 if_mode, if_status;
  58. /* clear all bits relative with interface mode */
  59. if_mode = in_be32(&regs->if_mode);
  60. if_status = in_be32(&regs->if_status);
  61. /* set interface mode */
  62. switch (type) {
  63. case PHY_INTERFACE_MODE_GMII:
  64. if_mode &= ~IF_MODE_MASK;
  65. if_mode |= IF_MODE_GMII;
  66. break;
  67. case PHY_INTERFACE_MODE_RGMII:
  68. case PHY_INTERFACE_MODE_RGMII_ID:
  69. case PHY_INTERFACE_MODE_RGMII_RXID:
  70. case PHY_INTERFACE_MODE_RGMII_TXID:
  71. if_mode |= (IF_MODE_GMII | IF_MODE_RG);
  72. break;
  73. case PHY_INTERFACE_MODE_RMII:
  74. if_mode |= (IF_MODE_GMII | IF_MODE_RM);
  75. break;
  76. case PHY_INTERFACE_MODE_SGMII:
  77. case PHY_INTERFACE_MODE_SGMII_2500:
  78. case PHY_INTERFACE_MODE_QSGMII:
  79. if_mode &= ~IF_MODE_MASK;
  80. if_mode |= (IF_MODE_GMII);
  81. break;
  82. case PHY_INTERFACE_MODE_XFI:
  83. case PHY_INTERFACE_MODE_XGMII:
  84. if_mode &= ~IF_MODE_MASK;
  85. if_mode |= IF_MODE_XGMII;
  86. break;
  87. default:
  88. break;
  89. }
  90. /* Enable automatic speed selection for Non-XGMII */
  91. if (type != PHY_INTERFACE_MODE_XGMII && type != PHY_INTERFACE_MODE_XFI)
  92. if_mode |= IF_MODE_EN_AUTO;
  93. if (type == PHY_INTERFACE_MODE_RGMII ||
  94. type == PHY_INTERFACE_MODE_RGMII_ID ||
  95. type == PHY_INTERFACE_MODE_RGMII_RXID ||
  96. type == PHY_INTERFACE_MODE_RGMII_TXID) {
  97. if_mode &= ~IF_MODE_EN_AUTO;
  98. if_mode &= ~IF_MODE_SETSP_MASK;
  99. switch (speed) {
  100. case SPEED_1000:
  101. if_mode |= IF_MODE_SETSP_1000M;
  102. break;
  103. case SPEED_100:
  104. if_mode |= IF_MODE_SETSP_100M;
  105. break;
  106. case SPEED_10:
  107. if_mode |= IF_MODE_SETSP_10M;
  108. default:
  109. break;
  110. }
  111. }
  112. debug(" %s, if_mode = %x\n", __func__, if_mode);
  113. debug(" %s, if_status = %x\n", __func__, if_status);
  114. out_be32(&regs->if_mode, if_mode);
  115. return;
  116. }
  117. void init_memac(struct fsl_enet_mac *mac, void *base,
  118. void *phyregs, int max_rx_len)
  119. {
  120. debug("%s: @ %p, mdio @ %p\n", __func__, base, phyregs);
  121. mac->base = base;
  122. mac->phyregs = phyregs;
  123. mac->max_rx_len = max_rx_len;
  124. mac->init_mac = memac_init_mac;
  125. mac->enable_mac = memac_enable_mac;
  126. mac->disable_mac = memac_disable_mac;
  127. mac->set_mac_addr = memac_set_mac_addr;
  128. mac->set_if_mode = memac_set_interface_mode;
  129. }