[thirdparty/lldpd.git] / src / daemon / lldpd.c

/* -*- mode: c; c-file-style: "openbsd" -*- */
/*
 * Copyright (c) 2008 Vincent Bernat <bernat@luffy.cx>
 *
 * Permission to use, copy, modify, and/or distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */

#include "lldpd.h"

#include <stdio.h>
#include <unistd.h>
#include <errno.h>
#include <signal.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <time.h>
#include <libgen.h>
#include <assert.h>
#include <sys/utsname.h>
#include <sys/types.h>
#include <sys/wait.h>
#include <sys/socket.h>
#include <sys/select.h>
#include <sys/time.h>
#include <sys/ioctl.h>
#include <arpa/inet.h>
#include <net/if_arp.h>
#include <pwd.h>
#include <grp.h>

static void              usage(void);

static struct protocol protos[] =
{
        { LLDPD_MODE_LLDP, 1, "LLDP", 'l', lldp_send, lldp_decode, NULL,
          LLDP_MULTICAST_ADDR },
#ifdef ENABLE_CDP
        { LLDPD_MODE_CDPV1, 0, "CDPv1", 'c', cdpv1_send, cdp_decode, cdpv1_guess,
          CDP_MULTICAST_ADDR },
        { LLDPD_MODE_CDPV2, 0, "CDPv2", 'c', cdpv2_send, cdp_decode, cdpv2_guess,
          CDP_MULTICAST_ADDR },
#endif
#ifdef ENABLE_SONMP
        { LLDPD_MODE_SONMP, 0, "SONMP", 's', sonmp_send, sonmp_decode, NULL,
          SONMP_MULTICAST_ADDR },
#endif
#ifdef ENABLE_EDP
        { LLDPD_MODE_EDP, 0, "EDP", 'e', edp_send, edp_decode, NULL,
          EDP_MULTICAST_ADDR },
#endif
#ifdef ENABLE_FDP
        { LLDPD_MODE_FDP, 0, "FDP", 'f', fdp_send, cdp_decode, NULL,
          FDP_MULTICAST_ADDR },
#endif
        { 0, 0, "any", ' ', NULL, NULL, NULL,
          {0,0,0,0,0,0} }
};

static char             **saved_argv;
#ifdef HAVE___PROGNAME
extern const char       *__progname;
#else
# define __progname "lldpd"
#endif

static void
usage(void)
{
        fprintf(stderr, "Usage:   %s [OPTIONS ...]\n", __progname);
        fprintf(stderr, "Version: %s\n", PACKAGE_STRING);

        fprintf(stderr, "\n");

        fprintf(stderr, "-d       Do not daemonize.\n");
        fprintf(stderr, "-r       Receive-only mode\n");
        fprintf(stderr, "-i       Disable LLDP-MED inventory TLV transmission.\n");
        fprintf(stderr, "-k       Disable advertising of kernel release, version, machine.\n");
        fprintf(stderr, "-S descr Override the default system description.\n");
        fprintf(stderr, "-P name  Override the default hardware platform.\n");
        fprintf(stderr, "-m IP    Specify the IPv4 management addresses of this system.\n");
        fprintf(stderr, "-H mode  Specify the behaviour when detecting multiple neighbors.\n");
        fprintf(stderr, "-I iface Limit interfaces to use.\n");
#ifdef ENABLE_LLDPMED
        fprintf(stderr, "-M class Enable emission of LLDP-MED frame. 'class' should be one of:\n");
        fprintf(stderr, "             1 Generic Endpoint (Class I)\n");
        fprintf(stderr, "             2 Media Endpoint (Class II)\n");
        fprintf(stderr, "             3 Communication Device Endpoints (Class III)\n");
        fprintf(stderr, "             4 Network Connectivity Device\n");
#endif
#ifdef USE_SNMP
        fprintf(stderr, "-x       Enable SNMP subagent.\n");
#endif
        fprintf(stderr, "\n");

#if defined ENABLE_CDP || defined ENABLE_EDP || defined ENABLE_FDP || defined ENABLE_SONMP
        fprintf(stderr, "Additional protocol support.\n");
#ifdef ENABLE_CDP
        fprintf(stderr, "-c       Enable the support of CDP protocol. (Cisco)\n");
#endif
#ifdef ENABLE_EDP
        fprintf(stderr, "-e       Enable the support of EDP protocol. (Extreme)\n");
#endif
#ifdef ENABLE_FDP
        fprintf(stderr, "-f       Enable the support of FDP protocol. (Foundry)\n");
#endif
#ifdef ENABLE_SONMP
        fprintf(stderr, "-s       Enable the support of SONMP protocol. (Nortel)\n");
#endif

        fprintf(stderr, "\n");
#endif

        fprintf(stderr, "see manual page lldpd(8) for more information\n");
        exit(1);
}

struct lldpd_hardware *
lldpd_get_hardware(struct lldpd *cfg, char *name, int index, struct lldpd_ops *ops)
{
        struct lldpd_hardware *hardware;
        TAILQ_FOREACH(hardware, &cfg->g_hardware, h_entries) {
                if ((strcmp(hardware->h_ifname, name) == 0) &&
                    (hardware->h_ifindex == index) &&
                    ((!ops) || (ops == hardware->h_ops)))
                        break;
        }
        return hardware;
}

