1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186
|
// SPDX-License-Identifier: GPL-2.0-only
/*
* Copyright (c) 2025 AIROHA Inc
* Author: Lorenzo Bianconi <lorenzo@kernel.org>
*/
#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;
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;
}
|