1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Copyright (C) 2023, Intel Corporation 4 * stmmac EST(802.3 Qbv) handling 5 */ 6 #include <linux/iopoll.h> 7 #include <linux/types.h> 8 #include "stmmac.h" 9 #include "stmmac_est.h" 10 11 static int est_write(void __iomem *est_addr, u32 reg, u32 val, bool gcl) 12 { 13 u32 ctrl; 14 15 writel(val, est_addr + EST_GCL_DATA); 16 17 ctrl = (reg << EST_ADDR_SHIFT); 18 ctrl |= gcl ? 0 : EST_GCRR; 19 writel(ctrl, est_addr + EST_GCL_CONTROL); 20 21 ctrl |= EST_SRWO; 22 writel(ctrl, est_addr + EST_GCL_CONTROL); 23 24 return readl_poll_timeout(est_addr + EST_GCL_CONTROL, ctrl, 25 !(ctrl & EST_SRWO), 100, 5000); 26 } 27 28 static int est_configure(struct stmmac_priv *priv, struct stmmac_est *cfg, 29 unsigned int ptp_rate) 30 { 31 void __iomem *est_addr = priv->estaddr; 32 int i, ret = 0; 33 u32 ctrl; 34 35 ret |= est_write(est_addr, EST_BTR_LOW, cfg->btr[0], false); 36 ret |= est_write(est_addr, EST_BTR_HIGH, cfg->btr[1], false); 37 ret |= est_write(est_addr, EST_TER, cfg->ter, false); 38 ret |= est_write(est_addr, EST_LLR, cfg->gcl_size, false); 39 ret |= est_write(est_addr, EST_CTR_LOW, cfg->ctr[0], false); 40 ret |= est_write(est_addr, EST_CTR_HIGH, cfg->ctr[1], false); 41 if (ret) 42 return ret; 43 44 for (i = 0; i < cfg->gcl_size; i++) { 45 ret = est_write(est_addr, i, cfg->gcl[i], true); 46 if (ret) 47 return ret; 48 } 49 50 ctrl = readl(est_addr + EST_CONTROL); 51 if (priv->plat->has_xgmac) { 52 ctrl &= ~EST_XGMAC_PTOV; 53 ctrl |= ((NSEC_PER_SEC / ptp_rate) * EST_XGMAC_PTOV_MUL) << 54 EST_XGMAC_PTOV_SHIFT; 55 } else { 56 ctrl &= ~EST_GMAC5_PTOV; 57 ctrl |= ((NSEC_PER_SEC / ptp_rate) * EST_GMAC5_PTOV_MUL) << 58 EST_GMAC5_PTOV_SHIFT; 59 } 60 if (cfg->enable) 61 ctrl |= EST_EEST | EST_SSWL; 62 else 63 ctrl &= ~EST_EEST; 64 65 writel(ctrl, est_addr + EST_CONTROL); 66 67 /* Configure EST interrupt */ 68 if (cfg->enable) 69 ctrl = EST_IECGCE | EST_IEHS | EST_IEHF | EST_IEBE | EST_IECC; 70 else 71 ctrl = 0; 72 73 writel(ctrl, est_addr + EST_INT_EN); 74 75 return 0; 76 } 77 78 static void est_irq_status(struct stmmac_priv *priv, struct net_device *dev, 79 struct stmmac_extra_stats *x, u32 txqcnt) 80 { 81 u32 status, value, feqn, hbfq, hbfs, btrl, btrl_max; 82 void __iomem *est_addr = priv->estaddr; 83 u32 txqcnt_mask = BIT(txqcnt) - 1; 84 85 status = readl(est_addr + EST_STATUS); 86 87 value = EST_CGCE | EST_HLBS | EST_HLBF | EST_BTRE | EST_SWLC; 88 89 /* Return if there is no error */ 90 if (!(status & value)) 91 return; 92 93 if (status & EST_CGCE) { 94 /* Clear Interrupt */ 95 writel(EST_CGCE, est_addr + EST_STATUS); 96 97 x->mtl_est_cgce++; 98 } 99 100 if (status & EST_HLBS) { 101 value = readl(est_addr + EST_SCH_ERR); 102 value &= txqcnt_mask; 103 104 x->mtl_est_hlbs++; 105 106 /* Clear Interrupt */ 107 writel(value, est_addr + EST_SCH_ERR); 108 109 /* Collecting info to shows all the queues that has HLBS 110 * issue. The only way to clear this is to clear the 111 * statistic 112 */ 113 if (net_ratelimit()) 114 netdev_err(dev, "EST: HLB(sched) Queue 0x%x\n", value); 115 } 116 117 if (status & EST_HLBF) { 118 value = readl(est_addr + EST_FRM_SZ_ERR); 119 feqn = value & txqcnt_mask; 120 121 value = readl(est_addr + EST_FRM_SZ_CAP); 122 hbfq = (value & EST_SZ_CAP_HBFQ_MASK(txqcnt)) >> 123 EST_SZ_CAP_HBFQ_SHIFT; 124 hbfs = value & EST_SZ_CAP_HBFS_MASK; 125 126 x->mtl_est_hlbf++; 127 128 /* Clear Interrupt */ 129 writel(feqn, est_addr + EST_FRM_SZ_ERR); 130 131 if (net_ratelimit()) 132 netdev_err(dev, "EST: HLB(size) Queue %u Size %u\n", 133 hbfq, hbfs); 134 } 135 136 if (status & EST_BTRE) { 137 if (priv->plat->has_xgmac) { 138 btrl = FIELD_GET(EST_XGMAC_BTRL, status); 139 btrl_max = FIELD_MAX(EST_XGMAC_BTRL); 140 } else { 141 btrl = FIELD_GET(EST_GMAC5_BTRL, status); 142 btrl_max = FIELD_MAX(EST_GMAC5_BTRL); 143 } 144 if (btrl == btrl_max) 145 x->mtl_est_btrlm++; 146 else 147 x->mtl_est_btre++; 148 149 if (net_ratelimit()) 150 netdev_info(dev, "EST: BTR Error Loop Count %u\n", 151 btrl); 152 153 writel(EST_BTRE, est_addr + EST_STATUS); 154 } 155 156 if (status & EST_SWLC) { 157 writel(EST_SWLC, est_addr + EST_STATUS); 158 netdev_info(dev, "EST: SWOL has been switched\n"); 159 } 160 } 161 162 const struct stmmac_est_ops dwmac510_est_ops = { 163 .configure = est_configure, 164 .irq_status = est_irq_status, 165 }; 166