108 lines
2.4 KiB
C
108 lines
2.4 KiB
C
|
#include "format.h"
|
||
|
|
#include "sock.h"
|
||
|
|
#include "conn.h"
|
||
|
|
#include "cw.h"
|
||
|
|
|
||
|
|
/**
|
||
|
|
* @brief Format a packet header for debugging purposes
|
||
|
|
* @param dst Destination buffer
|
||
|
|
* @param incomming True if the packet is an incomming packet, otherweise 0
|
||
|
|
* @param packet packet data
|
||
|
|
* @param len length of packet data
|
||
|
|
* @param from Address from where the packet was received
|
||
|
|
* @return Number of bytes written
|
||
|
|
*/
|
||
|
|
int cw_format_pkt_hdr(char *dst, int incomming, uint8_t * packet, int len,
|
||
|
|
struct sockaddr *from)
|
||
|
|
{
|
||
|
|
char sock_buf[SOCK_ADDR_BUFSIZE];
|
||
|
|
int preamble;
|
||
|
|
char *s;
|
||
|
|
int hlen, rid, wbid;
|
||
|
|
int frag_id,frag_offs;
|
||
|
|
|
||
|
|
s = dst;
|
||
|
|
|
||
|
|
if (incomming){
|
||
|
|
if (cw_get_hdr_flag_f(packet)) {
|
||
|
|
s += sprintf(s, "Fragment from %s",
|
||
|
|
sock_addr2str_p(from,sock_buf));
|
||
|
|
} else {
|
||
|
|
s += sprintf(s, "From %s", sock_addr2str_p(from,sock_buf));
|
||
|
|
}
|
||
|
|
}
|
||
|
|
else{
|
||
|
|
if (cw_get_hdr_flag_f(packet)) {
|
||
|
|
s += sprintf(s, "Fragment to %s", sock_addr2str(from,sock_buf));
|
||
|
|
} else {
|
||
|
|
s += sprintf(s, "To %s", sock_addr2str(from,sock_buf));
|
||
|
|
}
|
||
|
|
}
|
||
|
|
s += sprintf(s, " l=%d: ", len);
|
||
|
|
|
||
|
|
preamble = cw_get_hdr_preamble(packet);
|
||
|
|
if (preamble == 01) {
|
||
|
|
s += sprintf(s, " (encrypted)");
|
||
|
|
return s - dst;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (len < 4)
|
||
|
|
goto abort;
|
||
|
|
|
||
|
|
/*
|
||
|
|
if (cw_get_hdr_flag_f(packet)){
|
||
|
|
s+=sprintf(s," (fragmented)");
|
||
|
|
}
|
||
|
|
*/
|
||
|
|
hlen = cw_get_hdr_hlen(packet);
|
||
|
|
rid = cw_get_hdr_rid(packet);
|
||
|
|
wbid = cw_get_hdr_wbid(packet);
|
||
|
|
s += sprintf(s, " H:%d R:%02d W:%02d", hlen, rid, wbid);
|
||
|
|
|
||
|
|
|
||
|
|
s += sprintf(s, " Flgs:");
|
||
|
|
s += format_hdr_flags(s, packet);
|
||
|
|
|
||
|
|
if (len < 8)
|
||
|
|
goto abort;
|
||
|
|
frag_id = cw_get_hdr_fragid(packet);
|
||
|
|
frag_offs = cw_get_hdr_fragoffset(packet);
|
||
|
|
s += sprintf(s, " Frag/Offs:%d/%d", frag_id, frag_offs);
|
||
|
|
|
||
|
|
|
||
|
|
if (cw_get_hdr_flag_m(packet)) {
|
||
|
|
/* rmac is present, print the rmac */
|
||
|
|
int rmac_len = cw_get_hdr_rmac_len(packet);
|
||
|
|
int plen = rmac_len;
|
||
|
|
if (rmac_len + 8 > len)
|
||
|
|
plen = len - 8;
|
||
|
|
if (rmac_len > 10)
|
||
|
|
plen = 10;
|
||
|
|
|
||
|
|
s += sprintf(s, " R-MAC:");
|
||
|
|
s += format_mac(s, cw_get_hdr_rmac_data(packet), plen);
|
||
|
|
if (rmac_len > 10) {
|
||
|
|
s += sprintf(s, " ... (len=%d)", rmac_len);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
if (cw_get_hdr_flag_w(packet)) {
|
||
|
|
/* print wireless specific info */
|
||
|
|
int ws_len = cw_get_hdr_ws_len(packet);
|
||
|
|
int plen = ws_len > 20 ? 20 : ws_len;
|
||
|
|
s += sprintf(s, " WS:");
|
||
|
|
s += format_hexu(s, cw_get_hdr_ws_data(packet), plen);
|
||
|
|
if (ws_len > 20) {
|
||
|
|
s += sprintf(s, " ... (len=%d)", ws_len);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
return s - dst;
|
||
|
|
|
||
|
|
|
||
|
|
|
||
|
|
abort:
|
||
|
|
s += sprintf(s, " Incomplete...");
|
||
|
|
return s - dst;
|
||
|
|
|
||
|
|
}
|