cpuport.c 3.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122
  1. /*
  2. * File : cpuport.c
  3. * This file is part of RT-Thread RTOS
  4. * COPYRIGHT (C) 2009 - 2011, RT-Thread Development Team
  5. *
  6. * The license and distribution terms for this file may be
  7. * found in the file LICENSE in this distribution or at
  8. * http://www.rt-thread.org/license/LICENSE
  9. *
  10. * Change Logs:
  11. * Date Author Notes
  12. * 2006-08-23 Bernard the first version
  13. * 2011-06-03 Bernard merge all of C source code into cpuport.c
  14. */
  15. #include <rtthread.h>
  16. /* exception and interrupt handler table */
  17. rt_uint32_t rt_interrupt_from_thread, rt_interrupt_to_thread;
  18. rt_uint32_t rt_thread_switch_interrupt_flag;
  19. struct stack_contex
  20. {
  21. rt_uint32_t r0;
  22. rt_uint32_t r1;
  23. rt_uint32_t r2;
  24. rt_uint32_t r3;
  25. rt_uint32_t r12;
  26. rt_uint32_t lr;
  27. rt_uint32_t pc;
  28. rt_uint32_t psr;
  29. };
  30. struct stack_contex_fpu
  31. {
  32. rt_uint32_t r0;
  33. rt_uint32_t r1;
  34. rt_uint32_t r2;
  35. rt_uint32_t r3;
  36. rt_uint32_t r12;
  37. rt_uint32_t lr;
  38. rt_uint32_t pc;
  39. rt_uint32_t psr;
  40. /* FPU register */
  41. rt_uint32_t S0;
  42. rt_uint32_t S1;
  43. rt_uint32_t S2;
  44. rt_uint32_t S3;
  45. rt_uint32_t S4;
  46. rt_uint32_t S5;
  47. rt_uint32_t S6;
  48. rt_uint32_t S7;
  49. rt_uint32_t S8;
  50. rt_uint32_t S9;
  51. rt_uint32_t S10;
  52. rt_uint32_t S11;
  53. rt_uint32_t S12;
  54. rt_uint32_t S13;
  55. rt_uint32_t S14;
  56. rt_uint32_t S15;
  57. rt_uint32_t FPSCR;
  58. rt_uint32_t NO_NAME;
  59. };
  60. rt_uint8_t *rt_hw_stack_init(void *tentry, void *parameter,
  61. rt_uint8_t *stack_addr, void *texit)
  62. {
  63. unsigned long *stk;
  64. struct stack_contex_fpu * stack_contex_fpu;
  65. stk = (unsigned long *)stack_addr;
  66. stk -= sizeof(struct stack_contex_fpu);
  67. stack_contex_fpu = (struct stack_contex_fpu *)stk;
  68. stack_contex_fpu->r0 = (unsigned long)parameter; /* r0 : argument */
  69. stack_contex_fpu->r1 = 0; /* r1 */
  70. stack_contex_fpu->r2 = 0; /* r2 */
  71. stack_contex_fpu->r3 = 0; /* r3 */
  72. stack_contex_fpu->r12 = 0; /* r12 */
  73. stack_contex_fpu->lr = (unsigned long)texit; /* lr */
  74. stack_contex_fpu->pc = (unsigned long)tentry; /* entry point, pc */
  75. stack_contex_fpu->psr = 0x01000000L; /* PSR */
  76. *(--stk) = 0; /* r11 */
  77. *(--stk) = 0; /* r10 */
  78. *(--stk) = 0; /* r9 */
  79. *(--stk) = 0; /* r8 */
  80. *(--stk) = 0; /* r7 */
  81. *(--stk) = 0; /* r6 */
  82. *(--stk) = 0; /* r5 */
  83. *(--stk) = 0; /* r4 */
  84. /* return task's current stack address */
  85. return (rt_uint8_t *)stk;
  86. }
  87. extern void rt_hw_interrupt_thread_switch(void);
  88. extern void list_thread(void);
  89. extern rt_thread_t rt_current_thread;
  90. void rt_hw_hard_fault_exception(struct stack_contex* contex)
  91. {
  92. rt_kprintf("psr: 0x%08x\n", contex->psr);
  93. rt_kprintf(" pc: 0x%08x\n", contex->pc);
  94. rt_kprintf(" lr: 0x%08x\n", contex->lr);
  95. rt_kprintf("r12: 0x%08x\n", contex->r12);
  96. rt_kprintf("r03: 0x%08x\n", contex->r3);
  97. rt_kprintf("r02: 0x%08x\n", contex->r2);
  98. rt_kprintf("r01: 0x%08x\n", contex->r1);
  99. rt_kprintf("r00: 0x%08x\n", contex->r0);
  100. rt_kprintf("hard fault on thread: %s\n", rt_current_thread->name);
  101. #ifdef RT_USING_FINSH
  102. list_thread();
  103. #endif
  104. while (1);
  105. }
  106. void rt_hw_cpu_shutdown()
  107. {
  108. rt_kprintf("shutdown...\n");
  109. RT_ASSERT(0);
  110. }