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