PCI: Wait for up to 1000ms after FLR reset
[linux/fpc-iii.git] / scripts / recordmcount.c
blobe167592793a70e8a1bac057d58ca7456e064db8e
1 /*
2 * recordmcount.c: construct a table of the locations of calls to 'mcount'
3 * so that ftrace can find them quickly.
4 * Copyright 2009 John F. Reiser <jreiser@BitWagon.com>. All rights reserved.
5 * Licensed under the GNU General Public License, version 2 (GPLv2).
7 * Restructured to fit Linux format, as well as other updates:
8 * Copyright 2010 Steven Rostedt <srostedt@redhat.com>, Red Hat Inc.
9 */
12 * Strategy: alter the .o file in-place.
14 * Append a new STRTAB that has the new section names, followed by a new array
15 * ElfXX_Shdr[] that has the new section headers, followed by the section
16 * contents for __mcount_loc and its relocations. The old shstrtab strings,
17 * and the old ElfXX_Shdr[] array, remain as "garbage" (commonly, a couple
18 * kilobytes.) Subsequent processing by /bin/ld (or the kernel module loader)
19 * will ignore the garbage regions, because they are not designated by the
20 * new .e_shoff nor the new ElfXX_Shdr[]. [In order to remove the garbage,
21 * then use "ld -r" to create a new file that omits the garbage.]
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 <setjmp.h>
31 #include <stdio.h>
32 #include <stdlib.h>
33 #include <string.h>
34 #include <unistd.h>
36 #ifndef EM_METAG
37 /* Remove this when these make it to the standard system elf.h. */
38 #define EM_METAG 174
39 #define R_METAG_ADDR32 2
40 #define R_METAG_NONE 3
41 #endif
43 #ifndef EM_AARCH64
44 #define EM_AARCH64 183
45 #define R_AARCH64_NONE 0
46 #define R_AARCH64_ABS64 257
47 #endif
49 static int fd_map; /* File descriptor for file being modified. */
50 static int mmap_failed; /* Boolean flag. */
51 static char gpfx; /* prefix for global symbol name (sometimes '_') */
52 static struct stat sb; /* Remember .st_size, etc. */
53 static jmp_buf jmpenv; /* setjmp/longjmp per-file error escape */
54 static const char *altmcount; /* alternate mcount symbol name */
55 static int warn_on_notrace_sect; /* warn when section has mcount not being recorded */
56 static void *file_map; /* pointer of the mapped file */
57 static void *file_end; /* pointer to the end of the mapped file */
58 static int file_updated; /* flag to state file was changed */
59 static void *file_ptr; /* current file pointer location */
60 static void *file_append; /* added to the end of the file */
61 static size_t file_append_size; /* how much is added to end of file */
63 /* setjmp() return values */
64 enum {
65 SJ_SETJMP = 0, /* hardwired first return */
66 SJ_FAIL,
67 SJ_SUCCEED
70 /* Per-file resource cleanup when multiple files. */
71 static void
72 cleanup(void)
74 if (!mmap_failed)
75 munmap(file_map, sb.st_size);
76 else
77 free(file_map);
78 file_map = NULL;
79 free(file_append);
80 file_append = NULL;
81 file_append_size = 0;
82 file_updated = 0;
85 static void __attribute__((noreturn))
86 fail_file(void)
88 cleanup();
89 longjmp(jmpenv, SJ_FAIL);
92 static void __attribute__((noreturn))
93 succeed_file(void)
95 cleanup();
96 longjmp(jmpenv, SJ_SUCCEED);
99 /* ulseek, uread, ...: Check return value for errors. */
101 static off_t
102 ulseek(int const fd, off_t const offset, int const whence)
104 switch (whence) {
105 case SEEK_SET:
106 file_ptr = file_map + offset;
107 break;
108 case SEEK_CUR:
109 file_ptr += offset;
110 break;
111 case SEEK_END:
112 file_ptr = file_map + (sb.st_size - offset);
113 break;
115 if (file_ptr < file_map) {
116 fprintf(stderr, "lseek: seek before file\n");
117 fail_file();
119 return file_ptr - file_map;
122 static size_t
123 uread(int const fd, void *const buf, size_t const count)
125 size_t const n = read(fd, buf, count);
126 if (n != count) {
127 perror("read");
128 fail_file();
130 return n;
133 static size_t
134 uwrite(int const fd, void const *const buf, size_t const count)
136 size_t cnt = count;
137 off_t idx = 0;
139 file_updated = 1;
141 if (file_ptr + count >= file_end) {
142 off_t aoffset = (file_ptr + count) - file_end;
144 if (aoffset > file_append_size) {
145 file_append = realloc(file_append, aoffset);
146 file_append_size = aoffset;
148 if (!file_append) {
149 perror("write");
150 fail_file();
152 if (file_ptr < file_end) {
153 cnt = file_end - file_ptr;
154 } else {
155 cnt = 0;
156 idx = aoffset - count;
160 if (cnt)
161 memcpy(file_ptr, buf, cnt);
163 if (cnt < count)
164 memcpy(file_append + idx, buf + cnt, count - cnt);
166 file_ptr += count;
167 return count;
170 static void *
171 umalloc(size_t size)
173 void *const addr = malloc(size);
174 if (addr == 0) {
175 fprintf(stderr, "malloc failed: %zu bytes\n", size);
176 fail_file();
178 return addr;
181 static unsigned char ideal_nop5_x86_64[5] = { 0x0f, 0x1f, 0x44, 0x00, 0x00 };
182 static unsigned char ideal_nop5_x86_32[5] = { 0x3e, 0x8d, 0x74, 0x26, 0x00 };
183 static unsigned char *ideal_nop;
185 static char rel_type_nop;
187 static int (*make_nop)(void *map, size_t const offset);
189 static int make_nop_x86(void *map, size_t const offset)
191 uint32_t *ptr;
192 unsigned char *op;
194 /* Confirm we have 0xe8 0x0 0x0 0x0 0x0 */
195 ptr = map + offset;
196 if (*ptr != 0)
197 return -1;
199 op = map + offset - 1;
200 if (*op != 0xe8)
201 return -1;
203 /* convert to nop */
204 ulseek(fd_map, offset - 1, SEEK_SET);
205 uwrite(fd_map, ideal_nop, 5);
206 return 0;
209 static unsigned char ideal_nop4_arm64[4] = {0x1f, 0x20, 0x03, 0xd5};
210 static int make_nop_arm64(void *map, size_t const offset)
212 uint32_t *ptr;
214 ptr = map + offset;
215 /* bl <_mcount> is 0x94000000 before relocation */
216 if (*ptr != 0x94000000)
217 return -1;
219 /* Convert to nop */
220 ulseek(fd_map, offset, SEEK_SET);
221 uwrite(fd_map, ideal_nop, 4);
222 return 0;
226 * Get the whole file as a programming convenience in order to avoid
227 * malloc+lseek+read+free of many pieces. If successful, then mmap
228 * avoids copying unused pieces; else just read the whole file.
229 * Open for both read and write; new info will be appended to the file.
230 * Use MAP_PRIVATE so that a few changes to the in-memory ElfXX_Ehdr
231 * do not propagate to the file until an explicit overwrite at the last.
232 * This preserves most aspects of consistency (all except .st_size)
233 * for simultaneous readers of the file while we are appending to it.
234 * However, multiple writers still are bad. We choose not to use
235 * locking because it is expensive and the use case of kernel build
236 * makes multiple writers unlikely.
238 static void *mmap_file(char const *fname)
240 fd_map = open(fname, O_RDONLY);
241 if (fd_map < 0 || fstat(fd_map, &sb) < 0) {
242 perror(fname);
243 fail_file();
245 if (!S_ISREG(sb.st_mode)) {
246 fprintf(stderr, "not a regular file: %s\n", fname);
247 fail_file();
249 file_map = mmap(0, sb.st_size, PROT_READ|PROT_WRITE, MAP_PRIVATE,
250 fd_map, 0);
251 mmap_failed = 0;
252 if (file_map == MAP_FAILED) {
253 mmap_failed = 1;
254 file_map = umalloc(sb.st_size);
255 uread(fd_map, file_map, sb.st_size);
257 close(fd_map);
259 file_end = file_map + sb.st_size;
261 return file_map;
264 static void write_file(const char *fname)
266 char tmp_file[strlen(fname) + 4];
267 size_t n;
269 if (!file_updated)
270 return;
272 sprintf(tmp_file, "%s.rc", fname);
275 * After reading the entire file into memory, delete it
276 * and write it back, to prevent weird side effects of modifying
277 * an object file in place.
279 fd_map = open(tmp_file, O_WRONLY | O_TRUNC | O_CREAT, sb.st_mode);
280 if (fd_map < 0) {
281 perror(fname);
282 fail_file();
284 n = write(fd_map, file_map, sb.st_size);
285 if (n != sb.st_size) {
286 perror("write");
287 fail_file();
289 if (file_append_size) {
290 n = write(fd_map, file_append, file_append_size);
291 if (n != file_append_size) {
292 perror("write");
293 fail_file();
296 close(fd_map);
297 if (rename(tmp_file, fname) < 0) {
298 perror(fname);
299 fail_file();
303 /* w8rev, w8nat, ...: Handle endianness. */
305 static uint64_t w8rev(uint64_t const x)
307 return ((0xff & (x >> (0 * 8))) << (7 * 8))
308 | ((0xff & (x >> (1 * 8))) << (6 * 8))
309 | ((0xff & (x >> (2 * 8))) << (5 * 8))
310 | ((0xff & (x >> (3 * 8))) << (4 * 8))
311 | ((0xff & (x >> (4 * 8))) << (3 * 8))
312 | ((0xff & (x >> (5 * 8))) << (2 * 8))
313 | ((0xff & (x >> (6 * 8))) << (1 * 8))
314 | ((0xff & (x >> (7 * 8))) << (0 * 8));
317 static uint32_t w4rev(uint32_t const x)
319 return ((0xff & (x >> (0 * 8))) << (3 * 8))
320 | ((0xff & (x >> (1 * 8))) << (2 * 8))
321 | ((0xff & (x >> (2 * 8))) << (1 * 8))
322 | ((0xff & (x >> (3 * 8))) << (0 * 8));
325 static uint32_t w2rev(uint16_t const x)
327 return ((0xff & (x >> (0 * 8))) << (1 * 8))
328 | ((0xff & (x >> (1 * 8))) << (0 * 8));
331 static uint64_t w8nat(uint64_t const x)
333 return x;
336 static uint32_t w4nat(uint32_t const x)
338 return x;
341 static uint32_t w2nat(uint16_t const x)
343 return x;
346 static uint64_t (*w8)(uint64_t);
347 static uint32_t (*w)(uint32_t);
348 static uint32_t (*w2)(uint16_t);
350 /* Names of the sections that could contain calls to mcount. */
351 static int
352 is_mcounted_section_name(char const *const txtname)
354 return strcmp(".text", txtname) == 0 ||
355 strcmp(".ref.text", txtname) == 0 ||
356 strcmp(".sched.text", txtname) == 0 ||
357 strcmp(".spinlock.text", txtname) == 0 ||
358 strcmp(".irqentry.text", txtname) == 0 ||
359 strcmp(".kprobes.text", txtname) == 0 ||
360 strcmp(".text.unlikely", txtname) == 0;
363 /* 32 bit and 64 bit are very similar */
364 #include "recordmcount.h"
365 #define RECORD_MCOUNT_64
366 #include "recordmcount.h"
368 /* 64-bit EM_MIPS has weird ELF64_Rela.r_info.
369 * http://techpubs.sgi.com/library/manuals/4000/007-4658-001/pdf/007-4658-001.pdf
370 * We interpret Table 29 Relocation Operation (Elf64_Rel, Elf64_Rela) [p.40]
371 * to imply the order of the members; the spec does not say so.
372 * typedef unsigned char Elf64_Byte;
373 * fails on MIPS64 because their <elf.h> already has it!
376 typedef uint8_t myElf64_Byte; /* Type for a 8-bit quantity. */
378 union mips_r_info {
379 Elf64_Xword r_info;
380 struct {
381 Elf64_Word r_sym; /* Symbol index. */
382 myElf64_Byte r_ssym; /* Special symbol. */
383 myElf64_Byte r_type3; /* Third relocation. */
384 myElf64_Byte r_type2; /* Second relocation. */
385 myElf64_Byte r_type; /* First relocation. */
386 } r_mips;
389 static uint64_t MIPS64_r_sym(Elf64_Rel const *rp)
391 return w(((union mips_r_info){ .r_info = rp->r_info }).r_mips.r_sym);
394 static void MIPS64_r_info(Elf64_Rel *const rp, unsigned sym, unsigned type)
396 rp->r_info = ((union mips_r_info){
397 .r_mips = { .r_sym = w(sym), .r_type = type }
398 }).r_info;
401 static void
402 do_file(char const *const fname)
404 Elf32_Ehdr *const ehdr = mmap_file(fname);
405 unsigned int reltype = 0;
407 w = w4nat;
408 w2 = w2nat;
409 w8 = w8nat;
410 switch (ehdr->e_ident[EI_DATA]) {
411 static unsigned int const endian = 1;
412 default:
413 fprintf(stderr, "unrecognized ELF data encoding %d: %s\n",
414 ehdr->e_ident[EI_DATA], fname);
415 fail_file();
416 break;
417 case ELFDATA2LSB:
418 if (*(unsigned char const *)&endian != 1) {
419 /* main() is big endian, file.o is little endian. */
420 w = w4rev;
421 w2 = w2rev;
422 w8 = w8rev;
424 break;
425 case ELFDATA2MSB:
426 if (*(unsigned char const *)&endian != 0) {
427 /* main() is little endian, file.o is big endian. */
428 w = w4rev;
429 w2 = w2rev;
430 w8 = w8rev;
432 break;
433 } /* end switch */
434 if (memcmp(ELFMAG, ehdr->e_ident, SELFMAG) != 0
435 || w2(ehdr->e_type) != ET_REL
436 || ehdr->e_ident[EI_VERSION] != EV_CURRENT) {
437 fprintf(stderr, "unrecognized ET_REL file %s\n", fname);
438 fail_file();
441 gpfx = 0;
442 switch (w2(ehdr->e_machine)) {
443 default:
444 fprintf(stderr, "unrecognized e_machine %d %s\n",
445 w2(ehdr->e_machine), fname);
446 fail_file();
447 break;
448 case EM_386:
449 reltype = R_386_32;
450 rel_type_nop = R_386_NONE;
451 make_nop = make_nop_x86;
452 ideal_nop = ideal_nop5_x86_32;
453 mcount_adjust_32 = -1;
454 break;
455 case EM_ARM: reltype = R_ARM_ABS32;
456 altmcount = "__gnu_mcount_nc";
457 break;
458 case EM_AARCH64:
459 reltype = R_AARCH64_ABS64;
460 make_nop = make_nop_arm64;
461 rel_type_nop = R_AARCH64_NONE;
462 ideal_nop = ideal_nop4_arm64;
463 gpfx = '_';
464 break;
465 case EM_IA_64: reltype = R_IA64_IMM64; gpfx = '_'; break;
466 case EM_METAG: reltype = R_METAG_ADDR32;
467 altmcount = "_mcount_wrapper";
468 rel_type_nop = R_METAG_NONE;
469 /* We happen to have the same requirement as MIPS */
470 is_fake_mcount32 = MIPS32_is_fake_mcount;
471 break;
472 case EM_MIPS: /* reltype: e_class */ gpfx = '_'; break;
473 case EM_PPC: reltype = R_PPC_ADDR32; gpfx = '_'; break;
474 case EM_PPC64: reltype = R_PPC64_ADDR64; gpfx = '_'; break;
475 case EM_S390: /* reltype: e_class */ gpfx = '_'; break;
476 case EM_SH: reltype = R_SH_DIR32; break;
477 case EM_SPARCV9: reltype = R_SPARC_64; gpfx = '_'; break;
478 case EM_X86_64:
479 make_nop = make_nop_x86;
480 ideal_nop = ideal_nop5_x86_64;
481 reltype = R_X86_64_64;
482 rel_type_nop = R_X86_64_NONE;
483 mcount_adjust_64 = -1;
484 break;
485 } /* end switch */
487 switch (ehdr->e_ident[EI_CLASS]) {
488 default:
489 fprintf(stderr, "unrecognized ELF class %d %s\n",
490 ehdr->e_ident[EI_CLASS], fname);
491 fail_file();
492 break;
493 case ELFCLASS32:
494 if (w2(ehdr->e_ehsize) != sizeof(Elf32_Ehdr)
495 || w2(ehdr->e_shentsize) != sizeof(Elf32_Shdr)) {
496 fprintf(stderr,
497 "unrecognized ET_REL file: %s\n", fname);
498 fail_file();
500 if (w2(ehdr->e_machine) == EM_MIPS) {
501 reltype = R_MIPS_32;
502 is_fake_mcount32 = MIPS32_is_fake_mcount;
504 do32(ehdr, fname, reltype);
505 break;
506 case ELFCLASS64: {
507 Elf64_Ehdr *const ghdr = (Elf64_Ehdr *)ehdr;
508 if (w2(ghdr->e_ehsize) != sizeof(Elf64_Ehdr)
509 || w2(ghdr->e_shentsize) != sizeof(Elf64_Shdr)) {
510 fprintf(stderr,
511 "unrecognized ET_REL file: %s\n", fname);
512 fail_file();
514 if (w2(ghdr->e_machine) == EM_S390) {
515 reltype = R_390_64;
516 mcount_adjust_64 = -14;
518 if (w2(ghdr->e_machine) == EM_MIPS) {
519 reltype = R_MIPS_64;
520 Elf64_r_sym = MIPS64_r_sym;
521 Elf64_r_info = MIPS64_r_info;
522 is_fake_mcount64 = MIPS64_is_fake_mcount;
524 do64(ghdr, fname, reltype);
525 break;
527 } /* end switch */
529 write_file(fname);
530 cleanup();
534 main(int argc, char *argv[])
536 const char ftrace[] = "/ftrace.o";
537 int ftrace_size = sizeof(ftrace) - 1;
538 int n_error = 0; /* gcc-4.3.0 false positive complaint */
539 int c;
540 int i;
542 while ((c = getopt(argc, argv, "w")) >= 0) {
543 switch (c) {
544 case 'w':
545 warn_on_notrace_sect = 1;
546 break;
547 default:
548 fprintf(stderr, "usage: recordmcount [-w] file.o...\n");
549 return 0;
553 if ((argc - optind) < 1) {
554 fprintf(stderr, "usage: recordmcount [-w] file.o...\n");
555 return 0;
558 /* Process each file in turn, allowing deep failure. */
559 for (i = optind; i < argc; i++) {
560 char *file = argv[i];
561 int const sjval = setjmp(jmpenv);
562 int len;
565 * The file kernel/trace/ftrace.o references the mcount
566 * function but does not call it. Since ftrace.o should
567 * not be traced anyway, we just skip it.
569 len = strlen(file);
570 if (len >= ftrace_size &&
571 strcmp(file + (len - ftrace_size), ftrace) == 0)
572 continue;
574 switch (sjval) {
575 default:
576 fprintf(stderr, "internal error: %s\n", file);
577 exit(1);
578 break;
579 case SJ_SETJMP: /* normal sequence */
580 /* Avoid problems if early cleanup() */
581 fd_map = -1;
582 mmap_failed = 1;
583 file_map = NULL;
584 file_ptr = NULL;
585 file_updated = 0;
586 do_file(file);
587 break;
588 case SJ_FAIL: /* error in do_file or below */
589 fprintf(stderr, "%s: failed\n", file);
590 ++n_error;
591 break;
592 case SJ_SUCCEED: /* premature success */
593 /* do nothing */
594 break;
595 } /* end switch */
597 return !!n_error;