mirror of
				https://git.zaroz.cloud/nintendo-back-up/yuzu/yuzu.git
				synced 2025-05-12 00:45:25 +00:00 
			
		
		
		
	Merge pull request #444 from yuriks/handle-reform2
Kernel Lifetime Reform Pt. 2
This commit is contained in:
		
						commit
						6ae12424df
					
				@ -13,6 +13,7 @@
 | 
				
			|||||||
#include "core/core.h"
 | 
					#include "core/core.h"
 | 
				
			||||||
#include "common/break_points.h"
 | 
					#include "common/break_points.h"
 | 
				
			||||||
#include "common/symbols.h"
 | 
					#include "common/symbols.h"
 | 
				
			||||||
 | 
					#include "core/arm/arm_interface.h"
 | 
				
			||||||
#include "core/arm/skyeye_common/armdefs.h"
 | 
					#include "core/arm/skyeye_common/armdefs.h"
 | 
				
			||||||
#include "core/arm/disassembler/arm_disasm.h"
 | 
					#include "core/arm/disassembler/arm_disasm.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
				
			|||||||
@ -7,7 +7,9 @@
 | 
				
			|||||||
#include "common/common.h"
 | 
					#include "common/common.h"
 | 
				
			||||||
#include "common/common_types.h"
 | 
					#include "common/common_types.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#include "core/hle/svc.h"
 | 
					namespace Core {
 | 
				
			||||||
 | 
					    struct ThreadContext;
 | 
				
			||||||
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Generic ARM11 CPU interface
 | 
					/// Generic ARM11 CPU interface
 | 
				
			||||||
class ARM_Interface : NonCopyable {
 | 
					class ARM_Interface : NonCopyable {
 | 
				
			||||||
@ -87,13 +89,13 @@ public:
 | 
				
			|||||||
     * Saves the current CPU context
 | 
					     * Saves the current CPU context
 | 
				
			||||||
     * @param ctx Thread context to save
 | 
					     * @param ctx Thread context to save
 | 
				
			||||||
     */
 | 
					     */
 | 
				
			||||||
    virtual void SaveContext(ThreadContext& ctx) = 0;
 | 
					    virtual void SaveContext(Core::ThreadContext& ctx) = 0;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    /**
 | 
					    /**
 | 
				
			||||||
     * Loads a CPU context
 | 
					     * Loads a CPU context
 | 
				
			||||||
     * @param ctx Thread context to load
 | 
					     * @param ctx Thread context to load
 | 
				
			||||||
     */
 | 
					     */
 | 
				
			||||||
    virtual void LoadContext(const ThreadContext& ctx) = 0;
 | 
					    virtual void LoadContext(const Core::ThreadContext& ctx) = 0;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    /// Prepare core for thread reschedule (if needed to correctly handle state)
 | 
					    /// Prepare core for thread reschedule (if needed to correctly handle state)
 | 
				
			||||||
    virtual void PrepareReschedule() = 0;
 | 
					    virtual void PrepareReschedule() = 0;
 | 
				
			||||||
 | 
				
			|||||||
@ -9,6 +9,7 @@
 | 
				
			|||||||
#include "core/arm/dyncom/arm_dyncom.h"
 | 
					#include "core/arm/dyncom/arm_dyncom.h"
 | 
				
			||||||
#include "core/arm/dyncom/arm_dyncom_interpreter.h"
 | 
					#include "core/arm/dyncom/arm_dyncom_interpreter.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include "core/core.h"
 | 
				
			||||||
#include "core/core_timing.h"
 | 
					#include "core/core_timing.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
const static cpu_config_t s_arm11_cpu_info = {
 | 
					const static cpu_config_t s_arm11_cpu_info = {
 | 
				
			||||||
@ -94,7 +95,7 @@ void ARM_DynCom::ExecuteInstructions(int num_instructions) {
 | 
				
			|||||||
    AddTicks(ticks_executed);
 | 
					    AddTicks(ticks_executed);
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
void ARM_DynCom::SaveContext(ThreadContext& ctx) {
 | 
					void ARM_DynCom::SaveContext(Core::ThreadContext& ctx) {
 | 
				
			||||||
    memcpy(ctx.cpu_registers, state->Reg, sizeof(ctx.cpu_registers));
 | 
					    memcpy(ctx.cpu_registers, state->Reg, sizeof(ctx.cpu_registers));
 | 
				
			||||||
    memcpy(ctx.fpu_registers, state->ExtReg, sizeof(ctx.fpu_registers));
 | 
					    memcpy(ctx.fpu_registers, state->ExtReg, sizeof(ctx.fpu_registers));
 | 
				
			||||||
 | 
					
 | 
				
			||||||
@ -110,7 +111,7 @@ void ARM_DynCom::SaveContext(ThreadContext& ctx) {
 | 
				
			|||||||
    ctx.mode = state->NextInstr;
 | 
					    ctx.mode = state->NextInstr;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
void ARM_DynCom::LoadContext(const ThreadContext& ctx) {
 | 
					void ARM_DynCom::LoadContext(const Core::ThreadContext& ctx) {
 | 
				
			||||||
    memcpy(state->Reg, ctx.cpu_registers, sizeof(ctx.cpu_registers));
 | 
					    memcpy(state->Reg, ctx.cpu_registers, sizeof(ctx.cpu_registers));
 | 
				
			||||||
    memcpy(state->ExtReg, ctx.fpu_registers, sizeof(ctx.fpu_registers));
 | 
					    memcpy(state->ExtReg, ctx.fpu_registers, sizeof(ctx.fpu_registers));
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
				
			|||||||
@ -71,13 +71,13 @@ public:
 | 
				
			|||||||
     * Saves the current CPU context
 | 
					     * Saves the current CPU context
 | 
				
			||||||
     * @param ctx Thread context to save
 | 
					     * @param ctx Thread context to save
 | 
				
			||||||
     */
 | 
					     */
 | 
				
			||||||
    void SaveContext(ThreadContext& ctx) override;
 | 
					    void SaveContext(Core::ThreadContext& ctx) override;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    /**
 | 
					    /**
 | 
				
			||||||
     * Loads a CPU context
 | 
					     * Loads a CPU context
 | 
				
			||||||
     * @param ctx Thread context to load
 | 
					     * @param ctx Thread context to load
 | 
				
			||||||
     */
 | 
					     */
 | 
				
			||||||
    void LoadContext(const ThreadContext& ctx) override;
 | 
					    void LoadContext(const Core::ThreadContext& ctx) override;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    /// Prepare core for thread reschedule (if needed to correctly handle state)
 | 
					    /// Prepare core for thread reschedule (if needed to correctly handle state)
 | 
				
			||||||
    void PrepareReschedule() override;
 | 
					    void PrepareReschedule() override;
 | 
				
			||||||
 | 
				
			|||||||
@ -4,6 +4,8 @@
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
#include "core/arm/interpreter/arm_interpreter.h"
 | 
					#include "core/arm/interpreter/arm_interpreter.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include "core/core.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
const static cpu_config_t arm11_cpu_info = {
 | 
					const static cpu_config_t arm11_cpu_info = {
 | 
				
			||||||
    "armv6", "arm11", 0x0007b000, 0x0007f000, NONCACHE
 | 
					    "armv6", "arm11", 0x0007b000, 0x0007f000, NONCACHE
 | 
				
			||||||
};
 | 
					};
 | 
				
			||||||
@ -75,7 +77,7 @@ void ARM_Interpreter::ExecuteInstructions(int num_instructions) {
 | 
				
			|||||||
    ARMul_Emulate32(state);
 | 
					    ARMul_Emulate32(state);
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
void ARM_Interpreter::SaveContext(ThreadContext& ctx) {
 | 
					void ARM_Interpreter::SaveContext(Core::ThreadContext& ctx) {
 | 
				
			||||||
    memcpy(ctx.cpu_registers, state->Reg, sizeof(ctx.cpu_registers));
 | 
					    memcpy(ctx.cpu_registers, state->Reg, sizeof(ctx.cpu_registers));
 | 
				
			||||||
    memcpy(ctx.fpu_registers, state->ExtReg, sizeof(ctx.fpu_registers));
 | 
					    memcpy(ctx.fpu_registers, state->ExtReg, sizeof(ctx.fpu_registers));
 | 
				
			||||||
 | 
					
 | 
				
			||||||
@ -91,7 +93,7 @@ void ARM_Interpreter::SaveContext(ThreadContext& ctx) {
 | 
				
			|||||||
    ctx.mode = state->NextInstr;
 | 
					    ctx.mode = state->NextInstr;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
void ARM_Interpreter::LoadContext(const ThreadContext& ctx) {
 | 
					void ARM_Interpreter::LoadContext(const Core::ThreadContext& ctx) {
 | 
				
			||||||
    memcpy(state->Reg, ctx.cpu_registers, sizeof(ctx.cpu_registers));
 | 
					    memcpy(state->Reg, ctx.cpu_registers, sizeof(ctx.cpu_registers));
 | 
				
			||||||
    memcpy(state->ExtReg, ctx.fpu_registers, sizeof(ctx.fpu_registers));
 | 
					    memcpy(state->ExtReg, ctx.fpu_registers, sizeof(ctx.fpu_registers));
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
				
			|||||||
@ -70,13 +70,13 @@ public:
 | 
				
			|||||||
     * Saves the current CPU context
 | 
					     * Saves the current CPU context
 | 
				
			||||||
     * @param ctx Thread context to save
 | 
					     * @param ctx Thread context to save
 | 
				
			||||||
     */
 | 
					     */
 | 
				
			||||||
    void SaveContext(ThreadContext& ctx) override;
 | 
					    void SaveContext(Core::ThreadContext& ctx) override;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    /**
 | 
					    /**
 | 
				
			||||||
     * Loads a CPU context
 | 
					     * Loads a CPU context
 | 
				
			||||||
     * @param ctx Thread context to load
 | 
					     * @param ctx Thread context to load
 | 
				
			||||||
     */
 | 
					     */
 | 
				
			||||||
    void LoadContext(const ThreadContext& ctx) override;
 | 
					    void LoadContext(const Core::ThreadContext& ctx) override;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    /// Prepare core for thread reschedule (if needed to correctly handle state)
 | 
					    /// Prepare core for thread reschedule (if needed to correctly handle state)
 | 
				
			||||||
    void PrepareReschedule() override;
 | 
					    void PrepareReschedule() override;
 | 
				
			||||||
 | 
				
			|||||||
@ -8,6 +8,7 @@
 | 
				
			|||||||
#include "core/core_timing.h"
 | 
					#include "core/core_timing.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#include "core/settings.h"
 | 
					#include "core/settings.h"
 | 
				
			||||||
 | 
					#include "core/arm/arm_interface.h"
 | 
				
			||||||
#include "core/arm/disassembler/arm_disasm.h"
 | 
					#include "core/arm/disassembler/arm_disasm.h"
 | 
				
			||||||
#include "core/arm/interpreter/arm_interpreter.h"
 | 
					#include "core/arm/interpreter/arm_interpreter.h"
 | 
				
			||||||
#include "core/arm/dyncom/arm_dyncom.h"
 | 
					#include "core/arm/dyncom/arm_dyncom.h"
 | 
				
			||||||
@ -24,7 +25,7 @@ ARM_Interface*     g_sys_core = nullptr;  ///< ARM11 system (OS) core
 | 
				
			|||||||
void RunLoop(int tight_loop) {
 | 
					void RunLoop(int tight_loop) {
 | 
				
			||||||
    // If the current thread is an idle thread, then don't execute instructions,
 | 
					    // If the current thread is an idle thread, then don't execute instructions,
 | 
				
			||||||
    // instead advance to the next event and try to yield to the next thread
 | 
					    // instead advance to the next event and try to yield to the next thread
 | 
				
			||||||
    if (Kernel::IsIdleThread(Kernel::GetCurrentThreadHandle())) {
 | 
					    if (Kernel::GetCurrentThread()->IsIdle()) {
 | 
				
			||||||
        LOG_TRACE(Core_ARM11, "Idling");
 | 
					        LOG_TRACE(Core_ARM11, "Idling");
 | 
				
			||||||
        CoreTiming::Idle();
 | 
					        CoreTiming::Idle();
 | 
				
			||||||
        CoreTiming::Advance();
 | 
					        CoreTiming::Advance();
 | 
				
			||||||
 | 
				
			|||||||
@ -4,8 +4,9 @@
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
#pragma once
 | 
					#pragma once
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#include "core/arm/arm_interface.h"
 | 
					#include "common/common_types.h"
 | 
				
			||||||
#include "core/arm/skyeye_common/armdefs.h"
 | 
					
 | 
				
			||||||
 | 
					class ARM_Interface;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
////////////////////////////////////////////////////////////////////////////////////////////////////
 | 
					////////////////////////////////////////////////////////////////////////////////////////////////////
 | 
				
			||||||
 | 
					
 | 
				
			||||||
@ -16,6 +17,21 @@ enum CPUCore {
 | 
				
			|||||||
    CPU_OldInterpreter,
 | 
					    CPU_OldInterpreter,
 | 
				
			||||||
};
 | 
					};
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					struct ThreadContext {
 | 
				
			||||||
 | 
					    u32 cpu_registers[13];
 | 
				
			||||||
 | 
					    u32 sp;
 | 
				
			||||||
 | 
					    u32 lr;
 | 
				
			||||||
 | 
					    u32 pc;
 | 
				
			||||||
 | 
					    u32 cpsr;
 | 
				
			||||||
 | 
					    u32 fpu_registers[32];
 | 
				
			||||||
 | 
					    u32 fpscr;
 | 
				
			||||||
 | 
					    u32 fpexc;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    // These are not part of native ThreadContext, but needed by emu
 | 
				
			||||||
 | 
					    u32 reg_15;
 | 
				
			||||||
 | 
					    u32 mode;
 | 
				
			||||||
 | 
					};
 | 
				
			||||||
 | 
					
 | 
				
			||||||
extern ARM_Interface*   g_app_core;     ///< ARM11 application core
 | 
					extern ARM_Interface*   g_app_core;     ///< ARM11 application core
 | 
				
			||||||
extern ARM_Interface*   g_sys_core;     ///< ARM11 system (OS) core
 | 
					extern ARM_Interface*   g_sys_core;     ///< ARM11 system (OS) core
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
				
			|||||||
@ -9,6 +9,8 @@
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
#include "common/chunk_file.h"
 | 
					#include "common/chunk_file.h"
 | 
				
			||||||
#include "common/log.h"
 | 
					#include "common/log.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include "core/arm/arm_interface.h"
 | 
				
			||||||
#include "core/core.h"
 | 
					#include "core/core.h"
 | 
				
			||||||
#include "core/core_timing.h"
 | 
					#include "core/core_timing.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
				
			|||||||
@ -5,6 +5,8 @@
 | 
				
			|||||||
#pragma once
 | 
					#pragma once
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#include "common/common_types.h"
 | 
					#include "common/common_types.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include "core/arm/arm_interface.h"
 | 
				
			||||||
#include "core/mem_map.h"
 | 
					#include "core/mem_map.h"
 | 
				
			||||||
#include "core/hle/hle.h"
 | 
					#include "core/hle/hle.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
				
			|||||||
@ -4,6 +4,7 @@
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
#include <vector>
 | 
					#include <vector>
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include "core/arm/arm_interface.h"
 | 
				
			||||||
#include "core/mem_map.h"
 | 
					#include "core/mem_map.h"
 | 
				
			||||||
#include "core/hle/hle.h"
 | 
					#include "core/hle/hle.h"
 | 
				
			||||||
#include "core/hle/kernel/thread.h"
 | 
					#include "core/hle/kernel/thread.h"
 | 
				
			||||||
 | 
				
			|||||||
@ -4,6 +4,8 @@
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
#pragma once
 | 
					#pragma once
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include <string>
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#include "common/common_types.h"
 | 
					#include "common/common_types.h"
 | 
				
			||||||
#include "core/core.h"
 | 
					#include "core/core.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
				
			|||||||
@ -30,24 +30,28 @@ public:
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
/// Arbitrate an address
 | 
					/// Arbitrate an address
 | 
				
			||||||
ResultCode ArbitrateAddress(Handle handle, ArbitrationType type, u32 address, s32 value) {
 | 
					ResultCode ArbitrateAddress(Handle handle, ArbitrationType type, u32 address, s32 value) {
 | 
				
			||||||
 | 
					    Object* object = Kernel::g_handle_table.GetGeneric(handle);
 | 
				
			||||||
 | 
					    if (object == nullptr)
 | 
				
			||||||
 | 
					        return InvalidHandle(ErrorModule::Kernel);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    switch (type) {
 | 
					    switch (type) {
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    // Signal thread(s) waiting for arbitrate address...
 | 
					    // Signal thread(s) waiting for arbitrate address...
 | 
				
			||||||
    case ArbitrationType::Signal:
 | 
					    case ArbitrationType::Signal:
 | 
				
			||||||
        // Negative value means resume all threads
 | 
					        // Negative value means resume all threads
 | 
				
			||||||
        if (value < 0) {
 | 
					        if (value < 0) {
 | 
				
			||||||
            ArbitrateAllThreads(handle, address);
 | 
					            ArbitrateAllThreads(object, address);
 | 
				
			||||||
        } else {
 | 
					        } else {
 | 
				
			||||||
            // Resume first N threads
 | 
					            // Resume first N threads
 | 
				
			||||||
            for(int i = 0; i < value; i++)
 | 
					            for(int i = 0; i < value; i++)
 | 
				
			||||||
                ArbitrateHighestPriorityThread(handle, address);
 | 
					                ArbitrateHighestPriorityThread(object, address);
 | 
				
			||||||
        }
 | 
					        }
 | 
				
			||||||
        break;
 | 
					        break;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    // Wait current thread (acquire the arbiter)...
 | 
					    // Wait current thread (acquire the arbiter)...
 | 
				
			||||||
    case ArbitrationType::WaitIfLessThan:
 | 
					    case ArbitrationType::WaitIfLessThan:
 | 
				
			||||||
        if ((s32)Memory::Read32(address) <= value) {
 | 
					        if ((s32)Memory::Read32(address) <= value) {
 | 
				
			||||||
            Kernel::WaitCurrentThread(WAITTYPE_ARB, handle, address);
 | 
					            Kernel::WaitCurrentThread(WAITTYPE_ARB, object, address);
 | 
				
			||||||
            HLE::Reschedule(__func__);
 | 
					            HLE::Reschedule(__func__);
 | 
				
			||||||
        }
 | 
					        }
 | 
				
			||||||
        break;
 | 
					        break;
 | 
				
			||||||
@ -57,7 +61,7 @@ ResultCode ArbitrateAddress(Handle handle, ArbitrationType type, u32 address, s3
 | 
				
			|||||||
        s32 memory_value = Memory::Read32(address) - 1;
 | 
					        s32 memory_value = Memory::Read32(address) - 1;
 | 
				
			||||||
        Memory::Write32(address, memory_value);
 | 
					        Memory::Write32(address, memory_value);
 | 
				
			||||||
        if (memory_value <= value) {
 | 
					        if (memory_value <= value) {
 | 
				
			||||||
            Kernel::WaitCurrentThread(WAITTYPE_ARB, handle, address);
 | 
					            Kernel::WaitCurrentThread(WAITTYPE_ARB, object, address);
 | 
				
			||||||
            HLE::Reschedule(__func__);
 | 
					            HLE::Reschedule(__func__);
 | 
				
			||||||
        }
 | 
					        }
 | 
				
			||||||
        break;
 | 
					        break;
 | 
				
			||||||
 | 
				
			|||||||
@ -33,11 +33,11 @@ public:
 | 
				
			|||||||
    ResultVal<bool> WaitSynchronization() override {
 | 
					    ResultVal<bool> WaitSynchronization() override {
 | 
				
			||||||
        bool wait = locked;
 | 
					        bool wait = locked;
 | 
				
			||||||
        if (locked) {
 | 
					        if (locked) {
 | 
				
			||||||
            Handle thread = GetCurrentThreadHandle();
 | 
					            Handle thread = GetCurrentThread()->GetHandle();
 | 
				
			||||||
            if (std::find(waiting_threads.begin(), waiting_threads.end(), thread) == waiting_threads.end()) {
 | 
					            if (std::find(waiting_threads.begin(), waiting_threads.end(), thread) == waiting_threads.end()) {
 | 
				
			||||||
                waiting_threads.push_back(thread);
 | 
					                waiting_threads.push_back(thread);
 | 
				
			||||||
            }
 | 
					            }
 | 
				
			||||||
            Kernel::WaitCurrentThread(WAITTYPE_EVENT, GetHandle());
 | 
					            Kernel::WaitCurrentThread(WAITTYPE_EVENT, this);
 | 
				
			||||||
        }
 | 
					        }
 | 
				
			||||||
        if (reset_type != RESETTYPE_STICKY && !permanent_locked) {
 | 
					        if (reset_type != RESETTYPE_STICKY && !permanent_locked) {
 | 
				
			||||||
            locked = true;
 | 
					            locked = true;
 | 
				
			||||||
@ -88,7 +88,9 @@ ResultCode SignalEvent(const Handle handle) {
 | 
				
			|||||||
    // Resume threads waiting for event to signal
 | 
					    // Resume threads waiting for event to signal
 | 
				
			||||||
    bool event_caught = false;
 | 
					    bool event_caught = false;
 | 
				
			||||||
    for (size_t i = 0; i < evt->waiting_threads.size(); ++i) {
 | 
					    for (size_t i = 0; i < evt->waiting_threads.size(); ++i) {
 | 
				
			||||||
        ResumeThreadFromWait( evt->waiting_threads[i]);
 | 
					        Thread* thread = Kernel::g_handle_table.Get<Thread>(evt->waiting_threads[i]);
 | 
				
			||||||
 | 
					        if (thread != nullptr)
 | 
				
			||||||
 | 
					            thread->ResumeFromWait();
 | 
				
			||||||
 | 
					
 | 
				
			||||||
        // If any thread is signalled awake by this event, assume the event was "caught" and reset
 | 
					        // If any thread is signalled awake by this event, assume the event was "caught" and reset
 | 
				
			||||||
        // the event. This will result in the next thread waiting on the event to block. Otherwise,
 | 
					        // the event. This will result in the next thread waiting on the event to block. Otherwise,
 | 
				
			||||||
 | 
				
			|||||||
@ -6,6 +6,7 @@
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
#include "common/common.h"
 | 
					#include "common/common.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include "core/arm/arm_interface.h"
 | 
				
			||||||
#include "core/core.h"
 | 
					#include "core/core.h"
 | 
				
			||||||
#include "core/hle/kernel/kernel.h"
 | 
					#include "core/hle/kernel/kernel.h"
 | 
				
			||||||
#include "core/hle/kernel/thread.h"
 | 
					#include "core/hle/kernel/thread.h"
 | 
				
			||||||
@ -13,7 +14,7 @@
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
namespace Kernel {
 | 
					namespace Kernel {
 | 
				
			||||||
 | 
					
 | 
				
			||||||
Handle g_main_thread = 0;
 | 
					Thread* g_main_thread = nullptr;
 | 
				
			||||||
HandleTable g_handle_table;
 | 
					HandleTable g_handle_table;
 | 
				
			||||||
u64 g_program_id = 0;
 | 
					u64 g_program_id = 0;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
@ -80,8 +81,7 @@ bool HandleTable::IsValid(Handle handle) const {
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
Object* HandleTable::GetGeneric(Handle handle) const {
 | 
					Object* HandleTable::GetGeneric(Handle handle) const {
 | 
				
			||||||
    if (handle == CurrentThread) {
 | 
					    if (handle == CurrentThread) {
 | 
				
			||||||
        // TODO(yuriks) Directly return the pointer once this is possible.
 | 
					        return GetCurrentThread();
 | 
				
			||||||
        handle = GetCurrentThreadHandle();
 | 
					 | 
				
			||||||
    } else if (handle == CurrentProcess) {
 | 
					    } else if (handle == CurrentProcess) {
 | 
				
			||||||
        LOG_ERROR(Kernel, "Current process (%08X) pseudo-handle not supported", CurrentProcess);
 | 
					        LOG_ERROR(Kernel, "Current process (%08X) pseudo-handle not supported", CurrentProcess);
 | 
				
			||||||
        return nullptr;
 | 
					        return nullptr;
 | 
				
			||||||
 | 
				
			|||||||
@ -16,6 +16,8 @@ const Handle INVALID_HANDLE = 0;
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
namespace Kernel {
 | 
					namespace Kernel {
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					class Thread;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
// TODO: Verify code
 | 
					// TODO: Verify code
 | 
				
			||||||
const ResultCode ERR_OUT_OF_HANDLES(ErrorDescription::OutOfMemory, ErrorModule::Kernel,
 | 
					const ResultCode ERR_OUT_OF_HANDLES(ErrorDescription::OutOfMemory, ErrorModule::Kernel,
 | 
				
			||||||
        ErrorSummary::OutOfResource, ErrorLevel::Temporary);
 | 
					        ErrorSummary::OutOfResource, ErrorLevel::Temporary);
 | 
				
			||||||
@ -190,7 +192,7 @@ private:
 | 
				
			|||||||
};
 | 
					};
 | 
				
			||||||
 | 
					
 | 
				
			||||||
extern HandleTable g_handle_table;
 | 
					extern HandleTable g_handle_table;
 | 
				
			||||||
extern Handle g_main_thread;
 | 
					extern Thread* g_main_thread;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// The ID code of the currently running game
 | 
					/// The ID code of the currently running game
 | 
				
			||||||
/// TODO(Subv): This variable should not be here, 
 | 
					/// TODO(Subv): This variable should not be here, 
 | 
				
			||||||
 | 
				
			|||||||
@ -40,14 +40,21 @@ static MutexMap g_mutex_held_locks;
 | 
				
			|||||||
 * @param mutex Mutex that is to be acquired
 | 
					 * @param mutex Mutex that is to be acquired
 | 
				
			||||||
 * @param thread Thread that will acquired
 | 
					 * @param thread Thread that will acquired
 | 
				
			||||||
 */
 | 
					 */
 | 
				
			||||||
void MutexAcquireLock(Mutex* mutex, Handle thread = GetCurrentThreadHandle()) {
 | 
					void MutexAcquireLock(Mutex* mutex, Handle thread = GetCurrentThread()->GetHandle()) {
 | 
				
			||||||
    g_mutex_held_locks.insert(std::make_pair(thread, mutex->GetHandle()));
 | 
					    g_mutex_held_locks.insert(std::make_pair(thread, mutex->GetHandle()));
 | 
				
			||||||
    mutex->lock_thread = thread;
 | 
					    mutex->lock_thread = thread;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
bool ReleaseMutexForThread(Mutex* mutex, Handle thread) {
 | 
					bool ReleaseMutexForThread(Mutex* mutex, Handle thread_handle) {
 | 
				
			||||||
    MutexAcquireLock(mutex, thread);
 | 
					    MutexAcquireLock(mutex, thread_handle);
 | 
				
			||||||
    Kernel::ResumeThreadFromWait(thread);
 | 
					
 | 
				
			||||||
 | 
					    Thread* thread = Kernel::g_handle_table.Get<Thread>(thread_handle);
 | 
				
			||||||
 | 
					    if (thread == nullptr) {
 | 
				
			||||||
 | 
					        LOG_ERROR(Kernel, "Called with invalid handle: %08X", thread_handle);
 | 
				
			||||||
 | 
					        return false;
 | 
				
			||||||
 | 
					    }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    thread->ResumeFromWait();
 | 
				
			||||||
    return true;
 | 
					    return true;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
@ -168,8 +175,8 @@ Handle CreateMutex(bool initial_locked, const std::string& name) {
 | 
				
			|||||||
ResultVal<bool> Mutex::WaitSynchronization() {
 | 
					ResultVal<bool> Mutex::WaitSynchronization() {
 | 
				
			||||||
    bool wait = locked;
 | 
					    bool wait = locked;
 | 
				
			||||||
    if (locked) {
 | 
					    if (locked) {
 | 
				
			||||||
        waiting_threads.push_back(GetCurrentThreadHandle());
 | 
					        waiting_threads.push_back(GetCurrentThread()->GetHandle());
 | 
				
			||||||
        Kernel::WaitCurrentThread(WAITTYPE_MUTEX, GetHandle());
 | 
					        Kernel::WaitCurrentThread(WAITTYPE_MUTEX, this);
 | 
				
			||||||
    } else {
 | 
					    } else {
 | 
				
			||||||
        // Lock the mutex when the first thread accesses it
 | 
					        // Lock the mutex when the first thread accesses it
 | 
				
			||||||
        locked = true;
 | 
					        locked = true;
 | 
				
			||||||
 | 
				
			|||||||
@ -37,8 +37,8 @@ public:
 | 
				
			|||||||
        bool wait = !IsAvailable();
 | 
					        bool wait = !IsAvailable();
 | 
				
			||||||
 | 
					
 | 
				
			||||||
        if (wait) {
 | 
					        if (wait) {
 | 
				
			||||||
            Kernel::WaitCurrentThread(WAITTYPE_SEMA, GetHandle());
 | 
					            Kernel::WaitCurrentThread(WAITTYPE_SEMA, this);
 | 
				
			||||||
            waiting_threads.push(GetCurrentThreadHandle());
 | 
					            waiting_threads.push(GetCurrentThread()->GetHandle());
 | 
				
			||||||
        } else {
 | 
					        } else {
 | 
				
			||||||
            --available_count;
 | 
					            --available_count;
 | 
				
			||||||
        }
 | 
					        }
 | 
				
			||||||
@ -84,7 +84,9 @@ ResultCode ReleaseSemaphore(s32* count, Handle handle, s32 release_count) {
 | 
				
			|||||||
    // Notify some of the threads that the semaphore has been released
 | 
					    // Notify some of the threads that the semaphore has been released
 | 
				
			||||||
    // stop once the semaphore is full again or there are no more waiting threads
 | 
					    // stop once the semaphore is full again or there are no more waiting threads
 | 
				
			||||||
    while (!semaphore->waiting_threads.empty() && semaphore->IsAvailable()) {
 | 
					    while (!semaphore->waiting_threads.empty() && semaphore->IsAvailable()) {
 | 
				
			||||||
        Kernel::ResumeThreadFromWait(semaphore->waiting_threads.front());
 | 
					        Thread* thread = Kernel::g_handle_table.Get<Thread>(semaphore->waiting_threads.front());
 | 
				
			||||||
 | 
					        if (thread != nullptr)
 | 
				
			||||||
 | 
					            thread->ResumeFromWait();
 | 
				
			||||||
        semaphore->waiting_threads.pop();
 | 
					        semaphore->waiting_threads.pop();
 | 
				
			||||||
        --semaphore->available_count;
 | 
					        --semaphore->available_count;
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
 | 
				
			|||||||
@ -10,6 +10,7 @@
 | 
				
			|||||||
#include "common/common.h"
 | 
					#include "common/common.h"
 | 
				
			||||||
#include "common/thread_queue_list.h"
 | 
					#include "common/thread_queue_list.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include "core/arm/arm_interface.h"
 | 
				
			||||||
#include "core/core.h"
 | 
					#include "core/core.h"
 | 
				
			||||||
#include "core/core_timing.h"
 | 
					#include "core/core_timing.h"
 | 
				
			||||||
#include "core/hle/hle.h"
 | 
					#include "core/hle/hle.h"
 | 
				
			||||||
@ -21,68 +22,25 @@
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
namespace Kernel {
 | 
					namespace Kernel {
 | 
				
			||||||
 | 
					
 | 
				
			||||||
class Thread : public Kernel::Object {
 | 
					ResultVal<bool> Thread::WaitSynchronization() {
 | 
				
			||||||
public:
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    std::string GetName() const override { return name; }
 | 
					 | 
				
			||||||
    std::string GetTypeName() const override { return "Thread"; }
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    static const HandleType HANDLE_TYPE = HandleType::Thread;
 | 
					 | 
				
			||||||
    HandleType GetHandleType() const override { return HANDLE_TYPE; }
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    inline bool IsRunning() const { return (status & THREADSTATUS_RUNNING) != 0; }
 | 
					 | 
				
			||||||
    inline bool IsStopped() const { return (status & THREADSTATUS_DORMANT) != 0; }
 | 
					 | 
				
			||||||
    inline bool IsReady() const { return (status & THREADSTATUS_READY) != 0; }
 | 
					 | 
				
			||||||
    inline bool IsWaiting() const { return (status & THREADSTATUS_WAIT) != 0; }
 | 
					 | 
				
			||||||
    inline bool IsSuspended() const { return (status & THREADSTATUS_SUSPEND) != 0; }
 | 
					 | 
				
			||||||
    inline bool IsIdle() const { return idle; }
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    ResultVal<bool> WaitSynchronization() override {
 | 
					 | 
				
			||||||
    const bool wait = status != THREADSTATUS_DORMANT;
 | 
					    const bool wait = status != THREADSTATUS_DORMANT;
 | 
				
			||||||
    if (wait) {
 | 
					    if (wait) {
 | 
				
			||||||
            Handle thread = GetCurrentThreadHandle();
 | 
					        Thread* thread = GetCurrentThread();
 | 
				
			||||||
        if (std::find(waiting_threads.begin(), waiting_threads.end(), thread) == waiting_threads.end()) {
 | 
					        if (std::find(waiting_threads.begin(), waiting_threads.end(), thread) == waiting_threads.end()) {
 | 
				
			||||||
            waiting_threads.push_back(thread);
 | 
					            waiting_threads.push_back(thread);
 | 
				
			||||||
        }
 | 
					        }
 | 
				
			||||||
            WaitCurrentThread(WAITTYPE_THREADEND, this->GetHandle());
 | 
					        WaitCurrentThread(WAITTYPE_THREADEND, this);
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    return MakeResult<bool>(wait);
 | 
					    return MakeResult<bool>(wait);
 | 
				
			||||||
    }
 | 
					}
 | 
				
			||||||
 | 
					 | 
				
			||||||
    ThreadContext context;
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    u32 thread_id;
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    u32 status;
 | 
					 | 
				
			||||||
    u32 entry_point;
 | 
					 | 
				
			||||||
    u32 stack_top;
 | 
					 | 
				
			||||||
    u32 stack_size;
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    s32 initial_priority;
 | 
					 | 
				
			||||||
    s32 current_priority;
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    s32 processor_id;
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    WaitType wait_type;
 | 
					 | 
				
			||||||
    Handle wait_handle;
 | 
					 | 
				
			||||||
    VAddr wait_address;
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    std::vector<Handle> waiting_threads;
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    std::string name;
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    /// Whether this thread is intended to never actually be executed, i.e. always idle
 | 
					 | 
				
			||||||
    bool idle = false;
 | 
					 | 
				
			||||||
};
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
// Lists all thread ids that aren't deleted/etc.
 | 
					// Lists all thread ids that aren't deleted/etc.
 | 
				
			||||||
static std::vector<Handle> thread_queue;
 | 
					static std::vector<Thread*> thread_list; // TODO(yuriks): Owned
 | 
				
			||||||
 | 
					
 | 
				
			||||||
// Lists only ready thread ids.
 | 
					// Lists only ready thread ids.
 | 
				
			||||||
static Common::ThreadQueueList<Handle, THREADPRIO_LOWEST+1> thread_ready_queue;
 | 
					static Common::ThreadQueueList<Thread*, THREADPRIO_LOWEST+1> thread_ready_queue;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static Handle current_thread_handle;
 | 
					 | 
				
			||||||
static Thread* current_thread;
 | 
					static Thread* current_thread;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
static const u32 INITIAL_THREAD_ID = 1; ///< The first available thread id at startup
 | 
					static const u32 INITIAL_THREAD_ID = 1; ///< The first available thread id at startup
 | 
				
			||||||
@ -92,30 +50,9 @@ Thread* GetCurrentThread() {
 | 
				
			|||||||
    return current_thread;
 | 
					    return current_thread;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Gets the current thread handle
 | 
					 | 
				
			||||||
Handle GetCurrentThreadHandle() {
 | 
					 | 
				
			||||||
    return GetCurrentThread()->GetHandle();
 | 
					 | 
				
			||||||
}
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
/// Sets the current thread
 | 
					 | 
				
			||||||
inline void SetCurrentThread(Thread* t) {
 | 
					 | 
				
			||||||
    current_thread = t;
 | 
					 | 
				
			||||||
    current_thread_handle = t->GetHandle();
 | 
					 | 
				
			||||||
}
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
/// Saves the current CPU context
 | 
					 | 
				
			||||||
void SaveContext(ThreadContext& ctx) {
 | 
					 | 
				
			||||||
    Core::g_app_core->SaveContext(ctx);
 | 
					 | 
				
			||||||
}
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
/// Loads a CPU context
 | 
					 | 
				
			||||||
void LoadContext(ThreadContext& ctx) {
 | 
					 | 
				
			||||||
    Core::g_app_core->LoadContext(ctx);
 | 
					 | 
				
			||||||
}
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
/// Resets a thread
 | 
					/// Resets a thread
 | 
				
			||||||
void ResetThread(Thread* t, u32 arg, s32 lowest_priority) {
 | 
					static void ResetThread(Thread* t, u32 arg, s32 lowest_priority) {
 | 
				
			||||||
    memset(&t->context, 0, sizeof(ThreadContext));
 | 
					    memset(&t->context, 0, sizeof(Core::ThreadContext));
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    t->context.cpu_registers[0] = arg;
 | 
					    t->context.cpu_registers[0] = arg;
 | 
				
			||||||
    t->context.pc = t->context.reg_15 = t->entry_point;
 | 
					    t->context.pc = t->context.reg_15 = t->entry_point;
 | 
				
			||||||
@ -131,22 +68,21 @@ void ResetThread(Thread* t, u32 arg, s32 lowest_priority) {
 | 
				
			|||||||
        t->current_priority = t->initial_priority;
 | 
					        t->current_priority = t->initial_priority;
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
    t->wait_type = WAITTYPE_NONE;
 | 
					    t->wait_type = WAITTYPE_NONE;
 | 
				
			||||||
    t->wait_handle = 0;
 | 
					    t->wait_object = nullptr;
 | 
				
			||||||
    t->wait_address = 0;
 | 
					    t->wait_address = 0;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Change a thread to "ready" state
 | 
					/// Change a thread to "ready" state
 | 
				
			||||||
void ChangeReadyState(Thread* t, bool ready) {
 | 
					static void ChangeReadyState(Thread* t, bool ready) {
 | 
				
			||||||
    Handle handle = t->GetHandle();
 | 
					 | 
				
			||||||
    if (t->IsReady()) {
 | 
					    if (t->IsReady()) {
 | 
				
			||||||
        if (!ready) {
 | 
					        if (!ready) {
 | 
				
			||||||
            thread_ready_queue.remove(t->current_priority, handle);
 | 
					            thread_ready_queue.remove(t->current_priority, t);
 | 
				
			||||||
        }
 | 
					        }
 | 
				
			||||||
    }  else if (ready) {
 | 
					    }  else if (ready) {
 | 
				
			||||||
        if (t->IsRunning()) {
 | 
					        if (t->IsRunning()) {
 | 
				
			||||||
            thread_ready_queue.push_front(t->current_priority, handle);
 | 
					            thread_ready_queue.push_front(t->current_priority, t);
 | 
				
			||||||
        } else {
 | 
					        } else {
 | 
				
			||||||
            thread_ready_queue.push_back(t->current_priority, handle);
 | 
					            thread_ready_queue.push_back(t->current_priority, t);
 | 
				
			||||||
        }
 | 
					        }
 | 
				
			||||||
        t->status = THREADSTATUS_READY;
 | 
					        t->status = THREADSTATUS_READY;
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
@ -158,43 +94,36 @@ static bool CheckWaitType(const Thread* thread, WaitType type) {
 | 
				
			|||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Check if a thread is blocking on a specified wait type with a specified handle
 | 
					/// Check if a thread is blocking on a specified wait type with a specified handle
 | 
				
			||||||
static bool CheckWaitType(const Thread* thread, WaitType type, Handle wait_handle) {
 | 
					static bool CheckWaitType(const Thread* thread, WaitType type, Object* wait_object) {
 | 
				
			||||||
    return CheckWaitType(thread, type) && (wait_handle == thread->wait_handle);
 | 
					    return CheckWaitType(thread, type) && wait_object == thread->wait_object;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Check if a thread is blocking on a specified wait type with a specified handle and address
 | 
					/// Check if a thread is blocking on a specified wait type with a specified handle and address
 | 
				
			||||||
static bool CheckWaitType(const Thread* thread, WaitType type, Handle wait_handle, VAddr wait_address) {
 | 
					static bool CheckWaitType(const Thread* thread, WaitType type, Object* wait_object, VAddr wait_address) {
 | 
				
			||||||
    return CheckWaitType(thread, type, wait_handle) && (wait_address == thread->wait_address);
 | 
					    return CheckWaitType(thread, type, wait_object) && (wait_address == thread->wait_address);
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Stops the current thread
 | 
					/// Stops the current thread
 | 
				
			||||||
ResultCode StopThread(Handle handle, const char* reason) {
 | 
					void Thread::Stop(const char* reason) {
 | 
				
			||||||
    Thread* thread = g_handle_table.Get<Thread>(handle);
 | 
					 | 
				
			||||||
    if (thread == nullptr) return InvalidHandle(ErrorModule::Kernel);
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    // Release all the mutexes that this thread holds
 | 
					    // Release all the mutexes that this thread holds
 | 
				
			||||||
    ReleaseThreadMutexes(handle);
 | 
					    ReleaseThreadMutexes(GetHandle());
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    ChangeReadyState(thread, false);
 | 
					    ChangeReadyState(this, false);
 | 
				
			||||||
    thread->status = THREADSTATUS_DORMANT;
 | 
					    status = THREADSTATUS_DORMANT;
 | 
				
			||||||
    for (Handle waiting_handle : thread->waiting_threads) {
 | 
					    for (Thread* waiting_thread : waiting_threads) {
 | 
				
			||||||
        Thread* waiting_thread = g_handle_table.Get<Thread>(waiting_handle);
 | 
					        if (CheckWaitType(waiting_thread, WAITTYPE_THREADEND, this))
 | 
				
			||||||
 | 
					            waiting_thread->ResumeFromWait();
 | 
				
			||||||
        if (CheckWaitType(waiting_thread, WAITTYPE_THREADEND, handle))
 | 
					 | 
				
			||||||
            ResumeThreadFromWait(waiting_handle);
 | 
					 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
    thread->waiting_threads.clear();
 | 
					    waiting_threads.clear();
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    // Stopped threads are never waiting.
 | 
					    // Stopped threads are never waiting.
 | 
				
			||||||
    thread->wait_type = WAITTYPE_NONE;
 | 
					    wait_type = WAITTYPE_NONE;
 | 
				
			||||||
    thread->wait_handle = 0;
 | 
					    wait_object = nullptr;
 | 
				
			||||||
    thread->wait_address = 0;
 | 
					    wait_address = 0;
 | 
				
			||||||
 | 
					 | 
				
			||||||
    return RESULT_SUCCESS;
 | 
					 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Changes a threads state
 | 
					/// Changes a threads state
 | 
				
			||||||
void ChangeThreadState(Thread* t, ThreadStatus new_status) {
 | 
					static void ChangeThreadState(Thread* t, ThreadStatus new_status) {
 | 
				
			||||||
    if (!t || t->status == new_status) {
 | 
					    if (!t || t->status == new_status) {
 | 
				
			||||||
        return;
 | 
					        return;
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
@ -209,14 +138,12 @@ void ChangeThreadState(Thread* t, ThreadStatus new_status) {
 | 
				
			|||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Arbitrate the highest priority thread that is waiting
 | 
					/// Arbitrate the highest priority thread that is waiting
 | 
				
			||||||
Handle ArbitrateHighestPriorityThread(u32 arbiter, u32 address) {
 | 
					Thread* ArbitrateHighestPriorityThread(Object* arbiter, u32 address) {
 | 
				
			||||||
    Handle highest_priority_thread = 0;
 | 
					    Thread* highest_priority_thread = nullptr;
 | 
				
			||||||
    s32 priority = THREADPRIO_LOWEST;
 | 
					    s32 priority = THREADPRIO_LOWEST;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    // Iterate through threads, find highest priority thread that is waiting to be arbitrated...
 | 
					    // Iterate through threads, find highest priority thread that is waiting to be arbitrated...
 | 
				
			||||||
    for (Handle handle : thread_queue) {
 | 
					    for (Thread* thread : thread_list) {
 | 
				
			||||||
        Thread* thread = g_handle_table.Get<Thread>(handle);
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
        if (!CheckWaitType(thread, WAITTYPE_ARB, arbiter, address))
 | 
					        if (!CheckWaitType(thread, WAITTYPE_ARB, arbiter, address))
 | 
				
			||||||
            continue;
 | 
					            continue;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
@ -224,31 +151,31 @@ Handle ArbitrateHighestPriorityThread(u32 arbiter, u32 address) {
 | 
				
			|||||||
            continue; // TODO(yuriks): Thread handle will hang around forever. Should clean up.
 | 
					            continue; // TODO(yuriks): Thread handle will hang around forever. Should clean up.
 | 
				
			||||||
 | 
					
 | 
				
			||||||
        if(thread->current_priority <= priority) {
 | 
					        if(thread->current_priority <= priority) {
 | 
				
			||||||
            highest_priority_thread = handle;
 | 
					            highest_priority_thread = thread;
 | 
				
			||||||
            priority = thread->current_priority;
 | 
					            priority = thread->current_priority;
 | 
				
			||||||
        }
 | 
					        }
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    // If a thread was arbitrated, resume it
 | 
					    // If a thread was arbitrated, resume it
 | 
				
			||||||
    if (0 != highest_priority_thread)
 | 
					    if (nullptr != highest_priority_thread) {
 | 
				
			||||||
        ResumeThreadFromWait(highest_priority_thread);
 | 
					        highest_priority_thread->ResumeFromWait();
 | 
				
			||||||
 | 
					    }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    return highest_priority_thread;
 | 
					    return highest_priority_thread;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Arbitrate all threads currently waiting
 | 
					/// Arbitrate all threads currently waiting
 | 
				
			||||||
void ArbitrateAllThreads(u32 arbiter, u32 address) {
 | 
					void ArbitrateAllThreads(Object* arbiter, u32 address) {
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    // Iterate through threads, find highest priority thread that is waiting to be arbitrated...
 | 
					    // Iterate through threads, find highest priority thread that is waiting to be arbitrated...
 | 
				
			||||||
    for (Handle handle : thread_queue) {
 | 
					    for (Thread* thread : thread_list) {
 | 
				
			||||||
        Thread* thread = g_handle_table.Get<Thread>(handle);
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
        if (CheckWaitType(thread, WAITTYPE_ARB, arbiter, address))
 | 
					        if (CheckWaitType(thread, WAITTYPE_ARB, arbiter, address))
 | 
				
			||||||
            ResumeThreadFromWait(handle);
 | 
					            thread->ResumeFromWait();
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Calls a thread by marking it as "ready" (note: will not actually execute until current thread yields)
 | 
					/// Calls a thread by marking it as "ready" (note: will not actually execute until current thread yields)
 | 
				
			||||||
void CallThread(Thread* t) {
 | 
					static void CallThread(Thread* t) {
 | 
				
			||||||
    // Stop waiting
 | 
					    // Stop waiting
 | 
				
			||||||
    if (t->wait_type != WAITTYPE_NONE) {
 | 
					    if (t->wait_type != WAITTYPE_NONE) {
 | 
				
			||||||
        t->wait_type = WAITTYPE_NONE;
 | 
					        t->wait_type = WAITTYPE_NONE;
 | 
				
			||||||
@ -257,12 +184,12 @@ void CallThread(Thread* t) {
 | 
				
			|||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Switches CPU context to that of the specified thread
 | 
					/// Switches CPU context to that of the specified thread
 | 
				
			||||||
void SwitchContext(Thread* t) {
 | 
					static void SwitchContext(Thread* t) {
 | 
				
			||||||
    Thread* cur = GetCurrentThread();
 | 
					    Thread* cur = GetCurrentThread();
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    // Save context for current thread
 | 
					    // Save context for current thread
 | 
				
			||||||
    if (cur) {
 | 
					    if (cur) {
 | 
				
			||||||
        SaveContext(cur->context);
 | 
					        Core::g_app_core->SaveContext(cur->context);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
        if (cur->IsRunning()) {
 | 
					        if (cur->IsRunning()) {
 | 
				
			||||||
            ChangeReadyState(cur, true);
 | 
					            ChangeReadyState(cur, true);
 | 
				
			||||||
@ -270,19 +197,19 @@ void SwitchContext(Thread* t) {
 | 
				
			|||||||
    }
 | 
					    }
 | 
				
			||||||
    // Load context of new thread
 | 
					    // Load context of new thread
 | 
				
			||||||
    if (t) {
 | 
					    if (t) {
 | 
				
			||||||
        SetCurrentThread(t);
 | 
					        current_thread = t;
 | 
				
			||||||
        ChangeReadyState(t, false);
 | 
					        ChangeReadyState(t, false);
 | 
				
			||||||
        t->status = (t->status | THREADSTATUS_RUNNING) & ~THREADSTATUS_READY;
 | 
					        t->status = (t->status | THREADSTATUS_RUNNING) & ~THREADSTATUS_READY;
 | 
				
			||||||
        t->wait_type = WAITTYPE_NONE;
 | 
					        t->wait_type = WAITTYPE_NONE;
 | 
				
			||||||
        LoadContext(t->context);
 | 
					        Core::g_app_core->LoadContext(t->context);
 | 
				
			||||||
    } else {
 | 
					    } else {
 | 
				
			||||||
        SetCurrentThread(nullptr);
 | 
					        current_thread = nullptr;
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Gets the next thread that is ready to be run by priority
 | 
					/// Gets the next thread that is ready to be run by priority
 | 
				
			||||||
Thread* NextThread() {
 | 
					static Thread* NextThread() {
 | 
				
			||||||
    Handle next;
 | 
					    Thread* next;
 | 
				
			||||||
    Thread* cur = GetCurrentThread();
 | 
					    Thread* cur = GetCurrentThread();
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    if (cur && cur->IsRunning()) {
 | 
					    if (cur && cur->IsRunning()) {
 | 
				
			||||||
@ -293,18 +220,18 @@ Thread* NextThread() {
 | 
				
			|||||||
    if (next == 0) {
 | 
					    if (next == 0) {
 | 
				
			||||||
        return nullptr;
 | 
					        return nullptr;
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
    return Kernel::g_handle_table.Get<Thread>(next);
 | 
					    return next;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
void WaitCurrentThread(WaitType wait_type, Handle wait_handle) {
 | 
					void WaitCurrentThread(WaitType wait_type, Object* wait_object) {
 | 
				
			||||||
    Thread* thread = GetCurrentThread();
 | 
					    Thread* thread = GetCurrentThread();
 | 
				
			||||||
    thread->wait_type = wait_type;
 | 
					    thread->wait_type = wait_type;
 | 
				
			||||||
    thread->wait_handle = wait_handle;
 | 
					    thread->wait_object = wait_object;
 | 
				
			||||||
    ChangeThreadState(thread, ThreadStatus(THREADSTATUS_WAIT | (thread->status & THREADSTATUS_SUSPEND)));
 | 
					    ChangeThreadState(thread, ThreadStatus(THREADSTATUS_WAIT | (thread->status & THREADSTATUS_SUSPEND)));
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
void WaitCurrentThread(WaitType wait_type, Handle wait_handle, VAddr wait_address) {
 | 
					void WaitCurrentThread(WaitType wait_type, Object* wait_object, VAddr wait_address) {
 | 
				
			||||||
    WaitCurrentThread(wait_type, wait_handle);
 | 
					    WaitCurrentThread(wait_type, wait_object);
 | 
				
			||||||
    GetCurrentThread()->wait_address = wait_address;
 | 
					    GetCurrentThread()->wait_address = wait_address;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
@ -320,67 +247,84 @@ static void ThreadWakeupCallback(u64 parameter, int cycles_late) {
 | 
				
			|||||||
        return;
 | 
					        return;
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    Kernel::ResumeThreadFromWait(handle);
 | 
					    thread->ResumeFromWait();
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					
 | 
				
			||||||
void WakeThreadAfterDelay(Handle handle, s64 nanoseconds) {
 | 
					void WakeThreadAfterDelay(Thread* thread, s64 nanoseconds) {
 | 
				
			||||||
    // Don't schedule a wakeup if the thread wants to wait forever
 | 
					    // Don't schedule a wakeup if the thread wants to wait forever
 | 
				
			||||||
    if (nanoseconds == -1)
 | 
					    if (nanoseconds == -1)
 | 
				
			||||||
        return;
 | 
					        return;
 | 
				
			||||||
 | 
					    _dbg_assert_(Kernel, thread != nullptr);
 | 
				
			||||||
    Thread* thread = Kernel::g_handle_table.Get<Thread>(handle);
 | 
					 | 
				
			||||||
    if (thread == nullptr) {
 | 
					 | 
				
			||||||
        LOG_ERROR(Kernel, "Thread doesn't exist %u", handle);
 | 
					 | 
				
			||||||
        return;
 | 
					 | 
				
			||||||
    }
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
    u64 microseconds = nanoseconds / 1000;
 | 
					    u64 microseconds = nanoseconds / 1000;
 | 
				
			||||||
    CoreTiming::ScheduleEvent(usToCycles(microseconds), ThreadWakeupEventType, handle);
 | 
					    CoreTiming::ScheduleEvent(usToCycles(microseconds), ThreadWakeupEventType, thread->GetHandle());
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Resumes a thread from waiting by marking it as "ready"
 | 
					/// Resumes a thread from waiting by marking it as "ready"
 | 
				
			||||||
void ResumeThreadFromWait(Handle handle) {
 | 
					void Thread::ResumeFromWait() {
 | 
				
			||||||
    Thread* thread = Kernel::g_handle_table.Get<Thread>(handle);
 | 
					    status &= ~THREADSTATUS_WAIT;
 | 
				
			||||||
    if (thread) {
 | 
					    wait_object = nullptr;
 | 
				
			||||||
        thread->status &= ~THREADSTATUS_WAIT;
 | 
					    wait_type = WAITTYPE_NONE;
 | 
				
			||||||
        thread->wait_handle = 0;
 | 
					    if (!(status & (THREADSTATUS_WAITSUSPEND | THREADSTATUS_DORMANT | THREADSTATUS_DEAD))) {
 | 
				
			||||||
        thread->wait_type = WAITTYPE_NONE;
 | 
					        ChangeReadyState(this, true);
 | 
				
			||||||
        if (!(thread->status & (THREADSTATUS_WAITSUSPEND | THREADSTATUS_DORMANT | THREADSTATUS_DEAD))) {
 | 
					 | 
				
			||||||
            ChangeReadyState(thread, true);
 | 
					 | 
				
			||||||
        }
 | 
					 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Prints the thread queue for debugging purposes
 | 
					/// Prints the thread queue for debugging purposes
 | 
				
			||||||
void DebugThreadQueue() {
 | 
					static void DebugThreadQueue() {
 | 
				
			||||||
    Thread* thread = GetCurrentThread();
 | 
					    Thread* thread = GetCurrentThread();
 | 
				
			||||||
    if (!thread) {
 | 
					    if (!thread) {
 | 
				
			||||||
        return;
 | 
					        return;
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
    LOG_DEBUG(Kernel, "0x%02X 0x%08X (current)", thread->current_priority, GetCurrentThreadHandle());
 | 
					    LOG_DEBUG(Kernel, "0x%02X 0x%08X (current)", thread->current_priority, GetCurrentThread()->GetHandle());
 | 
				
			||||||
    for (u32 i = 0; i < thread_queue.size(); i++) {
 | 
					    for (Thread* t : thread_list) {
 | 
				
			||||||
        Handle handle = thread_queue[i];
 | 
					        s32 priority = thread_ready_queue.contains(t);
 | 
				
			||||||
        s32 priority = thread_ready_queue.contains(handle);
 | 
					 | 
				
			||||||
        if (priority != -1) {
 | 
					        if (priority != -1) {
 | 
				
			||||||
            LOG_DEBUG(Kernel, "0x%02X 0x%08X", priority, handle);
 | 
					            LOG_DEBUG(Kernel, "0x%02X 0x%08X", priority, t->GetHandle());
 | 
				
			||||||
        }
 | 
					        }
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Creates a new thread
 | 
					ResultVal<Thread*> Thread::Create(const char* name, u32 entry_point, s32 priority, u32 arg,
 | 
				
			||||||
Thread* CreateThread(Handle& handle, const char* name, u32 entry_point, s32 priority,
 | 
					 | 
				
			||||||
        s32 processor_id, u32 stack_top, int stack_size) {
 | 
					        s32 processor_id, u32 stack_top, int stack_size) {
 | 
				
			||||||
 | 
					    _dbg_assert_(Kernel, name != nullptr);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    _assert_msg_(KERNEL, (priority >= THREADPRIO_HIGHEST && priority <= THREADPRIO_LOWEST),
 | 
					    if ((u32)stack_size < 0x200) {
 | 
				
			||||||
        "priority=%d, outside of allowable range!", priority)
 | 
					        LOG_ERROR(Kernel, "(name=%s): invalid stack_size=0x%08X", name, stack_size);
 | 
				
			||||||
 | 
					        // TODO: Verify error
 | 
				
			||||||
 | 
					        return ResultCode(ErrorDescription::InvalidSize, ErrorModule::Kernel,
 | 
				
			||||||
 | 
					                ErrorSummary::InvalidArgument, ErrorLevel::Permanent);
 | 
				
			||||||
 | 
					    }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    if (priority < THREADPRIO_HIGHEST || priority > THREADPRIO_LOWEST) {
 | 
				
			||||||
 | 
					        s32 new_priority = CLAMP(priority, THREADPRIO_HIGHEST, THREADPRIO_LOWEST);
 | 
				
			||||||
 | 
					        LOG_WARNING(Kernel_SVC, "(name=%s): invalid priority=%d, clamping to %d",
 | 
				
			||||||
 | 
					            name, priority, new_priority);
 | 
				
			||||||
 | 
					        // TODO(bunnei): Clamping to a valid priority is not necessarily correct behavior... Confirm
 | 
				
			||||||
 | 
					        // validity of this
 | 
				
			||||||
 | 
					        priority = new_priority;
 | 
				
			||||||
 | 
					    }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    if (!Memory::GetPointer(entry_point)) {
 | 
				
			||||||
 | 
					        LOG_ERROR(Kernel_SVC, "(name=%s): invalid entry %08x", name, entry_point);
 | 
				
			||||||
 | 
					        // TODO: Verify error
 | 
				
			||||||
 | 
					        return ResultCode(ErrorDescription::InvalidAddress, ErrorModule::Kernel,
 | 
				
			||||||
 | 
					                ErrorSummary::InvalidArgument, ErrorLevel::Permanent);
 | 
				
			||||||
 | 
					    }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    Thread* thread = new Thread;
 | 
					    Thread* thread = new Thread;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    // TOOD(yuriks): Fix error reporting
 | 
					    // TODO(yuriks): Thread requires a handle to be inserted into the various scheduling queues for
 | 
				
			||||||
    handle = Kernel::g_handle_table.Create(thread).ValueOr(INVALID_HANDLE);
 | 
					    //               the time being. Create a handle here, it will be copied to the handle field in
 | 
				
			||||||
 | 
					    //               the object and use by the rest of the code. This should be removed when other
 | 
				
			||||||
 | 
					    //               code doesn't rely on the handle anymore.
 | 
				
			||||||
 | 
					    ResultVal<Handle> handle = Kernel::g_handle_table.Create(thread);
 | 
				
			||||||
 | 
					    // TODO(yuriks): Plug memory leak
 | 
				
			||||||
 | 
					    if (handle.Failed())
 | 
				
			||||||
 | 
					        return handle.Code();
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    thread_queue.push_back(handle);
 | 
					    thread_list.push_back(thread);
 | 
				
			||||||
    thread_ready_queue.prepare(priority);
 | 
					    thread_ready_queue.prepare(priority);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    thread->thread_id = next_thread_id++;
 | 
					    thread->thread_id = next_thread_id++;
 | 
				
			||||||
@ -391,69 +335,18 @@ Thread* CreateThread(Handle& handle, const char* name, u32 entry_point, s32 prio
 | 
				
			|||||||
    thread->initial_priority = thread->current_priority = priority;
 | 
					    thread->initial_priority = thread->current_priority = priority;
 | 
				
			||||||
    thread->processor_id = processor_id;
 | 
					    thread->processor_id = processor_id;
 | 
				
			||||||
    thread->wait_type = WAITTYPE_NONE;
 | 
					    thread->wait_type = WAITTYPE_NONE;
 | 
				
			||||||
    thread->wait_handle = 0;
 | 
					    thread->wait_object = nullptr;
 | 
				
			||||||
    thread->wait_address = 0;
 | 
					    thread->wait_address = 0;
 | 
				
			||||||
    thread->name = name;
 | 
					    thread->name = name;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    return thread;
 | 
					 | 
				
			||||||
}
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
/// Creates a new thread - wrapper for external user
 | 
					 | 
				
			||||||
Handle CreateThread(const char* name, u32 entry_point, s32 priority, u32 arg, s32 processor_id,
 | 
					 | 
				
			||||||
    u32 stack_top, int stack_size) {
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    if (name == nullptr) {
 | 
					 | 
				
			||||||
        LOG_ERROR(Kernel_SVC, "nullptr name");
 | 
					 | 
				
			||||||
        return -1;
 | 
					 | 
				
			||||||
    }
 | 
					 | 
				
			||||||
    if ((u32)stack_size < 0x200) {
 | 
					 | 
				
			||||||
        LOG_ERROR(Kernel_SVC, "(name=%s): invalid stack_size=0x%08X", name,
 | 
					 | 
				
			||||||
            stack_size);
 | 
					 | 
				
			||||||
        return -1;
 | 
					 | 
				
			||||||
    }
 | 
					 | 
				
			||||||
    if (priority < THREADPRIO_HIGHEST || priority > THREADPRIO_LOWEST) {
 | 
					 | 
				
			||||||
        s32 new_priority = CLAMP(priority, THREADPRIO_HIGHEST, THREADPRIO_LOWEST);
 | 
					 | 
				
			||||||
        LOG_WARNING(Kernel_SVC, "(name=%s): invalid priority=%d, clamping to %d",
 | 
					 | 
				
			||||||
            name, priority, new_priority);
 | 
					 | 
				
			||||||
        // TODO(bunnei): Clamping to a valid priority is not necessarily correct behavior... Confirm
 | 
					 | 
				
			||||||
        // validity of this
 | 
					 | 
				
			||||||
        priority = new_priority;
 | 
					 | 
				
			||||||
    }
 | 
					 | 
				
			||||||
    if (!Memory::GetPointer(entry_point)) {
 | 
					 | 
				
			||||||
        LOG_ERROR(Kernel_SVC, "(name=%s): invalid entry %08x", name, entry_point);
 | 
					 | 
				
			||||||
        return -1;
 | 
					 | 
				
			||||||
    }
 | 
					 | 
				
			||||||
    Handle handle;
 | 
					 | 
				
			||||||
    Thread* thread = CreateThread(handle, name, entry_point, priority, processor_id, stack_top,
 | 
					 | 
				
			||||||
        stack_size);
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    ResetThread(thread, arg, 0);
 | 
					    ResetThread(thread, arg, 0);
 | 
				
			||||||
    CallThread(thread);
 | 
					    CallThread(thread);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    return handle;
 | 
					    return MakeResult<Thread*>(thread);
 | 
				
			||||||
}
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
/// Get the priority of the thread specified by handle
 | 
					 | 
				
			||||||
ResultVal<u32> GetThreadPriority(const Handle handle) {
 | 
					 | 
				
			||||||
    Thread* thread = g_handle_table.Get<Thread>(handle);
 | 
					 | 
				
			||||||
    if (thread == nullptr) return InvalidHandle(ErrorModule::Kernel);
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    return MakeResult<u32>(thread->current_priority);
 | 
					 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Set the priority of the thread specified by handle
 | 
					/// Set the priority of the thread specified by handle
 | 
				
			||||||
ResultCode SetThreadPriority(Handle handle, s32 priority) {
 | 
					void Thread::SetPriority(s32 priority) {
 | 
				
			||||||
    Thread* thread = nullptr;
 | 
					 | 
				
			||||||
    if (!handle) {
 | 
					 | 
				
			||||||
        thread = GetCurrentThread(); // TODO(bunnei): Is this correct behavior?
 | 
					 | 
				
			||||||
    } else {
 | 
					 | 
				
			||||||
        thread = g_handle_table.Get<Thread>(handle);
 | 
					 | 
				
			||||||
        if (thread == nullptr) {
 | 
					 | 
				
			||||||
            return InvalidHandle(ErrorModule::Kernel);
 | 
					 | 
				
			||||||
        }
 | 
					 | 
				
			||||||
    }
 | 
					 | 
				
			||||||
    _assert_msg_(KERNEL, (thread != nullptr), "called, but thread is nullptr!");
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    // If priority is invalid, clamp to valid range
 | 
					    // If priority is invalid, clamp to valid range
 | 
				
			||||||
    if (priority < THREADPRIO_HIGHEST || priority > THREADPRIO_LOWEST) {
 | 
					    if (priority < THREADPRIO_HIGHEST || priority > THREADPRIO_LOWEST) {
 | 
				
			||||||
        s32 new_priority = CLAMP(priority, THREADPRIO_HIGHEST, THREADPRIO_LOWEST);
 | 
					        s32 new_priority = CLAMP(priority, THREADPRIO_HIGHEST, THREADPRIO_LOWEST);
 | 
				
			||||||
@ -464,38 +357,39 @@ ResultCode SetThreadPriority(Handle handle, s32 priority) {
 | 
				
			|||||||
    }
 | 
					    }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    // Change thread priority
 | 
					    // Change thread priority
 | 
				
			||||||
    s32 old = thread->current_priority;
 | 
					    s32 old = current_priority;
 | 
				
			||||||
    thread_ready_queue.remove(old, handle);
 | 
					    thread_ready_queue.remove(old, this);
 | 
				
			||||||
    thread->current_priority = priority;
 | 
					    current_priority = priority;
 | 
				
			||||||
    thread_ready_queue.prepare(thread->current_priority);
 | 
					    thread_ready_queue.prepare(current_priority);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    // Change thread status to "ready" and push to ready queue
 | 
					    // Change thread status to "ready" and push to ready queue
 | 
				
			||||||
    if (thread->IsRunning()) {
 | 
					    if (IsRunning()) {
 | 
				
			||||||
        thread->status = (thread->status & ~THREADSTATUS_RUNNING) | THREADSTATUS_READY;
 | 
					        status = (status & ~THREADSTATUS_RUNNING) | THREADSTATUS_READY;
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
    if (thread->IsReady()) {
 | 
					    if (IsReady()) {
 | 
				
			||||||
        thread_ready_queue.push_back(thread->current_priority, handle);
 | 
					        thread_ready_queue.push_back(current_priority, this);
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
 | 
					 | 
				
			||||||
    return RESULT_SUCCESS;
 | 
					 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
Handle SetupIdleThread() {
 | 
					Handle SetupIdleThread() {
 | 
				
			||||||
    Handle handle;
 | 
					    // We need to pass a few valid values to get around parameter checking in Thread::Create.
 | 
				
			||||||
    Thread* thread = CreateThread(handle, "idle", 0, THREADPRIO_LOWEST, THREADPROCESSORID_0, 0, 0);
 | 
					    auto thread_res = Thread::Create("idle", Memory::KERNEL_MEMORY_VADDR, THREADPRIO_LOWEST, 0,
 | 
				
			||||||
 | 
					            THREADPROCESSORID_0, 0, Kernel::DEFAULT_STACK_SIZE);
 | 
				
			||||||
 | 
					    _dbg_assert_(Kernel, thread_res.Succeeded());
 | 
				
			||||||
 | 
					    Thread* thread = *thread_res;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    thread->idle = true;
 | 
					    thread->idle = true;
 | 
				
			||||||
    CallThread(thread);
 | 
					    CallThread(thread);
 | 
				
			||||||
    return handle;
 | 
					    return thread->GetHandle();
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
Handle SetupMainThread(s32 priority, int stack_size) {
 | 
					Thread* SetupMainThread(s32 priority, int stack_size) {
 | 
				
			||||||
    Handle handle;
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    // Initialize new "main" thread
 | 
					    // Initialize new "main" thread
 | 
				
			||||||
    Thread* thread = CreateThread(handle, "main", Core::g_app_core->GetPC(), priority,
 | 
					    ResultVal<Thread*> thread_res = Thread::Create("main", Core::g_app_core->GetPC(), priority, 0,
 | 
				
			||||||
        THREADPROCESSORID_0, Memory::SCRATCHPAD_VADDR_END, stack_size);
 | 
					        THREADPROCESSORID_0, Memory::SCRATCHPAD_VADDR_END, stack_size);
 | 
				
			||||||
 | 
					    // TODO(yuriks): Propagate error
 | 
				
			||||||
    ResetThread(thread, 0, 0);
 | 
					    _dbg_assert_(Kernel, thread_res.Succeeded());
 | 
				
			||||||
 | 
					    Thread* thread = *thread_res;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    // If running another thread already, set it to "ready" state
 | 
					    // If running another thread already, set it to "ready" state
 | 
				
			||||||
    Thread* cur = GetCurrentThread();
 | 
					    Thread* cur = GetCurrentThread();
 | 
				
			||||||
@ -504,11 +398,11 @@ Handle SetupMainThread(s32 priority, int stack_size) {
 | 
				
			|||||||
    }
 | 
					    }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    // Run new "main" thread
 | 
					    // Run new "main" thread
 | 
				
			||||||
    SetCurrentThread(thread);
 | 
					    current_thread = thread;
 | 
				
			||||||
    thread->status = THREADSTATUS_RUNNING;
 | 
					    thread->status = THREADSTATUS_RUNNING;
 | 
				
			||||||
    LoadContext(thread->context);
 | 
					    Core::g_app_core->LoadContext(thread->context);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    return handle;
 | 
					    return thread;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					
 | 
				
			||||||
@ -524,34 +418,14 @@ void Reschedule() {
 | 
				
			|||||||
    } else {
 | 
					    } else {
 | 
				
			||||||
        LOG_TRACE(Kernel, "cannot context switch from 0x%08X, no higher priority thread!", prev->GetHandle());
 | 
					        LOG_TRACE(Kernel, "cannot context switch from 0x%08X, no higher priority thread!", prev->GetHandle());
 | 
				
			||||||
 | 
					
 | 
				
			||||||
        for (Handle handle : thread_queue) {
 | 
					        for (Thread* thread : thread_list) {
 | 
				
			||||||
            Thread* thread = g_handle_table.Get<Thread>(handle);
 | 
					 | 
				
			||||||
            LOG_TRACE(Kernel, "\thandle=0x%08X prio=0x%02X, status=0x%08X wait_type=0x%08X wait_handle=0x%08X",
 | 
					            LOG_TRACE(Kernel, "\thandle=0x%08X prio=0x%02X, status=0x%08X wait_type=0x%08X wait_handle=0x%08X",
 | 
				
			||||||
                thread->GetHandle(), thread->current_priority, thread->status, thread->wait_type, thread->wait_handle);
 | 
					                thread->GetHandle(), thread->current_priority, thread->status, thread->wait_type,
 | 
				
			||||||
 | 
					                (thread->wait_object ? thread->wait_object->GetHandle() : INVALID_HANDLE));
 | 
				
			||||||
        }
 | 
					        }
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
bool IsIdleThread(Handle handle) {
 | 
					 | 
				
			||||||
    Thread* thread = g_handle_table.Get<Thread>(handle);
 | 
					 | 
				
			||||||
    if (!thread) {
 | 
					 | 
				
			||||||
        LOG_ERROR(Kernel, "Thread not found %u", handle);
 | 
					 | 
				
			||||||
        return false;
 | 
					 | 
				
			||||||
    }
 | 
					 | 
				
			||||||
    return thread->IsIdle();
 | 
					 | 
				
			||||||
}
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
ResultCode GetThreadId(u32* thread_id, Handle handle) {
 | 
					 | 
				
			||||||
    Thread* thread = g_handle_table.Get<Thread>(handle);
 | 
					 | 
				
			||||||
    if (thread == nullptr)
 | 
					 | 
				
			||||||
        return ResultCode(ErrorDescription::InvalidHandle, ErrorModule::OS, 
 | 
					 | 
				
			||||||
                          ErrorSummary::WrongArgument, ErrorLevel::Permanent);
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    *thread_id = thread->thread_id;
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    return RESULT_SUCCESS;
 | 
					 | 
				
			||||||
}
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
////////////////////////////////////////////////////////////////////////////////////////////////////
 | 
					////////////////////////////////////////////////////////////////////////////////////////////////////
 | 
				
			||||||
 | 
					
 | 
				
			||||||
void ThreadingInit() {
 | 
					void ThreadingInit() {
 | 
				
			||||||
 | 
				
			|||||||
@ -4,8 +4,12 @@
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
#pragma once
 | 
					#pragma once
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include <string>
 | 
				
			||||||
 | 
					#include <vector>
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#include "common/common_types.h"
 | 
					#include "common/common_types.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include "core/core.h"
 | 
				
			||||||
#include "core/mem_map.h"
 | 
					#include "core/mem_map.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#include "core/hle/kernel/kernel.h"
 | 
					#include "core/hle/kernel/kernel.h"
 | 
				
			||||||
@ -48,69 +52,102 @@ enum WaitType {
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
namespace Kernel {
 | 
					namespace Kernel {
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Creates a new thread - wrapper for external user
 | 
					class Thread : public Kernel::Object {
 | 
				
			||||||
Handle CreateThread(const char* name, u32 entry_point, s32 priority, u32 arg, s32 processor_id,
 | 
					public:
 | 
				
			||||||
    u32 stack_top, int stack_size=Kernel::DEFAULT_STACK_SIZE);
 | 
					    static ResultVal<Thread*> Create(const char* name, u32 entry_point, s32 priority, u32 arg,
 | 
				
			||||||
 | 
					        s32 processor_id, u32 stack_top, int stack_size = Kernel::DEFAULT_STACK_SIZE);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    std::string GetName() const override { return name; }
 | 
				
			||||||
 | 
					    std::string GetTypeName() const override { return "Thread"; }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    static const HandleType HANDLE_TYPE = HandleType::Thread;
 | 
				
			||||||
 | 
					    HandleType GetHandleType() const override { return HANDLE_TYPE; }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    inline bool IsRunning() const { return (status & THREADSTATUS_RUNNING) != 0; }
 | 
				
			||||||
 | 
					    inline bool IsStopped() const { return (status & THREADSTATUS_DORMANT) != 0; }
 | 
				
			||||||
 | 
					    inline bool IsReady() const { return (status & THREADSTATUS_READY) != 0; }
 | 
				
			||||||
 | 
					    inline bool IsWaiting() const { return (status & THREADSTATUS_WAIT) != 0; }
 | 
				
			||||||
 | 
					    inline bool IsSuspended() const { return (status & THREADSTATUS_SUSPEND) != 0; }
 | 
				
			||||||
 | 
					    inline bool IsIdle() const { return idle; }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    ResultVal<bool> WaitSynchronization() override;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    s32 GetPriority() const { return current_priority; }
 | 
				
			||||||
 | 
					    void SetPriority(s32 priority);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    u32 GetThreadId() const { return thread_id; }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    void Stop(const char* reason);
 | 
				
			||||||
 | 
					    /// Resumes a thread from waiting by marking it as "ready".
 | 
				
			||||||
 | 
					    void ResumeFromWait();
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    Core::ThreadContext context;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    u32 thread_id;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    u32 status;
 | 
				
			||||||
 | 
					    u32 entry_point;
 | 
				
			||||||
 | 
					    u32 stack_top;
 | 
				
			||||||
 | 
					    u32 stack_size;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    s32 initial_priority;
 | 
				
			||||||
 | 
					    s32 current_priority;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    s32 processor_id;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    WaitType wait_type;
 | 
				
			||||||
 | 
					    Object* wait_object;
 | 
				
			||||||
 | 
					    VAddr wait_address;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    std::vector<Thread*> waiting_threads; // TODO(yuriks): Owned
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    std::string name;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    /// Whether this thread is intended to never actually be executed, i.e. always idle
 | 
				
			||||||
 | 
					    bool idle = false;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					private:
 | 
				
			||||||
 | 
					    Thread() = default;
 | 
				
			||||||
 | 
					};
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Sets up the primary application thread
 | 
					/// Sets up the primary application thread
 | 
				
			||||||
Handle SetupMainThread(s32 priority, int stack_size=Kernel::DEFAULT_STACK_SIZE);
 | 
					Thread* SetupMainThread(s32 priority, int stack_size = Kernel::DEFAULT_STACK_SIZE);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Reschedules to the next available thread (call after current thread is suspended)
 | 
					/// Reschedules to the next available thread (call after current thread is suspended)
 | 
				
			||||||
void Reschedule();
 | 
					void Reschedule();
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Stops the current thread
 | 
					 | 
				
			||||||
ResultCode StopThread(Handle thread, const char* reason);
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
/**
 | 
					 | 
				
			||||||
 * Retrieves the ID of the specified thread handle
 | 
					 | 
				
			||||||
 * @param thread_id Will contain the output thread id
 | 
					 | 
				
			||||||
 * @param handle Handle to the thread we want
 | 
					 | 
				
			||||||
 * @return Whether the function was successful or not
 | 
					 | 
				
			||||||
 */
 | 
					 | 
				
			||||||
ResultCode GetThreadId(u32* thread_id, Handle handle);
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
/// Resumes a thread from waiting by marking it as "ready"
 | 
					 | 
				
			||||||
void ResumeThreadFromWait(Handle handle);
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
/// Arbitrate the highest priority thread that is waiting
 | 
					/// Arbitrate the highest priority thread that is waiting
 | 
				
			||||||
Handle ArbitrateHighestPriorityThread(u32 arbiter, u32 address);
 | 
					Thread* ArbitrateHighestPriorityThread(Object* arbiter, u32 address);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Arbitrate all threads currently waiting...
 | 
					/// Arbitrate all threads currently waiting...
 | 
				
			||||||
void ArbitrateAllThreads(u32 arbiter, u32 address);
 | 
					void ArbitrateAllThreads(Object* arbiter, u32 address);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Gets the current thread handle
 | 
					/// Gets the current thread
 | 
				
			||||||
Handle GetCurrentThreadHandle();
 | 
					Thread* GetCurrentThread();
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/**
 | 
					/**
 | 
				
			||||||
 * Puts the current thread in the wait state for the given type
 | 
					 * Puts the current thread in the wait state for the given type
 | 
				
			||||||
 * @param wait_type Type of wait
 | 
					 * @param wait_type Type of wait
 | 
				
			||||||
 * @param wait_handle Handle of Kernel object that we are waiting on, defaults to current thread
 | 
					 * @param wait_object Kernel object that we are waiting on, defaults to current thread
 | 
				
			||||||
 */
 | 
					 */
 | 
				
			||||||
void WaitCurrentThread(WaitType wait_type, Handle wait_handle=GetCurrentThreadHandle());
 | 
					void WaitCurrentThread(WaitType wait_type, Object* wait_object = GetCurrentThread());
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/**
 | 
					/**
 | 
				
			||||||
 * Schedules an event to wake up the specified thread after the specified delay.
 | 
					 * Schedules an event to wake up the specified thread after the specified delay.
 | 
				
			||||||
 * @param handle The thread handle.
 | 
					 * @param handle The thread handle.
 | 
				
			||||||
 * @param nanoseconds The time this thread will be allowed to sleep for.
 | 
					 * @param nanoseconds The time this thread will be allowed to sleep for.
 | 
				
			||||||
 */
 | 
					 */
 | 
				
			||||||
void WakeThreadAfterDelay(Handle handle, s64 nanoseconds);
 | 
					void WakeThreadAfterDelay(Thread* thread, s64 nanoseconds);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/**
 | 
					/**
 | 
				
			||||||
 * Puts the current thread in the wait state for the given type
 | 
					 * Puts the current thread in the wait state for the given type
 | 
				
			||||||
 * @param wait_type Type of wait
 | 
					 * @param wait_type Type of wait
 | 
				
			||||||
 * @param wait_handle Handle of Kernel object that we are waiting on, defaults to current thread
 | 
					 * @param wait_object Kernel object that we are waiting on
 | 
				
			||||||
 * @param wait_address Arbitration address used to resume from wait
 | 
					 * @param wait_address Arbitration address used to resume from wait
 | 
				
			||||||
 */
 | 
					 */
 | 
				
			||||||
void WaitCurrentThread(WaitType wait_type, Handle wait_handle, VAddr wait_address);
 | 
					void WaitCurrentThread(WaitType wait_type, Object* wait_object, VAddr wait_address);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Put current thread in a wait state - on WaitSynchronization
 | 
					 | 
				
			||||||
void WaitThread_Synchronization();
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Get the priority of the thread specified by handle
 | 
					 | 
				
			||||||
ResultVal<u32> GetThreadPriority(const Handle handle);
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
/// Set the priority of the thread specified by handle
 | 
					 | 
				
			||||||
ResultCode SetThreadPriority(Handle handle, s32 priority);
 | 
					 | 
				
			||||||
 | 
					
 | 
				
			||||||
/**
 | 
					/**
 | 
				
			||||||
 * Sets up the idle thread, this is a thread that is intended to never execute instructions,
 | 
					 * Sets up the idle thread, this is a thread that is intended to never execute instructions,
 | 
				
			||||||
@ -119,10 +156,6 @@ ResultCode SetThreadPriority(Handle handle, s32 priority);
 | 
				
			|||||||
 * @returns The handle of the idle thread
 | 
					 * @returns The handle of the idle thread
 | 
				
			||||||
 */
 | 
					 */
 | 
				
			||||||
Handle SetupIdleThread();
 | 
					Handle SetupIdleThread();
 | 
				
			||||||
 | 
					 | 
				
			||||||
/// Whether the current thread is an idle thread
 | 
					 | 
				
			||||||
bool IsIdleThread(Handle thread);
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
/// Initialize threading
 | 
					/// Initialize threading
 | 
				
			||||||
void ThreadingInit();
 | 
					void ThreadingInit();
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
				
			|||||||
@ -33,8 +33,8 @@ public:
 | 
				
			|||||||
    ResultVal<bool> WaitSynchronization() override {
 | 
					    ResultVal<bool> WaitSynchronization() override {
 | 
				
			||||||
        bool wait = !signaled;
 | 
					        bool wait = !signaled;
 | 
				
			||||||
        if (wait) {
 | 
					        if (wait) {
 | 
				
			||||||
            waiting_threads.insert(GetCurrentThreadHandle());
 | 
					            waiting_threads.insert(GetCurrentThread()->GetHandle());
 | 
				
			||||||
            Kernel::WaitCurrentThread(WAITTYPE_TIMER, GetHandle());
 | 
					            Kernel::WaitCurrentThread(WAITTYPE_TIMER, this);
 | 
				
			||||||
        }
 | 
					        }
 | 
				
			||||||
        return MakeResult<bool>(wait);
 | 
					        return MakeResult<bool>(wait);
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
@ -92,8 +92,10 @@ static void TimerCallback(u64 timer_handle, int cycles_late) {
 | 
				
			|||||||
    timer->signaled = true;
 | 
					    timer->signaled = true;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    // Resume all waiting threads
 | 
					    // Resume all waiting threads
 | 
				
			||||||
    for (Handle thread : timer->waiting_threads)
 | 
					    for (Handle thread_handle : timer->waiting_threads) {
 | 
				
			||||||
        ResumeThreadFromWait(thread);
 | 
					        if (Thread* thread = Kernel::g_handle_table.Get<Thread>(thread_handle))
 | 
				
			||||||
 | 
					            thread->ResumeFromWait();
 | 
				
			||||||
 | 
					    }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    timer->waiting_threads.clear();
 | 
					    timer->waiting_threads.clear();
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
				
			|||||||
@ -4,6 +4,7 @@
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
#include "common/log.h"
 | 
					#include "common/log.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include "core/arm/arm_interface.h"
 | 
				
			||||||
#include "core/hle/hle.h"
 | 
					#include "core/hle/hle.h"
 | 
				
			||||||
#include "core/hle/kernel/event.h"
 | 
					#include "core/hle/kernel/event.h"
 | 
				
			||||||
#include "core/hle/kernel/shared_memory.h"
 | 
					#include "core/hle/kernel/shared_memory.h"
 | 
				
			||||||
 | 
				
			|||||||
@ -7,6 +7,7 @@
 | 
				
			|||||||
#include "common/string_util.h"
 | 
					#include "common/string_util.h"
 | 
				
			||||||
#include "common/symbols.h"
 | 
					#include "common/symbols.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include "core/arm/arm_interface.h"
 | 
				
			||||||
#include "core/mem_map.h"
 | 
					#include "core/mem_map.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#include "core/hle/kernel/address_arbiter.h"
 | 
					#include "core/hle/kernel/address_arbiter.h"
 | 
				
			||||||
@ -230,14 +231,17 @@ static Result CreateThread(u32 priority, u32 entry_point, u32 arg, u32 stack_top
 | 
				
			|||||||
        name = Common::StringFromFormat("unknown-%08x", entry_point);
 | 
					        name = Common::StringFromFormat("unknown-%08x", entry_point);
 | 
				
			||||||
    }
 | 
					    }
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    Handle thread = Kernel::CreateThread(name.c_str(), entry_point, priority, arg, processor_id,
 | 
					    ResultVal<Kernel::Thread*> thread_res = Kernel::Thread::Create(name.c_str(), entry_point, priority, arg,
 | 
				
			||||||
        stack_top);
 | 
					            processor_id, stack_top);
 | 
				
			||||||
 | 
					    if (thread_res.Failed())
 | 
				
			||||||
 | 
					        return thread_res.Code().raw;
 | 
				
			||||||
 | 
					    Kernel::Thread* thread = *thread_res;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    Core::g_app_core->SetReg(1, thread);
 | 
					    Core::g_app_core->SetReg(1, thread->GetHandle());
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    LOG_TRACE(Kernel_SVC, "called entrypoint=0x%08X (%s), arg=0x%08X, stacktop=0x%08X, "
 | 
					    LOG_TRACE(Kernel_SVC, "called entrypoint=0x%08X (%s), arg=0x%08X, stacktop=0x%08X, "
 | 
				
			||||||
        "threadpriority=0x%08X, processorid=0x%08X : created handle=0x%08X", entry_point,
 | 
					        "threadpriority=0x%08X, processorid=0x%08X : created handle=0x%08X", entry_point,
 | 
				
			||||||
        name.c_str(), arg, stack_top, priority, processor_id, thread);
 | 
					        name.c_str(), arg, stack_top, priority, processor_id, thread->GetHandle());
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    if (THREADPROCESSORID_1 == processor_id) {
 | 
					    if (THREADPROCESSORID_1 == processor_id) {
 | 
				
			||||||
        LOG_WARNING(Kernel_SVC,
 | 
					        LOG_WARNING(Kernel_SVC,
 | 
				
			||||||
@ -248,28 +252,31 @@ static Result CreateThread(u32 priority, u32 entry_point, u32 arg, u32 stack_top
 | 
				
			|||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Called when a thread exits
 | 
					/// Called when a thread exits
 | 
				
			||||||
static u32 ExitThread() {
 | 
					static void ExitThread() {
 | 
				
			||||||
    Handle thread = Kernel::GetCurrentThreadHandle();
 | 
					    LOG_TRACE(Kernel_SVC, "called, pc=0x%08X", Core::g_app_core->GetPC());
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    LOG_TRACE(Kernel_SVC, "called, pc=0x%08X", Core::g_app_core->GetPC()); // PC = 0x0010545C
 | 
					    Kernel::GetCurrentThread()->Stop(__func__);
 | 
				
			||||||
 | 
					 | 
				
			||||||
    Kernel::StopThread(thread, __func__);
 | 
					 | 
				
			||||||
    HLE::Reschedule(__func__);
 | 
					    HLE::Reschedule(__func__);
 | 
				
			||||||
    return 0;
 | 
					 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Gets the priority for the specified thread
 | 
					/// Gets the priority for the specified thread
 | 
				
			||||||
static Result GetThreadPriority(s32* priority, Handle handle) {
 | 
					static Result GetThreadPriority(s32* priority, Handle handle) {
 | 
				
			||||||
    ResultVal<u32> priority_result = Kernel::GetThreadPriority(handle);
 | 
					    const Kernel::Thread* thread = Kernel::g_handle_table.Get<Kernel::Thread>(handle);
 | 
				
			||||||
    if (priority_result.Succeeded()) {
 | 
					    if (thread == nullptr)
 | 
				
			||||||
        *priority = *priority_result;
 | 
					        return InvalidHandle(ErrorModule::Kernel).raw;
 | 
				
			||||||
    }
 | 
					
 | 
				
			||||||
    return priority_result.Code().raw;
 | 
					    *priority = thread->GetPriority();
 | 
				
			||||||
 | 
					    return RESULT_SUCCESS.raw;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Sets the priority for the specified thread
 | 
					/// Sets the priority for the specified thread
 | 
				
			||||||
static Result SetThreadPriority(Handle handle, s32 priority) {
 | 
					static Result SetThreadPriority(Handle handle, s32 priority) {
 | 
				
			||||||
    return Kernel::SetThreadPriority(handle, priority).raw;
 | 
					    Kernel::Thread* thread = Kernel::g_handle_table.Get<Kernel::Thread>(handle);
 | 
				
			||||||
 | 
					    if (thread == nullptr)
 | 
				
			||||||
 | 
					        return InvalidHandle(ErrorModule::Kernel).raw;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    thread->SetPriority(priority);
 | 
				
			||||||
 | 
					    return RESULT_SUCCESS.raw;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Create a mutex
 | 
					/// Create a mutex
 | 
				
			||||||
@ -290,8 +297,13 @@ static Result ReleaseMutex(Handle handle) {
 | 
				
			|||||||
/// Get the ID for the specified thread.
 | 
					/// Get the ID for the specified thread.
 | 
				
			||||||
static Result GetThreadId(u32* thread_id, Handle handle) {
 | 
					static Result GetThreadId(u32* thread_id, Handle handle) {
 | 
				
			||||||
    LOG_TRACE(Kernel_SVC, "called thread=0x%08X", handle);
 | 
					    LOG_TRACE(Kernel_SVC, "called thread=0x%08X", handle);
 | 
				
			||||||
    ResultCode result = Kernel::GetThreadId(thread_id, handle);
 | 
					
 | 
				
			||||||
    return result.raw;
 | 
					    const Kernel::Thread* thread = Kernel::g_handle_table.Get<Kernel::Thread>(handle);
 | 
				
			||||||
 | 
					    if (thread == nullptr)
 | 
				
			||||||
 | 
					        return InvalidHandle(ErrorModule::Kernel).raw;
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					    *thread_id = thread->GetThreadId();
 | 
				
			||||||
 | 
					    return RESULT_SUCCESS.raw;
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
 | 
					
 | 
				
			||||||
/// Creates a semaphore
 | 
					/// Creates a semaphore
 | 
				
			||||||
@ -379,7 +391,7 @@ static void SleepThread(s64 nanoseconds) {
 | 
				
			|||||||
    Kernel::WaitCurrentThread(WAITTYPE_SLEEP);
 | 
					    Kernel::WaitCurrentThread(WAITTYPE_SLEEP);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    // Create an event to wake the thread up after the specified nanosecond delay has passed
 | 
					    // Create an event to wake the thread up after the specified nanosecond delay has passed
 | 
				
			||||||
    Kernel::WakeThreadAfterDelay(Kernel::GetCurrentThreadHandle(), nanoseconds);
 | 
					    Kernel::WakeThreadAfterDelay(Kernel::GetCurrentThread(), nanoseconds);
 | 
				
			||||||
 | 
					
 | 
				
			||||||
    HLE::Reschedule(__func__);
 | 
					    HLE::Reschedule(__func__);
 | 
				
			||||||
}
 | 
					}
 | 
				
			||||||
@ -411,7 +423,7 @@ const HLE::FunctionDef SVC_Table[] = {
 | 
				
			|||||||
    {0x06, nullptr,                         "GetProcessIdealProcessor"},
 | 
					    {0x06, nullptr,                         "GetProcessIdealProcessor"},
 | 
				
			||||||
    {0x07, nullptr,                         "SetProcessIdealProcessor"},
 | 
					    {0x07, nullptr,                         "SetProcessIdealProcessor"},
 | 
				
			||||||
    {0x08, HLE::Wrap<CreateThread>,         "CreateThread"},
 | 
					    {0x08, HLE::Wrap<CreateThread>,         "CreateThread"},
 | 
				
			||||||
    {0x09, HLE::Wrap<ExitThread>,           "ExitThread"},
 | 
					    {0x09, ExitThread,                      "ExitThread"},
 | 
				
			||||||
    {0x0A, HLE::Wrap<SleepThread>,          "SleepThread"},
 | 
					    {0x0A, HLE::Wrap<SleepThread>,          "SleepThread"},
 | 
				
			||||||
    {0x0B, HLE::Wrap<GetThreadPriority>,    "GetThreadPriority"},
 | 
					    {0x0B, HLE::Wrap<GetThreadPriority>,    "GetThreadPriority"},
 | 
				
			||||||
    {0x0C, HLE::Wrap<SetThreadPriority>,    "SetThreadPriority"},
 | 
					    {0x0C, HLE::Wrap<SetThreadPriority>,    "SetThreadPriority"},
 | 
				
			||||||
 | 
				
			|||||||
@ -20,21 +20,6 @@ struct PageInfo {
 | 
				
			|||||||
    u32 flags;
 | 
					    u32 flags;
 | 
				
			||||||
};
 | 
					};
 | 
				
			||||||
 | 
					
 | 
				
			||||||
struct ThreadContext {
 | 
					 | 
				
			||||||
    u32 cpu_registers[13];
 | 
					 | 
				
			||||||
    u32 sp;
 | 
					 | 
				
			||||||
    u32 lr;
 | 
					 | 
				
			||||||
    u32 pc;
 | 
					 | 
				
			||||||
    u32 cpsr;
 | 
					 | 
				
			||||||
    u32 fpu_registers[32];
 | 
					 | 
				
			||||||
    u32 fpscr;
 | 
					 | 
				
			||||||
    u32 fpexc;
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
    // These are not part of native ThreadContext, but needed by emu
 | 
					 | 
				
			||||||
    u32 reg_15;
 | 
					 | 
				
			||||||
    u32 mode;
 | 
					 | 
				
			||||||
};
 | 
					 | 
				
			||||||
 | 
					 | 
				
			||||||
enum ResetType {
 | 
					enum ResetType {
 | 
				
			||||||
    RESETTYPE_ONESHOT,
 | 
					    RESETTYPE_ONESHOT,
 | 
				
			||||||
    RESETTYPE_STICKY,
 | 
					    RESETTYPE_STICKY,
 | 
				
			||||||
 | 
				
			|||||||
@ -4,6 +4,8 @@
 | 
				
			|||||||
 | 
					
 | 
				
			||||||
#include "common/common_types.h"
 | 
					#include "common/common_types.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
 | 
					#include "core/arm/arm_interface.h"
 | 
				
			||||||
 | 
					
 | 
				
			||||||
#include "core/settings.h"
 | 
					#include "core/settings.h"
 | 
				
			||||||
#include "core/core.h"
 | 
					#include "core/core.h"
 | 
				
			||||||
#include "core/mem_map.h"
 | 
					#include "core/mem_map.h"
 | 
				
			||||||
 | 
				
			|||||||
		Loading…
	
		Reference in New Issue
	
	Block a user