From 13c21fe90c1666b538a2221dafb12955ac40a031 Mon Sep 17 00:00:00 2001 From: Hauke Mehrtens Date: Wed, 13 Nov 2013 18:04:39 +0000 Subject: [PATCH] kernel: b53: fix untagged shift for BCM5365 The BCM5365 needs a shift of 7 bits and not 6 bits like the BCM5325 for the untagged ports. Thank you Russell for reporting this and testing the patch. Signed-off-by: Hauke Mehrtens SVN-Revision: 38793 --- target/linux/generic/files/drivers/net/phy/b53/b53_common.c | 6 ++++-- target/linux/generic/files/drivers/net/phy/b53/b53_regs.h | 6 ++++-- 2 files changed, 8 insertions(+), 4 deletions(-) diff --git a/target/linux/generic/files/drivers/net/phy/b53/b53_common.c b/target/linux/generic/files/drivers/net/phy/b53/b53_common.c index 39027c1771..f5dd068a1b 100644 --- a/target/linux/generic/files/drivers/net/phy/b53/b53_common.c +++ b/target/linux/generic/files/drivers/net/phy/b53/b53_common.c @@ -189,7 +189,8 @@ static void b53_set_vlan_entry(struct b53_device *dev, u16 vid, u16 members, u32 entry = 0; if (members) { - entry = (untag << VA_UNTAG_S) | members; + entry = ((untag & VA_UNTAG_MASK_25) << VA_UNTAG_S_25) | + members; if (dev->core_rev >= 3) entry |= VA_VALID_25_R4 | vid << VA_VID_HIGH_S; else @@ -203,7 +204,8 @@ static void b53_set_vlan_entry(struct b53_device *dev, u16 vid, u16 members, u16 entry = 0; if (members) - entry = (untag << VA_UNTAG_S) | members | VA_VALID_65; + entry = ((untag & VA_UNTAG_MASK_65) << VA_UNTAG_S_65) | + members | VA_VALID_65; b53_write16(dev, B53_VLAN_PAGE, B53_VLAN_WRITE_65, entry); b53_write16(dev, B53_VLAN_PAGE, B53_VLAN_TABLE_ACCESS_65, vid | diff --git a/target/linux/generic/files/drivers/net/phy/b53/b53_regs.h b/target/linux/generic/files/drivers/net/phy/b53/b53_regs.h index 7018ff4ebb..ba509154f6 100644 --- a/target/linux/generic/files/drivers/net/phy/b53/b53_regs.h +++ b/target/linux/generic/files/drivers/net/phy/b53/b53_regs.h @@ -282,8 +282,10 @@ #define B53_VLAN_WRITE_65 0x0a #define B53_VLAN_READ 0x0c #define VA_MEMBER_MASK 0x3f -#define VA_UNTAG_S 6 -#define VA_UNTAG_MASK (0x3f << VA_UNTAG_S) +#define VA_UNTAG_S_25 6 +#define VA_UNTAG_MASK_25 0x3f +#define VA_UNTAG_S_65 7 +#define VA_UNTAG_MASK_65 0x1f #define VA_VID_HIGH_S 12 #define VA_VID_HIGH_MASK (0xffff << VA_VID_HIGH_S) #define VA_VALID_25 BIT(20) -- 2.30.2