Startseite Erkunden Hilfe
Anmelden
zxy
/
acr_test
1
0
Fork 0
Dateien Issues 0 Pull-Requests 0 Wiki
Branch: master
Branches Tags
acr_test
/
libcpu
/
arm
/
s3c44b0
/
context_gcc.S

context_gcc.S 2.1 KB
Permalink Verlauf Originalformat

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495 
  1. /*
    2. 

  2.  * Copyright (c) 2006-2018, RT-Thread Development Team
    3. 

  3.  *
    4. 

  4.  * SPDX-License-Identifier: Apache-2.0
    5. 

  5.  *
    6. 

  6.  * Change Logs:
    7. 

  7.  * Date           Author       Notes
    8. 

  8.  * 2006-09-06     XuXinming    first version
    9. 

  9.  */
    10. 

  10. 

  11. /*!
    12. 

  12.  * \addtogroup S3C44B0
    13. 

  13.  */
    14. 

  14. /*@{*/
    15. 

  15. 

  16. #define NOINT			0xc0
    17. 

  17. 

  18. /*
    19. 

  19.  * rt_base_t rt_hw_interrupt_disable();
    20. 

  20.  */
    21. 

  21. .globl rt_hw_interrupt_disable
    22. 

  22. rt_hw_interrupt_disable:
    23. 

  23. 	mrs r0, cpsr
    24. 

  24. 	orr r1, r0, #NOINT
    25. 

  25. 	msr cpsr_c, r1
    26. 

  26. 	mov pc, lr
    27. 

  27. 

  28. /*
    29. 

  29.  * void rt_hw_interrupt_enable(rt_base_t level);
    30. 

  30.  */
    31. 

  31. .globl rt_hw_interrupt_enable
    32. 

  32. rt_hw_interrupt_enable:
    33. 

  33. 	msr cpsr, r0
    34. 

  34. 	mov pc, lr
    35. 

  35. 

  36. /*
    37. 

  37.  * void rt_hw_context_switch(rt_uint32 from, rt_uint32 to);
    38. 

  38.  * r0 --> from
    39. 

  39.  * r1 --> to
    40. 

  40.  */
    41. 

  41. .globl rt_hw_context_switch
    42. 

  42. rt_hw_context_switch:
    43. 

  43. 	stmfd	sp!, {lr}		@ push pc (lr should be pushed in place of PC)
    44. 

  44. 	stmfd	sp!, {r0-r12, lr}	@ push lr & register file
    45. 

  45. 

  46. 	mrs	r4, cpsr
    47. 

  47. 	stmfd	sp!, {r4}		@ push cpsr
    48. 

  48. 	mrs	r4, spsr
    49. 

  49. 	stmfd	sp!, {r4}		@ push spsr
    50. 

  50. 

  51. 	str	sp, [r0]			@ store sp in preempted tasks TCB
    52. 

  52. 	ldr	sp, [r1]			@ get new task stack pointer
    53. 

  53. 

  54. 	ldmfd	sp!, {r4}		@ pop new task spsr
    55. 

  55. 	msr	spsr_cxsf, r4
    56. 

  56. 	ldmfd	sp!, {r4}		@ pop new task cpsr
    57. 

  57. 	msr	cpsr_cxsf, r4
    58. 

  58. 

  59. 	ldmfd	sp!, {r0-r12, lr, pc}	@ pop new task r0-r12, lr & pc
    60. 

  60. 

  61. /*
    62. 

  62.  * void rt_hw_context_switch_to(rt_uint32 to);
    63. 

  63.  * r0 --> to
    64. 

  64.  */
    65. 

  65. .globl rt_hw_context_switch_to
    66. 

  66. rt_hw_context_switch_to:
    67. 

  67. 	ldr	sp, [r0]		@ get new task stack pointer
    68. 

  68. 

  69. 	ldmfd	sp!, {r4}		@ pop new task spsr
    70. 

  70. 	msr	spsr_cxsf, r4
    71. 

  71. 	ldmfd	sp!, {r4}		@ pop new task cpsr
    72. 

  72. 	msr	cpsr_cxsf, r4
    73. 

  73. 

  74. 	ldmfd	sp!, {r0-r12, lr, pc}	@ pop new task r0-r12, lr & pc
    75. 

  75. 

  76. /*
    77. 

  77.  * void rt_hw_context_switch_interrupt(rt_uint32 from, rt_uint32 to);
    78. 

  78.  */
    79. 

  79. .globl rt_thread_switch_interrupt_flag
    80. 

  80. .globl rt_interrupt_from_thread
    81. 

  81. .globl rt_interrupt_to_thread
    82. 

  82. .globl rt_hw_context_switch_interrupt
    83. 

  83. rt_hw_context_switch_interrupt:
    84. 

  84. 	ldr r2, =rt_thread_switch_interrupt_flag
    85. 

  85. 	ldr r3, [r2]
    86. 

  86. 	cmp r3, #1
    87. 

  87. 	beq _reswitch
    88. 

  88. 	mov r3, #1				@ set rt_thread_switch_interrupt_flag to 1
    89. 

  89. 	str r3, [r2]
    90. 

  90. 	ldr r2, =rt_interrupt_from_thread	@ set rt_interrupt_from_thread
    91. 

  91. 	str r0, [r2]
    92. 

  92. _reswitch:
    93. 

  93. 	ldr r2, =rt_interrupt_to_thread		@ set rt_interrupt_to_thread
    94. 

  94. 	str r1, [r2]
    95. 

  95. 	mov pc, lr
    96.