#include <stdio.h>

#include "main.h"
#include "util.h"
#include "vars.h"

void printx(unsigned char *pkt, int nb)
{
 int i;
 int j;

 i = 0;
 while (nb > 8)
  { printf("%02x %02x %02x %02x %02x %02x %02x %02x  .\n",pkt[i],pkt[i+1],pkt[i+2],pkt[i+3],pkt[i+4],pkt[i+5],pkt[i+6],pkt[i+7]);
    i += 8;
    nb -= 8;
  }
 for (j=0;j<nb;j++) printf("%02x ",pkt[i+j]);
 printf("%*s",1+(3*8)-(3*nb),"");
}

static void printu(unsigned char *buf, int nb)
{
 for (;nb>0;nb--,buf++)
  { if ( (*buf < 0x20) ||
	 ((*buf > 0x7e) && (*buf < 0xa0)) )
     { putchar(0xb7); /* ISO Latin-1 centered-dot */
     }
    else
     { putchar(*buf);
     }
  }
}

void printxu(unsigned char *pkt, int nb)
{
 int i;
 int j;

 i = 0;
 while (nb > 8)
  { printf("%02x %02x %02x %02x %02x %02x %02x %02x  ",pkt[i],pkt[i+1],pkt[i+2],pkt[i+3],pkt[i+4],pkt[i+5],pkt[i+6],pkt[i+7]);
    printu(pkt+i,8);
    putchar('\n');
    i += 8;
    nb -= 8;
  }
 for (j=0;j<nb;j++) printf("%02x ",pkt[i+j]);
 printf("%*s",1+(3*8)-(3*nb),"");
 printu(pkt+i,nb);
 printf("%*s",2+8-nb,"");
}

void printxu_limited(unsigned char *pkt, int nb, unsigned int maxfull, unsigned int truncto)
{
 int i;
 int j;
 int np;

 np = nb;
 if (np > maxfull) np = truncto;
 i = 0;
 while (np > 8)
  { printf("%02x %02x %02x %02x %02x %02x %02x %02x  ",pkt[i],pkt[i+1],pkt[i+2],pkt[i+3],pkt[i+4],pkt[i+5],pkt[i+6],pkt[i+7]);
    printu(pkt+i,8);
    putchar('\n');
    i += 8;
    nb -= 8;
    np -= 8;
  }
 for (j=0;j<np;j++) printf("%02x ",pkt[i+j]);
 printf("%*s",1+(3*8)-(3*np),"");
 printu(pkt+i,np);
 if (np < nb)
  { char omitbuf[64];
    putchar('\n');
    sprintf(&omitbuf[0],"(%d more omitted)",nb-np);
    printf("%-35s",&omitbuf[0]);
  }
 else
  { printf("%*s",2+8-np,"");
  }
}

void need(int nb, const char *why)
{
 if (pktleft < nb)
  { printf("packet too short: want %d bytes for %s but %d left\n",nb,why,pktleft);
    dumpabort();
  }
}

void consume(int nb)
{
 pktleft -= nb;
 pkt += nb;
}

unsigned char get8(int inx)
{
 return(pkt[inx]);
}

unsigned short int get16(int inx)
{
 return((pkt[inx]*(unsigned short int)256)|pkt[inx+1]);
}

unsigned long int get32(int inx)
{
 return((pkt[inx]*0x01000000UL)|(pkt[inx+1]*0x10000UL)|(pkt[inx+2]*256UL)|pkt[inx+3]);
}