AST-2009-005
[asterisk/asterisk.git] / main / netsock.c
1 /*
2  * Asterisk -- An open source telephony toolkit.
3  *
4  * Copyright (C) 1999 - 2005, Digium, Inc.
5  *
6  * Kevin P. Fleming <kpfleming@digium.com>
7  * Mark Spencer <markster@digium.com>
8  *
9  * See http://www.asterisk.org for more information about
10  * the Asterisk project. Please do not directly contact
11  * any of the maintainers of this project for assistance;
12  * the project provides a web site, mailing lists and IRC
13  * channels for your use.
14  *
15  * This program is free software, distributed under the terms of
16  * the GNU General Public License Version 2. See the LICENSE file
17  * at the top of the source tree.
18  */
19
20 /*! \file
21  *
22  * \brief Network socket handling
23  *
24  * \author Kevin P. Fleming <kpfleming@digium.com>
25  * \author Mark Spencer <markster@digium.com>
26  */
27
28 #include "asterisk.h"
29
30 ASTERISK_FILE_VERSION(__FILE__, "$Revision$")
31
32 #if defined(__OpenBSD__) || defined(__NetBSD__) || defined(__FreeBSD__) || defined(__Darwin__)
33 #include <net/if_dl.h>
34 #endif
35
36 #if defined (SOLARIS)
37 #include <sys/sockio.h>
38 #elif defined(HAVE_GETIFADDRS)
39 #include <ifaddrs.h>
40 #endif
41
42 #include "asterisk/netsock.h"
43 #include "asterisk/utils.h"
44 #include "asterisk/astobj.h"
45
46 struct ast_netsock {
47         ASTOBJ_COMPONENTS(struct ast_netsock);
48         struct sockaddr_in bindaddr;
49         int sockfd;
50         int *ioref;
51         struct io_context *ioc;
52         void *data;
53 };
54
55 struct ast_netsock_list {
56         ASTOBJ_CONTAINER_COMPONENTS(struct ast_netsock);
57         struct io_context *ioc;
58 };
59
60 static void ast_netsock_destroy(struct ast_netsock *netsock)
61 {
62         ast_io_remove(netsock->ioc, netsock->ioref);
63         close(netsock->sockfd);
64         ast_free(netsock);
65 }
66
67 struct ast_netsock_list *ast_netsock_list_alloc(void)
68 {
69         return ast_calloc(1, sizeof(struct ast_netsock_list));
70 }
71
72 int ast_netsock_init(struct ast_netsock_list *list)
73 {
74         memset(list, 0, sizeof(*list));
75         ASTOBJ_CONTAINER_INIT(list);
76
77         return 0;
78 }
79
80 int ast_netsock_release(struct ast_netsock_list *list)
81 {
82         ASTOBJ_CONTAINER_DESTROYALL(list, ast_netsock_destroy);
83         ASTOBJ_CONTAINER_DESTROY(list);
84
85         return 0;
86 }
87
88 struct ast_netsock *ast_netsock_find(struct ast_netsock_list *list,
89                                      struct sockaddr_in *sa)
90 {
91         struct ast_netsock *sock = NULL;
92
93         ASTOBJ_CONTAINER_TRAVERSE(list, !sock, {
94                 ASTOBJ_RDLOCK(iterator);
95                 if (!inaddrcmp(&iterator->bindaddr, sa))
96                         sock = iterator;
97                 ASTOBJ_UNLOCK(iterator);
98         });
99
100         return sock;
101 }
102
103 struct ast_netsock *ast_netsock_bindaddr(struct ast_netsock_list *list, struct io_context *ioc, struct sockaddr_in *bindaddr, int tos, int cos, ast_io_cb callback, void *data)
104 {
105         int netsocket = -1;
106         int *ioref;
107         
108         struct ast_netsock *ns;
109         const int reuseFlag = 1;
110         
111         /* Make a UDP socket */
112         netsocket = socket(AF_INET, SOCK_DGRAM, IPPROTO_IP);
113         
114         if (netsocket < 0) {
115                 ast_log(LOG_ERROR, "Unable to create network socket: %s\n", strerror(errno));
116                 return NULL;
117         }
118         if (setsockopt(netsocket, SOL_SOCKET, SO_REUSEADDR, (char *)&reuseFlag, sizeof reuseFlag) < 0) {
119                         ast_log(LOG_WARNING, "Error setting SO_REUSEADDR on sockfd '%d'\n", netsocket);
120         }
121         if (bind(netsocket,(struct sockaddr *)bindaddr, sizeof(struct sockaddr_in))) {
122                 ast_log(LOG_ERROR, "Unable to bind to %s port %d: %s\n", ast_inet_ntoa(bindaddr->sin_addr), ntohs(bindaddr->sin_port), strerror(errno));
123                 close(netsocket);
124                 return NULL;
125         }
126
127         ast_netsock_set_qos(netsocket, tos, cos, "IAX2");
128                 
129         ast_enable_packet_fragmentation(netsocket);
130
131         if (!(ns = ast_calloc(1, sizeof(*ns)))) {
132                 close(netsocket);
133                 return NULL;
134         }
135         
136         /* Establish I/O callback for socket read */
137         if (!(ioref = ast_io_add(ioc, netsocket, callback, AST_IO_IN, ns))) {
138                 close(netsocket);
139                 ast_free(ns);
140                 return NULL;
141         }       
142         ASTOBJ_INIT(ns);
143         ns->ioref = ioref;
144         ns->ioc = ioc;
145         ns->sockfd = netsocket;
146         ns->data = data;
147         memcpy(&ns->bindaddr, bindaddr, sizeof(ns->bindaddr));
148         ASTOBJ_CONTAINER_LINK(list, ns);
149
150         return ns;
151 }
152
153 int ast_netsock_set_qos(int netsocket, int tos, int cos, const char *desc)
154 {
155         int res;
156         
157         if ((res = setsockopt(netsocket, IPPROTO_IP, IP_TOS, &tos, sizeof(tos))))
158                 ast_log(LOG_WARNING, "Unable to set %s TOS to %d, may be you have no root privileges\n", desc, tos);
159         else if (tos)
160                 ast_verb(2, "Using %s TOS bits %d\n", desc, tos);
161
162 #if defined(linux)                                                              
163         if (setsockopt(netsocket, SOL_SOCKET, SO_PRIORITY, &cos, sizeof(cos)))
164                 ast_log(LOG_WARNING, "Unable to set %s CoS to %d\n", desc, cos);
165         else if (cos)
166                 ast_verb(2, "Using %s CoS mark %d\n", desc, cos);
167 #endif
168                                                         
169         return res;
170 }
171                                                                                                         
172
173 struct ast_netsock *ast_netsock_bind(struct ast_netsock_list *list, struct io_context *ioc, const char *bindinfo, int defaultport, int tos, int cos, ast_io_cb callback, void *data)
174 {
175         struct sockaddr_in sin;
176         char *tmp;
177         char *host;
178         char *port;
179         int portno;
180
181         memset(&sin, 0, sizeof(sin));
182         sin.sin_family = AF_INET;
183         sin.sin_port = htons(defaultport);
184         tmp = ast_strdupa(bindinfo);
185
186         host = strsep(&tmp, ":");
187         port = tmp;
188
189         if (port && ((portno = atoi(port)) > 0))
190                 sin.sin_port = htons(portno);
191
192         inet_aton(host, &sin.sin_addr);
193
194         return ast_netsock_bindaddr(list, ioc, &sin, tos, cos, callback, data);
195 }
196
197 int ast_netsock_sockfd(const struct ast_netsock *ns)
198 {
199         return ns ? ns-> sockfd : -1;
200 }
201
202 const struct sockaddr_in *ast_netsock_boundaddr(const struct ast_netsock *ns)
203 {
204         return &(ns->bindaddr);
205 }
206
207 void *ast_netsock_data(const struct ast_netsock *ns)
208 {
209         return ns->data;
210 }
211
212 void ast_netsock_unref(struct ast_netsock *ns)
213 {
214         ASTOBJ_UNREF(ns, ast_netsock_destroy);
215 }
216
217 char *ast_eid_to_str(char *s, int maxlen, struct ast_eid *eid)
218 {
219         int x;
220         char *os = s;
221         if (maxlen < 18) {
222                 if (s && (maxlen > 0))
223                         *s = '\0';
224         } else {
225                 for (x = 0; x < 5; x++) {
226                         sprintf(s, "%02x:", eid->eid[x]);
227                         s += 3;
228                 }
229                 sprintf(s, "%02x", eid->eid[5]);
230         }
231         return os;
232 }
233
234 void ast_set_default_eid(struct ast_eid *eid)
235 {
236 #if defined(SIOCGIFHWADDR)
237         int s, x = 0;
238         char eid_str[20];
239         struct ifreq ifr;
240
241         s = socket(AF_INET, SOCK_STREAM, 0);
242         if (s < 0)
243                 return;
244         for (x = 0; x < 10; x++) {
245                 memset(&ifr, 0, sizeof(ifr));
246                 snprintf(ifr.ifr_name, sizeof(ifr.ifr_name), "eth%d", x);
247                 if (ioctl(s, SIOCGIFHWADDR, &ifr))
248                         continue;
249                 memcpy(eid, ((unsigned char *)&ifr.ifr_hwaddr) + 2, sizeof(*eid));
250                 ast_debug(1, "Seeding global EID '%s' from '%s' using 'siocgifhwaddr'\n", ast_eid_to_str(eid_str, sizeof(eid_str), eid), ifr.ifr_name);
251                 close(s);
252                 return;
253         }
254         close(s);
255 #else
256 #if defined(ifa_broadaddr) && !defined(SOLARIS)
257         char eid_str[20];
258         struct ifaddrs *ifap;
259         
260         if (getifaddrs(&ifap) == 0) {
261                 struct ifaddrs *p;
262                 for (p = ifap; p; p = p->ifa_next) {
263                         if ((p->ifa_addr->sa_family == AF_LINK) && !(p->ifa_flags & IFF_LOOPBACK) && (p->ifa_flags & IFF_RUNNING)) {
264                                 struct sockaddr_dl* sdp = (struct sockaddr_dl*) p->ifa_addr;
265                                 memcpy(&(eid->eid), sdp->sdl_data + sdp->sdl_nlen, 6);
266                                 ast_debug(1, "Seeding global EID '%s' from '%s' using 'getifaddrs'\n", ast_eid_to_str(eid_str, sizeof(eid_str), eid), p->ifa_name);
267                                 freeifaddrs(ifap);
268                                 return;
269                         }
270                 }
271                 freeifaddrs(ifap);
272         }
273 #endif
274 #endif
275         ast_debug(1, "No ethernet interface found for seeding global EID. You will have to set it manually.\n");
276 }
277
278 int ast_str_to_eid(struct ast_eid *eid, const char *s)
279 {
280         unsigned int eid_int[6];
281         int x;
282
283         if (sscanf(s, "%2x:%2x:%2x:%2x:%2x:%2x", &eid_int[0], &eid_int[1], &eid_int[2],
284                  &eid_int[3], &eid_int[4], &eid_int[5]) != 6)
285                         return -1;
286         
287         for (x = 0; x < 6; x++)
288                 eid->eid[x] = eid_int[x];
289
290         return 0;
291 }
292
293 int ast_eid_cmp(const struct ast_eid *eid1, const struct ast_eid *eid2)
294 {
295         return memcmp(eid1, eid2, sizeof(*eid1));
296 }