75dabfd1067bf9c225ad0f39321e2e2d63d80120
[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
43 #include "socket_parser.h"
44 #include "scheduler.h"
45 #include "olsr.h"
46 #include "defs.h"
47 #include "log.h"
48 #include "net_os.h"
49
50 #include <errno.h>
51 #include <stdlib.h>
52
53
54 #ifdef WIN32
55 #undef EINTR
56 #define EINTR WSAEINTR
57 #undef errno
58 #define errno WSAGetLastError()
59 #undef strerror
60 #define strerror(x) StrError(x)
61 #endif
62
63
64 struct olsr_socket_entry *olsr_socket_entries;
65
66 /**
67  * Add a socket and handler to the socketset
68  * beeing used in the main select(2) loop
69  * in listen_loop
70  *
71  *@param fd the socket
72  *@param pf the processing function
73  */
74 void
75 add_olsr_socket(int fd, socket_handler_func  pf)
76 {
77   struct olsr_socket_entry *new_entry;
78
79   if (fd == 0 || pf == NULL) {
80     fprintf(stderr, "Bogus socket entry - not registering...\n");
81     return;
82   }
83   OLSR_PRINTF(2, "Adding OLSR socket entry %d\n", fd);
84
85   new_entry = olsr_malloc(sizeof(struct olsr_socket_entry), "Socket entry");
86
87   new_entry->fd = fd;
88   new_entry->process_function = pf;
89
90   /* Queue */
91   new_entry->next = olsr_socket_entries;
92   olsr_socket_entries = new_entry;
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, socket_handler_func pf)
105 {
106   struct olsr_socket_entry *entry, *prev_entry;
107
108   if (fd == 0 || pf == NULL) {
109     olsr_syslog(OLSR_LOG_ERR, "Bogus socket entry - not processing...\n");
110     return 0;
111   }
112   OLSR_PRINTF(1, "Removing OLSR socket entry %d\n", fd);
113
114   for (entry = olsr_socket_entries, prev_entry = NULL;
115        entry != NULL;
116        prev_entry = entry, entry = entry->next) {
117     if (entry->fd == fd && entry->process_function == pf) {
118       if (prev_entry == NULL) {
119         olsr_socket_entries = entry->next;
120       } else {
121         prev_entry->next = entry->next;
122       }
123       free(entry);
124       return 1;
125     }
126   }
127   return 0;
128 }
129
130
131 void
132 olsr_poll_sockets(void)
133 {
134   int n;
135   struct olsr_socket_entry *olsr_sockets;
136   fd_set ibits;
137   struct timeval tvp = { 0, 0 };
138   int hfd = 0;
139   const char * err_msg;
140   /* If there are no registered sockets we
141    * do not call select(2)
142    */
143   if (olsr_socket_entries == NULL) {
144     return;
145   }
146
147   FD_ZERO(&ibits);
148   
149   /* Adding file-descriptors to FD set */
150   for (olsr_sockets = olsr_socket_entries; olsr_sockets; olsr_sockets = olsr_sockets->next) {
151     FD_SET((unsigned int)olsr_sockets->fd, &ibits); /* And we cast here since we get a warning on Win32 */    
152     if (olsr_sockets->fd >= hfd) {
153       hfd = olsr_sockets->fd + 1;
154     }
155   }
156       
157   /* Running select on the FD set */
158   do {
159     n = olsr_select(hfd, &ibits, NULL, NULL, &tvp);
160   } while (n == -1 && errno == EINTR);
161
162   switch (n) {
163   case 0:
164     break;
165
166     /* Did somethig go wrong? */
167   case -1: 
168     err_msg = strerror(errno);
169     olsr_syslog(OLSR_LOG_ERR, "select: %s", err_msg);
170     OLSR_PRINTF(1, "Error select: %s", err_msg);
171     break;
172     
173   default:
174     /* Update time since this is much used by the parsing functions */
175     now_times = olsr_times();
176     for (olsr_sockets = olsr_socket_entries;olsr_sockets;olsr_sockets = olsr_sockets->next) {
177       if (FD_ISSET(olsr_sockets->fd, &ibits)) {
178         olsr_sockets->process_function(olsr_sockets->fd);
179       }
180     }
181     break;
182   }
183 }
184
185 /*
186  * Local Variables:
187  * c-basic-offset: 2
188  * End:
189  */