From e832bbe554e174694cb43d4fe86f31af283a10da Mon Sep 17 00:00:00 2001 From: Tony Wasserka Date: Fri, 25 Jul 2014 11:22:40 +0200 Subject: [PATCH] GSP: Add a helper function for convenience. --- src/core/hle/service/gsp.cpp | 43 ++++++++++++++++++++---------------- 1 file changed, 24 insertions(+), 19 deletions(-) diff --git a/src/core/hle/service/gsp.cpp b/src/core/hle/service/gsp.cpp index 635f50a53..f793b592c 100644 --- a/src/core/hle/service/gsp.cpp +++ b/src/core/hle/service/gsp.cpp @@ -42,33 +42,38 @@ static inline InterruptRelayQueue* GetInterruptRelayQueue(u32 thread_id) { sizeof(InterruptRelayQueue) * thread_id); } +void WriteHWRegs(u32 base_address, u32 size_in_bytes, const u32* data) { + // TODO: Return proper error codes + if (base_address + size_in_bytes >= 0x420000) { + ERROR_LOG(GPU, "Write address out of range! (address=0x%08x, size=0x%08x)", + base_address, size_in_bytes); + return; + } + + // size should be word-aligned + if ((size_in_bytes % 4) != 0) { + ERROR_LOG(GPU, "Invalid size 0x%08x", size_in_bytes); + return; + } + + while (size_in_bytes > 0) { + GPU::Write(base_address + 0x1EB00000, *data); + + size_in_bytes -= 4; + ++data; + base_address += 4; + } +} + /// Write a GSP GPU hardware register void WriteHWRegs(Service::Interface* self) { u32* cmd_buff = Service::GetCommandBuffer(); u32 reg_addr = cmd_buff[1]; u32 size = cmd_buff[2]; - // TODO: Return proper error codes - if (reg_addr + size >= 0x420000) { - ERROR_LOG(GPU, "Write address out of range! (address=0x%08x, size=0x%08x)", reg_addr, size); - return; - } - - // size should be word-aligned - if ((size % 4) != 0) { - ERROR_LOG(GPU, "Invalid size 0x%08x", size); - return; - } - u32* src = (u32*)Memory::GetPointer(cmd_buff[0x4]); - while (size > 0) { - GPU::Write(reg_addr + 0x1EB00000, *src); - - size -= 4; - ++src; - reg_addr += 4; - } + WriteHWRegs(reg_addr, size, src); } /// Read a GSP GPU hardware register