struct lldpd_hardware *
lldpd_alloc_hardware(struct lldpd *cfg, char *name)
{
        struct lldpd_hardware *hardware;

        if ((hardware = (struct lldpd_hardware *)
                calloc(1, sizeof(struct lldpd_hardware))) == NULL)
                return NULL;

        hardware->h_cfg = cfg;
        strlcpy(hardware->h_ifname, name, sizeof(hardware->h_ifname));
        hardware->h_lport.p_chassis = LOCAL_CHASSIS(cfg);
        hardware->h_lport.p_chassis->c_refcount++;
        TAILQ_INIT(&hardware->h_rports);

#ifdef ENABLE_LLDPMED
        if (LOCAL_CHASSIS(cfg)->c_med_cap_available) {
                hardware->h_lport.p_med_cap_enabled = LLDP_MED_CAP_CAP;
                if (!cfg->g_config.c_noinventory)
                        hardware->h_lport.p_med_cap_enabled |= LLDP_MED_CAP_IV;
        }
#endif
#ifdef ENABLE_DOT1
        TAILQ_INIT(&hardware->h_lport.p_vlans);
        TAILQ_INIT(&hardware->h_lport.p_ppvids);
        TAILQ_INIT(&hardware->h_lport.p_pids);
#endif

        levent_hardware_init(hardware);
        return hardware;
}

struct lldpd_mgmt *
lldpd_alloc_mgmt(int family, void *addrptr, size_t addrsize, u_int32_t iface)
{
        struct lldpd_mgmt *mgmt;
        
        if (family <= LLDPD_AF_UNSPEC || family >= LLDPD_AF_LAST) {
                errno = EAFNOSUPPORT;
                return NULL;
        }
        if (addrsize > LLDPD_MGMT_MAXADDRSIZE) {
                errno = EOVERFLOW;
                return NULL;
        }
        mgmt = calloc(1, sizeof(struct lldpd_mgmt));
        if (mgmt == NULL) {
                errno = ENOMEM;
                return NULL;
        }
        mgmt->m_family = family;
        assert(addrsize <= LLDPD_MGMT_MAXADDRSIZE);
        memcpy(&mgmt->m_addr, addrptr, addrsize);
        mgmt->m_addrsize = addrsize;
        mgmt->m_iface = iface;
        return mgmt;
}

void
lldpd_hardware_cleanup(struct lldpd *cfg, struct lldpd_hardware *hardware)
{
        lldpd_port_cleanup(&hardware->h_lport, 1);
        if (hardware->h_ops->cleanup)
                hardware->h_ops->cleanup(cfg, hardware);
        levent_hardware_release(hardware);
        free(hardware);
}

static void
notify_clients_deletion(struct lldpd_hardware *hardware,
    struct lldpd_port *rport)
{
        levent_ctl_notify(hardware->h_ifname, NEIGHBOR_CHANGE_DELETED,
            rport);
#ifdef USE_SNMP
        agent_notify(hardware, NEIGHBOR_CHANGE_DELETED, rport);
#endif
}

static void
lldpd_cleanup(struct lldpd *cfg)
{
        struct lldpd_hardware *hardware, *hardware_next;
        struct lldpd_chassis *chassis, *chassis_next;

        for (hardware = TAILQ_FIRST(&cfg->g_hardware); hardware != NULL;
             hardware = hardware_next) {
                hardware_next = TAILQ_NEXT(hardware, h_entries);
                if (!hardware->h_flags) {
                        TAILQ_REMOVE(&cfg->g_hardware, hardware, h_entries);
                        lldpd_remote_cleanup(hardware, NULL);
                        lldpd_hardware_cleanup(cfg, hardware);
                } else
                        lldpd_remote_cleanup(hardware, notify_clients_deletion);
        }

        for (chassis = TAILQ_FIRST(&cfg->g_chassis); chassis;
             chassis = chassis_next) {
                chassis_next = TAILQ_NEXT(chassis, c_entries);
                if (chassis->c_refcount == 0) {
                        TAILQ_REMOVE(&cfg->g_chassis, chassis, c_entries);
                        lldpd_chassis_cleanup(chassis, 1);
                }
        }
}

/* Update chassis `ochassis' with values from `chassis'. The later one is not
   expected to be part of a list! It will also be wiped from memory. */
static void
lldpd_move_chassis(struct lldpd_chassis *ochassis,
    struct lldpd_chassis *chassis) {
        struct lldpd_mgmt *mgmt, *mgmt_next;

        /* We want to keep refcount, index and list stuff from the current
         * chassis */
        TAILQ_ENTRY(lldpd_chassis) entries;
        int refcount = ochassis->c_refcount;
        int index = ochassis->c_index;
        memcpy(&entries, &ochassis->c_entries,
            sizeof(entries));
        lldpd_chassis_cleanup(ochassis, 0);

        /* Make the copy. */
        /* WARNING: this is a kludgy hack, we need in-place copy and cannot use
         * marshaling. */
        memcpy(ochassis, chassis, sizeof(struct lldpd_chassis));
        TAILQ_INIT(&ochassis->c_mgmt);

        /* Copy of management addresses */
        for (mgmt = TAILQ_FIRST(&chassis->c_mgmt);
             mgmt != NULL;
             mgmt = mgmt_next) {
                mgmt_next = TAILQ_NEXT(mgmt, m_entries);
                TAILQ_REMOVE(&chassis->c_mgmt, mgmt, m_entries);
                TAILQ_INSERT_TAIL(&ochassis->c_mgmt, mgmt, m_entries);
        }

        /* Restore saved values */
        ochassis->c_refcount = refcount;
        ochassis->c_index = index;
        memcpy(&ochassis->c_entries, &entries, sizeof(entries));

        /* Get rid of the new chassis */
        free(chassis);
}

static int
lldpd_guess_type(struct lldpd *cfg, char *frame, int s)
{
        int i;
        if (s < ETH_ALEN)
                return -1;
        for (i=0; cfg->g_protocols[i].mode != 0; i++) {
                if (!cfg->g_protocols[i].enabled)
                        continue;
                if (cfg->g_protocols[i].guess == NULL) {
                        if (memcmp(frame, cfg->g_protocols[i].mac, ETH_ALEN) == 0)
                                return cfg->g_protocols[i].mode;
                } else {
                        if (cfg->g_protocols[i].guess(frame, s))
                                return cfg->g_protocols[i].mode;
                }
        }
        return -1;
}

