int link_new(Manager *manager, struct udev_device *device, Link **ret) {
_cleanup_link_free_ Link *link = NULL;
- uint64_t ifindex;
+ const char *mac;
+ struct ether_addr *mac_addr;
+ const char *ifname;
int r;
assert(device);
if (!link)
return -ENOMEM;
- ifindex = udev_device_get_ifindex(device);
- if (ifindex <= 0)
+ link->manager = manager;
+ link->state = _LINK_STATE_INVALID;
+
+ link->ifindex = udev_device_get_ifindex(device);
+ if (link->ifindex <= 0)
return -EINVAL;
- link->ifindex = ifindex;
- link->manager = manager;
+ mac = udev_device_get_sysattr_value(device, "address");
+ if (mac) {
+ mac_addr = ether_aton(mac);
+ if (mac_addr)
+ memcpy(&link->mac, mac_addr, sizeof(struct ether_addr));
+ }
+
+ ifname = udev_device_get_sysname(device);
+ link->ifname = strdup(ifname);
- r = hashmap_put(manager->links, &ifindex, link);
+ r = hashmap_put(manager->links, &link->ifindex, link);
if (r < 0)
return r;
if (!link)
return;
- network_free(link->network);
+ assert(link->manager);
+
+ if (link->dhcp)
+ sd_dhcp_client_free(link->dhcp);
+
+ route_free(link->dhcp_route);
+ link->dhcp_route = NULL;
+
+ address_free(link->dhcp_address);
+ link->dhcp_address = NULL;
- hashmap_remove(link->manager->links, link);
+ hashmap_remove(link->manager->links, &link->ifindex);
+
+ free(link->ifname);
free(link);
}
-int link_add(Manager *m, struct udev_device *device) {
+int link_add(Manager *m, struct udev_device *device, Link **ret) {
Link *link;
Network *network;
int r;
uint64_t ifindex;
+ const char *devtype;
assert(m);
assert(device);
ifindex = udev_device_get_ifindex(device);
link = hashmap_get(m->links, &ifindex);
- if (link)
- return 0;
+ if (link) {
+ *ret = link;
+ return -EEXIST;
+ }
r = link_new(m, device, &link);
- if (r < 0) {
- log_error("could not create link: %s", strerror(-r));
+ if (r < 0)
return r;
+
+ *ret = link;
+
+ devtype = udev_device_get_devtype(device);
+ if (streq_ptr(devtype, "bridge")) {
+ r = bridge_set_link(m, link);
+ if (r < 0 && r != -ENOENT)
+ return r;
}
r = network_get(m, device, &network);
return 0;
}
-int link_up(Manager *manager, Link *link) {
+static int link_enter_configured(Link *link) {
+ assert(link);
+ assert(link->state == LINK_STATE_SETTING_ROUTES);
+
+ log_info_link(link, "link configured");
+
+ link->state = LINK_STATE_CONFIGURED;
+
+ return 0;
+}
+
+static void link_enter_failed(Link *link) {
+ assert(link);
+
+ log_warning_link(link, "failed");
+
+ link->state = LINK_STATE_FAILED;
+}
+
+static int route_handler(sd_rtnl *rtnl, sd_rtnl_message *m, void *userdata) {
+ Link *link = userdata;
+ int r;
+
+ assert(link->route_messages > 0);
+ assert(link->state == LINK_STATE_SETTING_ADDRESSES ||
+ link->state == LINK_STATE_SETTING_ROUTES ||
+ link->state == LINK_STATE_FAILED);
+
+ link->route_messages --;
+
+ if (link->state == LINK_STATE_FAILED)
+ return 1;
+
+ r = sd_rtnl_message_get_errno(m);
+ if (r < 0 && r != -EEXIST)
+ log_warning_link(link, "could not set route: %s", strerror(-r));
+
+ /* we might have received an old reply after moving back to SETTING_ADDRESSES,
+ * ignore it */
+ if (link->route_messages == 0 && link->state == LINK_STATE_SETTING_ROUTES) {
+ log_debug_link(link, "routes set");
+ link_enter_configured(link);
+ }
+
+ return 1;
+}
+
+static int link_enter_set_routes(Link *link) {
+ Route *route;
+ int r;
+
+ assert(link);
+ assert(link->network);
+ assert(link->state == LINK_STATE_SETTING_ADDRESSES);
+
+ link->state = LINK_STATE_SETTING_ROUTES;
+
+ if (!link->network->static_routes && !link->dhcp_route)
+ return link_enter_configured(link);
+
+ log_debug_link(link, "setting routes");
+
+ LIST_FOREACH(static_routes, route, link->network->static_routes) {
+ r = route_configure(route, link, &route_handler);
+ if (r < 0) {
+ log_warning_link(link,
+ "could not set routes: %s", strerror(-r));
+ link_enter_failed(link);
+ return r;
+ }
+
+ link->route_messages ++;
+ }
+
+ if (link->dhcp_route) {
+ r = route_configure(link->dhcp_route, link, &route_handler);
+ if (r < 0) {
+ log_warning_link(link,
+ "could not set routes: %s", strerror(-r));
+ link_enter_failed(link);
+ return r;
+ }
+
+ link->route_messages ++;
+ }
+
+ return 0;
+}
+
+static int address_handler(sd_rtnl *rtnl, sd_rtnl_message *m, void *userdata) {
+ Link *link = userdata;
+ int r;
+
+ assert(m);
+ assert(link);
+ assert(link->ifname);
+ assert(link->addr_messages > 0);
+ assert(link->state == LINK_STATE_SETTING_ADDRESSES || link->state == LINK_STATE_FAILED);
+
+ link->addr_messages --;
+
+ if (link->state == LINK_STATE_FAILED)
+ return 1;
+
+ r = sd_rtnl_message_get_errno(m);
+ if (r < 0 && r != -EEXIST)
+ log_struct_link(LOG_ERR, link,
+ "MESSAGE=%s: could not set address: %s",
+ link->ifname, strerror(-r),
+ "ERRNO=%d", -r,
+ NULL);
+
+ if (link->addr_messages == 0) {
+ log_debug_link(link, "addresses set");
+ link_enter_set_routes(link);
+ }
+
+ return 1;
+}
+
+static int link_enter_set_addresses(Link *link) {
+ Address *address;
+ int r;
+
+ assert(link);
+ assert(link->network);
+ assert(link->state != _LINK_STATE_INVALID);
+
+ link->state = LINK_STATE_SETTING_ADDRESSES;
+
+ if (!link->network->static_addresses && !link->dhcp_address)
+ return link_enter_set_routes(link);
+
+ log_debug_link(link, "setting addresses");
+
+ LIST_FOREACH(static_addresses, address, link->network->static_addresses) {
+ r = address_configure(address, link, &address_handler);
+ if (r < 0) {
+ log_warning_link(link,
+ "could not set addresses: %s", strerror(-r));
+ link_enter_failed(link);
+ return r;
+ }
+
+ link->addr_messages ++;
+ }
+
+ if (link->dhcp_address) {
+ r = address_configure(link->dhcp_address, link, &address_handler);
+ if (r < 0) {
+ log_warning_link(link,
+ "could not set addresses: %s", strerror(-r));
+ link_enter_failed(link);
+ return r;
+ }
+
+ link->addr_messages ++;
+ }
+
+ return 0;
+}
+
+static int address_drop_handler(sd_rtnl *rtnl, sd_rtnl_message *m, void *userdata) {
+ Link *link = userdata;
+ int r;
+
+ assert(m);
+ assert(link);
+ assert(link->ifname);
+
+ if (link->state == LINK_STATE_FAILED)
+ return 1;
+
+ r = sd_rtnl_message_get_errno(m);
+ if (r < 0 && r != -EEXIST)
+ log_warning_link(link, "could not drop address: %s", strerror(-r));
+
+ return 1;
+}
+
+static int set_mtu_handler(sd_rtnl *rtnl, sd_rtnl_message *m, void *userdata) {
+ Link *link = userdata;
+ int r;
+
+ assert(m);
+ assert(link);
+ assert(link->ifname);
+
+ if (link->state == LINK_STATE_FAILED)
+ return 1;
+
+ r = sd_rtnl_message_get_errno(m);
+ if (r < 0 && r != -EEXIST)
+ log_warning_link(link, "Could not set MTU: %s", strerror(-r));
+
+ return 1;
+}
+
+static int link_set_mtu(Link *link, uint32_t mtu) {
+ _cleanup_sd_rtnl_message_unref_ sd_rtnl_message *req = NULL;
+ int r;
+
+ assert(link);
+ assert(link->manager);
+ assert(link->manager->rtnl);
+
+ log_debug_link(link, "setting MTU: %" PRIu32, mtu);
+
+ r = sd_rtnl_message_link_new(RTM_SETLINK, link->ifindex, &req);
+ if (r < 0) {
+ log_error_link(link, "Could not allocate RTM_SETLINK message");
+ return r;
+ }
+
+ r = sd_rtnl_message_append_u32(req, IFLA_MTU, mtu);
+ if (r < 0) {
+ log_error_link(link, "Could not append MTU: %s", strerror(-r));
+ return r;
+ }
+
+ r = sd_rtnl_call_async(link->manager->rtnl, req, set_mtu_handler, link, 0, NULL);
+ if (r < 0) {
+ log_error_link(link,
+ "Could not send rtnetlink message: %s", strerror(-r));
+ return r;
+ }
+
+ return 0;
+}
+
+static void dhcp_handler(sd_dhcp_client *client, int event, void *userdata) {
+ Link *link = userdata;
+ struct in_addr address;
+ struct in_addr netmask;
+ struct in_addr gateway;
+ int prefixlen;
+ int r;
+
+ assert(link);
+ assert(link->network);
+
+ if (link->state == LINK_STATE_FAILED)
+ return;
+
+ if (event < 0) {
+ log_warning_link(link, "DHCP error: %s", strerror(-event));
+ link_enter_failed(link);
+ return;
+ }
+
+ if (event == DHCP_EVENT_NO_LEASE)
+ log_debug_link(link, "IP address in use.");
+
+ if (event == DHCP_EVENT_IP_CHANGE || event == DHCP_EVENT_EXPIRED ||
+ event == DHCP_EVENT_STOP) {
+ if (link->dhcp_address) {
+ address_drop(link->dhcp_address, link, address_drop_handler);
+
+ address_free(link->dhcp_address);
+ link->dhcp_address = NULL;
+ }
+
+ if (link->dhcp_route) {
+ route_free(link->dhcp_route);
+ link->dhcp_route = NULL;
+ }
+
+ if (link->network->dhcp_mtu) {
+ uint16_t mtu;
+
+ r = sd_dhcp_client_get_mtu(client, &mtu);
+ if (r >= 0 && link->original_mtu != mtu) {
+ r = link_set_mtu(link, link->original_mtu);
+ if (r < 0) {
+ log_warning_link(link, "DHCP error: could not reset MTU");
+ link_enter_failed(link);
+ return;
+ }
+ }
+ }
+ }
+
+ r = sd_dhcp_client_get_address(client, &address);
+ if (r < 0) {
+ log_warning_link(link, "DHCP error: no address");
+ link_enter_failed(link);
+ return;
+ }
+
+ r = sd_dhcp_client_get_netmask(client, &netmask);
+ if (r < 0) {
+ log_warning_link(link, "DHCP error: no netmask");
+ link_enter_failed(link);
+ return;
+ }
+
+ prefixlen = sd_dhcp_client_prefixlen(&netmask);
+ if (prefixlen < 0) {
+ log_warning_link(link, "DHCP error: no prefixlen");
+ link_enter_failed(link);
+ return;
+ }
+
+ r = sd_dhcp_client_get_router(client, &gateway);
+ if (r < 0) {
+ log_warning_link(link, "DHCP error: no router");
+ link_enter_failed(link);
+ return;
+ }
+
+ if (event == DHCP_EVENT_IP_CHANGE || event == DHCP_EVENT_IP_ACQUIRE) {
+ _cleanup_address_free_ Address *addr = NULL;
+ _cleanup_route_free_ Route *rt = NULL;
+ struct in_addr **nameservers;
+
+ log_struct_link(LOG_INFO, link,
+ "MESSAGE=%s: DHCPv4 address %u.%u.%u.%u/%u via %u.%u.%u.%u",
+ link->ifname,
+ ADDRESS_FMT_VAL(address),
+ prefixlen,
+ ADDRESS_FMT_VAL(gateway),
+ "ADDRESS=%u.%u.%u.%u",
+ ADDRESS_FMT_VAL(address),
+ "PREFIXLEN=%u",
+ prefixlen,
+ "GATEWAY=%u.%u.%u.%u",
+ ADDRESS_FMT_VAL(gateway),
+ NULL);
+
+ r = address_new_dynamic(&addr);
+ if (r < 0) {
+ log_error_link(link, "Could not allocate address");
+ link_enter_failed(link);
+ return;
+ }
+
+ addr->family = AF_INET;
+ addr->in_addr.in = address;
+ addr->prefixlen = prefixlen;
+ addr->netmask = netmask;
+
+ r = route_new_dynamic(&rt);
+ if (r < 0) {
+ log_error_link(link, "Could not allocate route");
+ link_enter_failed(link);
+ return;
+ }
+
+ rt->family = AF_INET;
+ rt->in_addr.in = gateway;
+
+ link->dhcp_address = addr;
+ link->dhcp_route = rt;
+ addr = NULL;
+ rt = NULL;
+
+ if (link->network->dhcp_dns) {
+ r = sd_dhcp_client_get_dns(client, &nameservers);
+ if (r >= 0) {
+ r = manager_update_resolv_conf(link->manager);
+ if (r < 0)
+ log_error("Failed to update resolv.conf");
+ }
+ }
+
+ if (link->network->dhcp_mtu) {
+ uint16_t mtu;
+
+ r = sd_dhcp_client_get_mtu(client, &mtu);
+ if (r >= 0) {
+ r = link_set_mtu(link, mtu);
+ if (r < 0)
+ log_error_link(link, "Failed to set MTU "
+ "to %" PRIu16, mtu);
+ }
+ }
+
+ link_enter_set_addresses(link);
+ }
+
+ return;
+}
+
+static int link_acquire_conf(Link *link) {
+ int r;
+
+ assert(link);
+ assert(link->network);
+ assert(link->network->dhcp);
+ assert(link->manager);
+ assert(link->manager->event);
+
+ if (!link->dhcp) {
+ link->dhcp = sd_dhcp_client_new(link->manager->event);
+ if (!link->dhcp)
+ return -ENOMEM;
+
+ r = sd_dhcp_client_set_index(link->dhcp, link->ifindex);
+ if (r < 0)
+ return r;
+
+ r = sd_dhcp_client_set_mac(link->dhcp, &link->mac);
+ if (r < 0)
+ return r;
+
+ r = sd_dhcp_client_set_callback(link->dhcp, dhcp_handler, link);
+ if (r < 0)
+ return r;
+ }
+
+ log_debug_link(link, "acquiring DHCPv4 lease");
+
+ if (link->network->dhcp_mtu) {
+ r = sd_dhcp_client_set_request_option(link->dhcp, 26);
+ if (r < 0)
+ return r;
+ }
+
+ r = sd_dhcp_client_start(link->dhcp);
+ if (r < 0)
+ return r;
+
+ return 0;
+}
+
+static int link_update_flags(Link *link, unsigned flags) {
+ int r;
+
+ assert(link);
+ assert(link->network);
+
+ if (link->state == LINK_STATE_FAILED)
+ return 0;
+
+ if (link->flags == flags) {
+ log_debug_link(link, "link status unchanged: %#.8x", flags);
+ return 0;
+ }
+
+ if ((link->flags & IFF_UP) != (flags & IFF_UP))
+ log_info_link(link,
+ "power %s", flags & IFF_UP ? "on": "off");
+
+ if ((link->flags & IFF_LOWER_UP) != (flags & IFF_LOWER_UP)) {
+ if (flags & IFF_LOWER_UP) {
+ log_info_link(link, "carrier on");
+
+ if (link->network->dhcp) {
+ r = link_acquire_conf(link);
+ if (r < 0) {
+ link_enter_failed(link);
+ return r;
+ }
+ }
+ } else {
+ log_info_link(link, "carrier off");
+
+ if (link->network->dhcp) {
+ r = sd_dhcp_client_stop(link->dhcp);
+ if (r < 0) {
+ link_enter_failed(link);
+ return r;
+ }
+ }
+ }
+ }
+
+ log_debug_link(link,
+ "link status updated: %#.8x -> %#.8x", link->flags, flags);
+
+ link->flags = flags;
+
+ return 0;
+}
+
+static int link_up_handler(sd_rtnl *rtnl, sd_rtnl_message *m, void *userdata) {
+ Link *link = userdata;
+ int r;
+
+ assert(link);
+
+ if (link->state == LINK_STATE_FAILED)
+ return 1;
+
+ r = sd_rtnl_message_get_errno(m);
+ if (r < 0) {
+ log_warning_link(link,
+ "could not bring up interface: %s", strerror(-r));
+ link_enter_failed(link);
+ }
+
+ link_update_flags(link, link->flags | IFF_UP);
+
+ return 1;
+}
+
+static int link_up(Link *link) {
_cleanup_sd_rtnl_message_unref_ sd_rtnl_message *req = NULL;
int r;
- r = sd_rtnl_message_link_new(RTM_NEWLINK, link->ifindex, 0, IFF_UP, &req);
+ assert(link);
+ assert(link->manager);
+ assert(link->manager->rtnl);
+
+ log_debug_link(link, "bringing link up");
+
+ r = sd_rtnl_message_link_new(RTM_SETLINK, link->ifindex, &req);
+ if (r < 0) {
+ log_error_link(link, "Could not allocate RTM_SETLINK message");
+ return r;
+ }
+
+ r = sd_rtnl_message_link_set_flags(req, IFF_UP);
+ if (r < 0) {
+ log_error_link(link, "Could not set link flags: %s", strerror(-r));
+ return r;
+ }
+
+ r = sd_rtnl_call_async(link->manager->rtnl, req, link_up_handler, link, 0, NULL);
if (r < 0) {
- log_error("Could not allocate RTM_NEWLINK message");
+ log_error_link(link,
+ "Could not send rtnetlink message: %s", strerror(-r));
return r;
}
- r = sd_rtnl_call(manager->rtnl, req, 0, NULL);
+ return 0;
+}
+
+static int link_bridge_joined(Link *link) {
+ int r;
+
+ assert(link);
+ assert(link->state == LINK_STATE_JOINING_BRIDGE);
+ assert(link->network);
+
+ r = link_up(link);
if (r < 0) {
- log_error("Could not UP link: %s", strerror(-r));
+ link_enter_failed(link);
return r;
}
- log_info("Link is UP");
+ if (!link->network->dhcp)
+ return link_enter_set_addresses(link);
return 0;
}
+
+static int bridge_handler(sd_rtnl *rtnl, sd_rtnl_message *m, void *userdata) {
+ Link *link = userdata;
+ int r;
+
+ assert(link);
+ assert(link->state == LINK_STATE_JOINING_BRIDGE || link->state == LINK_STATE_FAILED);
+ assert(link->network);
+
+ if (link->state == LINK_STATE_FAILED)
+ return 1;
+
+ r = sd_rtnl_message_get_errno(m);
+ if (r < 0) {
+ log_struct_link(LOG_ERR, link,
+ "MESSAGE=%s: could not join bridge '%s': %s",
+ link->ifname, link->network->bridge->name, strerror(-r),
+ BRIDGE(link->network->bridge),
+ NULL);
+ link_enter_failed(link);
+ return 1;
+ }
+
+ log_struct_link(LOG_DEBUG, link,
+ "MESSAGE=%s: joined bridge '%s'",
+ link->network->bridge->name,
+ BRIDGE(link->network->bridge),
+ NULL);
+
+ link_bridge_joined(link);
+
+ return 1;
+}
+
+static int link_enter_join_bridge(Link *link) {
+ int r;
+
+ assert(link);
+ assert(link->network);
+ assert(link->state == _LINK_STATE_INVALID);
+
+ link->state = LINK_STATE_JOINING_BRIDGE;
+
+ if (!link->network->bridge)
+ return link_bridge_joined(link);
+
+ log_struct_link(LOG_DEBUG, link,
+ "MESSAGE=%s: joining bridge '%s'",
+ link->network->bridge->name,
+ BRIDGE(link->network->bridge),
+ NULL);
+ log_debug_link(link, "joining bridge");
+
+ r = bridge_join(link->network->bridge, link, &bridge_handler);
+ if (r < 0) {
+ log_struct_link(LOG_WARNING, link,
+ "MESSAGE=%s: could not join bridge '%s': %s",
+ link->network->bridge->name, strerror(-r),
+ BRIDGE(link->network->bridge),
+ NULL);
+ link_enter_failed(link);
+ return r;
+ }
+
+ return 0;
+}
+
+static int link_get_handler(sd_rtnl *rtnl, sd_rtnl_message *m, void *userdata) {
+ Link *link = userdata;
+ int r;
+
+ assert(link);
+
+ if (link->state == LINK_STATE_FAILED)
+ return 1;
+
+ r = sd_rtnl_message_get_errno(m);
+ if (r < 0) {
+ log_warning_link(link, "could not get state: %s", strerror(-r));
+ link_enter_failed(link);
+ }
+
+ log_debug_link(link, "got link state");
+
+ link_update(link, m);
+
+ return 1;
+}
+
+static int link_get(Link *link) {
+ _cleanup_sd_rtnl_message_unref_ sd_rtnl_message *req = NULL;
+ int r;
+
+ assert(link);
+ assert(link->manager);
+ assert(link->manager->rtnl);
+
+ log_debug_link(link, "requesting link status");
+
+ r = sd_rtnl_message_link_new(RTM_GETLINK, link->ifindex, &req);
+ if (r < 0) {
+ log_error_link(link, "Could not allocate RTM_GETLINK message");
+ return r;
+ }
+
+ r = sd_rtnl_call_async(link->manager->rtnl, req, link_get_handler, link, 0, NULL);
+ if (r < 0) {
+ log_error_link(link,
+ "Could not send rtnetlink message: %s", strerror(-r));
+ return r;
+ }
+
+ return 0;
+}
+
+int link_configure(Link *link) {
+ int r;
+
+ assert(link);
+ assert(link->network);
+ assert(link->state == _LINK_STATE_INVALID);
+
+ r = link_get(link);
+ if (r < 0) {
+ link_enter_failed(link);
+ return r;
+ }
+
+ return link_enter_join_bridge(link);
+}
+
+int link_update(Link *link, sd_rtnl_message *m) {
+ unsigned flags;
+ void *data;
+ uint16_t type;
+ int r;
+
+ assert(link);
+ assert(m);
+
+ if (link->state == LINK_STATE_FAILED)
+ return 0;
+
+ r = sd_rtnl_message_link_get_flags(m, &flags);
+ if (r < 0) {
+ log_warning_link(link, "Could not get link flags");
+ return r;
+ }
+
+ while (sd_rtnl_message_read(m, &type, &data) > 0) {
+ if (type == IFLA_MTU && link->network->dhcp_mtu && !link->original_mtu) {
+ link->original_mtu = *(uint16_t *) data;
+ log_debug_link(link, "saved original MTU: %" PRIu16, link->original_mtu);
+ }
+ }
+
+ return link_update_flags(link, flags);
+}