clang format, similar to GNU Radio
This commit is contained in:
Bastian Bloessl
+374
-350
@@ -14,415 +14,439 @@
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
#include <ieee802_11/parse_mac.h>
|
||||
#include "utils.h"
|
||||
#include <ieee802_11/parse_mac.h>
|
||||
|
||||
#include <gnuradio/io_signature.h>
|
||||
#include <gnuradio/block_detail.h>
|
||||
#include <gnuradio/io_signature.h>
|
||||
#include <string>
|
||||
|
||||
using namespace gr::ieee802_11;
|
||||
|
||||
class parse_mac_impl : public parse_mac {
|
||||
class parse_mac_impl : public parse_mac
|
||||
{
|
||||
|
||||
public:
|
||||
parse_mac_impl(bool log, bool debug)
|
||||
: block("parse_mac",
|
||||
gr::io_signature::make(0, 0, 0),
|
||||
gr::io_signature::make(0, 0, 0)),
|
||||
d_log(log),
|
||||
d_last_seq_no(-1),
|
||||
d_debug(debug)
|
||||
{
|
||||
|
||||
parse_mac_impl(bool log, bool debug) :
|
||||
block("parse_mac",
|
||||
gr::io_signature::make(0, 0, 0),
|
||||
gr::io_signature::make(0, 0, 0)),
|
||||
d_log(log), d_last_seq_no(-1),
|
||||
d_debug(debug) {
|
||||
message_port_register_in(pmt::mp("in"));
|
||||
set_msg_handler(
|
||||
pmt::mp("in"),
|
||||
boost::bind(&parse_mac_impl::parse, this, boost::placeholders::_1));
|
||||
|
||||
message_port_register_in(pmt::mp("in"));
|
||||
set_msg_handler(pmt::mp("in"), boost::bind(&parse_mac_impl::parse, this, boost::placeholders::_1));
|
||||
message_port_register_out(pmt::mp("out"));
|
||||
}
|
||||
|
||||
message_port_register_out(pmt::mp("out"));
|
||||
}
|
||||
~parse_mac_impl() {}
|
||||
|
||||
~parse_mac_impl() {
|
||||
void parse(pmt::pmt_t pdu)
|
||||
{
|
||||
|
||||
}
|
||||
if (pmt::is_eof_object(pdu)) {
|
||||
detail().get()->set_done(true);
|
||||
return;
|
||||
} else if (pmt::is_symbol(pdu)) {
|
||||
return;
|
||||
}
|
||||
|
||||
void parse(pmt::pmt_t pdu) {
|
||||
d_meta = pmt::car(pdu);
|
||||
d_msg = pmt::cdr(pdu);
|
||||
|
||||
if(pmt::is_eof_object(pdu)) {
|
||||
detail().get()->set_done(true);
|
||||
return;
|
||||
} else if(pmt::is_symbol(pdu)) {
|
||||
return;
|
||||
}
|
||||
int frame_len = pmt::blob_length(d_msg);
|
||||
mac_header* h = (mac_header*)pmt::blob_data(d_msg);
|
||||
|
||||
d_meta = pmt::car(pdu);
|
||||
d_msg = pmt::cdr(pdu);
|
||||
mylog(boost::format("length: %1%") % frame_len);
|
||||
|
||||
int frame_len = pmt::blob_length(d_msg);
|
||||
mac_header *h = (mac_header*)pmt::blob_data(d_msg);
|
||||
dout << std::endl << "new mac frame (length " << frame_len << ")" << std::endl;
|
||||
dout << "=========================================" << std::endl;
|
||||
if (frame_len < 20) {
|
||||
dout << "frame too short to parse (<20)" << std::endl;
|
||||
return;
|
||||
}
|
||||
|
||||
mylog(boost::format("length: %1%") % frame_len );
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Duration"), pmt::mp(h->duration));
|
||||
|
||||
dout << std::endl << "new mac frame (length " << frame_len << ")" << std::endl;
|
||||
dout << "=========================================" << std::endl;
|
||||
if(frame_len < 20) {
|
||||
dout << "frame too short to parse (<20)" << std::endl;
|
||||
return;
|
||||
}
|
||||
#define HEX(a) std::hex << std::setfill('0') << std::setw(2) << int(a) << std::dec
|
||||
dout << "duration: " << HEX(h->duration >> 8) << " " << HEX(h->duration & 0xff)
|
||||
<< std::endl;
|
||||
dout << "frame control: " << HEX(h->frame_control >> 8) << " "
|
||||
<< HEX(h->frame_control & 0xff);
|
||||
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Duration"), pmt::mp(h->duration));
|
||||
switch ((h->frame_control >> 2) & 3) {
|
||||
|
||||
#define HEX(a) std::hex << std::setfill('0') << std::setw(2) << int(a) << std::dec
|
||||
dout << "duration: " << HEX(h->duration >> 8) << " " << HEX(h->duration & 0xff) << std::endl;
|
||||
dout << "frame control: " << HEX(h->frame_control >> 8) << " " << HEX(h->frame_control & 0xff);
|
||||
case 0:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Type"), pmt::mp("Management"));
|
||||
dout << " (MANAGEMENT)" << std::endl;
|
||||
parse_management((char*)h, frame_len);
|
||||
break;
|
||||
case 1:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Type"), pmt::mp("Control"));
|
||||
dout << " (CONTROL)" << std::endl;
|
||||
parse_control((char*)h, frame_len);
|
||||
break;
|
||||
|
||||
switch((h->frame_control >> 2) & 3) {
|
||||
case 2:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Type"), pmt::mp("Data"));
|
||||
dout << " (DATA)" << std::endl;
|
||||
parse_data((char*)h, frame_len);
|
||||
break;
|
||||
|
||||
case 0:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Type"), pmt::mp("Management"));
|
||||
dout << " (MANAGEMENT)" << std::endl;
|
||||
parse_management((char*)h, frame_len);
|
||||
break;
|
||||
case 1:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Type"), pmt::mp("Control"));
|
||||
dout << " (CONTROL)" << std::endl;
|
||||
parse_control((char*)h, frame_len);
|
||||
break;
|
||||
default:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Type"), pmt::mp("Unknown"));
|
||||
dout << " (unknown)" << std::endl;
|
||||
break;
|
||||
}
|
||||
|
||||
case 2:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Type"), pmt::mp("Data"));
|
||||
dout << " (DATA)" << std::endl;
|
||||
parse_data((char*)h, frame_len);
|
||||
break;
|
||||
char* frame = (char*)pmt::blob_data(d_msg);
|
||||
|
||||
default:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Type"), pmt::mp("Unknown"));
|
||||
dout << " (unknown)" << std::endl;
|
||||
break;
|
||||
}
|
||||
// DATA
|
||||
if ((((h->frame_control) >> 2) & 63) == 2) {
|
||||
print_ascii(frame + 24, frame_len - 24);
|
||||
// QoS Data
|
||||
} else if ((((h->frame_control) >> 2) & 63) == 34) {
|
||||
print_ascii(frame + 26, frame_len - 26);
|
||||
}
|
||||
|
||||
char *frame = (char*)pmt::blob_data(d_msg);
|
||||
message_port_pub(pmt::mp("out"), pmt::cons(d_meta, d_msg));
|
||||
}
|
||||
|
||||
// DATA
|
||||
if((((h->frame_control) >> 2) & 63) == 2) {
|
||||
print_ascii(frame + 24, frame_len - 24);
|
||||
// QoS Data
|
||||
} else if((((h->frame_control) >> 2) & 63) == 34) {
|
||||
print_ascii(frame + 26, frame_len - 26);
|
||||
}
|
||||
void parse_management(char* buf, int length)
|
||||
{
|
||||
mac_header* h = (mac_header*)buf;
|
||||
|
||||
message_port_pub(pmt::mp("out"), pmt::cons(d_meta, d_msg));
|
||||
}
|
||||
if (length < 24) {
|
||||
dout << "too short for a management frame" << std::endl;
|
||||
return;
|
||||
}
|
||||
|
||||
void parse_management(char *buf, int length) {
|
||||
mac_header* h = (mac_header*)buf;
|
||||
dout << "Subtype: ";
|
||||
switch (((h->frame_control) >> 4) & 0xf) {
|
||||
case 0:
|
||||
d_meta =
|
||||
pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Association Request"));
|
||||
dout << "Association Request";
|
||||
break;
|
||||
case 1:
|
||||
d_meta = pmt::dict_add(
|
||||
d_meta, pmt::mp("Subtype"), pmt::mp("Association Response"));
|
||||
dout << "Association Response";
|
||||
break;
|
||||
case 2:
|
||||
d_meta = pmt::dict_add(
|
||||
d_meta, pmt::mp("Subtype"), pmt::mp("Reassociation Request"));
|
||||
dout << "Reassociation Request";
|
||||
break;
|
||||
case 3:
|
||||
d_meta = pmt::dict_add(
|
||||
d_meta, pmt::mp("Subtype"), pmt::mp("Reassociation Response"));
|
||||
dout << "Reassociation Response";
|
||||
break;
|
||||
case 4:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Probe Request"));
|
||||
dout << "Probe Request";
|
||||
break;
|
||||
case 5:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Probe Response"));
|
||||
dout << "Probe Response";
|
||||
break;
|
||||
case 6:
|
||||
d_meta = pmt::dict_add(
|
||||
d_meta, pmt::mp("Subtype"), pmt::mp("Timing Advertisement"));
|
||||
dout << "Timing Advertisement";
|
||||
break;
|
||||
case 7:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Reserved"));
|
||||
dout << "Reserved";
|
||||
break;
|
||||
case 8:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Beacon"));
|
||||
dout << "Beacon" << std::endl;
|
||||
if (length < 38) {
|
||||
return;
|
||||
}
|
||||
{
|
||||
uint8_t* len = (uint8_t*)(buf + 24 + 13);
|
||||
if (length < 38 + *len) {
|
||||
return;
|
||||
}
|
||||
std::string s(buf + 24 + 14, *len);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("SSID"), pmt::mp(s));
|
||||
dout << "SSID: " << s;
|
||||
}
|
||||
break;
|
||||
case 9:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("ATIM"));
|
||||
dout << "ATIM";
|
||||
break;
|
||||
case 10:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Disassociation"));
|
||||
dout << "Disassociation";
|
||||
break;
|
||||
case 11:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Authentication"));
|
||||
dout << "Authentication";
|
||||
break;
|
||||
case 12:
|
||||
d_meta =
|
||||
pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Deauthentication"));
|
||||
dout << "Deauthentication";
|
||||
break;
|
||||
case 13:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Action"));
|
||||
dout << "Action";
|
||||
break;
|
||||
case 14:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Action No Ack"));
|
||||
dout << "Action No Ack";
|
||||
break;
|
||||
case 15:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Reserved"));
|
||||
dout << "Reserved";
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
dout << std::endl;
|
||||
|
||||
if(length < 24) {
|
||||
dout << "too short for a management frame" << std::endl;
|
||||
return;
|
||||
}
|
||||
int seq_no = int(h->seq_nr >> 4);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Sequence number"), pmt::mp(seq_no));
|
||||
dout << "seq nr: " << seq_no << std::endl;
|
||||
|
||||
dout << "Subtype: ";
|
||||
switch(((h->frame_control) >> 4) & 0xf) {
|
||||
case 0:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Association Request"));
|
||||
dout << "Association Request";
|
||||
break;
|
||||
case 1:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Association Response"));
|
||||
dout << "Association Response";
|
||||
break;
|
||||
case 2:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Reassociation Request"));
|
||||
dout << "Reassociation Request";
|
||||
break;
|
||||
case 3:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Reassociation Response"));
|
||||
dout << "Reassociation Response";
|
||||
break;
|
||||
case 4:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Probe Request"));
|
||||
dout << "Probe Request";
|
||||
break;
|
||||
case 5:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Probe Response"));
|
||||
dout << "Probe Response";
|
||||
break;
|
||||
case 6:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Timing Advertisement"));
|
||||
dout << "Timing Advertisement";
|
||||
break;
|
||||
case 7:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Reserved"));
|
||||
dout << "Reserved";
|
||||
break;
|
||||
case 8:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Beacon"));
|
||||
dout << "Beacon" << std::endl;
|
||||
if(length < 38) {
|
||||
return;
|
||||
}
|
||||
{
|
||||
uint8_t* len = (uint8_t*) (buf + 24 + 13);
|
||||
if(length < 38 + *len) {
|
||||
return;
|
||||
}
|
||||
std::string s(buf + 24 + 14, *len);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("SSID"), pmt::mp(s));
|
||||
dout << "SSID: " << s;
|
||||
}
|
||||
break;
|
||||
case 9:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("ATIM"));
|
||||
dout << "ATIM";
|
||||
break;
|
||||
case 10:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Disassociation"));
|
||||
dout << "Disassociation";
|
||||
break;
|
||||
case 11:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Authentication"));
|
||||
dout << "Authentication";
|
||||
break;
|
||||
case 12:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Deauthentication"));
|
||||
dout << "Deauthentication";
|
||||
break;
|
||||
case 13:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Action"));
|
||||
dout << "Action";
|
||||
break;
|
||||
case 14:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Action No Ack"));
|
||||
dout << "Action No Ack";
|
||||
break;
|
||||
case 15:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Reserved"));
|
||||
dout << "Reserved";
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
dout << std::endl;
|
||||
auto address = format_mac_address(h->addr1);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Address 1"), pmt::mp(address));
|
||||
dout << "address 1: " << address << std::endl;
|
||||
|
||||
int seq_no = int(h->seq_nr >> 4);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Sequence number"), pmt::mp(seq_no));
|
||||
dout << "seq nr: " << seq_no << std::endl;
|
||||
address = format_mac_address(h->addr2);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Address 2"), pmt::mp(address));
|
||||
dout << "address 2: " << address << std::endl;
|
||||
|
||||
auto address = format_mac_address(h->addr1);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Address 1"), pmt::mp(address));
|
||||
dout << "address 1: " << address << std::endl;
|
||||
|
||||
address = format_mac_address(h->addr2);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Address 2"), pmt::mp(address));
|
||||
dout << "address 2: "<< address << std::endl;
|
||||
|
||||
address = format_mac_address(h->addr3);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Address 3"), pmt::mp(address));
|
||||
dout << "address 3: "<< address << std::endl;
|
||||
}
|
||||
address = format_mac_address(h->addr3);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Address 3"), pmt::mp(address));
|
||||
dout << "address 3: " << address << std::endl;
|
||||
}
|
||||
|
||||
|
||||
void parse_data(char *buf, int length) {
|
||||
mac_header* h = (mac_header*)buf;
|
||||
if(length < 24) {
|
||||
dout << "too short for a data frame" << std::endl;
|
||||
return;
|
||||
}
|
||||
void parse_data(char* buf, int length)
|
||||
{
|
||||
mac_header* h = (mac_header*)buf;
|
||||
if (length < 24) {
|
||||
dout << "too short for a data frame" << std::endl;
|
||||
return;
|
||||
}
|
||||
|
||||
dout << "Subtype: ";
|
||||
switch(((h->frame_control) >> 4) & 0xf) {
|
||||
case 0:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Data"));
|
||||
dout << "Data";
|
||||
break;
|
||||
case 1:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Data + CF-ACK"));
|
||||
dout << "Data + CF-ACK";
|
||||
break;
|
||||
case 2:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Data + CR-Poll"));
|
||||
dout << "Data + CR-Poll";
|
||||
break;
|
||||
case 3:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Data + CF-ACK + CF-Poll"));
|
||||
dout << "Data + CF-ACK + CF-Poll";
|
||||
break;
|
||||
case 4:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Null"));
|
||||
dout << "Null";
|
||||
break;
|
||||
case 5:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("CF-ACK"));
|
||||
dout << "CF-ACK";
|
||||
break;
|
||||
case 6:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("CF-Poll"));
|
||||
dout << "CF-Poll";
|
||||
break;
|
||||
case 7:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("CF-ACK + CF-Poll"));
|
||||
dout << "CF-ACK + CF-Poll";
|
||||
break;
|
||||
case 8:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("QoS Data"));
|
||||
dout << "QoS Data";
|
||||
break;
|
||||
case 9:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("QoS Data + CF-ACK"));
|
||||
dout << "QoS Data + CF-ACK";
|
||||
break;
|
||||
case 10:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("QoS Data + CF-Poll"));
|
||||
dout << "QoS Data + CF-Poll";
|
||||
break;
|
||||
case 11:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("QoS Data + CF-ACK + CF-Poll"));
|
||||
dout << "QoS Data + CF-ACK + CF-Poll";
|
||||
break;
|
||||
case 12:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("QoS Null"));
|
||||
dout << "QoS Null";
|
||||
break;
|
||||
case 13:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Reserved"));
|
||||
dout << "Reserved";
|
||||
break;
|
||||
case 14:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("QoS CF-Poll"));
|
||||
dout << "QoS CF-Poll";
|
||||
break;
|
||||
case 15:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("QoS CF-ACK + CF-Poll"));
|
||||
dout << "QoS CF-ACK + CF-Poll";
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
dout << std::endl;
|
||||
dout << "Subtype: ";
|
||||
switch (((h->frame_control) >> 4) & 0xf) {
|
||||
case 0:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Data"));
|
||||
dout << "Data";
|
||||
break;
|
||||
case 1:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Data + CF-ACK"));
|
||||
dout << "Data + CF-ACK";
|
||||
break;
|
||||
case 2:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Data + CR-Poll"));
|
||||
dout << "Data + CR-Poll";
|
||||
break;
|
||||
case 3:
|
||||
d_meta = pmt::dict_add(
|
||||
d_meta, pmt::mp("Subtype"), pmt::mp("Data + CF-ACK + CF-Poll"));
|
||||
dout << "Data + CF-ACK + CF-Poll";
|
||||
break;
|
||||
case 4:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Null"));
|
||||
dout << "Null";
|
||||
break;
|
||||
case 5:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("CF-ACK"));
|
||||
dout << "CF-ACK";
|
||||
break;
|
||||
case 6:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("CF-Poll"));
|
||||
dout << "CF-Poll";
|
||||
break;
|
||||
case 7:
|
||||
d_meta =
|
||||
pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("CF-ACK + CF-Poll"));
|
||||
dout << "CF-ACK + CF-Poll";
|
||||
break;
|
||||
case 8:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("QoS Data"));
|
||||
dout << "QoS Data";
|
||||
break;
|
||||
case 9:
|
||||
d_meta =
|
||||
pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("QoS Data + CF-ACK"));
|
||||
dout << "QoS Data + CF-ACK";
|
||||
break;
|
||||
case 10:
|
||||
d_meta =
|
||||
pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("QoS Data + CF-Poll"));
|
||||
dout << "QoS Data + CF-Poll";
|
||||
break;
|
||||
case 11:
|
||||
d_meta = pmt::dict_add(
|
||||
d_meta, pmt::mp("Subtype"), pmt::mp("QoS Data + CF-ACK + CF-Poll"));
|
||||
dout << "QoS Data + CF-ACK + CF-Poll";
|
||||
break;
|
||||
case 12:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("QoS Null"));
|
||||
dout << "QoS Null";
|
||||
break;
|
||||
case 13:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Reserved"));
|
||||
dout << "Reserved";
|
||||
break;
|
||||
case 14:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("QoS CF-Poll"));
|
||||
dout << "QoS CF-Poll";
|
||||
break;
|
||||
case 15:
|
||||
d_meta = pmt::dict_add(
|
||||
d_meta, pmt::mp("Subtype"), pmt::mp("QoS CF-ACK + CF-Poll"));
|
||||
dout << "QoS CF-ACK + CF-Poll";
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
dout << std::endl;
|
||||
|
||||
|
||||
int seq_no = int(h->seq_nr >> 4);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Sequence number"), pmt::mp(seq_no));
|
||||
dout << "seq nr: " << seq_no << std::endl;
|
||||
int seq_no = int(h->seq_nr >> 4);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Sequence number"), pmt::mp(seq_no));
|
||||
dout << "seq nr: " << seq_no << std::endl;
|
||||
|
||||
auto address = format_mac_address(h->addr1);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Address 1"), pmt::mp(address));
|
||||
dout << "address 1: " << address << std::endl;
|
||||
auto address = format_mac_address(h->addr1);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Address 1"), pmt::mp(address));
|
||||
dout << "address 1: " << address << std::endl;
|
||||
|
||||
address = format_mac_address(h->addr2);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Address 2"), pmt::mp(address));
|
||||
dout << "address 2: "<< address << std::endl;
|
||||
address = format_mac_address(h->addr2);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Address 2"), pmt::mp(address));
|
||||
dout << "address 2: " << address << std::endl;
|
||||
|
||||
address = format_mac_address(h->addr3);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Address 3"), pmt::mp(address));
|
||||
dout << "address 3: "<< address << std::endl;
|
||||
address = format_mac_address(h->addr3);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Address 3"), pmt::mp(address));
|
||||
dout << "address 3: " << address << std::endl;
|
||||
|
||||
|
||||
float lost_frames = seq_no - d_last_seq_no - 1;
|
||||
if(lost_frames < 0)
|
||||
lost_frames += 1 << 12;
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Lost frames"), pmt::mp(lost_frames));
|
||||
float lost_frames = seq_no - d_last_seq_no - 1;
|
||||
if (lost_frames < 0)
|
||||
lost_frames += 1 << 12;
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Lost frames"), pmt::mp(lost_frames));
|
||||
|
||||
// calculate frame error rate
|
||||
float fer = lost_frames / (lost_frames + 1);
|
||||
dout << "instantaneous fer: " << fer << std::endl;
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Instantaneous FER"), pmt::mp(fer));
|
||||
// calculate frame error rate
|
||||
float fer = lost_frames / (lost_frames + 1);
|
||||
dout << "instantaneous fer: " << fer << std::endl;
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Instantaneous FER"), pmt::mp(fer));
|
||||
|
||||
// keep track of sequence numbers
|
||||
d_last_seq_no = seq_no;
|
||||
}
|
||||
// keep track of sequence numbers
|
||||
d_last_seq_no = seq_no;
|
||||
}
|
||||
|
||||
void parse_control(char *buf, int length) {
|
||||
mac_header* h = (mac_header*)buf;
|
||||
void parse_control(char* buf, int length)
|
||||
{
|
||||
mac_header* h = (mac_header*)buf;
|
||||
|
||||
dout << "Subtype: ";
|
||||
switch(((h->frame_control) >> 4) & 0xf) {
|
||||
case 7:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Control Wrapper"));
|
||||
dout << "Control Wrapper";
|
||||
break;
|
||||
case 8:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Block ACK Request"));
|
||||
dout << "Block ACK Request";
|
||||
break;
|
||||
case 9:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Block ACK"));
|
||||
dout << "Block ACK";
|
||||
break;
|
||||
case 10:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("PS Poll"));
|
||||
dout << "PS Poll";
|
||||
break;
|
||||
case 11:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("RTS"));
|
||||
dout << "RTS";
|
||||
break;
|
||||
case 12:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("CTS"));
|
||||
dout << "CTS";
|
||||
break;
|
||||
case 13:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("ACK"));
|
||||
dout << "ACK";
|
||||
break;
|
||||
case 14:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("CF-End"));
|
||||
dout << "CF-End";
|
||||
break;
|
||||
case 15:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("CF-End + CF-ACK"));
|
||||
dout << "CF-End + CF-ACK";
|
||||
break;
|
||||
default:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Reserved"));
|
||||
dout << "Reserved";
|
||||
break;
|
||||
}
|
||||
dout << std::endl;
|
||||
dout << "Subtype: ";
|
||||
switch (((h->frame_control) >> 4) & 0xf) {
|
||||
case 7:
|
||||
d_meta =
|
||||
pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Control Wrapper"));
|
||||
dout << "Control Wrapper";
|
||||
break;
|
||||
case 8:
|
||||
d_meta =
|
||||
pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Block ACK Request"));
|
||||
dout << "Block ACK Request";
|
||||
break;
|
||||
case 9:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Block ACK"));
|
||||
dout << "Block ACK";
|
||||
break;
|
||||
case 10:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("PS Poll"));
|
||||
dout << "PS Poll";
|
||||
break;
|
||||
case 11:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("RTS"));
|
||||
dout << "RTS";
|
||||
break;
|
||||
case 12:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("CTS"));
|
||||
dout << "CTS";
|
||||
break;
|
||||
case 13:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("ACK"));
|
||||
dout << "ACK";
|
||||
break;
|
||||
case 14:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("CF-End"));
|
||||
dout << "CF-End";
|
||||
break;
|
||||
case 15:
|
||||
d_meta =
|
||||
pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("CF-End + CF-ACK"));
|
||||
dout << "CF-End + CF-ACK";
|
||||
break;
|
||||
default:
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("Subtype"), pmt::mp("Reserved"));
|
||||
dout << "Reserved";
|
||||
break;
|
||||
}
|
||||
dout << std::endl;
|
||||
|
||||
|
||||
auto address = format_mac_address(h->addr1);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("RA"), pmt::mp(address));
|
||||
dout << "RA: " << address << std::endl;
|
||||
auto address = format_mac_address(h->addr1);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("RA"), pmt::mp(address));
|
||||
dout << "RA: " << address << std::endl;
|
||||
|
||||
address = format_mac_address(h->addr2);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("TA"), pmt::mp(address));
|
||||
dout << "TA: "<< address << std::endl;
|
||||
}
|
||||
address = format_mac_address(h->addr2);
|
||||
d_meta = pmt::dict_add(d_meta, pmt::mp("TA"), pmt::mp(address));
|
||||
dout << "TA: " << address << std::endl;
|
||||
}
|
||||
|
||||
std::string format_mac_address(uint8_t *addr) {
|
||||
std::stringstream str;
|
||||
std::string format_mac_address(uint8_t* addr)
|
||||
{
|
||||
std::stringstream str;
|
||||
|
||||
str << std::setfill('0') << std::hex << std::setw(2) << (int)addr[0];
|
||||
str << std::setfill('0') << std::hex << std::setw(2) << (int)addr[0];
|
||||
|
||||
for(int i = 1; i < 6; i++) {
|
||||
str << ":" << (int)addr[i];
|
||||
}
|
||||
for (int i = 1; i < 6; i++) {
|
||||
str << ":" << (int)addr[i];
|
||||
}
|
||||
|
||||
return str.str();
|
||||
}
|
||||
return str.str();
|
||||
}
|
||||
|
||||
void print_ascii(char* buf, int length) {
|
||||
void print_ascii(char* buf, int length)
|
||||
{
|
||||
|
||||
for(int i = 0; i < length; i++) {
|
||||
if((buf[i] > 31) && (buf[i] < 127)) {
|
||||
dout << buf[i];
|
||||
} else {
|
||||
dout << ".";
|
||||
}
|
||||
}
|
||||
dout << std::endl;
|
||||
}
|
||||
for (int i = 0; i < length; i++) {
|
||||
if ((buf[i] > 31) && (buf[i] < 127)) {
|
||||
dout << buf[i];
|
||||
} else {
|
||||
dout << ".";
|
||||
}
|
||||
}
|
||||
dout << std::endl;
|
||||
}
|
||||
|
||||
private:
|
||||
bool d_log;
|
||||
bool d_debug;
|
||||
int d_last_seq_no;
|
||||
pmt::pmt_t d_meta;
|
||||
pmt::pmt_t d_msg;
|
||||
bool d_log;
|
||||
bool d_debug;
|
||||
int d_last_seq_no;
|
||||
pmt::pmt_t d_meta;
|
||||
pmt::pmt_t d_msg;
|
||||
};
|
||||
|
||||
parse_mac::sptr
|
||||
parse_mac::make(bool log, bool debug) {
|
||||
return gnuradio::get_initial_sptr(new parse_mac_impl(log, debug));
|
||||
parse_mac::sptr parse_mac::make(bool log, bool debug)
|
||||
{
|
||||
return gnuradio::get_initial_sptr(new parse_mac_impl(log, debug));
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user