ipq40xx: fix ethernet vlan double tagging

[openwrt/openwrt.git] / target / linux / ipq40xx / patches-5.4 / 705-net-add-qualcomm-ar40xx-phy.patch

diff --git a/target/linux/ipq40xx/patches-5.4/705-net-add-qualcomm-ar40xx-phy.patch b/target/linux/ipq40xx/patches-5.4/705-net-add-qualcomm-ar40xx-phy.patch
index 648723df0698f6d9d2cb17b8f6b99d2d294f9bd0..6c823b3483400fbb8e332b8e5e604ab00f0e1297 100644 (file)
--- a/target/linux/ipq40xx/patches-5.4/705-net-add-qualcomm-ar40xx-phy.patch
+++ b/target/linux/ipq40xx/patches-5.4/705-net-add-qualcomm-ar40xx-phy.patch
@@ -32,7 +32,7 @@ Index: linux-5.4.51/drivers/net/phy/ar40xx.c
 ===================================================================
 --- /dev/null
 +++ linux-5.4.51/drivers/net/phy/ar40xx.c
 ===================================================================
 --- /dev/null
 +++ linux-5.4.51/drivers/net/phy/ar40xx.c

-@@ -0,0 +1,2097 @@
+@@ -0,0 +1,2118 @@

 +/*
 + * Copyright (c) 2016, The Linux Foundation. All rights reserved.
 + *
 +/*
 + * Copyright (c) 2016, The Linux Foundation. All rights reserved.
 + *


@@ -1235,7 +1235,11 @@ Index: linux-5.4.51/drivers/net/phy/ar40xx.c
 +      ar40xx_rmw(priv, AR40XX_REG_PORT_STATUS(port),
 +                      AR40XX_PORT_AUTO_LINK_EN, 0);
 +
 +      ar40xx_rmw(priv, AR40XX_REG_PORT_STATUS(port),
 +                      AR40XX_PORT_AUTO_LINK_EN, 0);
 +

-+      ar40xx_write(priv, AR40XX_REG_PORT_HEADER(port), 0);
++      /* CPU port is setting headers to limit output ports */
++      if (port == 0)
++              ar40xx_write(priv, AR40XX_REG_PORT_HEADER(port), 0x8);
++      else
++              ar40xx_write(priv, AR40XX_REG_PORT_HEADER(port), 0);

 +
 +      ar40xx_write(priv, AR40XX_REG_PORT_VLAN0(port), 0);
 +
 +
 +      ar40xx_write(priv, AR40XX_REG_PORT_VLAN0(port), 0);
 +


@@ -1278,6 +1282,10 @@ Index: linux-5.4.51/drivers/net/phy/ar40xx.c
 +      t = (AR40XX_PORT0_FC_THRESH_ON_DFLT << 16) |
 +            AR40XX_PORT0_FC_THRESH_OFF_DFLT;
 +      ar40xx_write(priv, AR40XX_REG_PORT_FLOWCTRL_THRESH(0), t);
 +      t = (AR40XX_PORT0_FC_THRESH_ON_DFLT << 16) |
 +            AR40XX_PORT0_FC_THRESH_OFF_DFLT;
 +      ar40xx_write(priv, AR40XX_REG_PORT_FLOWCTRL_THRESH(0), t);

++
++      /* set service tag to 802.1q */
++      t = ETH_P_8021Q | AR40XX_ESS_SERVICE_TAG_STAG;
++      ar40xx_write(priv, AR40XX_ESS_SERVICE_TAG, t);

 +}
 +
 +static void
 +}
 +
 +static void