static void
lldpd_decode(struct lldpd *cfg, char *frame, int s,
    struct lldpd_hardware *hardware)
{
        int i, result;
        struct lldpd_chassis *chassis, *ochassis = NULL;
        struct lldpd_port *port, *oport = NULL, *aport;
        int guess = LLDPD_MODE_LLDP;

        if (s < sizeof(struct ethhdr) + 4)
                /* Too short, just discard it */
                return;
        /* Decapsulate VLAN frames */
        if (((struct ethhdr*)frame)->h_proto == htons(ETHERTYPE_VLAN)) {
                /* VLAN decapsulation means to shift 4 bytes left the frame from
                 * offset 2*ETH_ALEN */
                memmove(frame + 2*ETH_ALEN, frame + 2*ETH_ALEN + 4, s - 2*ETH_ALEN);
                s -= 4;
        }

        TAILQ_FOREACH(oport, &hardware->h_rports, p_entries) {
                if ((oport->p_lastframe != NULL) &&
                    (oport->p_lastframe->size == s) &&
                    (memcmp(oport->p_lastframe->frame, frame, s) == 0)) {
                        /* Already received the same frame */
                        oport->p_lastupdate = time(NULL);
                        return;
                }
        }

        guess = lldpd_guess_type(cfg, frame, s);
        for (i=0; cfg->g_protocols[i].mode != 0; i++) {
                if (!cfg->g_protocols[i].enabled)
                        continue;
                if (cfg->g_protocols[i].mode == guess) {
                        if ((result = cfg->g_protocols[i].decode(cfg, frame,
                                    s, hardware, &chassis, &port)) == -1)
                                return;
                        chassis->c_protocol = port->p_protocol =
                            cfg->g_protocols[i].mode;
                        break;
                        }
        }
        if (cfg->g_protocols[i].mode == 0) {
                LLOG_DEBUG("unable to guess frame type on %s",
                    hardware->h_ifname);
                return;
        }

        /* Do we already have the same MSAP somewhere? */
        TAILQ_FOREACH(oport, &hardware->h_rports, p_entries) {
                if ((port->p_protocol == oport->p_protocol) &&
                    (port->p_id_subtype == oport->p_id_subtype) &&
                    (port->p_id_len == oport->p_id_len) &&
                    (memcmp(port->p_id, oport->p_id, port->p_id_len) == 0) &&
                    (chassis->c_id_subtype == oport->p_chassis->c_id_subtype) &&
                    (chassis->c_id_len == oport->p_chassis->c_id_len) &&
                    (memcmp(chassis->c_id, oport->p_chassis->c_id,
                        chassis->c_id_len) == 0)) {
                        ochassis = oport->p_chassis;
                        break;
                }
        }
        /* No, but do we already know the system? */
        if (!oport) {
                TAILQ_FOREACH(ochassis, &cfg->g_chassis, c_entries) {
                        if ((chassis->c_protocol == ochassis->c_protocol) &&
                            (chassis->c_id_subtype == ochassis->c_id_subtype) &&
                            (chassis->c_id_len == ochassis->c_id_len) &&
                            (memcmp(chassis->c_id, ochassis->c_id,
                                chassis->c_id_len) == 0))
                        break;
                }
        }

        if (oport) {
                /* The port is known, remove it before adding it back */
                TAILQ_REMOVE(&hardware->h_rports, oport, p_entries);
                lldpd_port_cleanup(oport, 1);
                free(oport);
        }
        if (ochassis) {
                lldpd_move_chassis(ochassis, chassis);
                chassis = ochassis;
        } else {
                /* Chassis not known, add it */
                chassis->c_index = ++cfg->g_lastrid;
                chassis->c_refcount = 0;
                TAILQ_INSERT_TAIL(&cfg->g_chassis, chassis, c_entries);
                i = 0; TAILQ_FOREACH(ochassis, &cfg->g_chassis, c_entries) i++;
                LLOG_DEBUG("Currently, we know %d different systems", i);
        }
        /* Add port */
        port->p_lastchange = port->p_lastupdate = time(NULL);
        if ((port->p_lastframe = (struct lldpd_frame *)malloc(s +
                    sizeof(struct lldpd_frame))) != NULL) {
                port->p_lastframe->size = s;
                memcpy(port->p_lastframe->frame, frame, s);
        }
        TAILQ_INSERT_TAIL(&hardware->h_rports, port, p_entries);
        port->p_chassis = chassis;
        port->p_chassis->c_refcount++;
        /* Several cases are possible :
             1. chassis is new, its refcount was 0. It is now attached
                to this port, its refcount is 1.
             2. chassis already exists and was attached to another
                port, we increase its refcount accordingly.
             3. chassis already exists and was attached to the same
                port, its refcount was decreased with
                lldpd_port_cleanup() and is now increased again.

           In all cases, if the port already existed, it has been
           freed with lldpd_port_cleanup() and therefore, the refcount
           of the chassis that was attached to it is decreased.
        */
        i = 0; TAILQ_FOREACH(aport, &hardware->h_rports, p_entries)
                i++;
        LLOG_DEBUG("Currently, %s knows %d neighbors",
            hardware->h_ifname, i);

        if (!oport) hardware->h_insert_cnt++;

        /* Notify */
        i = oport?NEIGHBOR_CHANGE_UPDATED:NEIGHBOR_CHANGE_ADDED;
        levent_ctl_notify(hardware->h_ifname, i, port);
#ifdef USE_SNMP
        agent_notify(hardware, i, port);
#endif

        return;
}

