582245e2e125f9b953de1a2ddea1befdc6586dc8
[olsrd.git] / src / unix / ifnet.c
1
2 /*
3  * The olsr.org Optimized Link-State Routing daemon(olsrd)
4  * Copyright (c) 2004-2009, the olsr.org team - see HISTORY file
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
43 #if defined __FreeBSD__ || defined __MacOSX__ || defined __NetBSD__ || defined __OpenBSD__
44 #define ifr_netmask ifr_addr
45 #endif
46
47 #include "ifnet.h"
48 #include "ipcalc.h"
49 #include "interfaces.h"
50 #include "defs.h"
51 #include "olsr.h"
52 #include "net_os.h"
53 #include "net_olsr.h"
54 #include "parser.h"
55 #include "scheduler.h"
56 #include "generate_msg.h"
57 #include "mantissa.h"
58 #include "lq_packet.h"
59 #include "log.h"
60 #include "link_set.h"
61 #include "../common/string.h"
62
63 #include <signal.h>
64 #include <sys/types.h>
65 #include <net/if.h>
66 #include <net/if_arp.h>
67 #include <netinet/in_systm.h>
68 #include <netinet/ip.h>
69 #include <arpa/inet.h>
70 #include <netdb.h>
71 #include <unistd.h>
72 #include <errno.h>
73
74 #define BUFSPACE  (127*1024)    /* max. input buffer size to request */
75
76 #if 0
77 int
78 set_flag(char *ifname, short flag __attribute__ ((unused)))
79 {
80   struct ifreq ifr;
81
82   /* Get flags */
83   strscpy(ifr.ifr_name, ifname, sizeof(ifr.ifr_name));
84   if (ioctl(olsr_cnf->ioctl_s, SIOCGIFFLAGS, &ifr) < 0) {
85     fprintf(stderr, "ioctl (get interface flags)");
86     return -1;
87   }
88
89   strscpy(ifr.ifr_name, ifname, sizeof(ifr.ifr_name));
90   //printf("Setting flags for if \"%s\"\n", ifr.ifr_name);
91   if ((ifr.ifr_flags & (IFF_UP | IFF_RUNNING)) == 0) {
92     /* Add UP */
93     ifr.ifr_flags |= (IFF_UP | IFF_RUNNING);
94     /* Set flags + UP */
95     if (ioctl(olsr_cnf->ioctl_s, SIOCSIFFLAGS, &ifr) < 0) {
96       fprintf(stderr, "ERROR(%s): %s\n", ifr.ifr_name, strerror(errno));
97       return -1;
98     }
99   }
100   return 1;
101 }
102 #endif
103
104 /**
105  * Checks if an initialized interface is changed
106  * that is if it has been set down or the address
107  * has been changed.
108  *
109  *@param iface the olsr_if_config struct describing the interface
110  */
111 int
112 chk_if_changed(struct olsr_if_config *iface)
113 {
114 #if !defined REMOVE_LOG_DEBUG || !defined REMOVE_LOG_INFO
115   struct ipaddr_str buf;
116 #endif
117   struct interface *ifp;
118   struct ifreq ifr;
119   int if_changes = 0;
120
121   OLSR_DEBUG(LOG_INTERFACE, "Checking if %s is set down or changed\n", iface->name);
122
123   ifp = iface->interf;
124   if (!ifp) {
125     return 0;
126   }
127
128   memset(&ifr, 0, sizeof(ifr));
129   strscpy(ifr.ifr_name, iface->name, sizeof(ifr.ifr_name));
130   /* Get flags (and check if interface exists) */
131   if (ioctl(olsr_cnf->ioctl_s, SIOCGIFFLAGS, &ifr) < 0) {
132     OLSR_WARN(LOG_INTERFACE, "No such interface: %s\n", iface->name);
133     remove_interface(&iface->interf);
134     return 0;
135   }
136   ifp->int_flags = ifr.ifr_flags;
137
138   /*
139    * First check if the interface is set DOWN
140    */
141   if ((ifp->int_flags & IFF_UP) == 0) {
142     OLSR_DEBUG(LOG_INTERFACE, "\tInterface %s not up - removing it...\n", iface->name);
143     remove_interface(&iface->interf);
144     return 0;
145   }
146
147   /*
148    * We do all the interface type checks over.
149    * This is because the interface might be a PCMCIA card. Therefore
150    * it might not be the same physical interface as we configured earlier.
151    */
152
153   /* Check broadcast */
154   if (olsr_cnf->ip_version == AF_INET && !iface->cnf->ipv4_broadcast.v4.s_addr &&       /* Skip if fixed bcast */
155       ((ifp->int_flags & IFF_BROADCAST)) == 0) {
156     OLSR_DEBUG(LOG_INTERFACE, "\tNo broadcast - removing\n");
157     remove_interface(&iface->interf);
158     return 0;
159   }
160
161   if (ifp->int_flags & IFF_LOOPBACK) {
162     OLSR_DEBUG(LOG_INTERFACE, "\tThis is a loopback interface - removing it...\n");
163     remove_interface(&iface->interf);
164     return 0;
165   }
166
167   ifp->is_hcif = false;
168
169   /* trying to detect if interface is wireless. */
170   ifp->is_wireless = check_wireless_interface(ifr.ifr_name);
171
172   /* Set interface metric */
173   ifp->int_metric = iface->cnf->weight.fixed ? iface->cnf->weight.value : calculate_if_metric(ifr.ifr_name);
174
175   /* Get MTU */
176   if (ioctl(olsr_cnf->ioctl_s, SIOCGIFMTU, &ifr) < 0) {
177     ifp->int_mtu = 0;
178   } else {
179     ifr.ifr_mtu -= olsr_cnf->ip_version == AF_INET6 ? UDP_IPV6_HDRSIZE : UDP_IPV4_HDRSIZE;
180     if (ifp->int_mtu != ifr.ifr_mtu) {
181       ifp->int_mtu = ifr.ifr_mtu;
182       /* Create new outputbuffer */
183       net_remove_buffer(ifp);   /* Remove old */
184       net_add_buffer(ifp);
185     }
186   }
187
188   /* Get interface index */
189   ifp->if_index = if_nametoindex(ifr.ifr_name);
190
191   /*
192    * Now check if the IP has changed
193    */
194
195   /* IP version 6 */
196   if (olsr_cnf->ip_version == AF_INET6) {
197     struct sockaddr_in6 tmp_saddr6;
198
199     /* Get interface address */
200     if (get_ipv6_address(ifr.ifr_name, &tmp_saddr6, iface->cnf->ipv6_addrtype) <= 0) {
201       if (iface->cnf->ipv6_addrtype == OLSR_IP6T_SITELOCAL)
202         OLSR_WARN(LOG_INTERFACE, "\tCould not find site-local IPv6 address for %s\n", ifr.ifr_name);
203       else if (iface->cnf->ipv6_addrtype == OLSR_IP6T_UNIQUELOCAL)
204         OLSR_WARN(LOG_INTERFACE, "\tCould not find unique-local IPv6 address for %s\n", ifr.ifr_name);
205       else if (iface->cnf->ipv6_addrtype == OLSR_IP6T_GLOBAL)
206         OLSR_WARN(LOG_INTERFACE, "\tCould not find global IPv6 address for %s\n", ifr.ifr_name);
207       else
208         OLSR_WARN(LOG_INTERFACE, "\tCould not find an IPv6 address for %s\n", ifr.ifr_name);
209       remove_interface(&iface->interf);
210       return 0;
211     }
212
213     OLSR_DEBUG(LOG_INTERFACE, "\tAddress: %s\n", ip6_to_string(&buf, &tmp_saddr6.sin6_addr));
214
215     if (ip6cmp(&tmp_saddr6.sin6_addr, &ifp->int6_addr.sin6_addr) != 0) {
216       OLSR_DEBUG(LOG_INTERFACE, "New IP address for %s:\n"
217                  "\tOld: %s\n\tNew: %s\n",
218                  ifr.ifr_name, ip6_to_string(&buf, &ifp->int6_addr.sin6_addr), ip6_to_string(&buf, &tmp_saddr6.sin6_addr));
219
220       /* Check main addr */
221       if (!olsr_cnf->fixed_origaddr && ip6cmp(&olsr_cnf->router_id.v6, &tmp_saddr6.sin6_addr) != 0) {
222         /* Update main addr */
223         olsr_cnf->router_id.v6 = tmp_saddr6.sin6_addr;
224       }
225
226       /* Update address */
227       ifp->int6_addr.sin6_addr = tmp_saddr6.sin6_addr;
228       ifp->ip_addr.v6 = tmp_saddr6.sin6_addr;
229
230       if_changes = 1;
231     }
232   } else {
233     /* IP version 4 */
234     const struct sockaddr_in *tmp_saddr4 = (struct sockaddr_in *)&ifr.ifr_addr;
235
236     /* Check interface address (IPv4) */
237     if (ioctl(olsr_cnf->ioctl_s, SIOCGIFADDR, &ifr) < 0) {
238       OLSR_DEBUG(LOG_INTERFACE, "\tCould not get address of interface - removing it\n");
239       remove_interface(&iface->interf);
240       return 0;
241     }
242
243     OLSR_DEBUG(LOG_INTERFACE, "\tAddress:%s\n", ip4_to_string(&buf, ifp->int_addr.sin_addr));
244
245     if (ip4cmp(&ifp->int_addr.sin_addr, &tmp_saddr4->sin_addr) != 0) {
246       /* New address */
247       OLSR_DEBUG(LOG_INTERFACE, "IPv4 address changed for %s\n"
248                  "\tOld:%s\n\tNew:%s\n",
249                  ifr.ifr_name, ip4_to_string(&buf, ifp->int_addr.sin_addr), ip4_to_string(&buf, tmp_saddr4->sin_addr));
250
251       ifp->int_addr = *(struct sockaddr_in *)&ifr.ifr_addr;
252       if (!olsr_cnf->fixed_origaddr && ip4cmp(&olsr_cnf->router_id.v4, &ifp->ip_addr.v4) == 0) {
253         OLSR_INFO(LOG_INTERFACE, "New main address: %s\n", ip4_to_string(&buf, tmp_saddr4->sin_addr));
254         olsr_cnf->router_id.v4 = tmp_saddr4->sin_addr;
255       }
256
257       ifp->ip_addr.v4 = tmp_saddr4->sin_addr;
258
259       if_changes = 1;
260     }
261
262     /* Check netmask */
263     if (ioctl(olsr_cnf->ioctl_s, SIOCGIFNETMASK, &ifr) < 0) {
264       OLSR_WARN(LOG_INTERFACE, "%s: ioctl (get broadaddr) failed", ifr.ifr_name);
265       remove_interface(&iface->interf);
266       return 0;
267     }
268
269     OLSR_DEBUG(LOG_INTERFACE, "\tNetmask:%s\n", ip4_to_string(&buf, ((struct sockaddr_in *)&ifr.ifr_netmask)->sin_addr));
270
271     if (ip4cmp(&ifp->int_netmask.sin_addr, &((struct sockaddr_in *)&ifr.ifr_netmask)->sin_addr) != 0) {
272       /* New address */
273       OLSR_DEBUG(LOG_INTERFACE, "IPv4 netmask changed for %s\n"
274                  "\tOld:%s\n\tNew:%s\n",
275                  ifr.ifr_name,
276                  ip4_to_string(&buf, ifp->int_netmask.sin_addr),
277                  ip4_to_string(&buf, ((struct sockaddr_in *)&ifr.ifr_netmask)->sin_addr));
278
279       ifp->int_netmask = *(struct sockaddr_in *)&ifr.ifr_netmask;
280
281       if_changes = 1;
282     }
283
284     if (!iface->cnf->ipv4_broadcast.v4.s_addr) {
285       /* Check broadcast address */
286       if (ioctl(olsr_cnf->ioctl_s, SIOCGIFBRDADDR, &ifr) < 0) {
287         OLSR_WARN(LOG_INTERFACE, "%s: ioctl (get broadaddr) failed", ifr.ifr_name);
288         return 0;
289       }
290
291       OLSR_DEBUG(LOG_INTERFACE, "\tBroadcast address:%s\n",
292                  ip4_to_string(&buf, ((struct sockaddr_in *)&ifr.ifr_broadaddr)->sin_addr));
293
294       if (ifp->int_broadaddr.sin_addr.s_addr != ((struct sockaddr_in *)&ifr.ifr_broadaddr)->sin_addr.s_addr) {
295         /* New address */
296         OLSR_DEBUG(LOG_INTERFACE, "IPv4 broadcast changed for %s\n"
297                    "\tOld:%s\n\tNew:%s\n",
298                    ifr.ifr_name,
299                    ip4_to_string(&buf, ifp->int_broadaddr.sin_addr),
300                    ip4_to_string(&buf, ((struct sockaddr_in *)&ifr.ifr_broadaddr)->sin_addr));
301
302         ifp->int_broadaddr = *(struct sockaddr_in *)&ifr.ifr_broadaddr;
303         if_changes = 1;
304       }
305     }
306   }
307   if (if_changes) {
308     run_ifchg_cbs(ifp, IFCHG_IF_UPDATE);
309   }
310   return if_changes;
311 }
312
313 /**
314  * Initializes the special interface used in
315  * host-client emulation
316  */
317 int
318 add_hemu_if(struct olsr_if_config *iface)
319 {
320   struct interface *ifp;
321   uint32_t addr[4];
322 #if !defined REMOVE_LOG_INFO
323   struct ipaddr_str buf;
324 #endif
325   size_t name_size;
326
327   ifp = olsr_cookie_malloc(interface_mem_cookie);
328
329   iface->interf = ifp;
330   lock_interface(iface->interf);
331
332   name_size = strlen("hcif01") + 1;
333   ifp->is_hcif = true;
334   ifp->int_name = olsr_malloc(name_size, "Interface update 3");
335   ifp->int_metric = 0;
336
337   strscpy(ifp->int_name, "hcif01", name_size);
338
339   OLSR_INFO(LOG_INTERFACE, "Adding %s (host emulation) with address %s\n",
340             ifp->int_name, olsr_ip_to_string(&buf, &iface->hemu_ip));
341
342   /* Queue */
343   list_add_before(&interface_head, &ifp->int_node);
344
345   if (!olsr_cnf->fixed_origaddr && olsr_ipcmp(&all_zero, &olsr_cnf->router_id) == 0) {
346     olsr_cnf->router_id = iface->hemu_ip;
347     OLSR_INFO(LOG_INTERFACE, "New main address: %s\n", olsr_ip_to_string(&buf, &olsr_cnf->router_id));
348   }
349
350   ifp->int_mtu = OLSR_DEFAULT_MTU - (olsr_cnf->ip_version == AF_INET6 ? UDP_IPV6_HDRSIZE : UDP_IPV4_HDRSIZE);
351
352   /* Set up buffer */
353   net_add_buffer(ifp);
354
355   if (olsr_cnf->ip_version == AF_INET) {
356     struct sockaddr_in sin4;
357
358     memset(&sin4, 0, sizeof(sin4));
359     sin4.sin_family = AF_INET;
360     sin4.sin_addr.s_addr = htonl(INADDR_LOOPBACK);
361     sin4.sin_port = htons(10150);
362
363     /* IP version 4 */
364     ifp->ip_addr.v4 = iface->hemu_ip.v4;
365     memcpy(&ifp->int_addr.sin_addr, &iface->hemu_ip, olsr_cnf->ipsize);
366
367     /*
368      * We create one socket for each interface and bind
369      * the socket to it. This to ensure that we can control
370      * on what interface the message is transmitted
371      */
372
373     ifp->olsr_socket = gethemusocket(&sin4);
374   } else {
375     /* IP version 6 */
376     memcpy(&ifp->ip_addr, &iface->hemu_ip, olsr_cnf->ipsize);
377
378 #if 0
379     /*
380      * We create one socket for each interface and bind
381      * the socket to it. This to ensure that we can control
382      * on what interface the message is transmitted
383      */
384
385     ifp->olsr_socket = gethcsocket6(&addrsock6, BUFSPACE, ifp->int_name);
386     if (ifp->olsr_socket < 0) {
387       olsr_exit(EXIT_FAULURE);
388     }
389     join_mcast(ifp, ifp->olsr_socket);
390 #endif
391   }
392
393   /* Send IP as first 4/16 bytes on socket */
394   memcpy(addr, iface->hemu_ip.v6.s6_addr, olsr_cnf->ipsize);
395   addr[0] = htonl(addr[0]);
396   addr[1] = htonl(addr[1]);
397   addr[2] = htonl(addr[2]);
398   addr[3] = htonl(addr[3]);
399
400   if (send(ifp->olsr_socket, addr, olsr_cnf->ipsize, 0) != (int)olsr_cnf->ipsize) {
401     OLSR_WARN(LOG_INTERFACE, "Error sending IP.\n");
402   }
403
404   /* Register socket */
405   add_olsr_socket(ifp->olsr_socket, &olsr_input_hostemu, NULL, NULL, SP_PR_READ);
406
407   /*
408    * Register functions for periodic message generation
409    */
410
411   ifp->hello_gen_timer =
412     olsr_start_timer(iface->cnf->hello_params.emission_interval * MSEC_PER_SEC,
413                      HELLO_JITTER, OLSR_TIMER_PERIODIC, &olsr_output_lq_hello, ifp, hello_gen_timer_cookie);
414   ifp->tc_gen_timer =
415     olsr_start_timer(iface->cnf->tc_params.emission_interval * MSEC_PER_SEC,
416                      TC_JITTER, OLSR_TIMER_PERIODIC, &olsr_output_lq_tc, ifp, tc_gen_timer_cookie);
417   ifp->mid_gen_timer =
418     olsr_start_timer(iface->cnf->mid_params.emission_interval * MSEC_PER_SEC,
419                      MID_JITTER, OLSR_TIMER_PERIODIC, &generate_mid, ifp, mid_gen_timer_cookie);
420   ifp->hna_gen_timer =
421     olsr_start_timer(iface->cnf->hna_params.emission_interval * MSEC_PER_SEC,
422                      HNA_JITTER, OLSR_TIMER_PERIODIC, &generate_hna, ifp, hna_gen_timer_cookie);
423
424   ifp->hello_etime = (olsr_reltime) (iface->cnf->hello_params.emission_interval * MSEC_PER_SEC);
425   ifp->valtimes.hello = reltime_to_me(iface->cnf->hello_params.validity_time * MSEC_PER_SEC);
426   ifp->valtimes.tc = reltime_to_me(iface->cnf->tc_params.validity_time * MSEC_PER_SEC);
427   ifp->valtimes.mid = reltime_to_me(iface->cnf->mid_params.validity_time * MSEC_PER_SEC);
428   ifp->valtimes.hna = reltime_to_me(iface->cnf->hna_params.validity_time * MSEC_PER_SEC);
429
430   return 1;
431 }
432
433 static char basenamestr[32];
434 static const char *if_basename(const char *name);
435 static const char *
436 if_basename(const char *name)
437 {
438   const char *p = strchr(name, ':');
439   if (NULL == p || p - name >= (int)(ARRAYSIZE(basenamestr) - 1)) {
440     return name;
441   }
442   memcpy(basenamestr, name, p - name);
443   basenamestr[p - name] = 0;
444   return basenamestr;
445 }
446
447 /**
448  * Initializes a interface described by iface,
449  * if it is set up and is of the correct type.
450  *
451  *@param iface the olsr_if_config struct describing the interface
452  *@param so the socket to use for ioctls
453  *
454  */
455 int
456 chk_if_up(struct olsr_if_config *iface)
457 {
458   struct interface *ifp;
459   struct ifreq ifr;
460   const char *ifr_basename;
461 #if !defined REMOVE_LOG_DEBUG || !defined REMOVE_LOG_INFO
462   struct ipaddr_str buf;
463 #endif
464
465   /*
466    * Sanity check.
467    */
468   if (iface->interf) {
469     return -1;
470   }
471   ifp = olsr_cookie_malloc(interface_mem_cookie);
472
473   /*
474    * Setup query block.
475    */
476   memset(&ifr, 0, sizeof(ifr));
477   strscpy(ifr.ifr_name, iface->name, sizeof(ifr.ifr_name));
478
479   OLSR_DEBUG(LOG_INTERFACE, "Checking %s:\n", ifr.ifr_name);
480
481   /* Get flags (and check if interface exists) */
482   if (ioctl(olsr_cnf->ioctl_s, SIOCGIFFLAGS, &ifr) < 0) {
483     OLSR_DEBUG(LOG_INTERFACE, "\tNo such interface!\n");
484     goto cleanup;
485   }
486
487   ifp->int_flags = ifr.ifr_flags;
488   if ((ifp->int_flags & IFF_UP) == 0) {
489     OLSR_DEBUG(LOG_INTERFACE, "\tInterface not up - skipping it...\n");
490     goto cleanup;
491   }
492
493   /* Check broadcast */
494   if (olsr_cnf->ip_version == AF_INET && !iface->cnf->ipv4_broadcast.v4.s_addr &&       /* Skip if fixed bcast */
495       (ifp->int_flags & IFF_BROADCAST) == 0) {
496     OLSR_DEBUG(LOG_INTERFACE, "\tNo broadcast - skipping\n");
497     goto cleanup;
498   }
499
500   if (ifp->int_flags & IFF_LOOPBACK) {
501     OLSR_DEBUG(LOG_INTERFACE, "\tThis is a loopback interface - skipping it...\n");
502     goto cleanup;
503   }
504
505   ifp->is_hcif = false;
506
507   /* trying to detect if interface is wireless. */
508   ifp->is_wireless = check_wireless_interface(ifr.ifr_name);
509   OLSR_DEBUG(LOG_INTERFACE, ifp->is_wireless ? "\tWireless interface detected\n" : "\tNot a wireless interface\n");
510
511   ifr_basename = if_basename(ifr.ifr_name);
512
513   /* IP version 6 */
514   if (olsr_cnf->ip_version == AF_INET6) {
515     /* Get interface address */
516     int result;
517
518     if (iface->cnf->ipv6_addrtype == OLSR_IP6T_AUTO) {
519       if ((result = get_ipv6_address(ifr.ifr_name, &ifp->int6_addr, OLSR_IP6T_SITELOCAL)) > 0) {
520         iface->cnf->ipv6_addrtype = OLSR_IP6T_SITELOCAL;
521       } else {
522         if ((result = get_ipv6_address(ifr.ifr_name, &ifp->int6_addr, OLSR_IP6T_UNIQUELOCAL)) > 0) {
523           iface->cnf->ipv6_addrtype = OLSR_IP6T_UNIQUELOCAL;
524         } else {
525           if ((result = get_ipv6_address(ifr.ifr_name, &ifp->int6_addr, OLSR_IP6T_GLOBAL)) > 0) {
526             iface->cnf->ipv6_addrtype = OLSR_IP6T_GLOBAL;
527           }
528         }
529       }
530     } else {
531       result = get_ipv6_address(ifr.ifr_name, &ifp->int6_addr, iface->cnf->ipv6_addrtype);
532     }
533
534     if (result <= 0) {
535       if (iface->cnf->ipv6_addrtype == OLSR_IP6T_SITELOCAL)
536         OLSR_DEBUG(LOG_INTERFACE, "\tCould not find site-local IPv6 address for %s\n", ifr.ifr_name);
537       else if (iface->cnf->ipv6_addrtype == OLSR_IP6T_UNIQUELOCAL)
538         OLSR_DEBUG(LOG_INTERFACE, "\tCould not find unique-local IPv6 address for %s\n", ifr.ifr_name);
539       else if (iface->cnf->ipv6_addrtype == OLSR_IP6T_GLOBAL)
540         OLSR_DEBUG(LOG_INTERFACE, "\tCould not find global IPv6 address for %s\n", ifr.ifr_name);
541       else
542         OLSR_DEBUG(LOG_INTERFACE, "\tCould not find an IPv6 address for %s\n", ifr.ifr_name);
543       goto cleanup;
544     }
545
546     OLSR_DEBUG(LOG_INTERFACE, "\tAddress: %s\n", ip6_to_string(&buf, &ifp->int6_addr.sin6_addr));
547
548     /* Multicast */
549     memset(&ifp->int6_multaddr, 0, sizeof(ifp->int6_multaddr));
550     ifp->int6_multaddr.sin6_family = AF_INET6;
551     ifp->int6_multaddr.sin6_flowinfo = htonl(0);
552     ifp->int6_multaddr.sin6_scope_id = if_nametoindex(ifr.ifr_name);
553     ifp->int6_multaddr.sin6_port = htons(olsr_cnf->olsr_port);
554     ifp->int6_multaddr.sin6_addr = iface->cnf->ipv6_addrtype == OLSR_IP6T_SITELOCAL
555       ? iface->cnf->ipv6_multi_site.v6 : iface->cnf->ipv6_multi_glbl.v6;
556
557 #ifdef __MacOSX__
558     ifp->int6_multaddr.sin6_scope_id = 0;
559 #endif
560
561     OLSR_DEBUG(LOG_INTERFACE, "\tMulticast: %s\n", ip6_to_string(&buf, &ifp->int6_multaddr.sin6_addr));
562
563     ifp->ip_addr.v6 = ifp->int6_addr.sin6_addr;
564   } else {
565     /* IP version 4 */
566
567     /* Get interface address (IPv4) */
568     if (ioctl(olsr_cnf->ioctl_s, SIOCGIFADDR, &ifr) < 0) {
569       OLSR_WARN(LOG_INTERFACE, "\tCould not get address of interface - skipping it\n");
570       goto cleanup;
571     }
572
573     ifp->int_addr = *(struct sockaddr_in *)&ifr.ifr_addr;
574
575     /* Find netmask */
576     if (ioctl(olsr_cnf->ioctl_s, SIOCGIFNETMASK, &ifr) < 0) {
577       OLSR_WARN(LOG_INTERFACE, "%s: ioctl (get netmask) failed", ifr.ifr_name);
578       goto cleanup;
579     }
580     ifp->int_netmask = *(struct sockaddr_in *)&ifr.ifr_netmask;
581
582     /* Find broadcast address */
583     if (iface->cnf->ipv4_broadcast.v4.s_addr) {
584       /* Specified broadcast */
585       ifp->int_broadaddr.sin_addr = iface->cnf->ipv4_broadcast.v4;
586     } else {
587       /* Autodetect */
588       if (ioctl(olsr_cnf->ioctl_s, SIOCGIFBRDADDR, &ifr) < 0) {
589         OLSR_WARN(LOG_INTERFACE, "%s: ioctl (get broadaddr) failed", ifr.ifr_name);
590         goto cleanup;
591       }
592
593       ifp->int_broadaddr = *(struct sockaddr_in *)&ifr.ifr_broadaddr;
594     }
595
596     /* Deactivate IP spoof filter */
597     deactivate_spoof(ifr_basename, ifp, olsr_cnf->ip_version);
598
599     /* Disable ICMP redirects */
600     disable_redirects(ifr_basename, ifp, olsr_cnf->ip_version);
601
602     ifp->ip_addr.v4 = ifp->int_addr.sin_addr;
603   }
604
605   /* check if interface with this IP already exists */
606   if (if_ifwithaddr(&ifp->ip_addr)) {
607     OLSR_ERROR(LOG_INTERFACE, "Warning, multiple interfaces with the same IP are deprecated. Use 'OriginatorAddress'"
608                " option if you fear a changing main address. Future versions of OLSR might block using multiple"
609                " interfaces with the same IP\n");
610   }
611
612   /* Get interface index */
613   ifp->if_index = if_nametoindex(ifr.ifr_name);
614
615   /* Set interface metric */
616   ifp->int_metric = iface->cnf->weight.fixed ? iface->cnf->weight.value : calculate_if_metric(ifr.ifr_name);
617   OLSR_DEBUG(LOG_INTERFACE, "\tMetric: %d\n", ifp->int_metric);
618
619   /* Get MTU */
620   if (ioctl(olsr_cnf->ioctl_s, SIOCGIFMTU, &ifr) < 0) {
621     ifp->int_mtu = OLSR_DEFAULT_MTU;
622   } else {
623     ifp->int_mtu = ifr.ifr_mtu;
624   }
625   ifp->int_mtu -= olsr_cnf->ip_version == AF_INET6 ? UDP_IPV6_HDRSIZE : UDP_IPV4_HDRSIZE;
626
627   ifp->ttl_index = -32;         /* For the first 32 TC's, fish-eye is disabled */
628
629   /* Set up buffer */
630   net_add_buffer(ifp);
631
632   OLSR_DEBUG(LOG_INTERFACE, "\tMTU - IPhdr: %d\n", ifp->int_mtu);
633
634   OLSR_INFO(LOG_INTERFACE, "Adding interface %s\n", iface->name);
635   OLSR_DEBUG(LOG_INTERFACE, "\tIndex %d\n", ifp->if_index);
636
637   if (olsr_cnf->ip_version == AF_INET) {
638     OLSR_DEBUG(LOG_INTERFACE, "\tAddress:%s\n", ip4_to_string(&buf, ifp->int_addr.sin_addr));
639     OLSR_DEBUG(LOG_INTERFACE, "\tNetmask:%s\n", ip4_to_string(&buf, ifp->int_netmask.sin_addr));
640     OLSR_DEBUG(LOG_INTERFACE, "\tBroadcast address:%s\n", ip4_to_string(&buf, ifp->int_broadaddr.sin_addr));
641   } else {
642     OLSR_DEBUG(LOG_INTERFACE, "\tAddress: %s\n", ip6_to_string(&buf, &ifp->int6_addr.sin6_addr));
643     OLSR_DEBUG(LOG_INTERFACE, "\tMulticast: %s\n", ip6_to_string(&buf, &ifp->int6_multaddr.sin6_addr));
644   }
645
646   /*
647    * Clone interface name.
648    */
649   ifp->int_name = olsr_malloc(strlen(ifr_basename) + 1, "Interface update 3");
650   strcpy(ifp->int_name, ifr_basename);
651
652   ifp->immediate_send_tc = iface->cnf->tc_params.emission_interval < iface->cnf->hello_params.emission_interval;
653 #if 0
654   ifp->gen_properties = NULL;
655 #endif
656
657   if (olsr_cnf->ip_version == AF_INET) {
658     /* IP version 4 */
659     /*
660      * We create one socket for each interface and bind
661      * the socket to it. This to ensure that we can control
662      * on what interface the message is transmitted
663      */
664     ifp->olsr_socket = getsocket(BUFSPACE, ifp->int_name);
665     if (ifp->olsr_socket < 0) {
666       OLSR_ERROR(LOG_INTERFACE, "Could not initialize socket... exiting!\n\n");
667       olsr_exit(EXIT_FAILURE);
668     }
669   } else {
670     /* IP version 6 */
671
672     /*
673      * We create one socket for each interface and bind
674      * the socket to it. This to ensure that we can control
675      * on what interface the message is transmitted
676      */
677     ifp->olsr_socket = getsocket6(BUFSPACE, ifp->int_name);
678     join_mcast(ifp, ifp->olsr_socket);
679   }
680
681   set_buffer_timer(ifp);
682
683   /* Register socket */
684   add_olsr_socket(ifp->olsr_socket, &olsr_input, NULL, NULL, SP_PR_READ);
685
686 #ifdef linux
687   {
688     /* Set TOS */
689     int data = IPTOS_PREC(olsr_cnf->tos);
690     if (setsockopt(ifp->olsr_socket, SOL_SOCKET, SO_PRIORITY, (char *)&data, sizeof(data)) < 0) {
691       OLSR_WARN(LOG_INTERFACE, "setsockopt(SO_PRIORITY) error %s", strerror(errno));
692     }
693     data = IPTOS_TOS(olsr_cnf->tos);
694     if (setsockopt(ifp->olsr_socket, SOL_IP, IP_TOS, (char *)&data, sizeof(data)) < 0) {
695       OLSR_WARN(LOG_INTERFACE, "setsockopt(IP_TOS) error %s", strerror(errno));
696     }
697   }
698 #endif
699
700   /*
701    *Initialize sequencenumber as a random 16bit value
702    */
703   ifp->olsr_seqnum = random() & 0xFFFF;
704
705   /*
706    * Set main address if this is the only interface
707    */
708   if (!olsr_cnf->fixed_origaddr && olsr_ipcmp(&all_zero, &olsr_cnf->router_id) == 0) {
709     olsr_cnf->router_id = ifp->ip_addr;
710     OLSR_INFO(LOG_INTERFACE, "New main address: %s\n", olsr_ip_to_string(&buf, &olsr_cnf->router_id));
711   }
712
713   /*
714    * Register functions for periodic message generation
715    */
716   ifp->hello_gen_timer =
717     olsr_start_timer(iface->cnf->hello_params.emission_interval * MSEC_PER_SEC,
718                      HELLO_JITTER, OLSR_TIMER_PERIODIC, &olsr_output_lq_hello, ifp, hello_gen_timer_cookie);
719   ifp->tc_gen_timer =
720     olsr_start_timer(iface->cnf->tc_params.emission_interval * MSEC_PER_SEC,
721                      TC_JITTER, OLSR_TIMER_PERIODIC, &olsr_output_lq_tc, ifp, tc_gen_timer_cookie);
722   ifp->mid_gen_timer =
723     olsr_start_timer(iface->cnf->mid_params.emission_interval * MSEC_PER_SEC,
724                      MID_JITTER, OLSR_TIMER_PERIODIC, &generate_mid, ifp, mid_gen_timer_cookie);
725   ifp->hna_gen_timer =
726     olsr_start_timer(iface->cnf->hna_params.emission_interval * MSEC_PER_SEC,
727                      HNA_JITTER, OLSR_TIMER_PERIODIC, &generate_hna, ifp, hna_gen_timer_cookie);
728
729   ifp->hello_etime = (olsr_reltime) (iface->cnf->hello_params.emission_interval * MSEC_PER_SEC);
730   ifp->valtimes.hello = reltime_to_me(iface->cnf->hello_params.validity_time * MSEC_PER_SEC);
731   ifp->valtimes.tc = reltime_to_me(iface->cnf->tc_params.validity_time * MSEC_PER_SEC);
732   ifp->valtimes.mid = reltime_to_me(iface->cnf->mid_params.validity_time * MSEC_PER_SEC);
733   ifp->valtimes.hna = reltime_to_me(iface->cnf->hna_params.validity_time * MSEC_PER_SEC);
734
735   ifp->mode = iface->cnf->mode;
736
737   /*
738    * Call possible ifchange functions registered by plugins
739    */
740   run_ifchg_cbs(ifp, IFCHG_IF_ADD);
741
742   /*
743    * The interface is ready, lock it.
744    */
745   lock_interface(ifp);
746
747   /*
748    * Link to config.
749    */
750   iface->interf = ifp;
751   lock_interface(iface->interf);
752
753   /* Queue */
754   list_node_init(&ifp->int_node);
755   list_add_before(&interface_head, &ifp->int_node);
756
757   return 1;
758
759 cleanup:
760   olsr_cookie_free(interface_mem_cookie, ifp);
761   return 0;
762 }
763
764 /*
765  * Local Variables:
766  * c-basic-offset: 2
767  * indent-tabs-mode: nil
768  * End:
769  */