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