arch/powerpc/kernel/module_64.c

   1 /*  Kernel module help for PPC64.
   2     Copyright (C) 2001, 2003 Rusty Russell IBM Corporation.
   3
   4     This program is free software; you can redistribute it and/or modify
   5     it under the terms of the GNU General Public License as published by
   6     the Free Software Foundation; either version 2 of the License, or
   7     (at your option) any later version.
   8
   9     This program is distributed in the hope that it will be useful,
  10     but WITHOUT ANY WARRANTY; without even the implied warranty of
  11     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12     GNU General Public License for more details.
  13
  14     You should have received a copy of the GNU General Public License
  15     along with this program; if not, write to the Free Software
  16     Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  17 */
  18
  19 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  20
  21 #include <linux/module.h>
  22 #include <linux/elf.h>
  23 #include <linux/moduleloader.h>
  24 #include <linux/err.h>
  25 #include <linux/vmalloc.h>
  26 #include <linux/ftrace.h>
  27 #include <linux/bug.h>
  28 #include <linux/uaccess.h>
  29 #include <asm/module.h>
  30 #include <asm/firmware.h>
  31 #include <asm/code-patching.h>
  32 #include <linux/sort.h>
  33 #include <asm/setup.h>
  34
  35 /* FIXME: We don't do .init separately.  To do this, we'd need to have
  36    a separate r2 value in the init and core section, and stub between
  37    them, too.
  38
  39    Using a magic allocator which places modules within 32MB solves
  40    this, and makes other things simpler.  Anton?
  41    --RR.  */
  42
  43 #if defined(_CALL_ELF) && _CALL_ELF == 2
  44 #define R2_STACK_OFFSET 24
  45
  46 /* An address is simply the address of the function. */
  47 typedef unsigned long func_desc_t;
  48
  49 static func_desc_t func_desc(unsigned long addr)
  50 {
  51         return addr;
  52 }
  53 static unsigned long func_addr(unsigned long addr)
  54 {
  55         return addr;
  56 }
  57 static unsigned long stub_func_addr(func_desc_t func)
  58 {
  59         return func;
  60 }
  61
  62 /* PowerPC64 specific values for the Elf64_Sym st_other field.  */
  63 #define STO_PPC64_LOCAL_BIT     5
  64 #define STO_PPC64_LOCAL_MASK    (7 << STO_PPC64_LOCAL_BIT)
  65 #define PPC64_LOCAL_ENTRY_OFFSET(other)                                 \
  66  (((1 << (((other) & STO_PPC64_LOCAL_MASK) >> STO_PPC64_LOCAL_BIT)) >> 2) << 2)
  67
  68 static unsigned int local_entry_offset(const Elf64_Sym *sym)
  69 {
  70         /* sym->st_other indicates offset to local entry point
  71          * (otherwise it will assume r12 is the address of the start
  72          * of function and try to derive r2 from it). */
  73         return PPC64_LOCAL_ENTRY_OFFSET(sym->st_other);
  74 }
  75 #else
  76 #define R2_STACK_OFFSET 40
  77
  78 /* An address is address of the OPD entry, which contains address of fn. */
  79 typedef struct ppc64_opd_entry func_desc_t;
  80
  81 static func_desc_t func_desc(unsigned long addr)
  82 {
  83         return *(struct ppc64_opd_entry *)addr;
  84 }
  85 static unsigned long func_addr(unsigned long addr)
  86 {
  87         return func_desc(addr).funcaddr;
  88 }
  89 static unsigned long stub_func_addr(func_desc_t func)
  90 {
  91         return func.funcaddr;
  92 }
  93 static unsigned int local_entry_offset(const Elf64_Sym *sym)
  94 {
  95         return 0;
  96 }
  97 #endif
  98
  99 #define STUB_MAGIC 0x73747562 /* stub */
 100
 101 /* Like PPC32, we need little trampolines to do > 24-bit jumps (into
 102    the kernel itself).  But on PPC64, these need to be used for every
 103    jump, actually, to reset r2 (TOC+0x8000). */
 104 struct ppc64_stub_entry
 105 {
 106         /* 28 byte jump instruction sequence (7 instructions). We only
 107          * need 6 instructions on ABIv2 but we always allocate 7 so
 108          * so we don't have to modify the trampoline load instruction. */
 109         u32 jump[7];
 110         /* Used by ftrace to identify stubs */
 111         u32 magic;
 112         /* Data for the above code */
 113         func_desc_t funcdata;
 114 };
 115
 116 /*
 117  * PPC64 uses 24 bit jumps, but we need to jump into other modules or
 118  * the kernel which may be further.  So we jump to a stub.
 119  *
 120  * For ELFv1 we need to use this to set up the new r2 value (aka TOC
 121  * pointer).  For ELFv2 it's the callee's responsibility to set up the
 122  * new r2, but for both we need to save the old r2.
 123  *
 124  * We could simply patch the new r2 value and function pointer into
 125  * the stub, but it's significantly shorter to put these values at the
 126  * end of the stub code, and patch the stub address (32-bits relative
 127  * to the TOC ptr, r2) into the stub.
 128  */
 129
 130 static u32 ppc64_stub_insns[] = {
 131         0x3d620000,                     /* addis   r11,r2, <high> */
 132         0x396b0000,                     /* addi    r11,r11, <low> */
 133         /* Save current r2 value in magic place on the stack. */
 134         0xf8410000|R2_STACK_OFFSET,     /* std     r2,R2_STACK_OFFSET(r1) */
 135         0xe98b0020,                     /* ld      r12,32(r11) */
 136 #if !defined(_CALL_ELF) || _CALL_ELF != 2
 137         /* Set up new r2 from function descriptor */
 138         0xe84b0028,                     /* ld      r2,40(r11) */
 139 #endif
 140         0x7d8903a6,                     /* mtctr   r12 */
 141         0x4e800420                      /* bctr */
 142 };
 143
 144 #ifdef CONFIG_DYNAMIC_FTRACE
 145 int module_trampoline_target(struct module *mod, unsigned long addr,
 146                              unsigned long *target)
 147 {
 148         struct ppc64_stub_entry *stub;
 149         func_desc_t funcdata;
 150         u32 magic;
 151
 152         if (!within_module_core(addr, mod)) {
 153                 pr_err("%s: stub %lx not in module %s\n", __func__, addr, mod->name);
 154                 return -EFAULT;
 155         }
 156
 157         stub = (struct ppc64_stub_entry *)addr;
 158
 159         if (probe_kernel_read(&magic, &stub->magic, sizeof(magic))) {
 160                 pr_err("%s: fault reading magic for stub %lx for %s\n", __func__, addr, mod->name);
 161                 return -EFAULT;
 162         }
 163
 164         if (magic != STUB_MAGIC) {
 165                 pr_err("%s: bad magic for stub %lx for %s\n", __func__, addr, mod->name);
 166                 return -EFAULT;
 167         }
 168
 169         if (probe_kernel_read(&funcdata, &stub->funcdata, sizeof(funcdata))) {
 170                 pr_err("%s: fault reading funcdata for stub %lx for %s\n", __func__, addr, mod->name);
 171                 return -EFAULT;
 172         }
 173
 174         *target = stub_func_addr(funcdata);
 175
 176         return 0;
 177 }
 178 #endif
 179
 180 /* Count how many different 24-bit relocations (different symbol,
 181    different addend) */
 182 static unsigned int count_relocs(const Elf64_Rela *rela, unsigned int num)
 183 {
 184         unsigned int i, r_info, r_addend, _count_relocs;
 185
 186         /* FIXME: Only count external ones --RR */
 187         _count_relocs = 0;
 188         r_info = 0;
 189         r_addend = 0;
 190         for (i = 0; i < num; i++)
 191                 /* Only count 24-bit relocs, others don't need stubs */
 192                 if (ELF64_R_TYPE(rela[i].r_info) == R_PPC_REL24 &&
 193                     (r_info != ELF64_R_SYM(rela[i].r_info) ||
 194                      r_addend != rela[i].r_addend)) {
 195                         _count_relocs++;
 196                         r_info = ELF64_R_SYM(rela[i].r_info);
 197                         r_addend = rela[i].r_addend;
 198                 }
 199
 200         return _count_relocs;
 201 }
 202
 203 static int relacmp(const void *_x, const void *_y)
 204 {
 205         const Elf64_Rela *x, *y;
 206
 207         y = (Elf64_Rela *)_x;
 208         x = (Elf64_Rela *)_y;
 209
 210         /* Compare the entire r_info (as opposed to ELF64_R_SYM(r_info) only) to
 211          * make the comparison cheaper/faster. It won't affect the sorting or
 212          * the counting algorithms' performance
 213          */
 214         if (x->r_info < y->r_info)
 215                 return -1;
 216         else if (x->r_info > y->r_info)
 217                 return 1;
 218         else if (x->r_addend < y->r_addend)
 219                 return -1;
 220         else if (x->r_addend > y->r_addend)
 221                 return 1;
 222         else
 223                 return 0;
 224 }
 225
 226 static void relaswap(void *_x, void *_y, int size)
 227 {
 228         uint64_t *x, *y, tmp;
 229         int i;
 230
 231         y = (uint64_t *)_x;
 232         x = (uint64_t *)_y;
 233
 234         for (i = 0; i < sizeof(Elf64_Rela) / sizeof(uint64_t); i++) {
 235                 tmp = x[i];
 236                 x[i] = y[i];
 237                 y[i] = tmp;
 238         }
 239 }
 240
 241 /* Get size of potential trampolines required. */
 242 static unsigned long get_stubs_size(const Elf64_Ehdr *hdr,
 243                                     const Elf64_Shdr *sechdrs)
 244 {
 245         /* One extra reloc so it's always 0-funcaddr terminated */
 246         unsigned long relocs = 1;
 247         unsigned i;
 248
 249         /* Every relocated section... */
 250         for (i = 1; i < hdr->e_shnum; i++) {
 251                 if (sechdrs[i].sh_type == SHT_RELA) {
 252                         pr_debug("Found relocations in section %u\n", i);
 253                         pr_debug("Ptr: %p.  Number: %Lu\n",
 254                                (void *)sechdrs[i].sh_addr,
 255                                sechdrs[i].sh_size / sizeof(Elf64_Rela));
 256
 257                         /* Sort the relocation information based on a symbol and
 258                          * addend key. This is a stable O(n*log n) complexity
 259                          * alogrithm but it will reduce the complexity of
 260                          * count_relocs() to linear complexity O(n)
 261                          */
 262                         sort((void *)sechdrs[i].sh_addr,
 263                              sechdrs[i].sh_size / sizeof(Elf64_Rela),
 264                              sizeof(Elf64_Rela), relacmp, relaswap);
 265
 266                         relocs += count_relocs((void *)sechdrs[i].sh_addr,
 267                                                sechdrs[i].sh_size
 268                                                / sizeof(Elf64_Rela));
 269                 }
 270         }
 271
 272 #ifdef CONFIG_DYNAMIC_FTRACE
 273         /* make the trampoline to the ftrace_caller */
 274         relocs++;
 275 #endif
 276
 277         pr_debug("Looks like a total of %lu stubs, max\n", relocs);
 278         return relocs * sizeof(struct ppc64_stub_entry);
 279 }
 280
 281 /* Still needed for ELFv2, for .TOC. */
 282 static void dedotify_versions(struct modversion_info *vers,
 283                               unsigned long size)
 284 {
 285         struct modversion_info *end;
 286
 287         for (end = (void *)vers + size; vers < end; vers++)
 288                 if (vers->name[0] == '.') {
 289                         memmove(vers->name, vers->name+1, strlen(vers->name));
 290 #ifdef ARCH_RELOCATES_KCRCTAB
 291                         /* The TOC symbol has no CRC computed. To avoid CRC
 292                          * check failing, we must force it to the expected
 293                          * value (see CRC check in module.c).
 294                          */
 295                         if (!strcmp(vers->name, "TOC."))
 296                                 vers->crc = -(unsigned long)reloc_start;
 297 #endif
 298                 }
 299 }
 300
 301 /*
 302  * Undefined symbols which refer to .funcname, hack to funcname. Make .TOC.
 303  * seem to be defined (value set later).
 304  */
 305 static void dedotify(Elf64_Sym *syms, unsigned int numsyms, char *strtab)
 306 {
 307         unsigned int i;
 308
 309         for (i = 1; i < numsyms; i++) {
 310                 if (syms[i].st_shndx == SHN_UNDEF) {
 311                         char *name = strtab + syms[i].st_name;
 312                         if (name[0] == '.') {
 313                                 if (strcmp(name+1, "TOC.") == 0)
 314                                         syms[i].st_shndx = SHN_ABS;
 315                                 memmove(name, name+1, strlen(name));
 316                         }
 317                 }
 318         }
 319 }
 320
 321 static Elf64_Sym *find_dot_toc(Elf64_Shdr *sechdrs,
 322                                const char *strtab,
 323                                unsigned int symindex)
 324 {
 325         unsigned int i, numsyms;
 326         Elf64_Sym *syms;
 327
 328         syms = (Elf64_Sym *)sechdrs[symindex].sh_addr;
 329         numsyms = sechdrs[symindex].sh_size / sizeof(Elf64_Sym);
 330
 331         for (i = 1; i < numsyms; i++) {
 332                 if (syms[i].st_shndx == SHN_ABS
 333                     && strcmp(strtab + syms[i].st_name, "TOC.") == 0)
 334                         return &syms[i];
 335         }
 336         return NULL;
 337 }
 338
 339 int module_frob_arch_sections(Elf64_Ehdr *hdr,
 340                               Elf64_Shdr *sechdrs,
 341                               char *secstrings,
 342                               struct module *me)
 343 {
 344         unsigned int i;
 345
 346         /* Find .toc and .stubs sections, symtab and strtab */
 347         for (i = 1; i < hdr->e_shnum; i++) {
 348                 char *p;
 349                 if (strcmp(secstrings + sechdrs[i].sh_name, ".stubs") == 0)
 350                         me->arch.stubs_section = i;
 351                 else if (strcmp(secstrings + sechdrs[i].sh_name, ".toc") == 0)
 352                         me->arch.toc_section = i;
 353                 else if (strcmp(secstrings+sechdrs[i].sh_name,"__versions")==0)
 354                         dedotify_versions((void *)hdr + sechdrs[i].sh_offset,
 355                                           sechdrs[i].sh_size);
 356
 357                 /* We don't handle .init for the moment: rename to _init */
 358                 while ((p = strstr(secstrings + sechdrs[i].sh_name, ".init")))
 359                         p[0] = '_';
 360
 361                 if (sechdrs[i].sh_type == SHT_SYMTAB)
 362                         dedotify((void *)hdr + sechdrs[i].sh_offset,
 363                                  sechdrs[i].sh_size / sizeof(Elf64_Sym),
 364                                  (void *)hdr
 365                                  + sechdrs[sechdrs[i].sh_link].sh_offset);
 366         }
 367
 368         if (!me->arch.stubs_section) {
 369                 pr_err("%s: doesn't contain .stubs.\n", me->name);
 370                 return -ENOEXEC;
 371         }
 372
 373         /* If we don't have a .toc, just use .stubs.  We need to set r2
 374            to some reasonable value in case the module calls out to
 375            other functions via a stub, or if a function pointer escapes
 376            the module by some means.  */
 377         if (!me->arch.toc_section)
 378                 me->arch.toc_section = me->arch.stubs_section;
 379
 380         /* Override the stubs size */
 381         sechdrs[me->arch.stubs_section].sh_size = get_stubs_size(hdr, sechdrs);
 382         return 0;
 383 }
 384
 385 /* r2 is the TOC pointer: it actually points 0x8000 into the TOC (this
 386    gives the value maximum span in an instruction which uses a signed
 387    offset) */
 388 static inline unsigned long my_r2(const Elf64_Shdr *sechdrs, struct module *me)
 389 {
 390         return sechdrs[me->arch.toc_section].sh_addr + 0x8000;
 391 }
 392
 393 /* Both low and high 16 bits are added as SIGNED additions, so if low
 394    16 bits has high bit set, high 16 bits must be adjusted.  These
 395    macros do that (stolen from binutils). */
 396 #define PPC_LO(v) ((v) & 0xffff)
 397 #define PPC_HI(v) (((v) >> 16) & 0xffff)
 398 #define PPC_HA(v) PPC_HI ((v) + 0x8000)
 399
 400 /* Patch stub to reference function and correct r2 value. */
 401 static inline int create_stub(const Elf64_Shdr *sechdrs,
 402                               struct ppc64_stub_entry *entry,
 403                               unsigned long addr,
 404                               struct module *me)
 405 {
 406         long reladdr;
 407
 408         memcpy(entry->jump, ppc64_stub_insns, sizeof(ppc64_stub_insns));
 409
 410         /* Stub uses address relative to r2. */
 411         reladdr = (unsigned long)entry - my_r2(sechdrs, me);
 412         if (reladdr > 0x7FFFFFFF || reladdr < -(0x80000000L)) {
 413                 pr_err("%s: Address %p of stub out of range of %p.\n",
 414                        me->name, (void *)reladdr, (void *)my_r2);
 415                 return 0;
 416         }
 417         pr_debug("Stub %p get data from reladdr %li\n", entry, reladdr);
 418
 419         entry->jump[0] |= PPC_HA(reladdr);
 420         entry->jump[1] |= PPC_LO(reladdr);
 421         entry->funcdata = func_desc(addr);
 422         entry->magic = STUB_MAGIC;
 423
 424         return 1;
 425 }
 426
 427 /* Create stub to jump to function described in this OPD/ptr: we need the
 428    stub to set up the TOC ptr (r2) for the function. */
 429 static unsigned long stub_for_addr(const Elf64_Shdr *sechdrs,
 430                                    unsigned long addr,
 431                                    struct module *me)
 432 {
 433         struct ppc64_stub_entry *stubs;
 434         unsigned int i, num_stubs;
 435
 436         num_stubs = sechdrs[me->arch.stubs_section].sh_size / sizeof(*stubs);
 437
 438         /* Find this stub, or if that fails, the next avail. entry */
 439         stubs = (void *)sechdrs[me->arch.stubs_section].sh_addr;
 440         for (i = 0; stub_func_addr(stubs[i].funcdata); i++) {
 441                 BUG_ON(i >= num_stubs);
 442
 443                 if (stub_func_addr(stubs[i].funcdata) == func_addr(addr))
 444                         return (unsigned long)&stubs[i];
 445         }
 446
 447         if (!create_stub(sechdrs, &stubs[i], addr, me))
 448                 return 0;
 449
 450         return (unsigned long)&stubs[i];
 451 }
 452
 453 /* We expect a noop next: if it is, replace it with instruction to
 454    restore r2. */
 455 static int restore_r2(u32 *instruction, struct module *me)
 456 {
 457         if (*instruction != PPC_INST_NOP) {
 458                 pr_err("%s: Expect noop after relocate, got %08x\n",
 459                        me->name, *instruction);
 460                 return 0;
 461         }
 462         /* ld r2,R2_STACK_OFFSET(r1) */
 463         *instruction = 0xe8410000 | R2_STACK_OFFSET;
 464         return 1;
 465 }
 466
 467 int apply_relocate_add(Elf64_Shdr *sechdrs,
 468                        const char *strtab,
 469                        unsigned int symindex,
 470                        unsigned int relsec,
 471                        struct module *me)
 472 {
 473         unsigned int i;
 474         Elf64_Rela *rela = (void *)sechdrs[relsec].sh_addr;
 475         Elf64_Sym *sym;
 476         unsigned long *location;
 477         unsigned long value;
 478
 479         pr_debug("Applying ADD relocate section %u to %u\n", relsec,
 480                sechdrs[relsec].sh_info);
 481
 482         /* First time we're called, we can fix up .TOC. */
 483         if (!me->arch.toc_fixed) {
 484                 sym = find_dot_toc(sechdrs, strtab, symindex);
 485                 /* It's theoretically possible that a module doesn't want a
 486                  * .TOC. so don't fail it just for that. */
 487                 if (sym)
 488                         sym->st_value = my_r2(sechdrs, me);
 489                 me->arch.toc_fixed = true;
 490         }
 491
 492         for (i = 0; i < sechdrs[relsec].sh_size / sizeof(*rela); i++) {
 493                 /* This is where to make the change */
 494                 location = (void *)sechdrs[sechdrs[relsec].sh_info].sh_addr
 495                         + rela[i].r_offset;
 496                 /* This is the symbol it is referring to */
 497                 sym = (Elf64_Sym *)sechdrs[symindex].sh_addr
 498                         + ELF64_R_SYM(rela[i].r_info);
 499
 500                 pr_debug("RELOC at %p: %li-type as %s (0x%lx) + %li\n",
 501                        location, (long)ELF64_R_TYPE(rela[i].r_info),
 502                        strtab + sym->st_name, (unsigned long)sym->st_value,
 503                        (long)rela[i].r_addend);
 504
 505                 /* `Everything is relative'. */
 506                 value = sym->st_value + rela[i].r_addend;
 507
 508                 switch (ELF64_R_TYPE(rela[i].r_info)) {
 509                 case R_PPC64_ADDR32:
 510                         /* Simply set it */
 511                         *(u32 *)location = value;
 512                         break;
 513
 514                 case R_PPC64_ADDR64:
 515                         /* Simply set it */
 516                         *(unsigned long *)location = value;
 517                         break;
 518
 519                 case R_PPC64_TOC:
 520                         *(unsigned long *)location = my_r2(sechdrs, me);
 521                         break;
 522
 523                 case R_PPC64_TOC16:
 524                         /* Subtract TOC pointer */
 525                         value -= my_r2(sechdrs, me);
 526                         if (value + 0x8000 > 0xffff) {
 527                                 pr_err("%s: bad TOC16 relocation (0x%lx)\n",
 528                                        me->name, value);
 529                                 return -ENOEXEC;
 530                         }
 531                         *((uint16_t *) location)
 532                                 = (*((uint16_t *) location) & ~0xffff)
 533                                 | (value & 0xffff);
 534                         break;
 535
 536                 case R_PPC64_TOC16_LO:
 537                         /* Subtract TOC pointer */
 538                         value -= my_r2(sechdrs, me);
 539                         *((uint16_t *) location)
 540                                 = (*((uint16_t *) location) & ~0xffff)
 541                                 | (value & 0xffff);
 542                         break;
 543
 544                 case R_PPC64_TOC16_DS:
 545                         /* Subtract TOC pointer */
 546                         value -= my_r2(sechdrs, me);
 547                         if ((value & 3) != 0 || value + 0x8000 > 0xffff) {
 548                                 pr_err("%s: bad TOC16_DS relocation (0x%lx)\n",
 549                                        me->name, value);
 550                                 return -ENOEXEC;
 551                         }
 552                         *((uint16_t *) location)
 553                                 = (*((uint16_t *) location) & ~0xfffc)
 554                                 | (value & 0xfffc);
 555                         break;
 556
 557                 case R_PPC64_TOC16_LO_DS:
 558                         /* Subtract TOC pointer */
 559                         value -= my_r2(sechdrs, me);
 560                         if ((value & 3) != 0) {
 561                                 pr_err("%s: bad TOC16_LO_DS relocation (0x%lx)\n",
 562                                        me->name, value);
 563                                 return -ENOEXEC;
 564                         }
 565                         *((uint16_t *) location)
 566                                 = (*((uint16_t *) location) & ~0xfffc)
 567                                 | (value & 0xfffc);
 568                         break;
 569
 570                 case R_PPC64_TOC16_HA:
 571                         /* Subtract TOC pointer */
 572                         value -= my_r2(sechdrs, me);
 573                         value = ((value + 0x8000) >> 16);
 574                         *((uint16_t *) location)
 575                                 = (*((uint16_t *) location) & ~0xffff)
 576                                 | (value & 0xffff);
 577                         break;
 578
 579                 case R_PPC_REL24:
 580                         /* FIXME: Handle weak symbols here --RR */
 581                         if (sym->st_shndx == SHN_UNDEF) {
 582                                 /* External: go via stub */
 583                                 value = stub_for_addr(sechdrs, value, me);
 584                                 if (!value)
 585                                         return -ENOENT;
 586                                 if (!restore_r2((u32 *)location + 1, me))
 587                                         return -ENOEXEC;
 588                         } else
 589                                 value += local_entry_offset(sym);
 590
 591                         /* Convert value to relative */
 592                         value -= (unsigned long)location;
 593                         if (value + 0x2000000 > 0x3ffffff || (value & 3) != 0){
 594                                 pr_err("%s: REL24 %li out of range!\n",
 595                                        me->name, (long int)value);
 596                                 return -ENOEXEC;
 597                         }
 598
 599                         /* Only replace bits 2 through 26 */
 600                         *(uint32_t *)location
 601                                 = (*(uint32_t *)location & ~0x03fffffc)
 602                                 | (value & 0x03fffffc);
 603                         break;
 604
 605                 case R_PPC64_REL64:
 606                         /* 64 bits relative (used by features fixups) */
 607                         *location = value - (unsigned long)location;
 608                         break;
 609
 610                 case R_PPC64_TOCSAVE:
 611                         /*
 612                          * Marker reloc indicates we don't have to save r2.
 613                          * That would only save us one instruction, so ignore
 614                          * it.
 615                          */
 616                         break;
 617
 618                 case R_PPC64_ENTRY:
 619                         /*
 620                          * Optimize ELFv2 large code model entry point if
 621                          * the TOC is within 2GB range of current location.
 622                          */
 623                         value = my_r2(sechdrs, me) - (unsigned long)location;
 624                         if (value + 0x80008000 > 0xffffffff)
 625                                 break;
 626                         /*
 627                          * Check for the large code model prolog sequence:
 628                          *      ld r2, ...(r12)
 629                          *      add r2, r2, r12
 630                          */
 631                         if ((((uint32_t *)location)[0] & ~0xfffc)
 632                             != 0xe84c0000)
 633                                 break;
 634                         if (((uint32_t *)location)[1] != 0x7c426214)
 635                                 break;
 636                         /*
 637                          * If found, replace it with:
 638                          *      addis r2, r12, (.TOC.-func)@ha
 639                          *      addi r2, r12, (.TOC.-func)@l
 640                          */
 641                         ((uint32_t *)location)[0] = 0x3c4c0000 + PPC_HA(value);
 642                         ((uint32_t *)location)[1] = 0x38420000 + PPC_LO(value);
 643                         break;
 644
 645                 case R_PPC64_REL16_HA:
 646                         /* Subtract location pointer */
 647                         value -= (unsigned long)location;
 648                         value = ((value + 0x8000) >> 16);
 649                         *((uint16_t *) location)
 650                                 = (*((uint16_t *) location) & ~0xffff)
 651                                 | (value & 0xffff);
 652                         break;
 653
 654                 case R_PPC64_REL16_LO:
 655                         /* Subtract location pointer */
 656                         value -= (unsigned long)location;
 657                         *((uint16_t *) location)
 658                                 = (*((uint16_t *) location) & ~0xffff)
 659                                 | (value & 0xffff);
 660                         break;
 661
 662                 default:
 663                         pr_err("%s: Unknown ADD relocation: %lu\n",
 664                                me->name,
 665                                (unsigned long)ELF64_R_TYPE(rela[i].r_info));
 666                         return -ENOEXEC;
 667                 }
 668         }
 669
 670         return 0;
 671 }
 672
 673 #ifdef CONFIG_DYNAMIC_FTRACE
 674 int module_finalize_ftrace(struct module *mod, const Elf_Shdr *sechdrs)
 675 {
 676         mod->arch.toc = my_r2(sechdrs, mod);
 677         mod->arch.tramp = stub_for_addr(sechdrs, (unsigned long)ftrace_caller, mod);
 678
 679         if (!mod->arch.tramp)
 680                 return -ENOENT;
 681
 682         return 0;
 683 }
 684 #endif