Syscall.cs 86 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675
  1. using Ryujinx.Common;
  2. using Ryujinx.Common.Logging;
  3. using Ryujinx.Cpu;
  4. using Ryujinx.HLE.Exceptions;
  5. using Ryujinx.HLE.HOS.Kernel.Common;
  6. using Ryujinx.HLE.HOS.Kernel.Ipc;
  7. using Ryujinx.HLE.HOS.Kernel.Memory;
  8. using Ryujinx.HLE.HOS.Kernel.Process;
  9. using Ryujinx.HLE.HOS.Kernel.Threading;
  10. using Ryujinx.Memory;
  11. using System;
  12. using System.Threading;
  13. namespace Ryujinx.HLE.HOS.Kernel.SupervisorCall
  14. {
  15. class Syscall
  16. {
  17. private readonly KernelContext _context;
  18. public Syscall(KernelContext context)
  19. {
  20. _context = context;
  21. }
  22. // Process
  23. public KernelResult GetProcessId(int handle, out long pid)
  24. {
  25. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  26. KProcess process = currentProcess.HandleTable.GetKProcess(handle);
  27. if (process == null)
  28. {
  29. KThread thread = currentProcess.HandleTable.GetKThread(handle);
  30. if (thread != null)
  31. {
  32. process = thread.Owner;
  33. }
  34. // TODO: KDebugEvent.
  35. }
  36. pid = process?.Pid ?? 0;
  37. return process != null
  38. ? KernelResult.Success
  39. : KernelResult.InvalidHandle;
  40. }
  41. public KernelResult CreateProcess(
  42. ProcessCreationInfo info,
  43. ReadOnlySpan<int> capabilities,
  44. out int handle,
  45. IProcessContextFactory contextFactory,
  46. ThreadStart customThreadStart = null)
  47. {
  48. handle = 0;
  49. if ((info.Flags & ~ProcessCreationFlags.All) != 0)
  50. {
  51. return KernelResult.InvalidEnumValue;
  52. }
  53. // TODO: Address space check.
  54. if ((info.Flags & ProcessCreationFlags.PoolPartitionMask) > ProcessCreationFlags.PoolPartitionSystemNonSecure)
  55. {
  56. return KernelResult.InvalidEnumValue;
  57. }
  58. if ((info.CodeAddress & 0x1fffff) != 0)
  59. {
  60. return KernelResult.InvalidAddress;
  61. }
  62. if (info.CodePagesCount < 0 || info.SystemResourcePagesCount < 0)
  63. {
  64. return KernelResult.InvalidSize;
  65. }
  66. if (info.Flags.HasFlag(ProcessCreationFlags.OptimizeMemoryAllocation) &&
  67. !info.Flags.HasFlag(ProcessCreationFlags.IsApplication))
  68. {
  69. return KernelResult.InvalidThread;
  70. }
  71. KHandleTable handleTable = KernelStatic.GetCurrentProcess().HandleTable;
  72. KProcess process = new KProcess(_context);
  73. using var _ = new OnScopeExit(process.DecrementReferenceCount);
  74. KResourceLimit resourceLimit;
  75. if (info.ResourceLimitHandle != 0)
  76. {
  77. resourceLimit = handleTable.GetObject<KResourceLimit>(info.ResourceLimitHandle);
  78. if (resourceLimit == null)
  79. {
  80. return KernelResult.InvalidHandle;
  81. }
  82. }
  83. else
  84. {
  85. resourceLimit = _context.ResourceLimit;
  86. }
  87. MemoryRegion memRegion = (info.Flags & ProcessCreationFlags.PoolPartitionMask) switch
  88. {
  89. ProcessCreationFlags.PoolPartitionApplication => MemoryRegion.Application,
  90. ProcessCreationFlags.PoolPartitionApplet => MemoryRegion.Applet,
  91. ProcessCreationFlags.PoolPartitionSystem => MemoryRegion.Service,
  92. ProcessCreationFlags.PoolPartitionSystemNonSecure => MemoryRegion.NvServices,
  93. _ => MemoryRegion.NvServices
  94. };
  95. KernelResult result = process.Initialize(
  96. info,
  97. capabilities,
  98. resourceLimit,
  99. memRegion,
  100. contextFactory,
  101. customThreadStart);
  102. if (result != KernelResult.Success)
  103. {
  104. return result;
  105. }
  106. _context.Processes.TryAdd(process.Pid, process);
  107. return handleTable.GenerateHandle(process, out handle);
  108. }
  109. public KernelResult StartProcess(int handle, int priority, int cpuCore, ulong mainThreadStackSize)
  110. {
  111. KProcess process = KernelStatic.GetCurrentProcess().HandleTable.GetObject<KProcess>(handle);
  112. if (process == null)
  113. {
  114. return KernelResult.InvalidHandle;
  115. }
  116. if ((uint)cpuCore >= KScheduler.CpuCoresCount || !process.IsCpuCoreAllowed(cpuCore))
  117. {
  118. return KernelResult.InvalidCpuCore;
  119. }
  120. if ((uint)priority >= KScheduler.PrioritiesCount || !process.IsPriorityAllowed(priority))
  121. {
  122. return KernelResult.InvalidPriority;
  123. }
  124. process.DefaultCpuCore = cpuCore;
  125. KernelResult result = process.Start(priority, mainThreadStackSize);
  126. if (result != KernelResult.Success)
  127. {
  128. return result;
  129. }
  130. process.IncrementReferenceCount();
  131. return KernelResult.Success;
  132. }
  133. // IPC
  134. public KernelResult ConnectToNamedPort(ulong namePtr, out int handle)
  135. {
  136. handle = 0;
  137. if (!KernelTransfer.UserToKernelString(_context, namePtr, 12, out string name))
  138. {
  139. return KernelResult.UserCopyFailed;
  140. }
  141. return ConnectToNamedPort(name, out handle);
  142. }
  143. public KernelResult ConnectToNamedPort(string name, out int handle)
  144. {
  145. handle = 0;
  146. if (name.Length > 11)
  147. {
  148. return KernelResult.MaximumExceeded;
  149. }
  150. KAutoObject autoObj = KAutoObject.FindNamedObject(_context, name);
  151. if (!(autoObj is KClientPort clientPort))
  152. {
  153. return KernelResult.NotFound;
  154. }
  155. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  156. KernelResult result = currentProcess.HandleTable.ReserveHandle(out handle);
  157. if (result != KernelResult.Success)
  158. {
  159. return result;
  160. }
  161. result = clientPort.Connect(out KClientSession clientSession);
  162. if (result != KernelResult.Success)
  163. {
  164. currentProcess.HandleTable.CancelHandleReservation(handle);
  165. return result;
  166. }
  167. currentProcess.HandleTable.SetReservedHandleObj(handle, clientSession);
  168. clientSession.DecrementReferenceCount();
  169. return result;
  170. }
  171. public KernelResult SendSyncRequest(int handle)
  172. {
  173. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  174. KClientSession session = currentProcess.HandleTable.GetObject<KClientSession>(handle);
  175. if (session == null)
  176. {
  177. return KernelResult.InvalidHandle;
  178. }
  179. return session.SendSyncRequest();
  180. }
  181. public KernelResult SendSyncRequestWithUserBuffer(ulong messagePtr, ulong messageSize, int handle)
  182. {
  183. if (!PageAligned(messagePtr))
  184. {
  185. return KernelResult.InvalidAddress;
  186. }
  187. if (!PageAligned(messageSize) || messageSize == 0)
  188. {
  189. return KernelResult.InvalidSize;
  190. }
  191. if (messagePtr + messageSize <= messagePtr)
  192. {
  193. return KernelResult.InvalidMemState;
  194. }
  195. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  196. KernelResult result = currentProcess.MemoryManager.BorrowIpcBuffer(messagePtr, messageSize);
  197. if (result != KernelResult.Success)
  198. {
  199. return result;
  200. }
  201. KClientSession session = currentProcess.HandleTable.GetObject<KClientSession>(handle);
  202. if (session == null)
  203. {
  204. result = KernelResult.InvalidHandle;
  205. }
  206. else
  207. {
  208. result = session.SendSyncRequest(messagePtr, messageSize);
  209. }
  210. KernelResult result2 = currentProcess.MemoryManager.UnborrowIpcBuffer(messagePtr, messageSize);
  211. if (result == KernelResult.Success)
  212. {
  213. result = result2;
  214. }
  215. return result;
  216. }
  217. public KernelResult SendAsyncRequestWithUserBuffer(ulong messagePtr, ulong messageSize, int handle, out int doneEventHandle)
  218. {
  219. doneEventHandle = 0;
  220. if (!PageAligned(messagePtr))
  221. {
  222. return KernelResult.InvalidAddress;
  223. }
  224. if (!PageAligned(messageSize) || messageSize == 0)
  225. {
  226. return KernelResult.InvalidSize;
  227. }
  228. if (messagePtr + messageSize <= messagePtr)
  229. {
  230. return KernelResult.InvalidMemState;
  231. }
  232. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  233. KernelResult result = currentProcess.MemoryManager.BorrowIpcBuffer(messagePtr, messageSize);
  234. if (result != KernelResult.Success)
  235. {
  236. return result;
  237. }
  238. KResourceLimit resourceLimit = currentProcess.ResourceLimit;
  239. if (resourceLimit != null && !resourceLimit.Reserve(LimitableResource.Event, 1))
  240. {
  241. currentProcess.MemoryManager.UnborrowIpcBuffer(messagePtr, messageSize);
  242. return KernelResult.ResLimitExceeded;
  243. }
  244. KClientSession session = currentProcess.HandleTable.GetObject<KClientSession>(handle);
  245. if (session == null)
  246. {
  247. result = KernelResult.InvalidHandle;
  248. }
  249. else
  250. {
  251. KEvent doneEvent = new KEvent(_context);
  252. result = currentProcess.HandleTable.GenerateHandle(doneEvent.ReadableEvent, out doneEventHandle);
  253. if (result == KernelResult.Success)
  254. {
  255. result = session.SendAsyncRequest(doneEvent.WritableEvent, messagePtr, messageSize);
  256. if (result != KernelResult.Success)
  257. {
  258. currentProcess.HandleTable.CloseHandle(doneEventHandle);
  259. }
  260. }
  261. }
  262. if (result != KernelResult.Success)
  263. {
  264. resourceLimit?.Release(LimitableResource.Event, 1);
  265. currentProcess.MemoryManager.UnborrowIpcBuffer(messagePtr, messageSize);
  266. }
  267. return result;
  268. }
  269. public KernelResult CreateSession(
  270. bool isLight,
  271. ulong namePtr,
  272. out int serverSessionHandle,
  273. out int clientSessionHandle)
  274. {
  275. serverSessionHandle = 0;
  276. clientSessionHandle = 0;
  277. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  278. KResourceLimit resourceLimit = currentProcess.ResourceLimit;
  279. if (resourceLimit != null && !resourceLimit.Reserve(LimitableResource.Session, 1))
  280. {
  281. return KernelResult.ResLimitExceeded;
  282. }
  283. KernelResult result;
  284. if (isLight)
  285. {
  286. KLightSession session = new KLightSession(_context);
  287. result = currentProcess.HandleTable.GenerateHandle(session.ServerSession, out serverSessionHandle);
  288. if (result == KernelResult.Success)
  289. {
  290. result = currentProcess.HandleTable.GenerateHandle(session.ClientSession, out clientSessionHandle);
  291. if (result != KernelResult.Success)
  292. {
  293. currentProcess.HandleTable.CloseHandle(serverSessionHandle);
  294. serverSessionHandle = 0;
  295. }
  296. }
  297. session.ServerSession.DecrementReferenceCount();
  298. session.ClientSession.DecrementReferenceCount();
  299. }
  300. else
  301. {
  302. KSession session = new KSession(_context);
  303. result = currentProcess.HandleTable.GenerateHandle(session.ServerSession, out serverSessionHandle);
  304. if (result == KernelResult.Success)
  305. {
  306. result = currentProcess.HandleTable.GenerateHandle(session.ClientSession, out clientSessionHandle);
  307. if (result != KernelResult.Success)
  308. {
  309. currentProcess.HandleTable.CloseHandle(serverSessionHandle);
  310. serverSessionHandle = 0;
  311. }
  312. }
  313. session.ServerSession.DecrementReferenceCount();
  314. session.ClientSession.DecrementReferenceCount();
  315. }
  316. return result;
  317. }
  318. public KernelResult AcceptSession(int portHandle, out int sessionHandle)
  319. {
  320. sessionHandle = 0;
  321. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  322. KServerPort serverPort = currentProcess.HandleTable.GetObject<KServerPort>(portHandle);
  323. if (serverPort == null)
  324. {
  325. return KernelResult.InvalidHandle;
  326. }
  327. KernelResult result = currentProcess.HandleTable.ReserveHandle(out int handle);
  328. if (result != KernelResult.Success)
  329. {
  330. return result;
  331. }
  332. KAutoObject session;
  333. if (serverPort.IsLight)
  334. {
  335. session = serverPort.AcceptIncomingLightConnection();
  336. }
  337. else
  338. {
  339. session = serverPort.AcceptIncomingConnection();
  340. }
  341. if (session != null)
  342. {
  343. currentProcess.HandleTable.SetReservedHandleObj(handle, session);
  344. session.DecrementReferenceCount();
  345. sessionHandle = handle;
  346. result = KernelResult.Success;
  347. }
  348. else
  349. {
  350. currentProcess.HandleTable.CancelHandleReservation(handle);
  351. result = KernelResult.NotFound;
  352. }
  353. return result;
  354. }
  355. public KernelResult ReplyAndReceive(
  356. ulong handlesPtr,
  357. int handlesCount,
  358. int replyTargetHandle,
  359. long timeout,
  360. out int handleIndex)
  361. {
  362. handleIndex = 0;
  363. if ((uint)handlesCount > 0x40)
  364. {
  365. return KernelResult.MaximumExceeded;
  366. }
  367. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  368. ulong copySize = (ulong)((long)handlesCount * 4);
  369. if (!currentProcess.MemoryManager.InsideAddrSpace(handlesPtr, copySize))
  370. {
  371. return KernelResult.UserCopyFailed;
  372. }
  373. if (handlesPtr + copySize < handlesPtr)
  374. {
  375. return KernelResult.UserCopyFailed;
  376. }
  377. int[] handles = new int[handlesCount];
  378. if (!KernelTransfer.UserToKernelInt32Array(_context, handlesPtr, handles))
  379. {
  380. return KernelResult.UserCopyFailed;
  381. }
  382. if (timeout > 0)
  383. {
  384. timeout += KTimeManager.DefaultTimeIncrementNanoseconds;
  385. }
  386. return ReplyAndReceive(handles, replyTargetHandle, timeout, out handleIndex);
  387. }
  388. public KernelResult ReplyAndReceive(ReadOnlySpan<int> handles, int replyTargetHandle, long timeout, out int handleIndex)
  389. {
  390. handleIndex = 0;
  391. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  392. KSynchronizationObject[] syncObjs = new KSynchronizationObject[handles.Length];
  393. for (int index = 0; index < handles.Length; index++)
  394. {
  395. KSynchronizationObject obj = currentProcess.HandleTable.GetObject<KSynchronizationObject>(handles[index]);
  396. if (obj == null)
  397. {
  398. return KernelResult.InvalidHandle;
  399. }
  400. syncObjs[index] = obj;
  401. }
  402. KernelResult result = KernelResult.Success;
  403. if (replyTargetHandle != 0)
  404. {
  405. KServerSession replyTarget = currentProcess.HandleTable.GetObject<KServerSession>(replyTargetHandle);
  406. if (replyTarget == null)
  407. {
  408. result = KernelResult.InvalidHandle;
  409. }
  410. else
  411. {
  412. result = replyTarget.Reply();
  413. }
  414. }
  415. if (result == KernelResult.Success)
  416. {
  417. if (timeout > 0)
  418. {
  419. timeout += KTimeManager.DefaultTimeIncrementNanoseconds;
  420. }
  421. while ((result = _context.Synchronization.WaitFor(syncObjs, timeout, out handleIndex)) == KernelResult.Success)
  422. {
  423. KServerSession session = currentProcess.HandleTable.GetObject<KServerSession>(handles[handleIndex]);
  424. if (session == null)
  425. {
  426. break;
  427. }
  428. if ((result = session.Receive()) != KernelResult.NotFound)
  429. {
  430. break;
  431. }
  432. }
  433. }
  434. return result;
  435. }
  436. public KernelResult ReplyAndReceiveWithUserBuffer(
  437. ulong handlesPtr,
  438. ulong messagePtr,
  439. ulong messageSize,
  440. int handlesCount,
  441. int replyTargetHandle,
  442. long timeout,
  443. out int handleIndex)
  444. {
  445. handleIndex = 0;
  446. if ((uint)handlesCount > 0x40)
  447. {
  448. return KernelResult.MaximumExceeded;
  449. }
  450. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  451. ulong copySize = (ulong)((long)handlesCount * 4);
  452. if (!currentProcess.MemoryManager.InsideAddrSpace(handlesPtr, copySize))
  453. {
  454. return KernelResult.UserCopyFailed;
  455. }
  456. if (handlesPtr + copySize < handlesPtr)
  457. {
  458. return KernelResult.UserCopyFailed;
  459. }
  460. KernelResult result = currentProcess.MemoryManager.BorrowIpcBuffer(messagePtr, messageSize);
  461. if (result != KernelResult.Success)
  462. {
  463. return result;
  464. }
  465. int[] handles = new int[handlesCount];
  466. if (!KernelTransfer.UserToKernelInt32Array(_context, handlesPtr, handles))
  467. {
  468. currentProcess.MemoryManager.UnborrowIpcBuffer(messagePtr, messageSize);
  469. return KernelResult.UserCopyFailed;
  470. }
  471. KSynchronizationObject[] syncObjs = new KSynchronizationObject[handlesCount];
  472. for (int index = 0; index < handlesCount; index++)
  473. {
  474. KSynchronizationObject obj = currentProcess.HandleTable.GetObject<KSynchronizationObject>(handles[index]);
  475. if (obj == null)
  476. {
  477. currentProcess.MemoryManager.UnborrowIpcBuffer(messagePtr, messageSize);
  478. return KernelResult.InvalidHandle;
  479. }
  480. syncObjs[index] = obj;
  481. }
  482. if (replyTargetHandle != 0)
  483. {
  484. KServerSession replyTarget = currentProcess.HandleTable.GetObject<KServerSession>(replyTargetHandle);
  485. if (replyTarget == null)
  486. {
  487. result = KernelResult.InvalidHandle;
  488. }
  489. else
  490. {
  491. result = replyTarget.Reply(messagePtr, messageSize);
  492. }
  493. }
  494. if (result == KernelResult.Success)
  495. {
  496. if (timeout > 0)
  497. {
  498. timeout += KTimeManager.DefaultTimeIncrementNanoseconds;
  499. }
  500. while ((result = _context.Synchronization.WaitFor(syncObjs, timeout, out handleIndex)) == KernelResult.Success)
  501. {
  502. KServerSession session = currentProcess.HandleTable.GetObject<KServerSession>(handles[handleIndex]);
  503. if (session == null)
  504. {
  505. break;
  506. }
  507. if ((result = session.Receive(messagePtr, messageSize)) != KernelResult.NotFound)
  508. {
  509. break;
  510. }
  511. }
  512. }
  513. currentProcess.MemoryManager.UnborrowIpcBuffer(messagePtr, messageSize);
  514. return result;
  515. }
  516. public KernelResult CreatePort(
  517. int maxSessions,
  518. bool isLight,
  519. ulong namePtr,
  520. out int serverPortHandle,
  521. out int clientPortHandle)
  522. {
  523. serverPortHandle = clientPortHandle = 0;
  524. if (maxSessions < 1)
  525. {
  526. return KernelResult.MaximumExceeded;
  527. }
  528. KPort port = new KPort(_context, maxSessions, isLight, (long)namePtr);
  529. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  530. KernelResult result = currentProcess.HandleTable.GenerateHandle(port.ClientPort, out clientPortHandle);
  531. if (result != KernelResult.Success)
  532. {
  533. return result;
  534. }
  535. result = currentProcess.HandleTable.GenerateHandle(port.ServerPort, out serverPortHandle);
  536. if (result != KernelResult.Success)
  537. {
  538. currentProcess.HandleTable.CloseHandle(clientPortHandle);
  539. }
  540. return result;
  541. }
  542. public KernelResult ManageNamedPort(ulong namePtr, int maxSessions, out int handle)
  543. {
  544. handle = 0;
  545. if (!KernelTransfer.UserToKernelString(_context, namePtr, 12, out string name))
  546. {
  547. return KernelResult.UserCopyFailed;
  548. }
  549. if (name.Length > 11)
  550. {
  551. return KernelResult.MaximumExceeded;
  552. }
  553. return ManageNamedPort(name, maxSessions, out handle);
  554. }
  555. public KernelResult ManageNamedPort(string name, int maxSessions, out int handle)
  556. {
  557. handle = 0;
  558. if (maxSessions < 0)
  559. {
  560. return KernelResult.MaximumExceeded;
  561. }
  562. if (maxSessions == 0)
  563. {
  564. return KAutoObject.RemoveName(_context, name);
  565. }
  566. KPort port = new KPort(_context, maxSessions, false, 0);
  567. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  568. KernelResult result = currentProcess.HandleTable.GenerateHandle(port.ServerPort, out handle);
  569. if (result != KernelResult.Success)
  570. {
  571. return result;
  572. }
  573. result = port.ClientPort.SetName(name);
  574. if (result != KernelResult.Success)
  575. {
  576. currentProcess.HandleTable.CloseHandle(handle);
  577. }
  578. return result;
  579. }
  580. public KernelResult ConnectToPort(int clientPortHandle, out int clientSessionHandle)
  581. {
  582. clientSessionHandle = 0;
  583. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  584. KClientPort clientPort = currentProcess.HandleTable.GetObject<KClientPort>(clientPortHandle);
  585. if (clientPort == null)
  586. {
  587. return KernelResult.InvalidHandle;
  588. }
  589. KernelResult result = currentProcess.HandleTable.ReserveHandle(out int handle);
  590. if (result != KernelResult.Success)
  591. {
  592. return result;
  593. }
  594. KAutoObject session;
  595. if (clientPort.IsLight)
  596. {
  597. result = clientPort.ConnectLight(out KLightClientSession clientSession);
  598. session = clientSession;
  599. }
  600. else
  601. {
  602. result = clientPort.Connect(out KClientSession clientSession);
  603. session = clientSession;
  604. }
  605. if (result != KernelResult.Success)
  606. {
  607. currentProcess.HandleTable.CancelHandleReservation(handle);
  608. return result;
  609. }
  610. currentProcess.HandleTable.SetReservedHandleObj(handle, session);
  611. session.DecrementReferenceCount();
  612. clientSessionHandle = handle;
  613. return result;
  614. }
  615. // Memory
  616. public KernelResult SetHeapSize(ulong size, out ulong position)
  617. {
  618. if ((size & 0xfffffffe001fffff) != 0)
  619. {
  620. position = 0;
  621. return KernelResult.InvalidSize;
  622. }
  623. KProcess process = KernelStatic.GetCurrentProcess();
  624. return process.MemoryManager.SetHeapSize(size, out position);
  625. }
  626. public KernelResult SetMemoryPermission(ulong address, ulong size, KMemoryPermission permission)
  627. {
  628. if (!PageAligned(address))
  629. {
  630. return KernelResult.InvalidAddress;
  631. }
  632. if (!PageAligned(size) || size == 0)
  633. {
  634. return KernelResult.InvalidSize;
  635. }
  636. if (address + size <= address)
  637. {
  638. return KernelResult.InvalidMemState;
  639. }
  640. if (permission != KMemoryPermission.None && (permission | KMemoryPermission.Write) != KMemoryPermission.ReadAndWrite)
  641. {
  642. return KernelResult.InvalidPermission;
  643. }
  644. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  645. if (!currentProcess.MemoryManager.InsideAddrSpace(address, size))
  646. {
  647. return KernelResult.InvalidMemState;
  648. }
  649. return currentProcess.MemoryManager.SetMemoryPermission(address, size, permission);
  650. }
  651. public KernelResult SetMemoryAttribute(
  652. ulong position,
  653. ulong size,
  654. MemoryAttribute attributeMask,
  655. MemoryAttribute attributeValue)
  656. {
  657. if (!PageAligned(position))
  658. {
  659. return KernelResult.InvalidAddress;
  660. }
  661. if (!PageAligned(size) || size == 0)
  662. {
  663. return KernelResult.InvalidSize;
  664. }
  665. MemoryAttribute attributes = attributeMask | attributeValue;
  666. if (attributes != attributeMask ||
  667. (attributes | MemoryAttribute.Uncached) != MemoryAttribute.Uncached)
  668. {
  669. return KernelResult.InvalidCombination;
  670. }
  671. KProcess process = KernelStatic.GetCurrentProcess();
  672. if (!process.MemoryManager.InsideAddrSpace(position, size))
  673. {
  674. return KernelResult.InvalidMemState;
  675. }
  676. KernelResult result = process.MemoryManager.SetMemoryAttribute(
  677. position,
  678. size,
  679. attributeMask,
  680. attributeValue);
  681. return result;
  682. }
  683. public KernelResult MapMemory(ulong dst, ulong src, ulong size)
  684. {
  685. if (!PageAligned(src | dst))
  686. {
  687. return KernelResult.InvalidAddress;
  688. }
  689. if (!PageAligned(size) || size == 0)
  690. {
  691. return KernelResult.InvalidSize;
  692. }
  693. if (src + size <= src || dst + size <= dst)
  694. {
  695. return KernelResult.InvalidMemState;
  696. }
  697. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  698. if (!currentProcess.MemoryManager.InsideAddrSpace(src, size))
  699. {
  700. return KernelResult.InvalidMemState;
  701. }
  702. if (currentProcess.MemoryManager.OutsideStackRegion(dst, size) ||
  703. currentProcess.MemoryManager.InsideHeapRegion(dst, size) ||
  704. currentProcess.MemoryManager.InsideAliasRegion(dst, size))
  705. {
  706. return KernelResult.InvalidMemRange;
  707. }
  708. KProcess process = KernelStatic.GetCurrentProcess();
  709. return process.MemoryManager.Map(dst, src, size);
  710. }
  711. public KernelResult UnmapMemory(ulong dst, ulong src, ulong size)
  712. {
  713. if (!PageAligned(src | dst))
  714. {
  715. return KernelResult.InvalidAddress;
  716. }
  717. if (!PageAligned(size) || size == 0)
  718. {
  719. return KernelResult.InvalidSize;
  720. }
  721. if (src + size <= src || dst + size <= dst)
  722. {
  723. return KernelResult.InvalidMemState;
  724. }
  725. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  726. if (!currentProcess.MemoryManager.InsideAddrSpace(src, size))
  727. {
  728. return KernelResult.InvalidMemState;
  729. }
  730. if (currentProcess.MemoryManager.OutsideStackRegion(dst, size) ||
  731. currentProcess.MemoryManager.InsideHeapRegion(dst, size) ||
  732. currentProcess.MemoryManager.InsideAliasRegion(dst, size))
  733. {
  734. return KernelResult.InvalidMemRange;
  735. }
  736. KProcess process = KernelStatic.GetCurrentProcess();
  737. return process.MemoryManager.Unmap(dst, src, size);
  738. }
  739. public KernelResult QueryMemory(ulong infoPtr, ulong position, out ulong pageInfo)
  740. {
  741. KProcess process = KernelStatic.GetCurrentProcess();
  742. KMemoryInfo blkInfo = process.MemoryManager.QueryMemory(position);
  743. process.CpuMemory.Write(infoPtr + 0x00, blkInfo.Address);
  744. process.CpuMemory.Write(infoPtr + 0x08, blkInfo.Size);
  745. process.CpuMemory.Write(infoPtr + 0x10, (int)blkInfo.State & 0xff);
  746. process.CpuMemory.Write(infoPtr + 0x14, (int)blkInfo.Attribute);
  747. process.CpuMemory.Write(infoPtr + 0x18, (int)blkInfo.Permission);
  748. process.CpuMemory.Write(infoPtr + 0x1c, blkInfo.IpcRefCount);
  749. process.CpuMemory.Write(infoPtr + 0x20, blkInfo.DeviceRefCount);
  750. process.CpuMemory.Write(infoPtr + 0x24, 0);
  751. pageInfo = 0;
  752. return KernelResult.Success;
  753. }
  754. public KernelResult MapSharedMemory(int handle, ulong address, ulong size, KMemoryPermission permission)
  755. {
  756. if (!PageAligned(address))
  757. {
  758. return KernelResult.InvalidAddress;
  759. }
  760. if (!PageAligned(size) || size == 0)
  761. {
  762. return KernelResult.InvalidSize;
  763. }
  764. if (address + size <= address)
  765. {
  766. return KernelResult.InvalidMemState;
  767. }
  768. if ((permission | KMemoryPermission.Write) != KMemoryPermission.ReadAndWrite)
  769. {
  770. return KernelResult.InvalidPermission;
  771. }
  772. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  773. KSharedMemory sharedMemory = currentProcess.HandleTable.GetObject<KSharedMemory>(handle);
  774. if (sharedMemory == null)
  775. {
  776. return KernelResult.InvalidHandle;
  777. }
  778. if (currentProcess.MemoryManager.IsInvalidRegion(address, size) ||
  779. currentProcess.MemoryManager.InsideHeapRegion(address, size) ||
  780. currentProcess.MemoryManager.InsideAliasRegion(address, size))
  781. {
  782. return KernelResult.InvalidMemRange;
  783. }
  784. return sharedMemory.MapIntoProcess(
  785. currentProcess.MemoryManager,
  786. address,
  787. size,
  788. currentProcess,
  789. permission);
  790. }
  791. public KernelResult UnmapSharedMemory(int handle, ulong address, ulong size)
  792. {
  793. if (!PageAligned(address))
  794. {
  795. return KernelResult.InvalidAddress;
  796. }
  797. if (!PageAligned(size) || size == 0)
  798. {
  799. return KernelResult.InvalidSize;
  800. }
  801. if (address + size <= address)
  802. {
  803. return KernelResult.InvalidMemState;
  804. }
  805. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  806. KSharedMemory sharedMemory = currentProcess.HandleTable.GetObject<KSharedMemory>(handle);
  807. if (sharedMemory == null)
  808. {
  809. return KernelResult.InvalidHandle;
  810. }
  811. if (currentProcess.MemoryManager.IsInvalidRegion(address, size) ||
  812. currentProcess.MemoryManager.InsideHeapRegion(address, size) ||
  813. currentProcess.MemoryManager.InsideAliasRegion(address, size))
  814. {
  815. return KernelResult.InvalidMemRange;
  816. }
  817. return sharedMemory.UnmapFromProcess(
  818. currentProcess.MemoryManager,
  819. address,
  820. size,
  821. currentProcess);
  822. }
  823. public KernelResult CreateTransferMemory(ulong address, ulong size, KMemoryPermission permission, out int handle)
  824. {
  825. handle = 0;
  826. if (!PageAligned(address))
  827. {
  828. return KernelResult.InvalidAddress;
  829. }
  830. if (!PageAligned(size) || size == 0)
  831. {
  832. return KernelResult.InvalidSize;
  833. }
  834. if (address + size <= address)
  835. {
  836. return KernelResult.InvalidMemState;
  837. }
  838. if (permission > KMemoryPermission.ReadAndWrite || permission == KMemoryPermission.Write)
  839. {
  840. return KernelResult.InvalidPermission;
  841. }
  842. KProcess process = KernelStatic.GetCurrentProcess();
  843. KResourceLimit resourceLimit = process.ResourceLimit;
  844. if (resourceLimit != null && !resourceLimit.Reserve(LimitableResource.TransferMemory, 1))
  845. {
  846. return KernelResult.ResLimitExceeded;
  847. }
  848. void CleanUpForError()
  849. {
  850. resourceLimit?.Release(LimitableResource.TransferMemory, 1);
  851. }
  852. if (!process.MemoryManager.InsideAddrSpace(address, size))
  853. {
  854. CleanUpForError();
  855. return KernelResult.InvalidMemState;
  856. }
  857. KTransferMemory transferMemory = new KTransferMemory(_context);
  858. KernelResult result = transferMemory.Initialize(address, size, permission);
  859. if (result != KernelResult.Success)
  860. {
  861. CleanUpForError();
  862. return result;
  863. }
  864. result = process.HandleTable.GenerateHandle(transferMemory, out handle);
  865. transferMemory.DecrementReferenceCount();
  866. return result;
  867. }
  868. public KernelResult MapTransferMemory(int handle, ulong address, ulong size, KMemoryPermission permission)
  869. {
  870. if (!PageAligned(address))
  871. {
  872. return KernelResult.InvalidAddress;
  873. }
  874. if (!PageAligned(size) || size == 0)
  875. {
  876. return KernelResult.InvalidSize;
  877. }
  878. if (address + size <= address)
  879. {
  880. return KernelResult.InvalidMemState;
  881. }
  882. if (permission > KMemoryPermission.ReadAndWrite || permission == KMemoryPermission.Write)
  883. {
  884. return KernelResult.InvalidPermission;
  885. }
  886. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  887. KTransferMemory transferMemory = currentProcess.HandleTable.GetObject<KTransferMemory>(handle);
  888. if (transferMemory == null)
  889. {
  890. return KernelResult.InvalidHandle;
  891. }
  892. if (currentProcess.MemoryManager.IsInvalidRegion(address, size) ||
  893. currentProcess.MemoryManager.InsideHeapRegion(address, size) ||
  894. currentProcess.MemoryManager.InsideAliasRegion(address, size))
  895. {
  896. return KernelResult.InvalidMemRange;
  897. }
  898. return transferMemory.MapIntoProcess(
  899. currentProcess.MemoryManager,
  900. address,
  901. size,
  902. currentProcess,
  903. permission);
  904. }
  905. public KernelResult UnmapTransferMemory(int handle, ulong address, ulong size)
  906. {
  907. if (!PageAligned(address))
  908. {
  909. return KernelResult.InvalidAddress;
  910. }
  911. if (!PageAligned(size) || size == 0)
  912. {
  913. return KernelResult.InvalidSize;
  914. }
  915. if (address + size <= address)
  916. {
  917. return KernelResult.InvalidMemState;
  918. }
  919. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  920. KTransferMemory transferMemory = currentProcess.HandleTable.GetObject<KTransferMemory>(handle);
  921. if (transferMemory == null)
  922. {
  923. return KernelResult.InvalidHandle;
  924. }
  925. if (currentProcess.MemoryManager.IsInvalidRegion(address, size) ||
  926. currentProcess.MemoryManager.InsideHeapRegion(address, size) ||
  927. currentProcess.MemoryManager.InsideAliasRegion(address, size))
  928. {
  929. return KernelResult.InvalidMemRange;
  930. }
  931. return transferMemory.UnmapFromProcess(
  932. currentProcess.MemoryManager,
  933. address,
  934. size,
  935. currentProcess);
  936. }
  937. public KernelResult MapPhysicalMemory(ulong address, ulong size)
  938. {
  939. if (!PageAligned(address))
  940. {
  941. return KernelResult.InvalidAddress;
  942. }
  943. if (!PageAligned(size) || size == 0)
  944. {
  945. return KernelResult.InvalidSize;
  946. }
  947. if (address + size <= address)
  948. {
  949. return KernelResult.InvalidMemRange;
  950. }
  951. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  952. if ((currentProcess.PersonalMmHeapPagesCount & 0xfffffffffffff) == 0)
  953. {
  954. return KernelResult.InvalidState;
  955. }
  956. if (!currentProcess.MemoryManager.InsideAddrSpace(address, size) ||
  957. currentProcess.MemoryManager.OutsideAliasRegion(address, size))
  958. {
  959. return KernelResult.InvalidMemRange;
  960. }
  961. KProcess process = KernelStatic.GetCurrentProcess();
  962. return process.MemoryManager.MapPhysicalMemory(address, size);
  963. }
  964. public KernelResult UnmapPhysicalMemory(ulong address, ulong size)
  965. {
  966. if (!PageAligned(address))
  967. {
  968. return KernelResult.InvalidAddress;
  969. }
  970. if (!PageAligned(size) || size == 0)
  971. {
  972. return KernelResult.InvalidSize;
  973. }
  974. if (address + size <= address)
  975. {
  976. return KernelResult.InvalidMemRange;
  977. }
  978. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  979. if ((currentProcess.PersonalMmHeapPagesCount & 0xfffffffffffff) == 0)
  980. {
  981. return KernelResult.InvalidState;
  982. }
  983. if (!currentProcess.MemoryManager.InsideAddrSpace(address, size) ||
  984. currentProcess.MemoryManager.OutsideAliasRegion(address, size))
  985. {
  986. return KernelResult.InvalidMemRange;
  987. }
  988. KProcess process = KernelStatic.GetCurrentProcess();
  989. return process.MemoryManager.UnmapPhysicalMemory(address, size);
  990. }
  991. public KernelResult MapProcessCodeMemory(int handle, ulong dst, ulong src, ulong size)
  992. {
  993. if (!PageAligned(dst) || !PageAligned(src))
  994. {
  995. return KernelResult.InvalidAddress;
  996. }
  997. if (!PageAligned(size) || size == 0)
  998. {
  999. return KernelResult.InvalidSize;
  1000. }
  1001. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  1002. KProcess targetProcess = currentProcess.HandleTable.GetObject<KProcess>(handle);
  1003. if (targetProcess == null)
  1004. {
  1005. return KernelResult.InvalidHandle;
  1006. }
  1007. if (targetProcess.MemoryManager.OutsideAddrSpace(dst, size) ||
  1008. targetProcess.MemoryManager.OutsideAddrSpace(src, size) ||
  1009. targetProcess.MemoryManager.InsideAliasRegion(dst, size) ||
  1010. targetProcess.MemoryManager.InsideHeapRegion(dst, size))
  1011. {
  1012. return KernelResult.InvalidMemRange;
  1013. }
  1014. if (size + dst <= dst || size + src <= src)
  1015. {
  1016. return KernelResult.InvalidMemState;
  1017. }
  1018. return targetProcess.MemoryManager.MapProcessCodeMemory(dst, src, size);
  1019. }
  1020. public KernelResult UnmapProcessCodeMemory(int handle, ulong dst, ulong src, ulong size)
  1021. {
  1022. if (!PageAligned(dst) || !PageAligned(src))
  1023. {
  1024. return KernelResult.InvalidAddress;
  1025. }
  1026. if (!PageAligned(size) || size == 0)
  1027. {
  1028. return KernelResult.InvalidSize;
  1029. }
  1030. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  1031. KProcess targetProcess = currentProcess.HandleTable.GetObject<KProcess>(handle);
  1032. if (targetProcess == null)
  1033. {
  1034. return KernelResult.InvalidHandle;
  1035. }
  1036. if (targetProcess.MemoryManager.OutsideAddrSpace(dst, size) ||
  1037. targetProcess.MemoryManager.OutsideAddrSpace(src, size) ||
  1038. targetProcess.MemoryManager.InsideAliasRegion(dst, size) ||
  1039. targetProcess.MemoryManager.InsideHeapRegion(dst, size))
  1040. {
  1041. return KernelResult.InvalidMemRange;
  1042. }
  1043. if (size + dst <= dst || size + src <= src)
  1044. {
  1045. return KernelResult.InvalidMemState;
  1046. }
  1047. return targetProcess.MemoryManager.UnmapProcessCodeMemory(dst, src, size);
  1048. }
  1049. public KernelResult SetProcessMemoryPermission(int handle, ulong src, ulong size, KMemoryPermission permission)
  1050. {
  1051. if (!PageAligned(src))
  1052. {
  1053. return KernelResult.InvalidAddress;
  1054. }
  1055. if (!PageAligned(size) || size == 0)
  1056. {
  1057. return KernelResult.InvalidSize;
  1058. }
  1059. if (permission != KMemoryPermission.None &&
  1060. permission != KMemoryPermission.Read &&
  1061. permission != KMemoryPermission.ReadAndWrite &&
  1062. permission != KMemoryPermission.ReadAndExecute)
  1063. {
  1064. return KernelResult.InvalidPermission;
  1065. }
  1066. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  1067. KProcess targetProcess = currentProcess.HandleTable.GetObject<KProcess>(handle);
  1068. if (targetProcess == null)
  1069. {
  1070. return KernelResult.InvalidHandle;
  1071. }
  1072. if (targetProcess.MemoryManager.OutsideAddrSpace(src, size))
  1073. {
  1074. return KernelResult.InvalidMemState;
  1075. }
  1076. return targetProcess.MemoryManager.SetProcessMemoryPermission(src, size, permission);
  1077. }
  1078. private static bool PageAligned(ulong position)
  1079. {
  1080. return (position & (KPageTableBase.PageSize - 1)) == 0;
  1081. }
  1082. // System
  1083. public KernelResult TerminateProcess(int handle)
  1084. {
  1085. KProcess process = KernelStatic.GetCurrentProcess();
  1086. process = process.HandleTable.GetObject<KProcess>(handle);
  1087. KernelResult result;
  1088. if (process != null)
  1089. {
  1090. if (process == KernelStatic.GetCurrentProcess())
  1091. {
  1092. result = KernelResult.Success;
  1093. process.DecrementToZeroWhileTerminatingCurrent();
  1094. }
  1095. else
  1096. {
  1097. result = process.Terminate();
  1098. process.DecrementReferenceCount();
  1099. }
  1100. }
  1101. else
  1102. {
  1103. result = KernelResult.InvalidHandle;
  1104. }
  1105. return result;
  1106. }
  1107. public void ExitProcess()
  1108. {
  1109. KernelStatic.GetCurrentProcess().TerminateCurrentProcess();
  1110. }
  1111. public KernelResult SignalEvent(int handle)
  1112. {
  1113. KProcess process = KernelStatic.GetCurrentProcess();
  1114. KWritableEvent writableEvent = process.HandleTable.GetObject<KWritableEvent>(handle);
  1115. KernelResult result;
  1116. if (writableEvent != null)
  1117. {
  1118. writableEvent.Signal();
  1119. result = KernelResult.Success;
  1120. }
  1121. else
  1122. {
  1123. result = KernelResult.InvalidHandle;
  1124. }
  1125. return result;
  1126. }
  1127. public KernelResult ClearEvent(int handle)
  1128. {
  1129. KernelResult result;
  1130. KProcess process = KernelStatic.GetCurrentProcess();
  1131. KWritableEvent writableEvent = process.HandleTable.GetObject<KWritableEvent>(handle);
  1132. if (writableEvent == null)
  1133. {
  1134. KReadableEvent readableEvent = process.HandleTable.GetObject<KReadableEvent>(handle);
  1135. result = readableEvent?.Clear() ?? KernelResult.InvalidHandle;
  1136. }
  1137. else
  1138. {
  1139. result = writableEvent.Clear();
  1140. }
  1141. return result;
  1142. }
  1143. public KernelResult CloseHandle(int handle)
  1144. {
  1145. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  1146. return currentProcess.HandleTable.CloseHandle(handle) ? KernelResult.Success : KernelResult.InvalidHandle;
  1147. }
  1148. public KernelResult ResetSignal(int handle)
  1149. {
  1150. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  1151. KReadableEvent readableEvent = currentProcess.HandleTable.GetObject<KReadableEvent>(handle);
  1152. KernelResult result;
  1153. if (readableEvent != null)
  1154. {
  1155. result = readableEvent.ClearIfSignaled();
  1156. }
  1157. else
  1158. {
  1159. KProcess process = currentProcess.HandleTable.GetKProcess(handle);
  1160. if (process != null)
  1161. {
  1162. result = process.ClearIfNotExited();
  1163. }
  1164. else
  1165. {
  1166. result = KernelResult.InvalidHandle;
  1167. }
  1168. }
  1169. return result;
  1170. }
  1171. public ulong GetSystemTick()
  1172. {
  1173. return KernelStatic.GetCurrentThread().Context.CntpctEl0;
  1174. }
  1175. public void Break(ulong reason)
  1176. {
  1177. KThread currentThread = KernelStatic.GetCurrentThread();
  1178. if ((reason & (1UL << 31)) == 0)
  1179. {
  1180. currentThread.PrintGuestStackTrace();
  1181. currentThread.PrintGuestRegisterPrintout();
  1182. // As the process is exiting, this is probably caused by emulation termination.
  1183. if (currentThread.Owner.State == ProcessState.Exiting)
  1184. {
  1185. return;
  1186. }
  1187. // TODO: Debug events.
  1188. currentThread.Owner.TerminateCurrentProcess();
  1189. throw new GuestBrokeExecutionException();
  1190. }
  1191. else
  1192. {
  1193. Logger.Debug?.Print(LogClass.KernelSvc, "Debugger triggered.");
  1194. }
  1195. }
  1196. public void OutputDebugString(ulong strPtr, ulong size)
  1197. {
  1198. KProcess process = KernelStatic.GetCurrentProcess();
  1199. string str = MemoryHelper.ReadAsciiString(process.CpuMemory, strPtr, (long)size);
  1200. Logger.Warning?.Print(LogClass.KernelSvc, str);
  1201. }
  1202. public KernelResult GetInfo(InfoType id, int handle, long subId, out long value)
  1203. {
  1204. value = 0;
  1205. switch (id)
  1206. {
  1207. case InfoType.CoreMask:
  1208. case InfoType.PriorityMask:
  1209. case InfoType.AliasRegionAddress:
  1210. case InfoType.AliasRegionSize:
  1211. case InfoType.HeapRegionAddress:
  1212. case InfoType.HeapRegionSize:
  1213. case InfoType.TotalMemorySize:
  1214. case InfoType.UsedMemorySize:
  1215. case InfoType.AslrRegionAddress:
  1216. case InfoType.AslrRegionSize:
  1217. case InfoType.StackRegionAddress:
  1218. case InfoType.StackRegionSize:
  1219. case InfoType.SystemResourceSizeTotal:
  1220. case InfoType.SystemResourceSizeUsed:
  1221. case InfoType.ProgramId:
  1222. case InfoType.UserExceptionContextAddress:
  1223. case InfoType.TotalNonSystemMemorySize:
  1224. case InfoType.UsedNonSystemMemorySize:
  1225. case InfoType.IsApplication:
  1226. case InfoType.FreeThreadCount:
  1227. {
  1228. if (subId != 0)
  1229. {
  1230. return KernelResult.InvalidCombination;
  1231. }
  1232. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  1233. KProcess process = currentProcess.HandleTable.GetKProcess(handle);
  1234. if (process == null)
  1235. {
  1236. return KernelResult.InvalidHandle;
  1237. }
  1238. switch (id)
  1239. {
  1240. case InfoType.CoreMask: value = process.Capabilities.AllowedCpuCoresMask; break;
  1241. case InfoType.PriorityMask: value = process.Capabilities.AllowedThreadPriosMask; break;
  1242. case InfoType.AliasRegionAddress: value = (long)process.MemoryManager.AliasRegionStart; break;
  1243. case InfoType.AliasRegionSize:
  1244. value = (long)(process.MemoryManager.AliasRegionEnd -
  1245. process.MemoryManager.AliasRegionStart); break;
  1246. case InfoType.HeapRegionAddress: value = (long)process.MemoryManager.HeapRegionStart; break;
  1247. case InfoType.HeapRegionSize:
  1248. value = (long)(process.MemoryManager.HeapRegionEnd -
  1249. process.MemoryManager.HeapRegionStart); break;
  1250. case InfoType.TotalMemorySize: value = (long)process.GetMemoryCapacity(); break;
  1251. case InfoType.UsedMemorySize: value = (long)process.GetMemoryUsage(); break;
  1252. case InfoType.AslrRegionAddress: value = (long)process.MemoryManager.GetAddrSpaceBaseAddr(); break;
  1253. case InfoType.AslrRegionSize: value = (long)process.MemoryManager.GetAddrSpaceSize(); break;
  1254. case InfoType.StackRegionAddress: value = (long)process.MemoryManager.StackRegionStart; break;
  1255. case InfoType.StackRegionSize:
  1256. value = (long)(process.MemoryManager.StackRegionEnd -
  1257. process.MemoryManager.StackRegionStart); break;
  1258. case InfoType.SystemResourceSizeTotal: value = (long)process.PersonalMmHeapPagesCount * KPageTableBase.PageSize; break;
  1259. case InfoType.SystemResourceSizeUsed:
  1260. if (process.PersonalMmHeapPagesCount != 0)
  1261. {
  1262. value = process.MemoryManager.GetMmUsedPages() * KPageTableBase.PageSize;
  1263. }
  1264. break;
  1265. case InfoType.ProgramId: value = (long)process.TitleId; break;
  1266. case InfoType.UserExceptionContextAddress: value = (long)process.UserExceptionContextAddress; break;
  1267. case InfoType.TotalNonSystemMemorySize: value = (long)process.GetMemoryCapacityWithoutPersonalMmHeap(); break;
  1268. case InfoType.UsedNonSystemMemorySize: value = (long)process.GetMemoryUsageWithoutPersonalMmHeap(); break;
  1269. case InfoType.IsApplication: value = process.IsApplication ? 1 : 0; break;
  1270. case InfoType.FreeThreadCount:
  1271. if (process.ResourceLimit != null)
  1272. {
  1273. value = process.ResourceLimit.GetLimitValue(LimitableResource.Thread) - process.ResourceLimit.GetCurrentValue(LimitableResource.Thread);
  1274. }
  1275. else
  1276. {
  1277. value = 0;
  1278. }
  1279. break;
  1280. }
  1281. break;
  1282. }
  1283. case InfoType.DebuggerAttached:
  1284. {
  1285. if (handle != 0)
  1286. {
  1287. return KernelResult.InvalidHandle;
  1288. }
  1289. if (subId != 0)
  1290. {
  1291. return KernelResult.InvalidCombination;
  1292. }
  1293. value = KernelStatic.GetCurrentProcess().Debug ? 1 : 0;
  1294. break;
  1295. }
  1296. case InfoType.ResourceLimit:
  1297. {
  1298. if (handle != 0)
  1299. {
  1300. return KernelResult.InvalidHandle;
  1301. }
  1302. if (subId != 0)
  1303. {
  1304. return KernelResult.InvalidCombination;
  1305. }
  1306. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  1307. if (currentProcess.ResourceLimit != null)
  1308. {
  1309. KHandleTable handleTable = currentProcess.HandleTable;
  1310. KResourceLimit resourceLimit = currentProcess.ResourceLimit;
  1311. KernelResult result = handleTable.GenerateHandle(resourceLimit, out int resLimHandle);
  1312. if (result != KernelResult.Success)
  1313. {
  1314. return result;
  1315. }
  1316. value = (uint)resLimHandle;
  1317. }
  1318. break;
  1319. }
  1320. case InfoType.IdleTickCount:
  1321. {
  1322. if (handle != 0)
  1323. {
  1324. return KernelResult.InvalidHandle;
  1325. }
  1326. int currentCore = KernelStatic.GetCurrentThread().CurrentCore;
  1327. if (subId != -1 && subId != currentCore)
  1328. {
  1329. return KernelResult.InvalidCombination;
  1330. }
  1331. value = KTimeManager.ConvertHostTicksToTicks(_context.Schedulers[currentCore].TotalIdleTimeTicks);
  1332. break;
  1333. }
  1334. case InfoType.RandomEntropy:
  1335. {
  1336. if (handle != 0)
  1337. {
  1338. return KernelResult.InvalidHandle;
  1339. }
  1340. if ((ulong)subId > 3)
  1341. {
  1342. return KernelResult.InvalidCombination;
  1343. }
  1344. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  1345. value = currentProcess.RandomEntropy[subId];
  1346. break;
  1347. }
  1348. case InfoType.ThreadTickCount:
  1349. {
  1350. if (subId < -1 || subId > 3)
  1351. {
  1352. return KernelResult.InvalidCombination;
  1353. }
  1354. KThread thread = KernelStatic.GetCurrentProcess().HandleTable.GetKThread(handle);
  1355. if (thread == null)
  1356. {
  1357. return KernelResult.InvalidHandle;
  1358. }
  1359. KThread currentThread = KernelStatic.GetCurrentThread();
  1360. int currentCore = currentThread.CurrentCore;
  1361. if (subId != -1 && subId != currentCore)
  1362. {
  1363. return KernelResult.Success;
  1364. }
  1365. KScheduler scheduler = _context.Schedulers[currentCore];
  1366. long timeDelta = PerformanceCounter.ElapsedTicks - scheduler.LastContextSwitchTime;
  1367. if (subId != -1)
  1368. {
  1369. value = KTimeManager.ConvertHostTicksToTicks(timeDelta);
  1370. }
  1371. else
  1372. {
  1373. long totalTimeRunning = thread.TotalTimeRunning;
  1374. if (thread == currentThread)
  1375. {
  1376. totalTimeRunning += timeDelta;
  1377. }
  1378. value = KTimeManager.ConvertHostTicksToTicks(totalTimeRunning);
  1379. }
  1380. break;
  1381. }
  1382. default: return KernelResult.InvalidEnumValue;
  1383. }
  1384. return KernelResult.Success;
  1385. }
  1386. public KernelResult CreateEvent(out int wEventHandle, out int rEventHandle)
  1387. {
  1388. KEvent Event = new KEvent(_context);
  1389. KProcess process = KernelStatic.GetCurrentProcess();
  1390. KernelResult result = process.HandleTable.GenerateHandle(Event.WritableEvent, out wEventHandle);
  1391. if (result == KernelResult.Success)
  1392. {
  1393. result = process.HandleTable.GenerateHandle(Event.ReadableEvent, out rEventHandle);
  1394. if (result != KernelResult.Success)
  1395. {
  1396. process.HandleTable.CloseHandle(wEventHandle);
  1397. }
  1398. }
  1399. else
  1400. {
  1401. rEventHandle = 0;
  1402. }
  1403. return result;
  1404. }
  1405. public KernelResult GetProcessList(ulong address, int maxCount, out int count)
  1406. {
  1407. count = 0;
  1408. if ((maxCount >> 28) != 0)
  1409. {
  1410. return KernelResult.MaximumExceeded;
  1411. }
  1412. if (maxCount != 0)
  1413. {
  1414. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  1415. ulong copySize = (ulong)maxCount * 8;
  1416. if (address + copySize <= address)
  1417. {
  1418. return KernelResult.InvalidMemState;
  1419. }
  1420. if (currentProcess.MemoryManager.OutsideAddrSpace(address, copySize))
  1421. {
  1422. return KernelResult.InvalidMemState;
  1423. }
  1424. }
  1425. int copyCount = 0;
  1426. lock (_context.Processes)
  1427. {
  1428. foreach (KProcess process in _context.Processes.Values)
  1429. {
  1430. if (copyCount < maxCount)
  1431. {
  1432. if (!KernelTransfer.KernelToUserInt64(_context, address + (ulong)copyCount * 8, process.Pid))
  1433. {
  1434. return KernelResult.UserCopyFailed;
  1435. }
  1436. }
  1437. copyCount++;
  1438. }
  1439. }
  1440. count = copyCount;
  1441. return KernelResult.Success;
  1442. }
  1443. public KernelResult GetSystemInfo(uint id, int handle, long subId, out long value)
  1444. {
  1445. value = 0;
  1446. if (id > 2)
  1447. {
  1448. return KernelResult.InvalidEnumValue;
  1449. }
  1450. if (handle != 0)
  1451. {
  1452. return KernelResult.InvalidHandle;
  1453. }
  1454. if (id < 2)
  1455. {
  1456. if ((ulong)subId > 3)
  1457. {
  1458. return KernelResult.InvalidCombination;
  1459. }
  1460. KMemoryRegionManager region = _context.MemoryManager.MemoryRegions[subId];
  1461. switch (id)
  1462. {
  1463. // Memory region capacity.
  1464. case 0: value = (long)region.Size; break;
  1465. // Memory region free space.
  1466. case 1:
  1467. {
  1468. ulong freePagesCount = region.GetFreePages();
  1469. value = (long)(freePagesCount * KPageTableBase.PageSize);
  1470. break;
  1471. }
  1472. }
  1473. }
  1474. else /* if (Id == 2) */
  1475. {
  1476. if ((ulong)subId > 1)
  1477. {
  1478. return KernelResult.InvalidCombination;
  1479. }
  1480. switch (subId)
  1481. {
  1482. case 0: value = _context.PrivilegedProcessLowestId; break;
  1483. case 1: value = _context.PrivilegedProcessHighestId; break;
  1484. }
  1485. }
  1486. return KernelResult.Success;
  1487. }
  1488. public KernelResult GetResourceLimitLimitValue(int handle, LimitableResource resource, out long limitValue)
  1489. {
  1490. limitValue = 0;
  1491. if (resource >= LimitableResource.Count)
  1492. {
  1493. return KernelResult.InvalidEnumValue;
  1494. }
  1495. KResourceLimit resourceLimit = KernelStatic.GetCurrentProcess().HandleTable.GetObject<KResourceLimit>(handle);
  1496. if (resourceLimit == null)
  1497. {
  1498. return KernelResult.InvalidHandle;
  1499. }
  1500. limitValue = resourceLimit.GetLimitValue(resource);
  1501. return KernelResult.Success;
  1502. }
  1503. public KernelResult GetResourceLimitCurrentValue(int handle, LimitableResource resource, out long limitValue)
  1504. {
  1505. limitValue = 0;
  1506. if (resource >= LimitableResource.Count)
  1507. {
  1508. return KernelResult.InvalidEnumValue;
  1509. }
  1510. KResourceLimit resourceLimit = KernelStatic.GetCurrentProcess().HandleTable.GetObject<KResourceLimit>(handle);
  1511. if (resourceLimit == null)
  1512. {
  1513. return KernelResult.InvalidHandle;
  1514. }
  1515. limitValue = resourceLimit.GetCurrentValue(resource);
  1516. return KernelResult.Success;
  1517. }
  1518. public KernelResult GetResourceLimitPeakValue(int handle, LimitableResource resource, out long peak)
  1519. {
  1520. peak = 0;
  1521. if (resource >= LimitableResource.Count)
  1522. {
  1523. return KernelResult.InvalidEnumValue;
  1524. }
  1525. KResourceLimit resourceLimit = KernelStatic.GetCurrentProcess().HandleTable.GetObject<KResourceLimit>(handle);
  1526. if (resourceLimit == null)
  1527. {
  1528. return KernelResult.InvalidHandle;
  1529. }
  1530. peak = resourceLimit.GetPeakValue(resource);
  1531. return KernelResult.Success;
  1532. }
  1533. public KernelResult CreateResourceLimit(out int handle)
  1534. {
  1535. KResourceLimit limit = new KResourceLimit(_context);
  1536. KProcess process = KernelStatic.GetCurrentProcess();
  1537. return process.HandleTable.GenerateHandle(limit, out handle);
  1538. }
  1539. public KernelResult SetResourceLimitLimitValue(int handle, LimitableResource resource, long limitValue)
  1540. {
  1541. if (resource >= LimitableResource.Count)
  1542. {
  1543. return KernelResult.InvalidEnumValue;
  1544. }
  1545. KResourceLimit resourceLimit = KernelStatic.GetCurrentProcess().HandleTable.GetObject<KResourceLimit>(handle);
  1546. if (resourceLimit == null)
  1547. {
  1548. return KernelResult.InvalidHandle;
  1549. }
  1550. return resourceLimit.SetLimitValue(resource, limitValue);
  1551. }
  1552. // Thread
  1553. public KernelResult CreateThread(
  1554. ulong entrypoint,
  1555. ulong argsPtr,
  1556. ulong stackTop,
  1557. int priority,
  1558. int cpuCore,
  1559. out int handle)
  1560. {
  1561. handle = 0;
  1562. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  1563. if (cpuCore == -2)
  1564. {
  1565. cpuCore = currentProcess.DefaultCpuCore;
  1566. }
  1567. if ((uint)cpuCore >= KScheduler.CpuCoresCount || !currentProcess.IsCpuCoreAllowed(cpuCore))
  1568. {
  1569. return KernelResult.InvalidCpuCore;
  1570. }
  1571. if ((uint)priority >= KScheduler.PrioritiesCount || !currentProcess.IsPriorityAllowed(priority))
  1572. {
  1573. return KernelResult.InvalidPriority;
  1574. }
  1575. long timeout = KTimeManager.ConvertMillisecondsToNanoseconds(100);
  1576. if (currentProcess.ResourceLimit != null &&
  1577. !currentProcess.ResourceLimit.Reserve(LimitableResource.Thread, 1, timeout))
  1578. {
  1579. return KernelResult.ResLimitExceeded;
  1580. }
  1581. KThread thread = new KThread(_context);
  1582. KernelResult result = currentProcess.InitializeThread(
  1583. thread,
  1584. entrypoint,
  1585. argsPtr,
  1586. stackTop,
  1587. priority,
  1588. cpuCore);
  1589. if (result == KernelResult.Success)
  1590. {
  1591. KProcess process = KernelStatic.GetCurrentProcess();
  1592. result = process.HandleTable.GenerateHandle(thread, out handle);
  1593. }
  1594. else
  1595. {
  1596. currentProcess.ResourceLimit?.Release(LimitableResource.Thread, 1);
  1597. }
  1598. thread.DecrementReferenceCount();
  1599. return result;
  1600. }
  1601. public KernelResult StartThread(int handle)
  1602. {
  1603. KProcess process = KernelStatic.GetCurrentProcess();
  1604. KThread thread = process.HandleTable.GetKThread(handle);
  1605. if (thread != null)
  1606. {
  1607. thread.IncrementReferenceCount();
  1608. KernelResult result = thread.Start();
  1609. if (result == KernelResult.Success)
  1610. {
  1611. thread.IncrementReferenceCount();
  1612. }
  1613. thread.DecrementReferenceCount();
  1614. return result;
  1615. }
  1616. else
  1617. {
  1618. return KernelResult.InvalidHandle;
  1619. }
  1620. }
  1621. public void ExitThread()
  1622. {
  1623. KThread currentThread = KernelStatic.GetCurrentThread();
  1624. currentThread.Exit();
  1625. }
  1626. public void SleepThread(long timeout)
  1627. {
  1628. if (timeout < 1)
  1629. {
  1630. switch (timeout)
  1631. {
  1632. case 0: KScheduler.Yield(_context); break;
  1633. case -1: KScheduler.YieldWithLoadBalancing(_context); break;
  1634. case -2: KScheduler.YieldToAnyThread(_context); break;
  1635. }
  1636. }
  1637. else
  1638. {
  1639. KernelStatic.GetCurrentThread().Sleep(timeout + KTimeManager.DefaultTimeIncrementNanoseconds);
  1640. }
  1641. }
  1642. public KernelResult GetThreadPriority(int handle, out int priority)
  1643. {
  1644. KProcess process = KernelStatic.GetCurrentProcess();
  1645. KThread thread = process.HandleTable.GetKThread(handle);
  1646. if (thread != null)
  1647. {
  1648. priority = thread.DynamicPriority;
  1649. return KernelResult.Success;
  1650. }
  1651. else
  1652. {
  1653. priority = 0;
  1654. return KernelResult.InvalidHandle;
  1655. }
  1656. }
  1657. public KernelResult SetThreadPriority(int handle, int priority)
  1658. {
  1659. // TODO: NPDM check.
  1660. KProcess process = KernelStatic.GetCurrentProcess();
  1661. KThread thread = process.HandleTable.GetKThread(handle);
  1662. if (thread == null)
  1663. {
  1664. return KernelResult.InvalidHandle;
  1665. }
  1666. thread.SetPriority(priority);
  1667. return KernelResult.Success;
  1668. }
  1669. public KernelResult GetThreadCoreMask(int handle, out int preferredCore, out long affinityMask)
  1670. {
  1671. KProcess process = KernelStatic.GetCurrentProcess();
  1672. KThread thread = process.HandleTable.GetKThread(handle);
  1673. if (thread != null)
  1674. {
  1675. preferredCore = thread.PreferredCore;
  1676. affinityMask = thread.AffinityMask;
  1677. return KernelResult.Success;
  1678. }
  1679. else
  1680. {
  1681. preferredCore = 0;
  1682. affinityMask = 0;
  1683. return KernelResult.InvalidHandle;
  1684. }
  1685. }
  1686. public KernelResult SetThreadCoreMask(int handle, int preferredCore, long affinityMask)
  1687. {
  1688. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  1689. if (preferredCore == -2)
  1690. {
  1691. preferredCore = currentProcess.DefaultCpuCore;
  1692. affinityMask = 1 << preferredCore;
  1693. }
  1694. else
  1695. {
  1696. if ((currentProcess.Capabilities.AllowedCpuCoresMask | affinityMask) !=
  1697. currentProcess.Capabilities.AllowedCpuCoresMask)
  1698. {
  1699. return KernelResult.InvalidCpuCore;
  1700. }
  1701. if (affinityMask == 0)
  1702. {
  1703. return KernelResult.InvalidCombination;
  1704. }
  1705. if ((uint)preferredCore > 3)
  1706. {
  1707. if ((preferredCore | 2) != -1)
  1708. {
  1709. return KernelResult.InvalidCpuCore;
  1710. }
  1711. }
  1712. else if ((affinityMask & (1 << preferredCore)) == 0)
  1713. {
  1714. return KernelResult.InvalidCombination;
  1715. }
  1716. }
  1717. KProcess process = KernelStatic.GetCurrentProcess();
  1718. KThread thread = process.HandleTable.GetKThread(handle);
  1719. if (thread == null)
  1720. {
  1721. return KernelResult.InvalidHandle;
  1722. }
  1723. return thread.SetCoreAndAffinityMask(preferredCore, affinityMask);
  1724. }
  1725. public int GetCurrentProcessorNumber()
  1726. {
  1727. return KernelStatic.GetCurrentThread().CurrentCore;
  1728. }
  1729. public KernelResult GetThreadId(int handle, out long threadUid)
  1730. {
  1731. KProcess process = KernelStatic.GetCurrentProcess();
  1732. KThread thread = process.HandleTable.GetKThread(handle);
  1733. if (thread != null)
  1734. {
  1735. threadUid = thread.ThreadUid;
  1736. return KernelResult.Success;
  1737. }
  1738. else
  1739. {
  1740. threadUid = 0;
  1741. return KernelResult.InvalidHandle;
  1742. }
  1743. }
  1744. public KernelResult SetThreadActivity(int handle, bool pause)
  1745. {
  1746. KProcess process = KernelStatic.GetCurrentProcess();
  1747. KThread thread = process.HandleTable.GetObject<KThread>(handle);
  1748. if (thread == null)
  1749. {
  1750. return KernelResult.InvalidHandle;
  1751. }
  1752. if (thread.Owner != process)
  1753. {
  1754. return KernelResult.InvalidHandle;
  1755. }
  1756. if (thread == KernelStatic.GetCurrentThread())
  1757. {
  1758. return KernelResult.InvalidThread;
  1759. }
  1760. return thread.SetActivity(pause);
  1761. }
  1762. public KernelResult GetThreadContext3(ulong address, int handle)
  1763. {
  1764. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  1765. KThread currentThread = KernelStatic.GetCurrentThread();
  1766. KThread thread = currentProcess.HandleTable.GetObject<KThread>(handle);
  1767. if (thread == null)
  1768. {
  1769. return KernelResult.InvalidHandle;
  1770. }
  1771. if (thread.Owner != currentProcess)
  1772. {
  1773. return KernelResult.InvalidHandle;
  1774. }
  1775. if (currentThread == thread)
  1776. {
  1777. return KernelResult.InvalidThread;
  1778. }
  1779. IVirtualMemoryManager memory = currentProcess.CpuMemory;
  1780. memory.Write(address + 0x0, thread.Context.GetX(0));
  1781. memory.Write(address + 0x8, thread.Context.GetX(1));
  1782. memory.Write(address + 0x10, thread.Context.GetX(2));
  1783. memory.Write(address + 0x18, thread.Context.GetX(3));
  1784. memory.Write(address + 0x20, thread.Context.GetX(4));
  1785. memory.Write(address + 0x28, thread.Context.GetX(5));
  1786. memory.Write(address + 0x30, thread.Context.GetX(6));
  1787. memory.Write(address + 0x38, thread.Context.GetX(7));
  1788. memory.Write(address + 0x40, thread.Context.GetX(8));
  1789. memory.Write(address + 0x48, thread.Context.GetX(9));
  1790. memory.Write(address + 0x50, thread.Context.GetX(10));
  1791. memory.Write(address + 0x58, thread.Context.GetX(11));
  1792. memory.Write(address + 0x60, thread.Context.GetX(12));
  1793. memory.Write(address + 0x68, thread.Context.GetX(13));
  1794. memory.Write(address + 0x70, thread.Context.GetX(14));
  1795. memory.Write(address + 0x78, thread.Context.GetX(15));
  1796. memory.Write(address + 0x80, thread.Context.GetX(16));
  1797. memory.Write(address + 0x88, thread.Context.GetX(17));
  1798. memory.Write(address + 0x90, thread.Context.GetX(18));
  1799. memory.Write(address + 0x98, thread.Context.GetX(19));
  1800. memory.Write(address + 0xa0, thread.Context.GetX(20));
  1801. memory.Write(address + 0xa8, thread.Context.GetX(21));
  1802. memory.Write(address + 0xb0, thread.Context.GetX(22));
  1803. memory.Write(address + 0xb8, thread.Context.GetX(23));
  1804. memory.Write(address + 0xc0, thread.Context.GetX(24));
  1805. memory.Write(address + 0xc8, thread.Context.GetX(25));
  1806. memory.Write(address + 0xd0, thread.Context.GetX(26));
  1807. memory.Write(address + 0xd8, thread.Context.GetX(27));
  1808. memory.Write(address + 0xe0, thread.Context.GetX(28));
  1809. memory.Write(address + 0xe8, thread.Context.GetX(29));
  1810. memory.Write(address + 0xf0, thread.Context.GetX(30));
  1811. memory.Write(address + 0xf8, thread.Context.GetX(31));
  1812. memory.Write(address + 0x100, thread.LastPc);
  1813. memory.Write(address + 0x108, (ulong)GetPsr(thread.Context));
  1814. memory.Write(address + 0x110, thread.Context.GetV(0));
  1815. memory.Write(address + 0x120, thread.Context.GetV(1));
  1816. memory.Write(address + 0x130, thread.Context.GetV(2));
  1817. memory.Write(address + 0x140, thread.Context.GetV(3));
  1818. memory.Write(address + 0x150, thread.Context.GetV(4));
  1819. memory.Write(address + 0x160, thread.Context.GetV(5));
  1820. memory.Write(address + 0x170, thread.Context.GetV(6));
  1821. memory.Write(address + 0x180, thread.Context.GetV(7));
  1822. memory.Write(address + 0x190, thread.Context.GetV(8));
  1823. memory.Write(address + 0x1a0, thread.Context.GetV(9));
  1824. memory.Write(address + 0x1b0, thread.Context.GetV(10));
  1825. memory.Write(address + 0x1c0, thread.Context.GetV(11));
  1826. memory.Write(address + 0x1d0, thread.Context.GetV(12));
  1827. memory.Write(address + 0x1e0, thread.Context.GetV(13));
  1828. memory.Write(address + 0x1f0, thread.Context.GetV(14));
  1829. memory.Write(address + 0x200, thread.Context.GetV(15));
  1830. memory.Write(address + 0x210, thread.Context.GetV(16));
  1831. memory.Write(address + 0x220, thread.Context.GetV(17));
  1832. memory.Write(address + 0x230, thread.Context.GetV(18));
  1833. memory.Write(address + 0x240, thread.Context.GetV(19));
  1834. memory.Write(address + 0x250, thread.Context.GetV(20));
  1835. memory.Write(address + 0x260, thread.Context.GetV(21));
  1836. memory.Write(address + 0x270, thread.Context.GetV(22));
  1837. memory.Write(address + 0x280, thread.Context.GetV(23));
  1838. memory.Write(address + 0x290, thread.Context.GetV(24));
  1839. memory.Write(address + 0x2a0, thread.Context.GetV(25));
  1840. memory.Write(address + 0x2b0, thread.Context.GetV(26));
  1841. memory.Write(address + 0x2c0, thread.Context.GetV(27));
  1842. memory.Write(address + 0x2d0, thread.Context.GetV(28));
  1843. memory.Write(address + 0x2e0, thread.Context.GetV(29));
  1844. memory.Write(address + 0x2f0, thread.Context.GetV(30));
  1845. memory.Write(address + 0x300, thread.Context.GetV(31));
  1846. memory.Write(address + 0x310, (int)thread.Context.Fpcr);
  1847. memory.Write(address + 0x314, (int)thread.Context.Fpsr);
  1848. memory.Write(address + 0x318, thread.Context.Tpidr);
  1849. return KernelResult.Success;
  1850. }
  1851. private static int GetPsr(ARMeilleure.State.ExecutionContext context)
  1852. {
  1853. return (context.GetPstateFlag(ARMeilleure.State.PState.NFlag) ? (1 << (int)ARMeilleure.State.PState.NFlag) : 0) |
  1854. (context.GetPstateFlag(ARMeilleure.State.PState.ZFlag) ? (1 << (int)ARMeilleure.State.PState.ZFlag) : 0) |
  1855. (context.GetPstateFlag(ARMeilleure.State.PState.CFlag) ? (1 << (int)ARMeilleure.State.PState.CFlag) : 0) |
  1856. (context.GetPstateFlag(ARMeilleure.State.PState.VFlag) ? (1 << (int)ARMeilleure.State.PState.VFlag) : 0);
  1857. }
  1858. // Thread synchronization
  1859. public KernelResult WaitSynchronization(ulong handlesPtr, int handlesCount, long timeout, out int handleIndex)
  1860. {
  1861. handleIndex = 0;
  1862. if ((uint)handlesCount > KThread.MaxWaitSyncObjects)
  1863. {
  1864. return KernelResult.MaximumExceeded;
  1865. }
  1866. KThread currentThread = KernelStatic.GetCurrentThread();
  1867. var syncObjs = new Span<KSynchronizationObject>(currentThread.WaitSyncObjects).Slice(0, handlesCount);
  1868. if (handlesCount != 0)
  1869. {
  1870. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  1871. if (currentProcess.MemoryManager.AddrSpaceStart > handlesPtr)
  1872. {
  1873. return KernelResult.UserCopyFailed;
  1874. }
  1875. long handlesSize = handlesCount * 4;
  1876. if (handlesPtr + (ulong)handlesSize <= handlesPtr)
  1877. {
  1878. return KernelResult.UserCopyFailed;
  1879. }
  1880. if (handlesPtr + (ulong)handlesSize - 1 > currentProcess.MemoryManager.AddrSpaceEnd - 1)
  1881. {
  1882. return KernelResult.UserCopyFailed;
  1883. }
  1884. Span<int> handles = new Span<int>(currentThread.WaitSyncHandles).Slice(0, handlesCount);
  1885. if (!KernelTransfer.UserToKernelInt32Array(_context, handlesPtr, handles))
  1886. {
  1887. return KernelResult.UserCopyFailed;
  1888. }
  1889. int processedHandles = 0;
  1890. for (; processedHandles < handlesCount; processedHandles++)
  1891. {
  1892. KSynchronizationObject syncObj = currentProcess.HandleTable.GetObject<KSynchronizationObject>(handles[processedHandles]);
  1893. if (syncObj == null)
  1894. {
  1895. break;
  1896. }
  1897. syncObjs[processedHandles] = syncObj;
  1898. syncObj.IncrementReferenceCount();
  1899. }
  1900. if (processedHandles != handlesCount)
  1901. {
  1902. // One or more handles are invalid.
  1903. for (int index = 0; index < processedHandles; index++)
  1904. {
  1905. currentThread.WaitSyncObjects[index].DecrementReferenceCount();
  1906. }
  1907. return KernelResult.InvalidHandle;
  1908. }
  1909. }
  1910. if (timeout > 0)
  1911. {
  1912. timeout += KTimeManager.DefaultTimeIncrementNanoseconds;
  1913. }
  1914. KernelResult result = _context.Synchronization.WaitFor(syncObjs, timeout, out handleIndex);
  1915. if (result == KernelResult.PortRemoteClosed)
  1916. {
  1917. result = KernelResult.Success;
  1918. }
  1919. for (int index = 0; index < handlesCount; index++)
  1920. {
  1921. currentThread.WaitSyncObjects[index].DecrementReferenceCount();
  1922. }
  1923. return result;
  1924. }
  1925. public KernelResult CancelSynchronization(int handle)
  1926. {
  1927. KProcess process = KernelStatic.GetCurrentProcess();
  1928. KThread thread = process.HandleTable.GetKThread(handle);
  1929. if (thread == null)
  1930. {
  1931. return KernelResult.InvalidHandle;
  1932. }
  1933. thread.CancelSynchronization();
  1934. return KernelResult.Success;
  1935. }
  1936. public KernelResult ArbitrateLock(int ownerHandle, ulong mutexAddress, int requesterHandle)
  1937. {
  1938. if (IsPointingInsideKernel(mutexAddress))
  1939. {
  1940. return KernelResult.InvalidMemState;
  1941. }
  1942. if (IsAddressNotWordAligned(mutexAddress))
  1943. {
  1944. return KernelResult.InvalidAddress;
  1945. }
  1946. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  1947. return currentProcess.AddressArbiter.ArbitrateLock(ownerHandle, mutexAddress, requesterHandle);
  1948. }
  1949. public KernelResult ArbitrateUnlock(ulong mutexAddress)
  1950. {
  1951. if (IsPointingInsideKernel(mutexAddress))
  1952. {
  1953. return KernelResult.InvalidMemState;
  1954. }
  1955. if (IsAddressNotWordAligned(mutexAddress))
  1956. {
  1957. return KernelResult.InvalidAddress;
  1958. }
  1959. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  1960. return currentProcess.AddressArbiter.ArbitrateUnlock(mutexAddress);
  1961. }
  1962. public KernelResult WaitProcessWideKeyAtomic(
  1963. ulong mutexAddress,
  1964. ulong condVarAddress,
  1965. int handle,
  1966. long timeout)
  1967. {
  1968. if (IsPointingInsideKernel(mutexAddress))
  1969. {
  1970. return KernelResult.InvalidMemState;
  1971. }
  1972. if (IsAddressNotWordAligned(mutexAddress))
  1973. {
  1974. return KernelResult.InvalidAddress;
  1975. }
  1976. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  1977. if (timeout > 0)
  1978. {
  1979. timeout += KTimeManager.DefaultTimeIncrementNanoseconds;
  1980. }
  1981. return currentProcess.AddressArbiter.WaitProcessWideKeyAtomic(
  1982. mutexAddress,
  1983. condVarAddress,
  1984. handle,
  1985. timeout);
  1986. }
  1987. public KernelResult SignalProcessWideKey(ulong address, int count)
  1988. {
  1989. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  1990. currentProcess.AddressArbiter.SignalProcessWideKey(address, count);
  1991. return KernelResult.Success;
  1992. }
  1993. public KernelResult WaitForAddress(ulong address, ArbitrationType type, int value, long timeout)
  1994. {
  1995. if (IsPointingInsideKernel(address))
  1996. {
  1997. return KernelResult.InvalidMemState;
  1998. }
  1999. if (IsAddressNotWordAligned(address))
  2000. {
  2001. return KernelResult.InvalidAddress;
  2002. }
  2003. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  2004. if (timeout > 0)
  2005. {
  2006. timeout += KTimeManager.DefaultTimeIncrementNanoseconds;
  2007. }
  2008. return type switch
  2009. {
  2010. ArbitrationType.WaitIfLessThan
  2011. => currentProcess.AddressArbiter.WaitForAddressIfLessThan(address, value, false, timeout),
  2012. ArbitrationType.DecrementAndWaitIfLessThan
  2013. => currentProcess.AddressArbiter.WaitForAddressIfLessThan(address, value, true, timeout),
  2014. ArbitrationType.WaitIfEqual
  2015. => currentProcess.AddressArbiter.WaitForAddressIfEqual(address, value, timeout),
  2016. _ => KernelResult.InvalidEnumValue,
  2017. };
  2018. }
  2019. public KernelResult SignalToAddress(ulong address, SignalType type, int value, int count)
  2020. {
  2021. if (IsPointingInsideKernel(address))
  2022. {
  2023. return KernelResult.InvalidMemState;
  2024. }
  2025. if (IsAddressNotWordAligned(address))
  2026. {
  2027. return KernelResult.InvalidAddress;
  2028. }
  2029. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  2030. return type switch
  2031. {
  2032. SignalType.Signal
  2033. => currentProcess.AddressArbiter.Signal(address, count),
  2034. SignalType.SignalAndIncrementIfEqual
  2035. => currentProcess.AddressArbiter.SignalAndIncrementIfEqual(address, value, count),
  2036. SignalType.SignalAndModifyIfEqual
  2037. => currentProcess.AddressArbiter.SignalAndModifyIfEqual(address, value, count),
  2038. _ => KernelResult.InvalidEnumValue
  2039. };
  2040. }
  2041. public KernelResult SynchronizePreemptionState()
  2042. {
  2043. KernelStatic.GetCurrentThread().SynchronizePreemptionState();
  2044. return KernelResult.Success;
  2045. }
  2046. private bool IsPointingInsideKernel(ulong address)
  2047. {
  2048. return (address + 0x1000000000) < 0xffffff000;
  2049. }
  2050. private bool IsAddressNotWordAligned(ulong address)
  2051. {
  2052. return (address & 3) != 0;
  2053. }
  2054. }
  2055. }