Commit bd2b3161 authored by Xiaoliang Yang's avatar Xiaoliang Yang Committed by David S. Miller
Browse files

net: dsa: felix: qos classified based on pcp 



Set the default QoS Classification based on PCP and DEI of vlan tag,
after that, frames can be Classified to different Qos based on PCP tag.
If there is no vlan tag or vlan ignored, use port default Qos.

Signed-off-by: default avatarXiaoliang Yang <xiaoliang.yang_1@nxp.com>
Reviewed-by: default avatarFlorian Fainelli <f.fainelli@gmail.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent fb9f2e92

drivers/net/dsa/ocelot/felix.c

+26 −0
Original line number Diff line number Diff line
@@ -289,6 +289,27 @@ static void felix_phylink_mac_link_up(struct dsa_switch *ds, int port, 
			 QSYS_SWITCH_PORT_MODE, port);

}



static void felix_port_qos_map_init(struct ocelot *ocelot, int port)

{

	int i;



	ocelot_rmw_gix(ocelot,

		       ANA_PORT_QOS_CFG_QOS_PCP_ENA,

		       ANA_PORT_QOS_CFG_QOS_PCP_ENA,

		       ANA_PORT_QOS_CFG,

		       port);



	for (i = 0; i < FELIX_NUM_TC * 2; i++) {

		ocelot_rmw_ix(ocelot,

			      (ANA_PORT_PCP_DEI_MAP_DP_PCP_DEI_VAL & i) |

			      ANA_PORT_PCP_DEI_MAP_QOS_PCP_DEI_VAL(i),

			      ANA_PORT_PCP_DEI_MAP_DP_PCP_DEI_VAL |

			      ANA_PORT_PCP_DEI_MAP_QOS_PCP_DEI_VAL_M,

			      ANA_PORT_PCP_DEI_MAP,

			      port, i);

	}

}



static void felix_get_strings(struct dsa_switch *ds, int port,

			      u32 stringset, u8 *data)

{
@@ -547,6 +568,11 @@ static int felix_setup(struct dsa_switch *ds) 
			ocelot_configure_cpu(ocelot, port,

					     OCELOT_TAG_PREFIX_NONE,

					     OCELOT_TAG_PREFIX_LONG);



		/* Set the default QoS Classification based on PCP and DEI

		 * bits of vlan tag.

		 */

		felix_port_qos_map_init(ocelot, port);

	}



	/* Include the CPU port module in the forwarding mask for unknown

CRA Git | Maintained and supported by SUSTech CRA and CCSE