source: examples/tracedump/tracedump-lib.cc @ 3a3aa23

#include <netinet/ether.h>
#include <netinet/in.h>
#include <stdio.h>
#include <stdint.h>
#include <dlfcn.h>
#include <map>
#include <string>
#include <ctype.h>
#include "tracedump.h"

#ifndef DIRNAME
#define DIRNAME "./"
#endif

typedef void (*decode_t)(uint16_t type,char *packet,int len);

static std::map<std::string,std::map<uint16_t,decode_t> > decoders;

#define WIDTH 16

static void generic_decode(uint16_t type,char *packet, int len) {
        int i;
        printf(" Unknown Protocol: %i",type);
        for(i=0;i<len; /* Nothing */ ) {
                int j;
                printf("\n ");
                for(j=0;j<WIDTH;j++) {
                        if (i+j<len)
                                printf(" %02x",(unsigned char)packet[i+j]);
                        else
                                printf("   ");
                }
                printf("    ");
                for(j=0;j<WIDTH;j++) {
                        if (i+j<len)
                                if (isprint((unsigned char)packet[i+j]))
                                        printf("%c",(unsigned char)packet[i+j]);
                                else
                                        printf(".");
                        else
                                printf("   ");
                }
                if (i+WIDTH>len)
                        break;
                else
                        i+=WIDTH;
        }
        printf("\n");
}

void decode_next(char *packet,int len,char *proto_name,int type)
{
        std::string sname(proto_name);
        if (decoders[sname].find(type)==decoders[sname].end()) {
                void *hdl;
                char name[1024];
                snprintf(name,sizeof(name),DIRNAME "%s_%i.so",sname.c_str(),type);
                hdl = dlopen(name,RTLD_LAZY);
                if (!hdl) 
                        decoders[sname][type]=generic_decode;
                else {
                        void *s=dlsym(hdl,"decode");
                        if (!s) {
                                decoders[sname][type]=generic_decode;
                        }
                        else
                                decoders[sname][type]=(decode_t)s;
                }
        }
        decoders[sname][type](type,packet,len);
}