code-patching.c 1.0 KB

12345678910111213141516171819202122232425262728293031323334353637
  1. /*
  2. * Copyright 2008 Michael Ellerman, IBM Corporation.
  3. *
  4. * This program is free software; you can redistribute it and/or
  5. * modify it under the terms of the GNU General Public License
  6. * as published by the Free Software Foundation; either version
  7. * 2 of the License, or (at your option) any later version.
  8. */
  9. #include <linux/kernel.h>
  10. #include <asm/code-patching.h>
  11. void patch_instruction(unsigned int *addr, unsigned int instr)
  12. {
  13. *addr = instr;
  14. asm ("dcbst 0, %0; sync; icbi 0,%0; sync; isync" : : "r" (addr));
  15. }
  16. void patch_branch(unsigned int *addr, unsigned long target, int flags)
  17. {
  18. patch_instruction(addr, create_branch(addr, target, flags));
  19. }
  20. unsigned int create_branch(const unsigned int *addr,
  21. unsigned long target, int flags)
  22. {
  23. unsigned int instruction;
  24. if (! (flags & BRANCH_ABSOLUTE))
  25. target = target - (unsigned long)addr;
  26. /* Mask out the flags and target, so they don't step on each other. */
  27. instruction = 0x48000000 | (flags & 0x3) | (target & 0x03FFFFFC);
  28. return instruction;
  29. }