headsmp.S 764 B

12345678910111213141516171819202122232425262728293031
  1. /*
  2. * Copyright 2011 Freescale Semiconductor, Inc.
  3. * Copyright 2011 Linaro Ltd.
  4. *
  5. * The code contained herein is licensed under the GNU General Public
  6. * License. You may obtain a copy of the GNU General Public License
  7. * Version 2 or later at the following locations:
  8. *
  9. * http://www.opensource.org/licenses/gpl-license.html
  10. * http://www.gnu.org/copyleft/gpl.html
  11. */
  12. #include <linux/linkage.h>
  13. #include <linux/init.h>
  14. diag_reg_offset:
  15. .word g_diag_reg - .
  16. .macro set_diag_reg
  17. adr r0, diag_reg_offset
  18. ldr r1, [r0]
  19. add r1, r1, r0 @ r1 = physical &g_diag_reg
  20. ldr r0, [r1]
  21. mcr p15, 0, r0, c15, c0, 1 @ write diagnostic register
  22. .endm
  23. ENTRY(v7_secondary_startup)
  24. bl v7_invalidate_l1
  25. set_diag_reg
  26. b secondary_startup
  27. ENDPROC(v7_secondary_startup)