Merge branch 'stable' into niit
[olsrd.git] / src / socket_parser.c
1
2 /*
3  * The olsr.org Optimized Link-State Routing daemon(olsrd)
4  * Copyright (c) 2004, Andreas Tonnesen(andreto@olsr.org)
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  *
11  * * Redistributions of source code must retain the above copyright
12  *   notice, this list of conditions and the following disclaimer.
13  * * Redistributions in binary form must reproduce the above copyright
14  *   notice, this list of conditions and the following disclaimer in
15  *   the documentation and/or other materials provided with the
16  *   distribution.
17  * * Neither the name of olsr.org, olsrd nor the names of its
18  *   contributors may be used to endorse or promote products derived
19  *   from this software without specific prior written permission.
20  *
21  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
22  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
23  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
24  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
25  * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
26  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
27  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
28  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
29  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
31  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
32  * POSSIBILITY OF SUCH DAMAGE.
33  *
34  * Visit http://www.olsr.org for more information.
35  *
36  * If you find this software useful feel free to make a donation
37  * to the project. For more information see the website or contact
38  * the copyright holders.
39  *
40  */
41
42 #include <unistd.h>
43 #include "socket_parser.h"
44 #include "olsr.h"
45 #include "defs.h"
46 #include "log.h"
47 #include "net_os.h"
48
49 #ifdef WIN32
50 #undef EINTR
51 #define EINTR WSAEINTR
52 #undef errno
53 #define errno WSAGetLastError()
54 #undef strerror
55 #define strerror(x) StrError(x)
56 #endif
57
58 struct olsr_socket_entry *olsr_socket_entries;
59
60 static int hfd = 0;
61
62 /**
63  * Add a socket and handler to the socketset
64  * beeing used in the main select(2) loop
65  * in listen_loop
66  *
67  *@param fd the socket
68  *@param pf the processing function
69  */
70 void
71 add_olsr_socket(int fd, void (*pf) (int fd))
72 {
73   struct olsr_socket_entry *new_entry;
74
75   if ((fd == 0) || (pf == NULL)) {
76     fprintf(stderr, "Bogus socket entry - not registering...\n");
77     return;
78   }
79   OLSR_PRINTF(2, "Adding OLSR socket entry %d\n", fd);
80
81   new_entry = olsr_malloc(sizeof(struct olsr_socket_entry), "Socket entry");
82
83   new_entry->fd = fd;
84   new_entry->process_function = pf;
85
86   /* Queue */
87   new_entry->next = olsr_socket_entries;
88   olsr_socket_entries = new_entry;
89
90   if (fd + 1 > hfd)
91     hfd = fd + 1;
92 }
93
94 /**
95  * Remove a socket and handler to the socketset
96  * beeing used in the main select(2) loop
97  * in listen_loop
98  *
99  *@param fd the socket
100  *@param pf the processing function
101  */
102 int
103 remove_olsr_socket(int fd, void (*pf) (int))
104 {
105   struct olsr_socket_entry *entry, *prev_entry;
106
107   if ((fd == 0) || (pf == NULL)) {
108     olsr_syslog(OLSR_LOG_ERR, "Bogus socket entry - not processing...\n");
109     return 0;
110   }
111   OLSR_PRINTF(1, "Removing OLSR socket entry %d\n", fd);
112
113   entry = olsr_socket_entries;
114   prev_entry = NULL;
115
116   while (entry) {
117     if ((entry->fd == fd) && (entry->process_function == pf)) {
118       if (prev_entry == NULL) {
119         olsr_socket_entries = entry->next;
120         free(entry);
121       } else {
122         prev_entry->next = entry->next;
123         free(entry);
124       }
125
126       if (hfd == fd + 1) {
127         /* Re-calculate highest FD */
128         entry = olsr_socket_entries;
129         hfd = 0;
130         while (entry) {
131           if (entry->fd + 1 > hfd)
132             hfd = entry->fd + 1;
133           entry = entry->next;
134         }
135       }
136       return 1;
137     }
138     prev_entry = entry;
139     entry = entry->next;
140   }
141
142   return 0;
143 }
144
145 void
146 olsr_poll_sockets(void)
147 {
148   int n;
149   struct olsr_socket_entry *olsr_sockets;
150   fd_set ibits;
151   struct timeval tvp = { 0, 0 };
152
153   /* If there are no registered sockets we
154    * do not call select(2)
155    */
156   if (hfd == 0)
157     return;
158
159   FD_ZERO(&ibits);
160
161   /* Adding file-descriptors to FD set */
162
163   for (olsr_sockets = olsr_socket_entries; olsr_sockets; olsr_sockets = olsr_sockets->next) {
164     /* And we cast here since we get a warning on Win32 */
165     FD_SET((unsigned int)olsr_sockets->fd, &ibits);
166   }
167
168   /* Runnig select on the FD set */
169   n = olsr_select(hfd, &ibits, NULL, NULL, &tvp);
170
171   if (n == 0)
172     return;
173   /* Did somethig go wrong? */
174   if (n < 0) {
175     if (errno != EINTR) {
176       const char *const err_msg = strerror(errno);
177       olsr_syslog(OLSR_LOG_ERR, "select: %s", err_msg);
178       OLSR_PRINTF(1, "Error select: %s", err_msg);
179     }
180     return;
181   }
182
183   /* Update time since this is much used by the parsing functions */
184   now_times = olsr_times();
185
186   for (olsr_sockets = olsr_socket_entries; olsr_sockets; olsr_sockets = olsr_sockets->next) {
187     if (FD_ISSET(olsr_sockets->fd, &ibits))
188       olsr_sockets->process_function(olsr_sockets->fd);
189   }
190 }
191
192 /*
193  * Local Variables:
194  * c-basic-offset: 2
195  * indent-tabs-mode: nil
196  * End:
197  */