ba1a170abcccd49411f4c466d0c99f78e79b9c0d
2 * This program is free software; you can redistribute it and/or modify
3 * it under the terms of the GNU General Public License as published by
4 * the Free Software Foundation; version 2 of the License
6 * This program is distributed in the hope that it will be useful,
7 * but WITHOUT ANY WARRANTY; without even the implied warranty of
8 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
9 * GNU General Public License for more details.
11 * You should have received a copy of the GNU General Public License
12 * along with this program; if not, write to the Free Software
13 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307, USA.
15 * Copyright (C) 2009-2013 John Crispin <blogic@openwrt.org>
18 #include <linux/module.h>
19 #include <linux/platform_device.h>
20 #include <linux/if_vlan.h>
22 #include <asm/mach-ralink/ralink_regs.h>
25 #include "ralink_soc_eth.h"
26 #include "gsw_mt7620a.h"
28 #define MT7620A_CDMA_CSG_CFG 0x400
29 #define MT7620_DMA_VID (MT7620A_CDMA_CSG_CFG | 0x30)
30 #define MT7621_DMA_VID 0xa8
31 #define MT7620A_DMA_2B_OFFSET BIT(31)
32 #define MT7620A_RESET_FE BIT(21)
33 #define MT7621_RESET_FE BIT(6)
34 #define MT7620A_RESET_ESW BIT(23)
35 #define MT7620_L4_VALID BIT(23)
36 #define MT7621_L4_VALID BIT(24)
38 #define MT7620_TX_DMA_UDF BIT(15)
39 #define MT7621_TX_DMA_UDF BIT(19)
40 #define TX_DMA_FP_BMAP ((0xff) << 19)
42 #define SYSC_REG_RESET_CTRL 0x34
44 #define CDMA_ICS_EN BIT(2)
45 #define CDMA_UCS_EN BIT(1)
46 #define CDMA_TCS_EN BIT(0)
48 #define GDMA_ICS_EN BIT(22)
49 #define GDMA_TCS_EN BIT(21)
50 #define GDMA_UCS_EN BIT(20)
52 /* frame engine counters */
53 #define MT7620_REG_MIB_OFFSET 0x1000
54 #define MT7620_PPE_AC_BCNT0 (MT7620_REG_MIB_OFFSET + 0x00)
55 #define MT7620_GDM1_TX_GBCNT (MT7620_REG_MIB_OFFSET + 0x300)
56 #define MT7620_GDM2_TX_GBCNT (MT7620_GDM1_TX_GBCNT + 0x40)
58 #define MT7621_REG_MIB_OFFSET 0x2000
59 #define MT7621_PPE_AC_BCNT0 (MT7621_REG_MIB_OFFSET + 0x00)
60 #define MT7621_GDM1_TX_GBCNT (MT7621_REG_MIB_OFFSET + 0x400)
61 #define MT7621_GDM2_TX_GBCNT (MT7621_GDM1_TX_GBCNT + 0x40)
63 #define GSW_REG_GDMA1_MAC_ADRL 0x508
64 #define GSW_REG_GDMA1_MAC_ADRH 0x50C
66 #define MT7621_FE_RST_GL (FE_FE_OFFSET + 0x04)
68 static const u32 mt7620_reg_table
[FE_REG_COUNT
] = {
69 [FE_REG_PDMA_GLO_CFG
] = RT5350_PDMA_GLO_CFG
,
70 [FE_REG_PDMA_RST_CFG
] = RT5350_PDMA_RST_CFG
,
71 [FE_REG_DLY_INT_CFG
] = RT5350_DLY_INT_CFG
,
72 [FE_REG_TX_BASE_PTR0
] = RT5350_TX_BASE_PTR0
,
73 [FE_REG_TX_MAX_CNT0
] = RT5350_TX_MAX_CNT0
,
74 [FE_REG_TX_CTX_IDX0
] = RT5350_TX_CTX_IDX0
,
75 [FE_REG_RX_BASE_PTR0
] = RT5350_RX_BASE_PTR0
,
76 [FE_REG_RX_MAX_CNT0
] = RT5350_RX_MAX_CNT0
,
77 [FE_REG_RX_CALC_IDX0
] = RT5350_RX_CALC_IDX0
,
78 [FE_REG_FE_INT_ENABLE
] = RT5350_FE_INT_ENABLE
,
79 [FE_REG_FE_INT_STATUS
] = RT5350_FE_INT_STATUS
,
80 [FE_REG_FE_DMA_VID_BASE
] = MT7620_DMA_VID
,
81 [FE_REG_FE_COUNTER_BASE
] = MT7620_GDM1_TX_GBCNT
,
82 [FE_REG_FE_RST_GL
] = MT7621_FE_RST_GL
,
85 static const u32 mt7621_reg_table
[FE_REG_COUNT
] = {
86 [FE_REG_PDMA_GLO_CFG
] = RT5350_PDMA_GLO_CFG
,
87 [FE_REG_PDMA_RST_CFG
] = RT5350_PDMA_RST_CFG
,
88 [FE_REG_DLY_INT_CFG
] = RT5350_DLY_INT_CFG
,
89 [FE_REG_TX_BASE_PTR0
] = RT5350_TX_BASE_PTR0
,
90 [FE_REG_TX_MAX_CNT0
] = RT5350_TX_MAX_CNT0
,
91 [FE_REG_TX_CTX_IDX0
] = RT5350_TX_CTX_IDX0
,
92 [FE_REG_RX_BASE_PTR0
] = RT5350_RX_BASE_PTR0
,
93 [FE_REG_RX_MAX_CNT0
] = RT5350_RX_MAX_CNT0
,
94 [FE_REG_RX_CALC_IDX0
] = RT5350_RX_CALC_IDX0
,
95 [FE_REG_FE_INT_ENABLE
] = RT5350_FE_INT_ENABLE
,
96 [FE_REG_FE_INT_STATUS
] = RT5350_FE_INT_STATUS
,
97 [FE_REG_FE_DMA_VID_BASE
] = MT7621_DMA_VID
,
98 [FE_REG_FE_COUNTER_BASE
] = MT7621_GDM1_TX_GBCNT
,
99 [FE_REG_FE_RST_GL
] = MT7621_FE_RST_GL
,
102 static void mt7620_fe_reset(void)
104 u32 val
= rt_sysc_r32(SYSC_REG_RESET_CTRL
);
106 rt_sysc_w32(val
| MT7620A_RESET_FE
| MT7620A_RESET_ESW
, SYSC_REG_RESET_CTRL
);
107 rt_sysc_w32(val
, SYSC_REG_RESET_CTRL
);
110 static void mt7621_fe_reset(void)
112 u32 val
= rt_sysc_r32(SYSC_REG_RESET_CTRL
);
114 rt_sysc_w32(val
| MT7621_RESET_FE
, SYSC_REG_RESET_CTRL
);
115 rt_sysc_w32(val
, SYSC_REG_RESET_CTRL
);
118 static void mt7620_rxcsum_config(bool enable
)
121 fe_w32(fe_r32(MT7620A_GDMA1_FWD_CFG
) | (GDMA_ICS_EN
|
122 GDMA_TCS_EN
| GDMA_UCS_EN
),
123 MT7620A_GDMA1_FWD_CFG
);
125 fe_w32(fe_r32(MT7620A_GDMA1_FWD_CFG
) & ~(GDMA_ICS_EN
|
126 GDMA_TCS_EN
| GDMA_UCS_EN
),
127 MT7620A_GDMA1_FWD_CFG
);
130 static void mt7620_txcsum_config(bool enable
)
133 fe_w32(fe_r32(MT7620A_CDMA_CSG_CFG
) | (CDMA_ICS_EN
|
134 CDMA_UCS_EN
| CDMA_TCS_EN
),
135 MT7620A_CDMA_CSG_CFG
);
137 fe_w32(fe_r32(MT7620A_CDMA_CSG_CFG
) & ~(CDMA_ICS_EN
|
138 CDMA_UCS_EN
| CDMA_TCS_EN
),
139 MT7620A_CDMA_CSG_CFG
);
142 static int mt7620_fwd_config(struct fe_priv
*priv
)
144 struct net_device
*dev
= priv_netdev(priv
);
146 fe_w32(fe_r32(MT7620A_GDMA1_FWD_CFG
) & ~7, MT7620A_GDMA1_FWD_CFG
);
148 mt7620_txcsum_config((dev
->features
& NETIF_F_IP_CSUM
));
149 mt7620_rxcsum_config((dev
->features
& NETIF_F_RXCSUM
));
154 static int mt7621_fwd_config(struct fe_priv
*priv
)
156 struct net_device
*dev
= priv_netdev(priv
);
158 fe_w32(fe_r32(MT7620A_GDMA1_FWD_CFG
) & ~0xffff, MT7620A_GDMA1_FWD_CFG
);
160 mt7620_txcsum_config((dev
->features
& NETIF_F_IP_CSUM
));
161 mt7620_rxcsum_config((dev
->features
& NETIF_F_RXCSUM
));
166 static void mt7620_tx_dma(struct fe_priv
*priv
, int idx
, struct sk_buff
*skb
)
168 priv
->tx_dma
[idx
].txd4
= 0;
171 static void mt7621_tx_dma(struct fe_priv
*priv
, int idx
, struct sk_buff
*skb
)
173 priv
->tx_dma
[idx
].txd4
= BIT(25);
176 static void mt7620_rx_dma(struct fe_priv
*priv
, int idx
, int len
)
178 priv
->rx_dma
[idx
].rxd2
= RX_DMA_PLEN0(len
);
181 static void mt7620_init_data(struct fe_soc_data
*data
,
182 struct net_device
*netdev
)
184 struct fe_priv
*priv
= netdev_priv(netdev
);
186 priv
->flags
= FE_FLAG_PADDING_64B
;
187 netdev
->hw_features
= NETIF_F_IP_CSUM
| NETIF_F_RXCSUM
|
188 NETIF_F_HW_VLAN_CTAG_TX
;
190 if (mt7620_get_eco() >= 5 || IS_ENABLED(CONFIG_SOC_MT7621
))
191 netdev
->hw_features
|= NETIF_F_SG
| NETIF_F_TSO
| NETIF_F_TSO6
|
195 static void mt7621_set_mac(struct fe_priv
*priv
, unsigned char *mac
)
199 spin_lock_irqsave(&priv
->page_lock
, flags
);
200 fe_w32((mac
[0] << 8) | mac
[1], GSW_REG_GDMA1_MAC_ADRH
);
201 fe_w32((mac
[2] << 24) | (mac
[3] << 16) | (mac
[4] << 8) | mac
[5],
202 GSW_REG_GDMA1_MAC_ADRL
);
203 spin_unlock_irqrestore(&priv
->page_lock
, flags
);
206 static struct fe_soc_data mt7620_data
= {
207 .mac
= { 0x00, 0x11, 0x22, 0x33, 0x44, 0x55 },
208 .init_data
= mt7620_init_data
,
209 .reset_fe
= mt7620_fe_reset
,
210 .set_mac
= mt7620_set_mac
,
211 .fwd_config
= mt7620_fwd_config
,
212 .tx_dma
= mt7620_tx_dma
,
213 .rx_dma
= mt7620_rx_dma
,
214 .switch_init
= mt7620_gsw_probe
,
215 .switch_config
= mt7620_gsw_config
,
216 .port_init
= mt7620_port_init
,
217 .reg_table
= mt7620_reg_table
,
218 .pdma_glo_cfg
= FE_PDMA_SIZE_16DWORDS
| MT7620A_DMA_2B_OFFSET
,
219 .rx_dly_int
= RT5350_RX_DLY_INT
,
220 .tx_dly_int
= RT5350_TX_DLY_INT
,
221 .checksum_bit
= MT7620_L4_VALID
,
222 .tx_udf_bit
= MT7620_TX_DMA_UDF
,
223 .has_carrier
= mt7620a_has_carrier
,
224 .mdio_read
= mt7620_mdio_read
,
225 .mdio_write
= mt7620_mdio_write
,
226 .mdio_adjust_link
= mt7620_mdio_link_adjust
,
229 static struct fe_soc_data mt7621_data
= {
230 .mac
= { 0x00, 0x11, 0x22, 0x33, 0x44, 0x55 },
231 .init_data
= mt7620_init_data
,
232 .reset_fe
= mt7621_fe_reset
,
233 .set_mac
= mt7621_set_mac
,
234 .fwd_config
= mt7621_fwd_config
,
235 .tx_dma
= mt7621_tx_dma
,
236 .rx_dma
= mt7620_rx_dma
,
237 .switch_init
= mt7620_gsw_probe
,
238 .switch_config
= mt7621_gsw_config
,
239 .reg_table
= mt7621_reg_table
,
240 .pdma_glo_cfg
= FE_PDMA_SIZE_16DWORDS
| MT7620A_DMA_2B_OFFSET
,
241 .rx_dly_int
= RT5350_RX_DLY_INT
,
242 .tx_dly_int
= RT5350_TX_DLY_INT
,
243 .checksum_bit
= MT7621_L4_VALID
,
244 .tx_udf_bit
= MT7621_TX_DMA_UDF
,
245 .has_carrier
= mt7620a_has_carrier
,
246 .mdio_read
= mt7620_mdio_read
,
247 .mdio_write
= mt7620_mdio_write
,
248 .mdio_adjust_link
= mt7620_mdio_link_adjust
,
251 const struct of_device_id of_fe_match
[] = {
252 { .compatible
= "ralink,mt7620a-eth", .data
= &mt7620_data
},
253 { .compatible
= "ralink,mt7621-eth", .data
= &mt7621_data
},
257 MODULE_DEVICE_TABLE(of
, of_fe_match
);