136 lines
2.3 KiB
C
136 lines
2.3 KiB
C
|
|
||
|
|
#include <stdlib.h>
|
||
|
|
#include <stdio.h>
|
||
|
|
#include <string.h>
|
||
|
|
|
||
|
|
#include "format.h"
|
||
|
|
|
||
|
|
|
||
|
|
static struct cw_FormatDumpSettings CW_FORMAT_DUMP_SETTINGS = {
|
||
|
|
32/*CW_FORMAT_DUMP_ROW_LEN*/, /* rowlen */
|
||
|
|
1, /* ascii */
|
||
|
|
0, /* settings->invlen */
|
||
|
|
"\n\t", /* dump_prefix */
|
||
|
|
};
|
||
|
|
|
||
|
|
|
||
|
|
|
||
|
|
|
||
|
|
static int cw_format_dump_row(char *dst, const uint8_t * data, int len){
|
||
|
|
char *pdst = dst;
|
||
|
|
int i;
|
||
|
|
char *sp;
|
||
|
|
for (i = 0; i < len; i++) {
|
||
|
|
sp = ((i+1)%4==0 && i<len-1) ? "|" : " ";
|
||
|
|
pdst += sprintf(pdst, "%02X%s", data[i] & 0xff, sp);
|
||
|
|
}
|
||
|
|
|
||
|
|
pdst+=sprintf(pdst," ");
|
||
|
|
|
||
|
|
for (i = 0; i < len; i++) {
|
||
|
|
int c = data[i] & 0xff;
|
||
|
|
if (c < 0x20 || c > 0x7f)
|
||
|
|
c = '.';
|
||
|
|
pdst+=sprintf(pdst,"%c",c);
|
||
|
|
}
|
||
|
|
|
||
|
|
pdst+=sprintf(pdst,"%s","\n");
|
||
|
|
return pdst-dst;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
|
||
|
|
/**
|
||
|
|
* Create an ASCII hex dump of binary data
|
||
|
|
*
|
||
|
|
* @param data data to dump
|
||
|
|
* @param len number of bytes to dump (size of data)
|
||
|
|
* @return a character string with the created data ASCII
|
||
|
|
* dump (must be released with free).If memory cannot be allocated
|
||
|
|
* the return value is NULL.
|
||
|
|
*/
|
||
|
|
char *cw_format_dump(const uint8_t * data, int len,
|
||
|
|
struct cw_FormatDumpSettings *settings)
|
||
|
|
{
|
||
|
|
int i;
|
||
|
|
|
||
|
|
int row,rows;
|
||
|
|
|
||
|
|
|
||
|
|
|
||
|
|
|
||
|
|
if (!settings)
|
||
|
|
settings = &CW_FORMAT_DUMP_SETTINGS;
|
||
|
|
|
||
|
|
rows = len / settings->rowlen;
|
||
|
|
|
||
|
|
printf("Number fo rows: %d\n",rows);
|
||
|
|
|
||
|
|
int md;
|
||
|
|
if (settings->ascii)
|
||
|
|
md = 2;
|
||
|
|
else
|
||
|
|
md = 1;
|
||
|
|
|
||
|
|
char *dst = malloc(2 * (md * (len * 3 + (rows * 2) + 8 )));
|
||
|
|
if (!dst)
|
||
|
|
return NULL;
|
||
|
|
|
||
|
|
if (len % settings->rowlen)
|
||
|
|
rows++;
|
||
|
|
|
||
|
|
char *pdst = dst;
|
||
|
|
|
||
|
|
pdst += sprintf(pdst, "%s",settings->dump_prefix);
|
||
|
|
/* pdst += 2; */
|
||
|
|
|
||
|
|
char asc_buffer[128];
|
||
|
|
char *ascdst = asc_buffer;
|
||
|
|
|
||
|
|
pdst = dst;
|
||
|
|
for (row; row<rows; row++){
|
||
|
|
int n;
|
||
|
|
pdst += cw_format_dump_row(pdst,data+row*settings->rowlen,settings->rowlen);
|
||
|
|
}
|
||
|
|
return dst;
|
||
|
|
|
||
|
|
|
||
|
|
for (i = 0; i < len; i++) {
|
||
|
|
char *sp = " ";
|
||
|
|
if (i == settings->invlen - 1)
|
||
|
|
sp = "|";
|
||
|
|
|
||
|
|
pdst += sprintf(pdst, "%02X%s", data[i] & 0xff, sp);
|
||
|
|
if (settings->ascii) {
|
||
|
|
int c = data[i] & 0xff;
|
||
|
|
if (c < 0x20 || c > 0x7f)
|
||
|
|
c = '.';
|
||
|
|
*ascdst = c;
|
||
|
|
ascdst++;
|
||
|
|
}
|
||
|
|
|
||
|
|
if ((i + 1) % settings->rowlen == 0) {
|
||
|
|
int l;
|
||
|
|
if (settings->ascii) {
|
||
|
|
*ascdst = 0;
|
||
|
|
l = sprintf(pdst, " | %s\n\t", asc_buffer);
|
||
|
|
ascdst = asc_buffer;
|
||
|
|
|
||
|
|
} else {
|
||
|
|
l = sprintf(pdst, "\n\t");
|
||
|
|
}
|
||
|
|
pdst += l;
|
||
|
|
}
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
if (settings->ascii) {
|
||
|
|
*ascdst = 0;
|
||
|
|
if (strlen(asc_buffer))
|
||
|
|
pdst += sprintf(pdst, " | %s", asc_buffer);
|
||
|
|
}
|
||
|
|
|
||
|
|
return dst;
|
||
|
|
}
|
||
|
|
|