gsp_gpu.cpp 27 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683
  1. // Copyright 2014 Citra Emulator Project
  2. // Licensed under GPLv2 or any later version
  3. // Refer to the license.txt file included.
  4. #include "common/bit_field.h"
  5. #include "common/microprofile.h"
  6. #include "core/memory.h"
  7. #include "core/hle/kernel/event.h"
  8. #include "core/hle/kernel/shared_memory.h"
  9. #include "core/hle/result.h"
  10. #include "core/hw/hw.h"
  11. #include "core/hw/gpu.h"
  12. #include "core/hw/lcd.h"
  13. #include "video_core/gpu_debugger.h"
  14. #include "video_core/debug_utils/debug_utils.h"
  15. #include "video_core/renderer_base.h"
  16. #include "video_core/video_core.h"
  17. #include "gsp_gpu.h"
  18. // Main graphics debugger object - TODO: Here is probably not the best place for this
  19. GraphicsDebugger g_debugger;
  20. // Beginning address of HW regs
  21. const static u32 REGS_BEGIN = 0x1EB00000;
  22. ////////////////////////////////////////////////////////////////////////////////////////////////////
  23. // Namespace GSP_GPU
  24. namespace GSP_GPU {
  25. const ResultCode ERR_GSP_REGS_OUTOFRANGE_OR_MISALIGNED(ErrorDescription::OutofRangeOrMisalignedAddress, ErrorModule::GX,
  26. ErrorSummary::InvalidArgument, ErrorLevel::Usage); // 0xE0E02A01
  27. const ResultCode ERR_GSP_REGS_MISALIGNED(ErrorDescription::MisalignedSize, ErrorModule::GX,
  28. ErrorSummary::InvalidArgument, ErrorLevel::Usage); // 0xE0E02BF2
  29. const ResultCode ERR_GSP_REGS_INVALID_SIZE(ErrorDescription::InvalidSize, ErrorModule::GX,
  30. ErrorSummary::InvalidArgument, ErrorLevel::Usage); // 0xE0E02BEC
  31. /// Event triggered when GSP interrupt has been signalled
  32. Kernel::SharedPtr<Kernel::Event> g_interrupt_event;
  33. /// GSP shared memoryings
  34. Kernel::SharedPtr<Kernel::SharedMemory> g_shared_memory;
  35. /// Thread index into interrupt relay queue
  36. u32 g_thread_id = 0;
  37. /// Gets a pointer to a thread command buffer in GSP shared memory
  38. static inline u8* GetCommandBuffer(u32 thread_id) {
  39. return g_shared_memory->GetPointer(0x800 + (thread_id * sizeof(CommandBuffer)));
  40. }
  41. FrameBufferUpdate* GetFrameBufferInfo(u32 thread_id, u32 screen_index) {
  42. DEBUG_ASSERT_MSG(screen_index < 2, "Invalid screen index");
  43. // For each thread there are two FrameBufferUpdate fields
  44. u32 offset = 0x200 + (2 * thread_id + screen_index) * sizeof(FrameBufferUpdate);
  45. u8* ptr = g_shared_memory->GetPointer(offset);
  46. return reinterpret_cast<FrameBufferUpdate*>(ptr);
  47. }
  48. /// Gets a pointer to the interrupt relay queue for a given thread index
  49. static inline InterruptRelayQueue* GetInterruptRelayQueue(u32 thread_id) {
  50. u8* ptr = g_shared_memory->GetPointer(sizeof(InterruptRelayQueue) * thread_id);
  51. return reinterpret_cast<InterruptRelayQueue*>(ptr);
  52. }
  53. /**
  54. * Writes sequential GSP GPU hardware registers using an array of source data
  55. *
  56. * @param base_address The address of the first register in the sequence
  57. * @param size_in_bytes The number of registers to update (size of data)
  58. * @param data A pointer to the source data
  59. * @return RESULT_SUCCESS if the parameters are valid, error code otherwise
  60. */
  61. static ResultCode WriteHWRegs(u32 base_address, u32 size_in_bytes, const u32* data) {
  62. // This magic number is verified to be done by the gsp module
  63. const u32 max_size_in_bytes = 0x80;
  64. if (base_address & 3 || base_address >= 0x420000) {
  65. LOG_ERROR(Service_GSP, "Write address was out of range or misaligned! (address=0x%08x, size=0x%08x)",
  66. base_address, size_in_bytes);
  67. return ERR_GSP_REGS_OUTOFRANGE_OR_MISALIGNED;
  68. } else if (size_in_bytes <= max_size_in_bytes) {
  69. if (size_in_bytes & 3) {
  70. LOG_ERROR(Service_GSP, "Misaligned size 0x%08x", size_in_bytes);
  71. return ERR_GSP_REGS_MISALIGNED;
  72. } else {
  73. while (size_in_bytes > 0) {
  74. HW::Write<u32>(base_address + REGS_BEGIN, *data);
  75. size_in_bytes -= 4;
  76. ++data;
  77. base_address += 4;
  78. }
  79. return RESULT_SUCCESS;
  80. }
  81. } else {
  82. LOG_ERROR(Service_GSP, "Out of range size 0x%08x", size_in_bytes);
  83. return ERR_GSP_REGS_INVALID_SIZE;
  84. }
  85. }
  86. /**
  87. * Updates sequential GSP GPU hardware registers using parallel arrays of source data and masks.
  88. * For each register, the value is updated only where the mask is high
  89. *
  90. * @param base_address The address of the first register in the sequence
  91. * @param size_in_bytes The number of registers to update (size of data)
  92. * @param data A pointer to the source data to use for updates
  93. * @param masks A pointer to the masks
  94. * @return RESULT_SUCCESS if the parameters are valid, error code otherwise
  95. */
  96. static ResultCode WriteHWRegsWithMask(u32 base_address, u32 size_in_bytes, const u32* data, const u32* masks) {
  97. // This magic number is verified to be done by the gsp module
  98. const u32 max_size_in_bytes = 0x80;
  99. if (base_address & 3 || base_address >= 0x420000) {
  100. LOG_ERROR(Service_GSP, "Write address was out of range or misaligned! (address=0x%08x, size=0x%08x)",
  101. base_address, size_in_bytes);
  102. return ERR_GSP_REGS_OUTOFRANGE_OR_MISALIGNED;
  103. } else if (size_in_bytes <= max_size_in_bytes) {
  104. if (size_in_bytes & 3) {
  105. LOG_ERROR(Service_GSP, "Misaligned size 0x%08x", size_in_bytes);
  106. return ERR_GSP_REGS_MISALIGNED;
  107. } else {
  108. while (size_in_bytes > 0) {
  109. const u32 reg_address = base_address + REGS_BEGIN;
  110. u32 reg_value;
  111. HW::Read<u32>(reg_value, reg_address);
  112. // Update the current value of the register only for set mask bits
  113. reg_value = (reg_value & ~*masks) | (*data | *masks);
  114. HW::Write<u32>(reg_address, reg_value);
  115. size_in_bytes -= 4;
  116. ++data;
  117. ++masks;
  118. base_address += 4;
  119. }
  120. return RESULT_SUCCESS;
  121. }
  122. } else {
  123. LOG_ERROR(Service_GSP, "Out of range size 0x%08x", size_in_bytes);
  124. return ERR_GSP_REGS_INVALID_SIZE;
  125. }
  126. }
  127. /**
  128. * GSP_GPU::WriteHWRegs service function
  129. *
  130. * Writes sequential GSP GPU hardware registers
  131. *
  132. * Inputs:
  133. * 1 : address of first GPU register
  134. * 2 : number of registers to write sequentially
  135. * 4 : pointer to source data array
  136. */
  137. static void WriteHWRegs(Service::Interface* self) {
  138. u32* cmd_buff = Kernel::GetCommandBuffer();
  139. u32 reg_addr = cmd_buff[1];
  140. u32 size = cmd_buff[2];
  141. u32* src = (u32*)Memory::GetPointer(cmd_buff[4]);
  142. cmd_buff[1] = WriteHWRegs(reg_addr, size, src).raw;
  143. }
  144. /**
  145. * GSP_GPU::WriteHWRegsWithMask service function
  146. *
  147. * Updates sequential GSP GPU hardware registers using masks
  148. *
  149. * Inputs:
  150. * 1 : address of first GPU register
  151. * 2 : number of registers to update sequentially
  152. * 4 : pointer to source data array
  153. * 6 : pointer to mask array
  154. */
  155. static void WriteHWRegsWithMask(Service::Interface* self) {
  156. u32* cmd_buff = Kernel::GetCommandBuffer();
  157. u32 reg_addr = cmd_buff[1];
  158. u32 size = cmd_buff[2];
  159. u32* src_data = (u32*)Memory::GetPointer(cmd_buff[4]);
  160. u32* mask_data = (u32*)Memory::GetPointer(cmd_buff[6]);
  161. cmd_buff[1] = WriteHWRegsWithMask(reg_addr, size, src_data, mask_data).raw;
  162. }
  163. /// Read a GSP GPU hardware register
  164. static void ReadHWRegs(Service::Interface* self) {
  165. u32* cmd_buff = Kernel::GetCommandBuffer();
  166. u32 reg_addr = cmd_buff[1];
  167. u32 size = cmd_buff[2];
  168. // TODO: Return proper error codes
  169. if (reg_addr + size >= 0x420000) {
  170. LOG_ERROR(Service_GSP, "Read address out of range! (address=0x%08x, size=0x%08x)", reg_addr, size);
  171. return;
  172. }
  173. // size should be word-aligned
  174. if ((size % 4) != 0) {
  175. LOG_ERROR(Service_GSP, "Invalid size 0x%08x", size);
  176. return;
  177. }
  178. u32* dst = (u32*)Memory::GetPointer(cmd_buff[0x41]);
  179. while (size > 0) {
  180. HW::Read<u32>(*dst, reg_addr + REGS_BEGIN);
  181. size -= 4;
  182. ++dst;
  183. reg_addr += 4;
  184. }
  185. }
  186. ResultCode SetBufferSwap(u32 screen_id, const FrameBufferInfo& info) {
  187. u32 base_address = 0x400000;
  188. PAddr phys_address_left = Memory::VirtualToPhysicalAddress(info.address_left);
  189. PAddr phys_address_right = Memory::VirtualToPhysicalAddress(info.address_right);
  190. if (info.active_fb == 0) {
  191. WriteHWRegs(base_address + 4 * static_cast<u32>(GPU_REG_INDEX(framebuffer_config[screen_id].address_left1)),
  192. 4, &phys_address_left);
  193. WriteHWRegs(base_address + 4 * static_cast<u32>(GPU_REG_INDEX(framebuffer_config[screen_id].address_right1)),
  194. 4, &phys_address_right);
  195. } else {
  196. WriteHWRegs(base_address + 4 * static_cast<u32>(GPU_REG_INDEX(framebuffer_config[screen_id].address_left2)),
  197. 4, &phys_address_left);
  198. WriteHWRegs(base_address + 4 * static_cast<u32>(GPU_REG_INDEX(framebuffer_config[screen_id].address_right2)),
  199. 4, &phys_address_right);
  200. }
  201. WriteHWRegs(base_address + 4 * static_cast<u32>(GPU_REG_INDEX(framebuffer_config[screen_id].stride)),
  202. 4, &info.stride);
  203. WriteHWRegs(base_address + 4 * static_cast<u32>(GPU_REG_INDEX(framebuffer_config[screen_id].color_format)),
  204. 4, &info.format);
  205. WriteHWRegs(base_address + 4 * static_cast<u32>(GPU_REG_INDEX(framebuffer_config[screen_id].active_fb)),
  206. 4, &info.shown_fb);
  207. if (Pica::g_debug_context)
  208. Pica::g_debug_context->OnEvent(Pica::DebugContext::Event::BufferSwapped, nullptr);
  209. if (screen_id == 0) {
  210. MicroProfileFlip();
  211. }
  212. return RESULT_SUCCESS;
  213. }
  214. /**
  215. * GSP_GPU::SetBufferSwap service function
  216. *
  217. * Updates GPU display framebuffer configuration using the specified parameters.
  218. *
  219. * Inputs:
  220. * 1 : Screen ID (0 = top screen, 1 = bottom screen)
  221. * 2-7 : FrameBufferInfo structure
  222. * Outputs:
  223. * 1: Result code
  224. */
  225. static void SetBufferSwap(Service::Interface* self) {
  226. u32* cmd_buff = Kernel::GetCommandBuffer();
  227. u32 screen_id = cmd_buff[1];
  228. FrameBufferInfo* fb_info = (FrameBufferInfo*)&cmd_buff[2];
  229. cmd_buff[1] = SetBufferSwap(screen_id, *fb_info).raw;
  230. }
  231. /**
  232. * GSP_GPU::FlushDataCache service function
  233. *
  234. * This Function is a no-op, We aren't emulating the CPU cache any time soon.
  235. *
  236. * Inputs:
  237. * 1 : Address
  238. * 2 : Size
  239. * 3 : Value 0, some descriptor for the KProcess Handle
  240. * 4 : KProcess handle
  241. * Outputs:
  242. * 1 : Result of function, 0 on success, otherwise error code
  243. */
  244. static void FlushDataCache(Service::Interface* self) {
  245. u32* cmd_buff = Kernel::GetCommandBuffer();
  246. u32 address = cmd_buff[1];
  247. u32 size = cmd_buff[2];
  248. u32 process = cmd_buff[4];
  249. VideoCore::g_renderer->Rasterizer()->InvalidateRegion(Memory::VirtualToPhysicalAddress(address), size);
  250. // TODO(purpasmart96): Verify return header on HW
  251. cmd_buff[1] = RESULT_SUCCESS.raw; // No error
  252. LOG_DEBUG(Service_GSP, "(STUBBED) called address=0x%08X, size=0x%08X, process=0x%08X",
  253. address, size, process);
  254. }
  255. /**
  256. * GSP_GPU::SetAxiConfigQoSMode service function
  257. * Inputs:
  258. * 1 : Mode, unused in emulator
  259. * Outputs:
  260. * 1 : Result of function, 0 on success, otherwise error code
  261. */
  262. static void SetAxiConfigQoSMode(Service::Interface* self) {
  263. u32* cmd_buff = Kernel::GetCommandBuffer();
  264. u32 mode = cmd_buff[1];
  265. cmd_buff[1] = RESULT_SUCCESS.raw; // No error
  266. LOG_WARNING(Service_GSP, "(STUBBED) called mode=0x%08X", mode);
  267. }
  268. /**
  269. * GSP_GPU::RegisterInterruptRelayQueue service function
  270. * Inputs:
  271. * 1 : "Flags" field, purpose is unknown
  272. * 3 : Handle to GSP synchronization event
  273. * Outputs:
  274. * 1 : Result of function, 0x2A07 on success, otherwise error code
  275. * 2 : Thread index into GSP command buffer
  276. * 4 : Handle to GSP shared memory
  277. */
  278. static void RegisterInterruptRelayQueue(Service::Interface* self) {
  279. u32* cmd_buff = Kernel::GetCommandBuffer();
  280. u32 flags = cmd_buff[1];
  281. g_interrupt_event = Kernel::g_handle_table.Get<Kernel::Event>(cmd_buff[3]);
  282. ASSERT_MSG((g_interrupt_event != nullptr), "handle is not valid!");
  283. g_interrupt_event->name = "GSP_GPU::interrupt_event";
  284. using Kernel::MemoryPermission;
  285. g_shared_memory = Kernel::SharedMemory::Create(0x1000, MemoryPermission::ReadWrite,
  286. MemoryPermission::ReadWrite, "GSPSharedMem");
  287. Handle shmem_handle = Kernel::g_handle_table.Create(g_shared_memory).MoveFrom();
  288. // This specific code is required for a successful initialization, rather than 0
  289. cmd_buff[1] = ResultCode((ErrorDescription)519, ErrorModule::GX,
  290. ErrorSummary::Success, ErrorLevel::Success).raw;
  291. cmd_buff[2] = g_thread_id++; // Thread ID
  292. cmd_buff[4] = shmem_handle; // GSP shared memory
  293. g_interrupt_event->Signal(); // TODO(bunnei): Is this correct?
  294. }
  295. /**
  296. * GSP_GPU::UnregisterInterruptRelayQueue service function
  297. * Outputs:
  298. * 1 : Result of function, 0 on success, otherwise error code
  299. */
  300. static void UnregisterInterruptRelayQueue(Service::Interface* self) {
  301. u32* cmd_buff = Kernel::GetCommandBuffer();
  302. g_shared_memory = nullptr;
  303. g_interrupt_event = nullptr;
  304. cmd_buff[1] = RESULT_SUCCESS.raw;
  305. LOG_WARNING(Service_GSP, "called");
  306. }
  307. /**
  308. * Signals that the specified interrupt type has occurred to userland code
  309. * @param interrupt_id ID of interrupt that is being signalled
  310. * @todo This should probably take a thread_id parameter and only signal this thread?
  311. * @todo This probably does not belong in the GSP module, instead move to video_core
  312. */
  313. void SignalInterrupt(InterruptId interrupt_id) {
  314. if (nullptr == g_interrupt_event) {
  315. LOG_WARNING(Service_GSP, "cannot synchronize until GSP event has been created!");
  316. return;
  317. }
  318. if (nullptr == g_shared_memory) {
  319. LOG_WARNING(Service_GSP, "cannot synchronize until GSP shared memory has been created!");
  320. return;
  321. }
  322. for (int thread_id = 0; thread_id < 0x4; ++thread_id) {
  323. InterruptRelayQueue* interrupt_relay_queue = GetInterruptRelayQueue(thread_id);
  324. u8 next = interrupt_relay_queue->index;
  325. next += interrupt_relay_queue->number_interrupts;
  326. next = next % 0x34; // 0x34 is the number of interrupt slots
  327. interrupt_relay_queue->number_interrupts += 1;
  328. interrupt_relay_queue->slot[next] = interrupt_id;
  329. interrupt_relay_queue->error_code = 0x0; // No error
  330. // Update framebuffer information if requested
  331. // TODO(yuriks): Confirm where this code should be called. It is definitely updated without
  332. // executing any GSP commands, only waiting on the event.
  333. int screen_id = (interrupt_id == InterruptId::PDC0) ? 0 : (interrupt_id == InterruptId::PDC1) ? 1 : -1;
  334. if (screen_id != -1) {
  335. FrameBufferUpdate* info = GetFrameBufferInfo(thread_id, screen_id);
  336. if (info->is_dirty) {
  337. SetBufferSwap(screen_id, info->framebuffer_info[info->index]);
  338. info->is_dirty.Assign(false);
  339. }
  340. }
  341. }
  342. g_interrupt_event->Signal();
  343. }
  344. /// Executes the next GSP command
  345. static void ExecuteCommand(const Command& command, u32 thread_id) {
  346. // Utility function to convert register ID to address
  347. static auto WriteGPURegister = [](u32 id, u32 data) {
  348. GPU::Write<u32>(0x1EF00000 + 4 * id, data);
  349. };
  350. switch (command.id) {
  351. // GX request DMA - typically used for copying memory from GSP heap to VRAM
  352. case CommandId::REQUEST_DMA:
  353. VideoCore::g_renderer->Rasterizer()->FlushRegion(Memory::VirtualToPhysicalAddress(command.dma_request.source_address),
  354. command.dma_request.size);
  355. memcpy(Memory::GetPointer(command.dma_request.dest_address),
  356. Memory::GetPointer(command.dma_request.source_address),
  357. command.dma_request.size);
  358. SignalInterrupt(InterruptId::DMA);
  359. VideoCore::g_renderer->Rasterizer()->InvalidateRegion(Memory::VirtualToPhysicalAddress(command.dma_request.dest_address),
  360. command.dma_request.size);
  361. break;
  362. // TODO: This will need some rework in the future. (why?)
  363. case CommandId::SUBMIT_GPU_CMDLIST:
  364. {
  365. auto& params = command.submit_gpu_cmdlist;
  366. if (params.do_flush) {
  367. // This flag flushes the command list (params.address, params.size) from the cache.
  368. // Command lists are not processed by the hardware renderer, so we don't need to
  369. // actually flush them in Citra.
  370. }
  371. WriteGPURegister(static_cast<u32>(GPU_REG_INDEX(command_processor_config.address)),
  372. Memory::VirtualToPhysicalAddress(params.address) >> 3);
  373. WriteGPURegister(static_cast<u32>(GPU_REG_INDEX(command_processor_config.size)), params.size);
  374. // TODO: Not sure if we are supposed to always write this .. seems to trigger processing though
  375. WriteGPURegister(static_cast<u32>(GPU_REG_INDEX(command_processor_config.trigger)), 1);
  376. // TODO(yuriks): Figure out the meaning of the `flags` field.
  377. break;
  378. }
  379. // It's assumed that the two "blocks" behave equivalently.
  380. // Presumably this is done simply to allow two memory fills to run in parallel.
  381. case CommandId::SET_MEMORY_FILL:
  382. {
  383. auto& params = command.memory_fill;
  384. if (params.start1 != 0) {
  385. WriteGPURegister(static_cast<u32>(GPU_REG_INDEX(memory_fill_config[0].address_start)),
  386. Memory::VirtualToPhysicalAddress(params.start1) >> 3);
  387. WriteGPURegister(static_cast<u32>(GPU_REG_INDEX(memory_fill_config[0].address_end)),
  388. Memory::VirtualToPhysicalAddress(params.end1) >> 3);
  389. WriteGPURegister(static_cast<u32>(GPU_REG_INDEX(memory_fill_config[0].value_32bit)), params.value1);
  390. WriteGPURegister(static_cast<u32>(GPU_REG_INDEX(memory_fill_config[0].control)), params.control1);
  391. }
  392. if (params.start2 != 0) {
  393. WriteGPURegister(static_cast<u32>(GPU_REG_INDEX(memory_fill_config[1].address_start)),
  394. Memory::VirtualToPhysicalAddress(params.start2) >> 3);
  395. WriteGPURegister(static_cast<u32>(GPU_REG_INDEX(memory_fill_config[1].address_end)),
  396. Memory::VirtualToPhysicalAddress(params.end2) >> 3);
  397. WriteGPURegister(static_cast<u32>(GPU_REG_INDEX(memory_fill_config[1].value_32bit)), params.value2);
  398. WriteGPURegister(static_cast<u32>(GPU_REG_INDEX(memory_fill_config[1].control)), params.control2);
  399. }
  400. break;
  401. }
  402. case CommandId::SET_DISPLAY_TRANSFER:
  403. {
  404. auto& params = command.display_transfer;
  405. WriteGPURegister(static_cast<u32>(GPU_REG_INDEX(display_transfer_config.input_address)),
  406. Memory::VirtualToPhysicalAddress(params.in_buffer_address) >> 3);
  407. WriteGPURegister(static_cast<u32>(GPU_REG_INDEX(display_transfer_config.output_address)),
  408. Memory::VirtualToPhysicalAddress(params.out_buffer_address) >> 3);
  409. WriteGPURegister(static_cast<u32>(GPU_REG_INDEX(display_transfer_config.input_size)), params.in_buffer_size);
  410. WriteGPURegister(static_cast<u32>(GPU_REG_INDEX(display_transfer_config.output_size)), params.out_buffer_size);
  411. WriteGPURegister(static_cast<u32>(GPU_REG_INDEX(display_transfer_config.flags)), params.flags);
  412. WriteGPURegister(static_cast<u32>(GPU_REG_INDEX(display_transfer_config.trigger)), 1);
  413. break;
  414. }
  415. case CommandId::SET_TEXTURE_COPY:
  416. {
  417. auto& params = command.texture_copy;
  418. WriteGPURegister((u32)GPU_REG_INDEX(display_transfer_config.input_address),
  419. Memory::VirtualToPhysicalAddress(params.in_buffer_address) >> 3);
  420. WriteGPURegister((u32)GPU_REG_INDEX(display_transfer_config.output_address),
  421. Memory::VirtualToPhysicalAddress(params.out_buffer_address) >> 3);
  422. WriteGPURegister((u32)GPU_REG_INDEX(display_transfer_config.texture_copy.size),
  423. params.size);
  424. WriteGPURegister((u32)GPU_REG_INDEX(display_transfer_config.texture_copy.input_size),
  425. params.in_width_gap);
  426. WriteGPURegister((u32)GPU_REG_INDEX(display_transfer_config.texture_copy.output_size),
  427. params.out_width_gap);
  428. WriteGPURegister((u32)GPU_REG_INDEX(display_transfer_config.flags),
  429. params.flags);
  430. // NOTE: Actual GSP ORs 1 with current register instead of overwriting. Doesn't seem to matter.
  431. WriteGPURegister((u32)GPU_REG_INDEX(display_transfer_config.trigger), 1);
  432. break;
  433. }
  434. case CommandId::CACHE_FLUSH:
  435. {
  436. for (auto& region : command.cache_flush.regions) {
  437. if (region.size == 0)
  438. break;
  439. VideoCore::g_renderer->Rasterizer()->InvalidateRegion(
  440. Memory::VirtualToPhysicalAddress(region.address), region.size);
  441. }
  442. break;
  443. }
  444. default:
  445. LOG_ERROR(Service_GSP, "unknown command 0x%08X", (int)command.id.Value());
  446. }
  447. if (Pica::g_debug_context)
  448. Pica::g_debug_context->OnEvent(Pica::DebugContext::Event::GSPCommandProcessed, (void*)&command);
  449. }
  450. /**
  451. * GSP_GPU::SetLcdForceBlack service function
  452. *
  453. * Enable or disable REG_LCDCOLORFILL with the color black.
  454. *
  455. * Inputs:
  456. * 1: Black color fill flag (0 = don't fill, !0 = fill)
  457. * Outputs:
  458. * 1: Result code
  459. */
  460. static void SetLcdForceBlack(Service::Interface* self) {
  461. u32* cmd_buff = Kernel::GetCommandBuffer();
  462. bool enable_black = cmd_buff[1] != 0;
  463. LCD::Regs::ColorFill data = {0};
  464. // Since data is already zeroed, there is no need to explicitly set
  465. // the color to black (all zero).
  466. data.is_enabled.Assign(enable_black);
  467. LCD::Write(HW::VADDR_LCD + 4 * LCD_REG_INDEX(color_fill_top), data.raw); // Top LCD
  468. LCD::Write(HW::VADDR_LCD + 4 * LCD_REG_INDEX(color_fill_bottom), data.raw); // Bottom LCD
  469. cmd_buff[1] = RESULT_SUCCESS.raw;
  470. }
  471. /// This triggers handling of the GX command written to the command buffer in shared memory.
  472. static void TriggerCmdReqQueue(Service::Interface* self) {
  473. // Iterate through each thread's command queue...
  474. for (unsigned thread_id = 0; thread_id < 0x4; ++thread_id) {
  475. CommandBuffer* command_buffer = (CommandBuffer*)GetCommandBuffer(thread_id);
  476. // Iterate through each command...
  477. for (unsigned i = 0; i < command_buffer->number_commands; ++i) {
  478. g_debugger.GXCommandProcessed((u8*)&command_buffer->commands[i]);
  479. // Decode and execute command
  480. ExecuteCommand(command_buffer->commands[i], thread_id);
  481. // Indicates that command has completed
  482. command_buffer->number_commands.Assign(command_buffer->number_commands - 1);
  483. }
  484. }
  485. u32* cmd_buff = Kernel::GetCommandBuffer();
  486. cmd_buff[1] = 0; // No error
  487. }
  488. /**
  489. * GSP_GPU::ImportDisplayCaptureInfo service function
  490. *
  491. * Returns information about the current framebuffer state
  492. *
  493. * Inputs:
  494. * 0: Header 0x00180000
  495. * Outputs:
  496. * 1: Result code
  497. * 2: Left framebuffer virtual address for the main screen
  498. * 3: Right framebuffer virtual address for the main screen
  499. * 4: Main screen framebuffer format
  500. * 5: Main screen framebuffer width
  501. * 6: Left framebuffer virtual address for the bottom screen
  502. * 7: Right framebuffer virtual address for the bottom screen
  503. * 8: Bottom screen framebuffer format
  504. * 9: Bottom screen framebuffer width
  505. */
  506. static void ImportDisplayCaptureInfo(Service::Interface* self) {
  507. u32* cmd_buff = Kernel::GetCommandBuffer();
  508. // TODO(Subv): We're always returning the framebuffer structures for thread_id = 0,
  509. // because we only support a single running application at a time.
  510. // This should always return the framebuffer data that is currently displayed on the screen.
  511. u32 thread_id = 0;
  512. FrameBufferUpdate* top_screen = GetFrameBufferInfo(thread_id, 0);
  513. FrameBufferUpdate* bottom_screen = GetFrameBufferInfo(thread_id, 1);
  514. cmd_buff[2] = top_screen->framebuffer_info[top_screen->index].address_left;
  515. cmd_buff[3] = top_screen->framebuffer_info[top_screen->index].address_right;
  516. cmd_buff[4] = top_screen->framebuffer_info[top_screen->index].format;
  517. cmd_buff[5] = top_screen->framebuffer_info[top_screen->index].stride;
  518. cmd_buff[6] = bottom_screen->framebuffer_info[bottom_screen->index].address_left;
  519. cmd_buff[7] = bottom_screen->framebuffer_info[bottom_screen->index].address_right;
  520. cmd_buff[8] = bottom_screen->framebuffer_info[bottom_screen->index].format;
  521. cmd_buff[9] = bottom_screen->framebuffer_info[bottom_screen->index].stride;
  522. cmd_buff[1] = RESULT_SUCCESS.raw;
  523. LOG_WARNING(Service_GSP, "called");
  524. }
  525. const Interface::FunctionInfo FunctionTable[] = {
  526. {0x00010082, WriteHWRegs, "WriteHWRegs"},
  527. {0x00020084, WriteHWRegsWithMask, "WriteHWRegsWithMask"},
  528. {0x00030082, nullptr, "WriteHWRegRepeat"},
  529. {0x00040080, ReadHWRegs, "ReadHWRegs"},
  530. {0x00050200, SetBufferSwap, "SetBufferSwap"},
  531. {0x00060082, nullptr, "SetCommandList"},
  532. {0x000700C2, nullptr, "RequestDma"},
  533. {0x00080082, FlushDataCache, "FlushDataCache"},
  534. {0x00090082, nullptr, "InvalidateDataCache"},
  535. {0x000A0044, nullptr, "RegisterInterruptEvents"},
  536. {0x000B0040, SetLcdForceBlack, "SetLcdForceBlack"},
  537. {0x000C0000, TriggerCmdReqQueue, "TriggerCmdReqQueue"},
  538. {0x000D0140, nullptr, "SetDisplayTransfer"},
  539. {0x000E0180, nullptr, "SetTextureCopy"},
  540. {0x000F0200, nullptr, "SetMemoryFill"},
  541. {0x00100040, SetAxiConfigQoSMode, "SetAxiConfigQoSMode"},
  542. {0x00110040, nullptr, "SetPerfLogMode"},
  543. {0x00120000, nullptr, "GetPerfLog"},
  544. {0x00130042, RegisterInterruptRelayQueue, "RegisterInterruptRelayQueue"},
  545. {0x00140000, UnregisterInterruptRelayQueue, "UnregisterInterruptRelayQueue"},
  546. {0x00150002, nullptr, "TryAcquireRight"},
  547. {0x00160042, nullptr, "AcquireRight"},
  548. {0x00170000, nullptr, "ReleaseRight"},
  549. {0x00180000, ImportDisplayCaptureInfo, "ImportDisplayCaptureInfo"},
  550. {0x00190000, nullptr, "SaveVramSysArea"},
  551. {0x001A0000, nullptr, "RestoreVramSysArea"},
  552. {0x001B0000, nullptr, "ResetGpuCore"},
  553. {0x001C0040, nullptr, "SetLedForceOff"},
  554. {0x001D0040, nullptr, "SetTestCommand"},
  555. {0x001E0080, nullptr, "SetInternalPriorities"},
  556. {0x001F0082, nullptr, "StoreDataCache"},
  557. };
  558. ////////////////////////////////////////////////////////////////////////////////////////////////////
  559. // Interface class
  560. Interface::Interface() {
  561. Register(FunctionTable);
  562. g_interrupt_event = nullptr;
  563. g_shared_memory = nullptr;
  564. g_thread_id = 0;
  565. }
  566. Interface::~Interface() {
  567. g_interrupt_event = nullptr;
  568. g_shared_memory = nullptr;
  569. }
  570. } // namespace