From: Boon Khai Ng <boon.khai.ng@intel.com>
To: "David S . Miller" <davem@davemloft.net>
Cc: linux-kernel@vger.kernel.org,
Mun Yew Tham <mun.yew.tham@intel.com>,
Tien Sung Ang <tien.sung.ang@intel.com>,
Boon Khai Ng <boon.khai.ng@intel.com>
Subject: [PATCH v1 7/8] net: stmmac: Add Double VLAN handling for VLAN Rx filtering
Date: Thu, 30 Mar 2023 15:04:05 +0800 [thread overview]
Message-ID: <20230330070405.6901-1-boon.khai.ng@intel.com> (raw)
Add double VLAN handling for VLAN Rx Filtering.
Signed-off-by: Boon Khai Ng <boon.khai.ng@intel.com>
---
drivers/net/ethernet/stmicro/stmmac/common.h | 1 +
drivers/net/ethernet/stmicro/stmmac/dwxgmac2.h | 3 +++
.../ethernet/stmicro/stmmac/dwxgmac2_core.c | 18 ++++++++++++++++++
3 files changed, 22 insertions(+)
diff --git a/drivers/net/ethernet/stmicro/stmmac/common.h b/drivers/net/ethernet/stmicro/stmmac/common.h
index ec9c130276d8..ca2d4515dd0f 100644
--- a/drivers/net/ethernet/stmicro/stmmac/common.h
+++ b/drivers/net/ethernet/stmicro/stmmac/common.h
@@ -535,6 +535,7 @@ struct mac_device_info {
unsigned int promisc;
bool vlan_fail_q_en;
u8 vlan_fail_q;
+ unsigned int double_vlan;
};
struct stmmac_rx_routing {
diff --git a/drivers/net/ethernet/stmicro/stmmac/dwxgmac2.h b/drivers/net/ethernet/stmicro/stmmac/dwxgmac2.h
index 3f11b2c52324..428f82905273 100644
--- a/drivers/net/ethernet/stmicro/stmmac/dwxgmac2.h
+++ b/drivers/net/ethernet/stmicro/stmmac/dwxgmac2.h
@@ -499,6 +499,9 @@
#define XGMAC_VLAN_TAG_STRIP_ALL (0x3 << XGMAC_VLAN_TAG_CTRL_EVLS_SHIFT)
#define XGMAC_VLAN_TAG_DATA 0x00000054
+#define XGMAC_VLAN_TAG_DATA_ERIVLT BIT(20)
+#define XGMAC_VLAN_TAG_DATA_ERSVLM BIT(19)
+#define XGMAC_VLAN_TAG_DATA_DOVLTC BIT(18)
#define XGMAC_VLAN_TAG_DATA_ETV BIT(17)
#define XGMAC_VLAN_TAG_DATA_VEN BIT(16)
#define XGMAC_VLAN_TAG_DATA_VID GENMASK(15, 0)
diff --git a/drivers/net/ethernet/stmicro/stmmac/dwxgmac2_core.c b/drivers/net/ethernet/stmicro/stmmac/dwxgmac2_core.c
index 78bad5242562..4dff53dc771f 100644
--- a/drivers/net/ethernet/stmicro/stmmac/dwxgmac2_core.c
+++ b/drivers/net/ethernet/stmicro/stmmac/dwxgmac2_core.c
@@ -438,6 +438,15 @@ static int dwxgmac2_write_vlan_filter(struct net_device *dev,
if (index >= hw->num_vlan)
return -EINVAL;
+ if (hw->double_vlan) {
+ data |= XGMAC_VLAN_TAG_DATA_DOVLTC;
+ data |= XGMAC_VLAN_TAG_DATA_ERIVLT;
+ data &= ~XGMAC_VLAN_TAG_DATA_ERSVLM;
+ } else {
+ data &= ~XGMAC_VLAN_TAG_DATA_DOVLTC;
+ data &= ~XGMAC_VLAN_TAG_DATA_ERIVLT;
+ }
+
writel(data, ioaddr + XGMAC_VLAN_TAG_DATA);
val = readl(ioaddr + XGMAC_VLAN_TAG);
@@ -1855,6 +1864,14 @@ static u32 dwxgmac2_get_num_vlan(void __iomem *ioaddr)
return num_vlan;
}
+static u32 dwxgmac2_is_double_vlan(void __iomem *ioaddr)
+{
+ u32 val;
+
+ val = readl(ioaddr + XGMAC_HW_FEATURE3);
+ return (val & XGMAC_HWFEAT_DVLAN);
+}
+
int dwxgmac2_setup(struct stmmac_priv *priv)
{
struct mac_device_info *mac = priv->hw;
@@ -1889,6 +1906,7 @@ int dwxgmac2_setup(struct stmmac_priv *priv)
mac->mii.clk_csr_shift = 19;
mac->mii.clk_csr_mask = GENMASK(21, 19);
mac->num_vlan = dwxgmac2_get_num_vlan(priv->ioaddr);
+ mac->double_vlan = dwxgmac2_is_double_vlan(priv->ioaddr);
return 0;
}
--
2.25.1
next reply other threads:[~2023-03-30 7:04 UTC|newest]
Thread overview: 2+ messages / expand[flat|nested] mbox.gz Atom feed top
2023-03-30 7:04 Boon Khai Ng [this message]
2023-03-30 17:25 ` Please ignore this review, send out by accident Boon Khai Ng
Reply instructions:
You may reply publicly to this message via plain-text email
using any one of the following methods:
* Save the following mbox file, import it into your mail client,
and reply-to-all from there: mbox
Avoid top-posting and favor interleaved quoting:
https://en.wikipedia.org/wiki/Posting_style#Interleaved_style
* Reply using the --to, --cc, and --in-reply-to
switches of git-send-email(1):
git send-email \
--in-reply-to=20230330070405.6901-1-boon.khai.ng@intel.com \
--to=boon.khai.ng@intel.com \
--cc=davem@davemloft.net \
--cc=linux-kernel@vger.kernel.org \
--cc=mun.yew.tham@intel.com \
--cc=tien.sung.ang@intel.com \
/path/to/YOUR_REPLY
https://kernel.org/pub/software/scm/git/docs/git-send-email.html
* If your mail client supports setting the In-Reply-To header
via mailto: links, try the mailto: link
Be sure your reply has a Subject: header at the top and a blank line
before the message body.
This is a public inbox, see mirroring instructions
for how to clone and mirror all data and code used for this inbox
all inboxes | Powered by JetHome®