/* Get the output of lsb_release -s -d.  This is a slow function. It should be
   called once. It return NULL if any problem happens. Otherwise, this is a
   statically allocated buffer. The result includes the trailing \n  */
static char *
lldpd_get_lsb_release() {
        static char release[1024];
        char *const command[] = { "lsb_release", "-s", "-d", NULL };
        int pid, status, devnull, count;
        int pipefd[2];

        if (pipe(pipefd)) {
                LLOG_WARN("unable to get a pair of pipes");
                return NULL;
        }

        if ((pid = fork()) < 0) {
                LLOG_WARN("unable to fork");
                return NULL;
        }
        switch (pid) {
        case 0:
                /* Child, exec lsb_release */
                close(pipefd[0]);
                if ((devnull = open("/dev/null", O_RDWR, 0)) != -1) {
                        dup2(devnull, STDIN_FILENO);
                        dup2(devnull, STDERR_FILENO);
                        dup2(pipefd[1], STDOUT_FILENO);
                        if (devnull > 2) close(devnull);
                        if (pipefd[1] > 2) close(pipefd[1]);
                        execvp("lsb_release", command);
                }
                exit(127);
                break;
        default:
                /* Father, read the output from the children */
                close(pipefd[1]);
                count = 0;
                do {
                        status = read(pipefd[0], release+count, sizeof(release)-count);
                        if ((status == -1) && (errno == EINTR)) continue;
                        if (status > 0)
                                count += status;
                } while (count < sizeof(release) && (status > 0));
                if (status < 0) {
                        LLOG_WARN("unable to read from lsb_release");
                        close(pipefd[0]);
                        waitpid(pid, &status, 0);
                        return NULL;
                }
                close(pipefd[0]);
                if (count >= sizeof(release)) {
                        LLOG_INFO("output of lsb_release is too large");
                        waitpid(pid, &status, 0);
                        return NULL;
                }
                status = -1;
                if (waitpid(pid, &status, 0) != pid)
                        return NULL;
                if (!WIFEXITED(status) || (WEXITSTATUS(status) != 0)) {
                        LLOG_INFO("lsb_release information not available");
                        return NULL;
                }
                if (!count) {
                        LLOG_INFO("lsb_release returned an empty string");
                        return NULL;
                }
                release[count] = '\0';
                return release;
        }
        /* Should not be here */
        return NULL;
}

/* Same like lldpd_get_lsb_release but reads /etc/os-release for PRETTY_NAME=. */
static char *
lldpd_get_os_release() {
        static char release[1024];
        char line[1024];
        char *key, *val;
        char *ptr1 = release;
        char *ptr2 = release;

        FILE *fp = fopen("/etc/os-release", "r");
        if (!fp) {
                LLOG_WARN("could not open /etc/os-release");
                return NULL;
        }

        while ((fgets(line, 1024, fp) != NULL)) {
                key = strtok(line, "=");
                val = strtok(NULL, "=");

                if (strncmp(key, "PRETTY_NAME", 1024) == 0) {
                        strncpy(release, val, 1024);
                        break;
                }
        }
        fclose(fp);

        /* Remove trailing newline and all " in the string. */
        while (*ptr1 != 0) {
                if ((*ptr1 == '"') || (*ptr1 == '\n')) {
                        ++ptr1;
                } else {
                        *ptr2++ = *ptr1++;
                }
        }
        *ptr2 = 0;

        return release;
}

static void
lldpd_hide_ports(struct lldpd *cfg, struct lldpd_hardware *hardware, int mask) {
        struct lldpd_port *port;
        int protocols[LLDPD_MODE_MAX+1];
        char buffer[256];
        int i, j, k, found;
        unsigned int min;

        /* Compute the number of occurrences of each protocol */
        for (i = 0; i <= LLDPD_MODE_MAX; i++) protocols[i] = 0;
        TAILQ_FOREACH(port, &hardware->h_rports, p_entries)
                protocols[port->p_protocol]++;

        /* Turn the protocols[] array into an array of
           enabled/disabled protocols. 1 means enabled, 0
           means disabled. */
        min = (unsigned int)-1;
        for (i = 0; i <= LLDPD_MODE_MAX; i++)
                if (protocols[i] && (protocols[i] < min))
                        min = protocols[i];
        found = 0;
        for (i = 0; i <= LLDPD_MODE_MAX; i++)
                if ((protocols[i] == min) && !found) {
                        /* If we need a tie breaker, we take
                           the first protocol only */
                        if (cfg->g_config.c_smart & mask &
                            (SMART_OUTGOING_ONE_PROTO | SMART_INCOMING_ONE_PROTO))
                                found = 1;
                        protocols[i] = 1;
                } else protocols[i] = 0;

        /* We set the p_hidden flag to 1 if the protocol is disabled */
        TAILQ_FOREACH(port, &hardware->h_rports, p_entries) {
                if (mask == SMART_OUTGOING)
                        port->p_hidden_out = protocols[port->p_protocol]?0:1;
                else
                        port->p_hidden_in = protocols[port->p_protocol]?0:1;
        }

        /* If we want only one neighbor, we take the first one */
        if (cfg->g_config.c_smart & mask &
            (SMART_OUTGOING_ONE_NEIGH | SMART_INCOMING_ONE_NEIGH)) {
                found = 0;
                TAILQ_FOREACH(port, &hardware->h_rports, p_entries) {
                        if (mask == SMART_OUTGOING) {
                                if (found) port->p_hidden_out = 1;
                                if (!port->p_hidden_out)
                                        found = 1;
                        }
                        if (mask == SMART_INCOMING) {
                                if (found) port->p_hidden_in = 1;
                                if (!port->p_hidden_in)
                                        found = 1;
                        }
                }
        }

        /* Print a debug message summarizing the operation */
        for (i = 0; i <= LLDPD_MODE_MAX; i++) protocols[i] = 0;
        k = j = 0;
        TAILQ_FOREACH(port, &hardware->h_rports, p_entries) {
                if (!(((mask == SMART_OUTGOING) && port->p_hidden_out) ||
                      ((mask == SMART_INCOMING) && port->p_hidden_in))) {
                        k++;
                        protocols[port->p_protocol] = 1;
                }
                j++;
        }
        buffer[0] = '\0';
        for (i=0; cfg->g_protocols[i].mode != 0; i++) {
                if (cfg->g_protocols[i].enabled && protocols[cfg->g_protocols[i].mode]) {
                        if (strlen(buffer) +
                            strlen(cfg->g_protocols[i].name) + 3 > sizeof(buffer)) {
                                /* Unlikely, our buffer is too small */
                                memcpy(buffer + sizeof(buffer) - 4, "...", 4);
                                break;
                        }
                        if (buffer[0])
                                strcat(buffer, ", ");
                        strcat(buffer, cfg->g_protocols[i].name);
                }
        }
        LLOG_DEBUG("[%s] %s: %d visible neigh / %d. Protocols: %s.",
                   (mask == SMART_OUTGOING)?"out filter":"in filter",
                   hardware->h_ifname, k, j, buffer[0]?buffer:"(none)");
}

