Line data    Source code

       1             : /* SPDX-License-Identifier: LGPL-2.1+ */
       2             : 
       3             : #include <errno.h>
       4             : 
       5             : #include "sd-event.h"
       6             : #include "sd-netlink.h"
       7             : 
       8             : #include "networkd-link-bus.h"
       9             : #include "networkd-link.h"
      10             : #include "networkd-manager.h"
      11             : #include "networkd-speed-meter.h"
      12             : 
      13           0 : static int process_message(Manager *manager, sd_netlink_message *message) {
      14             :         uint16_t type;
      15             :         int ifindex, r;
      16             :         Link *link;
      17             : 
      18           0 :         r = sd_netlink_message_get_type(message, &type);
      19           0 :         if (r < 0)
      20           0 :                 return r;
      21             : 
      22           0 :         if (type != RTM_NEWLINK)
      23           0 :                 return 0;
      24             : 
      25           0 :         r = sd_rtnl_message_link_get_ifindex(message, &ifindex);
      26           0 :         if (r < 0)
      27           0 :                 return r;
      28             : 
      29           0 :         link = hashmap_get(manager->links, INT_TO_PTR(ifindex));
      30           0 :         if (!link)
      31           0 :                 return -ENODEV;
      32             : 
      33           0 :         link->stats_old = link->stats_new;
      34             : 
      35           0 :         r = sd_netlink_message_read(message, IFLA_STATS64, sizeof link->stats_new, &link->stats_new);
      36           0 :         if (r < 0)
      37           0 :                 return r;
      38             : 
      39           0 :         link->stats_updated = true;
      40             : 
      41           0 :         return 0;
      42             : }
      43             : 
      44           0 : static int speed_meter_handler(sd_event_source *s, uint64_t usec, void *userdata) {
      45           0 :         _cleanup_(sd_netlink_message_unrefp) sd_netlink_message *req = NULL, *reply = NULL;
      46           0 :         Manager *manager = userdata;
      47             :         sd_netlink_message *i;
      48             :         usec_t usec_now;
      49             :         Iterator j;
      50             :         Link *link;
      51             :         int r;
      52             : 
      53           0 :         assert(s);
      54           0 :         assert(userdata);
      55             : 
      56           0 :         r = sd_event_now(sd_event_source_get_event(s), CLOCK_MONOTONIC, &usec_now);
      57           0 :         if (r < 0)
      58           0 :                 return r;
      59             : 
      60           0 :         r = sd_event_source_set_time(s, usec_now + manager->speed_meter_interval_usec);
      61           0 :         if (r < 0)
      62           0 :                 return r;
      63             : 
      64           0 :         manager->speed_meter_usec_old = manager->speed_meter_usec_new;
      65           0 :         manager->speed_meter_usec_new = usec_now;
      66             : 
      67           0 :         HASHMAP_FOREACH(link, manager->links, j)
      68           0 :                 link->stats_updated = false;
      69             : 
      70           0 :         r = sd_rtnl_message_new_link(manager->rtnl, &req, RTM_GETLINK, 0);
      71           0 :         if (r < 0) {
      72           0 :                 log_warning_errno(r, "Failed to allocate RTM_GETLINK netlink message, ignoring: %m");
      73           0 :                 return 0;
      74             :         }
      75             : 
      76           0 :         r = sd_netlink_message_request_dump(req, true);
      77           0 :         if (r < 0) {
      78           0 :                 log_warning_errno(r, "Failed to set dump flag, ignoring: %m");
      79           0 :                 return 0;
      80             :         }
      81             : 
      82           0 :         r = sd_netlink_call(manager->rtnl, req, 0, &reply);
      83           0 :         if (r < 0) {
      84           0 :                 log_warning_errno(r, "Failed to call RTM_GETLINK, ignoring: %m");
      85           0 :                 return 0;
      86             :         }
      87             : 
      88           0 :         for (i = reply; i; i = sd_netlink_message_next(i))
      89           0 :                 (void) process_message(manager, i);
      90             : 
      91           0 :         return 0;
      92             : }
      93             : 
      94           0 : int manager_start_speed_meter(Manager *manager) {
      95           0 :         _cleanup_(sd_event_source_unrefp) sd_event_source *s = NULL;
      96             :         int r;
      97             : 
      98           0 :         assert(manager);
      99           0 :         assert(manager->event);
     100             : 
     101           0 :         if (!manager->use_speed_meter)
     102           0 :                 return 0;
     103             : 
     104           0 :         r = sd_event_add_time(manager->event, &s, CLOCK_MONOTONIC, 0, 0, speed_meter_handler, manager);
     105           0 :         if (r < 0)
     106           0 :                 return r;
     107             : 
     108           0 :         r = sd_event_source_set_enabled(s, SD_EVENT_ON);
     109           0 :         if (r < 0)
     110           0 :                 return r;
     111             : 
     112           0 :         manager->speed_meter_event_source = TAKE_PTR(s);
     113           0 :         return 0;
     114             : }