summaryrefslogtreecommitdiff
path: root/src/gsmd/select.c
blob: 9cd211e74109f7fce704cd8bf5a6658e3db40dc9 (plain)
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
/* select() FD handling for GSM Daemon.
 * (C) 2000-2006 by Harald Welte <laforge@gnumonks.org>
 *
 * Based on code originally written by myself for ulogd.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program 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 General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License along
 * with this program; if not, write to the Free Software Foundation, Inc.,
 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
 *
 */ 

#include <fcntl.h>
#include <common/linux_list.h>

#include "gsmd.h"

#include <gsmd/select.h>

static int maxfd = 0;
static LLIST_HEAD(gsmd_fds);

int gsmd_register_fd(struct gsmd_fd *fd)
{
	int flags;

	/* make FD nonblocking */
	flags = fcntl(fd->fd, F_GETFL);
	if (flags < 0)
		return -1;
	flags |= O_NONBLOCK;
	flags = fcntl(fd->fd, F_SETFL, flags);
	if (flags < 0)
		return -1;

	/* Register FD */
	if (fd->fd > maxfd)
		maxfd = fd->fd;

	llist_add_tail(&fd->list, &gsmd_fds);

	return 0;
}

void gsmd_unregister_fd(struct gsmd_fd *fd)
{
	llist_del(&fd->list);
}

int gsmd_select_main()
{
	struct gsmd_fd *ufd, *ufd2;
	fd_set readset, writeset, exceptset;
	int i;

	FD_ZERO(&readset);
	FD_ZERO(&writeset);
	FD_ZERO(&exceptset);

	/* prepare read and write fdsets */
	llist_for_each_entry(ufd, &gsmd_fds, list) {
		if (ufd->when & GSMD_FD_READ)
			FD_SET(ufd->fd, &readset);

		if (ufd->when & GSMD_FD_WRITE)
			FD_SET(ufd->fd, &writeset);

		if (ufd->when & GSMD_FD_EXCEPT)
			FD_SET(ufd->fd, &exceptset);
	}

	i = select(maxfd+1, &readset, &writeset, &exceptset, NULL);
	if (i > 0) {
		/* call registered callback functions */
		llist_for_each_entry_safe(ufd, ufd2, &gsmd_fds, list) {
			int flags = 0;

			if (FD_ISSET(ufd->fd, &readset))
				flags |= GSMD_FD_READ;

			if (FD_ISSET(ufd->fd, &writeset))
				flags |= GSMD_FD_WRITE;

			if (FD_ISSET(ufd->fd, &exceptset))
				flags |= GSMD_FD_EXCEPT;

			if (flags)
				ufd->cb(ufd->fd, flags, ufd->data);
		}
	}
	return i;
}
personal git repositories of Harald Welte. Your mileage may vary