@@ -1603,7 +1611,11 @@ Index: linux-5.4.51/drivers/net/phy/ar40xx.c
 +      u32 pvid = priv->vlan_id[priv->pvid[port]];
 +
 +      if (priv->vlan) {
 +      u32 pvid = priv->vlan_id[priv->pvid[port]];
 +
 +      if (priv->vlan) {

-+              egress = AR40XX_PORT_VLAN1_OUT_MODE_UNMOD;
++              if (priv->vlan_tagged & BIT(port))
++                      egress = AR40XX_PORT_VLAN1_OUT_MODE_TAG;
++              else
++                      egress = AR40XX_PORT_VLAN1_OUT_MODE_UNMOD;
++

 +              ingress = AR40XX_IN_SECURE;
 +      } else {
 +              egress = AR40XX_PORT_VLAN1_OUT_MODE_UNTOUCH;
 +              ingress = AR40XX_IN_SECURE;
 +      } else {
 +              egress = AR40XX_PORT_VLAN1_OUT_MODE_UNTOUCH;


@@ -1614,8 +1626,17 @@ Index: linux-5.4.51/drivers/net/phy/ar40xx.c
 +      t |= pvid << AR40XX_PORT_VLAN0_DEF_CVID_S;
 +      ar40xx_write(priv, AR40XX_REG_PORT_VLAN0(port), t);
 +
 +      t |= pvid << AR40XX_PORT_VLAN0_DEF_CVID_S;
 +      ar40xx_write(priv, AR40XX_REG_PORT_VLAN0(port), t);
 +

-+      t = AR40XX_PORT_VLAN1_PORT_VLAN_PROP;
-+      t |= egress << AR40XX_PORT_VLAN1_OUT_MODE_S;
++      t = egress << AR40XX_PORT_VLAN1_OUT_MODE_S;
++
++      /* set CPU port to core port */
++      if (port == 0)
++              t |= AR40XX_PORT_VLAN1_CORE_PORT;
++
++      if (priv->vlan_tagged & BIT(port))
++              t |= AR40XX_PORT_VLAN1_PORT_VLAN_PROP;
++      else
++              t |= AR40XX_PORT_VLAN1_PORT_TLS_MODE;
++

 +      ar40xx_write(priv, AR40XX_REG_PORT_VLAN1(port), t);
 +
 +      t = members;
 +      ar40xx_write(priv, AR40XX_REG_PORT_VLAN1(port), t);
 +
 +      t = members;


@@ -2134,7 +2155,7 @@ Index: linux-5.4.51/drivers/net/phy/ar40xx.h
 ===================================================================
 --- /dev/null
 +++ linux-5.4.51/drivers/net/phy/ar40xx.h
 ===================================================================
 --- /dev/null
 +++ linux-5.4.51/drivers/net/phy/ar40xx.h

-@@ -0,0 +1,337 @@
+@@ -0,0 +1,342 @@

 +/*
 + * Copyright (c) 2016, The Linux Foundation. All rights reserved.
 + *
 +/*
 + * Copyright (c) 2016, The Linux Foundation. All rights reserved.
 + *


@@ -2288,6 +2309,9 @@ Index: linux-5.4.51/drivers/net/phy/ar40xx.h
 +#define   AR40XX_MIB_FUNC_NO_OP               0x0
 +#define   AR40XX_MIB_FUNC_FLUSH               0x1
 +
 +#define   AR40XX_MIB_FUNC_NO_OP               0x0
 +#define   AR40XX_MIB_FUNC_FLUSH               0x1
 +

++#define AR40XX_ESS_SERVICE_TAG                0x48
++#define AR40XX_ESS_SERVICE_TAG_STAG   BIT(17)
++

 +#define AR40XX_REG_PORT_STATUS(_i)            (0x07c + (_i) * 4)
 +#define   AR40XX_PORT_SPEED                   BITS(0, 2)
 +#define   AR40XX_PORT_STATUS_SPEED_S  0
 +#define AR40XX_REG_PORT_STATUS(_i)            (0x07c + (_i) * 4)
 +#define   AR40XX_PORT_SPEED                   BITS(0, 2)
 +#define   AR40XX_PORT_STATUS_SPEED_S  0


@@ -2316,6 +2340,8 @@ Index: linux-5.4.51/drivers/net/phy/ar40xx.h
 +#define   AR40XX_PORT_VLAN0_DEF_CVID_S                16
 +
 +#define AR40XX_REG_PORT_VLAN1(_i)             (0x424 + (_i) * 0x8)
 +#define   AR40XX_PORT_VLAN0_DEF_CVID_S                16
 +
 +#define AR40XX_REG_PORT_VLAN1(_i)             (0x424 + (_i) * 0x8)

++#define   AR40XX_PORT_VLAN1_CORE_PORT         BIT(9)
++#define   AR40XX_PORT_VLAN1_PORT_TLS_MODE     BIT(7)

 +#define   AR40XX_PORT_VLAN1_PORT_VLAN_PROP    BIT(6)
 +#define   AR40XX_PORT_VLAN1_OUT_MODE          BITS(12, 2)
 +#define   AR40XX_PORT_VLAN1_OUT_MODE_S                12
 +#define   AR40XX_PORT_VLAN1_PORT_VLAN_PROP    BIT(6)
 +#define   AR40XX_PORT_VLAN1_OUT_MODE          BITS(12, 2)
 +#define   AR40XX_PORT_VLAN1_OUT_MODE_S                12