Subversion Repositories amber

/*----------------------------------------------------------------

//                                                              //

//  amber-bin2mem.c                                             //

//                                                              //

//  This file is part of the Amber project                      //

//  http://www.opencores.org/project,amber                      //

//                                                              //

//  Description                                                 //

//  Read in a binary file from tcpdump and write it out in      //

//  in Verilog readmem format.                                  //

//                                                              //

//  Author(s):                                                  //

//      - Conor Santifort, csantifort.amber@gmail.com           //

//                                                              //

//////////////////////////////////////////////////////////////////

//                                                              //

// Copyright (C) 2010 Authors and OPENCORES.ORG                 //

//                                                              //

// This source file may be used and distributed without         //

// restriction provided that this copyright statement is not    //

// removed from the file and that any derivative work contains  //

// the original copyright notice and the associated disclaimer. //

//                                                              //

// This source file is free software; you can redistribute it   //

// and/or modify it under the terms of the GNU Lesser General   //

// Public License as published by the Free Software Foundation; //

// either version 2.1 of the License, or (at your option) any   //

// later version.                                               //

//                                                              //

// This source is distributed in the hope that it will be       //

// useful, but WITHOUT ANY WARRANTY; without even the implied   //

// warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR      //

// PURPOSE.  See the GNU Lesser General Public License for more //

// details.                                                     //

//                                                              //

// You should have received a copy of the GNU Lesser General    //

// Public License along with this source; if not, download it   //

// from http://www.opencores.org/lgpl.shtml                     //

//                                                              //

----------------------------------------------------------------*/

#include <stdio.h>

#include <stdlib.h>

#include "../boot-loader-serial/boot-loader.h"

/* Function prototypes */

int fsize(FILE *f);

int conv_hstring(char*, unsigned int*);

unsigned int buf_uint (unsigned char *buf);

int main(int argc,char *argv[])

{

   FILE *infile;

   char filename_mem[80], filename_nopath[80];

   unsigned char *buf;

   FILE *file_mem;

   int infile_size, buf_size, i, j;

   int ret;

   int buf_pos;

   unsigned int incl_len;

   unsigned int orig_len;

   int mem_pos = 0;

   if (argc<2){

      fprintf(stderr, "ERROR: no input file specified. Quitting\n");

      exit(1);

      }

   infile=fopen(argv[1],"rb");

   if(infile==NULL) {

      fprintf(stderr, "ERROR: Can't open %s. Quitting\n", argv[1]);

      exit(1);

   }

   infile_size = fsize(infile);

   buf=(unsigned char*)malloc(infile_size);

   buf_size=fread(buf,1,infile_size,infile);

   fclose(infile);

   if ( buf_size != infile_size ) {

      fprintf(stderr, "%s ERROR: Input %s file length is %d bytes long, buffer read buf_size %d\n",

      argv[0], argv[1], infile_size, buf_size);

      exit(1);

      }

   if ( infile_size > 0x1000000 ) {

      fprintf(stderr, "%s WARNING: Input %s file length is %d bytes long, greater than boot-loader can handle \n",

      argv[0], argv[1], infile_size);

      }

   /* Start of file */

   buf_pos = 6*4;

   /* Main loop. once per packet */

   while (buf_pos < infile_size) {

      buf_pos=buf_pos+8;

      incl_len = buf_uint(&buf[buf_pos]); buf_pos+=4;

      orig_len = buf_uint(&buf[buf_pos]); buf_pos+=4;

      /* error check included packet length */

      if (incl_len != orig_len) {

         fprintf(stderr, "Warning: the full packet was not captured in the tcpdump file\n");

         fprintf(stderr, "incl_len %d != orig_len %d\n", incl_len, orig_len);

         //goto error_return;

         }

      /* error check max packet length */

      if (orig_len > 255) {

         fprintf(stderr, "Error: the packet is too long. Max length is 255 bytes\n");

         fprintf(stderr, "orig_len %d\n", orig_len);

         goto error_return;

         }

      /* check if full packet is contained in file */

      if (buf_pos + incl_len > infile_size) {

         fprintf(stderr, "Error: end of current packet is after the end of the buffer\n");

         goto error_return;

         }

      printf("// incl_len %d, orig_len %d\n", incl_len, orig_len);

      printf("// ip-sa %d.%d.%d.%d, ip-da %d.%d.%d.%d, protocol %d\n",

               buf[buf_pos+26], buf[buf_pos+27], buf[buf_pos+28], buf[buf_pos+29],

               buf[buf_pos+30], buf[buf_pos+31], buf[buf_pos+32], buf[buf_pos+33],

               buf[buf_pos+23]

               );

      /* First byte gives the packet length */

      printf("@%04x %02x\n",   mem_pos++, orig_len);

      for (i=buf_pos;i<buf_pos+incl_len;i++,mem_pos++) {

          printf("@%04x %02x\n", mem_pos, buf[i]);

          }

      /* pad out any missing bytes */

      if (orig_len > incl_len) {

         for (i=incl_len;i<orig_len;i++,mem_pos++) {

            printf("@%04x 00\n", mem_pos);

            }

      }

      /* advance to the start of the next entry */

      buf_pos += incl_len;

      }

   free(buf);

   return 0;

   error_return:

      free(buf);

      return 1;

}

unsigned int buf_uint (unsigned char *buf)

{

    return buf[3]<<24 | buf[2]<<16 | buf[1]<<8 | buf[0];

}

/* Return the buf_size of a file in bytes */

int fsize( FILE *f )

{

    int end;

    /* Set current position at end of file */

    fseek( f, 0, SEEK_END );

    /* File buf_size in bytes */

    end = ftell( f );

    /* Set current position at start of file */

    fseek( f, 0, SEEK_SET );

    return end;

}

int conv_hstring ( char *string, unsigned int * num)

{

int pos = 0;

*num = 0;

while (((string[pos] >= '0' && string[pos] <= '9') ||

       (string[pos] >= 'a' && string[pos] <= 'f')) && pos < 9) {

    if (string[pos] >= '0' && string[pos] <= '9')

        *num =  (*num << 4) + ( string[pos++] - '0' );

    else

        *num =  (*num << 4) + ( string[pos++] - 'a' ) + 10;

    }

return pos;

}