lowlevel_init.S 1.2 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162
  1. /* SPDX-License-Identifier: GPL-2.0+ */
  2. /*
  3. * Copyright 2017 NXP
  4. */
  5. #include <config.h>
  6. .align 8
  7. .global rom_pointer
  8. rom_pointer:
  9. .space 256
  10. /*
  11. * Routine: save_boot_params (called after reset from start.S)
  12. */
  13. .global save_boot_params
  14. save_boot_params:
  15. /* The firmware provided ATAG/FDT address can be found in r2/x0 */
  16. adr x0, rom_pointer
  17. stp x1, x2, [x0], #16
  18. stp x3, x4, [x0], #16
  19. stp x5, x6, [x0], #16
  20. stp x7, x8, [x0], #16
  21. stp x9, x10, [x0], #16
  22. stp x11, x12, [x0], #16
  23. stp x13, x14, [x0], #16
  24. stp x15, x16, [x0], #16
  25. stp x17, x18, [x0], #16
  26. stp x19, x20, [x0], #16
  27. stp x21, x22, [x0], #16
  28. stp x23, x24, [x0], #16
  29. stp x25, x26, [x0], #16
  30. stp x27, x28, [x0], #16
  31. stp x29, x30, [x0], #16
  32. mov x30, sp
  33. str x30, [x0], #8
  34. /* Returns */
  35. b save_boot_params_ret
  36. .global restore_boot_params
  37. restore_boot_params:
  38. adr x0, rom_pointer
  39. ldp x1, x2, [x0], #16
  40. ldp x3, x4, [x0], #16
  41. ldp x5, x6, [x0], #16
  42. ldp x7, x8, [x0], #16
  43. ldp x9, x10, [x0], #16
  44. ldp x11, x12, [x0], #16
  45. ldp x13, x14, [x0], #16
  46. ldp x15, x16, [x0], #16
  47. ldp x17, x18, [x0], #16
  48. ldp x19, x20, [x0], #16
  49. ldp x21, x22, [x0], #16
  50. ldp x23, x24, [x0], #16
  51. ldp x25, x26, [x0], #16
  52. ldp x27, x28, [x0], #16
  53. ldp x29, x30, [x0], #16
  54. ldr x0, [x0]
  55. mov sp, x0
  56. ret