xref: /minix/external/bsd/libpcap/dist/pcap-sita.c (revision fb9c64b2)
1 /*	$NetBSD: pcap-sita.c,v 1.3 2015/03/31 21:39:42 christos Exp $	*/
2 
3 /*
4  *  pcap-sita.c: Packet capture interface additions for SITA ACN devices
5  *
6  *  Copyright (c) 2007 Fulko Hew, SITA INC Canada, Inc <fulko.hew@sita.aero>
7  *
8  *  License: BSD
9  *
10  *  Redistribution and use in source and binary forms, with or without
11  *  modification, are permitted provided that the following conditions
12  *  are met:
13  *
14  *  1. Redistributions of source code must retain the above copyright
15  *     notice, this list of conditions and the following disclaimer.
16  *  2. Redistributions in binary form must reproduce the above copyright
17  *     notice, this list of conditions and the following disclaimer in
18  *     the documentation and/or other materials provided with the
19  *     distribution.
20  *  3. The names of the authors may not be used to endorse or promote
21  *     products derived from this software without specific prior
22  *     written permission.
23  *
24  *  THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR
25  *  IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED
26  *  WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
27  */
28 
29 #include <sys/cdefs.h>
30 __RCSID("$NetBSD: pcap-sita.c,v 1.3 2015/03/31 21:39:42 christos Exp $");
31 
32 #ifdef HAVE_CONFIG_H
33 #include "config.h"
34 #endif
35 
36 #include <stdio.h>
37 #include <string.h>
38 #include <stdlib.h>
39 #include <unistd.h>
40 #include <fcntl.h>
41 #include <errno.h>
42 #include <sys/time.h>
43 #include <sys/socket.h>
44 #include <netinet/in.h>
45 #include <arpa/inet.h>
46 #include "pcap-int.h"
47 
48 #include "pcap-sita.h"
49 
50 	/* non-configureable manifests follow */
51 
52 #define IOP_SNIFFER_PORT	49152			/* TCP port on the IOP used for 'distributed pcap' usage */
53 #define MAX_LINE_SIZE		255				/* max size of a buffer/line in /etc/hosts we allow */
54 #define MAX_CHASSIS			8				/* number of chassis in an ACN site */
55 #define MAX_GEOSLOT			8				/* max number of access units in an ACN site */
56 
57 #define FIND			0
58 #define LIVE			1
59 
60 typedef struct iface {
61 	struct iface	*next;		/* a pointer to the next interface */
62 	char		*name;		/* this interface's name */
63 	char		*IOPname;	/* this interface's name on an IOP */
64 	uint32_t	iftype;		/* the type of interface (DLT values) */
65 } iface_t;
66 
67 typedef struct unit {
68 	char			*ip;		/* this unit's IP address (as extracted from /etc/hosts) */
69 	int			fd;		/* the connection to this unit (if it exists) */
70 	int			find_fd;	/* a big kludge to avoid my programming limitations since I could have this unit open for findalldevs purposes */
71 	int			first_time;	/* 0 = just opened via acn_open_live(),  ie. the first time, NZ = nth time */
72 	struct sockaddr_in	*serv_addr;	/* the address control block for comms to this unit */
73 	int			chassis;
74 	int			geoslot;
75 	iface_t			*iface;		/* a pointer to a linked list of interface structures */
76 	char			*imsg;		/* a pointer to an inbound message */
77 	int			len;		/* the current size of the inbound message */
78 } unit_t;
79 
80 static unit_t		units[MAX_CHASSIS+1][MAX_GEOSLOT+1];	/* we use indexes of 1 through 8, but we reserve/waste index 0 */
81 static fd_set		readfds;				/* a place to store the file descriptors for the connections to the IOPs */
82 static int		max_fs;
83 
84 pcap_if_t		*acn_if_list;		/* pcap's list of available interfaces */
85 
86 static void dump_interface_list(void) {
87 	pcap_if_t		*iff;
88 	pcap_addr_t		*addr;
89 	int			longest_name_len = 0;
90 	char			*n, *d, *f;
91 	int			if_number = 0;
92 
93 	iff = acn_if_list;
94 	while (iff) {
95 		if (iff->name && (strlen(iff->name) > longest_name_len)) longest_name_len = strlen(iff->name);
96 		iff = iff->next;
97 	}
98 	iff = acn_if_list;
99 	printf("Interface List:\n");
100 	while (iff) {
101 		n = (iff->name)							? iff->name			: "";
102 		d = (iff->description)					? iff->description	: "";
103 		f = (iff->flags == PCAP_IF_LOOPBACK)	? "L"				: "";
104 		printf("%3d: %*s %s '%s'\n", if_number++, longest_name_len, n, f, d);
105 		addr = iff->addresses;
106 		while (addr) {
107 			printf("%*s ", (5 + longest_name_len), "");		/* add some indentation */
108 			printf("%15s  ", (addr->addr)		? inet_ntoa(((struct sockaddr_in *)addr->addr)->sin_addr)		: "");
109 			printf("%15s  ", (addr->netmask)	? inet_ntoa(((struct sockaddr_in *)addr->netmask)->sin_addr)	: "");
110 			printf("%15s  ", (addr->broadaddr)	? inet_ntoa(((struct sockaddr_in *)addr->broadaddr)->sin_addr)	: "");
111 			printf("%15s  ", (addr->dstaddr)	? inet_ntoa(((struct sockaddr_in *)addr->dstaddr)->sin_addr)	: "");
112 			printf("\n");
113 			addr = addr->next;
114 		}
115 		iff = iff->next;
116 	}
117 }
118 
119 static void dump(unsigned char *ptr, int i, int indent) {
120 	fprintf(stderr, "%*s", indent, " ");
121 	for (; i > 0; i--) {
122 		fprintf(stderr, "%2.2x ", *ptr++);
123 	}
124 	fprintf(stderr, "\n");
125 }
126 
127 static void dump_interface_list_p(void) {
128 	pcap_if_t		*iff;
129 	pcap_addr_t		*addr;
130 	int				if_number = 0;
131 
132 	iff = acn_if_list;
133 	printf("Interface Pointer @ %p is %p:\n", &acn_if_list, iff);
134 	while (iff) {
135 		printf("%3d: %p %p next: %p\n", if_number++, iff->name, iff->description, iff->next);
136 		dump((unsigned char *)iff, sizeof(pcap_if_t), 5);
137 		addr = iff->addresses;
138 		while (addr) {
139 			printf("          %p %p %p %p, next: %p\n", addr->addr, addr->netmask, addr->broadaddr, addr->dstaddr, addr->next);
140 			dump((unsigned char *)addr, sizeof(pcap_addr_t), 10);
141 			addr = addr->next;
142 		}
143 		iff = iff->next;
144 	}
145 }
146 
147 static void dump_unit_table(void) {
148 	int		chassis, geoslot;
149 	iface_t	*p;
150 
151 	printf("%c:%c %s %s\n", 'C', 'S', "fd", "IP Address");
152 	for (chassis = 0; chassis <= MAX_CHASSIS; chassis++) {
153 		for (geoslot = 0; geoslot <= MAX_GEOSLOT; geoslot++) {
154 			if (units[chassis][geoslot].ip != NULL)
155 				printf("%d:%d %2d %s\n", chassis, geoslot, units[chassis][geoslot].fd, units[chassis][geoslot].ip);
156 			p = units[chassis][geoslot].iface;
157 			while (p) {
158 				char *n = (p->name)			? p->name			: "";
159 				char *i = (p->IOPname)		? p->IOPname		: "";
160 				p = p->next;
161 				printf("   %12s    -> %12s\n", i, n);
162 			}
163 		}
164 	}
165 }
166 
167 static int find_unit_by_fd(int fd, int *chassis, int *geoslot, unit_t **unit_ptr) {
168 	int		c, s;
169 
170 	for (c = 0; c <= MAX_CHASSIS; c++) {
171 		for (s = 0; s <= MAX_GEOSLOT; s++) {
172 			if (units[c][s].fd == fd || units[c][s].find_fd == fd) {
173 				if (chassis)	*chassis = c;
174 				if (geoslot)	*geoslot = s;
175 				if (unit_ptr)	*unit_ptr = &units[c][s];
176 				return 1;
177 			}
178 		}
179 	}
180 	return 0;
181 }
182 
183 static int read_client_nbytes(int fd, int count, unsigned char *buf) {
184 	unit_t			*u;
185 	int				chassis, geoslot;
186 	int				len;
187 
188 	find_unit_by_fd(fd, &chassis, &geoslot, &u);
189 	while (count) {
190 		if ((len = recv(fd, buf, count, 0)) <= 0)	return -1;	/* read in whatever data was sent to us */
191 		count -= len;
192 		buf += len;
193 	}															/* till we have everything we are looking for */
194 	return 0;
195 }
196 
197 static void empty_unit_iface(unit_t *u) {
198 	iface_t	*p, *cur;
199 
200 	cur = u->iface;
201 	while (cur) {											/* loop over all the interface entries */
202 		if (cur->name)			free(cur->name);			/* throwing away the contents if they exist */
203 		if (cur->IOPname)		free(cur->IOPname);
204 		p = cur->next;
205 		free(cur);											/* then throw away the structure itself */
206 		cur = p;
207 	}
208 	u->iface = 0;											/* and finally remember that there are no remaining structure */
209 }
210 
211 static void empty_unit(int chassis, int geoslot) {
212 	unit_t	*u = &units[chassis][geoslot];
213 
214 	empty_unit_iface(u);
215 	if (u->imsg) {											/* then if an inbound message buffer exists */
216 		u->imsg = (char *)realloc(u->imsg, 1);				/* and re-allocate the old large buffer into a new small one */
217 		if (u->imsg == NULL) {	/* oops, realloc call failed */
218 			fprintf(stderr, "Warning...call to realloc() failed, value of errno is %d\n", errno);
219 
220 	}
221 }
222 
223 static void empty_unit_table(void) {
224 	int		chassis, geoslot;
225 
226 	for (chassis = 0; chassis <= MAX_CHASSIS; chassis++) {
227 		for (geoslot = 0; geoslot <= MAX_GEOSLOT; geoslot++) {
228 			if (units[chassis][geoslot].ip != NULL) {
229 				free(units[chassis][geoslot].ip);			/* get rid of the malloc'ed space that holds the IP address */
230 				units[chassis][geoslot].ip = 0;				/* then set the pointer to NULL */
231 			}
232 			empty_unit(chassis, geoslot);
233 		}
234 	}
235 }
236 
237 static char *find_nth_interface_name(int n) {
238 	int		chassis, geoslot;
239 	iface_t	*p;
240 	char	*last_name = 0;
241 
242 	if (n < 0) n = 0;												/* ensure we are working with a valid number */
243 	for (chassis = 0; chassis <= MAX_CHASSIS; chassis++) {			/* scan the table... */
244 		for (geoslot = 0; geoslot <= MAX_GEOSLOT; geoslot++) {
245 			if (units[chassis][geoslot].ip != NULL) {
246 				p = units[chassis][geoslot].iface;
247 				while (p) {											/* and all interfaces... */
248 					if (p->IOPname) last_name = p->name;			/* remembering the last name found */
249 					if (n-- == 0) return last_name;					/* and if we hit the instance requested */
250 					p = p->next;
251 				}
252 			}
253 		}
254 	}
255 											/* if we couldn't fine the selected entry */
256 	if (last_name)	return last_name;		/* ... but we did have at least one entry... return the last entry found */
257 	return "";								/* ... but if there wasn't any entry... return an empty string instead */
258 }
259 
260 int acn_parse_hosts_file(char *errbuf) {				/* returns: -1 = error, 0 = OK */
261 	FILE	*fp;
262 	char	buf[MAX_LINE_SIZE];
263 	char	*ptr, *ptr2;
264 	int		pos;
265 	int		chassis, geoslot;
266 	unit_t	*u;
267 
268 	empty_unit_table();
269 	if ((fp = fopen("/etc/hosts", "r")) == NULL) {										/* try to open the hosts file and if it fails */
270 		snprintf(errbuf, PCAP_ERRBUF_SIZE, "Cannot open '/etc/hosts' for reading.");	/* return the nohostsfile error response */
271 		return -1;
272 	}
273 	while (fgets(buf, MAX_LINE_SIZE-1, fp)) {			/* while looping over the file */
274 
275 		pos = strcspn(buf, "#\n\r");					/* find the first comment character or EOL */
276 		*(buf + pos) = '\0';							/* and clobber it and anything that follows it */
277 
278 		pos = strspn(buf, " \t");						/* then find the first non-white space */
279 		if (pos == strlen(buf))							/* if there is nothing but white space on the line */
280 			continue;									/* ignore that empty line */
281 		ptr = buf + pos;								/* and skip over any of that leading whitespace */
282 
283 		if ((ptr2 = strstr(ptr, "_I_")) == NULL)		/* skip any lines that don't have names that look like they belong to IOPs */
284 			continue;
285 		if (*(ptr2 + 4) != '_')							/* and skip other lines that have names that don't look like ACN components */
286 			continue;
287 		*(ptr + strcspn(ptr, " \t")) = '\0';			/* null terminate the IP address so its a standalone string */
288 
289 		chassis = *(ptr2 + 3) - '0';					/* extract the chassis number */
290 		geoslot = *(ptr2 + 5) - '0';					/* and geo-slot number */
291 		if (chassis < 1 || chassis > MAX_CHASSIS ||
292 			geoslot < 1 || geoslot > MAX_GEOSLOT) {		/* if the chassis and/or slot numbers appear to be bad... */
293 			snprintf(errbuf, PCAP_ERRBUF_SIZE, "Invalid ACN name in '/etc/hosts'.");	/* warn the user */
294 			continue;																	/* and ignore the entry */
295 		}
296 		if ((ptr2 = (char *)malloc(strlen(ptr) + 1)) == NULL) {
297 			snprintf(errbuf, PCAP_ERRBUF_SIZE, "malloc: %s", pcap_strerror(errno));
298 			continue;
299 		}
300 		strcpy(ptr2, ptr);								/* copy the IP address into our malloc'ed memory */
301 		u = &units[chassis][geoslot];
302 		u->ip = ptr2;									/* and remember the whole shebang */
303 		u->chassis = chassis;
304 		u->geoslot = geoslot;
305 	}
306 	fclose(fp);
307 	if (*errbuf)	return -1;
308 	else			return 0;
309 }
310 
311 static int open_with_IOP(unit_t  *u, int flag) {
312 	int					sockfd;
313 	char				*ip;
314 
315 	if (u->serv_addr == NULL) {
316 		u->serv_addr = malloc(sizeof(struct sockaddr_in));
317 
318 		/* since we called malloc(), lets check to see if we actually got the memory	*/
319 		if (u->serv_addr == NULL) {	/* oops, we didn't get the memory requested	*/
320 			fprintf(stderr, "malloc() request for u->serv_addr failed, value of errno is: %d\n", errno);
321 			return 0;
322 		}
323 
324 	}
325 	ip = u->ip;
326 	/* bzero() is deprecated, replaced with memset()	*/
327 	memset((char *)u->serv_addr, 0, sizeof(struct sockaddr_in));
328 	u->serv_addr->sin_family		= AF_INET;
329 	u->serv_addr->sin_addr.s_addr	= inet_addr(ip);
330 	u->serv_addr->sin_port			= htons(IOP_SNIFFER_PORT);
331 
332 	if ((sockfd = socket(AF_INET, SOCK_STREAM, 0)) < 0) {
333 		fprintf(stderr, "pcap can't open a socket for connecting to IOP at %s\n", ip);
334 		return 0;
335 	}
336 	if (connect(sockfd, (struct sockaddr *)u->serv_addr, sizeof(struct sockaddr_in)) < 0) {
337 		fprintf(stderr, "pcap can't connect to IOP at %s\n", ip);
338 		return 0;
339 	}
340 	if (flag == LIVE)	u->fd = sockfd;
341 	else				u->find_fd = sockfd;
342 	u->first_time = 0;
343 	return sockfd;			/* return the non-zero file descriptor as a 'success' indicator */
344 }
345 
346 static void close_with_IOP(int chassis, int geoslot, int flag) {
347 	int		*id;
348 
349 	if (flag == LIVE)	id = &units[chassis][geoslot].fd;
350 	else				id = &units[chassis][geoslot].find_fd;
351 
352 	if (*id) {										/* this was the last time, so... if we are connected... */
353 		close(*id);									/* disconnect us */
354 		*id = 0;									/* and forget that the descriptor exists because we are not open */
355 	}
356 }
357 
358 static void pcap_cleanup_acn(pcap_t *handle) {
359 	int		chassis, geoslot;
360 	unit_t	*u;
361 
362 	if (find_unit_by_fd(handle->fd, &chassis, &geoslot, &u) == 0)
363 		return;
364 	close_with_IOP(chassis, geoslot, LIVE);
365 	if (u)
366 		u->first_time = 0;
367 	pcap_cleanup_live_common(handle);
368 }
369 
370 static void send_to_fd(int fd, int len, unsigned char *str) {
371 	int		nwritten;
372 	int		chassis, geoslot;
373 
374 	while (len > 0) {
375 		if ((nwritten = write(fd, str, len)) <= 0) {
376 			find_unit_by_fd(fd, &chassis, &geoslot, NULL);
377 			if (units[chassis][geoslot].fd == fd)			close_with_IOP(chassis, geoslot, LIVE);
378 			else if (units[chassis][geoslot].find_fd == fd)	close_with_IOP(chassis, geoslot, FIND);
379 			empty_unit(chassis, geoslot);
380 			return;
381 		}
382 		len -= nwritten;
383 		str += nwritten;
384 	}
385 }
386 
387 static void acn_freealldevs(void) {
388 
389 	pcap_if_t	*iff, *next_iff;
390 	pcap_addr_t	*addr, *next_addr;
391 
392 	for (iff = acn_if_list; iff != NULL; iff = next_iff) {
393 		next_iff = iff->next;
394 		for (addr = iff->addresses; addr != NULL; addr = next_addr) {
395 			next_addr = addr->next;
396 			if (addr->addr)			free(addr->addr);
397 			if (addr->netmask)		free(addr->netmask);
398 			if (addr->broadaddr)	free(addr->broadaddr);
399 			if (addr->dstaddr)		free(addr->dstaddr);
400 			free(addr);
401 		}
402 		if (iff->name)			free(iff->name);
403 		if (iff->description)	free(iff->description);
404 		free(iff);
405 	}
406 }
407 
408 static void nonUnified_IOP_port_name(char *buf, size_t bufsize, const char *proto, unit_t *u) {
409 
410 	snprintf(buf, bufsize, "%s_%d_%d", proto, u->chassis, u->geoslot);
411 }
412 
413 static void unified_IOP_port_name(char *buf, size_t bufsize, const char *proto, unit_t *u, int IOPportnum) {
414 	int			portnum;
415 
416 	portnum = ((u->chassis - 1) * 64) + ((u->geoslot - 1) * 8) + IOPportnum + 1;
417 	snprintf(buf, bufsize, "%s_%d", proto, portnum);
418 }
419 
420 static char *translate_IOP_to_pcap_name(unit_t *u, char *IOPname, bpf_u_int32 iftype) {
421 	iface_t		*iface_ptr, *iface;
422 	char		*name;
423 	char		buf[32];
424 	char		*proto;
425 	char		*port;
426 	int			IOPportnum = 0;
427 
428 	iface = malloc(sizeof(iface_t));		/* get memory for a structure */
429 	if (iface == NULL) {	/* oops, we didn't get the memory requested	*/
430 		fprintf(stderr, "Error...couldn't allocate memory for interface structure...value of errno is: %d\n", errno);
431 		return NULL;
432 	}
433 	memset((char *)iface, 0, sizeof(iface_t));	/* bzero is deprecated(), replaced with memset() */
434 
435 	iface->iftype = iftype;					/* remember the interface type of this interface */
436 
437 	name = malloc(strlen(IOPname) + 1);		/* get memory for the IOP's name */
438         if (name == NULL) {    /* oops, we didn't get the memory requested     */
439                 fprintf(stderr, "Error...couldn't allocate memory for IOPname...value of errno is: %d\n", errno);
440                 return NULL;
441         }
442 
443 	strcpy(name, IOPname);					/* and copy it in */
444 	iface->IOPname = name;					/* and stick it into the structure */
445 
446 	if (strncmp(IOPname, "lo", 2) == 0) {
447 		IOPportnum = atoi(&IOPname[2]);
448 		switch (iftype) {
449 			case DLT_EN10MB:
450 				nonUnified_IOP_port_name(buf, sizeof buf, "lo", u);
451 				break;
452 			default:
453 				unified_IOP_port_name(buf, sizeof buf, "???", u, IOPportnum);
454 				break;
455 		}
456 	} else if (strncmp(IOPname, "eth", 3) == 0) {
457 		IOPportnum = atoi(&IOPname[3]);
458 		switch (iftype) {
459 			case DLT_EN10MB:
460 				nonUnified_IOP_port_name(buf, sizeof buf, "eth", u);
461 				break;
462 			default:
463 				unified_IOP_port_name(buf, sizeof buf, "???", u, IOPportnum);
464 				break;
465 		}
466 	} else if (strncmp(IOPname, "wan", 3) == 0) {
467 		IOPportnum = atoi(&IOPname[3]);
468 		switch (iftype) {
469 			case DLT_SITA:
470 				unified_IOP_port_name(buf, sizeof buf, "wan", u, IOPportnum);
471 				break;
472 			default:
473 				unified_IOP_port_name(buf, sizeof buf, "???", u, IOPportnum);
474 				break;
475 		}
476 	} else {
477 		fprintf(stderr, "Error... invalid IOP name %s\n", IOPname);
478 		return NULL;
479 	}
480 
481 	name = malloc(strlen(buf) + 1);			/* get memory for that name */
482         if (name == NULL) {    /* oops, we didn't get the memory requested     */
483                 fprintf(stderr, "Error...couldn't allocate memory for IOP port name...value of errno is: %d\n", errno);
484                 return NULL;
485         }
486 
487 	strcpy(name, buf);						/* and copy it in */
488 	iface->name = name;						/* and stick it into the structure */
489 
490 	if (u->iface == 0) {					/* if this is the first name */
491 		u->iface = iface;					/* stick this entry at the head of the list */
492 	} else {
493 		iface_ptr = u->iface;
494 		while (iface_ptr->next) {			/* othewise scan the list */
495 			iface_ptr = iface_ptr->next;	/* till we're at the last entry */
496 		}
497 		iface_ptr->next = iface;			/* then tack this entry on the end of the list */
498 	}
499 	return iface->name;
500 }
501 
502 static int if_sort(char *s1, char *s2) {
503 	char	*s1_p2, *s2_p2;
504 	char	str1[MAX_LINE_SIZE], str2[MAX_LINE_SIZE];
505 	int		s1_p1_len, s2_p1_len;
506 	int		retval;
507 
508 	if ((s1_p2 = strchr(s1, '_'))) {	/* if an underscore is found... */
509 		s1_p1_len = s1_p2 - s1;			/* the prefix length is the difference in pointers */
510 		s1_p2++;						/* the suffix actually starts _after_ the underscore */
511 	} else {							/* otherwise... */
512 		s1_p1_len = strlen(s1);			/* the prefix length is the length of the string itself */
513 		s1_p2 = 0;						/* and there is no suffix */
514 	}
515 	if ((s2_p2 = strchr(s2, '_'))) {	/* now do the same for the second string */
516 		s2_p1_len = s2_p2 - s2;
517 		s2_p2++;
518 	} else {
519 		s2_p1_len = strlen(s2);
520 		s2_p2 = 0;
521 	}
522 	strncpy(str1, s1, (s1_p1_len > sizeof(str1)) ? s1_p1_len : sizeof(str1));   *(str1 + s1_p1_len) = 0;
523 	strncpy(str2, s2, (s2_p1_len > sizeof(str2)) ? s2_p1_len : sizeof(str2));   *(str2 + s2_p1_len) = 0;
524 	retval = strcmp(str1, str2);
525 	if (retval != 0) return retval;		/* if they are not identical, then we can quit now and return the indication */
526 	return strcmp(s1_p2, s2_p2);		/* otherwise we return the result of comparing the 2nd half of the string */
527 }
528 
529 static void sort_if_table(void) {
530 	pcap_if_t	*p1, *p2, *prev, *temp;
531 	int			has_swapped;
532 
533 	if (!acn_if_list) return;				/* nothing to do if the list is empty */
534 
535 	while (1) {
536 		p1 = acn_if_list;					/* start at the head of the list */
537 		prev = 0;
538 		has_swapped = 0;
539 		while ((p2 = p1->next)) {
540 			if (if_sort(p1->name, p2->name) > 0) {
541 				if (prev) {					/* we are swapping things that are _not_ at the head of the list */
542 					temp = p2->next;
543 					prev->next = p2;
544 					p2->next = p1;
545 					p1->next = temp;
546 				} else {					/* special treatment if we are swapping with the head of the list */
547 					temp = p2->next;
548 					acn_if_list= p2;
549 					p2->next = p1;
550 					p1->next = temp;
551 				}
552 				p1 = p2;
553 				prev = p1;
554 				has_swapped = 1;
555 			}
556 			prev = p1;
557 			p1 = p1->next;
558 		}
559 		if (has_swapped == 0)
560 			return;
561 	}
562 	return;
563 }
564 
565 static int process_client_data (char *errbuf) {								/* returns: -1 = error, 0 = OK */
566 	int					chassis, geoslot;
567 	unit_t				*u;
568 	pcap_if_t			*iff, *prev_iff;
569 	pcap_addr_t			*addr, *prev_addr;
570 	char				*ptr;
571 	int					address_count;
572 	struct sockaddr_in	*s;
573 	char				*newname;
574 	bpf_u_int32				interfaceType;
575 	unsigned char		flags;
576 
577 	prev_iff = 0;
578 	for (chassis = 0; chassis <= MAX_CHASSIS; chassis++) {
579 		for (geoslot = 0; geoslot <= MAX_GEOSLOT; geoslot++) {				/* now loop over all the devices */
580 			u = &units[chassis][geoslot];
581 			empty_unit_iface(u);
582 			ptr = u->imsg;													/* point to the start of the msg for this IOP */
583 			while (ptr < (u->imsg + u->len)) {
584 				if ((iff = malloc(sizeof(pcap_if_t))) == NULL) {
585 					snprintf(errbuf, PCAP_ERRBUF_SIZE, "malloc: %s", pcap_strerror(errno));
586 					return -1;
587 				}
588 				memset((char *)iff, 0, sizeof(pcap_if_t)); /* bzero() is deprecated, replaced with memset() */
589 				if (acn_if_list == 0)	acn_if_list = iff;					/* remember the head of the list */
590 				if (prev_iff)			prev_iff->next = iff;				/* insert a forward link */
591 
592 				if (*ptr) {													/* if there is a count for the name */
593 					if ((iff->name = malloc(*ptr + 1)) == NULL) {			/* get that amount of space */
594 						snprintf(errbuf, PCAP_ERRBUF_SIZE, "malloc: %s", pcap_strerror(errno));
595 						return -1;
596 					}
597 					memcpy(iff->name, (ptr + 1), *ptr);						/* copy the name into the malloc'ed space */
598 					*(iff->name + *ptr) = 0;								/* and null terminate the string */
599 					ptr += *ptr;											/* now move the pointer forwards by the length of the count plus the length of the string */
600 				}
601 				ptr++;
602 
603 				if (*ptr) {													/* if there is a count for the description */
604 					if ((iff->description = malloc(*ptr + 1)) == NULL) {	/* get that amount of space */
605 						snprintf(errbuf, PCAP_ERRBUF_SIZE, "malloc: %s", pcap_strerror(errno));
606 						return -1;
607 					}
608 					memcpy(iff->description, (ptr + 1), *ptr);				/* copy the name into the malloc'ed space */
609 					*(iff->description + *ptr) = 0;							/* and null terminate the string */
610 					ptr += *ptr;											/* now move the pointer forwards by the length of the count plus the length of the string */
611 				}
612 				ptr++;
613 
614 				interfaceType = ntohl(*(bpf_u_int32 *)ptr);
615 				ptr += 4;													/* skip over the interface type */
616 
617 				flags = *ptr++;
618 				if (flags) iff->flags = PCAP_IF_LOOPBACK;					/* if this is a loopback style interface, lets mark it as such */
619 
620 				address_count = *ptr++;
621 
622 				prev_addr = 0;
623 				while (address_count--) {
624 					if ((addr = malloc(sizeof(pcap_addr_t))) == NULL) {
625 						snprintf(errbuf, PCAP_ERRBUF_SIZE, "malloc: %s", pcap_strerror(errno));
626 						return -1;
627 					}
628 +					memset((char *)addr, 0, sizeof(pcap_addr_t)); /* bzero() is deprecated, replaced with memset() */
629 					if (iff->addresses == 0) iff->addresses = addr;
630 					if (prev_addr) prev_addr->next = addr;							/* insert a forward link */
631 					if (*ptr) {														/* if there is a count for the address */
632 						if ((s = malloc(sizeof(struct sockaddr_in))) == NULL) {		/* get that amount of space */
633 							snprintf(errbuf, PCAP_ERRBUF_SIZE, "malloc: %s", pcap_strerror(errno));
634 							return -1;
635 						}
636 						memset((char *)s, 0, sizeof(struct sockaddr_in)); /* bzero() is deprecated, replaced with memset() */
637 						addr->addr = (struct sockaddr *)s;
638 						s->sin_family		= AF_INET;
639 						s->sin_addr.s_addr	= *(bpf_u_int32 *)(ptr + 1);			/* copy the address in */
640 						ptr += *ptr;										/* now move the pointer forwards according to the specified length of the address */
641 					}
642 					ptr++;													/* then forwards one more for the 'length of the address' field */
643 					if (*ptr) {												/* process any netmask */
644 						if ((s = malloc(sizeof(struct sockaddr_in))) == NULL) {
645 							snprintf(errbuf, PCAP_ERRBUF_SIZE, "malloc: %s", pcap_strerror(errno));
646 							return -1;
647 						}
648 						/* bzero() is deprecated, replaced with memset() */
649 						memset((char *)s, 0, sizeof(struct sockaddr_in));
650 
651 						addr->netmask = (struct sockaddr *)s;
652 						s->sin_family		= AF_INET;
653 						s->sin_addr.s_addr	= *(bpf_u_int32*)(ptr + 1);
654 						ptr += *ptr;
655 					}
656 					ptr++;
657 					if (*ptr) {												/* process any broadcast address */
658 						if ((s = malloc(sizeof(struct sockaddr_in))) == NULL) {
659 							snprintf(errbuf, PCAP_ERRBUF_SIZE, "malloc: %s", pcap_strerror(errno));
660 							return -1;
661 						}
662 						/* bzero() is deprecated, replaced with memset() */
663 						memset((char *)s, 0, sizeof(struct sockaddr_in));
664 
665 						addr->broadaddr = (struct sockaddr *)s;
666 						s->sin_family		= AF_INET;
667 						s->sin_addr.s_addr	= *(bpf_u_int32*)(ptr + 1);
668 						ptr += *ptr;
669 					}
670 					ptr++;
671 					if (*ptr) {												/* process any destination address */
672 						if ((s = malloc(sizeof(struct sockaddr_in))) == NULL) {
673 							snprintf(errbuf, PCAP_ERRBUF_SIZE, "malloc: %s", pcap_strerror(errno));
674 							return -1;
675 						}
676 						/* bzero() is deprecated, replaced with memset() */
677 						memset((char *)s, 0, sizeof(struct sockaddr_in));
678 
679 						addr->dstaddr = (struct sockaddr *)s;
680 						s->sin_family		= AF_INET;
681 						s->sin_addr.s_addr	= *(bpf_u_int32*)(ptr + 1);
682 						ptr += *ptr;
683 					}
684 					ptr++;
685 					prev_addr = addr;
686 				}
687 				prev_iff = iff;
688 
689 				newname = translate_IOP_to_pcap_name(u, iff->name, interfaceType);		/* add a translation entry and get a point to the mangled name */
690 				if ((iff->name = realloc(iff->name, strlen(newname) + 1)) == NULL) {	/* we now re-write the name stored in the interface list */
691 					snprintf(errbuf, PCAP_ERRBUF_SIZE, "realloc: %s", pcap_strerror(errno));
692 					return -1;
693 				}
694 				strcpy(iff->name, newname);												/* to this new name */
695 			}
696 		}
697 	}
698 	return 0;
699 }
700 
701 static int read_client_data (int fd) {
702 	unsigned char	buf[256];
703 	int				chassis, geoslot;
704 	unit_t			*u;
705 	int				len;
706 
707 	find_unit_by_fd(fd, &chassis, &geoslot, &u);
708 
709 	if ((len = recv(fd, buf, sizeof(buf), 0)) <= 0)	return 0;	/* read in whatever data was sent to us */
710 
711 	if ((u->imsg = realloc(u->imsg, (u->len + len))) == NULL)	/* extend the buffer for the new data */
712 		return 0;
713 	memcpy((u->imsg + u->len), buf, len);						/* append the new data */
714 	u->len += len;
715 	return 1;
716 }
717 
718 static void wait_for_all_answers(void) {
719 	int		retval;
720 	struct	timeval tv;
721 	int		fd;
722 	int		chassis, geoslot;
723 
724 	tv.tv_sec = 2;
725 	tv.tv_usec = 0;
726 
727 	while (1) {
728 		int flag = 0;
729 		fd_set working_set;
730 
731 		for (fd = 0; fd <= max_fs; fd++) {								/* scan the list of descriptors we may be listening to */
732 			if (FD_ISSET(fd, &readfds)) flag = 1;						/* and see if there are any still set */
733 		}
734 		if (flag == 0) return;											/* we are done, when they are all gone */
735 
736 		memcpy(&working_set, &readfds, sizeof(readfds));				/* otherwise, we still have to listen for more stuff, till we timeout */
737 		retval = select(max_fs + 1, &working_set, NULL, NULL, &tv);
738 		if (retval == -1) {												/* an error occured !!!!! */
739 			return;
740 		} else if (retval == 0) {										/* timeout occured, so process what we've got sofar and return */
741 			printf("timeout\n");
742 			return;
743 		} else {
744 			for (fd = 0; fd <= max_fs; fd++) {							/* scan the list of things to do, and do them */
745 				if (FD_ISSET(fd, &working_set)) {
746 					if (read_client_data(fd) == 0) {					/* if the socket has closed */
747 						FD_CLR(fd, &readfds);							/* and descriptors we listen to for errors */
748 						find_unit_by_fd(fd, &chassis, &geoslot, NULL);
749 						close_with_IOP(chassis, geoslot, FIND);			/* and close out connection to him */
750 					}
751 				}
752 			}
753 		}
754 	}
755 }
756 
757 static char *get_error_response(int fd, char *errbuf) {		/* return a pointer on error, NULL on no error */
758 	char	byte;
759 	int		len = 0;
760 
761 	while (1) {
762 		recv(fd, &byte, 1, 0);							/* read another byte in */
763 		if (errbuf && (len++ < PCAP_ERRBUF_SIZE)) {		/* and if there is still room in the buffer */
764 			*errbuf++ = byte;							/* stick it in */
765 			*errbuf = '\0';								/* ensure the string is null terminated just in case we might exceed the buffer's size */
766 		}
767 		if (byte == '\0') {
768 			if (len > 1)	{ return errbuf;	}
769 			else			{ return NULL;		}
770 		}
771 	}
772 }
773 
774 int acn_findalldevs(char *errbuf) {								/* returns: -1 = error, 0 = OK */
775 	int		chassis, geoslot;
776 	unit_t	*u;
777 
778 	FD_ZERO(&readfds);
779 	max_fs = 0;
780 	for (chassis = 0; chassis <= MAX_CHASSIS; chassis++) {
781 		for (geoslot = 0; geoslot <= MAX_GEOSLOT; geoslot++) {
782 			u = &units[chassis][geoslot];
783 			if (u->ip && (open_with_IOP(u, FIND))) {			/* connect to the remote IOP */
784 				send_to_fd(u->find_fd, 1, (unsigned char *)"\0");
785 				if (get_error_response(u->find_fd, errbuf))
786 					close_with_IOP(chassis, geoslot, FIND);
787 				else {
788 					if (u->find_fd > max_fs)
789 						max_fs = u->find_fd;								/* remember the highest number currently in use */
790 					FD_SET(u->find_fd, &readfds);						/* we are going to want to read this guy's response to */
791 					u->len = 0;
792 					send_to_fd(u->find_fd, 1, (unsigned char *)"Q");		/* this interface query request */
793 				}
794 			}
795 		}
796 	}
797 	wait_for_all_answers();
798 	if (process_client_data(errbuf))
799 		return -1;
800 	sort_if_table();
801 	return 0;
802 }
803 
804 static int pcap_stats_acn(pcap_t *handle, struct pcap_stat *ps) {
805 	unsigned char	buf[12];
806 
807 	send_to_fd(handle->fd, 1, (unsigned char *)"S");						/* send the get_stats command to the IOP */
808 
809 	if (read_client_nbytes(handle->fd, sizeof(buf), buf) == -1) return -1;	/* try reading the required bytes */
810 
811 	ps->ps_recv		= ntohl(*(uint32_t *)&buf[0]);							/* break the buffer into its three 32 bit components */
812 	ps->ps_drop		= ntohl(*(uint32_t *)&buf[4]);
813 	ps->ps_ifdrop	= ntohl(*(uint32_t *)&buf[8]);
814 
815 	return 0;
816 }
817 
818 static int acn_open_live(const char *name, char *errbuf, int *linktype) {		/* returns 0 on error, else returns the file descriptor */
819 	int			chassis, geoslot;
820 	unit_t		*u;
821 	iface_t		*p;
822 	pcap_if_t	*alldevsp;
823 
824 	pcap_findalldevs_interfaces(&alldevsp, errbuf);
825 	for (chassis = 0; chassis <= MAX_CHASSIS; chassis++) {										/* scan the table... */
826 		for (geoslot = 0; geoslot <= MAX_GEOSLOT; geoslot++) {
827 			u = &units[chassis][geoslot];
828 			if (u->ip != NULL) {
829 				p = u->iface;
830 				while (p) {																		/* and all interfaces... */
831 					if (p->IOPname && p->name && (strcmp(p->name, name) == 0)) {				/* and if we found the interface we want... */
832 						*linktype = p->iftype;
833 						open_with_IOP(u, LIVE);													/* start a connection with that IOP */
834 						send_to_fd(u->fd, strlen(p->IOPname)+1, (unsigned char *)p->IOPname);	/* send the IOP's interface name, and a terminating null */
835 						if (get_error_response(u->fd, errbuf)) {
836 							return -1;
837 						}
838 						return u->fd;															/* and return that open descriptor */
839 					}
840 					p = p->next;
841 				}
842 			}
843 		}
844 	}
845 	return -1;																				/* if the interface wasn't found, return an error */
846 }
847 
848 static void acn_start_monitor(int fd, int snaplen, int timeout, int promiscuous, int direction) {
849 	unsigned char	buf[8];
850 	unit_t			*u;
851 
852 	//printf("acn_start_monitor()\n");				// fulko
853 	find_unit_by_fd(fd, NULL, NULL, &u);
854 	if (u->first_time == 0) {
855 		buf[0]					= 'M';
856 		*(uint32_t *)&buf[1]	= htonl(snaplen);
857 		buf[5]					= timeout;
858 		buf[6]					= promiscuous;
859 		buf[7]					= direction;
860 	//printf("acn_start_monitor() first time\n");				// fulko
861 		send_to_fd(fd, 8, buf);								/* send the start monitor command with its parameters to the IOP */
862 		u->first_time = 1;
863 	}
864 	//printf("acn_start_monitor() complete\n");				// fulko
865 }
866 
867 static int pcap_inject_acn(pcap_t *p, const void *buf _U_, size_t size _U_) {
868 	strlcpy(p->errbuf, "Sending packets isn't supported on ACN adapters",
869 	    PCAP_ERRBUF_SIZE);
870 	return (-1);
871 }
872 
873 static int pcap_setfilter_acn(pcap_t *handle, struct bpf_program *bpf) {
874 	int				fd = handle->fd;
875 	int				count;
876 	struct bpf_insn	*p;
877 	uint16_t		shortInt;
878 	uint32_t		longInt;
879 
880 	send_to_fd(fd, 1, (unsigned char *)"F");			/* BPF filter follows command */
881 	count = bpf->bf_len;
882 	longInt = htonl(count);
883 	send_to_fd(fd, 4, (unsigned char *)&longInt);		/* send the instruction sequence count */
884 	p = bpf->bf_insns;
885 	while (count--) {									/* followed by the list of instructions */
886 		shortInt = htons(p->code);
887 		longInt = htonl(p->k);
888 		send_to_fd(fd, 2, (unsigned char *)&shortInt);
889 		send_to_fd(fd, 1, (unsigned char *)&p->jt);
890 		send_to_fd(fd, 1, (unsigned char *)&p->jf);
891 		send_to_fd(fd, 4, (unsigned char *)&longInt);
892 		p++;
893 	}
894 	if (get_error_response(fd, NULL))
895 		return -1;
896 	return 0;
897 }
898 
899 static int pcap_setdirection_acn(pcap_t *handle, pcap_direction_t d) {
900 	snprintf(handle->errbuf, sizeof(handle->errbuf),
901 	    "Setting direction is not supported on ACN adapters");
902 	return -1;
903 }
904 
905 static int acn_read_n_bytes_with_timeout(pcap_t *handle, int count) {
906 	struct		timeval tv;
907 	int			retval, fd;
908 	fd_set		r_fds;
909 	fd_set		w_fds;
910 	u_char		*bp;
911 	int			len = 0;
912 	int			offset = 0;
913 
914 	tv.tv_sec = 5;
915 	tv.tv_usec = 0;
916 
917 	fd = handle->fd;
918 	FD_ZERO(&r_fds);
919 	FD_SET(fd, &r_fds);
920 	memcpy(&w_fds, &r_fds, sizeof(r_fds));
921 	bp = handle->bp;
922 	while (count) {
923 		retval = select(fd + 1, &w_fds, NULL, NULL, &tv);
924 		if (retval == -1) {											/* an error occured !!!!! */
925 //			fprintf(stderr, "error during packet data read\n");
926 			return -1;												/* but we need to return a good indication to prevent unneccessary popups */
927 		} else if (retval == 0) {									/* timeout occured, so process what we've got sofar and return */
928 //			fprintf(stderr, "timeout during packet data read\n");
929 			return -1;
930 		} else {
931 			if ((len = recv(fd, (bp + offset), count, 0)) <= 0) {
932 //				fprintf(stderr, "premature exit during packet data rx\n");
933 				return -1;
934 			}
935 			count -= len;
936 			offset += len;
937 		}
938 	}
939 	return 0;
940 }
941 
942 static int pcap_read_acn(pcap_t *handle, int max_packets, pcap_handler callback, u_char *user) {
943 	#define HEADER_SIZE (4 * 4)
944 	unsigned char		packet_header[HEADER_SIZE];
945 	struct pcap_pkthdr	pcap_header;
946 
947 	//printf("pcap_read_acn()\n");			// fulko
948 	acn_start_monitor(handle->fd, handle->snapshot, handle->opt.timeout, handle->opt.promisc, handle->direction);	/* maybe tell him to start monitoring */
949 	//printf("pcap_read_acn() after start monitor\n");			// fulko
950 
951 	handle->bp = packet_header;
952 	if (acn_read_n_bytes_with_timeout(handle, HEADER_SIZE) == -1) return 0;			/* try to read a packet header in so we can get the sizeof the packet data */
953 
954 	pcap_header.ts.tv_sec	= ntohl(*(uint32_t *)&packet_header[0]);				/* tv_sec */
955 	pcap_header.ts.tv_usec	= ntohl(*(uint32_t *)&packet_header[4]);				/* tv_usec */
956 	pcap_header.caplen		= ntohl(*(uint32_t *)&packet_header[8]);				/* caplen */
957 	pcap_header.len			= ntohl(*(uint32_t *)&packet_header[12]);				/* len */
958 
959 	handle->bp = handle->buffer + handle->offset;									/* start off the receive pointer at the right spot */
960 	if (acn_read_n_bytes_with_timeout(handle, pcap_header.caplen) == -1) return 0;	/* then try to read in the rest of the data */
961 
962 	callback(user, &pcap_header, handle->bp);										/* call the user supplied callback function */
963 	return 1;
964 }
965 
966 static int pcap_activate_sita(pcap_t *handle) {
967 	int		fd;
968 
969 	if (handle->opt.rfmon) {
970 		/*
971 		 * No monitor mode on SITA devices (they're not Wi-Fi
972 		 * devices).
973 		 */
974 		return PCAP_ERROR_RFMON_NOTSUP;
975 	}
976 
977 	/* Initialize some components of the pcap structure. */
978 
979 	handle->inject_op = pcap_inject_acn;
980 	handle->setfilter_op = pcap_setfilter_acn;
981 	handle->setdirection_op = pcap_setdirection_acn;
982 	handle->set_datalink_op = NULL;	/* can't change data link type */
983 	handle->getnonblock_op = pcap_getnonblock_fd;
984 	handle->setnonblock_op = pcap_setnonblock_fd;
985 	handle->cleanup_op = pcap_cleanup_acn;
986 	handle->read_op = pcap_read_acn;
987 	handle->stats_op = pcap_stats_acn;
988 
989 	fd = acn_open_live(handle->opt.source, handle->errbuf,
990 	    &handle->linktype);
991 	if (fd == -1)
992 		return PCAP_ERROR;
993 	handle->fd = fd;
994 	handle->bufsize = handle->snapshot;
995 
996 	/* Allocate the buffer */
997 
998 	handle->buffer	 = malloc(handle->bufsize + handle->offset);
999 	if (!handle->buffer) {
1000 	        snprintf(handle->errbuf, PCAP_ERRBUF_SIZE,
1001 			 "malloc: %s", pcap_strerror(errno));
1002 		pcap_cleanup_acn(handle);
1003 		return PCAP_ERROR;
1004 	}
1005 
1006 	/*
1007 	 * "handle->fd" is a socket, so "select()" and "poll()"
1008 	 * should work on it.
1009 	 */
1010 	handle->selectable_fd = handle->fd;
1011 
1012 	return 0;
1013 }
1014 
1015 pcap_t *pcap_create_interface(const char *device, char *ebuf) {
1016 	pcap_t *p;
1017 
1018 	p = pcap_create_common(device, ebuf, 0);
1019 	if (p == NULL)
1020 		return (NULL);
1021 
1022 	p->activate_op = pcap_activate_sita;
1023 	return (p);
1024 }
1025