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
116
117
118
119
120
121
122
123
124
125
126
127
128
129
|
#define _GNU_SOURCE
#include <ctype.h>
#include <stdint.h>
#include <stdbool.h>
/*===========================================================================*/
bool ispotfilestring(size_t len, char *buffer)
{
size_t i;
for(i = 0; i < len; i++)
{
if((buffer[i] < 0x20) || (buffer[i] > 0x7e) || (buffer[i] == ':')) return false;
}
return true;
}
/*===========================================================================*/
bool isasciistring(size_t len, uint8_t *buffer)
{
size_t i;
for(i = 0; i < len; i++)
{
if(buffer[i] == 0) return true;
if((buffer[i] < 0x20) || (buffer[i] == 0x7f)) return false;
}
return true;
}
/*===========================================================================*/
size_t getfieldlen(const char *str, size_t len)
{
size_t i;
for(i = 0; i < len; i++)
{
if(str[i] == '*') return i;
}
return -1;
}
/*===========================================================================*/
bool ishexvalue(const char *str, size_t len)
{
size_t i;
for(i = 0; i < len; i++)
{
if(!isxdigit((unsigned char)str[i])) return false;
}
return true;
}
/*===========================================================================*/
ssize_t hex2bin(const char *str, uint8_t *bytes, size_t blen)
{
uint8_t pos;
uint8_t idx0;
uint8_t idx1;
const uint8_t hashmap[] =
{
0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, // 01234567
0x08, 0x09, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, // 89:;<=>?
0x00, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f, 0x00, // @ABCDEFG
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, // HIJKLMNO
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, // PQRSTUVW
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, // XYZ[\]^_
0x00, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f, 0x00, // `abcdefg
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, // hijklmno
};
if(ishexvalue(str, blen) == false) return -1;
memset(bytes, 0, blen);
for (pos = 0; ((pos < (blen*2)) && (pos < strlen(str))); pos += 2)
{
idx0 = ((uint8_t)str[pos+0] & 0x1F) ^ 0x10;
idx1 = ((uint8_t)str[pos+1] & 0x1F) ^ 0x10;
bytes[pos/2] = (uint8_t)(hashmap[idx0] << 4) | hashmap[idx1];
};
return pos/2;
}
/*===========================================================================*/
ssize_t ishexify(const char *string)
{
size_t len;
len = strlen(string);
if (len < 6) return -1;
if (strncmp("$HEX[", string, 5)) return -1;
if (string[len -1] != ']') return -1;
if ((len &1) == 1) return -1;
return (len -6)/2;
}
/*===========================================================================*/
char** create_upper_array(const char** from, size_t size)
{
size_t len;
size_t i;
uint8_t j;
char** to;
to = (char**)malloc(size * sizeof(char *));
if(to == NULL)
{
fprintf(stderr, "failed to allocate memory\n");
exit(EXIT_FAILURE);
}
for (i = 0; i < size; i++)
{
len = strlen(from[i]);
to[i] = (char*)malloc(len * sizeof(char) + 1);
if(to[i] == NULL)
{
fprintf(stderr, "failed to allocate memory\n");
exit(EXIT_FAILURE);
}
for (j = 0; j <= len; j++) to[i][j] = toupper((unsigned char)from[i][j]);
}
return to;
}
/*===========================================================================*/
void free_array(char** arr, size_t size)
{
size_t i;
for (i = 0; i < size; i++) free(arr[i]);
free(arr);
return;
}
/*===========================================================================*/
|