/* Hide unwanted ports depending on smart mode set by the user */
static void
lldpd_hide_all(struct lldpd *cfg)
{
        struct lldpd_hardware *hardware;

        if (!cfg->g_config.c_smart)
                return;
        TAILQ_FOREACH(hardware, &cfg->g_hardware, h_entries) {
                if (cfg->g_config.c_smart & SMART_INCOMING_FILTER)
                        lldpd_hide_ports(cfg, hardware, SMART_INCOMING);
                if (cfg->g_config.c_smart & SMART_OUTGOING_FILTER)
                        lldpd_hide_ports(cfg, hardware, SMART_OUTGOING);
        }
}

void
lldpd_recv(struct lldpd *cfg, struct lldpd_hardware *hardware, int fd)
{
        char *buffer = NULL;
        int n;
        if ((buffer = (char *)malloc(hardware->h_mtu)) == NULL) {
                LLOG_WARN("failed to alloc reception buffer");
                return;
        }
        if ((n = hardware->h_ops->recv(cfg, hardware,
                    fd, buffer,
                    hardware->h_mtu)) == -1) {
                free(buffer);
                return;
        }
        hardware->h_rx_cnt++;
        lldpd_decode(cfg, buffer, n, hardware);
        lldpd_hide_all(cfg); /* Immediatly hide */
        free(buffer);
}

static void
lldpd_send_all(struct lldpd *cfg)
{
        struct lldpd_hardware *hardware;
        struct lldpd_port *port;
        int i, sent;

        cfg->g_lastsent = time(NULL);
        if (cfg->g_config.c_receiveonly) return;
        TAILQ_FOREACH(hardware, &cfg->g_hardware, h_entries) {
                /* Ignore if interface is down */
                if ((hardware->h_flags & IFF_RUNNING) == 0)
                        continue;

                sent = 0;
                for (i=0; cfg->g_protocols[i].mode != 0; i++) {
                        if (!cfg->g_protocols[i].enabled)
                                continue;
                        /* We send only if we have at least one remote system
                         * speaking this protocol or if the protocol is forced */
                        if (cfg->g_protocols[i].enabled > 1) {
                                cfg->g_protocols[i].send(cfg, hardware);
                                sent++;
                                continue;
                        }
                        TAILQ_FOREACH(port, &hardware->h_rports, p_entries) {
                                /* If this remote port is disabled, we don't
                                 * consider it */
                                if (port->p_hidden_out)
                                        continue;
                                if (port->p_protocol ==
                                    cfg->g_protocols[i].mode) {
                                        cfg->g_protocols[i].send(cfg,
                                            hardware);
                                        sent++;
                                        break;
                                }
                        }
                }

                if (!sent) {
                        /* Nothing was sent for this port, let's speak the first
                         * available protocol. */
                        for (i = 0; cfg->g_protocols[i].mode != 0; i++) {
                                if (!cfg->g_protocols[i].enabled) continue;
                                cfg->g_protocols[i].send(cfg,
                                    hardware);
                                break;
                        }
                        if (cfg->g_protocols[i].mode == 0)
                                LLOG_WARNX("no protocol enabled, dunno what to send");
                }
        }
}

#ifdef ENABLE_LLDPMED
static void
lldpd_med(struct lldpd_chassis *chassis)
{
#if __i386__ || __amd64__
        static short int once = 0;
        if (!once) {
                chassis->c_med_hw = dmi_hw();
                chassis->c_med_fw = dmi_fw();
                chassis->c_med_sn = dmi_sn();
                chassis->c_med_manuf = dmi_manuf();
                chassis->c_med_model = dmi_model();
                chassis->c_med_asset = dmi_asset();
                once = 1;
        }
#endif
}
#endif

