#include "airoha_eth.h"
static void airoha_debugfs_ppe_print_tuple(struct seq_file *m,
void *src_addr, void *dest_addr,
u16 *src_port, u16 *dest_port,
bool ipv6)
{
__be32 n_addr[IPV6_ADDR_WORDS];
if (ipv6) {
ipv6_addr_cpu_to_be32(n_addr, src_addr);
seq_printf(m, "%pI6", n_addr);
} else {
seq_printf(m, "%pI4h", src_addr);
}
if (src_port)
seq_printf(m, ":%d", *src_port);
seq_puts(m, "->");
if (ipv6) {
ipv6_addr_cpu_to_be32(n_addr, dest_addr);
seq_printf(m, "%pI6", n_addr);
} else {
seq_printf(m, "%pI4h", dest_addr);
}
if (dest_port)
seq_printf(m, ":%d", *dest_port);
}
static int airoha_ppe_debugfs_foe_show(struct seq_file *m, void *private,
bool bind)
{
static const char *const ppe_type_str[] = {
[PPE_PKT_TYPE_IPV4_HNAPT] = "IPv4 5T",
[PPE_PKT_TYPE_IPV4_ROUTE] = "IPv4 3T",
[PPE_PKT_TYPE_BRIDGE] = "L2B",
[PPE_PKT_TYPE_IPV4_DSLITE] = "DS-LITE",
[PPE_PKT_TYPE_IPV6_ROUTE_3T] = "IPv6 3T",
[PPE_PKT_TYPE_IPV6_ROUTE_5T] = "IPv6 5T",
[PPE_PKT_TYPE_IPV6_6RD] = "6RD",
};
static const char *const ppe_state_str[] = {
[AIROHA_FOE_STATE_INVALID] = "INV",
[AIROHA_FOE_STATE_UNBIND] = "UNB",
[AIROHA_FOE_STATE_BIND] = "BND",
[AIROHA_FOE_STATE_FIN] = "FIN",
};
struct airoha_ppe *ppe = m->private;
u32 ppe_num_entries = airoha_ppe_get_total_num_entries(ppe);
int i;
for (i = 0; i < ppe_num_entries; i++) {
const char *state_str, *type_str = "UNKNOWN";
void *src_addr = NULL, *dest_addr = NULL;
u16 *src_port = NULL, *dest_port = NULL;
struct airoha_foe_mac_info_common *l2;
unsigned char h_source[ETH_ALEN] = {};
struct airoha_foe_stats64 stats = {};
unsigned char h_dest[ETH_ALEN];
struct airoha_foe_entry *hwe;
u32 type, state, ib2, data;
bool ipv6 = false;
hwe = airoha_ppe_foe_get_entry(ppe, i);
if (!hwe)
continue;
state = FIELD_GET(AIROHA_FOE_IB1_BIND_STATE, hwe->ib1);
if (!state)
continue;
if (bind && state != AIROHA_FOE_STATE_BIND)
continue;
state_str = ppe_state_str[state % ARRAY_SIZE(ppe_state_str)];
type = FIELD_GET(AIROHA_FOE_IB1_BIND_PACKET_TYPE, hwe->ib1);
if (type < ARRAY_SIZE(ppe_type_str) && ppe_type_str[type])
type_str = ppe_type_str[type];
seq_printf(m, "%05x %s %7s", i, state_str, type_str);
switch (type) {
case PPE_PKT_TYPE_IPV4_HNAPT:
case PPE_PKT_TYPE_IPV4_DSLITE:
src_port = &hwe->ipv4.orig_tuple.src_port;
dest_port = &hwe->ipv4.orig_tuple.dest_port;
fallthrough;
case PPE_PKT_TYPE_IPV4_ROUTE:
src_addr = &hwe->ipv4.orig_tuple.src_ip;
dest_addr = &hwe->ipv4.orig_tuple.dest_ip;
break;
case PPE_PKT_TYPE_IPV6_ROUTE_5T:
src_port = &hwe->ipv6.src_port;
dest_port = &hwe->ipv6.dest_port;
fallthrough;
case PPE_PKT_TYPE_IPV6_ROUTE_3T:
case PPE_PKT_TYPE_IPV6_6RD:
src_addr = &hwe->ipv6.src_ip;
dest_addr = &hwe->ipv6.dest_ip;
ipv6 = true;
break;
default:
break;
}
if (src_addr && dest_addr) {
seq_puts(m, " orig=");
airoha_debugfs_ppe_print_tuple(m, src_addr, dest_addr,
src_port, dest_port, ipv6);
}
switch (type) {
case PPE_PKT_TYPE_IPV4_HNAPT:
case PPE_PKT_TYPE_IPV4_DSLITE:
src_port = &hwe->ipv4.new_tuple.src_port;
dest_port = &hwe->ipv4.new_tuple.dest_port;
fallthrough;
case PPE_PKT_TYPE_IPV4_ROUTE:
src_addr = &hwe->ipv4.new_tuple.src_ip;
dest_addr = &hwe->ipv4.new_tuple.dest_ip;
seq_puts(m, " new=");
airoha_debugfs_ppe_print_tuple(m, src_addr, dest_addr,
src_port, dest_port,
ipv6);
break;
default:
break;
}
if (type >= PPE_PKT_TYPE_IPV6_ROUTE_3T) {
data = hwe->ipv6.data;
ib2 = hwe->ipv6.ib2;
l2 = &hwe->ipv6.l2;
} else {
data = hwe->ipv4.data;
ib2 = hwe->ipv4.ib2;
l2 = &hwe->ipv4.l2.common;
*((__be16 *)&h_source[4]) =
cpu_to_be16(hwe->ipv4.l2.src_mac_lo);
}
airoha_ppe_foe_entry_get_stats(ppe, i, &stats);
*((__be32 *)h_dest) = cpu_to_be32(l2->dest_mac_hi);
*((__be16 *)&h_dest[4]) = cpu_to_be16(l2->dest_mac_lo);
*((__be32 *)h_source) = cpu_to_be32(l2->src_mac_hi);
seq_printf(m, " eth=%pM->%pM etype=%04x data=%08x"
" vlan=%d,%d ib1=%08x ib2=%08x"
" packets=%llu bytes=%llu\n",
h_source, h_dest, l2->etype, data,
l2->vlan1, l2->vlan2, hwe->ib1, ib2,
stats.packets, stats.bytes);
}
return 0;
}
static int airoha_ppe_debugfs_foe_all_show(struct seq_file *m, void *private)
{
return airoha_ppe_debugfs_foe_show(m, private, false);
}
DEFINE_SHOW_ATTRIBUTE(airoha_ppe_debugfs_foe_all);
static int airoha_ppe_debugfs_foe_bind_show(struct seq_file *m, void *private)
{
return airoha_ppe_debugfs_foe_show(m, private, true);
}
DEFINE_SHOW_ATTRIBUTE(airoha_ppe_debugfs_foe_bind);
int airoha_ppe_debugfs_init(struct airoha_ppe *ppe)
{
ppe->debugfs_dir = debugfs_create_dir("ppe", NULL);
debugfs_create_file("entries", 0444, ppe->debugfs_dir, ppe,
&airoha_ppe_debugfs_foe_all_fops);
debugfs_create_file("bind", 0444, ppe->debugfs_dir, ppe,
&airoha_ppe_debugfs_foe_bind_fops);
return 0;
}
