Commit 4b41d343 authored by Grygorii Strashko's avatar Grygorii Strashko Committed by David S. Miller
Browse files

net: ethernet: ti: cpsw: allow untagged traffic on host port 



Now untagged vlan traffic is not support on Host P0 port. This patch adds
in ALE context bitmap of VLANs for which Host P0 port bit set in Force
Untagged Packet Egress bitmask in VLANs ALE entries, and adds corresponding
check in VLAN incapsulation header parsing function cpsw_rx_vlan_encap().

Signed-off-by: default avatarGrygorii Strashko <grygorii.strashko@ti.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 7fe579df

drivers/net/ethernet/ti/cpsw.c

+8 −9
Original line number Original line Diff line number Diff line
@@ -428,17 +428,16 @@ static void cpsw_rx_vlan_encap(struct sk_buff *skb) 
	/* Ignore vid 0 and pass packet as is */

	/* Ignore vid 0 and pass packet as is */

	if (!vid)

	if (!vid)

		return;

		return;

	/* Ignore default vlans in dual mac mode */

	if (cpsw->data.dual_emac &&

	    vid == cpsw->slaves[priv->emac_port].port_vlan)

		return;





	/* Untag P0 packets if set for vlan */

	if (!cpsw_ale_get_vlan_p0_untag(cpsw->ale, vid)) {

		prio = (rx_vlan_encap_hdr >>

		prio = (rx_vlan_encap_hdr >>

			CPSW_RX_VLAN_ENCAP_HDR_PRIO_SHIFT) &

			CPSW_RX_VLAN_ENCAP_HDR_PRIO_SHIFT) &

			CPSW_RX_VLAN_ENCAP_HDR_PRIO_MSK;

			CPSW_RX_VLAN_ENCAP_HDR_PRIO_MSK;





		vtag = (prio << VLAN_PRIO_SHIFT) | vid;

		vtag = (prio << VLAN_PRIO_SHIFT) | vid;

		__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), vtag);

		__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), vtag);

	}





	/* strip vlan tag for VLAN-tagged packet */

	/* strip vlan tag for VLAN-tagged packet */

	if (pkt_type == CPSW_RX_VLAN_ENCAP_HDR_PKT_VLAN_TAG) {

	if (pkt_type == CPSW_RX_VLAN_ENCAP_HDR_PKT_VLAN_TAG) {

drivers/net/ethernet/ti/cpsw_ale.c

+22 −1
Original line number Original line Diff line number Diff line
@@ -5,6 +5,8 @@ 
 * Copyright (C) 2012 Texas Instruments

 * Copyright (C) 2012 Texas Instruments

 *

 *

 */

 */

#include <linux/bitmap.h>

#include <linux/if_vlan.h>

#include <linux/kernel.h>

#include <linux/kernel.h>

#include <linux/module.h>

#include <linux/module.h>

#include <linux/platform_device.h>

#include <linux/platform_device.h>
@@ -415,6 +417,17 @@ static void cpsw_ale_set_vlan_mcast(struct cpsw_ale *ale, u32 *ale_entry, 
	writel(unreg_mcast, ale->params.ale_regs + ALE_VLAN_MASK_MUX(idx));

	writel(unreg_mcast, ale->params.ale_regs + ALE_VLAN_MASK_MUX(idx));

}

}





static void cpsw_ale_set_vlan_untag(struct cpsw_ale *ale, u32 *ale_entry,

				    u16 vid, int untag_mask)

{

	cpsw_ale_set_vlan_untag_force(ale_entry,

				      untag_mask, ale->vlan_field_bits);

	if (untag_mask & ALE_PORT_HOST)

		bitmap_set(ale->p0_untag_vid_mask, vid, 1);

	else

		bitmap_clear(ale->p0_untag_vid_mask, vid, 1);

}



int cpsw_ale_add_vlan(struct cpsw_ale *ale, u16 vid, int port, int untag,

int cpsw_ale_add_vlan(struct cpsw_ale *ale, u16 vid, int port, int untag,

		      int reg_mcast, int unreg_mcast)

		      int reg_mcast, int unreg_mcast)

{

{
@@ -427,8 +440,8 @@ int cpsw_ale_add_vlan(struct cpsw_ale *ale, u16 vid, int port, int untag, 




	cpsw_ale_set_entry_type(ale_entry, ALE_TYPE_VLAN);

	cpsw_ale_set_entry_type(ale_entry, ALE_TYPE_VLAN);

	cpsw_ale_set_vlan_id(ale_entry, vid);

	cpsw_ale_set_vlan_id(ale_entry, vid);

	cpsw_ale_set_vlan_untag(ale, ale_entry, vid, untag);





	cpsw_ale_set_vlan_untag_force(ale_entry, untag, ale->vlan_field_bits);

	if (!ale->params.nu_switch_ale) {

	if (!ale->params.nu_switch_ale) {

		cpsw_ale_set_vlan_reg_mcast(ale_entry, reg_mcast,

		cpsw_ale_set_vlan_reg_mcast(ale_entry, reg_mcast,

					    ale->vlan_field_bits);

					    ale->vlan_field_bits);
@@ -460,6 +473,7 @@ int cpsw_ale_del_vlan(struct cpsw_ale *ale, u16 vid, int port_mask) 
		return -ENOENT;

		return -ENOENT;





	cpsw_ale_read(ale, idx, ale_entry);

	cpsw_ale_read(ale, idx, ale_entry);

	cpsw_ale_set_vlan_untag(ale, ale_entry, vid, 0);





	if (port_mask)

	if (port_mask)

		cpsw_ale_set_vlan_member_list(ale_entry, port_mask,

		cpsw_ale_set_vlan_member_list(ale_entry, port_mask,
@@ -792,6 +806,13 @@ struct cpsw_ale *cpsw_ale_create(struct cpsw_ale_params *params) 
	if (!ale)

	if (!ale)

		return NULL;

		return NULL;





	ale->p0_untag_vid_mask =

		devm_kmalloc_array(params->dev, BITS_TO_LONGS(VLAN_N_VID),

				   sizeof(unsigned long),

				   GFP_KERNEL);

	if (!ale->p0_untag_vid_mask)

		return ERR_PTR(-ENOMEM);



	ale->params = *params;

	ale->params = *params;

	ale->ageout = ale->params.ale_ageout * HZ;

	ale->ageout = ale->params.ale_ageout * HZ;

drivers/net/ethernet/ti/cpsw_ale.h

+5 −0
Original line number Original line Diff line number Diff line
@@ -35,6 +35,7 @@ struct cpsw_ale { 
	u32			port_mask_bits;

	u32			port_mask_bits;

	u32			port_num_bits;

	u32			port_num_bits;

	u32			vlan_field_bits;

	u32			vlan_field_bits;

	unsigned long		*p0_untag_vid_mask;

};

};





enum cpsw_ale_control {

enum cpsw_ale_control {
@@ -115,4 +116,8 @@ int cpsw_ale_control_set(struct cpsw_ale *ale, int port, 
			 int control, int value);

			 int control, int value);

void cpsw_ale_dump(struct cpsw_ale *ale, u32 *data);

void cpsw_ale_dump(struct cpsw_ale *ale, u32 *data);





static inline int cpsw_ale_get_vlan_p0_untag(struct cpsw_ale *ale, u16 vid)

{

	return test_bit(vid, ale->p0_untag_vid_mask);

}

#endif
 
#endif

CRA Git | Maintained and supported by SUSTech CRA and CCSE