mips_cache.c 2.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139
  1. /*
  2. * Copyright (c) 2006-2021, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2016-09-07 Urey the first version
  9. */
  10. #include <rtthread.h>
  11. #include "mips.h"
  12. extern void cache_init(rt_ubase_t cache_size, rt_ubase_t cache_line_size);
  13. void r4k_cache_init(void)
  14. {
  15. // cache_init(dcache_size, cpu_dcache_line_size);
  16. }
  17. void r4k_cache_flush_all(void)
  18. {
  19. blast_dcache16();
  20. blast_icache16();
  21. }
  22. void r4k_icache_flush_all(void)
  23. {
  24. blast_icache16();
  25. }
  26. void r4k_icache_flush_range(rt_ubase_t addr, rt_ubase_t size)
  27. {
  28. rt_ubase_t end, a;
  29. if (size > g_mips_core.icache_size)
  30. {
  31. blast_icache16();
  32. }
  33. else
  34. {
  35. rt_ubase_t ic_lsize = g_mips_core.icache_line_size;
  36. a = addr & ~(ic_lsize - 1);
  37. end = ((addr + size) - 1) & ~(ic_lsize - 1);
  38. while (1)
  39. {
  40. flush_icache_line(a);
  41. if (a == end)
  42. break;
  43. a += ic_lsize;
  44. }
  45. }
  46. }
  47. void r4k_icache_lock_range(rt_ubase_t addr, rt_ubase_t size)
  48. {
  49. rt_ubase_t end, a;
  50. rt_ubase_t ic_lsize = g_mips_core.icache_line_size;
  51. a = addr & ~(ic_lsize - 1);
  52. end = ((addr + size) - 1) & ~(ic_lsize - 1);
  53. while (1)
  54. {
  55. lock_icache_line(a);
  56. if (a == end)
  57. break;
  58. a += ic_lsize;
  59. }
  60. }
  61. void r4k_dcache_inv(rt_ubase_t addr, rt_ubase_t size)
  62. {
  63. rt_ubase_t end, a;
  64. rt_ubase_t dc_lsize = g_mips_core.dcache_line_size;
  65. a = addr & ~(dc_lsize - 1);
  66. end = ((addr + size) - 1) & ~(dc_lsize - 1);
  67. while (1)
  68. {
  69. invalidate_dcache_line(a);
  70. if (a == end)
  71. break;
  72. a += dc_lsize;
  73. }
  74. }
  75. void r4k_dcache_wback_inv(rt_ubase_t addr, rt_ubase_t size)
  76. {
  77. rt_ubase_t end, a;
  78. if (size >= g_mips_core.dcache_size)
  79. {
  80. blast_dcache16();
  81. }
  82. else
  83. {
  84. rt_ubase_t dc_lsize = g_mips_core.dcache_line_size;
  85. a = addr & ~(dc_lsize - 1);
  86. end = ((addr + size) - 1) & ~(dc_lsize - 1);
  87. while (1)
  88. {
  89. flush_dcache_line(a);
  90. if (a == end)
  91. break;
  92. a += dc_lsize;
  93. }
  94. }
  95. }
  96. #define dma_cache_wback_inv(start,size) \
  97. do { (void) (start); (void) (size); } while (0)
  98. #define dma_cache_wback(start,size) \
  99. do { (void) (start); (void) (size); } while (0)
  100. #define dma_cache_inv(start,size) \
  101. do { (void) (start); (void) (size); } while (0)
  102. void r4k_dma_cache_sync(rt_ubase_t addr, rt_size_t size, enum dma_data_direction direction)
  103. {
  104. switch (direction)
  105. {
  106. case DMA_TO_DEVICE:
  107. r4k_dcache_wback_inv(addr, size);
  108. break;
  109. case DMA_FROM_DEVICE:
  110. r4k_dcache_wback_inv(addr, size);
  111. break;
  112. case DMA_BIDIRECTIONAL:
  113. dma_cache_wback_inv(addr, size);
  114. break;
  115. default:
  116. RT_ASSERT(0) ;
  117. }
  118. }