Home Explore Help
Sign In
phreedom2600net
/
linux-libre
Watch 2
Star 0
Fork 0
Files Issues 0 Pull Requests 0 Wiki
Tree: 0d5005ec5c
Branches Tags
linux-libre
/
arch
/
arm
/
mach-shmobile
/
headsmp.S

headsmp.S 2.0 KB
History Raw

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596 
  1. /*
    2. 

  2.  * SMP support for R-Mobile / SH-Mobile
    3. 

  3.  *
    4. 

  4.  * Copyright (C) 2010  Magnus Damm
    5. 

  5.  * Copyright (C) 2010  Takashi Yoshii
    6. 

  6.  *
    7. 

  7.  * Based on vexpress, Copyright (c) 2003 ARM Limited, All Rights Reserved
    8. 

  8.  *
    9. 

  9.  * This program is free software; you can redistribute it and/or modify
    10. 

  10.  * it under the terms of the GNU General Public License version 2 as
    11. 

  11.  * published by the Free Software Foundation.
    12. 

  12.  */
    13. 

  13. #include <linux/init.h>
    14. 

  14. #include <linux/linkage.h>
    15. 

  15. #include <linux/threads.h>
    16. 

  16. #include <asm/assembler.h>
    17. 

  17. #include <asm/memory.h>
    18. 

  18. 

  19. /*
    20. 

  20.  * Reset vector for secondary CPUs.
    21. 

  21.  * This will be mapped at address 0 by SBAR register.
    22. 

  22.  * We need _long_ jump to the physical address.
    23. 

  23.  */
    24. 

  24. 	.arm
    25. 

  25. 	.align  12
    26. 

  26. ENTRY(shmobile_boot_vector)
    27. 

  27. 	ldr     r1, 1f
    28. 

  28. 	bx	r1
    29. 

  29. 

  30. ENDPROC(shmobile_boot_vector)
    31. 

  31. 

  32. 	.align	2
    33. 

  33. 	.globl	shmobile_boot_fn
    34. 

  34. shmobile_boot_fn:
    35. 

  35. 1:	.space	4
    36. 

  36. 	.globl	shmobile_boot_size
    37. 

  37. shmobile_boot_size:
    38. 

  38. 	.long	. - shmobile_boot_vector
    39. 

  39. 

  40. /*
    41. 

  41.  * Per-CPU SMP boot function/argument selection code based on MPIDR
    42. 

  42.  */
    43. 

  43. 

  44. ENTRY(shmobile_smp_boot)
    45. 

  45. 	mrc	p15, 0, r1, c0, c0, 5		@ r1 = MPIDR
    46. 

  46. 	and	r0, r1, #0xffffff		@ MPIDR_HWID_BITMASK
    47. 

  47. 						@ r0 = cpu_logical_map() value
    48. 

  48. 	mov	r1, #0				@ r1 = CPU index
    49. 

  49. 	adr	r2, 1f
    50. 

  50. 	ldmia	r2, {r5, r6, r7}
    51. 

  51. 	add	r5, r5, r2			@ array of per-cpu mpidr values
    52. 

  52. 	add	r6, r6, r2			@ array of per-cpu functions
    53. 

  53. 	add	r7, r7, r2			@ array of per-cpu arguments
    54. 

  54. 

  55. shmobile_smp_boot_find_mpidr:
    56. 

  56. 	ldr	r8, [r5, r1, lsl #2]
    57. 

  57. 	cmp	r8, r0
    58. 

  58. 	bne	shmobile_smp_boot_next
    59. 

  59. 

  60. 	ldr	r9, [r6, r1, lsl #2]
    61. 

  61. 	cmp	r9, #0
    62. 

  62. 	bne	shmobile_smp_boot_found
    63. 

  63. 

  64. shmobile_smp_boot_next:
    65. 

  65. 	add	r1, r1, #1
    66. 

  66. 	cmp	r1, #NR_CPUS
    67. 

  67. 	blo	shmobile_smp_boot_find_mpidr
    68. 

  68. 

  69. 	b	shmobile_smp_sleep
    70. 

  70. 

  71. shmobile_smp_boot_found:
    72. 

  72. 	ldr	r0, [r7, r1, lsl #2]
    73. 

  73. 	ret	r9
    74. 

  74. ENDPROC(shmobile_smp_boot)
    75. 

  75. 

  76. ENTRY(shmobile_smp_sleep)
    77. 

  77. 	wfi
    78. 

  78. 	b	shmobile_smp_boot
    79. 

  79. ENDPROC(shmobile_smp_sleep)
    80. 

  80. 

  81. 	.align	2
    82. 

  82. 1:	.long	shmobile_smp_mpidr - .
    83. 

  83. 	.long	shmobile_smp_fn - 1b
    84. 

  84. 	.long	shmobile_smp_arg - 1b
    85. 

  85. 

  86. 	.bss
    87. 

  87. 	.globl	shmobile_smp_mpidr
    88. 

  88. shmobile_smp_mpidr:
    89. 

  89. 	.space	NR_CPUS * 4
    90. 

  90. 	.globl	shmobile_smp_fn
    91. 

  91. shmobile_smp_fn:
    92. 

  92. 	.space	NR_CPUS * 4
    93. 

  93. 	.globl	shmobile_smp_arg
    94. 

  94. shmobile_smp_arg:
    95. 

  95. 	.space	NR_CPUS * 4
    96. 

  96.