]> git.meshlink.io Git - catta/blob - avahi-autoipd/main.c
* don't allow 169.254.0.0 and 169.254.255.255 as valid addresses
[catta] / avahi-autoipd / main.c
1 /* $Id$ */
2
3 /***
4   This file is part of avahi.
5  
6   avahi is free software; you can redistribute it and/or modify it
7   under the terms of the GNU Lesser General Public License as
8   published by the Free Software Foundation; either version 2.1 of the
9   License, or (at your option) any later version.
10  
11   avahi is distributed in the hope that it will be useful, but WITHOUT
12   ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
13   or FITNESS FOR A PARTICULAR PURPOSE. See the GNU Lesser General
14   Public License for more details.
15  
16   You should have received a copy of the GNU Lesser General Public
17   License along with avahi; if not, write to the Free Software
18   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
19   USA.
20 ***/
21
22 #ifdef HAVE_CONFIG_H
23 #include <config.h>
24 #endif
25
26 #include <stdlib.h>
27 #include <unistd.h>
28 #include <sys/socket.h>
29 #include <netpacket/packet.h>
30 #include <net/ethernet.h>
31 #include <fcntl.h>
32 #include <time.h>
33 #include <assert.h>
34 #include <errno.h>
35 #include <string.h>
36 #include <inttypes.h>
37 #include <sys/types.h>
38 #include <arpa/inet.h>
39 #include <sys/ioctl.h>
40 #include <poll.h>
41 #include <net/if.h>
42 #include <stdio.h>
43 #include <getopt.h>
44 #include <signal.h>
45 #include <sys/wait.h>
46 #include <pwd.h>
47 #include <grp.h>
48
49 #include <avahi-common/malloc.h>
50 #include <avahi-common/timeval.h>
51
52 #include <avahi-daemon/setproctitle.h>
53
54 #include <libdaemon/dfork.h>
55 #include <libdaemon/dsignal.h>
56 #include <libdaemon/dlog.h>
57 #include <libdaemon/dpid.h>
58 #include <libdaemon/dexec.h>
59
60 #include "main.h"
61 #include "iface.h"
62
63 #ifndef __linux__
64 #error "avahi-autoipd is only available on Linux for now"
65 #endif
66
67 /* An implementation of RFC 3927 */
68
69 /* Constants from the RFC */
70 #define PROBE_WAIT 1
71 #define PROBE_NUM 3
72 #define PROBE_MIN 1
73 #define PROBE_MAX 2
74 #define ANNOUNCE_WAIT 2
75 #define ANNOUNCE_NUM 2
76 #define ANNOUNCE_INTERVAL 2
77 #define MAX_CONFLICTS 10
78 #define RATE_LIMIT_INTERVAL 60
79 #define DEFEND_INTERVAL 10
80
81 #define IPV4LL_NETWORK 0xA9FE0000L
82 #define IPV4LL_NETMASK 0xFFFF0000L
83 #define IPV4LL_HOSTMASK 0x0000FFFFL
84 #define IPV4LL_BROADCAST 0xA9FEFFFFL
85
86 #define ETHER_ADDRLEN 6
87 #define ARP_PACKET_SIZE (8+4+4+2*ETHER_ADDRLEN)
88
89 typedef enum ArpOperation {
90     ARP_REQUEST = 1,
91     ARP_RESPONSE = 2
92 } ArpOperation;
93
94 typedef struct ArpPacketInfo {
95     ArpOperation operation;
96
97     uint32_t sender_ip_address, target_ip_address;
98     uint8_t sender_hw_address[ETHER_ADDRLEN], target_hw_address[ETHER_ADDRLEN];
99 } ArpPacketInfo;
100
101 static State state = STATE_START;
102 static int n_iteration = 0;
103 static int n_conflict = 0;
104
105 static char *interface_name = NULL;
106 static char *pid_file_name = NULL;
107 static uint32_t start_address = 0;
108 static char *argv0 = NULL;
109 static int daemonize = 0;
110 static int wait_for_address = 0;
111 static int use_syslog = 0;
112 static int debug = 0;
113 static int modify_proc_title = 1;
114 static int force_bind = 0;
115 #ifdef HAVE_CHROOT
116 static int no_chroot = 0;
117 #endif
118 static int no_drop_root = 0;
119 static int wrote_pid_file = 0;
120
121 static enum {
122     DAEMON_RUN,
123     DAEMON_KILL,
124     DAEMON_REFRESH,
125     DAEMON_VERSION,
126     DAEMON_HELP,
127     DAEMON_CHECK
128 } command = DAEMON_RUN;
129
130 typedef enum CalloutEvent {
131     CALLOUT_BIND,
132     CALLOUT_CONFLICT,
133     CALLOUT_UNBIND,
134     CALLOUT_STOP,
135     CALLOUT_MAX
136 } CalloutEvent;
137
138 static const char * const callout_event_table[CALLOUT_MAX] = {
139     [CALLOUT_BIND] = "BIND",
140     [CALLOUT_CONFLICT] = "CONFLICT",
141     [CALLOUT_UNBIND] = "UNBIND",
142     [CALLOUT_STOP] = "STOP"
143 };
144
145 typedef struct CalloutEventInfo {
146     CalloutEvent event;
147     uint32_t address;
148     int ifindex;
149 } CalloutEventInfo;
150
151 #define RANDOM_DEVICE "/dev/urandom"
152
153 #define DEBUG(x) do {\
154 if (debug) { \
155     x; \
156 } \
157 } while (0)
158
159 static void init_rand_seed(void) {
160     int fd;
161     unsigned seed = 0;
162
163     /* Try to initialize seed from /dev/urandom, to make it a little
164      * less predictable, and to make sure that multiple machines
165      * booted at the same time choose different random seeds.  */
166     if ((fd = open(RANDOM_DEVICE, O_RDONLY)) >= 0) {
167         read(fd, &seed, sizeof(seed));
168         close(fd);
169     }
170
171     /* If the initialization failed by some reason, we add the time to the seed */
172     seed ^= (unsigned) time(NULL);
173
174     srand(seed);
175 }
176
177 static uint32_t pick_addr(uint32_t old_addr) {
178     uint32_t addr;
179
180     do {
181         unsigned r = (unsigned) rand();
182
183         /* Reduce to 16 bits */
184         while (r > 0xFFFF)
185             r = (r >> 16) ^ (r & 0xFFFF);
186         
187         addr = htonl(IPV4LL_NETWORK | (uint32_t) r);
188
189     } while (addr == old_addr || !is_ll_address(addr));
190
191     return addr;
192 }
193
194 static int load_address(const char *fn, uint32_t *addr) {
195     FILE *f;
196     unsigned a, b, c, d;
197
198     assert(fn);
199     assert(addr);
200     
201     if (!(f = fopen(fn, "r"))) {
202
203         if (errno == ENOENT) {
204             *addr = 0;
205             return 0;
206         }
207         
208         daemon_log(LOG_ERR, "fopen() failed: %s", strerror(errno));
209         goto fail;
210     }
211
212     if (fscanf(f, "%u.%u.%u.%u\n", &a, &b, &c, &d) != 4) {
213         daemon_log(LOG_ERR, "Parse failure");
214         goto fail;
215     }
216
217     fclose(f);
218
219     *addr = htonl((a << 24) | (b << 16) | (c << 8) | d);
220     return 0;
221     
222 fail:
223     if (f)
224         fclose(f);
225
226     return -1;
227 }
228
229 static int save_address(const char *fn, uint32_t addr) {
230     FILE *f;
231     char buf[32];
232
233     assert(fn);
234     
235     if (!(f = fopen(fn, "w"))) {
236         daemon_log(LOG_ERR, "fopen() failed: %s", strerror(errno));
237         goto fail;
238     }
239
240     fprintf(f, "%s\n", inet_ntop(AF_INET, &addr, buf, sizeof (buf)));
241     fclose(f);
242
243     return 0;
244     
245 fail:
246     if (f)
247         fclose(f);
248
249     return -1;
250 }
251
252 static void* packet_new(const ArpPacketInfo *info, size_t *packet_len) {
253     uint8_t *r;
254
255     assert(info);
256     assert(packet_len);
257     assert(info->operation == ARP_REQUEST || info->operation == ARP_RESPONSE);
258
259     *packet_len = ARP_PACKET_SIZE;
260     r = avahi_new0(uint8_t, *packet_len);
261     
262     r[1] = 1; /* HTYPE */
263     r[2] = 8; /* PTYPE */
264     r[4] = ETHER_ADDRLEN; /* HLEN */
265     r[5] = 4; /* PLEN */
266     r[7] = (uint8_t) info->operation;
267
268     memcpy(r+8, info->sender_hw_address, ETHER_ADDRLEN);
269     memcpy(r+14, &info->sender_ip_address, 4);
270     memcpy(r+18, info->target_hw_address, ETHER_ADDRLEN);
271     memcpy(r+24, &info->target_ip_address, 4);
272
273     return r;
274 }
275
276 static void *packet_new_probe(uint32_t ip_address, const uint8_t*hw_address, size_t *packet_len) {
277     ArpPacketInfo info;
278     
279     memset(&info, 0, sizeof(info));
280     info.operation = ARP_REQUEST;
281     memcpy(info.sender_hw_address, hw_address, ETHER_ADDRLEN);
282     info.target_ip_address = ip_address;
283
284     return packet_new(&info, packet_len);
285 }
286
287 static void *packet_new_announcement(uint32_t ip_address, const uint8_t* hw_address, size_t *packet_len) {
288     ArpPacketInfo info;
289
290     memset(&info, 0, sizeof(info));
291     info.operation = ARP_REQUEST;
292     memcpy(info.sender_hw_address, hw_address, ETHER_ADDRLEN);
293     info.target_ip_address = ip_address;
294     info.sender_ip_address = ip_address;
295
296     return packet_new(&info, packet_len);
297 }
298
299 static int packet_parse(const void *data, size_t packet_len, ArpPacketInfo *info) {
300     const uint8_t *p = data;
301     
302     assert(data);
303
304     if (packet_len < ARP_PACKET_SIZE)
305         return -1;
306
307     /* Check HTYPE and PTYPE */
308     if (p[0] != 0 || p[1] != 1 || p[2] != 8 || p[3] != 0)
309         return -1;
310
311     /* Check HLEN, PLEN, OPERATION */
312     if (p[4] != ETHER_ADDRLEN || p[5] != 4 || p[6] != 0 || (p[7] != 1 && p[7] != 2))
313         return -1;
314     
315     info->operation = p[7];
316     memcpy(info->sender_hw_address, p+8, ETHER_ADDRLEN);
317     memcpy(&info->sender_ip_address, p+14, 4);
318     memcpy(info->target_hw_address, p+18, ETHER_ADDRLEN);
319     memcpy(&info->target_ip_address, p+24, 4);
320
321     return 0;
322 }
323
324 static void set_state(State st, int reset_counter, uint32_t address) {
325     static const char* const state_table[] = {
326         [STATE_START] = "START",
327         [STATE_WAITING_PROBE] = "WAITING_PROBE",
328         [STATE_PROBING] = "PROBING",
329         [STATE_WAITING_ANNOUNCE] = "WAITING_ANNOUNCE", 
330         [STATE_ANNOUNCING] = "ANNOUNCING",
331         [STATE_RUNNING] = "RUNNING",
332         [STATE_SLEEPING] = "SLEEPING"
333     };
334     char buf[64];
335     
336     assert(st < STATE_MAX);
337
338     if (st == state && !reset_counter) {
339         n_iteration++;
340         DEBUG(daemon_log(LOG_DEBUG, "State iteration %s-%i", state_table[state], n_iteration));
341     } else {
342         DEBUG(daemon_log(LOG_DEBUG, "State transition %s-%i -> %s-0", state_table[state], n_iteration, state_table[st]));
343         state = st;
344         n_iteration = 0;
345     }
346
347     if (state == STATE_SLEEPING) 
348         avahi_set_proc_title(argv0, "%s: [%s] sleeping", argv0, interface_name);
349     else if (state == STATE_ANNOUNCING)
350         avahi_set_proc_title(argv0, "%s: [%s] announcing %s", argv0, interface_name, inet_ntop(AF_INET, &address, buf, sizeof(buf)));
351     else if (state == STATE_RUNNING)
352         avahi_set_proc_title(argv0, "%s: [%s] bound %s", argv0, interface_name, inet_ntop(AF_INET, &address, buf, sizeof(buf)));
353     else
354         avahi_set_proc_title(argv0, "%s: [%s] probing %s", argv0, interface_name, inet_ntop(AF_INET, &address, buf, sizeof(buf)));
355 }
356
357 static int interface_up(int iface) {
358     int fd = -1;
359     struct ifreq ifreq;
360
361     if ((fd = socket(PF_INET, SOCK_DGRAM, 0)) < 0) {
362         daemon_log(LOG_ERR, "socket() failed: %s", strerror(errno));
363         goto fail;
364     }
365
366     memset(&ifreq, 0, sizeof(ifreq));
367     if (!if_indextoname(iface, ifreq.ifr_name)) {
368         daemon_log(LOG_ERR, "if_indextoname() failed: %s", strerror(errno));
369         goto fail;
370     }
371     
372     if (ioctl(fd, SIOCGIFFLAGS, &ifreq) < 0) {
373         daemon_log(LOG_ERR, "SIOCGIFFLAGS failed: %s", strerror(errno));
374         goto fail;
375     }
376
377     ifreq.ifr_flags |= IFF_UP;
378
379     if (ioctl(fd, SIOCSIFFLAGS, &ifreq) < 0) {
380         daemon_log(LOG_ERR, "SIOCSIFFLAGS failed: %s", strerror(errno));
381         goto fail;
382     }
383
384     close(fd);
385
386     return 0;
387     
388 fail:
389     if (fd >= 0)
390         close(fd);
391     
392     return -1;
393 }
394
395 static int open_socket(int iface, uint8_t *hw_address) {
396     int fd = -1;
397     struct sockaddr_ll sa;
398     socklen_t sa_len;
399
400     if (interface_up(iface) < 0)
401         goto fail;
402     
403     if ((fd = socket(PF_PACKET, SOCK_DGRAM, 0)) < 0) {
404         daemon_log(LOG_ERR, "socket() failed: %s", strerror(errno));
405         goto fail;
406     }
407
408     memset(&sa, 0, sizeof(sa));
409     sa.sll_family = AF_PACKET;
410     sa.sll_protocol = htons(ETH_P_ARP);
411     sa.sll_ifindex = iface;
412     
413     if (bind(fd, (struct sockaddr*) &sa, sizeof(sa)) < 0) {
414         daemon_log(LOG_ERR, "bind() failed: %s", strerror(errno));
415         goto fail;
416     }
417     
418     sa_len = sizeof(sa);
419     if (getsockname(fd, (struct sockaddr*) &sa, &sa_len) < 0) {
420         daemon_log(LOG_ERR, "getsockname() failed: %s", strerror(errno));
421         goto fail;
422     }
423     
424     if (sa.sll_halen != ETHER_ADDRLEN) {
425         daemon_log(LOG_ERR, "getsockname() returned invalid hardware address.");
426         goto fail;
427     }
428
429     memcpy(hw_address, sa.sll_addr, ETHER_ADDRLEN);
430
431     return fd;
432     
433 fail:
434     if (fd >= 0)
435         close(fd);
436
437     return -1;
438 }
439
440 static int send_packet(int fd, int iface, void *packet, size_t packet_len) {
441     struct sockaddr_ll sa;
442     
443     assert(fd >= 0);
444     assert(packet);
445     assert(packet_len > 0);
446
447     memset(&sa, 0, sizeof(sa));
448     sa.sll_family = AF_PACKET;
449     sa.sll_protocol = htons(ETH_P_ARP);
450     sa.sll_ifindex = iface;
451     sa.sll_halen = ETHER_ADDRLEN;
452     memset(sa.sll_addr, 0xFF, ETHER_ADDRLEN);
453
454     if (sendto(fd, packet, packet_len, 0, (struct sockaddr*) &sa, sizeof(sa)) < 0) {
455         daemon_log(LOG_ERR, "sendto() failed: %s", strerror(errno));
456         return -1;
457     }
458
459     return 0;
460 }
461
462 static int recv_packet(int fd, void **packet, size_t *packet_len) {
463     int s;
464     struct sockaddr_ll sa;
465     socklen_t sa_len;
466     ssize_t r;
467     
468     assert(fd >= 0);
469     assert(packet);
470     assert(packet_len);
471
472     *packet = NULL;
473
474     if (ioctl(fd, FIONREAD, &s) < 0) {
475         daemon_log(LOG_ERR, "FIONREAD failed: %s", strerror(errno));
476         goto fail;
477     }
478
479     if (s <= 0)
480         s = 4096;
481
482     *packet = avahi_new(uint8_t, s);
483
484     sa_len = sizeof(sa);
485     if ((r = recvfrom(fd, *packet, s, 0, (struct sockaddr*) &sa, &sa_len)) < 0) {
486         daemon_log(LOG_ERR, "recvfrom() failed: %s", strerror(errno));
487         goto fail;
488     }
489     
490     *packet_len = (size_t) r;
491     
492     return 0;
493     
494 fail:
495     if (*packet) {
496         avahi_free(*packet);
497         *packet = NULL;
498     }
499
500     return -1;
501 }
502  
503 int is_ll_address(uint32_t addr) {
504     return
505         (ntohl(addr) & IPV4LL_NETMASK) == IPV4LL_NETWORK &&
506         ntohl(addr) != IPV4LL_NETWORK &&
507         ntohl(addr) != IPV4LL_BROADCAST;
508 }
509
510 static struct timeval *elapse_time(struct timeval *tv, unsigned msec, unsigned jitter) {
511     assert(tv);
512
513     gettimeofday(tv, NULL);
514
515     if (msec)
516         avahi_timeval_add(tv, (AvahiUsec) msec*1000);
517
518     if (jitter)
519         avahi_timeval_add(tv, (AvahiUsec) (jitter*1000.0*rand()/(RAND_MAX+1.0)));
520         
521     return tv;
522 }
523
524 static FILE* fork_dispatcher(void) {
525     FILE *ret;
526     int fds[2];
527     pid_t pid;
528
529     if (pipe(fds) < 0) {
530         daemon_log(LOG_ERR, "pipe() failed: %s", strerror(errno));
531         goto fail;
532     }
533
534     if ((pid = fork()) < 0)
535         goto fail;
536     else if (pid == 0) {
537         FILE *f = NULL; 
538         int r = 1;
539
540         /* Please note that the signal pipe is not closed at this
541          * point, signals will thus be dispatched in the main
542          * process. */
543
544         daemon_retval_done();
545         
546         setsid();
547
548         avahi_set_proc_title(argv0, "%s: [%s] callout dispatcher", argv0, interface_name);
549
550         close(fds[1]);
551
552         if (!(f = fdopen(fds[0], "r"))) {
553             daemon_log(LOG_ERR, "fdopen() failed: %s", strerror(errno));
554             goto dispatcher_fail;
555         }
556         
557         for (;;) {
558             CalloutEventInfo info;
559             char name[IFNAMSIZ], buf[64];
560             int k;
561
562             if (fread(&info, sizeof(info), 1, f) != 1) {
563                 if (feof(f))
564                     break;
565
566                 daemon_log(LOG_ERR, "fread() failed: %s", strerror(errno));
567                 goto dispatcher_fail;
568             }
569
570             assert(info.event <= CALLOUT_MAX);
571
572             if (!if_indextoname(info.ifindex, name)) {
573                 daemon_log(LOG_ERR, "if_indextoname() failed: %s", strerror(errno));
574                 continue;
575             }
576             
577             if (daemon_exec("/", &k,
578                             AVAHI_IPCONF_SCRIPT, AVAHI_IPCONF_SCRIPT,
579                             callout_event_table[info.event],
580                             name,
581                             inet_ntop(AF_INET, &info.address, buf, sizeof(buf)), NULL) < 0) {
582                 
583                 daemon_log(LOG_ERR, "Failed to run script: %s", strerror(errno));
584                 continue;
585             }
586
587             if (k != 0)
588                 daemon_log(LOG_WARNING, "Script execution failed with return value %i", k);
589         }
590
591         r = 0;
592
593     dispatcher_fail:
594
595         if (f)
596             fclose(f);
597
598 #ifdef HAVE_CHROOT
599         /* If the main process is trapped inside a chroot() we have to
600          * remove the PID file for it */
601         
602         if (!no_chroot && wrote_pid_file)
603             daemon_pid_file_remove();
604 #endif
605         
606         _exit(r);
607     }
608
609     /* parent */
610
611     close(fds[0]);
612     fds[0] = -1;
613
614     if (!(ret = fdopen(fds[1], "w"))) {
615         daemon_log(LOG_ERR, "fdopen() failed: %s", strerror(errno));
616         goto fail;
617     }
618     
619     return ret;
620
621 fail:
622     if (fds[0] >= 0)
623         close(fds[0]);
624     if (fds[1] >= 0)
625         close(fds[1]);
626
627     return NULL;
628 }
629
630 static int do_callout(FILE *f, CalloutEvent event, int iface, uint32_t addr) {
631     CalloutEventInfo info;
632     char buf[64], ifname[IFNAMSIZ];
633
634     daemon_log(LOG_INFO, "Callout %s, address %s on interface %s",
635                callout_event_table[event],
636                inet_ntop(AF_INET, &addr, buf, sizeof(buf)),
637                if_indextoname(iface, ifname));
638
639     info.event = event;
640     info.ifindex = iface;
641     info.address = addr;
642
643     if (fwrite(&info, sizeof(info), 1, f) != 1 || fflush(f) != 0) {
644         daemon_log(LOG_ERR, "Failed to write callout event: %s", strerror(errno));
645         return -1;
646     }
647     
648     return 0;
649 }
650
651 #define set_env(key, value) putenv(avahi_strdup_printf("%s=%s", (key), (value)))
652
653 static int drop_privs(void) {
654     struct passwd *pw;
655     struct group * gr;
656     int r;
657     mode_t u;
658
659     /* Get user/group ID */
660     
661     if (!no_drop_root) {
662     
663         if (!(pw = getpwnam(AVAHI_AUTOIPD_USER))) {
664             daemon_log(LOG_ERR, "Failed to find user '"AVAHI_AUTOIPD_USER"'.");
665             return -1;
666         }
667         
668         if (!(gr = getgrnam(AVAHI_AUTOIPD_GROUP))) {
669             daemon_log(LOG_ERR, "Failed to find group '"AVAHI_AUTOIPD_GROUP"'.");
670             return -1;
671         }
672         
673         daemon_log(LOG_INFO, "Found user '"AVAHI_AUTOIPD_USER"' (UID %lu) and group '"AVAHI_AUTOIPD_GROUP"' (GID %lu).", (unsigned long) pw->pw_uid, (unsigned long) gr->gr_gid);
674     }
675
676     /* Create directory */
677     u = umask(0000);
678     r = mkdir(AVAHI_IPDATA_DIR, 0755);
679     umask(u);
680     
681     if (r < 0 && errno != EEXIST) {
682         daemon_log(LOG_ERR, "mkdir(\""AVAHI_IPDATA_DIR"\"): %s", strerror(errno));
683         return -1;
684     }
685
686     /* Convey working directory */
687     
688     if (!no_drop_root) {
689         struct stat st;
690         
691         chown(AVAHI_IPDATA_DIR, pw->pw_uid, gr->gr_gid);
692         
693         if (stat(AVAHI_IPDATA_DIR, &st) < 0) {
694             daemon_log(LOG_ERR, "stat(): %s\n", strerror(errno));
695             return -1;
696         }
697         
698         if (!S_ISDIR(st.st_mode) || st.st_uid != pw->pw_uid || st.st_gid != gr->gr_gid) {
699             daemon_log(LOG_ERR, "Failed to create runtime directory "AVAHI_IPDATA_DIR".");
700             return -1;
701         }
702     }
703
704 #ifdef HAVE_CHROOT
705
706     if (!no_chroot) {
707         if (chroot(AVAHI_IPDATA_DIR) < 0) {
708             daemon_log(LOG_ERR, "Failed to chroot(): %s", strerror(errno));
709             return -1;
710         }
711
712         daemon_log(LOG_INFO, "Successfully called chroot().");
713         chdir("/");
714
715         /* Since we are now trapped inside a chroot we cannot remove
716          * the pid file anymore, the helper process will do that for us. */
717         wrote_pid_file = 0;
718     }
719     
720 #endif
721
722     if (!no_drop_root) {
723
724         if (initgroups(AVAHI_AUTOIPD_USER, gr->gr_gid) != 0) {
725             daemon_log(LOG_ERR, "Failed to change group list: %s", strerror(errno));
726             return -1;
727         }
728         
729 #if defined(HAVE_SETRESGID)
730         r = setresgid(gr->gr_gid, gr->gr_gid, gr->gr_gid);
731 #elif defined(HAVE_SETEGID)
732         if ((r = setgid(gr->gr_gid)) >= 0)
733             r = setegid(gr->gr_gid);
734 #elif defined(HAVE_SETREGID)
735         r = setregid(gr->gr_gid, gr->gr_gid);
736 #else
737 #error "No API to drop priviliges"
738 #endif
739
740         if (r < 0) {
741             daemon_log(LOG_ERR, "Failed to change GID: %s", strerror(errno));
742             return -1;
743         }
744         
745 #if defined(HAVE_SETRESUID)
746         r = setresuid(pw->pw_uid, pw->pw_uid, pw->pw_uid);
747 #elif defined(HAVE_SETEUID)
748         if ((r = setuid(pw->pw_uid)) >= 0)
749             r = seteuid(pw->pw_uid);
750 #elif defined(HAVE_SETREUID)
751         r = setreuid(pw->pw_uid, pw->pw_uid);
752 #else
753 #error "No API to drop priviliges"
754 #endif
755         
756         if (r < 0) {
757             daemon_log(LOG_ERR, "Failed to change UID: %s", strerror(errno));
758             return -1;
759         }
760
761         set_env("USER", pw->pw_name);
762         set_env("LOGNAME", pw->pw_name);
763         set_env("HOME", pw->pw_dir);
764         
765         daemon_log(LOG_ERR, "Successfully dropped root privileges.");
766     }
767     
768     return 0;
769 }
770
771 static int loop(int iface, uint32_t addr) {
772     enum {
773         FD_ARP,
774         FD_IFACE,
775         FD_SIGNAL,
776         FD_MAX,
777     };
778
779     int fd = -1, ret = -1;
780     struct timeval next_wakeup;
781     int next_wakeup_valid = 0;
782     char buf[64];
783     void *in_packet = NULL;
784     size_t in_packet_len;
785     void *out_packet = NULL;
786     size_t out_packet_len;
787     uint8_t hw_address[ETHER_ADDRLEN];
788     struct pollfd pollfds[FD_MAX];
789     int iface_fd;
790     Event event = EVENT_NULL;
791     int retval_sent = !daemonize;
792     State st;
793     FILE *dispatcher = NULL;
794     char *address_fn = NULL;
795     const char *p;
796
797     daemon_signal_init(SIGINT, SIGTERM, SIGCHLD, SIGHUP,0);
798
799     if (!(dispatcher = fork_dispatcher()))
800         goto fail;
801
802     if ((fd = open_socket(iface, hw_address)) < 0)
803         goto fail;
804
805     if ((iface_fd = iface_init(iface)) < 0)
806         goto fail;
807
808     if (drop_privs() < 0)
809         goto fail;
810
811     if (force_bind)
812         st = STATE_START;
813     else if (iface_get_initial_state(&st) < 0)
814         goto fail;
815
816 #ifdef HAVE_CHROOT
817     if (!no_chroot)
818         p = "";
819     else
820 #endif
821         p = AVAHI_IPDATA_DIR;
822     
823     address_fn = avahi_strdup_printf(
824             "%s/%02x:%02x:%02x:%02x:%02x:%02x", p,
825             hw_address[0], hw_address[1],
826             hw_address[2], hw_address[3],
827             hw_address[4], hw_address[5]);
828     
829     if (!addr)
830         load_address(address_fn, &addr);
831
832     if (addr && !is_ll_address(addr)) {
833         daemon_log(LOG_WARNING, "Requested address %s is not from IPv4LL range 169.254/16, ignoring.", inet_ntop(AF_INET, &addr, buf, sizeof(buf)));
834         addr = 0;
835     }
836
837     if (!addr) {
838         int i;
839         uint32_t a = 1;
840
841         for (i = 0; i < ETHER_ADDRLEN; i++)
842             a += hw_address[i]*i;
843
844         addr = htonl(IPV4LL_NETWORK | (uint32_t) a);
845     }
846
847     set_state(st, 1, addr);
848     
849     daemon_log(LOG_INFO, "Starting with address %s", inet_ntop(AF_INET, &addr, buf, sizeof(buf)));
850
851     if (state == STATE_SLEEPING)
852         daemon_log(LOG_INFO, "Routable address already assigned, sleeping.");
853
854     if (!retval_sent && (!wait_for_address || state == STATE_SLEEPING)) {
855         daemon_retval_send(0);
856         retval_sent = 1;
857     }
858
859     memset(pollfds, 0, sizeof(pollfds));
860     pollfds[FD_ARP].fd = fd;
861     pollfds[FD_ARP].events = POLLIN;
862     pollfds[FD_IFACE].fd = iface_fd;
863     pollfds[FD_IFACE].events = POLLIN;
864     pollfds[FD_SIGNAL].fd = daemon_signal_fd();
865     pollfds[FD_SIGNAL].events = POLLIN;
866     
867     for (;;) {
868         int r, timeout;
869         AvahiUsec usec;
870
871         if (state == STATE_START) {
872
873             /* First, wait a random time */
874             set_state(STATE_WAITING_PROBE, 1, addr);
875
876             elapse_time(&next_wakeup, 0, PROBE_WAIT*1000);
877             next_wakeup_valid = 1;
878
879         } else if ((state == STATE_WAITING_PROBE && event == EVENT_TIMEOUT) ||
880                    (state == STATE_PROBING && event == EVENT_TIMEOUT && n_iteration < PROBE_NUM-2)) {
881
882             /* Send a probe */
883             out_packet = packet_new_probe(addr, hw_address, &out_packet_len);
884             set_state(STATE_PROBING, 0, addr);
885
886             elapse_time(&next_wakeup, PROBE_MIN*1000, (PROBE_MAX-PROBE_MIN)*1000);
887             next_wakeup_valid = 1;
888             
889         } else if (state == STATE_PROBING && event == EVENT_TIMEOUT && n_iteration >= PROBE_NUM-2) {
890
891             /* Send the last probe */
892             out_packet = packet_new_probe(addr, hw_address, &out_packet_len);
893             set_state(STATE_WAITING_ANNOUNCE, 1, addr);
894
895             elapse_time(&next_wakeup, ANNOUNCE_WAIT*1000, 0);
896             next_wakeup_valid = 1;
897             
898         } else if ((state == STATE_WAITING_ANNOUNCE && event == EVENT_TIMEOUT) ||
899                    (state == STATE_ANNOUNCING && event == EVENT_TIMEOUT && n_iteration < ANNOUNCE_NUM-1)) {
900
901             /* Send announcement packet */
902             out_packet = packet_new_announcement(addr, hw_address, &out_packet_len);
903             set_state(STATE_ANNOUNCING, 0, addr);
904
905             elapse_time(&next_wakeup, ANNOUNCE_INTERVAL*1000, 0);
906             next_wakeup_valid = 1;
907             
908             if (n_iteration == 0) {
909                 if (do_callout(dispatcher, CALLOUT_BIND, iface, addr) < 0)
910                     goto fail;
911                 
912                 n_conflict = 0;
913             }
914
915         } else if ((state == STATE_ANNOUNCING && event == EVENT_TIMEOUT && n_iteration >= ANNOUNCE_NUM-1)) {
916
917             daemon_log(LOG_INFO, "Successfully claimed IP address %s", inet_ntop(AF_INET, &addr, buf, sizeof(buf)));
918             set_state(STATE_RUNNING, 0, addr);
919
920             next_wakeup_valid = 0;
921
922             save_address(address_fn, addr);
923             
924             if (!retval_sent) {
925                 daemon_retval_send(0);
926                 retval_sent = 1;
927             }
928
929         } else if (event == EVENT_PACKET) {
930             ArpPacketInfo info;
931
932             assert(in_packet);
933             
934             if (packet_parse(in_packet, in_packet_len, &info) < 0)
935                 daemon_log(LOG_WARNING, "Failed to parse incoming ARP packet.");
936             else {
937                 int conflict = 0;
938
939                 if (info.sender_ip_address == addr) {
940                     /* Normal conflict */
941                     conflict = 1;
942                     daemon_log(LOG_INFO, "Recieved conflicting normal ARP packet.");
943                 } else if (state == STATE_WAITING_PROBE || state == STATE_PROBING || state == STATE_WAITING_ANNOUNCE) {
944                     /* Probe conflict */
945                     conflict = info.target_ip_address == addr && memcmp(hw_address, info.sender_hw_address, ETHER_ADDRLEN);
946                     daemon_log(LOG_INFO, "Recieved conflicting probe ARP packet.");
947                 }
948
949                 if (conflict) {
950                     
951                     if (state == STATE_RUNNING || state == STATE_ANNOUNCING)
952                         if (do_callout(dispatcher, CALLOUT_CONFLICT, iface, addr) < 0)
953                             goto fail;
954                     
955                     /* Pick a new address */
956                     addr = pick_addr(addr);
957
958                     daemon_log(LOG_INFO, "Trying address %s", inet_ntop(AF_INET, &addr, buf, sizeof(buf)));
959
960                     n_conflict++;
961
962                     set_state(STATE_WAITING_PROBE, 1, addr);
963                     
964                     if (n_conflict >= MAX_CONFLICTS) {
965                         daemon_log(LOG_WARNING, "Got too many conflicts, rate limiting new probes.");
966                         elapse_time(&next_wakeup, RATE_LIMIT_INTERVAL*1000, PROBE_WAIT*1000);
967                     } else
968                         elapse_time(&next_wakeup, 0, PROBE_WAIT*1000);
969
970                     next_wakeup_valid = 1;
971                 } else
972                     DEBUG(daemon_log(LOG_DEBUG, "Ignoring irrelevant ARP packet."));
973             }
974             
975         } else if (event == EVENT_ROUTABLE_ADDR_CONFIGURED) {
976
977             daemon_log(LOG_INFO, "A routable address has been configured.");
978
979             if (state == STATE_RUNNING || state == STATE_ANNOUNCING)
980                 if (do_callout(dispatcher, CALLOUT_UNBIND, iface, addr) < 0)
981                     goto fail;
982
983             if (!retval_sent) {
984                 daemon_retval_send(0);
985                 retval_sent = 1;
986             }
987             
988             set_state(STATE_SLEEPING, 1, addr);
989             next_wakeup_valid = 0;
990             
991         } else if (event == EVENT_ROUTABLE_ADDR_UNCONFIGURED && state == STATE_SLEEPING && !force_bind) {
992
993             daemon_log(LOG_INFO, "No longer a routable address configured, restarting probe process.");
994
995             set_state(STATE_WAITING_PROBE, 1, addr);
996
997             elapse_time(&next_wakeup, 0, PROBE_WAIT*1000);
998             next_wakeup_valid = 1;
999
1000         } else if (event == EVENT_REFRESH_REQUEST && state == STATE_RUNNING && !force_bind) {
1001
1002             /* The user requested a reannouncing of the address by a SIGHUP */
1003             daemon_log(LOG_INFO, "Reannouncing address.");
1004             
1005             /* Send announcement packet */
1006             out_packet = packet_new_announcement(addr, hw_address, &out_packet_len);
1007             set_state(STATE_ANNOUNCING, 1, addr);
1008
1009             elapse_time(&next_wakeup, ANNOUNCE_INTERVAL*1000, 0);
1010             next_wakeup_valid = 1;
1011         }
1012         
1013         if (out_packet) {
1014             DEBUG(daemon_log(LOG_DEBUG, "sending..."));
1015             
1016             if (send_packet(fd, iface, out_packet, out_packet_len) < 0)
1017                 goto fail;
1018             
1019             avahi_free(out_packet);
1020             out_packet = NULL;
1021         }
1022
1023         if (in_packet) {
1024             avahi_free(in_packet);
1025             in_packet = NULL;
1026         }
1027
1028         event = EVENT_NULL;
1029         timeout = -1;
1030         
1031         if (next_wakeup_valid) {
1032             usec = avahi_age(&next_wakeup);
1033             timeout = usec < 0 ? (int) (-usec/1000) : 0;
1034         }
1035
1036         DEBUG(daemon_log(LOG_DEBUG, "sleeping %ims", timeout));
1037                     
1038         while ((r = poll(pollfds, FD_MAX, timeout)) < 0 && errno == EINTR)
1039             ;
1040
1041         if (r < 0) {
1042             daemon_log(LOG_ERR, "poll() failed: %s", strerror(r));
1043             goto fail;
1044         } else if (r == 0) {
1045             event = EVENT_TIMEOUT;
1046             next_wakeup_valid = 0;
1047         } else {
1048             
1049             
1050             if (pollfds[FD_ARP].revents) {
1051
1052                 if (pollfds[FD_ARP].revents == POLLERR) {
1053                     /* The interface is probably down, let's recreate our socket */
1054                     
1055                     close(fd);
1056
1057                     if ((fd = open_socket(iface, hw_address)) < 0)
1058                         goto fail;
1059
1060                     pollfds[FD_ARP].fd = fd;
1061                     
1062                 } else {
1063                 
1064                     assert(pollfds[FD_ARP].revents == POLLIN);
1065                     
1066                     if (recv_packet(fd, &in_packet, &in_packet_len) < 0)
1067                         goto fail;
1068                     
1069                     if (in_packet)
1070                         event = EVENT_PACKET;
1071                 }
1072             }
1073
1074             if (event == EVENT_NULL &&
1075                 pollfds[FD_IFACE].revents) {
1076                 
1077                 assert(pollfds[FD_IFACE].revents == POLLIN);
1078
1079                 if (iface_process(&event) < 0)
1080                     goto fail;
1081             }
1082
1083             if (event == EVENT_NULL &&
1084                 pollfds[FD_SIGNAL].revents) {
1085
1086                 int sig;
1087                 assert(pollfds[FD_SIGNAL].revents == POLLIN);
1088
1089                 if ((sig = daemon_signal_next()) <= 0) {
1090                     daemon_log(LOG_ERR, "daemon_signal_next() failed");
1091                     goto fail;
1092                 }
1093
1094                 switch(sig) {
1095                     case SIGINT:
1096                     case SIGTERM:
1097                         daemon_log(LOG_INFO, "Got %s, quitting.", sig == SIGINT ? "SIGINT" : "SIGTERM");
1098                         ret = 0;
1099                         goto fail;
1100
1101                     case SIGCHLD:
1102                         waitpid(-1, NULL, WNOHANG);
1103                         break;
1104                     
1105                     case SIGHUP:
1106                         event = EVENT_REFRESH_REQUEST;
1107                         break;
1108                 }
1109                 
1110             }
1111         }
1112     }
1113
1114     ret = 0;
1115     
1116 fail:
1117
1118     if (state == STATE_RUNNING || state == STATE_ANNOUNCING)
1119         do_callout(dispatcher, CALLOUT_STOP, iface, addr);
1120
1121     avahi_free(out_packet);
1122     avahi_free(in_packet);
1123     
1124     if (fd >= 0)
1125         close(fd);
1126
1127     if (iface_fd >= 0)
1128         iface_done();
1129
1130     if (daemonize && !retval_sent)
1131         daemon_retval_send(ret);
1132
1133     if (dispatcher)
1134         fclose(dispatcher);
1135
1136     if (address_fn)
1137         avahi_free(address_fn);
1138     
1139     return ret;
1140 }
1141
1142
1143 static void help(FILE *f, const char *a0) {
1144     fprintf(f,
1145             "%s [options] INTERFACE\n"
1146             "    -h --help           Show this help\n"
1147             "    -D --daemonize      Daemonize after startup\n"
1148             "    -s --syslog         Write log messages to syslog(3) instead of STDERR\n"
1149             "    -k --kill           Kill a running daemon\n"
1150             "    -r --refresh        Request a running daemon to refresh it's IP address\n"
1151             "    -c --check          Return 0 if a daemon is already running\n"
1152             "    -V --version        Show version\n"
1153             "    -S --start=ADDRESS  Start with this address from the IPv4LL range\n"
1154             "                        169.254.0.0/16\n"
1155             "    -w --wait           Wait until an address has been acquired before\n"
1156             "                        daemonizing\n"
1157             "       --force-bind     Assign an IPv4LL address even if routable address\n"
1158             "                        is already assigned\n"
1159             "       --no-drop-root   Don't drop privileges\n"
1160 #ifdef HAVE_CHROOT            
1161             "       --no-chroot      Don't chroot()\n"
1162 #endif            
1163             "       --no-proc-title  Don't modify process title\n"
1164             "       --debug          Increase verbosity\n",
1165             a0);
1166 }
1167
1168 static int parse_command_line(int argc, char *argv[]) {
1169     int c;
1170     
1171     enum {
1172         OPTION_NO_PROC_TITLE = 256,
1173         OPTION_FORCE_BIND,
1174         OPTION_DEBUG,
1175         OPTION_NO_DROP_ROOT,
1176 #ifdef HAVE_CHROOT
1177         OPTION_NO_CHROOT
1178 #endif        
1179     };
1180     
1181     static const struct option long_options[] = {
1182         { "help",          no_argument,       NULL, 'h' },
1183         { "daemonize",     no_argument,       NULL, 'D' },
1184         { "syslog",        no_argument,       NULL, 's' },
1185         { "kill",          no_argument,       NULL, 'k' },
1186         { "refresh",       no_argument,       NULL, 'r' },
1187         { "check",         no_argument,       NULL, 'c' },
1188         { "version",       no_argument,       NULL, 'V' },
1189         { "start",         required_argument, NULL, 'S' },
1190         { "wait",          no_argument,       NULL, 'w' },
1191         { "force-bind",    no_argument,       NULL, OPTION_FORCE_BIND },
1192         { "no-drop-root",  no_argument,       NULL, OPTION_NO_DROP_ROOT },
1193 #ifdef HAVE_CHROOT            
1194         { "no-chroot",     no_argument,       NULL, OPTION_NO_CHROOT },
1195 #endif        
1196         { "no-proc-title", no_argument,       NULL, OPTION_NO_PROC_TITLE },
1197         { "debug",         no_argument,       NULL, OPTION_DEBUG },
1198         { NULL, 0, NULL, 0 }
1199     };
1200
1201     opterr = 0;
1202     while ((c = getopt_long(argc, argv, "hDskrcVS:w", long_options, NULL)) >= 0) {
1203
1204         switch(c) {
1205             case 's':
1206                 use_syslog = 1;
1207                 break;
1208             case 'h':
1209                 command = DAEMON_HELP;
1210                 break;
1211             case 'D':
1212                 daemonize = 1;
1213                 break;
1214             case 'k':
1215                 command = DAEMON_KILL;
1216                 break;
1217             case 'V':
1218                 command = DAEMON_VERSION;
1219                 break;
1220             case 'r':
1221                 command = DAEMON_REFRESH;
1222                 break;
1223             case 'c':
1224                 command = DAEMON_CHECK;
1225                 break;
1226             case 'S':
1227                 
1228                 if ((start_address = inet_addr(optarg)) == (uint32_t) -1) {
1229                     fprintf(stderr, "Failed to parse IP address '%s'.", optarg);
1230                     return -1;
1231                 }
1232                 break;
1233             case 'w':
1234                 wait_for_address = 1;
1235                 break;
1236                 
1237             case OPTION_NO_PROC_TITLE:
1238                 modify_proc_title = 0;
1239                 break;
1240
1241             case OPTION_DEBUG:
1242                 debug = 1;
1243                 break;
1244
1245             case OPTION_FORCE_BIND:
1246                 force_bind = 1;
1247                 break;
1248
1249             case OPTION_NO_DROP_ROOT:
1250                 no_drop_root = 1;
1251                 break;
1252
1253 #ifdef HAVE_CHROOT
1254             case OPTION_NO_CHROOT:
1255                 no_chroot = 1;
1256                 break;
1257 #endif
1258
1259             default:
1260                 fprintf(stderr, "Invalid command line argument: %c\n", c);
1261                 return -1;
1262         }
1263     }
1264
1265     if (command == DAEMON_RUN ||
1266         command == DAEMON_KILL ||
1267         command == DAEMON_REFRESH ||
1268         command == DAEMON_CHECK) {
1269
1270         if (optind >= argc) {
1271             fprintf(stderr, "Missing interface name.\n");
1272             return -1;
1273         }
1274
1275         interface_name = avahi_strdup(argv[optind++]);
1276     }
1277
1278     if (optind != argc) {
1279         fprintf(stderr, "Too many arguments\n");
1280         return -1;
1281     }
1282         
1283     return 0;
1284 }
1285
1286 static const char* pid_file_proc(void) {
1287     return pid_file_name;
1288 }
1289
1290 int main(int argc, char*argv[]) {
1291     int r = 1;
1292     char *log_ident = NULL;
1293
1294     signal(SIGPIPE, SIG_IGN);
1295     
1296     if ((argv0 = strrchr(argv[0], '/')))
1297         argv0 = avahi_strdup(argv0 + 1);
1298     else
1299         argv0 = avahi_strdup(argv[0]);
1300
1301     daemon_log_ident = argv0;
1302     
1303     if (parse_command_line(argc, argv) < 0)
1304         goto finish;
1305
1306     if (modify_proc_title)
1307         avahi_init_proc_title(argc, argv);
1308
1309     daemon_log_ident = log_ident = avahi_strdup_printf("%s(%s)", argv0, interface_name);
1310     daemon_pid_file_proc = pid_file_proc;
1311     pid_file_name = avahi_strdup_printf(AVAHI_RUNTIME_DIR"/avahi-autoipd.%s.pid", interface_name);
1312
1313     if (command == DAEMON_RUN) {
1314         pid_t pid;
1315         int ifindex;
1316
1317         init_rand_seed();
1318         
1319         if ((ifindex = if_nametoindex(interface_name)) <= 0) {
1320             daemon_log(LOG_ERR, "Failed to get index for interface name '%s': %s", interface_name, strerror(errno));
1321             goto finish;
1322         }
1323
1324         if (getuid() != 0) {
1325             daemon_log(LOG_ERR, "This program is intended to be run as root.");
1326             goto finish;
1327         }
1328
1329         if ((pid = daemon_pid_file_is_running()) >= 0) {
1330             daemon_log(LOG_ERR, "Daemon already running on PID %u", pid);
1331             goto finish;
1332         }
1333
1334         if (daemonize) {
1335             daemon_retval_init();
1336             
1337             if ((pid = daemon_fork()) < 0)
1338                 goto finish;
1339             else if (pid != 0) {
1340                 int ret;
1341                 /** Parent **/
1342
1343                 if ((ret = daemon_retval_wait(20)) < 0) {
1344                     daemon_log(LOG_ERR, "Could not receive return value from daemon process.");
1345                     goto finish;
1346                 }
1347
1348                 r = ret;
1349                 goto finish;
1350             }
1351
1352             /* Child */
1353         }
1354
1355         if (use_syslog || daemonize)
1356             daemon_log_use = DAEMON_LOG_SYSLOG;
1357
1358         chdir("/");
1359
1360         if (daemon_pid_file_create() < 0) {
1361             daemon_log(LOG_ERR, "Failed to create PID file: %s", strerror(errno));
1362
1363             if (daemonize)
1364                 daemon_retval_send(1);
1365             goto finish;
1366         } else
1367             wrote_pid_file = 1;
1368
1369         avahi_set_proc_title(argv0, "%s: [%s] starting up", argv0, interface_name);
1370         
1371         if (loop(ifindex, start_address) < 0)
1372             goto finish;
1373
1374         r = 0;
1375     } else if (command == DAEMON_HELP) {
1376         help(stdout, argv0);
1377         
1378         r = 0;
1379     } else if (command == DAEMON_VERSION) {
1380         printf("%s "PACKAGE_VERSION"\n", argv0);
1381         
1382         r = 0;
1383     } else if (command == DAEMON_KILL) {
1384         if (daemon_pid_file_kill_wait(SIGTERM, 5) < 0) {
1385             daemon_log(LOG_WARNING, "Failed to kill daemon: %s", strerror(errno));
1386             goto finish;
1387         }
1388         
1389         r = 0;
1390     } else if (command == DAEMON_REFRESH) {
1391         if (daemon_pid_file_kill(SIGHUP) < 0) {
1392             daemon_log(LOG_WARNING, "Failed to kill daemon: %s", strerror(errno));
1393             goto finish;
1394         }
1395
1396         r = 0;
1397     } else if (command == DAEMON_CHECK)
1398         r = (daemon_pid_file_is_running() >= 0) ? 0 : 1;
1399
1400
1401 finish:
1402
1403     if (daemonize)
1404         daemon_retval_done();
1405     
1406     if (wrote_pid_file)
1407         daemon_pid_file_remove();
1408
1409     avahi_free(log_ident);
1410     avahi_free(pid_file_name);
1411     avahi_free(argv0);
1412     avahi_free(interface_name);
1413
1414     return r;
1415 }
1416
1417 /* TODO:
1418
1419 - man page
1420
1421 */