Sākums Izpētīt Palīdzība
Reģistrēties Pierakstīties
phyus
/
linux-vybrid_public
8
0
Atdalīts 0
Faili Problēmas 0 Izmaiņu pieprasījumi 0 Vikivietne
Koks: cc61591e45
Atzari Tagi
linux-vybrid_pu...
/
arch
/
arm
/
mach-shmobile
/
headsmp.S

headsmp.S 2.0 KB
Vēsture Neapstrādāts

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889 
  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. 	__CPUINIT
    18. 

  18. 

  19. ENTRY(shmobile_invalidate_start)
    20. 

  20. 	bl	v7_invalidate_l1
    21. 

  21. 	b	secondary_startup
    22. 

  22. ENDPROC(shmobile_invalidate_start)
    23. 

  23. 

  24. /*
    25. 

  25.  * Reset vector for secondary CPUs.
    26. 

  26.  * This will be mapped at address 0 by SBAR register.
    27. 

  27.  * We need _long_ jump to the physical address.
    28. 

  28.  */
    29. 

  29. 	.align  12
    30. 

  30. ENTRY(shmobile_boot_vector)
    31. 

  31. 	ldr     r0, 2f
    32. 

  32. 	ldr     pc, 1f
    33. 

  33. ENDPROC(shmobile_boot_vector)
    34. 

  34. 

  35. 	.globl	shmobile_boot_fn
    36. 

  36. shmobile_boot_fn:
    37. 

  37. 1:	.space	4
    38. 

  38. 	.globl	shmobile_boot_arg
    39. 

  39. shmobile_boot_arg:
    40. 

  40. 2:	.space	4
    41. 

  41. 

  42. /*
    43. 

  43.  * Per-CPU SMP boot function/argument selection code based on MPIDR
    44. 

  44.  */
    45. 

  45. 

  46. ENTRY(shmobile_smp_boot)
    47. 

  47. 						@ r0 = MPIDR_HWID_BITMASK
    48. 

  48. 	mrc	p15, 0, r1, c0, c0, 5		@ r1 = MPIDR
    49. 

  49. 	and	r0, r1, r0			@ r0 = cpu_logical_map() value
    50. 

  50. 	mov	r1, #0				@ r1 = CPU index
    51. 

  51. 	adr	r5, 1f				@ array of per-cpu mpidr values
    52. 

  52. 	adr	r6, 2f				@ array of per-cpu functions
    53. 

  53. 	adr	r7, 3f				@ 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, #CONFIG_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. 	mov	pc, 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. 	.globl	shmobile_smp_mpidr
    82. 

  82. shmobile_smp_mpidr:
    83. 

  83. 1:	.space	CONFIG_NR_CPUS * 4
    84. 

  84. 	.globl	shmobile_smp_fn
    85. 

  85. shmobile_smp_fn:
    86. 

  86. 2:	.space	CONFIG_NR_CPUS * 4
    87. 

  87. 	.globl	shmobile_smp_arg
    88. 

  88. shmobile_smp_arg:
    89. 

  89. 3:	.space	CONFIG_NR_CPUS * 4
    90.