startup.c 3.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128
  1. /*
  2. * Copyright (c) 2021-2023 HPMicro
  3. *
  4. *
  5. */
  6. #include "hpm_common.h"
  7. #include "hpm_soc.h"
  8. #include "hpm_l1c_drv.h"
  9. #include <rtthread.h>
  10. void system_init(void);
  11. extern int entry(void);
  12. extern void __libc_init_array(void);
  13. extern void __libc_fini_array(void);
  14. void system_init(void)
  15. {
  16. disable_global_irq(CSR_MSTATUS_MIE_MASK);
  17. disable_irq_from_intc();
  18. enable_irq_from_intc();
  19. enable_global_irq(CSR_MSTATUS_MIE_MASK);
  20. #ifndef CONFIG_NOT_ENABLE_ICACHE
  21. l1c_ic_enable();
  22. #endif
  23. #ifndef CONFIG_NOT_ENABLE_DCACHE
  24. l1c_dc_enable();
  25. #endif
  26. }
  27. __attribute__((weak)) void c_startup(void)
  28. {
  29. uint32_t i, size;
  30. #ifdef FLASH_XIP
  31. extern uint8_t __vector_ram_start__[], __vector_ram_end__[], __vector_load_addr__[];
  32. size = __vector_ram_end__ - __vector_ram_start__;
  33. for (i = 0; i < size; i++) {
  34. *(__vector_ram_start__ + i) = *(__vector_load_addr__ + i);
  35. }
  36. #endif
  37. extern uint8_t __etext[];
  38. extern uint8_t __bss_start__[], __bss_end__[];
  39. extern uint8_t __tbss_start__[], __tbss_end__[];
  40. extern uint8_t __tdata_start__[], __tdata_end__[];
  41. extern uint8_t __data_start__[], __data_end__[];
  42. extern uint8_t __noncacheable_bss_start__[], __noncacheable_bss_end__[];
  43. extern uint8_t __ramfunc_start__[], __ramfunc_end__[];
  44. extern uint8_t __noncacheable_init_start__[], __noncacheable_init_end__[];
  45. /* tbss section */
  46. size = __tbss_end__ - __tbss_start__;
  47. for (i = 0; i < size; i++) {
  48. *(__tbss_start__ + i) = 0;
  49. }
  50. /* bss section */
  51. size = __bss_end__ - __bss_start__;
  52. for (i = 0; i < size; i++) {
  53. *(__bss_start__ + i) = 0;
  54. }
  55. /* noncacheable bss section */
  56. size = __noncacheable_bss_end__ - __noncacheable_bss_start__;
  57. for (i = 0; i < size; i++) {
  58. *(__noncacheable_bss_start__ + i) = 0;
  59. }
  60. /* tdata section LMA: etext */
  61. size = __tdata_end__ - __tdata_start__;
  62. for (i = 0; i < size; i++) {
  63. *(__tdata_start__ + i) = *(__etext + i);
  64. }
  65. /* data section LMA: etext */
  66. size = __data_end__ - __data_start__;
  67. for (i = 0; i < size; i++) {
  68. *(__data_start__ + i) = *(__etext + (__tdata_end__ - __tdata_start__) + i);
  69. }
  70. /* ramfunc section LMA: etext + data length */
  71. size = __ramfunc_end__ - __ramfunc_start__;
  72. for (i = 0; i < size; i++) {
  73. *(__ramfunc_start__ + i) = *(__etext + (__data_end__ - __tdata_start__) + i);
  74. }
  75. /* noncacheable init section LMA: etext + data length + ramfunc length */
  76. size = __noncacheable_init_end__ - __noncacheable_init_start__;
  77. for (i = 0; i < size; i++) {
  78. *(__noncacheable_init_start__ + i) = *(__etext + (__data_end__ - __tdata_start__) + (__ramfunc_end__ - __ramfunc_start__) + i);
  79. }
  80. }
  81. __attribute__((weak)) int main(void)
  82. {
  83. while(1);
  84. }
  85. void reset_handler(void)
  86. {
  87. /**
  88. * Disable preemptive interrupt
  89. */
  90. HPM_PLIC->FEATURE = 0;
  91. /*
  92. * Initialize LMA/VMA sections.
  93. * Relocation for any sections that need to be copied from LMA to VMA.
  94. */
  95. c_startup();
  96. /* Call platform specific hardware initialization */
  97. system_init();
  98. /* Do global constructors */
  99. __libc_init_array();
  100. /* Entry function */
  101. entry();
  102. }
  103. __attribute__((weak)) void _init()
  104. {
  105. }