source: trunk/libpacketdump/link_4.cc @ 911

#include <netinet/in.h>
#include <stdio.h>
#include <inttypes.h>
#include <dlfcn.h>
#include "libpacketdump.h"
#include "libtrace.h"

struct ieee_802_11_header {
        uint8_t      protocol:2;
        uint8_t      type:2;
        uint8_t      subtype:4;
        uint8_t      to_ds:1;
        uint8_t      from_ds:1;
        uint8_t      more_frag:1;
        uint8_t      retry:1;
        uint8_t      power:1;
        uint8_t      more_data:1;
        uint8_t      wep:1;
        uint8_t      order:1;
        uint16_t     duration;
        uint8_t      mac1[6];
        uint8_t      mac2[6];
        uint8_t      mac3[6];
        uint16_t     SeqCtl;
        uint8_t      mac4[6];
        uint8_t      data[1];
};

struct ieee_802_11_payload {
        uint16_t     type;
        uint8_t      data[1];
};

void decode(int link_type,char *packet,int len)
{
        char ether_buf[18] = {0, };
        printf(" 802.11:");
        struct ieee_802_11_header *hdr = (struct ieee_802_11_header *)packet;

        printf(" %s",trace_ether_ntoa((uint8_t*)(hdr->mac1), ether_buf));
        printf(" %s",trace_ether_ntoa((uint8_t*)(hdr->mac2), ether_buf));
        printf(" %s",trace_ether_ntoa((uint8_t*)(hdr->mac3), ether_buf));

        struct ieee_802_11_payload *pld = (struct ieee_802_11_payload *) ((char*)packet + sizeof(struct ieee_802_11_header) - 2);
        uint16_t type = htons(pld->type);
        printf(" %04x\n",type);
        decode_next((char *)pld->data,len-(sizeof(struct ieee_802_11_header)),"eth",type);
        return;
}