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