int cpsw_ale_flush_multicast(struct cpsw_ale *ale, int port_mask, int vid)
{
u32 ale_entry[ALE_ENTRY_WORDS];
int ret, idx;
for (idx = 0; idx < ale->params.ale_entries; idx++) {
cpsw_ale_read(ale, idx, ale_entry);
ret = cpsw_ale_get_entry_type(ale_entry);
if (ret != ALE_TYPE_ADDR && ret != ALE_TYPE_VLAN_ADDR)
continue;
/* if vid passed is -1 then remove all multicast entry from
* the table irrespective of vlan id, if a valid vlan id is
* passed then remove only multicast added to that vlan id.
* if vlan id doesn't match then move on to next entry.
*/
if (vid != -1 && cpsw_ale_get_vlan_id(ale_entry) != vid)
continue;
if (cpsw_ale_get_mcast(ale_entry)) {
u8 addr[6];
cpsw_ale_get_addr(ale_entry, addr);
if (!is_broadcast_ether_addr(addr))
cpsw_ale_flush_mcast(ale, ale_entry, port_mask);
}
cpsw_ale_write(ale, idx, ale_entry);
}
return 0;
}
static int cpsw_ale_match_addr(struct cpsw_ale *ale, u8* addr)
{
u32 ale_entry[ALE_ENTRY_WORDS];
int type, idx;
for (idx = 0; idx < ale->ale_entries; idx++) {
u8 entry_addr[6];
cpsw_ale_read(ale, idx, ale_entry);
type = cpsw_ale_get_entry_type(ale_entry);
if (type != ALE_TYPE_ADDR && type != ALE_TYPE_VLAN_ADDR)
continue;
cpsw_ale_get_addr(ale_entry, entry_addr);
if (memcmp(entry_addr, addr, 6) == 0)
return idx;
}
return -ENOENT;
}
int cpsw_ale_match_addr(struct cpsw_ale *ale, u8 *addr, u16 vid)
{
u32 ale_entry[ALE_ENTRY_WORDS];
int type, idx;
for (idx = 0; idx < ale->params.ale_entries; idx++) {
u8 entry_addr[6];
cpsw_ale_read(ale, idx, ale_entry);
type = cpsw_ale_get_entry_type(ale_entry);
if (type != ALE_TYPE_ADDR && type != ALE_TYPE_VLAN_ADDR)
continue;
if (cpsw_ale_get_vlan_id(ale_entry) != vid)
continue;
cpsw_ale_get_addr(ale_entry, entry_addr);
if (ether_addr_equal(entry_addr, addr))
return idx;
}
return -ENOENT;
}
int cpsw_ale_flush_multicast(struct cpsw_ale *ale, int port_mask)
{
u32 ale_entry[ALE_ENTRY_WORDS];
int ret, idx;
for (idx = 0; idx < ale->params.ale_entries; idx++) {
cpsw_ale_read(ale, idx, ale_entry);
ret = cpsw_ale_get_entry_type(ale_entry);
if (ret != ALE_TYPE_ADDR && ret != ALE_TYPE_VLAN_ADDR)
continue;
if (cpsw_ale_get_mcast(ale_entry)) {
u8 addr[6];
cpsw_ale_get_addr(ale_entry, addr);
if (!is_broadcast_ether_addr(addr))
cpsw_ale_flush_mcast(ale, ale_entry, port_mask);
}
cpsw_ale_write(ale, idx, ale_entry);
}
return 0;
}
static int cpsw_ale_dump_entry(int idx, u32 *ale_entry, char *buf, int len)
{
int type, outlen = 0;
u8 addr[6];
static const char *str_type[] = {"free", "addr", "vlan", "vlan+addr"};
type = cpsw_ale_get_entry_type(ale_entry);
if (type == ALE_TYPE_FREE)
return outlen;
if (idx >= 0) {
outlen += snprintf(buf + outlen, len - outlen,
"index %d, ", idx);
}
outlen += snprintf(buf + outlen, len - outlen, "raw: %08x %08x %08x, ",
ale_entry[0], ale_entry[1], ale_entry[2]);
outlen += snprintf(buf + outlen, len - outlen,
"type: %s(%d), ", str_type[type], type);
cpsw_ale_get_addr(ale_entry, addr);
outlen += snprintf(buf + outlen, len - outlen,
"addr: " ADDR_FMT_STR ", ", ADDR_FMT_ARGS(addr));
if (type == ALE_TYPE_VLAN || type == ALE_TYPE_VLAN_ADDR) {
outlen += snprintf(buf + outlen, len - outlen, "vlan: %d, ",
cpsw_ale_get_vlan_id(ale_entry));
}
outlen += cpsw_ale_get_mcast(ale_entry) ?
cpsw_ale_dump_mcast(ale_entry, buf + outlen, len - outlen) :
cpsw_ale_dump_ucast(ale_entry, buf + outlen, len - outlen);
return outlen;
}