headsmp.S 1.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051
  1. /*
  2. * SMP support: Entry point for secondary CPUs
  3. *
  4. * Copyright (C) 2012 Marvell
  5. *
  6. * Yehuda Yitschak <yehuday@marvell.com>
  7. * Gregory CLEMENT <gregory.clement@free-electrons.com>
  8. * Thomas Petazzoni <thomas.petazzoni@free-electrons.com>
  9. *
  10. * This file is licensed under the terms of the GNU General Public
  11. * License version 2. This program is licensed "as is" without any
  12. * warranty of any kind, whether express or implied.
  13. *
  14. * This file implements the assembly entry point for secondary CPUs in
  15. * an SMP kernel. The only thing we need to do is to add the CPU to
  16. * the coherency fabric by writing to 2 registers. Currently the base
  17. * register addresses are hard coded due to the early initialisation
  18. * problems.
  19. */
  20. #include <linux/linkage.h>
  21. #include <linux/init.h>
  22. #include <asm/assembler.h>
  23. /*
  24. * Armada XP specific entry point for secondary CPUs.
  25. * We add the CPU to the coherency fabric and then jump to secondary
  26. * startup
  27. */
  28. ENTRY(armada_xp_secondary_startup)
  29. ARM_BE8(setend be ) @ go BE8 if entered LE
  30. /* Get coherency fabric base physical address */
  31. adr r0, 1f
  32. ldr r1, [r0]
  33. ldr r0, [r0, r1]
  34. /* Read CPU id */
  35. mrc p15, 0, r1, c0, c0, 5
  36. and r1, r1, #0xF
  37. /* Add CPU to coherency fabric */
  38. bl ll_set_cpu_coherent
  39. b secondary_startup
  40. ENDPROC(armada_xp_secondary_startup)
  41. .align 2
  42. 1:
  43. .long coherency_phys_base - .