Home Explore Help
Register Sign In
phyus
/
linux-vybrid_public
8
0
Fork 0
Files Issues 0 Pull Requests 0 Wiki
Tree: 28be6e07e8
Branches Tags
linux-vybrid_pu...
/
arch
/
arm
/
mach-shmobile
/
headsmp.S

headsmp.S 2.0 KB
History Raw

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091 
  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/linkage.h>
    14. 

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

  15. #include <asm/memory.h>
    16. 

  16. 

  17. ENTRY(shmobile_invalidate_start)
    18. 

  18. 	bl	v7_invalidate_l1
    19. 

  19. 	b	secondary_startup
    20. 

  20. ENDPROC(shmobile_invalidate_start)
    21. 

  21. 

  22. /*
    23. 

  23.  * Reset vector for secondary CPUs.
    24. 

  24.  * This will be mapped at address 0 by SBAR register.
    25. 

  25.  * We need _long_ jump to the physical address.
    26. 

  26.  */
    27. 

  27. 	.arm
    28. 

  28. 	.align  12
    29. 

  29. ENTRY(shmobile_boot_vector)
    30. 

  30. 	ldr     r0, 2f
    31. 

  31. 	ldr     r1, 1f
    32. 

  32. 	bx	r1
    33. 

  33. 

  34. ENDPROC(shmobile_boot_vector)
    35. 

  35. 

  36. 	.align	2
    37. 

  37. 	.globl	shmobile_boot_fn
    38. 

  38. shmobile_boot_fn:
    39. 

  39. 1:	.space	4
    40. 

  40. 	.globl	shmobile_boot_arg
    41. 

  41. shmobile_boot_arg:
    42. 

  42. 2:	.space	4
    43. 

  43. 

  44. /*
    45. 

  45.  * Per-CPU SMP boot function/argument selection code based on MPIDR
    46. 

  46.  */
    47. 

  47. 

  48. ENTRY(shmobile_smp_boot)
    49. 

  49. 						@ r0 = MPIDR_HWID_BITMASK
    50. 

  50. 	mrc	p15, 0, r1, c0, c0, 5		@ r1 = MPIDR
    51. 

  51. 	and	r0, r1, r0			@ r0 = cpu_logical_map() value
    52. 

  52. 	mov	r1, #0				@ r1 = CPU index
    53. 

  53. 	adr	r5, 1f				@ array of per-cpu mpidr values
    54. 

  54. 	adr	r6, 2f				@ array of per-cpu functions
    55. 

  55. 	adr	r7, 3f				@ array of per-cpu arguments
    56. 

  56. 

  57. shmobile_smp_boot_find_mpidr:
    58. 

  58. 	ldr	r8, [r5, r1, lsl #2]
    59. 

  59. 	cmp	r8, r0
    60. 

  60. 	bne	shmobile_smp_boot_next
    61. 

  61. 

  62. 	ldr	r9, [r6, r1, lsl #2]
    63. 

  63. 	cmp	r9, #0
    64. 

  64. 	bne	shmobile_smp_boot_found
    65. 

  65. 

  66. shmobile_smp_boot_next:
    67. 

  67. 	add	r1, r1, #1
    68. 

  68. 	cmp	r1, #CONFIG_NR_CPUS
    69. 

  69. 	blo	shmobile_smp_boot_find_mpidr
    70. 

  70. 

  71. 	b	shmobile_smp_sleep
    72. 

  72. 

  73. shmobile_smp_boot_found:
    74. 

  74. 	ldr	r0, [r7, r1, lsl #2]
    75. 

  75. 	mov	pc, r9
    76. 

  76. ENDPROC(shmobile_smp_boot)
    77. 

  77. 

  78. ENTRY(shmobile_smp_sleep)
    79. 

  79. 	wfi
    80. 

  80. 	b	shmobile_smp_boot
    81. 

  81. ENDPROC(shmobile_smp_sleep)
    82. 

  82. 

  83. 	.globl	shmobile_smp_mpidr
    84. 

  84. shmobile_smp_mpidr:
    85. 

  85. 1:	.space	CONFIG_NR_CPUS * 4
    86. 

  86. 	.globl	shmobile_smp_fn
    87. 

  87. shmobile_smp_fn:
    88. 

  88. 2:	.space	CONFIG_NR_CPUS * 4
    89. 

  89. 	.globl	shmobile_smp_arg
    90. 

  90. shmobile_smp_arg:
    91. 

  91. 3:	.space	CONFIG_NR_CPUS * 4
    92.