static void
lldpd_update_localchassis(struct lldpd *cfg)
{
        struct utsname un;
        char *hp;
        int f;
        char status;

        /* Set system name and description */
        if (uname(&un) != 0)
                fatal("failed to get system information");
        if ((hp = priv_gethostbyname()) == NULL)
                fatal("failed to get system name");
        free(LOCAL_CHASSIS(cfg)->c_name);
        free(LOCAL_CHASSIS(cfg)->c_descr);
        if ((LOCAL_CHASSIS(cfg)->c_name = strdup(hp)) == NULL)
                fatal(NULL);
        if (cfg->g_config.c_description) {
                if (asprintf(&LOCAL_CHASSIS(cfg)->c_descr, "%s",
                        cfg->g_config.c_description) == -1)
                        fatal("failed to set full system description");
        } else {
                if (cfg->g_config.c_advertise_version) {
                        if (asprintf(&LOCAL_CHASSIS(cfg)->c_descr, "%s %s %s %s %s",
                                cfg->g_lsb_release?cfg->g_lsb_release:"",
                                un.sysname, un.release, un.version, un.machine)
                                == -1)
                                fatal("failed to set full system description");
                } else {
                        if (asprintf(&LOCAL_CHASSIS(cfg)->c_descr, "%s",
                                cfg->g_lsb_release?cfg->g_lsb_release:un.sysname) == -1)
                                fatal("failed to set minimal system description");
                }
        }

        /* Check forwarding */
        if ((f = priv_open("/proc/sys/net/ipv4/ip_forward")) >= 0) {
                if ((read(f, &status, 1) == 1) && (status == '1'))
                        LOCAL_CHASSIS(cfg)->c_cap_enabled |= LLDP_CAP_ROUTER;
                else
                        LOCAL_CHASSIS(cfg)->c_cap_enabled &= ~LLDP_CAP_ROUTER;
                close(f);
        }
#ifdef ENABLE_LLDPMED
        if (LOCAL_CHASSIS(cfg)->c_cap_available & LLDP_CAP_TELEPHONE)
                LOCAL_CHASSIS(cfg)->c_cap_enabled |= LLDP_CAP_TELEPHONE;
        lldpd_med(LOCAL_CHASSIS(cfg));
        free(LOCAL_CHASSIS(cfg)->c_med_sw);
        if (cfg->g_config.c_advertise_version)
                LOCAL_CHASSIS(cfg)->c_med_sw = strdup(un.release);
        else
                LOCAL_CHASSIS(cfg)->c_med_sw = strdup("Unknown");
#endif

        /* Set chassis ID if needed. This is only done if chassis ID
           has not been set previously (with the MAC address of an
           interface for example)
        */
        if (LOCAL_CHASSIS(cfg)->c_id == NULL) {
                if (!(LOCAL_CHASSIS(cfg)->c_id = strdup(LOCAL_CHASSIS(cfg)->c_name)))
                        fatal(NULL);
                LOCAL_CHASSIS(cfg)->c_id_len = strlen(LOCAL_CHASSIS(cfg)->c_name);
                LOCAL_CHASSIS(cfg)->c_id_subtype = LLDP_CHASSISID_SUBTYPE_LOCAL;
        }
}

static void
lldpd_update_localports(struct lldpd *cfg)
{
        struct ifaddrs *ifap;
        struct lldpd_hardware *hardware;
        lldpd_ifhandlers ifhs[] = {
                lldpd_ifh_whitelist, /* Is the interface whitelisted? */
                lldpd_ifh_bond, /* Handle bond */
                lldpd_ifh_eth,  /* Handle classic ethernet interfaces */
#ifdef ENABLE_DOT1
                lldpd_ifh_vlan, /* Handle VLAN */
#endif
                lldpd_ifh_mgmt, /* Handle management address (if not already handled) */
                lldpd_ifh_chassis, /* Handle chassis ID (if not already handled) */
                NULL
        };
        lldpd_ifhandlers *ifh;

        /* h_flags is set to 0 for each port. If the port is updated, h_flags
         * will be set to a non-zero value. This will allow us to clean up any
         * non up-to-date port */
        TAILQ_FOREACH(hardware, &cfg->g_hardware, h_entries)
            hardware->h_flags = 0;

        if (getifaddrs(&ifap) != 0)
                fatal("lldpd_update_localports: failed to get interface list");

        /* We will run the list of interfaces through a list of interface
         * handlers. Each handler will create or update some hardware port (and
         * will set h_flags to a non zero value. The handler can use the list of
         * interfaces but this is not mandatory. If the interface handler
         * handles an interface from the list, it should set ifa_flags to 0 to
         * let know the other handlers that it took care of this interface. This
         * means that more specific handlers should be before less specific
         * ones. */
        for (ifh = ifhs; *ifh != NULL; ifh++)
                (*ifh)(cfg, ifap);
        freeifaddrs(ifap);
}

void
lldpd_loop(struct lldpd *cfg)
{
        /* Main loop.
           
           1. Update local ports information
           2. Clean unwanted (removed) local ports
           3. Update local chassis information
           4. Send packets
           5. Update events
        */
        LLOG_DEBUG("start new loop");
        LOCAL_CHASSIS(cfg)->c_cap_enabled = 0;
        lldpd_update_localports(cfg);
        lldpd_cleanup(cfg);
        lldpd_update_localchassis(cfg);
        lldpd_send_all(cfg);
}

static void
lldpd_exit(struct lldpd *cfg)
{
        struct lldpd_hardware *hardware, *hardware_next;
        close(cfg->g_ctl);
        priv_ctl_cleanup();
        for (hardware = TAILQ_FIRST(&cfg->g_hardware); hardware != NULL;
             hardware = hardware_next) {
                hardware_next = TAILQ_NEXT(hardware, h_entries);
                lldpd_remote_cleanup(hardware, NULL);
                lldpd_hardware_cleanup(cfg, hardware);
        }
}

