1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
|
/*
* Copyright (C) 2006 Raul Tremsal
* File : smpp34_dumpBuf.c
* Author: Raul Tremsal <ultraismo@yahoo.com>
*
* This file is part of libsmpp34 (c-open-smpp3.4 library).
*
* The libsmpp34 library 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 library 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 library; if not, write to the Free Software Foundation,
* Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
*
*/
#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <sys/types.h>
#include <netinet/in.h>
#include <stdint.h>
#include "smpp34.h"
#include "smpp34_structs.h"
#include "smpp34_params.h"
/* GLOBALS ********************************************************************/
/* EXTERN *********************************************************************/
extern int smpp34_errno;
extern char smpp34_strerror[2048];
extern char *ptrerror;
/* FUNCTIONS ******************************************************************/
int
smpp34_dumpBuf(uint8_t *dest, int destL, uint8_t *src, int srcL)
{
int i;
int j;
int size;
uint8_t ind = 3;
uint8_t *buffer = NULL;
int lefterror = 0;
size = srcL;
buffer = src;
memset(smpp34_strerror, 0, sizeof(smpp34_strerror));
ptrerror = smpp34_strerror;
lefterror = sizeof(smpp34_strerror);
/* dump buffer character by character until size is reached */
for(i = 0; i < size; i++){
switch( i % 16 ) {
case 0:
dest += sprintf((char*)dest, "%*c%02X ", ind, ' ', (uint8_t)buffer[i]);
break;
case 7:
dest += sprintf((char*)dest, "%02X ", (uint8_t)buffer[i]);
break;
case 15:
dest += sprintf((char*)dest, "%02X ", (uint8_t)buffer[i]);
for(j = (i - 15); j <= i; j++) {
if ( (buffer[j] < ' ') || (buffer[j] > '~') )
dest += sprintf((char*)dest, ".");
else
dest += sprintf((char*)dest, "%c", buffer[j]);
if ( (j % 16) == 7 )
dest += sprintf((char*)dest, " ");
}
dest += sprintf((char*)dest, "\n");
break;
default:
dest += sprintf((char*)dest, "%02X ", (uint8_t)buffer[i]);
break;
}
};
/* if the line is not completed, we have to fill it */
if ( (size % 16) != 0 ) {
for (i = (size % 16); i < 16; i++) {
dest += sprintf((char*)dest, " ");
if ( (i % 16) == 7 )
dest += sprintf((char*)dest, " ");
}
dest += sprintf((char*)dest, " ");
for (j = size - (size % 16); j < size; j++) {
/* check if character is printable */
if ( (buffer[j] < ' ') || (buffer[j] > '~') )
dest += sprintf((char*)dest, ".");
else
dest += sprintf((char*)dest, "%c", (char) buffer[j]);
if ( (j % 16) == 7 )
dest += sprintf((char*)dest, " ");
}
dest += sprintf((char*)dest, "\n");
}
*dest = '\0';
return( 0 );
};
|