copy_page.S 1.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869
  1. /* SPDX-License-Identifier: GPL-2.0-only */
  2. /*
  3. * Copyright (C) 2012 ARM Ltd.
  4. */
  5. #include <linux/linkage.h>
  6. #include <linux/const.h>
  7. #include <asm/assembler.h>
  8. #include <asm/page.h>
  9. #include <asm/cpufeature.h>
  10. #include <asm/alternative.h>
  11. /*
  12. * Copy a page from src to dest (both are page aligned)
  13. *
  14. * Parameters:
  15. * x0 - dest
  16. * x1 - src
  17. */
  18. SYM_FUNC_START(__pi_copy_page)
  19. ldp x2, x3, [x1]
  20. ldp x4, x5, [x1, #16]
  21. ldp x6, x7, [x1, #32]
  22. ldp x8, x9, [x1, #48]
  23. ldp x10, x11, [x1, #64]
  24. ldp x12, x13, [x1, #80]
  25. ldp x14, x15, [x1, #96]
  26. ldp x16, x17, [x1, #112]
  27. add x0, x0, #256
  28. add x1, x1, #128
  29. 1:
  30. tst x0, #(PAGE_SIZE - 1)
  31. stnp x2, x3, [x0, #-256]
  32. ldp x2, x3, [x1]
  33. stnp x4, x5, [x0, #16 - 256]
  34. ldp x4, x5, [x1, #16]
  35. stnp x6, x7, [x0, #32 - 256]
  36. ldp x6, x7, [x1, #32]
  37. stnp x8, x9, [x0, #48 - 256]
  38. ldp x8, x9, [x1, #48]
  39. stnp x10, x11, [x0, #64 - 256]
  40. ldp x10, x11, [x1, #64]
  41. stnp x12, x13, [x0, #80 - 256]
  42. ldp x12, x13, [x1, #80]
  43. stnp x14, x15, [x0, #96 - 256]
  44. ldp x14, x15, [x1, #96]
  45. stnp x16, x17, [x0, #112 - 256]
  46. ldp x16, x17, [x1, #112]
  47. add x0, x0, #128
  48. add x1, x1, #128
  49. b.ne 1b
  50. stnp x2, x3, [x0, #-256]
  51. stnp x4, x5, [x0, #16 - 256]
  52. stnp x6, x7, [x0, #32 - 256]
  53. stnp x8, x9, [x0, #48 - 256]
  54. stnp x10, x11, [x0, #64 - 256]
  55. stnp x12, x13, [x0, #80 - 256]
  56. stnp x14, x15, [x0, #96 - 256]
  57. stnp x16, x17, [x0, #112 - 256]
  58. ret
  59. SYM_FUNC_END(__pi_copy_page)
  60. SYM_FUNC_ALIAS(copy_page, __pi_copy_page)
  61. EXPORT_SYMBOL(copy_page)