struct intint { int a; int b; };
static const struct intint filters[] = {
        {  0, 0 },
        {  1, SMART_INCOMING_FILTER | SMART_INCOMING_ONE_PROTO |
              SMART_OUTGOING_FILTER | SMART_OUTGOING_ONE_PROTO },
        {  2, SMART_INCOMING_FILTER | SMART_INCOMING_ONE_PROTO },
        {  3, SMART_OUTGOING_FILTER | SMART_OUTGOING_ONE_PROTO },
        {  4, SMART_INCOMING_FILTER | SMART_OUTGOING_FILTER },
        {  5, SMART_INCOMING_FILTER },
        {  6, SMART_OUTGOING_FILTER },
        {  7, SMART_INCOMING_FILTER | SMART_INCOMING_ONE_PROTO | SMART_INCOMING_ONE_NEIGH |
              SMART_OUTGOING_FILTER | SMART_OUTGOING_ONE_PROTO },
        {  8, SMART_INCOMING_FILTER | SMART_INCOMING_ONE_PROTO | SMART_INCOMING_ONE_NEIGH },
        {  9, SMART_INCOMING_FILTER | SMART_INCOMING_ONE_NEIGH |
              SMART_OUTGOING_FILTER | SMART_OUTGOING_ONE_PROTO },
        { 10, SMART_OUTGOING_FILTER | SMART_OUTGOING_ONE_NEIGH },
        { 11, SMART_INCOMING_FILTER | SMART_INCOMING_ONE_NEIGH },
        { 12, SMART_INCOMING_FILTER | SMART_INCOMING_ONE_NEIGH |
              SMART_OUTGOING_FILTER | SMART_OUTGOING_ONE_NEIGH },
        { 13, SMART_INCOMING_FILTER | SMART_INCOMING_ONE_NEIGH |
              SMART_OUTGOING_FILTER },
        { 14, SMART_INCOMING_FILTER | SMART_INCOMING_ONE_PROTO |
              SMART_OUTGOING_FILTER | SMART_OUTGOING_ONE_NEIGH },
        { 15, SMART_INCOMING_FILTER | SMART_INCOMING_ONE_PROTO |
              SMART_OUTGOING_FILTER },
        { 16, SMART_INCOMING_FILTER | SMART_INCOMING_ONE_PROTO | SMART_INCOMING_ONE_NEIGH |
              SMART_OUTGOING_FILTER | SMART_OUTGOING_ONE_NEIGH },
        { 17, SMART_INCOMING_FILTER | SMART_INCOMING_ONE_PROTO | SMART_INCOMING_ONE_NEIGH |
              SMART_OUTGOING_FILTER },
        { 18, SMART_INCOMING_FILTER |
              SMART_OUTGOING_FILTER | SMART_OUTGOING_ONE_NEIGH },
        { 19, SMART_INCOMING_FILTER |
              SMART_OUTGOING_FILTER | SMART_OUTGOING_ONE_PROTO },
        { -1, 0 }
};

