gfwleak/stellar-stellar
Archived
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

refactor: packet dump utils

Browse Source
This commit is contained in:
luwenpeng
2024-08-13 10:24:26 +08:00
parent ff8630e436
commit 03468d55be
13 changed files with 200 additions and 186 deletions
Download Patch File Download Diff File Expand all files Collapse all files

166
src/packet/packet_parse.cpp
View File

@@ -54,7 +54,6 @@
* Static API
******************************************************************************/
static inline const char *layer_proto_to_str(enum layer_proto proto);
static inline struct raw_layer *get_free_layer(struct packet *pkt);
// 数据链路层
@@ -92,51 +91,6 @@ static inline const char *parse_l4(struct packet *pkt, uint8_t next_proto, const
* Private API -- Utils
******************************************************************************/
static inline const char *layer_proto_to_str(enum layer_proto proto)
{
switch (proto)
{
case LAYER_PROTO_ETHER:
return "ETH";
case LAYER_PROTO_PWETH:
return "PWETH";
case LAYER_PROTO_PPP:
return "PPP";
case LAYER_PROTO_L2TP:
return "L2TP";
case LAYER_PROTO_VLAN:
return "VLAN";
case LAYER_PROTO_PPPOE:
return "PPPOE";
case LAYER_PROTO_MPLS:
return "MPLS";
case LAYER_PROTO_IPV4:
return "IPV4";
case LAYER_PROTO_IPV6:
return "IPV6";
case LAYER_PROTO_IPAH:
return "IPAH";
case LAYER_PROTO_GRE:
return "GRE";
case LAYER_PROTO_UDP:
return "UDP";
case LAYER_PROTO_TCP:
return "TCP";
case LAYER_PROTO_ICMP:
return "ICMP";
case LAYER_PROTO_ICMP6:
return "ICMP6";
case LAYER_PROTO_VXLAN:
return "VXLAN";
case LAYER_PROTO_GTP_C:
return "GTP-C";
case LAYER_PROTO_GTP_U:
return "GTP-U";
default:
return "UNKNOWN";
}
}
static inline struct raw_layer *get_free_layer(struct packet *pkt)
{
if (pkt->layers_used >= pkt->layers_size)
@@ -986,87 +940,47 @@ const char *packet_parse(struct packet *pkt, const char *data, uint16_t len)
return parse_ether(pkt, data, len);
}
int packet_to_str(const struct packet *pkt, char *buff, int size)
const char *layer_proto_to_str(enum layer_proto proto)
{
if (pkt == NULL)
switch (proto)
{
return 0;
case LAYER_PROTO_ETHER:
return "ETH";
case LAYER_PROTO_PWETH:
return "PWETH";
case LAYER_PROTO_PPP:
return "PPP";
case LAYER_PROTO_L2TP:
return "L2TP";
case LAYER_PROTO_VLAN:
return "VLAN";
case LAYER_PROTO_PPPOE:
return "PPPOE";
case LAYER_PROTO_MPLS:
return "MPLS";
case LAYER_PROTO_IPV4:
return "IPV4";
case LAYER_PROTO_IPV6:
return "IPV6";
case LAYER_PROTO_IPAH:
return "IPAH";
case LAYER_PROTO_GRE:
return "GRE";
case LAYER_PROTO_UDP:
return "UDP";
case LAYER_PROTO_TCP:
return "TCP";
case LAYER_PROTO_ICMP:
return "ICMP";
case LAYER_PROTO_ICMP6:
return "ICMP6";
case LAYER_PROTO_VXLAN:
return "VXLAN";
case LAYER_PROTO_GTP_C:
return "GTP-C";
case LAYER_PROTO_GTP_U:
return "GTP-U";
default:
return "UNKNOWN";
}
int used = 0;
memset(buff, 0, size);
used += snprintf(buff + used, size - used, "packet: %p, data_ptr: %p, data_len: %u, trim_len: %u, layers_used: %d, layers_size: %d\n",
pkt, pkt->data_ptr, pkt->data_len, pkt->trim_len,
pkt->layers_used, pkt->layers_size);
for (uint8_t i = 0; i < pkt->layers_used; i++)
{
const struct raw_layer *layer = &pkt->layers[i];
used += snprintf(buff + used, size - used, "=> layer[%u]: %p, proto: %s, header: {offset: %u, ptr: %p, len: %u}, payload: {ptr: %p, len: %u}\n",
i, layer, layer_proto_to_str(layer->proto), layer->hdr_offset,
layer->hdr_ptr, layer->hdr_len, layer->pld_ptr, layer->pld_len);
switch (layer->proto)
{
case LAYER_PROTO_ETHER:
used += eth_hdr_to_str((const struct ethhdr *)layer->hdr_ptr, buff + used, size - used);
used += snprintf(buff + used, size - used, "\n");
break;
case LAYER_PROTO_PWETH:
break;
case LAYER_PROTO_PPP:
break;
case LAYER_PROTO_L2TP:
used += l2tp_hdr_to_str((const struct l2tp_hdr *)layer->hdr_ptr, buff + used, size - used);
used += snprintf(buff + used, size - used, "\n");
break;
case LAYER_PROTO_VLAN:
used += vlan_hdr_to_str((const struct vlan_hdr *)layer->hdr_ptr, buff + used, size - used);
used += snprintf(buff + used, size - used, "\n");
break;
case LAYER_PROTO_PPPOE:
break;
case LAYER_PROTO_MPLS:
used += mpls_label_to_str((const struct mpls_label *)layer->hdr_ptr, buff + used, size - used);
used += snprintf(buff + used, size - used, "\n");
break;
case LAYER_PROTO_IPV4:
used += ip4_hdr_to_str((const struct ip *)layer->hdr_ptr, buff + used, size - used);
used += snprintf(buff + used, size - used, "\n");
break;
case LAYER_PROTO_IPV6:
used += ip6_hdr_to_str((const struct ip6_hdr *)layer->hdr_ptr, buff + used, size - used);
used += snprintf(buff + used, size - used, "\n");
break;
case LAYER_PROTO_IPAH:
break;
case LAYER_PROTO_GRE:
used += gre_hdr_to_str(layer->hdr_ptr, layer->hdr_len, buff + used, size - used);
used += snprintf(buff + used, size - used, "\n");
break;
case LAYER_PROTO_UDP:
used += udp_hdr_to_str((const struct udphdr *)layer->hdr_ptr, buff + used, size - used);
used += snprintf(buff + used, size - used, "\n");
break;
case LAYER_PROTO_TCP:
used += tcp_hdr_to_str((const struct tcphdr *)layer->hdr_ptr, buff + used, size - used);
used += snprintf(buff + used, size - used, "\n");
break;
case LAYER_PROTO_ICMP:
break;
case LAYER_PROTO_ICMP6:
break;
case LAYER_PROTO_VXLAN:
used += vxlan_hdr_to_str((const struct vxlan_hdr *)layer->hdr_ptr, buff + used, size - used);
used += snprintf(buff + used, size - used, "\n");
break;
case LAYER_PROTO_GTP_C:
case LAYER_PROTO_GTP_U:
used += gtp_hdr_to_str(layer->hdr_ptr, layer->hdr_len, buff + used, size - used);
used += snprintf(buff + used, size - used, "\n");
break;
default:
break;
}
}
return used;
}