This source file includes following definitions.
- file_append_cleanup
- mmap_cleanup
- ulseek
- uwrite
- umalloc
- mmap_file
- make_nop_x86
- make_nop_arm
- make_nop_arm64
- write_file
- w8rev
- w4rev
- w2rev
- w8nat
- w4nat
- w2nat
- is_mcounted_section_name
- arm_is_fake_mcount
- MIPS64_r_sym
- MIPS64_r_info
- do_file
- main
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24 #include <sys/types.h>
25 #include <sys/mman.h>
26 #include <sys/stat.h>
27 #include <getopt.h>
28 #include <elf.h>
29 #include <fcntl.h>
30 #include <stdio.h>
31 #include <stdlib.h>
32 #include <string.h>
33 #include <unistd.h>
34
35 #ifndef EM_AARCH64
36 #define EM_AARCH64 183
37 #define R_AARCH64_NONE 0
38 #define R_AARCH64_ABS64 257
39 #endif
40
41 #define R_ARM_PC24 1
42 #define R_ARM_THM_CALL 10
43 #define R_ARM_CALL 28
44
45 static int fd_map;
46 static int mmap_failed;
47 static char gpfx;
48 static struct stat sb;
49 static const char *altmcount;
50 static int warn_on_notrace_sect;
51 static void *file_map;
52 static void *file_end;
53 static int file_updated;
54 static void *file_ptr;
55
56 static void *file_append;
57 static size_t file_append_size;
58
59
60 static void file_append_cleanup(void)
61 {
62 free(file_append);
63 file_append = NULL;
64 file_append_size = 0;
65 file_updated = 0;
66 }
67
68 static void mmap_cleanup(void)
69 {
70 if (!mmap_failed)
71 munmap(file_map, sb.st_size);
72 else
73 free(file_map);
74 file_map = NULL;
75 }
76
77
78
79 static off_t ulseek(off_t const offset, int const whence)
80 {
81 switch (whence) {
82 case SEEK_SET:
83 file_ptr = file_map + offset;
84 break;
85 case SEEK_CUR:
86 file_ptr += offset;
87 break;
88 case SEEK_END:
89 file_ptr = file_map + (sb.st_size - offset);
90 break;
91 }
92 if (file_ptr < file_map) {
93 fprintf(stderr, "lseek: seek before file\n");
94 return -1;
95 }
96 return file_ptr - file_map;
97 }
98
99 static ssize_t uwrite(void const *const buf, size_t const count)
100 {
101 size_t cnt = count;
102 off_t idx = 0;
103
104 file_updated = 1;
105
106 if (file_ptr + count >= file_end) {
107 off_t aoffset = (file_ptr + count) - file_end;
108
109 if (aoffset > file_append_size) {
110 file_append = realloc(file_append, aoffset);
111 file_append_size = aoffset;
112 }
113 if (!file_append) {
114 perror("write");
115 file_append_cleanup();
116 mmap_cleanup();
117 return -1;
118 }
119 if (file_ptr < file_end) {
120 cnt = file_end - file_ptr;
121 } else {
122 cnt = 0;
123 idx = aoffset - count;
124 }
125 }
126
127 if (cnt)
128 memcpy(file_ptr, buf, cnt);
129
130 if (cnt < count)
131 memcpy(file_append + idx, buf + cnt, count - cnt);
132
133 file_ptr += count;
134 return count;
135 }
136
137 static void * umalloc(size_t size)
138 {
139 void *const addr = malloc(size);
140 if (addr == 0) {
141 fprintf(stderr, "malloc failed: %zu bytes\n", size);
142 file_append_cleanup();
143 mmap_cleanup();
144 return NULL;
145 }
146 return addr;
147 }
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162 static void *mmap_file(char const *fname)
163 {
164
165 fd_map = -1;
166 mmap_failed = 1;
167 file_map = NULL;
168 file_ptr = NULL;
169 file_updated = 0;
170 sb.st_size = 0;
171
172 fd_map = open(fname, O_RDONLY);
173 if (fd_map < 0) {
174 perror(fname);
175 return NULL;
176 }
177 if (fstat(fd_map, &sb) < 0) {
178 perror(fname);
179 goto out;
180 }
181 if (!S_ISREG(sb.st_mode)) {
182 fprintf(stderr, "not a regular file: %s\n", fname);
183 goto out;
184 }
185 file_map = mmap(0, sb.st_size, PROT_READ|PROT_WRITE, MAP_PRIVATE,
186 fd_map, 0);
187 if (file_map == MAP_FAILED) {
188 mmap_failed = 1;
189 file_map = umalloc(sb.st_size);
190 if (!file_map) {
191 perror(fname);
192 goto out;
193 }
194 if (read(fd_map, file_map, sb.st_size) != sb.st_size) {
195 perror(fname);
196 free(file_map);
197 file_map = NULL;
198 goto out;
199 }
200 } else
201 mmap_failed = 0;
202 out:
203 close(fd_map);
204 fd_map = -1;
205
206 file_end = file_map + sb.st_size;
207
208 return file_map;
209 }
210
211
212 static unsigned char ideal_nop5_x86_64[5] = { 0x0f, 0x1f, 0x44, 0x00, 0x00 };
213 static unsigned char ideal_nop5_x86_32[5] = { 0x3e, 0x8d, 0x74, 0x26, 0x00 };
214 static unsigned char *ideal_nop;
215
216 static char rel_type_nop;
217
218 static int (*make_nop)(void *map, size_t const offset);
219
220 static int make_nop_x86(void *map, size_t const offset)
221 {
222 uint32_t *ptr;
223 unsigned char *op;
224
225
226 ptr = map + offset;
227 if (*ptr != 0)
228 return -1;
229
230 op = map + offset - 1;
231 if (*op != 0xe8)
232 return -1;
233
234
235 if (ulseek(offset - 1, SEEK_SET) < 0)
236 return -1;
237 if (uwrite(ideal_nop, 5) < 0)
238 return -1;
239 return 0;
240 }
241
242 static unsigned char ideal_nop4_arm_le[4] = { 0x00, 0x00, 0xa0, 0xe1 };
243 static unsigned char ideal_nop4_arm_be[4] = { 0xe1, 0xa0, 0x00, 0x00 };
244 static unsigned char *ideal_nop4_arm;
245
246 static unsigned char bl_mcount_arm_le[4] = { 0xfe, 0xff, 0xff, 0xeb };
247 static unsigned char bl_mcount_arm_be[4] = { 0xeb, 0xff, 0xff, 0xfe };
248 static unsigned char *bl_mcount_arm;
249
250 static unsigned char push_arm_le[4] = { 0x04, 0xe0, 0x2d, 0xe5 };
251 static unsigned char push_arm_be[4] = { 0xe5, 0x2d, 0xe0, 0x04 };
252 static unsigned char *push_arm;
253
254 static unsigned char ideal_nop2_thumb_le[2] = { 0x00, 0xbf };
255 static unsigned char ideal_nop2_thumb_be[2] = { 0xbf, 0x00 };
256 static unsigned char *ideal_nop2_thumb;
257
258 static unsigned char push_bl_mcount_thumb_le[6] = { 0x00, 0xb5, 0xff, 0xf7, 0xfe, 0xff };
259 static unsigned char push_bl_mcount_thumb_be[6] = { 0xb5, 0x00, 0xf7, 0xff, 0xff, 0xfe };
260 static unsigned char *push_bl_mcount_thumb;
261
262 static int make_nop_arm(void *map, size_t const offset)
263 {
264 char *ptr;
265 int cnt = 1;
266 int nop_size;
267 size_t off = offset;
268
269 ptr = map + offset;
270 if (memcmp(ptr, bl_mcount_arm, 4) == 0) {
271 if (memcmp(ptr - 4, push_arm, 4) == 0) {
272 off -= 4;
273 cnt = 2;
274 }
275 ideal_nop = ideal_nop4_arm;
276 nop_size = 4;
277 } else if (memcmp(ptr - 2, push_bl_mcount_thumb, 6) == 0) {
278 cnt = 3;
279 nop_size = 2;
280 off -= 2;
281 ideal_nop = ideal_nop2_thumb;
282 } else
283 return -1;
284
285
286 if (ulseek(off, SEEK_SET) < 0)
287 return -1;
288
289 do {
290 if (uwrite(ideal_nop, nop_size) < 0)
291 return -1;
292 } while (--cnt > 0);
293
294 return 0;
295 }
296
297 static unsigned char ideal_nop4_arm64[4] = {0x1f, 0x20, 0x03, 0xd5};
298 static int make_nop_arm64(void *map, size_t const offset)
299 {
300 uint32_t *ptr;
301
302 ptr = map + offset;
303
304 if (*ptr != 0x94000000)
305 return -1;
306
307
308 if (ulseek(offset, SEEK_SET) < 0)
309 return -1;
310 if (uwrite(ideal_nop, 4) < 0)
311 return -1;
312 return 0;
313 }
314
315 static int write_file(const char *fname)
316 {
317 char tmp_file[strlen(fname) + 4];
318 size_t n;
319
320 if (!file_updated)
321 return 0;
322
323 sprintf(tmp_file, "%s.rc", fname);
324
325
326
327
328
329
330 fd_map = open(tmp_file, O_WRONLY | O_TRUNC | O_CREAT, sb.st_mode);
331 if (fd_map < 0) {
332 perror(fname);
333 return -1;
334 }
335 n = write(fd_map, file_map, sb.st_size);
336 if (n != sb.st_size) {
337 perror("write");
338 close(fd_map);
339 return -1;
340 }
341 if (file_append_size) {
342 n = write(fd_map, file_append, file_append_size);
343 if (n != file_append_size) {
344 perror("write");
345 close(fd_map);
346 return -1;
347 }
348 }
349 close(fd_map);
350 if (rename(tmp_file, fname) < 0) {
351 perror(fname);
352 return -1;
353 }
354 return 0;
355 }
356
357
358
359 static uint64_t w8rev(uint64_t const x)
360 {
361 return ((0xff & (x >> (0 * 8))) << (7 * 8))
362 | ((0xff & (x >> (1 * 8))) << (6 * 8))
363 | ((0xff & (x >> (2 * 8))) << (5 * 8))
364 | ((0xff & (x >> (3 * 8))) << (4 * 8))
365 | ((0xff & (x >> (4 * 8))) << (3 * 8))
366 | ((0xff & (x >> (5 * 8))) << (2 * 8))
367 | ((0xff & (x >> (6 * 8))) << (1 * 8))
368 | ((0xff & (x >> (7 * 8))) << (0 * 8));
369 }
370
371 static uint32_t w4rev(uint32_t const x)
372 {
373 return ((0xff & (x >> (0 * 8))) << (3 * 8))
374 | ((0xff & (x >> (1 * 8))) << (2 * 8))
375 | ((0xff & (x >> (2 * 8))) << (1 * 8))
376 | ((0xff & (x >> (3 * 8))) << (0 * 8));
377 }
378
379 static uint32_t w2rev(uint16_t const x)
380 {
381 return ((0xff & (x >> (0 * 8))) << (1 * 8))
382 | ((0xff & (x >> (1 * 8))) << (0 * 8));
383 }
384
385 static uint64_t w8nat(uint64_t const x)
386 {
387 return x;
388 }
389
390 static uint32_t w4nat(uint32_t const x)
391 {
392 return x;
393 }
394
395 static uint32_t w2nat(uint16_t const x)
396 {
397 return x;
398 }
399
400 static uint64_t (*w8)(uint64_t);
401 static uint32_t (*w)(uint32_t);
402 static uint32_t (*w2)(uint16_t);
403
404
405 static int is_mcounted_section_name(char const *const txtname)
406 {
407 return strncmp(".text", txtname, 5) == 0 ||
408 strcmp(".init.text", txtname) == 0 ||
409 strcmp(".ref.text", txtname) == 0 ||
410 strcmp(".sched.text", txtname) == 0 ||
411 strcmp(".spinlock.text", txtname) == 0 ||
412 strcmp(".irqentry.text", txtname) == 0 ||
413 strcmp(".softirqentry.text", txtname) == 0 ||
414 strcmp(".kprobes.text", txtname) == 0 ||
415 strcmp(".cpuidle.text", txtname) == 0;
416 }
417
418 static char const *already_has_rel_mcount = "success";
419
420
421 #include "recordmcount.h"
422 #define RECORD_MCOUNT_64
423 #include "recordmcount.h"
424
425 static int arm_is_fake_mcount(Elf32_Rel const *rp)
426 {
427 switch (ELF32_R_TYPE(w(rp->r_info))) {
428 case R_ARM_THM_CALL:
429 case R_ARM_CALL:
430 case R_ARM_PC24:
431 return 0;
432 }
433
434 return 1;
435 }
436
437
438
439
440
441
442
443
444
445 typedef uint8_t myElf64_Byte;
446
447 union mips_r_info {
448 Elf64_Xword r_info;
449 struct {
450 Elf64_Word r_sym;
451 myElf64_Byte r_ssym;
452 myElf64_Byte r_type3;
453 myElf64_Byte r_type2;
454 myElf64_Byte r_type;
455 } r_mips;
456 };
457
458 static uint64_t MIPS64_r_sym(Elf64_Rel const *rp)
459 {
460 return w(((union mips_r_info){ .r_info = rp->r_info }).r_mips.r_sym);
461 }
462
463 static void MIPS64_r_info(Elf64_Rel *const rp, unsigned sym, unsigned type)
464 {
465 rp->r_info = ((union mips_r_info){
466 .r_mips = { .r_sym = w(sym), .r_type = type }
467 }).r_info;
468 }
469
470 static int do_file(char const *const fname)
471 {
472 unsigned int reltype = 0;
473 Elf32_Ehdr *ehdr;
474 int rc = -1;
475
476 ehdr = mmap_file(fname);
477 if (!ehdr)
478 goto out;
479
480 w = w4nat;
481 w2 = w2nat;
482 w8 = w8nat;
483 switch (ehdr->e_ident[EI_DATA]) {
484 static unsigned int const endian = 1;
485 default:
486 fprintf(stderr, "unrecognized ELF data encoding %d: %s\n",
487 ehdr->e_ident[EI_DATA], fname);
488 goto out;
489 case ELFDATA2LSB:
490 if (*(unsigned char const *)&endian != 1) {
491
492 w = w4rev;
493 w2 = w2rev;
494 w8 = w8rev;
495 }
496 ideal_nop4_arm = ideal_nop4_arm_le;
497 bl_mcount_arm = bl_mcount_arm_le;
498 push_arm = push_arm_le;
499 ideal_nop2_thumb = ideal_nop2_thumb_le;
500 push_bl_mcount_thumb = push_bl_mcount_thumb_le;
501 break;
502 case ELFDATA2MSB:
503 if (*(unsigned char const *)&endian != 0) {
504
505 w = w4rev;
506 w2 = w2rev;
507 w8 = w8rev;
508 }
509 ideal_nop4_arm = ideal_nop4_arm_be;
510 bl_mcount_arm = bl_mcount_arm_be;
511 push_arm = push_arm_be;
512 ideal_nop2_thumb = ideal_nop2_thumb_be;
513 push_bl_mcount_thumb = push_bl_mcount_thumb_be;
514 break;
515 }
516 if (memcmp(ELFMAG, ehdr->e_ident, SELFMAG) != 0 ||
517 w2(ehdr->e_type) != ET_REL ||
518 ehdr->e_ident[EI_VERSION] != EV_CURRENT) {
519 fprintf(stderr, "unrecognized ET_REL file %s\n", fname);
520 goto out;
521 }
522
523 gpfx = '_';
524 switch (w2(ehdr->e_machine)) {
525 default:
526 fprintf(stderr, "unrecognized e_machine %u %s\n",
527 w2(ehdr->e_machine), fname);
528 goto out;
529 case EM_386:
530 reltype = R_386_32;
531 rel_type_nop = R_386_NONE;
532 make_nop = make_nop_x86;
533 ideal_nop = ideal_nop5_x86_32;
534 mcount_adjust_32 = -1;
535 gpfx = 0;
536 break;
537 case EM_ARM:
538 reltype = R_ARM_ABS32;
539 altmcount = "__gnu_mcount_nc";
540 make_nop = make_nop_arm;
541 rel_type_nop = R_ARM_NONE;
542 is_fake_mcount32 = arm_is_fake_mcount;
543 gpfx = 0;
544 break;
545 case EM_AARCH64:
546 reltype = R_AARCH64_ABS64;
547 make_nop = make_nop_arm64;
548 rel_type_nop = R_AARCH64_NONE;
549 ideal_nop = ideal_nop4_arm64;
550 break;
551 case EM_IA_64: reltype = R_IA64_IMM64; break;
552 case EM_MIPS: break;
553 case EM_PPC: reltype = R_PPC_ADDR32; break;
554 case EM_PPC64: reltype = R_PPC64_ADDR64; break;
555 case EM_S390: break;
556 case EM_SH: reltype = R_SH_DIR32; gpfx = 0; break;
557 case EM_SPARCV9: reltype = R_SPARC_64; break;
558 case EM_X86_64:
559 make_nop = make_nop_x86;
560 ideal_nop = ideal_nop5_x86_64;
561 reltype = R_X86_64_64;
562 rel_type_nop = R_X86_64_NONE;
563 mcount_adjust_64 = -1;
564 gpfx = 0;
565 break;
566 }
567
568 switch (ehdr->e_ident[EI_CLASS]) {
569 default:
570 fprintf(stderr, "unrecognized ELF class %d %s\n",
571 ehdr->e_ident[EI_CLASS], fname);
572 goto out;
573 case ELFCLASS32:
574 if (w2(ehdr->e_ehsize) != sizeof(Elf32_Ehdr)
575 || w2(ehdr->e_shentsize) != sizeof(Elf32_Shdr)) {
576 fprintf(stderr,
577 "unrecognized ET_REL file: %s\n", fname);
578 goto out;
579 }
580 if (w2(ehdr->e_machine) == EM_MIPS) {
581 reltype = R_MIPS_32;
582 is_fake_mcount32 = MIPS32_is_fake_mcount;
583 }
584 if (do32(ehdr, fname, reltype) < 0)
585 goto out;
586 break;
587 case ELFCLASS64: {
588 Elf64_Ehdr *const ghdr = (Elf64_Ehdr *)ehdr;
589 if (w2(ghdr->e_ehsize) != sizeof(Elf64_Ehdr)
590 || w2(ghdr->e_shentsize) != sizeof(Elf64_Shdr)) {
591 fprintf(stderr,
592 "unrecognized ET_REL file: %s\n", fname);
593 goto out;
594 }
595 if (w2(ghdr->e_machine) == EM_S390) {
596 reltype = R_390_64;
597 mcount_adjust_64 = -14;
598 }
599 if (w2(ghdr->e_machine) == EM_MIPS) {
600 reltype = R_MIPS_64;
601 Elf64_r_sym = MIPS64_r_sym;
602 Elf64_r_info = MIPS64_r_info;
603 is_fake_mcount64 = MIPS64_is_fake_mcount;
604 }
605 if (do64(ghdr, fname, reltype) < 0)
606 goto out;
607 break;
608 }
609 }
610
611 rc = write_file(fname);
612 out:
613 file_append_cleanup();
614 mmap_cleanup();
615 return rc;
616 }
617
618 int main(int argc, char *argv[])
619 {
620 const char ftrace[] = "/ftrace.o";
621 int ftrace_size = sizeof(ftrace) - 1;
622 int n_error = 0;
623 int c;
624 int i;
625
626 while ((c = getopt(argc, argv, "w")) >= 0) {
627 switch (c) {
628 case 'w':
629 warn_on_notrace_sect = 1;
630 break;
631 default:
632 fprintf(stderr, "usage: recordmcount [-w] file.o...\n");
633 return 0;
634 }
635 }
636
637 if ((argc - optind) < 1) {
638 fprintf(stderr, "usage: recordmcount [-w] file.o...\n");
639 return 0;
640 }
641
642
643 for (i = optind; i < argc; i++) {
644 char *file = argv[i];
645 int len;
646
647
648
649
650
651
652 len = strlen(file);
653 if (len >= ftrace_size &&
654 strcmp(file + (len - ftrace_size), ftrace) == 0)
655 continue;
656
657 if (do_file(file)) {
658 fprintf(stderr, "%s: failed\n", file);
659 ++n_error;
660 }
661 }
662 return !!n_error;
663 }