int
lldpd_main(int argc, char *argv[])
{
        struct lldpd *cfg;
        struct lldpd_chassis *lchassis;
        int ch, debug = 0;
#ifdef USE_SNMP
        int snmp = 0;
        char *agentx = NULL;    /* AgentX socket */
#endif
        char *mgmtp = NULL;
        char *cidp = NULL;
        char *interfaces = NULL;
        char *popt, opts[] = 
                "H:vhkrdxX:m:4:6:I:C:p:M:P:S:i@                    ";
        int i, found, advertise_version = 1;
#ifdef ENABLE_LLDPMED
        int lldpmed = 0, noinventory = 0;
#endif
        char *descr_override = NULL;
        char *platform_override = NULL;
        char *lsb_release = NULL;
        int smart = 15;
        int receiveonly = 0;
        int ctl;

        /* Non privileged user */
        struct passwd *user;
        struct group *group;
        uid_t uid;
        gid_t gid;

        saved_argv = argv;

        /*
         * Get and parse command line options
         */
        popt = strchr(opts, '@');
        for (i=0; protos[i].mode != 0; i++)
                *(popt++) = protos[i].arg;
        *popt = '\0';
        while ((ch = getopt(argc, argv, opts)) != -1) {
                switch (ch) {
                case 'h':
                        usage();
                        break;
                case 'v':
                        fprintf(stdout, "%s\n", PACKAGE_VERSION);
                        exit(0);
                        break;
                case 'd':
                        debug++;
                        break;
                case 'r':
                        receiveonly = 1;
                        break;
                case 'm':
                        mgmtp = optarg;
                        break;
                case 'I':
                        interfaces = optarg;
                        break;
                case 'C':
                        cidp = optarg;
                        break;
                case 'k':
                        advertise_version = 0;
                        break;
#ifdef ENABLE_LLDPMED
                case 'M':
                        lldpmed = atoi(optarg);
                        if ((lldpmed < 1) || (lldpmed > 4)) {
                                fprintf(stderr, "-M requires an argument between 1 and 4\n");
                                usage();
                        }
                        break;
                case 'i':
                        noinventory = 1;
                        break;
#else
                case 'M':
                case 'i':
                        fprintf(stderr, "LLDP-MED support is not built-in\n");
                        usage();
                        break;
#endif
#ifdef USE_SNMP
                case 'x':
                        snmp = 1;
                        break;
                case 'X':
                        snmp = 1;
                        agentx = optarg;
                        break;
#else
                case 'x':
                case 'X':
                        fprintf(stderr, "SNMP support is not built-in\n");
                        usage();
#endif
                        break;
                case 'S':
                        descr_override = strdup(optarg);
                        break;
                case 'P':
                        platform_override = strdup(optarg);
                        break;
                case 'H':
                        smart = atoi(optarg);
                        break;
                default:
                        found = 0;
                        for (i=0; protos[i].mode != 0; i++) {
                                if (ch == protos[i].arg) {
                                        protos[i].enabled++;
                                        protos[i].enabled %= 3;
                                        /* When an argument enable
                                           several protocols, only the
                                           first one can be forced. */
                                        if (found && protos[i].enabled > 1)
                                                protos[i].enabled = 1;
                                        found = 1;
                                }
                        }
                        if (!found)
                                usage();
                }
        }

        /* Set correct smart mode */
        for (i=0; (filters[i].a != -1) && (filters[i].a != smart); i++);
        if (filters[i].a == -1) {
                fprintf(stderr, "Incorrect mode for -H\n");
                usage();
        }
        smart = filters[i].b;
        
        log_init(debug, __progname);
        tzset();                /* Get timezone info before chroot */

        /* Grab uid and gid to use for priv sep */
        if ((user = getpwnam(PRIVSEP_USER)) == NULL)
                fatal("no " PRIVSEP_USER " user for privilege separation");
        uid = user->pw_uid;
        if ((group = getgrnam(PRIVSEP_GROUP)) == NULL)
                fatal("no " PRIVSEP_GROUP " group for privilege separation");
        gid = group->gr_gid;

        /* Create and setup socket */
        if ((ctl = ctl_create(LLDPD_CTL_SOCKET)) == -1) {
                LLOG_WARN ("unable to create control socket");
                LLOG_WARNX("If another instance is running, please stop it.");
                LLOG_WARNX("Otherwise, remove " LLDPD_CTL_SOCKET);
                fatalx("Giving up");
        }
        if (chown(LLDPD_CTL_SOCKET, uid, gid) == -1)
                LLOG_WARN("unable to chown control socket");
        if (chmod(LLDPD_CTL_SOCKET,
                S_IRUSR | S_IWUSR | S_IXUSR |
                S_IRGRP | S_IWGRP | S_IXGRP) == -1)
                LLOG_WARN("unable to chmod control socket");

        /* Disable SIGPIPE */
        signal(SIGPIPE, SIG_IGN);

        /* Detach if needed */
        if (!debug) {
                int pid;
                char *spid;
                if (daemon(0, 0) != 0)
                        fatal("failed to detach daemon");
                if ((pid = open(LLDPD_PID_FILE,
                            O_TRUNC | O_CREAT | O_WRONLY, 0644)) == -1)
                        fatal("unable to open pid file " LLDPD_PID_FILE);
                if (asprintf(&spid, "%d\n", getpid()) == -1)
                        fatal("unable to create pid file " LLDPD_PID_FILE);
                if (write(pid, spid, strlen(spid)) == -1)
                        fatal("unable to write pid file " LLDPD_PID_FILE);
                free(spid);
                close(pid);
        }

        /* Try to read system information from /etc/os-release if possible.
           Fall back to lsb_release for compatibility. */
        lsb_release = lldpd_get_os_release();
        if (!lsb_release) {
                lsb_release = lldpd_get_lsb_release();
        }

        priv_init(PRIVSEP_CHROOT, ctl, uid, gid);

        /* Initialization of global configuration */
        if ((cfg = (struct lldpd *)
            calloc(1, sizeof(struct lldpd))) == NULL)
                fatal(NULL);

        cfg->g_ctl = ctl;
        cfg->g_config.c_mgmt_pattern = mgmtp;
        cfg->g_config.c_cid_pattern = cidp;
        cfg->g_config.c_iface_pattern = interfaces;
        cfg->g_config.c_smart = smart;
        cfg->g_config.c_receiveonly = receiveonly;
#ifdef USE_SNMP
        cfg->g_snmp = snmp;
        cfg->g_snmp_agentx = agentx;
#endif /* USE_SNMP */

        /* Get ioctl socket */
        if ((cfg->g_sock = socket(AF_INET, SOCK_DGRAM, 0)) == -1)
                fatal("failed to get ioctl socket");
        cfg->g_config.c_tx_interval = LLDPD_TX_INTERVAL;

        /* Description */
        if (!(cfg->g_config.c_advertise_version = advertise_version) && lsb_release)
                /* Remove the \n */
                lsb_release[strlen(lsb_release) - 1] = '\0';
        cfg->g_lsb_release = lsb_release;
        if (descr_override)
           cfg->g_config.c_description = descr_override;

        if (platform_override)
                cfg->g_config.c_platform = platform_override;

        /* Set system capabilities */
        if ((lchassis = (struct lldpd_chassis*)
                calloc(1, sizeof(struct lldpd_chassis))) == NULL)
                fatal(NULL);
        lchassis->c_cap_available = LLDP_CAP_BRIDGE | LLDP_CAP_WLAN |
            LLDP_CAP_ROUTER;
        TAILQ_INIT(&lchassis->c_mgmt);
#ifdef ENABLE_LLDPMED
        if (lldpmed > 0) {
                if (lldpmed == LLDP_MED_CLASS_III)
                        lchassis->c_cap_available |= LLDP_CAP_TELEPHONE;
                lchassis->c_med_type = lldpmed;
                lchassis->c_med_cap_available = LLDP_MED_CAP_CAP |
                    LLDP_MED_CAP_IV | LLDP_MED_CAP_LOCATION |
                    LLDP_MED_CAP_POLICY | LLDP_MED_CAP_MDI_PSE | LLDP_MED_CAP_MDI_PD;
                cfg->g_config.c_noinventory = noinventory;
        } else
                cfg->g_config.c_noinventory = 1;
#endif

        /* Set TTL */
        lchassis->c_ttl = LLDPD_TTL;

        cfg->g_protocols = protos;
        for (i=0; protos[i].mode != 0; i++)
                if (protos[i].enabled > 1)
                        LLOG_INFO("protocol %s enabled and forced", protos[i].name);
                else if (protos[i].enabled)
                        LLOG_INFO("protocol %s enabled", protos[i].name);
                else
                        LLOG_INFO("protocol %s disabled", protos[i].name);

        TAILQ_INIT(&cfg->g_hardware);
        TAILQ_INIT(&cfg->g_chassis);
        TAILQ_INSERT_TAIL(&cfg->g_chassis, lchassis, c_entries);
        lchassis->c_refcount++; /* We should always keep a reference to local chassis */

        /* Main loop */
        levent_loop(cfg);
        lldpd_exit(cfg);

        return (0);
}