diff options
Diffstat (limited to 'src/libsystemd-network')
| -rw-r--r-- | src/libsystemd-network/lldp-internal.c | 97 | ||||
| -rw-r--r-- | src/libsystemd-network/lldp-internal.h | 4 | ||||
| -rw-r--r-- | src/libsystemd-network/sd-lldp.c | 214 | ||||
| -rw-r--r-- | src/libsystemd-network/sd-lldp.h | 9 |
4 files changed, 322 insertions, 2 deletions
diff --git a/src/libsystemd-network/lldp-internal.c b/src/libsystemd-network/lldp-internal.c index 7085a02491..f86c11e6ca 100644 --- a/src/libsystemd-network/lldp-internal.c +++ b/src/libsystemd-network/lldp-internal.c @@ -86,6 +86,8 @@ int lldp_read_port_id(tlv_packet *tlv, goto out1; switch (subtype) { + case LLDP_PORT_SUBTYPE_PORT_COMPONENT: + case LLDP_PORT_SUBTYPE_INTERFACE_ALIAS: case LLDP_PORT_SUBTYPE_INTERFACE_NAME: r = tlv_packet_read_string(tlv, &s, length); @@ -127,12 +129,105 @@ int lldp_read_ttl(tlv_packet *tlv, uint16_t *ttl) { r = tlv_packet_read_u16(tlv, ttl); - (void) lldp_tlv_packet_exit_container(tlv); + (void)lldp_tlv_packet_exit_container(tlv); out: return r; } +int lldp_read_system_name(tlv_packet *tlv, + uint16_t *length, + char **data) { + char *s; + int r; + + assert_return(tlv, -EINVAL); + + r = lldp_tlv_packet_enter_container(tlv, LLDP_TYPE_SYSTEM_NAME); + if (r < 0) + return r; + + r = tlv_packet_read_string(tlv, &s, length); + if (r < 0) + goto out; + + *data = (char *) s; + + out: + (void)lldp_tlv_packet_exit_container(tlv); + + return r; +} + +int lldp_read_system_description(tlv_packet *tlv, + uint16_t *length, + char **data) { + char *s; + int r; + + assert_return(tlv, -EINVAL); + + r = lldp_tlv_packet_enter_container(tlv, LLDP_TYPE_SYSTEM_DESCRIPTION); + if (r < 0) + return r; + + r = tlv_packet_read_string(tlv, &s, length); + if (r < 0) + goto out; + + *data = (char *) s; + + out: + (void)lldp_tlv_packet_exit_container(tlv); + + return r; +} + +int lldp_read_port_description(tlv_packet *tlv, + uint16_t *length, + char **data) { + char *s; + int r; + + assert_return(tlv, -EINVAL); + + r = lldp_tlv_packet_enter_container(tlv, LLDP_TYPE_PORT_DESCRIPTION); + if (r < 0) + return r; + + r = tlv_packet_read_string(tlv, &s, length); + if (r < 0) + goto out; + + *data = (char *) s; + + out: + (void)lldp_tlv_packet_exit_container(tlv); + + return r; +} + +int lldp_read_system_capability(tlv_packet *tlv, uint16_t *data) { + int r; + + assert_return(tlv, -EINVAL); + + r = lldp_tlv_packet_enter_container(tlv, LLDP_TYPE_SYSTEM_CAPABILITIES); + if (r < 0) + return r; + + r = tlv_packet_read_u16(tlv, data); + if (r < 0) + goto out; + + return 0; + out: + + (void)lldp_tlv_packet_exit_container(tlv); + + return r; +} + /* 10.5.5.2.2 mibUpdateObjects () * The mibUpdateObjects () procedure updates the MIB objects corresponding to * the TLVs contained in the received LLDPDU for the LLDP remote system diff --git a/src/libsystemd-network/lldp-internal.h b/src/libsystemd-network/lldp-internal.h index dbaf389792..028a35ffdd 100644 --- a/src/libsystemd-network/lldp-internal.h +++ b/src/libsystemd-network/lldp-internal.h @@ -89,5 +89,9 @@ int lldp_mib_remove_objects(lldp_chassis *c, tlv_packet *tlv); int lldp_read_chassis_id(tlv_packet *tlv, uint8_t *type, uint16_t *length, uint8_t **data); int lldp_read_port_id(tlv_packet *tlv, uint8_t *type, uint16_t *length, uint8_t **data); int lldp_read_ttl(tlv_packet *tlv, uint16_t *ttl); +int lldp_read_system_name(tlv_packet *tlv, uint16_t *length, char **data); +int lldp_read_system_description(tlv_packet *tlv, uint16_t *length, char **data); +int lldp_read_system_capability(tlv_packet *tlv, uint16_t *data); +int lldp_read_port_description(tlv_packet *tlv, uint16_t *length, char **data); #define log_lldp(fmt, ...) log_internal(LOG_DEBUG, 0, __FILE__, __LINE__, __func__, "LLDP: " fmt, ##__VA_ARGS__) diff --git a/src/libsystemd-network/sd-lldp.c b/src/libsystemd-network/sd-lldp.c index 97d1578446..45881e5f64 100644 --- a/src/libsystemd-network/sd-lldp.c +++ b/src/libsystemd-network/sd-lldp.c @@ -30,7 +30,21 @@ #include "lldp-port.h" #include "sd-lldp.h" #include "prioq.h" +#include "strv.h" #include "lldp-internal.h" +#include "ether-addr-util.h" + +typedef enum LLDPAgentRXState { + LLDP_AGENT_RX_WAIT_PORT_OPERATIONAL = 4, + LLDP_AGENT_RX_DELETE_AGED_INFO, + LLDP_AGENT_RX_LLDP_INITIALIZE, + LLDP_AGENT_RX_WAIT_FOR_FRAME, + LLDP_AGENT_RX_RX_FRAME, + LLDP_AGENT_RX_DELETE_INFO, + LLDP_AGENT_RX_UPDATE_INFO, + _LLDP_AGENT_RX_STATE_MAX, + _LLDP_AGENT_RX_INVALID = -1, +} LLDPAgentRXState; /* Section 10.5.2.2 Reception counters */ struct lldp_agent_statitics { @@ -48,6 +62,11 @@ struct sd_lldp { Prioq *by_expiry; Hashmap *neighbour_mib; + sd_lldp_cb_t cb; + + void *userdata; + + LLDPAgentRXState rx_state; lldp_agent_statitics statitics; }; @@ -87,6 +106,8 @@ static const struct hash_ops chassis_id_hash_ops = { }; static void lldp_mib_delete_objects(sd_lldp *lldp); +static void lldp_set_state(sd_lldp *lldp, LLDPAgentRXState state); +static void lldp_run_state_machine(sd_lldp *ll); static int lldp_receive_frame(sd_lldp *lldp, tlv_packet *tlv) { int r; @@ -95,13 +116,19 @@ static int lldp_receive_frame(sd_lldp *lldp, tlv_packet *tlv) { assert(tlv); /* Remove expired packets */ - if (prioq_size(lldp->by_expiry) > 0) + if (prioq_size(lldp->by_expiry) > 0) { + + lldp_set_state(lldp, LLDP_AGENT_RX_DELETE_INFO); + lldp_mib_delete_objects(lldp); + } r = lldp_mib_add_objects(lldp->by_expiry, lldp->neighbour_mib, tlv); if (r < 0) goto out; + lldp_set_state(lldp, LLDP_AGENT_RX_UPDATE_INFO); + log_lldp("Packet added. MIB size: %d , PQ size: %d", hashmap_size(lldp->neighbour_mib), prioq_size(lldp->by_expiry)); @@ -114,6 +141,8 @@ static int lldp_receive_frame(sd_lldp *lldp, tlv_packet *tlv) { if (r < 0) log_lldp("Receive frame failed: %s", strerror(-r)); + lldp_set_state(lldp, LLDP_AGENT_RX_WAIT_FOR_FRAME); + return 0; } @@ -142,6 +171,8 @@ int lldp_handle_packet(tlv_packet *tlv, uint16_t length) { goto out; } + lldp_set_state(lldp, LLDP_AGENT_RX_RX_FRAME); + p = tlv->pdu; p += sizeof(struct ether_header); @@ -304,6 +335,8 @@ int lldp_handle_packet(tlv_packet *tlv, uint16_t length) { return lldp_receive_frame(lldp, tlv); out: + lldp_set_state(lldp, LLDP_AGENT_RX_WAIT_FOR_FRAME); + if (malformed) { lldp->statitics.stats_frames_discarded_total ++; lldp->statitics.stats_frames_in_errors_total ++; @@ -326,6 +359,23 @@ static int ttl_expiry_item_prioq_compare_func(const void *a, const void *b) { return 0; } +static void lldp_set_state(sd_lldp *lldp, LLDPAgentRXState state) { + + assert(lldp); + assert(state < _LLDP_AGENT_RX_STATE_MAX); + + lldp->rx_state = state; + + lldp_run_state_machine(lldp); +} + +static void lldp_run_state_machine(sd_lldp *lldp) { + + if (lldp->rx_state == LLDP_AGENT_RX_UPDATE_INFO) + if (lldp->cb) + lldp->cb(lldp, LLDP_AGENT_RX_UPDATE_INFO, lldp->userdata); +} + /* 10.5.5.2.1 mibDeleteObjects () * The mibDeleteObjects () procedure deletes all information in the LLDP remote * systems MIB associated with the MSAP identifier if an LLDPDU is received with @@ -377,6 +427,150 @@ static void lldp_mib_objects_flush(sd_lldp *lldp) { assert(prioq_size(lldp->by_expiry) == 0); } +int sd_lldp_save(sd_lldp *lldp, const char *lldp_file) { + _cleanup_free_ char *s = NULL, *t = NULL, *k = NULL; + _cleanup_free_ char *temp_path = NULL; + _cleanup_fclose_ FILE *f = NULL; + uint8_t *mac, *port_id, type; + lldp_neighbour_port *p; + uint16_t data = 0, length = 0; + char buf[LINE_MAX]; + lldp_chassis *c; + usec_t time; + Iterator i; + int r; + + assert(lldp); + assert(lldp_file); + + r = fopen_temporary(lldp_file, &f, &temp_path); + if (r < 0) + goto finish; + + fchmod(fileno(f), 0644); + + HASHMAP_FOREACH(c, lldp->neighbour_mib, i) { + LIST_FOREACH(port, p, c->ports) { + + r = lldp_read_chassis_id(p->packet, &type, &length, &mac); + if (r < 0) + continue; + + memzero(buf, LINE_MAX); + + sprintf(buf, "'_Chassis=%02x:%02x:%02x:%02x:%02x:%02x' '_CType=%d' ", + mac[0], mac[1], mac[2], mac[3], mac[4], mac[5], type); + + s = strdup(buf); + if (!s) + return -ENOMEM; + + r = lldp_read_port_id(p->packet, &type, &length, &port_id); + if (r < 0) { + free(s); + continue; + } + + memzero(buf, LINE_MAX); + if (type != LLDP_PORT_SUBTYPE_MAC_ADDRESS) { + + k = strndup((char *) port_id, length -1); + if (!k) + return -ENOMEM; + + sprintf(buf, "'_Port=%s' '_PType=%d' ", k , type); + + t = strappend(s, buf); + + free(k); + } else { + + mac = port_id; + + sprintf(buf, "'_Port=%02x:%02x:%02x:%02x:%02x:%02x' '_PType=%d' ", + mac[0], mac[1], mac[2], mac[3], mac[4], mac[5], type); + + t = strappend(s, buf); + } + + if (!t) + return -ENOMEM; + + free(s); + s = t; + + time = now(CLOCK_BOOTTIME); + + /* Don't write expired packets */ + if(time - p->until <= 0) { + free(s); + continue; + } + + memzero(buf, LINE_MAX); + sprintf(buf, "'_TTL=%lu' ", p->until); + + t = strappend(s, buf); + if (!t) + return -ENOMEM; + + free(s); + s = t; + + r = lldp_read_system_name(p->packet, &length, &k); + if (r < 0) + k = strappend(s, "'_NAME=N/A' "); + else { + t = strndup(k, length); + if (!t) + return -ENOMEM; + + k = strjoin(s, "'_NAME=", t, "' ", NULL); + } + + if (!k) + return -ENOMEM; + + free(s); + s = k; + + memzero(buf, LINE_MAX); + + (void)lldp_read_system_capability(p->packet, &data); + + sprintf(buf, "'_CAP=%x'", data); + + t = strappend(s, buf); + if (!t) + return -ENOMEM; + + fprintf(f, "%s\n", t); + + free(s); + free(t); + } + } + r = 0; + + s = NULL; + t = NULL; + k = NULL; + + fflush(f); + + if (ferror(f) || rename(temp_path, lldp_file) < 0) { + r = -errno; + unlink(lldp_file); + unlink(temp_path); + } + + finish: + if (r < 0) + log_error("Failed to save lldp data %s: %s", lldp_file, strerror(-r)); + + return r; +} + int sd_lldp_start(sd_lldp *lldp) { int r; @@ -385,14 +579,21 @@ int sd_lldp_start(sd_lldp *lldp) { lldp->port->status = LLDP_PORT_STATUS_ENABLED; + lldp_set_state(lldp, LLDP_AGENT_RX_LLDP_INITIALIZE); + r = lldp_port_start(lldp->port); if (r < 0) { log_lldp("Failed to start Port : %s , %s", lldp->port->ifname, strerror(-r)); + + lldp_set_state(lldp, LLDP_AGENT_RX_WAIT_PORT_OPERATIONAL); + return r; } + lldp_set_state(lldp, LLDP_AGENT_RX_WAIT_FOR_FRAME); + return 0; } @@ -441,6 +642,15 @@ int sd_lldp_detach_event(sd_lldp *lldp) { return 0; } +int sd_lldp_set_callback(sd_lldp *lldp, sd_lldp_cb_t cb, void *userdata) { + assert_return(lldp, -EINVAL); + + lldp->cb = cb; + lldp->userdata = userdata; + + return 0; +} + void sd_lldp_free(sd_lldp *lldp) { if (!lldp) @@ -486,6 +696,8 @@ int sd_lldp_new(int ifindex, if (r < 0) return r; + lldp->rx_state = LLDP_AGENT_RX_WAIT_PORT_OPERATIONAL; + *ret = lldp; lldp = NULL; diff --git a/src/libsystemd-network/sd-lldp.h b/src/libsystemd-network/sd-lldp.h index 95d802df84..ee064c6fc8 100644 --- a/src/libsystemd-network/sd-lldp.h +++ b/src/libsystemd-network/sd-lldp.h @@ -28,6 +28,12 @@ typedef struct sd_lldp sd_lldp; typedef struct lldp_agent_statitics lldp_agent_statitics; +typedef void (*sd_lldp_cb_t)(sd_lldp *lldp, int event, void *userdata); + +enum { + UPDATE_INFO = 10, +}; + typedef enum LLDPPortStatus { LLDP_PORT_STATUS_NONE, LLDP_PORT_STATUS_ENABLED, @@ -48,4 +54,7 @@ int sd_lldp_stop(sd_lldp *lldp); int sd_lldp_attach_event(sd_lldp *lldp, sd_event *event, int priority); int sd_lldp_detach_event(sd_lldp *lldp); +int sd_lldp_set_callback(sd_lldp *lldp, sd_lldp_cb_t cb, void *userdata); +int sd_lldp_save(sd_lldp *lldp, const char *file); + int lldp_handle_packet(tlv_packet *m, uint16_t length); |