new debug functions - work on hex dump
FossilOrigin-Name: c76afdd26f14000b912fea5a052abf0338c8515871ae526fef727a828924d2e7
This commit is contained in:
135
src/cw/cw_format_dump.c
Normal file
135
src/cw/cw_format_dump.c
Normal file
@ -0,0 +1,135 @@
|
||||
|
||||
#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;
|
||||
}
|
||||
|
Reference in New Issue
Block a user