1 /**
2 * \file util.c
3 *
4 * This file contains generic utility functions such as can be
5 * used for debugging for example.
6 *
7 * Copyright (C) 2005-2007 Linus Walleij <triad@df.lth.se>
8 *
9 * This library is free software; you can redistribute it and/or
10 * modify it under the terms of the GNU Lesser General Public
11 * License as published by the Free Software Foundation; either
12 * version 2 of the License, or (at your option) any later version.
13 *
14 * This library is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
17 * Lesser General Public License for more details.
18 *
19 * You should have received a copy of the GNU Lesser General Public
20 * License along with this library; if not, write to the
21 * Free Software Foundation, Inc., 59 Temple Place - Suite 330,
22 * Boston, MA 02111-1307, USA.
23 */
24
25 /* MSVC does not have these */
26 #ifndef _MSC_VER
27 #include <sys/time.h>
28 #include <unistd.h>
29 #endif
30
31 #include <stdio.h>
32 #include <stdlib.h>
33 #include <errno.h>
34 #include <sys/stat.h>
35 #include <fcntl.h>
36 #include "libmtp.h"
37 #include "util.h"
38
39 /**
40 * This dumps out a number of bytes to a textual, hexadecimal
41 * dump.
42 *
43 * @param f the file to dump to (e.g. stdout or stderr)
44 * @param buf a pointer to the buffer containing the bytes to
45 * be dumped out in hex
46 * @param n the number of bytes to dump from this buffer
47 */
data_dump(FILE * f,void * buf,uint32_t n)48 void data_dump (FILE *f, void *buf, uint32_t n)
49 {
50 unsigned char *bp = (unsigned char *) buf;
51 uint32_t i;
52
53 for (i = 0; i < n; i++) {
54 fprintf(f, "%02x ", *bp);
55 bp++;
56 }
57 fprintf(f, "\n");
58 }
59
60 /**
61 * This dumps out a number of bytes to a textual, hexadecimal
62 * dump, and also prints out the string ASCII representation
63 * for each line of bytes. It will also print the memory address
64 * offset from a certain boundry.
65 *
66 * @param f the file to dump to (e.g. stdout or stderr)
67 * @param buf a pointer to the buffer containing the bytes to
68 * be dumped out in hex
69 * @param n the number of bytes to dump from this buffer
70 * @param dump_boundry the address offset to start at (usually 0)
71 */
data_dump_ascii(FILE * f,void * buf,uint32_t n,uint32_t dump_boundry)72 void data_dump_ascii (FILE *f, void *buf, uint32_t n, uint32_t dump_boundry)
73 {
74 uint32_t remain = n;
75 uint32_t ln, lc;
76 int i;
77 unsigned char *bp = (unsigned char *) buf;
78
79 lc = 0;
80 while (remain) {
81 fprintf(f, "\t%04x:", dump_boundry-0x10);
82
83 ln = ( remain > 16 ) ? 16 : remain;
84
85 for (i = 0; i < ln; i++) {
86 if ( ! (i%2) ) fprintf(f, " ");
87 fprintf(f, "%02x", bp[16*lc+i]);
88 }
89
90 if ( ln < 16 ) {
91 int width = ((16-ln)/2)*5 + (2*(ln%2));
92 fprintf(f, "%*.*s", width, width, "");
93 }
94
95 fprintf(f, "\t");
96 for (i = 0; i < ln; i++) {
97 unsigned char ch= bp[16*lc+i];
98 fprintf(f, "%c", ( ch >= 0x20 && ch <= 0x7e ) ?
99 ch : '.');
100 }
101 fprintf(f, "\n");
102
103 lc++;
104 remain -= ln;
105 dump_boundry += ln;
106 }
107 }
108