Commit | Line | Data |
---|---|---|
0e0af57e DTO |
1 | // SPDX-License-Identifier: GPL-2.0 |
2 | /* procacct.c | |
3 | * | |
4 | * Demonstrator of fetching resource data on task exit, as a way | |
5 | * to accumulate accurate program resource usage statistics, without | |
6 | * prior identification of the programs. For that, the fields for | |
7 | * device and inode of the program executable binary file are also | |
8 | * extracted in addition to the command string. | |
9 | * | |
10 | * The TGID together with the PID and the AGROUP flag allow | |
11 | * identification of threads in a process and single-threaded processes. | |
12 | * The ac_tgetime field gives proper whole-process walltime. | |
13 | * | |
14 | * Written (changed) by Thomas Orgis, University of Hamburg in 2022 | |
15 | * | |
16 | * This is a cheap derivation (inheriting the style) of getdelays.c: | |
17 | * | |
18 | * Utility to get per-pid and per-tgid delay accounting statistics | |
19 | * Also illustrates usage of the taskstats interface | |
20 | * | |
21 | * Copyright (C) Shailabh Nagar, IBM Corp. 2005 | |
22 | * Copyright (C) Balbir Singh, IBM Corp. 2006 | |
23 | * Copyright (c) Jay Lan, SGI. 2006 | |
24 | */ | |
25 | ||
26 | #include <stdio.h> | |
27 | #include <stdlib.h> | |
28 | #include <errno.h> | |
29 | #include <unistd.h> | |
30 | #include <poll.h> | |
31 | #include <string.h> | |
32 | #include <fcntl.h> | |
33 | #include <sys/types.h> | |
34 | #include <sys/stat.h> | |
35 | #include <sys/socket.h> | |
36 | #include <sys/wait.h> | |
37 | #include <signal.h> | |
38 | ||
39 | #include <linux/genetlink.h> | |
40 | #include <linux/acct.h> | |
41 | #include <linux/taskstats.h> | |
42 | #include <linux/kdev_t.h> | |
43 | ||
44 | /* | |
45 | * Generic macros for dealing with netlink sockets. Might be duplicated | |
46 | * elsewhere. It is recommended that commercial grade applications use | |
47 | * libnl or libnetlink and use the interfaces provided by the library | |
48 | */ | |
49 | #define GENLMSG_DATA(glh) ((void *)(NLMSG_DATA(glh) + GENL_HDRLEN)) | |
50 | #define GENLMSG_PAYLOAD(glh) (NLMSG_PAYLOAD(glh, 0) - GENL_HDRLEN) | |
51 | #define NLA_DATA(na) ((void *)((char *)(na) + NLA_HDRLEN)) | |
52 | #define NLA_PAYLOAD(len) (len - NLA_HDRLEN) | |
53 | ||
54 | #define err(code, fmt, arg...) \ | |
55 | do { \ | |
56 | fprintf(stderr, fmt, ##arg); \ | |
57 | exit(code); \ | |
58 | } while (0) | |
59 | ||
60 | int rcvbufsz; | |
61 | char name[100]; | |
62 | int dbg; | |
63 | int print_delays; | |
64 | int print_io_accounting; | |
65 | int print_task_context_switch_counts; | |
66 | ||
67 | #define PRINTF(fmt, arg...) { \ | |
68 | if (dbg) { \ | |
69 | printf(fmt, ##arg); \ | |
70 | } \ | |
71 | } | |
72 | ||
73 | /* Maximum size of response requested or message sent */ | |
74 | #define MAX_MSG_SIZE 1024 | |
75 | /* Maximum number of cpus expected to be specified in a cpumask */ | |
76 | #define MAX_CPUS 32 | |
77 | ||
78 | struct msgtemplate { | |
79 | struct nlmsghdr n; | |
80 | struct genlmsghdr g; | |
81 | char buf[MAX_MSG_SIZE]; | |
82 | }; | |
83 | ||
84 | char cpumask[100+6*MAX_CPUS]; | |
85 | ||
86 | static void usage(void) | |
87 | { | |
88 | fprintf(stderr, "procacct [-v] [-w logfile] [-r bufsize] [-m cpumask]\n"); | |
89 | fprintf(stderr, " -v: debug on\n"); | |
90 | } | |
91 | ||
92 | /* | |
93 | * Create a raw netlink socket and bind | |
94 | */ | |
95 | static int create_nl_socket(int protocol) | |
96 | { | |
97 | int fd; | |
98 | struct sockaddr_nl local; | |
99 | ||
100 | fd = socket(AF_NETLINK, SOCK_RAW, protocol); | |
101 | if (fd < 0) | |
102 | return -1; | |
103 | ||
104 | if (rcvbufsz) | |
105 | if (setsockopt(fd, SOL_SOCKET, SO_RCVBUF, | |
106 | &rcvbufsz, sizeof(rcvbufsz)) < 0) { | |
107 | fprintf(stderr, "Unable to set socket rcv buf size to %d\n", | |
108 | rcvbufsz); | |
109 | goto error; | |
110 | } | |
111 | ||
112 | memset(&local, 0, sizeof(local)); | |
113 | local.nl_family = AF_NETLINK; | |
114 | ||
115 | if (bind(fd, (struct sockaddr *) &local, sizeof(local)) < 0) | |
116 | goto error; | |
117 | ||
118 | return fd; | |
119 | error: | |
120 | close(fd); | |
121 | return -1; | |
122 | } | |
123 | ||
124 | ||
125 | static int send_cmd(int sd, __u16 nlmsg_type, __u32 nlmsg_pid, | |
126 | __u8 genl_cmd, __u16 nla_type, | |
127 | void *nla_data, int nla_len) | |
128 | { | |
129 | struct nlattr *na; | |
130 | struct sockaddr_nl nladdr; | |
131 | int r, buflen; | |
132 | char *buf; | |
133 | ||
134 | struct msgtemplate msg; | |
135 | ||
136 | msg.n.nlmsg_len = NLMSG_LENGTH(GENL_HDRLEN); | |
137 | msg.n.nlmsg_type = nlmsg_type; | |
138 | msg.n.nlmsg_flags = NLM_F_REQUEST; | |
139 | msg.n.nlmsg_seq = 0; | |
140 | msg.n.nlmsg_pid = nlmsg_pid; | |
141 | msg.g.cmd = genl_cmd; | |
142 | msg.g.version = 0x1; | |
143 | na = (struct nlattr *) GENLMSG_DATA(&msg); | |
144 | na->nla_type = nla_type; | |
145 | na->nla_len = nla_len + 1 + NLA_HDRLEN; | |
146 | memcpy(NLA_DATA(na), nla_data, nla_len); | |
147 | msg.n.nlmsg_len += NLMSG_ALIGN(na->nla_len); | |
148 | ||
149 | buf = (char *) &msg; | |
150 | buflen = msg.n.nlmsg_len; | |
151 | memset(&nladdr, 0, sizeof(nladdr)); | |
152 | nladdr.nl_family = AF_NETLINK; | |
153 | while ((r = sendto(sd, buf, buflen, 0, (struct sockaddr *) &nladdr, | |
154 | sizeof(nladdr))) < buflen) { | |
155 | if (r > 0) { | |
156 | buf += r; | |
157 | buflen -= r; | |
158 | } else if (errno != EAGAIN) | |
159 | return -1; | |
160 | } | |
161 | return 0; | |
162 | } | |
163 | ||
164 | ||
165 | /* | |
166 | * Probe the controller in genetlink to find the family id | |
167 | * for the TASKSTATS family | |
168 | */ | |
169 | static int get_family_id(int sd) | |
170 | { | |
171 | struct { | |
172 | struct nlmsghdr n; | |
173 | struct genlmsghdr g; | |
174 | char buf[256]; | |
175 | } ans; | |
176 | ||
177 | int id = 0, rc; | |
178 | struct nlattr *na; | |
179 | int rep_len; | |
180 | ||
181 | strcpy(name, TASKSTATS_GENL_NAME); | |
182 | rc = send_cmd(sd, GENL_ID_CTRL, getpid(), CTRL_CMD_GETFAMILY, | |
183 | CTRL_ATTR_FAMILY_NAME, (void *)name, | |
184 | strlen(TASKSTATS_GENL_NAME)+1); | |
185 | if (rc < 0) | |
186 | return 0; /* sendto() failure? */ | |
187 | ||
188 | rep_len = recv(sd, &ans, sizeof(ans), 0); | |
189 | if (ans.n.nlmsg_type == NLMSG_ERROR || | |
190 | (rep_len < 0) || !NLMSG_OK((&ans.n), rep_len)) | |
191 | return 0; | |
192 | ||
193 | na = (struct nlattr *) GENLMSG_DATA(&ans); | |
194 | na = (struct nlattr *) ((char *) na + NLA_ALIGN(na->nla_len)); | |
195 | if (na->nla_type == CTRL_ATTR_FAMILY_ID) | |
196 | id = *(__u16 *) NLA_DATA(na); | |
197 | ||
198 | return id; | |
199 | } | |
200 | ||
201 | #define average_ms(t, c) (t / 1000000ULL / (c ? c : 1)) | |
202 | ||
203 | static void print_procacct(struct taskstats *t) | |
204 | { | |
205 | /* First letter: T is a mere thread, G the last in a group, U unknown. */ | |
206 | printf( | |
207 | "%c pid=%lu tgid=%lu uid=%lu wall=%llu gwall=%llu cpu=%llu vmpeak=%llu rsspeak=%llu dev=%lu:%lu inode=%llu comm=%s\n" | |
208 | , t->version >= 12 ? (t->ac_flag & AGROUP ? 'P' : 'T') : '?' | |
209 | , (unsigned long)t->ac_pid | |
210 | , (unsigned long)(t->version >= 12 ? t->ac_tgid : 0) | |
211 | , (unsigned long)t->ac_uid | |
212 | , (unsigned long long)t->ac_etime | |
213 | , (unsigned long long)(t->version >= 12 ? t->ac_tgetime : 0) | |
214 | , (unsigned long long)(t->ac_utime+t->ac_stime) | |
215 | , (unsigned long long)t->hiwater_vm | |
216 | , (unsigned long long)t->hiwater_rss | |
217 | , (unsigned long)(t->version >= 12 ? MAJOR(t->ac_exe_dev) : 0) | |
218 | , (unsigned long)(t->version >= 12 ? MINOR(t->ac_exe_dev) : 0) | |
219 | , (unsigned long long)(t->version >= 12 ? t->ac_exe_inode : 0) | |
220 | , t->ac_comm | |
221 | ); | |
222 | } | |
223 | ||
224 | void handle_aggr(int mother, struct nlattr *na, int fd) | |
225 | { | |
226 | int aggr_len = NLA_PAYLOAD(na->nla_len); | |
227 | int len2 = 0; | |
228 | pid_t rtid = 0; | |
229 | ||
230 | na = (struct nlattr *) NLA_DATA(na); | |
231 | while (len2 < aggr_len) { | |
232 | switch (na->nla_type) { | |
233 | case TASKSTATS_TYPE_PID: | |
234 | rtid = *(int *) NLA_DATA(na); | |
235 | PRINTF("PID\t%d\n", rtid); | |
236 | break; | |
237 | case TASKSTATS_TYPE_TGID: | |
238 | rtid = *(int *) NLA_DATA(na); | |
239 | PRINTF("TGID\t%d\n", rtid); | |
240 | break; | |
241 | case TASKSTATS_TYPE_STATS: | |
242 | if (mother == TASKSTATS_TYPE_AGGR_PID) | |
243 | print_procacct((struct taskstats *) NLA_DATA(na)); | |
244 | if (fd) { | |
245 | if (write(fd, NLA_DATA(na), na->nla_len) < 0) | |
246 | err(1, "write error\n"); | |
247 | } | |
248 | break; | |
249 | case TASKSTATS_TYPE_NULL: | |
250 | break; | |
251 | default: | |
252 | fprintf(stderr, "Unknown nested nla_type %d\n", | |
253 | na->nla_type); | |
254 | break; | |
255 | } | |
256 | len2 += NLA_ALIGN(na->nla_len); | |
257 | na = (struct nlattr *)((char *)na + | |
258 | NLA_ALIGN(na->nla_len)); | |
259 | } | |
260 | } | |
261 | ||
262 | int main(int argc, char *argv[]) | |
263 | { | |
9629c2b9 | 264 | int c, rc, rep_len; |
0e0af57e DTO |
265 | __u16 id; |
266 | __u32 mypid; | |
267 | ||
268 | struct nlattr *na; | |
269 | int nl_sd = -1; | |
270 | int len = 0; | |
0e0af57e DTO |
271 | |
272 | int fd = 0; | |
273 | int write_file = 0; | |
274 | int maskset = 0; | |
275 | char *logfile = NULL; | |
0e0af57e DTO |
276 | int cfd = 0; |
277 | int forking = 0; | |
0e0af57e DTO |
278 | |
279 | struct msgtemplate msg; | |
280 | ||
281 | while (!forking) { | |
282 | c = getopt(argc, argv, "m:vr:"); | |
283 | if (c < 0) | |
284 | break; | |
285 | ||
286 | switch (c) { | |
287 | case 'w': | |
288 | logfile = strdup(optarg); | |
289 | printf("write to file %s\n", logfile); | |
290 | write_file = 1; | |
291 | break; | |
292 | case 'r': | |
293 | rcvbufsz = atoi(optarg); | |
294 | printf("receive buf size %d\n", rcvbufsz); | |
295 | if (rcvbufsz < 0) | |
296 | err(1, "Invalid rcv buf size\n"); | |
297 | break; | |
298 | case 'm': | |
299 | strncpy(cpumask, optarg, sizeof(cpumask)); | |
300 | cpumask[sizeof(cpumask) - 1] = '\0'; | |
301 | maskset = 1; | |
302 | break; | |
303 | case 'v': | |
304 | printf("debug on\n"); | |
305 | dbg = 1; | |
306 | break; | |
307 | default: | |
308 | usage(); | |
309 | exit(-1); | |
310 | } | |
311 | } | |
312 | if (!maskset) { | |
313 | maskset = 1; | |
314 | strncpy(cpumask, "1", sizeof(cpumask)); | |
315 | cpumask[sizeof(cpumask) - 1] = '\0'; | |
316 | } | |
317 | printf("cpumask %s maskset %d\n", cpumask, maskset); | |
318 | ||
319 | if (write_file) { | |
320 | fd = open(logfile, O_WRONLY | O_CREAT | O_TRUNC, 0644); | |
321 | if (fd == -1) { | |
322 | perror("Cannot open output file\n"); | |
323 | exit(1); | |
324 | } | |
325 | } | |
326 | ||
327 | nl_sd = create_nl_socket(NETLINK_GENERIC); | |
328 | if (nl_sd < 0) | |
329 | err(1, "error creating Netlink socket\n"); | |
330 | ||
331 | mypid = getpid(); | |
332 | id = get_family_id(nl_sd); | |
333 | if (!id) { | |
334 | fprintf(stderr, "Error getting family id, errno %d\n", errno); | |
335 | goto err; | |
336 | } | |
337 | PRINTF("family id %d\n", id); | |
338 | ||
339 | if (maskset) { | |
340 | rc = send_cmd(nl_sd, id, mypid, TASKSTATS_CMD_GET, | |
341 | TASKSTATS_CMD_ATTR_REGISTER_CPUMASK, | |
342 | &cpumask, strlen(cpumask) + 1); | |
343 | PRINTF("Sent register cpumask, retval %d\n", rc); | |
344 | if (rc < 0) { | |
345 | fprintf(stderr, "error sending register cpumask\n"); | |
346 | goto err; | |
347 | } | |
348 | } | |
349 | ||
350 | do { | |
351 | rep_len = recv(nl_sd, &msg, sizeof(msg), 0); | |
352 | PRINTF("received %d bytes\n", rep_len); | |
353 | ||
354 | if (rep_len < 0) { | |
355 | fprintf(stderr, "nonfatal reply error: errno %d\n", | |
356 | errno); | |
357 | continue; | |
358 | } | |
359 | if (msg.n.nlmsg_type == NLMSG_ERROR || | |
360 | !NLMSG_OK((&msg.n), rep_len)) { | |
361 | struct nlmsgerr *err = NLMSG_DATA(&msg); | |
362 | ||
363 | fprintf(stderr, "fatal reply error, errno %d\n", | |
364 | err->error); | |
365 | goto done; | |
366 | } | |
367 | ||
368 | PRINTF("nlmsghdr size=%zu, nlmsg_len=%d, rep_len=%d\n", | |
369 | sizeof(struct nlmsghdr), msg.n.nlmsg_len, rep_len); | |
370 | ||
371 | ||
372 | rep_len = GENLMSG_PAYLOAD(&msg.n); | |
373 | ||
374 | na = (struct nlattr *) GENLMSG_DATA(&msg); | |
375 | len = 0; | |
376 | while (len < rep_len) { | |
377 | len += NLA_ALIGN(na->nla_len); | |
378 | int mother = na->nla_type; | |
379 | ||
380 | PRINTF("mother=%i\n", mother); | |
381 | switch (na->nla_type) { | |
382 | case TASKSTATS_TYPE_AGGR_PID: | |
383 | case TASKSTATS_TYPE_AGGR_TGID: | |
384 | /* For nested attributes, na follows */ | |
385 | handle_aggr(mother, na, fd); | |
386 | break; | |
387 | default: | |
388 | fprintf(stderr, "Unexpected nla_type %d\n", | |
389 | na->nla_type); | |
390 | case TASKSTATS_TYPE_NULL: | |
391 | break; | |
392 | } | |
393 | na = (struct nlattr *) (GENLMSG_DATA(&msg) + len); | |
394 | } | |
395 | } while (1); | |
396 | done: | |
397 | if (maskset) { | |
398 | rc = send_cmd(nl_sd, id, mypid, TASKSTATS_CMD_GET, | |
399 | TASKSTATS_CMD_ATTR_DEREGISTER_CPUMASK, | |
400 | &cpumask, strlen(cpumask) + 1); | |
401 | printf("Sent deregister mask, retval %d\n", rc); | |
402 | if (rc < 0) | |
403 | err(rc, "error sending deregister cpumask\n"); | |
404 | } | |
405 | err: | |
406 | close(nl_sd); | |
407 | if (fd) | |
408 | close(fd); | |
409 | if (cfd) | |
410 | close(cfd); | |
411 | return 0; | |
412 | } |