Merge OSX compatibility patch (bug #1940)
[asterisk/asterisk.git] / utils.c
1 /*
2  * Asterisk -- A telephony toolkit for Linux.
3  *
4  * Utility functions
5  *
6  * Copyright (C) 2004, Digium
7  *
8  * This program is free software, distributed under the terms of
9  * the GNU General Public License
10  */
11
12 #include <ctype.h>
13 #include <string.h>
14 #include <unistd.h>
15 #include <asterisk/lock.h>
16 #include <asterisk/utils.h>
17
18 static char base64[64];
19 static char b2a[256];
20
21 #if defined(__FreeBSD__) || defined(__OpenBSD__) || defined(__APPLE__)
22
23 /* duh? ERANGE value copied from web... */
24 #define ERANGE 34
25 #undef gethostbyname
26
27 AST_MUTEX_DEFINE_STATIC(__mutex);
28
29 static int gethostbyname_r (const char *name, struct hostent *ret, char *buf,
30                                 size_t buflen, struct hostent **result, 
31                                 int *h_errnop) 
32 {
33         int hsave;
34         struct hostent *ph;
35         ast_mutex_lock(&__mutex); /* begin critical area */
36         hsave = h_errno;
37
38         ph = gethostbyname(name);
39         *h_errnop = h_errno; /* copy h_errno to *h_herrnop */
40         if (ph == NULL) {
41                 *result = NULL;
42         } else {
43                 char **p, **q;
44                 char *pbuf;
45                 int nbytes=0;
46                 int naddr=0, naliases=0;
47                 /* determine if we have enough space in buf */
48
49                 /* count how many addresses */
50                 for (p = ph->h_addr_list; *p != 0; p++) {
51                         nbytes += ph->h_length; /* addresses */
52                         nbytes += sizeof(*p); /* pointers */
53                         naddr++;
54                 }
55                 nbytes += sizeof(*p); /* one more for the terminating NULL */
56
57                 /* count how many aliases, and total length of strings */
58                 for (p = ph->h_aliases; *p != 0; p++) {
59                         nbytes += (strlen(*p)+1); /* aliases */
60                         nbytes += sizeof(*p);  /* pointers */
61                         naliases++;
62                 }
63                 nbytes += sizeof(*p); /* one more for the terminating NULL */
64
65                 /* here nbytes is the number of bytes required in buffer */
66                 /* as a terminator must be there, the minimum value is ph->h_length */
67                 if(nbytes > buflen) {
68                         *result = NULL;
69                         ast_mutex_unlock(&__mutex); /* end critical area */
70                         return ERANGE; /* not enough space in buf!! */
71                 }
72
73                 /* There is enough space. Now we need to do a deep copy! */
74                 /* Allocation in buffer:
75                         from [0] to [(naddr-1) * sizeof(*p)]:
76                         pointers to addresses
77                         at [naddr * sizeof(*p)]:
78                         NULL
79                         from [(naddr+1) * sizeof(*p)] to [(naddr+naliases) * sizeof(*p)] :
80                         pointers to aliases
81                         at [(naddr+naliases+1) * sizeof(*p)]:
82                         NULL
83                         then naddr addresses (fixed length), and naliases aliases (asciiz).
84                 */
85
86                 *ret = *ph;   /* copy whole structure (not its address!) */
87
88                 /* copy addresses */
89                 q = (char **)buf; /* pointer to pointers area (type: char **) */
90                 ret->h_addr_list = q; /* update pointer to address list */
91                 pbuf = buf + ((naddr+naliases+2)*sizeof(*p)); /* skip that area */
92                 for (p = ph->h_addr_list; *p != 0; p++) {
93                         memcpy(pbuf, *p, ph->h_length); /* copy address bytes */
94                         *q++ = pbuf; /* the pointer is the one inside buf... */
95                         pbuf += ph->h_length; /* advance pbuf */
96                 }
97                 *q++ = NULL; /* address list terminator */
98
99                 /* copy aliases */
100                 ret->h_aliases = q; /* update pointer to aliases list */
101                 for (p = ph->h_aliases; *p != 0; p++) {
102                         strcpy(pbuf, *p); /* copy alias strings */
103                         *q++ = pbuf; /* the pointer is the one inside buf... */
104                         pbuf += strlen(*p); /* advance pbuf */
105                         *pbuf++ = 0; /* string terminator */
106                 }
107                 *q++ = NULL; /* terminator */
108
109                 strcpy(pbuf, ph->h_name); /* copy alias strings */
110                 ret->h_name = pbuf;
111                 pbuf += strlen(ph->h_name); /* advance pbuf */
112                 *pbuf++ = 0; /* string terminator */
113
114                 *result = ret;  /* and let *result point to structure */
115
116         }
117         h_errno = hsave;  /* restore h_errno */
118         ast_mutex_unlock(&__mutex); /* end critical area */
119
120         return (*result == NULL); /* return 0 on success, non-zero on error */
121 }
122
123
124 #endif
125
126 struct hostent *ast_gethostbyname(const char *host, struct ast_hostent *hp)
127 {
128         int res;
129         int herrno;
130         const char *s;
131         struct hostent *result = NULL;
132         /* Although it is perfectly legitimate to lookup a pure integer, for
133            the sake of the sanity of people who like to name their peers as
134            integers, we break with tradition and refuse to look up a
135            pure integer */
136         s = host;
137         while(s && *s) {
138                 if (!isdigit(*s))
139                         break;
140                 s++;
141         }
142         if (!s || !*s)
143                 return NULL;
144         res = gethostbyname_r(host, &hp->hp, hp->buf, sizeof(hp->buf), &result, &herrno);
145
146         if (res || !result || !hp->hp.h_addr_list || !hp->hp.h_addr_list[0])
147                 return NULL;
148         return &hp->hp;
149 }
150
151
152 /* This is a regression test for recursive mutexes.
153    test_for_thread_safety() will return 0 if recursive mutex locks are
154    working properly, and non-zero if they are not working properly. */
155
156 AST_MUTEX_DEFINE_STATIC(test_lock);
157 AST_MUTEX_DEFINE_STATIC(test_lock2);
158 static pthread_t test_thread; 
159 static int lock_count = 0;
160 static int test_errors = 0;
161
162 static void *test_thread_body(void *data) 
163
164         ast_mutex_lock(&test_lock);
165         lock_count += 10;
166         if (lock_count != 10) 
167                 test_errors++;
168         ast_mutex_lock(&test_lock);
169         lock_count += 10;
170         if (lock_count != 20) 
171                 test_errors++;
172         ast_mutex_lock(&test_lock2);
173         ast_mutex_unlock(&test_lock);
174         lock_count -= 10;
175         if (lock_count != 10) 
176                 test_errors++;
177         ast_mutex_unlock(&test_lock);
178         lock_count -= 10;
179         ast_mutex_unlock(&test_lock2);
180         if (lock_count != 0) 
181                 test_errors++;
182         return NULL;
183
184
185 int test_for_thread_safety(void)
186
187         ast_mutex_lock(&test_lock2);
188         ast_mutex_lock(&test_lock);
189         lock_count += 1;
190         ast_mutex_lock(&test_lock);
191         lock_count += 1;
192         pthread_create(&test_thread, NULL, test_thread_body, NULL); 
193         usleep(100);
194         if (lock_count != 2) 
195                 test_errors++;
196         ast_mutex_unlock(&test_lock);
197         lock_count -= 1;
198         usleep(100); 
199         if (lock_count != 1) 
200                 test_errors++;
201         ast_mutex_unlock(&test_lock);
202         lock_count -= 1;
203         if (lock_count != 0) 
204                 test_errors++;
205         ast_mutex_unlock(&test_lock2);
206         usleep(100);
207         if (lock_count != 0) 
208                 test_errors++;
209         pthread_join(test_thread, NULL);
210         return(test_errors);          /* return 0 on success. */
211 }
212
213 int ast_base64decode(unsigned char *dst, char *src, int max)
214 {
215         int cnt = 0;
216         unsigned int byte = 0;
217         unsigned int bits = 0;
218         int incnt = 0;
219 #if 0
220         unsigned char *odst = dst;
221 #endif
222         while(*src && (cnt < max)) {
223                 /* Shift in 6 bits of input */
224                 byte <<= 6;
225                 byte |= (b2a[(int)(*src)]) & 0x3f;
226                 bits += 6;
227 #if 0
228                 printf("Add: %c %s\n", *src, binary(b2a[(int)(*src)] & 0x3f, 6));
229 #endif
230                 src++;
231                 incnt++;
232                 /* If we have at least 8 bits left over, take that character 
233                    off the top */
234                 if (bits >= 8)  {
235                         bits -= 8;
236                         *dst = (byte >> bits) & 0xff;
237 #if 0
238                         printf("Remove: %02x %s\n", *dst, binary(*dst, 8));
239 #endif
240                         dst++;
241                         cnt++;
242                 }
243         }
244 #if 0
245         dump(odst, cnt);
246 #endif
247         /* Dont worry about left over bits, they're extra anyway */
248         return cnt;
249 }
250
251 int ast_base64encode(char *dst, unsigned char *src, int srclen, int max)
252 {
253         int cnt = 0;
254         unsigned int byte = 0;
255         int bits = 0;
256         int index;
257         int cntin = 0;
258 #if 0
259         char *odst = dst;
260         dump(src, srclen);
261 #endif
262         /* Reserve one bit for end */
263         max--;
264         while((cntin < srclen) && (cnt < max)) {
265                 byte <<= 8;
266 #if 0
267                 printf("Add: %02x %s\n", *src, binary(*src, 8));
268 #endif
269                 byte |= *(src++);
270                 bits += 8;
271                 cntin++;
272                 while((bits >= 6) && (cnt < max)) {
273                         bits -= 6;
274                         /* We want only the top */
275                         index = (byte >> bits) & 0x3f;
276                         *dst = base64[index];
277 #if 0
278                         printf("Remove: %c %s\n", *dst, binary(index, 6));
279 #endif
280                         dst++;
281                         cnt++;
282                 }
283         }
284         if (bits && (cnt < max)) {
285                 /* Add one last character for the remaining bits, 
286                    padding the rest with 0 */
287                 byte <<= (6 - bits);
288                 index = (byte) & 0x3f;
289                 *(dst++) = base64[index];
290                 cnt++;
291         }
292         *dst = '\0';
293         return cnt;
294 }
295
296 static void base64_init(void)
297 {
298         int x;
299         memset(b2a, -1, sizeof(b2a));
300         /* Initialize base-64 Conversion table */
301         for (x=0;x<26;x++) {
302                 /* A-Z */
303                 base64[x] = 'A' + x;
304                 b2a['A' + x] = x;
305                 /* a-z */
306                 base64[x + 26] = 'a' + x;
307                 b2a['a' + x] = x + 26;
308                 /* 0-9 */
309                 if (x < 10) {
310                         base64[x + 52] = '0' + x;
311                         b2a['0' + x] = x + 52;
312                 }
313         }
314         base64[62] = '+';
315         base64[63] = '/';
316         b2a[(int)'+'] = 62;
317         b2a[(int)'/'] = 63;
318 #if 0
319         for (x=0;x<64;x++) {
320                 if (b2a[(int)base64[x]] != x) {
321                         fprintf(stderr, "!!! %d failed\n", x);
322                 } else
323                         fprintf(stderr, "--- %d passed\n", x);
324         }
325 #endif
326 }
327
328
329 int ast_utils_init(void)
330 {
331         base64_init();
332         return 0;
333 }