forked from Openwrt/openwrt
fb2c6e9d4d
Removed because they are upstream: generic/backport-5.15/704-15-v5.19-net-mtk_eth_soc-move-MAC_MCR-setting-to-mac_finish.patch https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git/commit/?h=linux-5.15.y&id=c5c0760adc260d55265c086b9efb350ea6dda38b generic/pending-5.15/735-net-mediatek-mtk_eth_soc-release-MAC_MCR_FORCE_LINK-.patch https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git/commit/?h=linux-5.15.y&id=448cc8b5f743985f6d1d98aa4efb386fef4c3bf2 generic/pending-5.15/736-net-ethernet-mtk_eth_soc-fix-PPE-hanging-issue.patch https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git/commit/?h=linux-5.15.y&id=9fcadd125044007351905d40c405fadc2d3bb6d6 Add new configuration symbols for tegra target. Signed-off-by: Hauke Mehrtens <hauke@hauke-m.de>
883 lines
29 KiB
Diff
883 lines
29 KiB
Diff
From 93408c858e5dc01d97c55efa721268f63fde2ae5 Mon Sep 17 00:00:00 2001
|
|
Message-Id: <93408c858e5dc01d97c55efa721268f63fde2ae5.1662886034.git.lorenzo@kernel.org>
|
|
In-Reply-To: <e5ecb4f619197b93fa682d722452dc8412864cdb.1662886033.git.lorenzo@kernel.org>
|
|
References: <e5ecb4f619197b93fa682d722452dc8412864cdb.1662886033.git.lorenzo@kernel.org>
|
|
From: Lorenzo Bianconi <lorenzo@kernel.org>
|
|
Date: Sat, 3 Sep 2022 18:34:09 +0200
|
|
Subject: [PATCH net-next 4/5] net: ethernet: mtk_eth_soc: introduce flow
|
|
offloading support for mt7986
|
|
|
|
Introduce hw flow offload support for mt7986 chipset. PPE is not enabled
|
|
yet in mt7986 since mt76 support is not available yet.
|
|
|
|
Co-developed-by: Bo Jiao <Bo.Jiao@mediatek.com>
|
|
Signed-off-by: Bo Jiao <Bo.Jiao@mediatek.com>
|
|
Co-developed-by: Sujuan Chen <sujuan.chen@mediatek.com>
|
|
Signed-off-by: Sujuan Chen <sujuan.chen@mediatek.com>
|
|
Signed-off-by: Lorenzo Bianconi <lorenzo@kernel.org>
|
|
---
|
|
drivers/net/ethernet/mediatek/mtk_eth_soc.c | 11 +-
|
|
drivers/net/ethernet/mediatek/mtk_eth_soc.h | 72 ++++++
|
|
drivers/net/ethernet/mediatek/mtk_ppe.c | 213 +++++++++++-------
|
|
drivers/net/ethernet/mediatek/mtk_ppe.h | 52 ++++-
|
|
.../net/ethernet/mediatek/mtk_ppe_offload.c | 49 ++--
|
|
drivers/net/ethernet/mediatek/mtk_ppe_regs.h | 8 +
|
|
6 files changed, 289 insertions(+), 116 deletions(-)
|
|
|
|
--- a/drivers/net/ethernet/mediatek/mtk_eth_soc.c
|
|
+++ b/drivers/net/ethernet/mediatek/mtk_eth_soc.c
|
|
@@ -1858,12 +1858,14 @@ static int mtk_poll_rx(struct napi_struc
|
|
bytes += skb->len;
|
|
|
|
if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V2)) {
|
|
+ reason = FIELD_GET(MTK_RXD5_PPE_CPU_REASON, trxd.rxd5);
|
|
hash = trxd.rxd5 & MTK_RXD5_FOE_ENTRY;
|
|
if (hash != MTK_RXD5_FOE_ENTRY)
|
|
skb_set_hash(skb, jhash_1word(hash, 0),
|
|
PKT_HASH_TYPE_L4);
|
|
rxdcsum = &trxd.rxd3;
|
|
} else {
|
|
+ reason = FIELD_GET(MTK_RXD4_PPE_CPU_REASON, trxd.rxd4);
|
|
hash = trxd.rxd4 & MTK_RXD4_FOE_ENTRY;
|
|
if (hash != MTK_RXD4_FOE_ENTRY)
|
|
skb_set_hash(skb, jhash_1word(hash, 0),
|
|
@@ -1877,7 +1879,6 @@ static int mtk_poll_rx(struct napi_struc
|
|
skb_checksum_none_assert(skb);
|
|
skb->protocol = eth_type_trans(skb, netdev);
|
|
|
|
- reason = FIELD_GET(MTK_RXD4_PPE_CPU_REASON, trxd.rxd4);
|
|
if (reason == MTK_PPE_CPU_REASON_HIT_UNBIND_RATE_REACHED)
|
|
mtk_ppe_check_skb(eth->ppe[0], skb, hash);
|
|
|
|
@@ -4179,7 +4180,7 @@ static const struct mtk_soc_data mt7621_
|
|
.required_pctl = false,
|
|
.offload_version = 2,
|
|
.hash_offset = 2,
|
|
- .foe_entry_size = sizeof(struct mtk_foe_entry),
|
|
+ .foe_entry_size = sizeof(struct mtk_foe_entry) - 16,
|
|
.txrx = {
|
|
.txd_size = sizeof(struct mtk_tx_dma),
|
|
.rxd_size = sizeof(struct mtk_rx_dma),
|
|
@@ -4199,7 +4200,7 @@ static const struct mtk_soc_data mt7622_
|
|
.required_pctl = false,
|
|
.offload_version = 2,
|
|
.hash_offset = 2,
|
|
- .foe_entry_size = sizeof(struct mtk_foe_entry),
|
|
+ .foe_entry_size = sizeof(struct mtk_foe_entry) - 16,
|
|
.txrx = {
|
|
.txd_size = sizeof(struct mtk_tx_dma),
|
|
.rxd_size = sizeof(struct mtk_rx_dma),
|
|
@@ -4218,7 +4219,7 @@ static const struct mtk_soc_data mt7623_
|
|
.required_pctl = true,
|
|
.offload_version = 2,
|
|
.hash_offset = 2,
|
|
- .foe_entry_size = sizeof(struct mtk_foe_entry),
|
|
+ .foe_entry_size = sizeof(struct mtk_foe_entry) - 16,
|
|
.txrx = {
|
|
.txd_size = sizeof(struct mtk_tx_dma),
|
|
.rxd_size = sizeof(struct mtk_rx_dma),
|
|
@@ -4250,9 +4251,11 @@ static const struct mtk_soc_data mt7986_
|
|
.reg_map = &mt7986_reg_map,
|
|
.ana_rgc3 = 0x128,
|
|
.caps = MT7986_CAPS,
|
|
+ .hw_features = MTK_HW_FEATURES,
|
|
.required_clks = MT7986_CLKS_BITMAP,
|
|
.required_pctl = false,
|
|
.hash_offset = 4,
|
|
+ .foe_entry_size = sizeof(struct mtk_foe_entry),
|
|
.txrx = {
|
|
.txd_size = sizeof(struct mtk_tx_dma_v2),
|
|
.rxd_size = sizeof(struct mtk_rx_dma_v2),
|
|
--- a/drivers/net/ethernet/mediatek/mtk_eth_soc.h
|
|
+++ b/drivers/net/ethernet/mediatek/mtk_eth_soc.h
|
|
@@ -1151,6 +1151,78 @@ mtk_foe_get_entry(struct mtk_ppe *ppe, u
|
|
return ppe->foe_table + hash * soc->foe_entry_size;
|
|
}
|
|
|
|
+static inline u32 mtk_get_ib1_ts_mask(struct mtk_eth *eth)
|
|
+{
|
|
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V2))
|
|
+ return MTK_FOE_IB1_BIND_TIMESTAMP_V2;
|
|
+
|
|
+ return MTK_FOE_IB1_BIND_TIMESTAMP;
|
|
+}
|
|
+
|
|
+static inline u32 mtk_get_ib1_ppoe_mask(struct mtk_eth *eth)
|
|
+{
|
|
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V2))
|
|
+ return MTK_FOE_IB1_BIND_PPPOE_V2;
|
|
+
|
|
+ return MTK_FOE_IB1_BIND_PPPOE;
|
|
+}
|
|
+
|
|
+static inline u32 mtk_get_ib1_vlan_tag_mask(struct mtk_eth *eth)
|
|
+{
|
|
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V2))
|
|
+ return MTK_FOE_IB1_BIND_VLAN_TAG_V2;
|
|
+
|
|
+ return MTK_FOE_IB1_BIND_VLAN_TAG;
|
|
+}
|
|
+
|
|
+static inline u32 mtk_get_ib1_vlan_layer_mask(struct mtk_eth *eth)
|
|
+{
|
|
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V2))
|
|
+ return MTK_FOE_IB1_BIND_VLAN_LAYER_V2;
|
|
+
|
|
+ return MTK_FOE_IB1_BIND_VLAN_LAYER;
|
|
+}
|
|
+
|
|
+static inline u32 mtk_prep_ib1_vlan_layer(struct mtk_eth *eth, u32 val)
|
|
+{
|
|
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V2))
|
|
+ return FIELD_PREP(MTK_FOE_IB1_BIND_VLAN_LAYER_V2, val);
|
|
+
|
|
+ return FIELD_PREP(MTK_FOE_IB1_BIND_VLAN_LAYER, val);
|
|
+}
|
|
+
|
|
+static inline u32 mtk_get_ib1_vlan_layer(struct mtk_eth *eth, u32 val)
|
|
+{
|
|
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V2))
|
|
+ return FIELD_GET(MTK_FOE_IB1_BIND_VLAN_LAYER_V2, val);
|
|
+
|
|
+ return FIELD_GET(MTK_FOE_IB1_BIND_VLAN_LAYER, val);
|
|
+}
|
|
+
|
|
+static inline u32 mtk_get_ib1_pkt_type_mask(struct mtk_eth *eth)
|
|
+{
|
|
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V2))
|
|
+ return MTK_FOE_IB1_PACKET_TYPE_V2;
|
|
+
|
|
+ return MTK_FOE_IB1_PACKET_TYPE;
|
|
+}
|
|
+
|
|
+static inline u32 mtk_get_ib1_pkt_type(struct mtk_eth *eth, u32 val)
|
|
+{
|
|
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V2))
|
|
+ return FIELD_GET(MTK_FOE_IB1_PACKET_TYPE_V2, val);
|
|
+
|
|
+ return FIELD_GET(MTK_FOE_IB1_PACKET_TYPE, val);
|
|
+}
|
|
+
|
|
+static inline u32 mtk_get_ib2_multicast_mask(struct mtk_eth *eth)
|
|
+{
|
|
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V2))
|
|
+ return MTK_FOE_IB2_MULTICAST_V2;
|
|
+
|
|
+ return MTK_FOE_IB2_MULTICAST;
|
|
+}
|
|
+
|
|
/* read the hardware status register */
|
|
void mtk_stats_update_mac(struct mtk_mac *mac);
|
|
|
|
--- a/drivers/net/ethernet/mediatek/mtk_ppe.c
|
|
+++ b/drivers/net/ethernet/mediatek/mtk_ppe.c
|
|
@@ -56,7 +56,7 @@ static u32 ppe_clear(struct mtk_ppe *ppe
|
|
|
|
static u32 mtk_eth_timestamp(struct mtk_eth *eth)
|
|
{
|
|
- return mtk_r32(eth, 0x0010) & MTK_FOE_IB1_BIND_TIMESTAMP;
|
|
+ return mtk_r32(eth, 0x0010) & mtk_get_ib1_ts_mask(eth);
|
|
}
|
|
|
|
static int mtk_ppe_wait_busy(struct mtk_ppe *ppe)
|
|
@@ -93,7 +93,7 @@ static u32 mtk_ppe_hash_entry(struct mtk
|
|
u32 hv1, hv2, hv3;
|
|
u32 hash;
|
|
|
|
- switch (FIELD_GET(MTK_FOE_IB1_PACKET_TYPE, e->ib1)) {
|
|
+ switch (mtk_get_ib1_pkt_type(eth, e->ib1)) {
|
|
case MTK_PPE_PKT_TYPE_IPV4_ROUTE:
|
|
case MTK_PPE_PKT_TYPE_IPV4_HNAPT:
|
|
hv1 = e->ipv4.orig.ports;
|
|
@@ -129,9 +129,9 @@ static u32 mtk_ppe_hash_entry(struct mtk
|
|
}
|
|
|
|
static inline struct mtk_foe_mac_info *
|
|
-mtk_foe_entry_l2(struct mtk_foe_entry *entry)
|
|
+mtk_foe_entry_l2(struct mtk_eth *eth, struct mtk_foe_entry *entry)
|
|
{
|
|
- int type = FIELD_GET(MTK_FOE_IB1_PACKET_TYPE, entry->ib1);
|
|
+ int type = mtk_get_ib1_pkt_type(eth, entry->ib1);
|
|
|
|
if (type == MTK_PPE_PKT_TYPE_BRIDGE)
|
|
return &entry->bridge.l2;
|
|
@@ -143,9 +143,9 @@ mtk_foe_entry_l2(struct mtk_foe_entry *e
|
|
}
|
|
|
|
static inline u32 *
|
|
-mtk_foe_entry_ib2(struct mtk_foe_entry *entry)
|
|
+mtk_foe_entry_ib2(struct mtk_eth *eth, struct mtk_foe_entry *entry)
|
|
{
|
|
- int type = FIELD_GET(MTK_FOE_IB1_PACKET_TYPE, entry->ib1);
|
|
+ int type = mtk_get_ib1_pkt_type(eth, entry->ib1);
|
|
|
|
if (type == MTK_PPE_PKT_TYPE_BRIDGE)
|
|
return &entry->bridge.ib2;
|
|
@@ -156,27 +156,38 @@ mtk_foe_entry_ib2(struct mtk_foe_entry *
|
|
return &entry->ipv4.ib2;
|
|
}
|
|
|
|
-int mtk_foe_entry_prepare(struct mtk_foe_entry *entry, int type, int l4proto,
|
|
- u8 pse_port, u8 *src_mac, u8 *dest_mac)
|
|
+int mtk_foe_entry_prepare(struct mtk_eth *eth, struct mtk_foe_entry *entry,
|
|
+ int type, int l4proto, u8 pse_port, u8 *src_mac,
|
|
+ u8 *dest_mac)
|
|
{
|
|
struct mtk_foe_mac_info *l2;
|
|
u32 ports_pad, val;
|
|
|
|
memset(entry, 0, sizeof(*entry));
|
|
|
|
- val = FIELD_PREP(MTK_FOE_IB1_STATE, MTK_FOE_STATE_BIND) |
|
|
- FIELD_PREP(MTK_FOE_IB1_PACKET_TYPE, type) |
|
|
- FIELD_PREP(MTK_FOE_IB1_UDP, l4proto == IPPROTO_UDP) |
|
|
- MTK_FOE_IB1_BIND_TTL |
|
|
- MTK_FOE_IB1_BIND_CACHE;
|
|
- entry->ib1 = val;
|
|
-
|
|
- val = FIELD_PREP(MTK_FOE_IB2_PORT_MG, 0x3f) |
|
|
- FIELD_PREP(MTK_FOE_IB2_PORT_AG, 0x1f) |
|
|
- FIELD_PREP(MTK_FOE_IB2_DEST_PORT, pse_port);
|
|
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V2)) {
|
|
+ val = FIELD_PREP(MTK_FOE_IB1_STATE, MTK_FOE_STATE_BIND) |
|
|
+ FIELD_PREP(MTK_FOE_IB1_PACKET_TYPE_V2, type) |
|
|
+ FIELD_PREP(MTK_FOE_IB1_UDP, l4proto == IPPROTO_UDP) |
|
|
+ MTK_FOE_IB1_BIND_CACHE_V2 | MTK_FOE_IB1_BIND_TTL_V2;
|
|
+ entry->ib1 = val;
|
|
+
|
|
+ val = FIELD_PREP(MTK_FOE_IB2_DEST_PORT_V2, pse_port) |
|
|
+ FIELD_PREP(MTK_FOE_IB2_PORT_AG_V2, 0xf);
|
|
+ } else {
|
|
+ val = FIELD_PREP(MTK_FOE_IB1_STATE, MTK_FOE_STATE_BIND) |
|
|
+ FIELD_PREP(MTK_FOE_IB1_PACKET_TYPE, type) |
|
|
+ FIELD_PREP(MTK_FOE_IB1_UDP, l4proto == IPPROTO_UDP) |
|
|
+ MTK_FOE_IB1_BIND_CACHE | MTK_FOE_IB1_BIND_TTL;
|
|
+ entry->ib1 = val;
|
|
+
|
|
+ val = FIELD_PREP(MTK_FOE_IB2_DEST_PORT, pse_port) |
|
|
+ FIELD_PREP(MTK_FOE_IB2_PORT_MG, 0x3f) |
|
|
+ FIELD_PREP(MTK_FOE_IB2_PORT_AG, 0x1f);
|
|
+ }
|
|
|
|
if (is_multicast_ether_addr(dest_mac))
|
|
- val |= MTK_FOE_IB2_MULTICAST;
|
|
+ val |= mtk_get_ib2_multicast_mask(eth);
|
|
|
|
ports_pad = 0xa5a5a500 | (l4proto & 0xff);
|
|
if (type == MTK_PPE_PKT_TYPE_IPV4_ROUTE)
|
|
@@ -210,24 +221,30 @@ int mtk_foe_entry_prepare(struct mtk_foe
|
|
return 0;
|
|
}
|
|
|
|
-int mtk_foe_entry_set_pse_port(struct mtk_foe_entry *entry, u8 port)
|
|
+int mtk_foe_entry_set_pse_port(struct mtk_eth *eth,
|
|
+ struct mtk_foe_entry *entry, u8 port)
|
|
{
|
|
- u32 *ib2 = mtk_foe_entry_ib2(entry);
|
|
- u32 val;
|
|
+ u32 *ib2 = mtk_foe_entry_ib2(eth, entry);
|
|
+ u32 val = *ib2;
|
|
|
|
- val = *ib2;
|
|
- val &= ~MTK_FOE_IB2_DEST_PORT;
|
|
- val |= FIELD_PREP(MTK_FOE_IB2_DEST_PORT, port);
|
|
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V2)) {
|
|
+ val &= ~MTK_FOE_IB2_DEST_PORT_V2;
|
|
+ val |= FIELD_PREP(MTK_FOE_IB2_DEST_PORT_V2, port);
|
|
+ } else {
|
|
+ val &= ~MTK_FOE_IB2_DEST_PORT;
|
|
+ val |= FIELD_PREP(MTK_FOE_IB2_DEST_PORT, port);
|
|
+ }
|
|
*ib2 = val;
|
|
|
|
return 0;
|
|
}
|
|
|
|
-int mtk_foe_entry_set_ipv4_tuple(struct mtk_foe_entry *entry, bool egress,
|
|
+int mtk_foe_entry_set_ipv4_tuple(struct mtk_eth *eth,
|
|
+ struct mtk_foe_entry *entry, bool egress,
|
|
__be32 src_addr, __be16 src_port,
|
|
__be32 dest_addr, __be16 dest_port)
|
|
{
|
|
- int type = FIELD_GET(MTK_FOE_IB1_PACKET_TYPE, entry->ib1);
|
|
+ int type = mtk_get_ib1_pkt_type(eth, entry->ib1);
|
|
struct mtk_ipv4_tuple *t;
|
|
|
|
switch (type) {
|
|
@@ -262,11 +279,12 @@ int mtk_foe_entry_set_ipv4_tuple(struct
|
|
return 0;
|
|
}
|
|
|
|
-int mtk_foe_entry_set_ipv6_tuple(struct mtk_foe_entry *entry,
|
|
+int mtk_foe_entry_set_ipv6_tuple(struct mtk_eth *eth,
|
|
+ struct mtk_foe_entry *entry,
|
|
__be32 *src_addr, __be16 src_port,
|
|
__be32 *dest_addr, __be16 dest_port)
|
|
{
|
|
- int type = FIELD_GET(MTK_FOE_IB1_PACKET_TYPE, entry->ib1);
|
|
+ int type = mtk_get_ib1_pkt_type(eth, entry->ib1);
|
|
u32 *src, *dest;
|
|
int i;
|
|
|
|
@@ -297,39 +315,41 @@ int mtk_foe_entry_set_ipv6_tuple(struct
|
|
return 0;
|
|
}
|
|
|
|
-int mtk_foe_entry_set_dsa(struct mtk_foe_entry *entry, int port)
|
|
+int mtk_foe_entry_set_dsa(struct mtk_eth *eth, struct mtk_foe_entry *entry,
|
|
+ int port)
|
|
{
|
|
- struct mtk_foe_mac_info *l2 = mtk_foe_entry_l2(entry);
|
|
+ struct mtk_foe_mac_info *l2 = mtk_foe_entry_l2(eth, entry);
|
|
|
|
l2->etype = BIT(port);
|
|
|
|
- if (!(entry->ib1 & MTK_FOE_IB1_BIND_VLAN_LAYER))
|
|
- entry->ib1 |= FIELD_PREP(MTK_FOE_IB1_BIND_VLAN_LAYER, 1);
|
|
+ if (!(entry->ib1 & mtk_get_ib1_vlan_layer_mask(eth)))
|
|
+ entry->ib1 |= mtk_prep_ib1_vlan_layer(eth, 1);
|
|
else
|
|
l2->etype |= BIT(8);
|
|
|
|
- entry->ib1 &= ~MTK_FOE_IB1_BIND_VLAN_TAG;
|
|
+ entry->ib1 &= ~mtk_get_ib1_vlan_tag_mask(eth);
|
|
|
|
return 0;
|
|
}
|
|
|
|
-int mtk_foe_entry_set_vlan(struct mtk_foe_entry *entry, int vid)
|
|
+int mtk_foe_entry_set_vlan(struct mtk_eth *eth, struct mtk_foe_entry *entry,
|
|
+ int vid)
|
|
{
|
|
- struct mtk_foe_mac_info *l2 = mtk_foe_entry_l2(entry);
|
|
+ struct mtk_foe_mac_info *l2 = mtk_foe_entry_l2(eth, entry);
|
|
|
|
- switch (FIELD_GET(MTK_FOE_IB1_BIND_VLAN_LAYER, entry->ib1)) {
|
|
+ switch (mtk_prep_ib1_vlan_layer(eth, entry->ib1)) {
|
|
case 0:
|
|
- entry->ib1 |= MTK_FOE_IB1_BIND_VLAN_TAG |
|
|
- FIELD_PREP(MTK_FOE_IB1_BIND_VLAN_LAYER, 1);
|
|
+ entry->ib1 |= mtk_get_ib1_vlan_tag_mask(eth) |
|
|
+ mtk_prep_ib1_vlan_layer(eth, 1);
|
|
l2->vlan1 = vid;
|
|
return 0;
|
|
case 1:
|
|
- if (!(entry->ib1 & MTK_FOE_IB1_BIND_VLAN_TAG)) {
|
|
+ if (!(entry->ib1 & mtk_get_ib1_vlan_tag_mask(eth))) {
|
|
l2->vlan1 = vid;
|
|
l2->etype |= BIT(8);
|
|
} else {
|
|
l2->vlan2 = vid;
|
|
- entry->ib1 += FIELD_PREP(MTK_FOE_IB1_BIND_VLAN_LAYER, 1);
|
|
+ entry->ib1 += mtk_prep_ib1_vlan_layer(eth, 1);
|
|
}
|
|
return 0;
|
|
default:
|
|
@@ -337,34 +357,42 @@ int mtk_foe_entry_set_vlan(struct mtk_fo
|
|
}
|
|
}
|
|
|
|
-int mtk_foe_entry_set_pppoe(struct mtk_foe_entry *entry, int sid)
|
|
+int mtk_foe_entry_set_pppoe(struct mtk_eth *eth, struct mtk_foe_entry *entry,
|
|
+ int sid)
|
|
{
|
|
- struct mtk_foe_mac_info *l2 = mtk_foe_entry_l2(entry);
|
|
+ struct mtk_foe_mac_info *l2 = mtk_foe_entry_l2(eth, entry);
|
|
|
|
- if (!(entry->ib1 & MTK_FOE_IB1_BIND_VLAN_LAYER) ||
|
|
- (entry->ib1 & MTK_FOE_IB1_BIND_VLAN_TAG))
|
|
+ if (!(entry->ib1 & mtk_get_ib1_vlan_layer_mask(eth)) ||
|
|
+ (entry->ib1 & mtk_get_ib1_vlan_tag_mask(eth)))
|
|
l2->etype = ETH_P_PPP_SES;
|
|
|
|
- entry->ib1 |= MTK_FOE_IB1_BIND_PPPOE;
|
|
+ entry->ib1 |= mtk_get_ib1_ppoe_mask(eth);
|
|
l2->pppoe_id = sid;
|
|
|
|
return 0;
|
|
}
|
|
|
|
-int mtk_foe_entry_set_wdma(struct mtk_foe_entry *entry, int wdma_idx, int txq,
|
|
- int bss, int wcid)
|
|
+int mtk_foe_entry_set_wdma(struct mtk_eth *eth, struct mtk_foe_entry *entry,
|
|
+ int wdma_idx, int txq, int bss, int wcid)
|
|
{
|
|
- struct mtk_foe_mac_info *l2 = mtk_foe_entry_l2(entry);
|
|
- u32 *ib2 = mtk_foe_entry_ib2(entry);
|
|
+ struct mtk_foe_mac_info *l2 = mtk_foe_entry_l2(eth, entry);
|
|
+ u32 *ib2 = mtk_foe_entry_ib2(eth, entry);
|
|
|
|
- *ib2 &= ~MTK_FOE_IB2_PORT_MG;
|
|
- *ib2 |= MTK_FOE_IB2_WDMA_WINFO;
|
|
- if (wdma_idx)
|
|
- *ib2 |= MTK_FOE_IB2_WDMA_DEVIDX;
|
|
-
|
|
- l2->vlan2 = FIELD_PREP(MTK_FOE_VLAN2_WINFO_BSS, bss) |
|
|
- FIELD_PREP(MTK_FOE_VLAN2_WINFO_WCID, wcid) |
|
|
- FIELD_PREP(MTK_FOE_VLAN2_WINFO_RING, txq);
|
|
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V2)) {
|
|
+ *ib2 &= ~MTK_FOE_IB2_PORT_MG_V2;
|
|
+ *ib2 |= FIELD_PREP(MTK_FOE_IB2_RX_IDX, txq) |
|
|
+ MTK_FOE_IB2_WDMA_WINFO_V2;
|
|
+ l2->winfo = FIELD_PREP(MTK_FOE_WINFO_WCID, wcid) |
|
|
+ FIELD_PREP(MTK_FOE_WINFO_BSS, bss);
|
|
+ } else {
|
|
+ *ib2 &= ~MTK_FOE_IB2_PORT_MG;
|
|
+ *ib2 |= MTK_FOE_IB2_WDMA_WINFO;
|
|
+ if (wdma_idx)
|
|
+ *ib2 |= MTK_FOE_IB2_WDMA_DEVIDX;
|
|
+ l2->vlan2 = FIELD_PREP(MTK_FOE_VLAN2_WINFO_BSS, bss) |
|
|
+ FIELD_PREP(MTK_FOE_VLAN2_WINFO_WCID, wcid) |
|
|
+ FIELD_PREP(MTK_FOE_VLAN2_WINFO_RING, txq);
|
|
+ }
|
|
|
|
return 0;
|
|
}
|
|
@@ -376,14 +404,15 @@ static inline bool mtk_foe_entry_usable(
|
|
}
|
|
|
|
static bool
|
|
-mtk_flow_entry_match(struct mtk_flow_entry *entry, struct mtk_foe_entry *data)
|
|
+mtk_flow_entry_match(struct mtk_eth *eth, struct mtk_flow_entry *entry,
|
|
+ struct mtk_foe_entry *data)
|
|
{
|
|
int type, len;
|
|
|
|
if ((data->ib1 ^ entry->data.ib1) & MTK_FOE_IB1_UDP)
|
|
return false;
|
|
|
|
- type = FIELD_GET(MTK_FOE_IB1_PACKET_TYPE, entry->data.ib1);
|
|
+ type = mtk_get_ib1_pkt_type(eth, entry->data.ib1);
|
|
if (type > MTK_PPE_PKT_TYPE_IPV4_DSLITE)
|
|
len = offsetof(struct mtk_foe_entry, ipv6._rsv);
|
|
else
|
|
@@ -427,14 +456,12 @@ __mtk_foe_entry_clear(struct mtk_ppe *pp
|
|
|
|
static int __mtk_foe_entry_idle_time(struct mtk_ppe *ppe, u32 ib1)
|
|
{
|
|
- u16 timestamp;
|
|
- u16 now;
|
|
-
|
|
- now = mtk_eth_timestamp(ppe->eth) & MTK_FOE_IB1_BIND_TIMESTAMP;
|
|
- timestamp = ib1 & MTK_FOE_IB1_BIND_TIMESTAMP;
|
|
+ u32 ib1_ts_mask = mtk_get_ib1_ts_mask(ppe->eth);
|
|
+ u16 now = mtk_eth_timestamp(ppe->eth);
|
|
+ u16 timestamp = ib1 & ib1_ts_mask;
|
|
|
|
if (timestamp > now)
|
|
- return MTK_FOE_IB1_BIND_TIMESTAMP + 1 - timestamp + now;
|
|
+ return ib1_ts_mask + 1 - timestamp + now;
|
|
else
|
|
return now - timestamp;
|
|
}
|
|
@@ -442,6 +469,7 @@ static int __mtk_foe_entry_idle_time(str
|
|
static void
|
|
mtk_flow_entry_update_l2(struct mtk_ppe *ppe, struct mtk_flow_entry *entry)
|
|
{
|
|
+ u32 ib1_ts_mask = mtk_get_ib1_ts_mask(ppe->eth);
|
|
struct mtk_flow_entry *cur;
|
|
struct mtk_foe_entry *hwe;
|
|
struct hlist_node *tmp;
|
|
@@ -466,8 +494,8 @@ mtk_flow_entry_update_l2(struct mtk_ppe
|
|
continue;
|
|
|
|
idle = cur_idle;
|
|
- entry->data.ib1 &= ~MTK_FOE_IB1_BIND_TIMESTAMP;
|
|
- entry->data.ib1 |= hwe->ib1 & MTK_FOE_IB1_BIND_TIMESTAMP;
|
|
+ entry->data.ib1 &= ~ib1_ts_mask;
|
|
+ entry->data.ib1 |= hwe->ib1 & ib1_ts_mask;
|
|
}
|
|
}
|
|
|
|
@@ -489,7 +517,7 @@ mtk_flow_entry_update(struct mtk_ppe *pp
|
|
|
|
hwe = mtk_foe_get_entry(ppe, entry->hash);
|
|
memcpy(&foe, hwe, ppe->eth->soc->foe_entry_size);
|
|
- if (!mtk_flow_entry_match(entry, &foe)) {
|
|
+ if (!mtk_flow_entry_match(ppe->eth, entry, &foe)) {
|
|
entry->hash = 0xffff;
|
|
goto out;
|
|
}
|
|
@@ -504,16 +532,22 @@ static void
|
|
__mtk_foe_entry_commit(struct mtk_ppe *ppe, struct mtk_foe_entry *entry,
|
|
u16 hash)
|
|
{
|
|
+ struct mtk_eth *eth = ppe->eth;
|
|
+ u16 timestamp = mtk_eth_timestamp(eth);
|
|
struct mtk_foe_entry *hwe;
|
|
- u16 timestamp;
|
|
|
|
- timestamp = mtk_eth_timestamp(ppe->eth);
|
|
- timestamp &= MTK_FOE_IB1_BIND_TIMESTAMP;
|
|
- entry->ib1 &= ~MTK_FOE_IB1_BIND_TIMESTAMP;
|
|
- entry->ib1 |= FIELD_PREP(MTK_FOE_IB1_BIND_TIMESTAMP, timestamp);
|
|
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V2)) {
|
|
+ entry->ib1 &= ~MTK_FOE_IB1_BIND_TIMESTAMP_V2;
|
|
+ entry->ib1 |= FIELD_PREP(MTK_FOE_IB1_BIND_TIMESTAMP_V2,
|
|
+ timestamp);
|
|
+ } else {
|
|
+ entry->ib1 &= ~MTK_FOE_IB1_BIND_TIMESTAMP;
|
|
+ entry->ib1 |= FIELD_PREP(MTK_FOE_IB1_BIND_TIMESTAMP,
|
|
+ timestamp);
|
|
+ }
|
|
|
|
hwe = mtk_foe_get_entry(ppe, hash);
|
|
- memcpy(&hwe->data, &entry->data, ppe->eth->soc->foe_entry_size);
|
|
+ memcpy(&hwe->data, &entry->data, eth->soc->foe_entry_size);
|
|
wmb();
|
|
hwe->ib1 = entry->ib1;
|
|
|
|
@@ -540,8 +574,8 @@ mtk_foe_entry_commit_l2(struct mtk_ppe *
|
|
|
|
int mtk_foe_entry_commit(struct mtk_ppe *ppe, struct mtk_flow_entry *entry)
|
|
{
|
|
- int type = FIELD_GET(MTK_FOE_IB1_PACKET_TYPE, entry->data.ib1);
|
|
const struct mtk_soc_data *soc = ppe->eth->soc;
|
|
+ int type = mtk_get_ib1_pkt_type(ppe->eth, entry->data.ib1);
|
|
u32 hash;
|
|
|
|
if (type == MTK_PPE_PKT_TYPE_BRIDGE)
|
|
@@ -564,7 +598,7 @@ mtk_foe_entry_commit_subflow(struct mtk_
|
|
struct mtk_flow_entry *flow_info;
|
|
struct mtk_foe_entry foe = {}, *hwe;
|
|
struct mtk_foe_mac_info *l2;
|
|
- u32 ib1_mask = MTK_FOE_IB1_PACKET_TYPE | MTK_FOE_IB1_UDP;
|
|
+ u32 ib1_mask = mtk_get_ib1_pkt_type_mask(ppe->eth) | MTK_FOE_IB1_UDP;
|
|
int type;
|
|
|
|
flow_info = kzalloc(offsetof(struct mtk_flow_entry, l2_data.end),
|
|
@@ -584,16 +618,16 @@ mtk_foe_entry_commit_subflow(struct mtk_
|
|
foe.ib1 &= ib1_mask;
|
|
foe.ib1 |= entry->data.ib1 & ~ib1_mask;
|
|
|
|
- l2 = mtk_foe_entry_l2(&foe);
|
|
+ l2 = mtk_foe_entry_l2(ppe->eth, &foe);
|
|
memcpy(l2, &entry->data.bridge.l2, sizeof(*l2));
|
|
|
|
- type = FIELD_GET(MTK_FOE_IB1_PACKET_TYPE, foe.ib1);
|
|
+ type = mtk_get_ib1_pkt_type(ppe->eth, foe.ib1);
|
|
if (type == MTK_PPE_PKT_TYPE_IPV4_HNAPT)
|
|
memcpy(&foe.ipv4.new, &foe.ipv4.orig, sizeof(foe.ipv4.new));
|
|
else if (type >= MTK_PPE_PKT_TYPE_IPV6_ROUTE_3T && l2->etype == ETH_P_IP)
|
|
l2->etype = ETH_P_IPV6;
|
|
|
|
- *mtk_foe_entry_ib2(&foe) = entry->data.bridge.ib2;
|
|
+ *mtk_foe_entry_ib2(ppe->eth, &foe) = entry->data.bridge.ib2;
|
|
|
|
__mtk_foe_entry_commit(ppe, &foe, hash);
|
|
}
|
|
@@ -626,7 +660,7 @@ void __mtk_ppe_check_skb(struct mtk_ppe
|
|
continue;
|
|
}
|
|
|
|
- if (found || !mtk_flow_entry_match(entry, hwe)) {
|
|
+ if (found || !mtk_flow_entry_match(ppe->eth, entry, hwe)) {
|
|
if (entry->hash != 0xffff)
|
|
entry->hash = 0xffff;
|
|
continue;
|
|
@@ -771,6 +805,8 @@ void mtk_ppe_start(struct mtk_ppe *ppe)
|
|
MTK_PPE_SCAN_MODE_CHECK_AGE) |
|
|
FIELD_PREP(MTK_PPE_TB_CFG_ENTRY_NUM,
|
|
MTK_PPE_ENTRIES_SHIFT);
|
|
+ if (MTK_HAS_CAPS(ppe->eth->soc->caps, MTK_NETSYS_V2))
|
|
+ val |= MTK_PPE_TB_CFG_INFO_SEL;
|
|
ppe_w32(ppe, MTK_PPE_TB_CFG, val);
|
|
|
|
ppe_w32(ppe, MTK_PPE_IP_PROTO_CHK,
|
|
@@ -778,15 +814,21 @@ void mtk_ppe_start(struct mtk_ppe *ppe)
|
|
|
|
mtk_ppe_cache_enable(ppe, true);
|
|
|
|
- val = MTK_PPE_FLOW_CFG_IP4_TCP_FRAG |
|
|
- MTK_PPE_FLOW_CFG_IP4_UDP_FRAG |
|
|
- MTK_PPE_FLOW_CFG_IP6_3T_ROUTE |
|
|
+ val = MTK_PPE_FLOW_CFG_IP6_3T_ROUTE |
|
|
MTK_PPE_FLOW_CFG_IP6_5T_ROUTE |
|
|
MTK_PPE_FLOW_CFG_IP6_6RD |
|
|
MTK_PPE_FLOW_CFG_IP4_NAT |
|
|
MTK_PPE_FLOW_CFG_IP4_NAPT |
|
|
MTK_PPE_FLOW_CFG_IP4_DSLITE |
|
|
MTK_PPE_FLOW_CFG_IP4_NAT_FRAG;
|
|
+ if (MTK_HAS_CAPS(ppe->eth->soc->caps, MTK_NETSYS_V2))
|
|
+ val |= MTK_PPE_MD_TOAP_BYP_CRSN0 |
|
|
+ MTK_PPE_MD_TOAP_BYP_CRSN1 |
|
|
+ MTK_PPE_MD_TOAP_BYP_CRSN2 |
|
|
+ MTK_PPE_FLOW_CFG_IP4_HASH_GRE_KEY;
|
|
+ else
|
|
+ val |= MTK_PPE_FLOW_CFG_IP4_TCP_FRAG |
|
|
+ MTK_PPE_FLOW_CFG_IP4_UDP_FRAG;
|
|
ppe_w32(ppe, MTK_PPE_FLOW_CFG, val);
|
|
|
|
val = FIELD_PREP(MTK_PPE_UNBIND_AGE_MIN_PACKETS, 1000) |
|
|
@@ -820,6 +862,11 @@ void mtk_ppe_start(struct mtk_ppe *ppe)
|
|
ppe_w32(ppe, MTK_PPE_GLO_CFG, val);
|
|
|
|
ppe_w32(ppe, MTK_PPE_DEFAULT_CPU_PORT, 0);
|
|
+
|
|
+ if (MTK_HAS_CAPS(ppe->eth->soc->caps, MTK_NETSYS_V2)) {
|
|
+ ppe_w32(ppe, MTK_PPE_DEFAULT_CPU_PORT1, 0xcb777);
|
|
+ ppe_w32(ppe, MTK_PPE_SBW_CTRL, 0x7f);
|
|
+ }
|
|
}
|
|
|
|
int mtk_ppe_stop(struct mtk_ppe *ppe)
|
|
--- a/drivers/net/ethernet/mediatek/mtk_ppe.h
|
|
+++ b/drivers/net/ethernet/mediatek/mtk_ppe.h
|
|
@@ -32,6 +32,15 @@
|
|
#define MTK_FOE_IB1_UDP BIT(30)
|
|
#define MTK_FOE_IB1_STATIC BIT(31)
|
|
|
|
+/* CONFIG_MEDIATEK_NETSYS_V2 */
|
|
+#define MTK_FOE_IB1_BIND_TIMESTAMP_V2 GENMASK(7, 0)
|
|
+#define MTK_FOE_IB1_BIND_VLAN_LAYER_V2 GENMASK(16, 14)
|
|
+#define MTK_FOE_IB1_BIND_PPPOE_V2 BIT(17)
|
|
+#define MTK_FOE_IB1_BIND_VLAN_TAG_V2 BIT(18)
|
|
+#define MTK_FOE_IB1_BIND_CACHE_V2 BIT(20)
|
|
+#define MTK_FOE_IB1_BIND_TTL_V2 BIT(22)
|
|
+#define MTK_FOE_IB1_PACKET_TYPE_V2 GENMASK(27, 23)
|
|
+
|
|
enum {
|
|
MTK_PPE_PKT_TYPE_IPV4_HNAPT = 0,
|
|
MTK_PPE_PKT_TYPE_IPV4_ROUTE = 1,
|
|
@@ -53,14 +62,25 @@ enum {
|
|
|
|
#define MTK_FOE_IB2_PORT_MG GENMASK(17, 12)
|
|
|
|
+#define MTK_FOE_IB2_RX_IDX GENMASK(18, 17)
|
|
#define MTK_FOE_IB2_PORT_AG GENMASK(23, 18)
|
|
|
|
#define MTK_FOE_IB2_DSCP GENMASK(31, 24)
|
|
|
|
+/* CONFIG_MEDIATEK_NETSYS_V2 */
|
|
+#define MTK_FOE_IB2_PORT_MG_V2 BIT(7)
|
|
+#define MTK_FOE_IB2_DEST_PORT_V2 GENMASK(12, 9)
|
|
+#define MTK_FOE_IB2_MULTICAST_V2 BIT(13)
|
|
+#define MTK_FOE_IB2_WDMA_WINFO_V2 BIT(19)
|
|
+#define MTK_FOE_IB2_PORT_AG_V2 GENMASK(23, 20)
|
|
+
|
|
#define MTK_FOE_VLAN2_WINFO_BSS GENMASK(5, 0)
|
|
#define MTK_FOE_VLAN2_WINFO_WCID GENMASK(13, 6)
|
|
#define MTK_FOE_VLAN2_WINFO_RING GENMASK(15, 14)
|
|
|
|
+#define MTK_FOE_WINFO_BSS GENMASK(5, 0)
|
|
+#define MTK_FOE_WINFO_WCID GENMASK(15, 6)
|
|
+
|
|
enum {
|
|
MTK_FOE_STATE_INVALID,
|
|
MTK_FOE_STATE_UNBIND,
|
|
@@ -81,6 +101,9 @@ struct mtk_foe_mac_info {
|
|
|
|
u16 pppoe_id;
|
|
u16 src_mac_lo;
|
|
+
|
|
+ u16 minfo;
|
|
+ u16 winfo;
|
|
};
|
|
|
|
/* software-only entry type */
|
|
@@ -198,7 +221,7 @@ struct mtk_foe_entry {
|
|
struct mtk_foe_ipv4_dslite dslite;
|
|
struct mtk_foe_ipv6 ipv6;
|
|
struct mtk_foe_ipv6_6rd ipv6_6rd;
|
|
- u32 data[19];
|
|
+ u32 data[23];
|
|
};
|
|
};
|
|
|
|
@@ -306,20 +329,27 @@ mtk_ppe_check_skb(struct mtk_ppe *ppe, s
|
|
__mtk_ppe_check_skb(ppe, skb, hash);
|
|
}
|
|
|
|
-int mtk_foe_entry_prepare(struct mtk_foe_entry *entry, int type, int l4proto,
|
|
- u8 pse_port, u8 *src_mac, u8 *dest_mac);
|
|
-int mtk_foe_entry_set_pse_port(struct mtk_foe_entry *entry, u8 port);
|
|
-int mtk_foe_entry_set_ipv4_tuple(struct mtk_foe_entry *entry, bool orig,
|
|
+int mtk_foe_entry_prepare(struct mtk_eth *eth, struct mtk_foe_entry *entry,
|
|
+ int type, int l4proto, u8 pse_port, u8 *src_mac,
|
|
+ u8 *dest_mac);
|
|
+int mtk_foe_entry_set_pse_port(struct mtk_eth *eth,
|
|
+ struct mtk_foe_entry *entry, u8 port);
|
|
+int mtk_foe_entry_set_ipv4_tuple(struct mtk_eth *eth,
|
|
+ struct mtk_foe_entry *entry, bool orig,
|
|
__be32 src_addr, __be16 src_port,
|
|
__be32 dest_addr, __be16 dest_port);
|
|
-int mtk_foe_entry_set_ipv6_tuple(struct mtk_foe_entry *entry,
|
|
+int mtk_foe_entry_set_ipv6_tuple(struct mtk_eth *eth,
|
|
+ struct mtk_foe_entry *entry,
|
|
__be32 *src_addr, __be16 src_port,
|
|
__be32 *dest_addr, __be16 dest_port);
|
|
-int mtk_foe_entry_set_dsa(struct mtk_foe_entry *entry, int port);
|
|
-int mtk_foe_entry_set_vlan(struct mtk_foe_entry *entry, int vid);
|
|
-int mtk_foe_entry_set_pppoe(struct mtk_foe_entry *entry, int sid);
|
|
-int mtk_foe_entry_set_wdma(struct mtk_foe_entry *entry, int wdma_idx, int txq,
|
|
- int bss, int wcid);
|
|
+int mtk_foe_entry_set_dsa(struct mtk_eth *eth, struct mtk_foe_entry *entry,
|
|
+ int port);
|
|
+int mtk_foe_entry_set_vlan(struct mtk_eth *eth, struct mtk_foe_entry *entry,
|
|
+ int vid);
|
|
+int mtk_foe_entry_set_pppoe(struct mtk_eth *eth, struct mtk_foe_entry *entry,
|
|
+ int sid);
|
|
+int mtk_foe_entry_set_wdma(struct mtk_eth *eth, struct mtk_foe_entry *entry,
|
|
+ int wdma_idx, int txq, int bss, int wcid);
|
|
int mtk_foe_entry_commit(struct mtk_ppe *ppe, struct mtk_flow_entry *entry);
|
|
void mtk_foe_entry_clear(struct mtk_ppe *ppe, struct mtk_flow_entry *entry);
|
|
int mtk_foe_entry_idle_time(struct mtk_ppe *ppe, struct mtk_flow_entry *entry);
|
|
--- a/drivers/net/ethernet/mediatek/mtk_ppe_offload.c
|
|
+++ b/drivers/net/ethernet/mediatek/mtk_ppe_offload.c
|
|
@@ -52,18 +52,19 @@ static const struct rhashtable_params mt
|
|
};
|
|
|
|
static int
|
|
-mtk_flow_set_ipv4_addr(struct mtk_foe_entry *foe, struct mtk_flow_data *data,
|
|
- bool egress)
|
|
+mtk_flow_set_ipv4_addr(struct mtk_eth *eth, struct mtk_foe_entry *foe,
|
|
+ struct mtk_flow_data *data, bool egress)
|
|
{
|
|
- return mtk_foe_entry_set_ipv4_tuple(foe, egress,
|
|
+ return mtk_foe_entry_set_ipv4_tuple(eth, foe, egress,
|
|
data->v4.src_addr, data->src_port,
|
|
data->v4.dst_addr, data->dst_port);
|
|
}
|
|
|
|
static int
|
|
-mtk_flow_set_ipv6_addr(struct mtk_foe_entry *foe, struct mtk_flow_data *data)
|
|
+mtk_flow_set_ipv6_addr(struct mtk_eth *eth, struct mtk_foe_entry *foe,
|
|
+ struct mtk_flow_data *data)
|
|
{
|
|
- return mtk_foe_entry_set_ipv6_tuple(foe,
|
|
+ return mtk_foe_entry_set_ipv6_tuple(eth, foe,
|
|
data->v6.src_addr.s6_addr32, data->src_port,
|
|
data->v6.dst_addr.s6_addr32, data->dst_port);
|
|
}
|
|
@@ -190,16 +191,29 @@ mtk_flow_set_output_device(struct mtk_et
|
|
int pse_port, dsa_port;
|
|
|
|
if (mtk_flow_get_wdma_info(dev, dest_mac, &info) == 0) {
|
|
- mtk_foe_entry_set_wdma(foe, info.wdma_idx, info.queue, info.bss,
|
|
- info.wcid);
|
|
- pse_port = 3;
|
|
+ mtk_foe_entry_set_wdma(eth, foe, info.wdma_idx, info.queue,
|
|
+ info.bss, info.wcid);
|
|
+ if (MTK_HAS_CAPS(eth->soc->caps, MTK_NETSYS_V2)) {
|
|
+ switch (info.wdma_idx) {
|
|
+ case 0:
|
|
+ pse_port = 8;
|
|
+ break;
|
|
+ case 1:
|
|
+ pse_port = 9;
|
|
+ break;
|
|
+ default:
|
|
+ return -EINVAL;
|
|
+ }
|
|
+ } else {
|
|
+ pse_port = 3;
|
|
+ }
|
|
*wed_index = info.wdma_idx;
|
|
goto out;
|
|
}
|
|
|
|
dsa_port = mtk_flow_get_dsa_port(&dev);
|
|
if (dsa_port >= 0)
|
|
- mtk_foe_entry_set_dsa(foe, dsa_port);
|
|
+ mtk_foe_entry_set_dsa(eth, foe, dsa_port);
|
|
|
|
if (dev == eth->netdev[0])
|
|
pse_port = 1;
|
|
@@ -209,7 +223,7 @@ mtk_flow_set_output_device(struct mtk_et
|
|
return -EOPNOTSUPP;
|
|
|
|
out:
|
|
- mtk_foe_entry_set_pse_port(foe, pse_port);
|
|
+ mtk_foe_entry_set_pse_port(eth, foe, pse_port);
|
|
|
|
return 0;
|
|
}
|
|
@@ -333,9 +347,8 @@ mtk_flow_offload_replace(struct mtk_eth
|
|
!is_valid_ether_addr(data.eth.h_dest))
|
|
return -EINVAL;
|
|
|
|
- err = mtk_foe_entry_prepare(&foe, offload_type, l4proto, 0,
|
|
- data.eth.h_source,
|
|
- data.eth.h_dest);
|
|
+ err = mtk_foe_entry_prepare(eth, &foe, offload_type, l4proto, 0,
|
|
+ data.eth.h_source, data.eth.h_dest);
|
|
if (err)
|
|
return err;
|
|
|
|
@@ -360,7 +373,7 @@ mtk_flow_offload_replace(struct mtk_eth
|
|
data.v4.src_addr = addrs.key->src;
|
|
data.v4.dst_addr = addrs.key->dst;
|
|
|
|
- mtk_flow_set_ipv4_addr(&foe, &data, false);
|
|
+ mtk_flow_set_ipv4_addr(eth, &foe, &data, false);
|
|
}
|
|
|
|
if (addr_type == FLOW_DISSECTOR_KEY_IPV6_ADDRS) {
|
|
@@ -371,7 +384,7 @@ mtk_flow_offload_replace(struct mtk_eth
|
|
data.v6.src_addr = addrs.key->src;
|
|
data.v6.dst_addr = addrs.key->dst;
|
|
|
|
- mtk_flow_set_ipv6_addr(&foe, &data);
|
|
+ mtk_flow_set_ipv6_addr(eth, &foe, &data);
|
|
}
|
|
|
|
flow_action_for_each(i, act, &rule->action) {
|
|
@@ -401,7 +414,7 @@ mtk_flow_offload_replace(struct mtk_eth
|
|
}
|
|
|
|
if (addr_type == FLOW_DISSECTOR_KEY_IPV4_ADDRS) {
|
|
- err = mtk_flow_set_ipv4_addr(&foe, &data, true);
|
|
+ err = mtk_flow_set_ipv4_addr(eth, &foe, &data, true);
|
|
if (err)
|
|
return err;
|
|
}
|
|
@@ -413,10 +426,10 @@ mtk_flow_offload_replace(struct mtk_eth
|
|
if (data.vlan.proto != htons(ETH_P_8021Q))
|
|
return -EOPNOTSUPP;
|
|
|
|
- mtk_foe_entry_set_vlan(&foe, data.vlan.id);
|
|
+ mtk_foe_entry_set_vlan(eth, &foe, data.vlan.id);
|
|
}
|
|
if (data.pppoe.num == 1)
|
|
- mtk_foe_entry_set_pppoe(&foe, data.pppoe.sid);
|
|
+ mtk_foe_entry_set_pppoe(eth, &foe, data.pppoe.sid);
|
|
|
|
err = mtk_flow_set_output_device(eth, &foe, odev, data.eth.h_dest,
|
|
&wed_index);
|
|
--- a/drivers/net/ethernet/mediatek/mtk_ppe_regs.h
|
|
+++ b/drivers/net/ethernet/mediatek/mtk_ppe_regs.h
|
|
@@ -21,6 +21,9 @@
|
|
#define MTK_PPE_GLO_CFG_BUSY BIT(31)
|
|
|
|
#define MTK_PPE_FLOW_CFG 0x204
|
|
+#define MTK_PPE_MD_TOAP_BYP_CRSN0 BIT(1)
|
|
+#define MTK_PPE_MD_TOAP_BYP_CRSN1 BIT(2)
|
|
+#define MTK_PPE_MD_TOAP_BYP_CRSN2 BIT(3)
|
|
#define MTK_PPE_FLOW_CFG_IP4_TCP_FRAG BIT(6)
|
|
#define MTK_PPE_FLOW_CFG_IP4_UDP_FRAG BIT(7)
|
|
#define MTK_PPE_FLOW_CFG_IP6_3T_ROUTE BIT(8)
|
|
@@ -54,6 +57,7 @@
|
|
#define MTK_PPE_TB_CFG_HASH_MODE GENMASK(15, 14)
|
|
#define MTK_PPE_TB_CFG_SCAN_MODE GENMASK(17, 16)
|
|
#define MTK_PPE_TB_CFG_HASH_DEBUG GENMASK(19, 18)
|
|
+#define MTK_PPE_TB_CFG_INFO_SEL BIT(20)
|
|
|
|
enum {
|
|
MTK_PPE_SCAN_MODE_DISABLED,
|
|
@@ -112,6 +116,8 @@ enum {
|
|
#define MTK_PPE_DEFAULT_CPU_PORT 0x248
|
|
#define MTK_PPE_DEFAULT_CPU_PORT_MASK(_n) (GENMASK(2, 0) << ((_n) * 4))
|
|
|
|
+#define MTK_PPE_DEFAULT_CPU_PORT1 0x24c
|
|
+
|
|
#define MTK_PPE_MTU_DROP 0x308
|
|
|
|
#define MTK_PPE_VLAN_MTU0 0x30c
|
|
@@ -141,4 +147,6 @@ enum {
|
|
#define MTK_PPE_MIB_CACHE_CTL_EN BIT(0)
|
|
#define MTK_PPE_MIB_CACHE_CTL_FLUSH BIT(2)
|
|
|
|
+#define MTK_PPE_SBW_CTRL 0x374
|
|
+
|
|
#endif
|