Home Explore Help
Sign In
GfA
/
linux_kernel
5
0
Fork 0
Files Issues 0 Pull Requests 0 Wiki
Branch: master
Branches Tags
linux_kernel
/
arch
/
csky
/
kernel
/
head.S

head.S 1.2 KB
Permalink History Raw

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677 
  1. /* SPDX-License-Identifier: GPL-2.0 */
    2. 

  2. 

  3. #include <linux/linkage.h>
    4. 

  4. #include <linux/init.h>
    5. 

  5. #include <asm/page.h>
    6. 

  6. #include <abi/entry.h>
    7. 

  7. 

  8. __HEAD
    9. 

  9. ENTRY(_start)
    10. 

  10. 	/* set super user mode */
    11. 

  11. 	lrw	a3, DEFAULT_PSR_VALUE
    12. 

  12. 	mtcr    a3, psr
    13. 

  13. 	psrset  ee
    14. 

  14. 

  15. 	SETUP_MMU a3
    16. 

  16. 

  17. 	/* set stack point */
    18. 

  18. 	lrw     a3, init_thread_union + THREAD_SIZE
    19. 

  19. 	mov	sp, a3
    20. 

  20. 

  21. 	jmpi	csky_start
    22. 

  22. END(_start)
    23. 

  23. 

  24. #ifdef CONFIG_SMP
    25. 

  25. .align 10
    26. 

  26. ENTRY(_start_smp_secondary)
    27. 

  27. 	/* Invalid I/Dcache BTB BHT */
    28. 

  28. 	movi	a3, 7
    29. 

  29. 	lsli	a3, 16
    30. 

  30. 	addi	a3, (1<<4) | 3
    31. 

  31. 	mtcr	a3, cr17
    32. 

  32. 

  33. 	tlbi.alls
    34. 

  34. 

  35. 	/* setup PAGEMASK */
    36. 

  36. 	movi	a3, 0
    37. 

  37. 	mtcr	a3, cr<6, 15>
    38. 

  38. 

  39. 	/* setup MEL0/MEL1 */
    40. 

  40. 	grs	a0, _start_smp_pc
    41. 

  41. _start_smp_pc:
    42. 

  42. 	bmaski  a1, 13
    43. 

  43. 	andn    a0, a1
    44. 

  44. 	movi    a1, 0x00000006
    45. 

  45. 	movi    a2, 0x00001006
    46. 

  46. 	or      a1, a0
    47. 

  47. 	or      a2, a0
    48. 

  48. 	mtcr	a1, cr<2, 15>
    49. 

  49. 	mtcr	a2, cr<3, 15>
    50. 

  50. 

  51. 	/* setup MEH */
    52. 

  52. 	mtcr	a0, cr<4, 15>
    53. 

  53. 

  54. 	/* write TLB */
    55. 

  55. 	bgeni   a3, 28
    56. 

  56. 	mtcr	a3, cr<8, 15>
    57. 

  57. 

  58. 	SETUP_MMU a3
    59. 

  59. 

  60. 	/* enable MMU */
    61. 

  61. 	movi	a3, 1
    62. 

  62. 	mtcr    a3, cr18
    63. 

  63. 

  64. 	jmpi	_goto_mmu_on
    65. 

  65. _goto_mmu_on:
    66. 

  66. 	lrw	a3, DEFAULT_PSR_VALUE
    67. 

  67. 	mtcr    a3, psr
    68. 

  68. 	psrset  ee
    69. 

  69. 

  70. 	/* set stack point */
    71. 

  71. 	lrw     a3, secondary_stack
    72. 

  72. 	ld.w	a3, (a3, 0)
    73. 

  73. 	mov	sp, a3
    74. 

  74. 

  75. 	jmpi	csky_start_secondary
    76. 

  76. END(_start_smp_secondary)
    77. 

  77. #endif
    78.