omap-headsmp.S 1.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566
  1. /*
  2. * Secondary CPU startup routine source file.
  3. *
  4. * Copyright (C) 2009 Texas Instruments, Inc.
  5. *
  6. * Author:
  7. * Santosh Shilimkar <santosh.shilimkar@ti.com>
  8. *
  9. * Interface functions needed for the SMP. This file is based on arm
  10. * realview smp platform.
  11. * Copyright (c) 2003 ARM Limited.
  12. *
  13. * This program is free software,you can redistribute it and/or modify
  14. * it under the terms of the GNU General Public License version 2 as
  15. * published by the Free Software Foundation.
  16. */
  17. #include <linux/linkage.h>
  18. #include <linux/init.h>
  19. __CPUINIT
  20. /* Physical address needed since MMU not enabled yet on secondary core */
  21. #define AUX_CORE_BOOT0_PA 0x48281800
  22. /*
  23. * OMAP5 specific entry point for secondary CPU to jump from ROM
  24. * code. This routine also provides a holding flag into which
  25. * secondary core is held until we're ready for it to initialise.
  26. * The primary core will update this flag using a hardware
  27. + * register AuxCoreBoot0.
  28. */
  29. ENTRY(omap5_secondary_startup)
  30. wait: ldr r2, =AUX_CORE_BOOT0_PA @ read from AuxCoreBoot0
  31. ldr r0, [r2]
  32. mov r0, r0, lsr #5
  33. mrc p15, 0, r4, c0, c0, 5
  34. and r4, r4, #0x0f
  35. cmp r0, r4
  36. bne wait
  37. b secondary_startup
  38. END(omap5_secondary_startup)
  39. /*
  40. * OMAP4 specific entry point for secondary CPU to jump from ROM
  41. * code. This routine also provides a holding flag into which
  42. * secondary core is held until we're ready for it to initialise.
  43. * The primary core will update this flag using a hardware
  44. * register AuxCoreBoot0.
  45. */
  46. ENTRY(omap_secondary_startup)
  47. hold: ldr r12,=0x103
  48. dsb
  49. smc #0 @ read from AuxCoreBoot0
  50. mov r0, r0, lsr #9
  51. mrc p15, 0, r4, c0, c0, 5
  52. and r4, r4, #0x0f
  53. cmp r0, r4
  54. bne hold
  55. /*
  56. * we've been released from the wait loop,secondary_stack
  57. * should now contain the SVC stack for this core
  58. */
  59. b secondary_startup
  60. ENDPROC(omap_secondary_startup)