svc.cpp 31 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849
  1. // Copyright 2018 yuzu emulator team
  2. // Licensed under GPLv2 or any later version
  3. // Refer to the license.txt file included.
  4. #include <algorithm>
  5. #include "common/logging/log.h"
  6. #include "common/microprofile.h"
  7. #include "common/string_util.h"
  8. #include "core/core_timing.h"
  9. #include "core/hle/kernel/client_port.h"
  10. #include "core/hle/kernel/client_session.h"
  11. #include "core/hle/kernel/condition_variable.h"
  12. #include "core/hle/kernel/event.h"
  13. #include "core/hle/kernel/handle_table.h"
  14. #include "core/hle/kernel/mutex.h"
  15. #include "core/hle/kernel/object_address_table.h"
  16. #include "core/hle/kernel/process.h"
  17. #include "core/hle/kernel/resource_limit.h"
  18. #include "core/hle/kernel/svc.h"
  19. #include "core/hle/kernel/svc_wrap.h"
  20. #include "core/hle/kernel/sync_object.h"
  21. #include "core/hle/kernel/thread.h"
  22. #include "core/hle/lock.h"
  23. #include "core/hle/result.h"
  24. #include "core/hle/service/service.h"
  25. namespace Kernel {
  26. /// Set the process heap to a given Size. It can both extend and shrink the heap.
  27. static ResultCode SetHeapSize(VAddr* heap_addr, u64 heap_size) {
  28. LOG_TRACE(Kernel_SVC, "called, heap_size=0x%llx", heap_size);
  29. auto& process = *g_current_process;
  30. CASCADE_RESULT(*heap_addr,
  31. process.HeapAllocate(Memory::HEAP_VADDR, heap_size, VMAPermission::ReadWrite));
  32. return RESULT_SUCCESS;
  33. }
  34. static ResultCode SetMemoryAttribute(VAddr addr, u64 size, u32 state0, u32 state1) {
  35. LOG_WARNING(Kernel_SVC, "(STUBBED) called, addr=0x%llx", addr);
  36. return RESULT_SUCCESS;
  37. }
  38. /// Maps a memory range into a different range.
  39. static ResultCode MapMemory(VAddr dst_addr, VAddr src_addr, u64 size) {
  40. LOG_TRACE(Kernel_SVC, "called, dst_addr=0x%llx, src_addr=0x%llx, size=0x%llx", dst_addr,
  41. src_addr, size);
  42. return g_current_process->MirrorMemory(dst_addr, src_addr, size);
  43. }
  44. /// Unmaps a region that was previously mapped with svcMapMemory
  45. static ResultCode UnmapMemory(VAddr dst_addr, VAddr src_addr, u64 size) {
  46. LOG_TRACE(Kernel_SVC, "called, dst_addr=0x%llx, src_addr=0x%llx, size=0x%llx", dst_addr,
  47. src_addr, size);
  48. return g_current_process->UnmapMemory(dst_addr, src_addr, size);
  49. }
  50. /// Connect to an OS service given the port name, returns the handle to the port to out
  51. static ResultCode ConnectToPort(Handle* out_handle, VAddr port_name_address) {
  52. if (!Memory::IsValidVirtualAddress(port_name_address))
  53. return ERR_NOT_FOUND;
  54. static constexpr std::size_t PortNameMaxLength = 11;
  55. // Read 1 char beyond the max allowed port name to detect names that are too long.
  56. std::string port_name = Memory::ReadCString(port_name_address, PortNameMaxLength + 1);
  57. if (port_name.size() > PortNameMaxLength)
  58. return ERR_PORT_NAME_TOO_LONG;
  59. LOG_TRACE(Kernel_SVC, "called port_name=%s", port_name.c_str());
  60. auto it = Service::g_kernel_named_ports.find(port_name);
  61. if (it == Service::g_kernel_named_ports.end()) {
  62. LOG_WARNING(Kernel_SVC, "tried to connect to unknown port: %s", port_name.c_str());
  63. return ERR_NOT_FOUND;
  64. }
  65. auto client_port = it->second;
  66. SharedPtr<ClientSession> client_session;
  67. CASCADE_RESULT(client_session, client_port->Connect());
  68. // Return the client session
  69. CASCADE_RESULT(*out_handle, g_handle_table.Create(client_session));
  70. return RESULT_SUCCESS;
  71. }
  72. /// Makes a blocking IPC call to an OS service.
  73. static ResultCode SendSyncRequest(Handle handle) {
  74. SharedPtr<SyncObject> session = g_handle_table.Get<SyncObject>(handle);
  75. if (!session) {
  76. LOG_ERROR(Kernel_SVC, "called with invalid handle=0x%08X", handle);
  77. return ERR_INVALID_HANDLE;
  78. }
  79. LOG_TRACE(Kernel_SVC, "called handle=0x%08X(%s)", handle, session->GetName().c_str());
  80. Core::System::GetInstance().PrepareReschedule();
  81. // TODO(Subv): svcSendSyncRequest should put the caller thread to sleep while the server
  82. // responds and cause a reschedule.
  83. return session->SendSyncRequest(GetCurrentThread());
  84. }
  85. /// Get the ID for the specified thread.
  86. static ResultCode GetThreadId(u32* thread_id, Handle thread_handle) {
  87. LOG_TRACE(Kernel_SVC, "called thread=0x%08X", thread_handle);
  88. const SharedPtr<Thread> thread = g_handle_table.Get<Thread>(thread_handle);
  89. if (!thread) {
  90. return ERR_INVALID_HANDLE;
  91. }
  92. *thread_id = thread->GetThreadId();
  93. return RESULT_SUCCESS;
  94. }
  95. /// Get the ID of the specified process
  96. static ResultCode GetProcessId(u32* process_id, Handle process_handle) {
  97. LOG_TRACE(Kernel_SVC, "called process=0x%08X", process_handle);
  98. const SharedPtr<Process> process = g_handle_table.Get<Process>(process_handle);
  99. if (!process) {
  100. return ERR_INVALID_HANDLE;
  101. }
  102. *process_id = process->process_id;
  103. return RESULT_SUCCESS;
  104. }
  105. /// Default thread wakeup callback for WaitSynchronization
  106. static bool DefaultThreadWakeupCallback(ThreadWakeupReason reason, SharedPtr<Thread> thread,
  107. SharedPtr<WaitObject> object, size_t index) {
  108. ASSERT(thread->status == THREADSTATUS_WAIT_SYNCH_ANY);
  109. if (reason == ThreadWakeupReason::Timeout) {
  110. thread->SetWaitSynchronizationResult(RESULT_TIMEOUT);
  111. return true;
  112. }
  113. ASSERT(reason == ThreadWakeupReason::Signal);
  114. thread->SetWaitSynchronizationResult(RESULT_SUCCESS);
  115. thread->SetWaitSynchronizationOutput(static_cast<u32>(index));
  116. return true;
  117. };
  118. /// Wait for a kernel object to synchronize, timeout after the specified nanoseconds
  119. static ResultCode WaitSynchronization1(
  120. SharedPtr<WaitObject> object, Thread* thread, s64 nano_seconds = -1,
  121. std::function<Thread::WakeupCallback> wakeup_callback = DefaultThreadWakeupCallback) {
  122. if (!object) {
  123. return ERR_INVALID_HANDLE;
  124. }
  125. if (object->ShouldWait(thread)) {
  126. if (nano_seconds == 0) {
  127. return RESULT_TIMEOUT;
  128. }
  129. thread->wait_objects = {object};
  130. object->AddWaitingThread(thread);
  131. thread->status = THREADSTATUS_WAIT_SYNCH_ANY;
  132. // Create an event to wake the thread up after the specified nanosecond delay has passed
  133. thread->WakeAfterDelay(nano_seconds);
  134. thread->wakeup_callback = wakeup_callback;
  135. Core::System::GetInstance().PrepareReschedule();
  136. } else {
  137. object->Acquire(thread);
  138. }
  139. return RESULT_SUCCESS;
  140. }
  141. /// Wait for the given handles to synchronize, timeout after the specified nanoseconds
  142. static ResultCode WaitSynchronization(Handle* index, VAddr handles_address, u64 handle_count,
  143. s64 nano_seconds) {
  144. LOG_TRACE(Kernel_SVC, "called handles_address=0x%llx, handle_count=%d, nano_seconds=%d",
  145. handles_address, handle_count, nano_seconds);
  146. if (!Memory::IsValidVirtualAddress(handles_address))
  147. return ERR_INVALID_POINTER;
  148. static constexpr u64 MaxHandles = 0x40;
  149. if (handle_count > MaxHandles)
  150. return ResultCode(ErrorModule::Kernel, ErrCodes::TooLarge);
  151. auto thread = GetCurrentThread();
  152. using ObjectPtr = SharedPtr<WaitObject>;
  153. std::vector<ObjectPtr> objects(handle_count);
  154. for (int i = 0; i < handle_count; ++i) {
  155. Handle handle = Memory::Read32(handles_address + i * sizeof(Handle));
  156. auto object = g_handle_table.Get<WaitObject>(handle);
  157. if (object == nullptr)
  158. return ERR_INVALID_HANDLE;
  159. objects[i] = object;
  160. }
  161. // Find the first object that is acquirable in the provided list of objects
  162. auto itr = std::find_if(objects.begin(), objects.end(), [thread](const ObjectPtr& object) {
  163. return !object->ShouldWait(thread);
  164. });
  165. if (itr != objects.end()) {
  166. // We found a ready object, acquire it and set the result value
  167. WaitObject* object = itr->get();
  168. object->Acquire(thread);
  169. *index = static_cast<s32>(std::distance(objects.begin(), itr));
  170. return RESULT_SUCCESS;
  171. }
  172. // No objects were ready to be acquired, prepare to suspend the thread.
  173. // If a timeout value of 0 was provided, just return the Timeout error code instead of
  174. // suspending the thread.
  175. if (nano_seconds == 0)
  176. return RESULT_TIMEOUT;
  177. for (auto& object : objects)
  178. object->AddWaitingThread(thread);
  179. thread->wait_objects = std::move(objects);
  180. thread->status = THREADSTATUS_WAIT_SYNCH_ANY;
  181. // Create an event to wake the thread up after the specified nanosecond delay has passed
  182. thread->WakeAfterDelay(nano_seconds);
  183. thread->wakeup_callback = DefaultThreadWakeupCallback;
  184. Core::System::GetInstance().PrepareReschedule();
  185. return RESULT_TIMEOUT;
  186. }
  187. /// Resumes a thread waiting on WaitSynchronization
  188. static ResultCode CancelSynchronization(Handle thread_handle) {
  189. LOG_TRACE(Kernel_SVC, "called thread=0x%08X", thread_handle);
  190. const SharedPtr<Thread> thread = g_handle_table.Get<Thread>(thread_handle);
  191. if (!thread) {
  192. return ERR_INVALID_HANDLE;
  193. }
  194. ASSERT(thread->status == THREADSTATUS_WAIT_SYNCH_ANY);
  195. thread->SetWaitSynchronizationResult(
  196. ResultCode(ErrorModule::Kernel, ErrCodes::SynchronizationCanceled));
  197. thread->ResumeFromWait();
  198. return RESULT_SUCCESS;
  199. }
  200. /// Attempts to locks a mutex, creating it if it does not already exist
  201. static ResultCode LockMutex(Handle holding_thread_handle, VAddr mutex_addr,
  202. Handle requesting_thread_handle) {
  203. LOG_TRACE(Kernel_SVC,
  204. "called holding_thread_handle=0x%08X, mutex_addr=0x%llx, "
  205. "requesting_current_thread_handle=0x%08X",
  206. holding_thread_handle, mutex_addr, requesting_thread_handle);
  207. SharedPtr<Thread> holding_thread = g_handle_table.Get<Thread>(holding_thread_handle);
  208. SharedPtr<Thread> requesting_thread = g_handle_table.Get<Thread>(requesting_thread_handle);
  209. ASSERT(requesting_thread);
  210. SharedPtr<Mutex> mutex = g_object_address_table.Get<Mutex>(mutex_addr);
  211. if (!mutex) {
  212. // Create a new mutex for the specified address if one does not already exist
  213. mutex = Mutex::Create(holding_thread, mutex_addr);
  214. mutex->name = Common::StringFromFormat("mutex-%llx", mutex_addr);
  215. }
  216. ASSERT(holding_thread == mutex->GetHoldingThread());
  217. return WaitSynchronization1(mutex, requesting_thread.get());
  218. }
  219. /// Unlock a mutex
  220. static ResultCode UnlockMutex(VAddr mutex_addr) {
  221. LOG_TRACE(Kernel_SVC, "called mutex_addr=0x%llx", mutex_addr);
  222. SharedPtr<Mutex> mutex = g_object_address_table.Get<Mutex>(mutex_addr);
  223. ASSERT(mutex);
  224. return mutex->Release(GetCurrentThread());
  225. }
  226. /// Break program execution
  227. static void Break(u64 unk_0, u64 unk_1, u64 unk_2) {
  228. LOG_CRITICAL(Debug_Emulated, "Emulated program broke execution!");
  229. ASSERT(false);
  230. }
  231. /// Used to output a message on a debug hardware unit - does nothing on a retail unit
  232. static void OutputDebugString(VAddr address, s32 len) {
  233. std::vector<char> string(len);
  234. Memory::ReadBlock(address, string.data(), len);
  235. LOG_DEBUG(Debug_Emulated, "%.*s", len, string.data());
  236. }
  237. /// Gets system/memory information for the current process
  238. static ResultCode GetInfo(u64* result, u64 info_id, u64 handle, u64 info_sub_id) {
  239. LOG_TRACE(Kernel_SVC, "called info_id=0x%X, info_sub_id=0x%X, handle=0x%08X", info_id,
  240. info_sub_id, handle);
  241. ASSERT(handle == 0 || handle == CurrentProcess);
  242. auto& vm_manager = g_current_process->vm_manager;
  243. switch (static_cast<GetInfoType>(info_id)) {
  244. case GetInfoType::AllowedCpuIdBitmask:
  245. *result = g_current_process->allowed_processor_mask;
  246. break;
  247. case GetInfoType::TotalMemoryUsage:
  248. *result = vm_manager.GetTotalMemoryUsage();
  249. break;
  250. case GetInfoType::TotalHeapUsage:
  251. *result = vm_manager.GetTotalHeapUsage();
  252. break;
  253. case GetInfoType::RandomEntropy:
  254. *result = 0;
  255. break;
  256. case GetInfoType::AddressSpaceBaseAddr:
  257. *result = vm_manager.GetAddressSpaceBaseAddr();
  258. break;
  259. case GetInfoType::AddressSpaceSize:
  260. *result = vm_manager.GetAddressSpaceSize();
  261. break;
  262. case GetInfoType::NewMapRegionBaseAddr:
  263. *result = vm_manager.GetNewMapRegionBaseAddr();
  264. break;
  265. case GetInfoType::NewMapRegionSize:
  266. *result = vm_manager.GetNewMapRegionSize();
  267. break;
  268. default:
  269. UNIMPLEMENTED();
  270. }
  271. return RESULT_SUCCESS;
  272. }
  273. /// Gets the priority for the specified thread
  274. static ResultCode GetThreadPriority(u32* priority, Handle handle) {
  275. const SharedPtr<Thread> thread = g_handle_table.Get<Thread>(handle);
  276. if (!thread)
  277. return ERR_INVALID_HANDLE;
  278. *priority = thread->GetPriority();
  279. return RESULT_SUCCESS;
  280. }
  281. /// Sets the priority for the specified thread
  282. static ResultCode SetThreadPriority(Handle handle, u32 priority) {
  283. if (priority > THREADPRIO_LOWEST) {
  284. return ERR_OUT_OF_RANGE;
  285. }
  286. SharedPtr<Thread> thread = g_handle_table.Get<Thread>(handle);
  287. if (!thread)
  288. return ERR_INVALID_HANDLE;
  289. // Note: The kernel uses the current process's resource limit instead of
  290. // the one from the thread owner's resource limit.
  291. SharedPtr<ResourceLimit>& resource_limit = g_current_process->resource_limit;
  292. if (resource_limit->GetMaxResourceValue(ResourceTypes::PRIORITY) > priority) {
  293. return ERR_NOT_AUTHORIZED;
  294. }
  295. thread->SetPriority(priority);
  296. thread->UpdatePriority();
  297. // Update the mutexes that this thread is waiting for
  298. for (auto& mutex : thread->pending_mutexes)
  299. mutex->UpdatePriority();
  300. Core::System::GetInstance().PrepareReschedule();
  301. return RESULT_SUCCESS;
  302. }
  303. /// Get which CPU core is executing the current thread
  304. static u32 GetCurrentProcessorNumber() {
  305. LOG_WARNING(Kernel_SVC, "(STUBBED) called, defaulting to processor 0");
  306. return 0;
  307. }
  308. /// Query process memory
  309. static ResultCode QueryProcessMemory(MemoryInfo* memory_info, PageInfo* /*page_info*/,
  310. Handle process_handle, u64 addr) {
  311. SharedPtr<Process> process = g_handle_table.Get<Process>(process_handle);
  312. if (!process) {
  313. return ERR_INVALID_HANDLE;
  314. }
  315. auto vma = process->vm_manager.FindVMA(addr);
  316. memory_info->attributes = 0;
  317. if (vma == g_current_process->vm_manager.vma_map.end()) {
  318. memory_info->base_address = 0;
  319. memory_info->permission = static_cast<u32>(VMAPermission::None);
  320. memory_info->size = 0;
  321. memory_info->type = static_cast<u32>(MemoryState::Free);
  322. } else {
  323. memory_info->base_address = vma->second.base;
  324. memory_info->permission = static_cast<u32>(vma->second.permissions);
  325. memory_info->size = vma->second.size;
  326. memory_info->type = static_cast<u32>(vma->second.meminfo_state);
  327. }
  328. LOG_TRACE(Kernel_SVC, "called process=0x%08X addr=%llx", process_handle, addr);
  329. return RESULT_SUCCESS;
  330. }
  331. /// Query memory
  332. static ResultCode QueryMemory(MemoryInfo* memory_info, PageInfo* page_info, VAddr addr) {
  333. LOG_TRACE(Kernel_SVC, "called, addr=%llx", addr);
  334. return QueryProcessMemory(memory_info, page_info, CurrentProcess, addr);
  335. }
  336. /// Exits the current process
  337. static void ExitProcess() {
  338. LOG_INFO(Kernel_SVC, "Process %u exiting", g_current_process->process_id);
  339. ASSERT_MSG(g_current_process->status == ProcessStatus::Running, "Process has already exited");
  340. g_current_process->status = ProcessStatus::Exited;
  341. // Stop all the process threads that are currently waiting for objects.
  342. auto& thread_list = GetThreadList();
  343. for (auto& thread : thread_list) {
  344. if (thread->owner_process != g_current_process)
  345. continue;
  346. if (thread == GetCurrentThread())
  347. continue;
  348. // TODO(Subv): When are the other running/ready threads terminated?
  349. ASSERT_MSG(thread->status == THREADSTATUS_WAIT_SYNCH_ANY ||
  350. thread->status == THREADSTATUS_WAIT_SYNCH_ALL,
  351. "Exiting processes with non-waiting threads is currently unimplemented");
  352. thread->Stop();
  353. }
  354. // Kill the current thread
  355. GetCurrentThread()->Stop();
  356. Core::System::GetInstance().PrepareReschedule();
  357. }
  358. /// Creates a new thread
  359. static ResultCode CreateThread(Handle* out_handle, VAddr entry_point, u64 arg, VAddr stack_top,
  360. u32 priority, s32 processor_id) {
  361. std::string name = Common::StringFromFormat("unknown-%llx", entry_point);
  362. if (priority > THREADPRIO_LOWEST) {
  363. return ERR_OUT_OF_RANGE;
  364. }
  365. SharedPtr<ResourceLimit>& resource_limit = g_current_process->resource_limit;
  366. if (resource_limit->GetMaxResourceValue(ResourceTypes::PRIORITY) > priority) {
  367. return ERR_NOT_AUTHORIZED;
  368. }
  369. if (processor_id == THREADPROCESSORID_DEFAULT) {
  370. // Set the target CPU to the one specified in the process' exheader.
  371. processor_id = g_current_process->ideal_processor;
  372. ASSERT(processor_id != THREADPROCESSORID_DEFAULT);
  373. }
  374. switch (processor_id) {
  375. case THREADPROCESSORID_0:
  376. break;
  377. case THREADPROCESSORID_1:
  378. case THREADPROCESSORID_2:
  379. case THREADPROCESSORID_3:
  380. // TODO(bunnei): Implement support for other processor IDs
  381. LOG_ERROR(Kernel_SVC,
  382. "Newly created thread must run in another thread (%u), unimplemented.",
  383. processor_id);
  384. break;
  385. default:
  386. ASSERT_MSG(false, "Unsupported thread processor ID: %d", processor_id);
  387. break;
  388. }
  389. CASCADE_RESULT(SharedPtr<Thread> thread,
  390. Thread::Create(name, entry_point, priority, arg, processor_id, stack_top,
  391. g_current_process));
  392. CASCADE_RESULT(thread->guest_handle, g_handle_table.Create(thread));
  393. *out_handle = thread->guest_handle;
  394. Core::System::GetInstance().PrepareReschedule();
  395. LOG_TRACE(Kernel_SVC,
  396. "called entrypoint=0x%08X (%s), arg=0x%08X, stacktop=0x%08X, "
  397. "threadpriority=0x%08X, processorid=0x%08X : created handle=0x%08X",
  398. entry_point, name.c_str(), arg, stack_top, priority, processor_id, *out_handle);
  399. return RESULT_SUCCESS;
  400. }
  401. /// Starts the thread for the provided handle
  402. static ResultCode StartThread(Handle thread_handle) {
  403. LOG_TRACE(Kernel_SVC, "called thread=0x%08X", thread_handle);
  404. const SharedPtr<Thread> thread = g_handle_table.Get<Thread>(thread_handle);
  405. if (!thread) {
  406. return ERR_INVALID_HANDLE;
  407. }
  408. thread->ResumeFromWait();
  409. return RESULT_SUCCESS;
  410. }
  411. /// Called when a thread exits
  412. static void ExitThread() {
  413. LOG_TRACE(Kernel_SVC, "called, pc=0x%08X", Core::CPU().GetPC());
  414. ExitCurrentThread();
  415. Core::System::GetInstance().PrepareReschedule();
  416. }
  417. /// Sleep the current thread
  418. static void SleepThread(s64 nanoseconds) {
  419. LOG_TRACE(Kernel_SVC, "called nanoseconds=%lld", nanoseconds);
  420. // Don't attempt to yield execution if there are no available threads to run,
  421. // this way we avoid a useless reschedule to the idle thread.
  422. if (nanoseconds == 0 && !HaveReadyThreads())
  423. return;
  424. // Sleep current thread and check for next thread to schedule
  425. WaitCurrentThread_Sleep();
  426. // Create an event to wake the thread up after the specified nanosecond delay has passed
  427. GetCurrentThread()->WakeAfterDelay(nanoseconds);
  428. Core::System::GetInstance().PrepareReschedule();
  429. }
  430. /// Signal process wide key atomic
  431. static ResultCode WaitProcessWideKeyAtomic(VAddr mutex_addr, VAddr condition_variable_addr,
  432. Handle thread_handle, s64 nano_seconds) {
  433. LOG_TRACE(
  434. Kernel_SVC,
  435. "called mutex_addr=%llx, condition_variable_addr=%llx, thread_handle=0x%08X, timeout=%d",
  436. mutex_addr, condition_variable_addr, thread_handle, nano_seconds);
  437. SharedPtr<Thread> thread = g_handle_table.Get<Thread>(thread_handle);
  438. ASSERT(thread);
  439. SharedPtr<Mutex> mutex = g_object_address_table.Get<Mutex>(mutex_addr);
  440. if (!mutex) {
  441. // Create a new mutex for the specified address if one does not already exist
  442. mutex = Mutex::Create(thread, mutex_addr);
  443. mutex->name = Common::StringFromFormat("mutex-%llx", mutex_addr);
  444. }
  445. ASSERT(mutex->GetOwnerHandle() == thread_handle);
  446. SharedPtr<ConditionVariable> condition_variable =
  447. g_object_address_table.Get<ConditionVariable>(condition_variable_addr);
  448. if (!condition_variable) {
  449. // Create a new condition_variable for the specified address if one does not already exist
  450. condition_variable =
  451. ConditionVariable::Create(condition_variable_addr, mutex_addr).Unwrap();
  452. condition_variable->name =
  453. Common::StringFromFormat("condition-variable-%llx", condition_variable_addr);
  454. }
  455. ASSERT(condition_variable->GetAvailableCount() == 0);
  456. ASSERT(condition_variable->mutex_addr == mutex_addr);
  457. auto wakeup_callback = [mutex, nano_seconds](ThreadWakeupReason reason,
  458. SharedPtr<Thread> thread,
  459. SharedPtr<WaitObject> object, size_t index) {
  460. ASSERT(thread->status == THREADSTATUS_WAIT_SYNCH_ANY);
  461. if (reason == ThreadWakeupReason::Timeout) {
  462. thread->SetWaitSynchronizationResult(RESULT_TIMEOUT);
  463. return true;
  464. }
  465. ASSERT(reason == ThreadWakeupReason::Signal);
  466. // Now try to acquire the mutex and don't resume if it's not available.
  467. if (!mutex->ShouldWait(thread.get())) {
  468. mutex->Acquire(thread.get());
  469. thread->SetWaitSynchronizationResult(RESULT_SUCCESS);
  470. return true;
  471. }
  472. if (nano_seconds == 0) {
  473. thread->SetWaitSynchronizationResult(RESULT_TIMEOUT);
  474. return true;
  475. }
  476. thread->wait_objects = {mutex};
  477. mutex->AddWaitingThread(thread);
  478. thread->status = THREADSTATUS_WAIT_SYNCH_ANY;
  479. // Create an event to wake the thread up after the
  480. // specified nanosecond delay has passed
  481. thread->WakeAfterDelay(nano_seconds);
  482. thread->wakeup_callback = DefaultThreadWakeupCallback;
  483. Core::System::GetInstance().PrepareReschedule();
  484. return false;
  485. };
  486. CASCADE_CODE(
  487. WaitSynchronization1(condition_variable, thread.get(), nano_seconds, wakeup_callback));
  488. mutex->Release(thread.get());
  489. return RESULT_SUCCESS;
  490. }
  491. /// Signal process wide key
  492. static ResultCode SignalProcessWideKey(VAddr condition_variable_addr, s32 target) {
  493. LOG_TRACE(Kernel_SVC, "called, condition_variable_addr=0x%llx, target=0x%08x",
  494. condition_variable_addr, target);
  495. // Wakeup all or one thread - Any other value is unimplemented
  496. ASSERT(target == -1 || target == 1);
  497. SharedPtr<ConditionVariable> condition_variable =
  498. g_object_address_table.Get<ConditionVariable>(condition_variable_addr);
  499. if (!condition_variable) {
  500. // Create a new condition_variable for the specified address if one does not already exist
  501. condition_variable = ConditionVariable::Create(condition_variable_addr).Unwrap();
  502. condition_variable->name =
  503. Common::StringFromFormat("condition-variable-%llx", condition_variable_addr);
  504. }
  505. CASCADE_CODE(condition_variable->Release(target));
  506. if (condition_variable->mutex_addr) {
  507. // If a mutex was created for this condition_variable, wait the current thread on it
  508. SharedPtr<Mutex> mutex = g_object_address_table.Get<Mutex>(condition_variable->mutex_addr);
  509. return WaitSynchronization1(mutex, GetCurrentThread());
  510. }
  511. return RESULT_SUCCESS;
  512. }
  513. /// This returns the total CPU ticks elapsed since the CPU was powered-on
  514. static u64 GetSystemTick() {
  515. const u64 result{CoreTiming::GetTicks()};
  516. // Advance time to defeat dumb games that busy-wait for the frame to end.
  517. CoreTiming::AddTicks(400);
  518. return result;
  519. }
  520. /// Close a handle
  521. static ResultCode CloseHandle(Handle handle) {
  522. LOG_TRACE(Kernel_SVC, "Closing handle 0x%08X", handle);
  523. return g_handle_table.Close(handle);
  524. }
  525. /// Reset an event
  526. static ResultCode ResetSignal(Handle handle) {
  527. LOG_WARNING(Kernel_SVC, "(STUBBED) called handle 0x%08X", handle);
  528. auto event = g_handle_table.Get<Event>(handle);
  529. ASSERT(event != nullptr);
  530. event->Clear();
  531. return RESULT_SUCCESS;
  532. }
  533. /// Creates a TransferMemory object
  534. static ResultCode CreateTransferMemory(Handle* handle, VAddr addr, u64 size, u32 permissions) {
  535. LOG_WARNING(Kernel_SVC, "(STUBBED) called addr=0x%llx, size=0x%llx, perms=%08X", addr, size,
  536. permissions);
  537. *handle = 0;
  538. return RESULT_SUCCESS;
  539. }
  540. namespace {
  541. struct FunctionDef {
  542. using Func = void();
  543. u32 id;
  544. Func* func;
  545. const char* name;
  546. };
  547. } // namespace
  548. static const FunctionDef SVC_Table[] = {
  549. {0x00, nullptr, "Unknown"},
  550. {0x01, SvcWrap<SetHeapSize>, "SetHeapSize"},
  551. {0x02, nullptr, "SetMemoryPermission"},
  552. {0x03, SvcWrap<SetMemoryAttribute>, "SetMemoryAttribute"},
  553. {0x04, SvcWrap<MapMemory>, "MapMemory"},
  554. {0x05, SvcWrap<UnmapMemory>, "UnmapMemory"},
  555. {0x06, SvcWrap<QueryMemory>, "QueryMemory"},
  556. {0x07, SvcWrap<ExitProcess>, "ExitProcess"},
  557. {0x08, SvcWrap<CreateThread>, "CreateThread"},
  558. {0x09, SvcWrap<StartThread>, "StartThread"},
  559. {0x0A, SvcWrap<ExitThread>, "ExitThread"},
  560. {0x0B, SvcWrap<SleepThread>, "SleepThread"},
  561. {0x0C, SvcWrap<GetThreadPriority>, "GetThreadPriority"},
  562. {0x0D, SvcWrap<SetThreadPriority>, "SetThreadPriority"},
  563. {0x0E, nullptr, "GetThreadCoreMask"},
  564. {0x0F, nullptr, "SetThreadCoreMask"},
  565. {0x10, SvcWrap<GetCurrentProcessorNumber>, "GetCurrentProcessorNumber"},
  566. {0x11, nullptr, "SignalEvent"},
  567. {0x12, nullptr, "ClearEvent"},
  568. {0x13, nullptr, "MapSharedMemory"},
  569. {0x14, nullptr, "UnmapSharedMemory"},
  570. {0x15, SvcWrap<CreateTransferMemory>, "CreateTransferMemory"},
  571. {0x16, SvcWrap<CloseHandle>, "CloseHandle"},
  572. {0x17, SvcWrap<ResetSignal>, "ResetSignal"},
  573. {0x18, SvcWrap<WaitSynchronization>, "WaitSynchronization"},
  574. {0x19, SvcWrap<CancelSynchronization>, "CancelSynchronization"},
  575. {0x1A, SvcWrap<LockMutex>, "LockMutex"},
  576. {0x1B, SvcWrap<UnlockMutex>, "UnlockMutex"},
  577. {0x1C, SvcWrap<WaitProcessWideKeyAtomic>, "WaitProcessWideKeyAtomic"},
  578. {0x1D, SvcWrap<SignalProcessWideKey>, "SignalProcessWideKey"},
  579. {0x1E, SvcWrap<GetSystemTick>, "GetSystemTick"},
  580. {0x1F, SvcWrap<ConnectToPort>, "ConnectToPort"},
  581. {0x20, nullptr, "SendSyncRequestLight"},
  582. {0x21, SvcWrap<SendSyncRequest>, "SendSyncRequest"},
  583. {0x22, nullptr, "SendSyncRequestWithUserBuffer"},
  584. {0x23, nullptr, "SendAsyncRequestWithUserBuffer"},
  585. {0x24, SvcWrap<GetProcessId>, "GetProcessId"},
  586. {0x25, SvcWrap<GetThreadId>, "GetThreadId"},
  587. {0x26, SvcWrap<Break>, "Break"},
  588. {0x27, SvcWrap<OutputDebugString>, "OutputDebugString"},
  589. {0x28, nullptr, "ReturnFromException"},
  590. {0x29, SvcWrap<GetInfo>, "GetInfo"},
  591. {0x2A, nullptr, "FlushEntireDataCache"},
  592. {0x2B, nullptr, "FlushDataCache"},
  593. {0x2C, nullptr, "MapPhysicalMemory"},
  594. {0x2D, nullptr, "UnmapPhysicalMemory"},
  595. {0x2E, nullptr, "Unknown"},
  596. {0x2F, nullptr, "GetLastThreadInfo"},
  597. {0x30, nullptr, "GetResourceLimitLimitValue"},
  598. {0x31, nullptr, "GetResourceLimitCurrentValue"},
  599. {0x32, nullptr, "SetThreadActivity"},
  600. {0x33, nullptr, "GetThreadContext"},
  601. {0x34, nullptr, "Unknown"},
  602. {0x35, nullptr, "Unknown"},
  603. {0x36, nullptr, "Unknown"},
  604. {0x37, nullptr, "Unknown"},
  605. {0x38, nullptr, "Unknown"},
  606. {0x39, nullptr, "Unknown"},
  607. {0x3A, nullptr, "Unknown"},
  608. {0x3B, nullptr, "Unknown"},
  609. {0x3C, nullptr, "DumpInfo"},
  610. {0x3D, nullptr, "Unknown"},
  611. {0x3E, nullptr, "Unknown"},
  612. {0x3F, nullptr, "Unknown"},
  613. {0x40, nullptr, "CreateSession"},
  614. {0x41, nullptr, "AcceptSession"},
  615. {0x42, nullptr, "ReplyAndReceiveLight"},
  616. {0x43, nullptr, "ReplyAndReceive"},
  617. {0x44, nullptr, "ReplyAndReceiveWithUserBuffer"},
  618. {0x45, nullptr, "CreateEvent"},
  619. {0x46, nullptr, "Unknown"},
  620. {0x47, nullptr, "Unknown"},
  621. {0x48, nullptr, "Unknown"},
  622. {0x49, nullptr, "Unknown"},
  623. {0x4A, nullptr, "Unknown"},
  624. {0x4B, nullptr, "Unknown"},
  625. {0x4C, nullptr, "Unknown"},
  626. {0x4D, nullptr, "SleepSystem"},
  627. {0x4E, nullptr, "ReadWriteRegister"},
  628. {0x4F, nullptr, "SetProcessActivity"},
  629. {0x50, nullptr, "CreateSharedMemory"},
  630. {0x51, nullptr, "MapTransferMemory"},
  631. {0x52, nullptr, "UnmapTransferMemory"},
  632. {0x53, nullptr, "CreateInterruptEvent"},
  633. {0x54, nullptr, "QueryPhysicalAddress"},
  634. {0x55, nullptr, "QueryIoMapping"},
  635. {0x56, nullptr, "CreateDeviceAddressSpace"},
  636. {0x57, nullptr, "AttachDeviceAddressSpace"},
  637. {0x58, nullptr, "DetachDeviceAddressSpace"},
  638. {0x59, nullptr, "MapDeviceAddressSpaceByForce"},
  639. {0x5A, nullptr, "MapDeviceAddressSpaceAligned"},
  640. {0x5B, nullptr, "MapDeviceAddressSpace"},
  641. {0x5C, nullptr, "UnmapDeviceAddressSpace"},
  642. {0x5D, nullptr, "InvalidateProcessDataCache"},
  643. {0x5E, nullptr, "StoreProcessDataCache"},
  644. {0x5F, nullptr, "FlushProcessDataCache"},
  645. {0x60, nullptr, "DebugActiveProcess"},
  646. {0x61, nullptr, "BreakDebugProcess"},
  647. {0x62, nullptr, "TerminateDebugProcess"},
  648. {0x63, nullptr, "GetDebugEvent"},
  649. {0x64, nullptr, "ContinueDebugEvent"},
  650. {0x65, nullptr, "GetProcessList"},
  651. {0x66, nullptr, "GetThreadList"},
  652. {0x67, nullptr, "GetDebugThreadContext"},
  653. {0x68, nullptr, "SetDebugThreadContext"},
  654. {0x69, nullptr, "QueryDebugProcessMemory"},
  655. {0x6A, nullptr, "ReadDebugProcessMemory"},
  656. {0x6B, nullptr, "WriteDebugProcessMemory"},
  657. {0x6C, nullptr, "SetHardwareBreakPoint"},
  658. {0x6D, nullptr, "GetDebugThreadParam"},
  659. {0x6E, nullptr, "Unknown"},
  660. {0x6F, nullptr, "Unknown"},
  661. {0x70, nullptr, "CreatePort"},
  662. {0x71, nullptr, "ManageNamedPort"},
  663. {0x72, nullptr, "ConnectToPort"},
  664. {0x73, nullptr, "SetProcessMemoryPermission"},
  665. {0x74, nullptr, "MapProcessMemory"},
  666. {0x75, nullptr, "UnmapProcessMemory"},
  667. {0x76, nullptr, "QueryProcessMemory"},
  668. {0x77, nullptr, "MapProcessCodeMemory"},
  669. {0x78, nullptr, "UnmapProcessCodeMemory"},
  670. {0x79, nullptr, "CreateProcess"},
  671. {0x7A, nullptr, "StartProcess"},
  672. {0x7B, nullptr, "TerminateProcess"},
  673. {0x7C, nullptr, "GetProcessInfo"},
  674. {0x7D, nullptr, "CreateResourceLimit"},
  675. {0x7E, nullptr, "SetResourceLimitLimitValue"},
  676. {0x7F, nullptr, "CallSecureMonitor"},
  677. };
  678. static const FunctionDef* GetSVCInfo(u32 func_num) {
  679. if (func_num >= ARRAY_SIZE(SVC_Table)) {
  680. LOG_ERROR(Kernel_SVC, "unknown svc=0x%02X", func_num);
  681. return nullptr;
  682. }
  683. return &SVC_Table[func_num];
  684. }
  685. MICROPROFILE_DEFINE(Kernel_SVC, "Kernel", "SVC", MP_RGB(70, 200, 70));
  686. void CallSVC(u32 immediate) {
  687. MICROPROFILE_SCOPE(Kernel_SVC);
  688. // Lock the global kernel mutex when we enter the kernel HLE.
  689. std::lock_guard<std::recursive_mutex> lock(HLE::g_hle_lock);
  690. const FunctionDef* info = GetSVCInfo(immediate);
  691. if (info) {
  692. if (info->func) {
  693. info->func();
  694. } else {
  695. LOG_CRITICAL(Kernel_SVC, "unimplemented SVC function %s(..)", info->name);
  696. }
  697. } else {
  698. LOG_CRITICAL(Kernel_SVC, "unknown SVC function 0x%x", immediate);
  699. }
  700. }
  701. } // namespace Kernel