Debian Codegraph @

src/network/networkd-speed-meter.c

raw
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 }