cpuport.c 2.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110
  1. /*
  2. * Copyright (c) 2006-2018, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2018-09-01 xuzhuoyi the first version.
  9. */
  10. #include <rtthread.h>
  11. /* exception and interrupt handler table */
  12. rt_uint32_t rt_interrupt_from_thread;
  13. rt_uint32_t rt_interrupt_to_thread;
  14. rt_uint32_t rt_thread_switch_interrupt_flag;
  15. /* exception hook */
  16. static rt_err_t (*rt_exception_hook)(void *context) = RT_NULL;
  17. struct exception_stack_frame
  18. {
  19. rt_uint32_t t_st0;
  20. rt_uint32_t acc;
  21. rt_uint32_t p;
  22. rt_uint32_t ar1_ar0;
  23. rt_uint32_t dp_st1;
  24. rt_uint32_t dbgstat_ier;
  25. rt_uint32_t return_address;
  26. };
  27. struct stack_frame
  28. {
  29. struct exception_stack_frame exception_stack_frame;
  30. /* r4 ~ r11 register */
  31. rt_uint16_t ar0h;
  32. rt_uint16_t ar1h;
  33. rt_uint32_t xar2;
  34. rt_uint32_t xar3;
  35. rt_uint32_t xar4;
  36. rt_uint32_t xar5;
  37. rt_uint32_t xar6;
  38. rt_uint32_t xar7;
  39. rt_uint32_t xt;
  40. rt_uint32_t rpc;
  41. };
  42. rt_uint8_t *rt_hw_stack_init(void *tentry,
  43. void *parameter,
  44. rt_uint8_t *stack_addr,
  45. void *texit)
  46. {
  47. struct stack_frame *stack_frame;
  48. rt_uint8_t *stk;
  49. unsigned long i;
  50. stk = stack_addr;
  51. stk = (rt_uint8_t *)RT_ALIGN((rt_uint32_t)stk, 8);
  52. //stk -= sizeof(struct stack_frame);
  53. stack_frame = (struct stack_frame *)stk;
  54. /* init all register */
  55. for (i = 0; i < sizeof(struct stack_frame) / sizeof(rt_uint32_t); i ++)
  56. {
  57. ((rt_uint32_t *)stack_frame)[i] = 0xdeadbeef;
  58. }
  59. stack_frame->exception_stack_frame.t_st0 = 0x11110000 | rt_hw_get_st0();
  60. stack_frame->exception_stack_frame.acc = 0x33332222;
  61. stack_frame->exception_stack_frame.ar1_ar0 = 0x00001111 & (unsigned long)parameter; /* ar0 : argument */
  62. stack_frame->exception_stack_frame.p = 0x55554444; /* p */
  63. stack_frame->exception_stack_frame.dp_st1 = (0x00000000) | rt_hw_get_st1(); /* dp_st1 */
  64. stack_frame->exception_stack_frame.dbgstat_ier = 0; /* dbgstat_ier */
  65. stack_frame->exception_stack_frame.return_address = (unsigned long)tentry; /* return_address */
  66. stack_frame->rpc = (unsigned long)texit;
  67. /* return task's current stack address */
  68. return stk + sizeof(struct stack_frame);
  69. }
  70. /**
  71. * This function set the hook, which is invoked on fault exception handling.
  72. *
  73. * @param exception_handle the exception handling hook function.
  74. */
  75. void rt_hw_exception_install(rt_err_t (*exception_handle)(void *context))
  76. {
  77. rt_exception_hook = exception_handle;
  78. }
  79. struct exception_info
  80. {
  81. rt_uint32_t exc_return;
  82. struct stack_frame stack_frame;
  83. };
  84. /**
  85. * shutdown CPU
  86. */
  87. void rt_hw_cpu_shutdown(void)
  88. {
  89. rt_kprintf("shutdown...\n");
  90. RT_ASSERT(0);
  91. }