memory.cpp 26 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751
  1. // Copyright 2015 Citra Emulator Project
  2. // Licensed under GPLv2 or any later version
  3. // Refer to the license.txt file included.
  4. #include <array>
  5. #include <cstring>
  6. #include "audio_core/audio_core.h"
  7. #include "common/assert.h"
  8. #include "common/common_types.h"
  9. #include "common/logging/log.h"
  10. #include "common/swap.h"
  11. #include "core/hle/kernel/memory.h"
  12. #include "core/hle/kernel/process.h"
  13. #include "core/hle/lock.h"
  14. #include "core/memory.h"
  15. #include "core/memory_setup.h"
  16. #include "video_core/renderer_base.h"
  17. #include "video_core/video_core.h"
  18. namespace Memory {
  19. static std::array<u8, Memory::VRAM_SIZE> vram;
  20. static std::array<u8, Memory::N3DS_EXTRA_RAM_SIZE> n3ds_extra_ram;
  21. PageTable* current_page_table = nullptr;
  22. std::array<u8*, PAGE_TABLE_NUM_ENTRIES>* GetCurrentPageTablePointers() {
  23. return &current_page_table->pointers;
  24. }
  25. static void MapPages(PageTable& page_table, u32 base, u32 size, u8* memory, PageType type) {
  26. LOG_DEBUG(HW_Memory, "Mapping %p onto %08X-%08X", memory, base * PAGE_SIZE,
  27. (base + size) * PAGE_SIZE);
  28. RasterizerFlushVirtualRegion(base << PAGE_BITS, size * PAGE_SIZE,
  29. FlushMode::FlushAndInvalidate);
  30. u32 end = base + size;
  31. while (base != end) {
  32. ASSERT_MSG(base < PAGE_TABLE_NUM_ENTRIES, "out of range mapping at %08X", base);
  33. page_table.attributes[base] = type;
  34. page_table.pointers[base] = memory;
  35. page_table.cached_res_count[base] = 0;
  36. base += 1;
  37. if (memory != nullptr)
  38. memory += PAGE_SIZE;
  39. }
  40. }
  41. void MapMemoryRegion(PageTable& page_table, VAddr base, u32 size, u8* target) {
  42. ASSERT_MSG((size & PAGE_MASK) == 0, "non-page aligned size: %08X", size);
  43. ASSERT_MSG((base & PAGE_MASK) == 0, "non-page aligned base: %08X", base);
  44. MapPages(page_table, base / PAGE_SIZE, size / PAGE_SIZE, target, PageType::Memory);
  45. }
  46. void MapIoRegion(PageTable& page_table, VAddr base, u32 size, MMIORegionPointer mmio_handler) {
  47. ASSERT_MSG((size & PAGE_MASK) == 0, "non-page aligned size: %08X", size);
  48. ASSERT_MSG((base & PAGE_MASK) == 0, "non-page aligned base: %08X", base);
  49. MapPages(page_table, base / PAGE_SIZE, size / PAGE_SIZE, nullptr, PageType::Special);
  50. page_table.special_regions.emplace_back(SpecialRegion{base, size, mmio_handler});
  51. }
  52. void UnmapRegion(PageTable& page_table, VAddr base, u32 size) {
  53. ASSERT_MSG((size & PAGE_MASK) == 0, "non-page aligned size: %08X", size);
  54. ASSERT_MSG((base & PAGE_MASK) == 0, "non-page aligned base: %08X", base);
  55. MapPages(page_table, base / PAGE_SIZE, size / PAGE_SIZE, nullptr, PageType::Unmapped);
  56. }
  57. /**
  58. * Gets a pointer to the exact memory at the virtual address (i.e. not page aligned)
  59. * using a VMA from the current process
  60. */
  61. static u8* GetPointerFromVMA(VAddr vaddr) {
  62. u8* direct_pointer = nullptr;
  63. auto& vm_manager = Kernel::g_current_process->vm_manager;
  64. auto it = vm_manager.FindVMA(vaddr);
  65. ASSERT(it != vm_manager.vma_map.end());
  66. auto& vma = it->second;
  67. switch (vma.type) {
  68. case Kernel::VMAType::AllocatedMemoryBlock:
  69. direct_pointer = vma.backing_block->data() + vma.offset;
  70. break;
  71. case Kernel::VMAType::BackingMemory:
  72. direct_pointer = vma.backing_memory;
  73. break;
  74. case Kernel::VMAType::Free:
  75. return nullptr;
  76. default:
  77. UNREACHABLE();
  78. }
  79. return direct_pointer + (vaddr - vma.base);
  80. }
  81. /**
  82. * This function should only be called for virtual addreses with attribute `PageType::Special`.
  83. */
  84. static MMIORegionPointer GetMMIOHandler(VAddr vaddr) {
  85. for (const auto& region : current_page_table->special_regions) {
  86. if (vaddr >= region.base && vaddr < (region.base + region.size)) {
  87. return region.handler;
  88. }
  89. }
  90. ASSERT_MSG(false, "Mapped IO page without a handler @ %08X", vaddr);
  91. return nullptr; // Should never happen
  92. }
  93. template <typename T>
  94. T ReadMMIO(MMIORegionPointer mmio_handler, VAddr addr);
  95. template <typename T>
  96. T Read(const VAddr vaddr) {
  97. const u8* page_pointer = current_page_table->pointers[vaddr >> PAGE_BITS];
  98. if (page_pointer) {
  99. // NOTE: Avoid adding any extra logic to this fast-path block
  100. T value;
  101. std::memcpy(&value, &page_pointer[vaddr & PAGE_MASK], sizeof(T));
  102. return value;
  103. }
  104. // The memory access might do an MMIO or cached access, so we have to lock the HLE kernel state
  105. std::lock_guard<std::recursive_mutex> lock(HLE::g_hle_lock);
  106. PageType type = current_page_table->attributes[vaddr >> PAGE_BITS];
  107. switch (type) {
  108. case PageType::Unmapped:
  109. LOG_ERROR(HW_Memory, "unmapped Read%lu @ 0x%08X", sizeof(T) * 8, vaddr);
  110. return 0;
  111. case PageType::Memory:
  112. ASSERT_MSG(false, "Mapped memory page without a pointer @ %08X", vaddr);
  113. break;
  114. case PageType::RasterizerCachedMemory: {
  115. RasterizerFlushVirtualRegion(vaddr, sizeof(T), FlushMode::Flush);
  116. T value;
  117. std::memcpy(&value, GetPointerFromVMA(vaddr), sizeof(T));
  118. return value;
  119. }
  120. case PageType::Special:
  121. return ReadMMIO<T>(GetMMIOHandler(vaddr), vaddr);
  122. case PageType::RasterizerCachedSpecial: {
  123. RasterizerFlushVirtualRegion(vaddr, sizeof(T), FlushMode::Flush);
  124. return ReadMMIO<T>(GetMMIOHandler(vaddr), vaddr);
  125. }
  126. default:
  127. UNREACHABLE();
  128. }
  129. }
  130. template <typename T>
  131. void WriteMMIO(MMIORegionPointer mmio_handler, VAddr addr, const T data);
  132. template <typename T>
  133. void Write(const VAddr vaddr, const T data) {
  134. u8* page_pointer = current_page_table->pointers[vaddr >> PAGE_BITS];
  135. if (page_pointer) {
  136. // NOTE: Avoid adding any extra logic to this fast-path block
  137. std::memcpy(&page_pointer[vaddr & PAGE_MASK], &data, sizeof(T));
  138. return;
  139. }
  140. // The memory access might do an MMIO or cached access, so we have to lock the HLE kernel state
  141. std::lock_guard<std::recursive_mutex> lock(HLE::g_hle_lock);
  142. PageType type = current_page_table->attributes[vaddr >> PAGE_BITS];
  143. switch (type) {
  144. case PageType::Unmapped:
  145. LOG_ERROR(HW_Memory, "unmapped Write%lu 0x%08X @ 0x%08X", sizeof(data) * 8, (u32)data,
  146. vaddr);
  147. return;
  148. case PageType::Memory:
  149. ASSERT_MSG(false, "Mapped memory page without a pointer @ %08X", vaddr);
  150. break;
  151. case PageType::RasterizerCachedMemory: {
  152. RasterizerFlushVirtualRegion(vaddr, sizeof(T), FlushMode::FlushAndInvalidate);
  153. std::memcpy(GetPointerFromVMA(vaddr), &data, sizeof(T));
  154. break;
  155. }
  156. case PageType::Special:
  157. WriteMMIO<T>(GetMMIOHandler(vaddr), vaddr, data);
  158. break;
  159. case PageType::RasterizerCachedSpecial: {
  160. RasterizerFlushVirtualRegion(vaddr, sizeof(T), FlushMode::FlushAndInvalidate);
  161. WriteMMIO<T>(GetMMIOHandler(vaddr), vaddr, data);
  162. break;
  163. }
  164. default:
  165. UNREACHABLE();
  166. }
  167. }
  168. bool IsValidVirtualAddress(const VAddr vaddr) {
  169. const u8* page_pointer = current_page_table->pointers[vaddr >> PAGE_BITS];
  170. if (page_pointer)
  171. return true;
  172. if (current_page_table->attributes[vaddr >> PAGE_BITS] == PageType::RasterizerCachedMemory)
  173. return true;
  174. if (current_page_table->attributes[vaddr >> PAGE_BITS] != PageType::Special)
  175. return false;
  176. MMIORegionPointer mmio_region = GetMMIOHandler(vaddr);
  177. if (mmio_region) {
  178. return mmio_region->IsValidAddress(vaddr);
  179. }
  180. return false;
  181. }
  182. bool IsValidPhysicalAddress(const PAddr paddr) {
  183. return GetPhysicalPointer(paddr) != nullptr;
  184. }
  185. u8* GetPointer(const VAddr vaddr) {
  186. u8* page_pointer = current_page_table->pointers[vaddr >> PAGE_BITS];
  187. if (page_pointer) {
  188. return page_pointer + (vaddr & PAGE_MASK);
  189. }
  190. if (current_page_table->attributes[vaddr >> PAGE_BITS] == PageType::RasterizerCachedMemory) {
  191. return GetPointerFromVMA(vaddr);
  192. }
  193. LOG_ERROR(HW_Memory, "unknown GetPointer @ 0x%08x", vaddr);
  194. return nullptr;
  195. }
  196. std::string ReadCString(VAddr vaddr, std::size_t max_length) {
  197. std::string string;
  198. string.reserve(max_length);
  199. for (std::size_t i = 0; i < max_length; ++i) {
  200. char c = Read8(vaddr);
  201. if (c == '\0')
  202. break;
  203. string.push_back(c);
  204. ++vaddr;
  205. }
  206. string.shrink_to_fit();
  207. return string;
  208. }
  209. u8* GetPhysicalPointer(PAddr address) {
  210. struct MemoryArea {
  211. PAddr paddr_base;
  212. u32 size;
  213. };
  214. static constexpr MemoryArea memory_areas[] = {
  215. {VRAM_PADDR, VRAM_SIZE},
  216. {IO_AREA_PADDR, IO_AREA_SIZE},
  217. {DSP_RAM_PADDR, DSP_RAM_SIZE},
  218. {FCRAM_PADDR, FCRAM_N3DS_SIZE},
  219. {N3DS_EXTRA_RAM_PADDR, N3DS_EXTRA_RAM_SIZE},
  220. };
  221. const auto area =
  222. std::find_if(std::begin(memory_areas), std::end(memory_areas), [&](const auto& area) {
  223. return address >= area.paddr_base && address < area.paddr_base + area.size;
  224. });
  225. if (area == std::end(memory_areas)) {
  226. LOG_ERROR(HW_Memory, "unknown GetPhysicalPointer @ 0x%08X", address);
  227. return nullptr;
  228. }
  229. if (area->paddr_base == IO_AREA_PADDR) {
  230. LOG_ERROR(HW_Memory, "MMIO mappings are not supported yet. phys_addr=0x%08X", address);
  231. return nullptr;
  232. }
  233. u32 offset_into_region = address - area->paddr_base;
  234. u8* target_pointer = nullptr;
  235. switch (area->paddr_base) {
  236. case VRAM_PADDR:
  237. target_pointer = vram.data() + offset_into_region;
  238. break;
  239. case DSP_RAM_PADDR:
  240. target_pointer = AudioCore::GetDspMemory().data() + offset_into_region;
  241. break;
  242. case FCRAM_PADDR:
  243. for (const auto& region : Kernel::memory_regions) {
  244. if (offset_into_region >= region.base &&
  245. offset_into_region < region.base + region.size) {
  246. target_pointer =
  247. region.linear_heap_memory->data() + offset_into_region - region.base;
  248. break;
  249. }
  250. }
  251. ASSERT_MSG(target_pointer != nullptr, "Invalid FCRAM address");
  252. break;
  253. case N3DS_EXTRA_RAM_PADDR:
  254. target_pointer = n3ds_extra_ram.data() + offset_into_region;
  255. break;
  256. default:
  257. UNREACHABLE();
  258. }
  259. return target_pointer;
  260. }
  261. void RasterizerMarkRegionCached(PAddr start, u32 size, int count_delta) {
  262. if (start == 0) {
  263. return;
  264. }
  265. u32 num_pages = ((start + size - 1) >> PAGE_BITS) - (start >> PAGE_BITS) + 1;
  266. PAddr paddr = start;
  267. for (unsigned i = 0; i < num_pages; ++i, paddr += PAGE_SIZE) {
  268. boost::optional<VAddr> maybe_vaddr = PhysicalToVirtualAddress(paddr);
  269. if (!maybe_vaddr)
  270. continue;
  271. VAddr vaddr = *maybe_vaddr;
  272. u8& res_count = current_page_table->cached_res_count[vaddr >> PAGE_BITS];
  273. ASSERT_MSG(count_delta <= UINT8_MAX - res_count,
  274. "Rasterizer resource cache counter overflow!");
  275. ASSERT_MSG(count_delta >= -res_count, "Rasterizer resource cache counter underflow!");
  276. // Switch page type to cached if now cached
  277. if (res_count == 0) {
  278. PageType& page_type = current_page_table->attributes[vaddr >> PAGE_BITS];
  279. switch (page_type) {
  280. case PageType::Memory:
  281. page_type = PageType::RasterizerCachedMemory;
  282. current_page_table->pointers[vaddr >> PAGE_BITS] = nullptr;
  283. break;
  284. case PageType::Special:
  285. page_type = PageType::RasterizerCachedSpecial;
  286. break;
  287. default:
  288. UNREACHABLE();
  289. }
  290. }
  291. res_count += count_delta;
  292. // Switch page type to uncached if now uncached
  293. if (res_count == 0) {
  294. PageType& page_type = current_page_table->attributes[vaddr >> PAGE_BITS];
  295. switch (page_type) {
  296. case PageType::RasterizerCachedMemory: {
  297. u8* pointer = GetPointerFromVMA(vaddr & ~PAGE_MASK);
  298. if (pointer == nullptr) {
  299. // It's possible that this function has called been while updating the pagetable
  300. // after unmapping a VMA. In that case the underlying VMA will no longer exist,
  301. // and we should just leave the pagetable entry blank.
  302. page_type = PageType::Unmapped;
  303. } else {
  304. page_type = PageType::Memory;
  305. current_page_table->pointers[vaddr >> PAGE_BITS] = pointer;
  306. }
  307. break;
  308. }
  309. case PageType::RasterizerCachedSpecial:
  310. page_type = PageType::Special;
  311. break;
  312. default:
  313. UNREACHABLE();
  314. }
  315. }
  316. }
  317. }
  318. void RasterizerFlushRegion(PAddr start, u32 size) {
  319. if (VideoCore::g_renderer != nullptr) {
  320. VideoCore::g_renderer->Rasterizer()->FlushRegion(start, size);
  321. }
  322. }
  323. void RasterizerFlushAndInvalidateRegion(PAddr start, u32 size) {
  324. // Since pages are unmapped on shutdown after video core is shutdown, the renderer may be
  325. // null here
  326. if (VideoCore::g_renderer != nullptr) {
  327. VideoCore::g_renderer->Rasterizer()->FlushAndInvalidateRegion(start, size);
  328. }
  329. }
  330. void RasterizerFlushVirtualRegion(VAddr start, u32 size, FlushMode mode) {
  331. // Since pages are unmapped on shutdown after video core is shutdown, the renderer may be
  332. // null here
  333. if (VideoCore::g_renderer != nullptr) {
  334. VAddr end = start + size;
  335. auto CheckRegion = [&](VAddr region_start, VAddr region_end) {
  336. if (start >= region_end || end <= region_start) {
  337. // No overlap with region
  338. return;
  339. }
  340. VAddr overlap_start = std::max(start, region_start);
  341. VAddr overlap_end = std::min(end, region_end);
  342. PAddr physical_start = TryVirtualToPhysicalAddress(overlap_start).value();
  343. u32 overlap_size = overlap_end - overlap_start;
  344. auto* rasterizer = VideoCore::g_renderer->Rasterizer();
  345. switch (mode) {
  346. case FlushMode::Flush:
  347. rasterizer->FlushRegion(physical_start, overlap_size);
  348. break;
  349. case FlushMode::FlushAndInvalidate:
  350. rasterizer->FlushAndInvalidateRegion(physical_start, overlap_size);
  351. break;
  352. }
  353. };
  354. CheckRegion(LINEAR_HEAP_VADDR, LINEAR_HEAP_VADDR_END);
  355. CheckRegion(NEW_LINEAR_HEAP_VADDR, NEW_LINEAR_HEAP_VADDR_END);
  356. CheckRegion(VRAM_VADDR, VRAM_VADDR_END);
  357. }
  358. }
  359. u8 Read8(const VAddr addr) {
  360. return Read<u8>(addr);
  361. }
  362. u16 Read16(const VAddr addr) {
  363. return Read<u16_le>(addr);
  364. }
  365. u32 Read32(const VAddr addr) {
  366. return Read<u32_le>(addr);
  367. }
  368. u64 Read64(const VAddr addr) {
  369. return Read<u64_le>(addr);
  370. }
  371. void ReadBlock(const VAddr src_addr, void* dest_buffer, const size_t size) {
  372. size_t remaining_size = size;
  373. size_t page_index = src_addr >> PAGE_BITS;
  374. size_t page_offset = src_addr & PAGE_MASK;
  375. while (remaining_size > 0) {
  376. const size_t copy_amount = std::min(PAGE_SIZE - page_offset, remaining_size);
  377. const VAddr current_vaddr = (page_index << PAGE_BITS) + page_offset;
  378. switch (current_page_table->attributes[page_index]) {
  379. case PageType::Unmapped: {
  380. LOG_ERROR(HW_Memory, "unmapped ReadBlock @ 0x%08X (start address = 0x%08X, size = %zu)",
  381. current_vaddr, src_addr, size);
  382. std::memset(dest_buffer, 0, copy_amount);
  383. break;
  384. }
  385. case PageType::Memory: {
  386. DEBUG_ASSERT(current_page_table->pointers[page_index]);
  387. const u8* src_ptr = current_page_table->pointers[page_index] + page_offset;
  388. std::memcpy(dest_buffer, src_ptr, copy_amount);
  389. break;
  390. }
  391. case PageType::Special: {
  392. DEBUG_ASSERT(GetMMIOHandler(current_vaddr));
  393. GetMMIOHandler(current_vaddr)->ReadBlock(current_vaddr, dest_buffer, copy_amount);
  394. break;
  395. }
  396. case PageType::RasterizerCachedMemory: {
  397. RasterizerFlushVirtualRegion(current_vaddr, copy_amount, FlushMode::Flush);
  398. std::memcpy(dest_buffer, GetPointerFromVMA(current_vaddr), copy_amount);
  399. break;
  400. }
  401. case PageType::RasterizerCachedSpecial: {
  402. DEBUG_ASSERT(GetMMIOHandler(current_vaddr));
  403. RasterizerFlushVirtualRegion(current_vaddr, copy_amount, FlushMode::Flush);
  404. GetMMIOHandler(current_vaddr)->ReadBlock(current_vaddr, dest_buffer, copy_amount);
  405. break;
  406. }
  407. default:
  408. UNREACHABLE();
  409. }
  410. page_index++;
  411. page_offset = 0;
  412. dest_buffer = static_cast<u8*>(dest_buffer) + copy_amount;
  413. remaining_size -= copy_amount;
  414. }
  415. }
  416. void Write8(const VAddr addr, const u8 data) {
  417. Write<u8>(addr, data);
  418. }
  419. void Write16(const VAddr addr, const u16 data) {
  420. Write<u16_le>(addr, data);
  421. }
  422. void Write32(const VAddr addr, const u32 data) {
  423. Write<u32_le>(addr, data);
  424. }
  425. void Write64(const VAddr addr, const u64 data) {
  426. Write<u64_le>(addr, data);
  427. }
  428. void WriteBlock(const VAddr dest_addr, const void* src_buffer, const size_t size) {
  429. size_t remaining_size = size;
  430. size_t page_index = dest_addr >> PAGE_BITS;
  431. size_t page_offset = dest_addr & PAGE_MASK;
  432. while (remaining_size > 0) {
  433. const size_t copy_amount = std::min(PAGE_SIZE - page_offset, remaining_size);
  434. const VAddr current_vaddr = (page_index << PAGE_BITS) + page_offset;
  435. switch (current_page_table->attributes[page_index]) {
  436. case PageType::Unmapped: {
  437. LOG_ERROR(HW_Memory,
  438. "unmapped WriteBlock @ 0x%08X (start address = 0x%08X, size = %zu)",
  439. current_vaddr, dest_addr, size);
  440. break;
  441. }
  442. case PageType::Memory: {
  443. DEBUG_ASSERT(current_page_table->pointers[page_index]);
  444. u8* dest_ptr = current_page_table->pointers[page_index] + page_offset;
  445. std::memcpy(dest_ptr, src_buffer, copy_amount);
  446. break;
  447. }
  448. case PageType::Special: {
  449. DEBUG_ASSERT(GetMMIOHandler(current_vaddr));
  450. GetMMIOHandler(current_vaddr)->WriteBlock(current_vaddr, src_buffer, copy_amount);
  451. break;
  452. }
  453. case PageType::RasterizerCachedMemory: {
  454. RasterizerFlushVirtualRegion(current_vaddr, copy_amount, FlushMode::FlushAndInvalidate);
  455. std::memcpy(GetPointerFromVMA(current_vaddr), src_buffer, copy_amount);
  456. break;
  457. }
  458. case PageType::RasterizerCachedSpecial: {
  459. DEBUG_ASSERT(GetMMIOHandler(current_vaddr));
  460. RasterizerFlushVirtualRegion(current_vaddr, copy_amount, FlushMode::FlushAndInvalidate);
  461. GetMMIOHandler(current_vaddr)->WriteBlock(current_vaddr, src_buffer, copy_amount);
  462. break;
  463. }
  464. default:
  465. UNREACHABLE();
  466. }
  467. page_index++;
  468. page_offset = 0;
  469. src_buffer = static_cast<const u8*>(src_buffer) + copy_amount;
  470. remaining_size -= copy_amount;
  471. }
  472. }
  473. void ZeroBlock(const VAddr dest_addr, const size_t size) {
  474. size_t remaining_size = size;
  475. size_t page_index = dest_addr >> PAGE_BITS;
  476. size_t page_offset = dest_addr & PAGE_MASK;
  477. static const std::array<u8, PAGE_SIZE> zeros = {};
  478. while (remaining_size > 0) {
  479. const size_t copy_amount = std::min(PAGE_SIZE - page_offset, remaining_size);
  480. const VAddr current_vaddr = (page_index << PAGE_BITS) + page_offset;
  481. switch (current_page_table->attributes[page_index]) {
  482. case PageType::Unmapped: {
  483. LOG_ERROR(HW_Memory, "unmapped ZeroBlock @ 0x%08X (start address = 0x%08X, size = %zu)",
  484. current_vaddr, dest_addr, size);
  485. break;
  486. }
  487. case PageType::Memory: {
  488. DEBUG_ASSERT(current_page_table->pointers[page_index]);
  489. u8* dest_ptr = current_page_table->pointers[page_index] + page_offset;
  490. std::memset(dest_ptr, 0, copy_amount);
  491. break;
  492. }
  493. case PageType::Special: {
  494. DEBUG_ASSERT(GetMMIOHandler(current_vaddr));
  495. GetMMIOHandler(current_vaddr)->WriteBlock(current_vaddr, zeros.data(), copy_amount);
  496. break;
  497. }
  498. case PageType::RasterizerCachedMemory: {
  499. RasterizerFlushVirtualRegion(current_vaddr, copy_amount, FlushMode::FlushAndInvalidate);
  500. std::memset(GetPointerFromVMA(current_vaddr), 0, copy_amount);
  501. break;
  502. }
  503. case PageType::RasterizerCachedSpecial: {
  504. DEBUG_ASSERT(GetMMIOHandler(current_vaddr));
  505. RasterizerFlushVirtualRegion(current_vaddr, copy_amount, FlushMode::FlushAndInvalidate);
  506. GetMMIOHandler(current_vaddr)->WriteBlock(current_vaddr, zeros.data(), copy_amount);
  507. break;
  508. }
  509. default:
  510. UNREACHABLE();
  511. }
  512. page_index++;
  513. page_offset = 0;
  514. remaining_size -= copy_amount;
  515. }
  516. }
  517. void CopyBlock(VAddr dest_addr, VAddr src_addr, const size_t size) {
  518. size_t remaining_size = size;
  519. size_t page_index = src_addr >> PAGE_BITS;
  520. size_t page_offset = src_addr & PAGE_MASK;
  521. while (remaining_size > 0) {
  522. const size_t copy_amount = std::min(PAGE_SIZE - page_offset, remaining_size);
  523. const VAddr current_vaddr = (page_index << PAGE_BITS) + page_offset;
  524. switch (current_page_table->attributes[page_index]) {
  525. case PageType::Unmapped: {
  526. LOG_ERROR(HW_Memory, "unmapped CopyBlock @ 0x%08X (start address = 0x%08X, size = %zu)",
  527. current_vaddr, src_addr, size);
  528. ZeroBlock(dest_addr, copy_amount);
  529. break;
  530. }
  531. case PageType::Memory: {
  532. DEBUG_ASSERT(current_page_table->pointers[page_index]);
  533. const u8* src_ptr = current_page_table->pointers[page_index] + page_offset;
  534. WriteBlock(dest_addr, src_ptr, copy_amount);
  535. break;
  536. }
  537. case PageType::Special: {
  538. DEBUG_ASSERT(GetMMIOHandler(current_vaddr));
  539. std::vector<u8> buffer(copy_amount);
  540. GetMMIOHandler(current_vaddr)->ReadBlock(current_vaddr, buffer.data(), buffer.size());
  541. WriteBlock(dest_addr, buffer.data(), buffer.size());
  542. break;
  543. }
  544. case PageType::RasterizerCachedMemory: {
  545. RasterizerFlushVirtualRegion(current_vaddr, copy_amount, FlushMode::Flush);
  546. WriteBlock(dest_addr, GetPointerFromVMA(current_vaddr), copy_amount);
  547. break;
  548. }
  549. case PageType::RasterizerCachedSpecial: {
  550. DEBUG_ASSERT(GetMMIOHandler(current_vaddr));
  551. RasterizerFlushVirtualRegion(current_vaddr, copy_amount, FlushMode::Flush);
  552. std::vector<u8> buffer(copy_amount);
  553. GetMMIOHandler(current_vaddr)->ReadBlock(current_vaddr, buffer.data(), buffer.size());
  554. WriteBlock(dest_addr, buffer.data(), buffer.size());
  555. break;
  556. }
  557. default:
  558. UNREACHABLE();
  559. }
  560. page_index++;
  561. page_offset = 0;
  562. dest_addr += copy_amount;
  563. src_addr += copy_amount;
  564. remaining_size -= copy_amount;
  565. }
  566. }
  567. template <>
  568. u8 ReadMMIO<u8>(MMIORegionPointer mmio_handler, VAddr addr) {
  569. return mmio_handler->Read8(addr);
  570. }
  571. template <>
  572. u16 ReadMMIO<u16>(MMIORegionPointer mmio_handler, VAddr addr) {
  573. return mmio_handler->Read16(addr);
  574. }
  575. template <>
  576. u32 ReadMMIO<u32>(MMIORegionPointer mmio_handler, VAddr addr) {
  577. return mmio_handler->Read32(addr);
  578. }
  579. template <>
  580. u64 ReadMMIO<u64>(MMIORegionPointer mmio_handler, VAddr addr) {
  581. return mmio_handler->Read64(addr);
  582. }
  583. template <>
  584. void WriteMMIO<u8>(MMIORegionPointer mmio_handler, VAddr addr, const u8 data) {
  585. mmio_handler->Write8(addr, data);
  586. }
  587. template <>
  588. void WriteMMIO<u16>(MMIORegionPointer mmio_handler, VAddr addr, const u16 data) {
  589. mmio_handler->Write16(addr, data);
  590. }
  591. template <>
  592. void WriteMMIO<u32>(MMIORegionPointer mmio_handler, VAddr addr, const u32 data) {
  593. mmio_handler->Write32(addr, data);
  594. }
  595. template <>
  596. void WriteMMIO<u64>(MMIORegionPointer mmio_handler, VAddr addr, const u64 data) {
  597. mmio_handler->Write64(addr, data);
  598. }
  599. boost::optional<PAddr> TryVirtualToPhysicalAddress(const VAddr addr) {
  600. if (addr == 0) {
  601. return 0;
  602. } else if (addr >= VRAM_VADDR && addr < VRAM_VADDR_END) {
  603. return addr - VRAM_VADDR + VRAM_PADDR;
  604. } else if (addr >= LINEAR_HEAP_VADDR && addr < LINEAR_HEAP_VADDR_END) {
  605. return addr - LINEAR_HEAP_VADDR + FCRAM_PADDR;
  606. } else if (addr >= NEW_LINEAR_HEAP_VADDR && addr < NEW_LINEAR_HEAP_VADDR_END) {
  607. return addr - NEW_LINEAR_HEAP_VADDR + FCRAM_PADDR;
  608. } else if (addr >= DSP_RAM_VADDR && addr < DSP_RAM_VADDR_END) {
  609. return addr - DSP_RAM_VADDR + DSP_RAM_PADDR;
  610. } else if (addr >= IO_AREA_VADDR && addr < IO_AREA_VADDR_END) {
  611. return addr - IO_AREA_VADDR + IO_AREA_PADDR;
  612. } else if (addr >= N3DS_EXTRA_RAM_VADDR && addr < N3DS_EXTRA_RAM_VADDR_END) {
  613. return addr - N3DS_EXTRA_RAM_VADDR + N3DS_EXTRA_RAM_PADDR;
  614. }
  615. return boost::none;
  616. }
  617. PAddr VirtualToPhysicalAddress(const VAddr addr) {
  618. auto paddr = TryVirtualToPhysicalAddress(addr);
  619. if (!paddr) {
  620. LOG_ERROR(HW_Memory, "Unknown virtual address @ 0x%08X", addr);
  621. // To help with debugging, set bit on address so that it's obviously invalid.
  622. return addr | 0x80000000;
  623. }
  624. return *paddr;
  625. }
  626. boost::optional<VAddr> PhysicalToVirtualAddress(const PAddr addr) {
  627. if (addr == 0) {
  628. return 0;
  629. } else if (addr >= VRAM_PADDR && addr < VRAM_PADDR_END) {
  630. return addr - VRAM_PADDR + VRAM_VADDR;
  631. } else if (addr >= FCRAM_PADDR && addr < FCRAM_PADDR_END) {
  632. return addr - FCRAM_PADDR + Kernel::g_current_process->GetLinearHeapAreaAddress();
  633. } else if (addr >= DSP_RAM_PADDR && addr < DSP_RAM_PADDR_END) {
  634. return addr - DSP_RAM_PADDR + DSP_RAM_VADDR;
  635. } else if (addr >= IO_AREA_PADDR && addr < IO_AREA_PADDR_END) {
  636. return addr - IO_AREA_PADDR + IO_AREA_VADDR;
  637. } else if (addr >= N3DS_EXTRA_RAM_PADDR && addr < N3DS_EXTRA_RAM_PADDR_END) {
  638. return addr - N3DS_EXTRA_RAM_PADDR + N3DS_EXTRA_RAM_VADDR;
  639. }
  640. return boost::none;
  641. }
  642. } // namespace Memory