/*
* pnc_mac_da_mask - Add DA MAC address match rule to the MAC section
* @da: destination MAC address
* @mask: destination mask
* @len: destination MAC address length to match on: 0..6
* @port_mask: source port id: 0..1F or ANY
* @rxq: rx queue
* @rinfo: result info bits to set
*/
static struct tcam_entry *pnc_mac_da_mask(unsigned char *da, unsigned char *mask, unsigned int len,
unsigned int port_mask, int rxq, unsigned int rinfo)
{
struct tcam_entry *te = NULL;
if (len > MV_MAC_ADDR_SIZE)
goto out;
if (rinfo >= BIT24)
goto out;
te = tcam_sw_alloc(TCAM_LU_MAC);
/* set match on DA */
while (len--)
{
tcam_sw_set_byte(te, MV_ETH_MH_SIZE + len, da[len]);
tcam_sw_set_mask(te, MV_ETH_MH_SIZE + len, mask[len]);
}
/* port id match */
tcam_sw_set_port(te, 0, port_mask);
/* result info bit */
sram_sw_set_rinfo(te, rinfo);
/* set rx queue */
sram_sw_set_rxq(te, rxq, 0);
/* shift to ethertype */
sram_sw_set_shift_update(te, 0, MV_ETH_MH_SIZE + 2 * MV_MAC_ADDR_SIZE);
sram_sw_set_next_lookup(te, TCAM_LU_L2);
out:
return te;
}
/*
* pnc_mac_init - GE init phase configuration
*/
static int pnc_mac_init(void)
{
struct tcam_entry *te;
unsigned char da_mc[6] = { 0x01, 0x00, 0x00, 0x00, 0x00, 0x00 };
unsigned char da_mc_mask[6] = { 0x01, 0x00, 0x00, 0x00, 0x00, 0x00 };
unsigned char da_bc[6] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
PNC_DBG("%s\n", __func__);
/* broadcast - for all ports */
te = pnc_mac_da(da_bc, 6, 0, rxq_mac_bc, RI_DA_BC);
tcam_sw_text(te, "bcast");
tcam_hw_write(te, TE_MAC_BC);
tcam_sw_free(te);
/* flow control PAUSE frames - discard for all ports by default */
pnc_mac_fc_drop();
/* All Multicast - no ports by default */
te = pnc_mac_da_mask(da_mc, da_mc_mask, 1, PORT_MASK, rxq_mac_mc, RI_DA_MC);
tcam_sw_text(te, "mcast_all");
tcam_hw_write(te, TE_MAC_MC_ALL);
tcam_sw_free(te);
/* end of section */
te = tcam_sw_alloc(TCAM_LU_MAC);
sram_sw_set_flowid(te, FLOWID_EOF_LU_MAC, 0xF);
/* Non-promiscous mode - DROP unknown packets */
sram_sw_set_rinfo(te, RI_DROP);
sram_sw_set_lookup_done(te, 1);
tcam_sw_text(te, "mac_eof");
tcam_hw_write(te, TE_MAC_EOF);
tcam_sw_free(te);
return 0;
}
/*
* pnc_mac_fc_drop - Add Flow Control MAC address match rule to the MAC section
* to drop PAUSE frames arriving without Marvell Header on all ports
*/
static void pnc_mac_fc_drop(void)
{
struct tcam_entry *te = NULL;
unsigned char da[6] = { 0x01, 0x80, 0xC2, 0x00, 0x00, 0x01 };
unsigned int len = MV_MAC_ADDR_SIZE;
te = tcam_sw_alloc(TCAM_LU_MAC);
/* set match on DA */
while (len--)
tcam_sw_set_byte(te, len, da[len]);
/* port id match */
tcam_sw_set_port(te, 0, 0); /* all ports */
/* result info bit */
sram_sw_set_rinfo(te, RI_DROP);
tcam_sw_text(te, "flow control");
sram_sw_set_lookup_done(te, 1);
tcam_hw_write(te, TE_MAC_FLOW_CTRL);
tcam_sw_free(te);
}
static ssize_t tcam_store(struct device *dev,
struct device_attribute *attr, const char *buf, size_t len)
{
const char* name = attr->attr.name;
unsigned int err=0, a=0, b=0;
unsigned long flags;
if (!capable(CAP_NET_ADMIN))
return -EPERM;
sscanf(buf,"%x %x",&a, &b);
raw_local_irq_save(flags);
if (!strcmp(name, "hw_write"))
tcam_hw_write(&te, a);
else if (!strcmp(name, "hw_read"))
tcam_hw_read(&te, a);
else if (!strcmp(name, "hw_debug"))
tcam_hw_debug(a);
else if (!strcmp(name, "hw_inv"))
tcam_hw_inv(a);
else if (!strcmp(name, "hw_inv_all"))
tcam_hw_inv_all();
else if (!strcmp(name, "hw_hits"))
tcam_hw_record(a);
#ifdef CONFIG_MV_ETH_PNC_AGING
else if (!strcmp(name, "age_clear"))
mvPncAgingCntrClear(a);
else if (!strcmp(name, "age_cntr")) {
b = mvPncAgingCntrRead(a);
printk("tid=%d: age_cntr = 0x%08x\n", a, b);
}
#endif /* CONFIG_MV_ETH_PNC_AGING */
else if (!strcmp(name, "sw_clear"))
tcam_sw_clear(&te);
else if (!strcmp(name, "sw_text"))
{
/* Remove last byte (new line) from the buffer */
int len = strlen(buf);
char* temp = mvOsMalloc(len + 1);
strncpy(temp, buf, len-1);
temp[len-1] = 0;
tcam_sw_text(&te, temp);
mvOsFree(temp);
}
else if (!strcmp(name, "t_port"))
tcam_sw_set_port(&te, a, b);
else if (!strcmp(name, "t_lookup"))
tcam_sw_set_lookup(&te, a);
else if (!strcmp(name, "t_ainfo_0"))
tcam_sw_set_ainfo(&te, 0<<a, 1<<a);
else if (!strcmp(name, "t_ainfo_1"))
tcam_sw_set_ainfo(&te, 1<<a, 1<<a);
else if (!strcmp(name, "t_ainfo"))
tcam_sw_set_ainfo(&te, a, b);
else if (!strcmp(name, "t_offset_byte"))
tcam_sw_set_byte(&te, a, b);
else if (!strcmp(name, "t_offset_mask"))
tcam_sw_set_mask(&te, a, b);
else if (!strcmp(name, "s_lookup"))
sram_sw_set_next_lookup(&te, a);
else if (!strcmp(name, "s_ainfo"))
sram_sw_set_ainfo(&te, a, b);
else if (!strcmp(name, "s_lookup_done"))
sram_sw_set_lookup_done(&te, a);
else if (!strcmp(name, "s_next_lookup_shift"))
sram_sw_set_next_lookup_shift(&te, a);
else if (!strcmp(name, "s_rxq"))
sram_sw_set_rxq(&te, a, b);
else if (!strcmp(name, "s_shift_update"))
sram_sw_set_shift_update(&te,a,b);
else if (!strcmp(name, "s_rinfo"))
sram_sw_set_rinfo(&te, 1 << a);
else if (!strcmp(name, "s_rinfo_extra"))
sram_sw_set_rinfo_extra(&te, a << (b & ~1));
else if (!strcmp(name, "s_flowid"))
sram_sw_set_flowid(&te, a, b);
else if (!strcmp(name, "s_flowid_nibble"))
sram_sw_set_flowid_nibble(&te, a, b);
#ifdef CONFIG_MV_ETH_PNC_AGING
else if (!strcmp(name, "age_gr_set"))
mvPncAgingCntrGroupSet(a, b);
#endif /* CONFIG_MV_ETH_PNC_AGING */
else {
err = 1;
printk("%s: illegal operation <%s>\n", __FUNCTION__, attr->attr.name);
}
raw_local_irq_restore(flags);
if (err)
printk("%s: <%s>, error %d\n", __FUNCTION__, attr->attr.name, err);
return err ? -EINVAL : len;
}
