KServerSession.cs 41 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247
  1. using Ryujinx.Common;
  2. using Ryujinx.HLE.HOS.Kernel.Common;
  3. using Ryujinx.HLE.HOS.Kernel.Memory;
  4. using Ryujinx.HLE.HOS.Kernel.Process;
  5. using Ryujinx.HLE.HOS.Kernel.Threading;
  6. using System.Collections.Generic;
  7. namespace Ryujinx.HLE.HOS.Kernel.Ipc
  8. {
  9. class KServerSession : KSynchronizationObject
  10. {
  11. private static readonly MemoryState[] IpcMemoryStates = new MemoryState[]
  12. {
  13. MemoryState.IpcBuffer3,
  14. MemoryState.IpcBuffer0,
  15. MemoryState.IpcBuffer1,
  16. (MemoryState)0xfffce5d4 //This is invalid, shouldn't be accessed.
  17. };
  18. private struct Message
  19. {
  20. public ulong Address { get; }
  21. public ulong Size { get; }
  22. public bool IsCustom { get; }
  23. public Message(KThread thread, ulong customCmdBuffAddress, ulong customCmdBuffSize)
  24. {
  25. IsCustom = customCmdBuffAddress != 0;
  26. if (IsCustom)
  27. {
  28. Address = customCmdBuffAddress;
  29. Size = customCmdBuffSize;
  30. }
  31. else
  32. {
  33. Address = thread.TlsAddress;
  34. Size = 0x100;
  35. }
  36. }
  37. public Message(KSessionRequest request) : this(
  38. request.ClientThread,
  39. request.CustomCmdBuffAddr,
  40. request.CustomCmdBuffSize) { }
  41. }
  42. private struct MessageHeader
  43. {
  44. public uint Word0 { get; }
  45. public uint Word1 { get; }
  46. public uint Word2 { get; }
  47. public uint PointerBuffersCount { get; }
  48. public uint SendBuffersCount { get; }
  49. public uint ReceiveBuffersCount { get; }
  50. public uint ExchangeBuffersCount { get; }
  51. public uint RawDataSizeInWords { get; }
  52. public uint ReceiveListType { get; }
  53. public uint MessageSizeInWords { get; }
  54. public uint ReceiveListOffsetInWords { get; }
  55. public uint ReceiveListOffset { get; }
  56. public bool HasHandles { get; }
  57. public bool HasPid { get; }
  58. public uint CopyHandlesCount { get; }
  59. public uint MoveHandlesCount { get; }
  60. public MessageHeader(uint word0, uint word1, uint word2)
  61. {
  62. Word0 = word0;
  63. Word1 = word1;
  64. Word2 = word2;
  65. HasHandles = word1 >> 31 != 0;
  66. uint handleDescSizeInWords = 0;
  67. if (HasHandles)
  68. {
  69. uint pidSize = (word2 & 1) * 8;
  70. HasPid = pidSize != 0;
  71. CopyHandlesCount = (word2 >> 1) & 0xf;
  72. MoveHandlesCount = (word2 >> 5) & 0xf;
  73. handleDescSizeInWords = (pidSize + CopyHandlesCount * 4 + MoveHandlesCount * 4) / 4;
  74. }
  75. else
  76. {
  77. HasPid = false;
  78. CopyHandlesCount = 0;
  79. MoveHandlesCount = 0;
  80. }
  81. PointerBuffersCount = (word0 >> 16) & 0xf;
  82. SendBuffersCount = (word0 >> 20) & 0xf;
  83. ReceiveBuffersCount = (word0 >> 24) & 0xf;
  84. ExchangeBuffersCount = word0 >> 28;
  85. uint pointerDescSizeInWords = PointerBuffersCount * 2;
  86. uint sendDescSizeInWords = SendBuffersCount * 3;
  87. uint receiveDescSizeInWords = ReceiveBuffersCount * 3;
  88. uint exchangeDescSizeInWords = ExchangeBuffersCount * 3;
  89. RawDataSizeInWords = word1 & 0x3ff;
  90. ReceiveListType = (word1 >> 10) & 0xf;
  91. ReceiveListOffsetInWords = (word1 >> 20) & 0x7ff;
  92. uint paddingSizeInWords = HasHandles ? 3u : 2u;
  93. MessageSizeInWords = pointerDescSizeInWords +
  94. sendDescSizeInWords +
  95. receiveDescSizeInWords +
  96. exchangeDescSizeInWords +
  97. RawDataSizeInWords +
  98. paddingSizeInWords +
  99. handleDescSizeInWords;
  100. if (ReceiveListOffsetInWords == 0)
  101. {
  102. ReceiveListOffsetInWords = MessageSizeInWords;
  103. }
  104. ReceiveListOffset = ReceiveListOffsetInWords * 4;
  105. }
  106. }
  107. private struct PointerBufferDesc
  108. {
  109. public uint ReceiveIndex { get; }
  110. public uint BufferSize { get; }
  111. public ulong BufferAddress { get; set; }
  112. public PointerBufferDesc(ulong dword)
  113. {
  114. ReceiveIndex = (uint)dword & 0xf;
  115. BufferSize = (uint)dword >> 16;
  116. BufferAddress = (dword >> 2) & 0x70;
  117. BufferAddress |= (dword >> 12) & 0xf;
  118. BufferAddress = (BufferAddress << 32) | (dword >> 32);
  119. }
  120. public ulong Pack()
  121. {
  122. ulong dword = (ReceiveIndex & 0xf) | ((BufferSize & 0xffff) << 16);
  123. dword |= BufferAddress << 32;
  124. dword |= (BufferAddress >> 20) & 0xf000;
  125. dword |= (BufferAddress >> 30) & 0xffc0;
  126. return dword;
  127. }
  128. }
  129. private KSession _parent;
  130. private LinkedList<KSessionRequest> _requests;
  131. private KSessionRequest _activeRequest;
  132. public KServerSession(KernelContext context, KSession parent) : base(context)
  133. {
  134. _parent = parent;
  135. _requests = new LinkedList<KSessionRequest>();
  136. }
  137. public KernelResult EnqueueRequest(KSessionRequest request)
  138. {
  139. if (_parent.ClientSession.State != ChannelState.Open)
  140. {
  141. return KernelResult.PortRemoteClosed;
  142. }
  143. if (request.AsyncEvent == null)
  144. {
  145. if (request.ClientThread.ShallBeTerminated ||
  146. request.ClientThread.SchedFlags == ThreadSchedState.TerminationPending)
  147. {
  148. return KernelResult.ThreadTerminating;
  149. }
  150. request.ClientThread.Reschedule(ThreadSchedState.Paused);
  151. }
  152. _requests.AddLast(request);
  153. if (_requests.Count == 1)
  154. {
  155. Signal();
  156. }
  157. return KernelResult.Success;
  158. }
  159. public KernelResult Receive(ulong customCmdBuffAddr = 0, ulong customCmdBuffSize = 0)
  160. {
  161. KThread serverThread = KernelStatic.GetCurrentThread();
  162. KProcess serverProcess = serverThread.Owner;
  163. KernelContext.CriticalSection.Enter();
  164. if (_parent.ClientSession.State != ChannelState.Open)
  165. {
  166. KernelContext.CriticalSection.Leave();
  167. return KernelResult.PortRemoteClosed;
  168. }
  169. if (_activeRequest != null || !DequeueRequest(out KSessionRequest request))
  170. {
  171. KernelContext.CriticalSection.Leave();
  172. return KernelResult.NotFound;
  173. }
  174. if (request.ClientThread == null)
  175. {
  176. KernelContext.CriticalSection.Leave();
  177. return KernelResult.PortRemoteClosed;
  178. }
  179. KThread clientThread = request.ClientThread;
  180. KProcess clientProcess = clientThread.Owner;
  181. KernelContext.CriticalSection.Leave();
  182. _activeRequest = request;
  183. request.ServerProcess = serverProcess;
  184. Message clientMsg = new Message(request);
  185. Message serverMsg = new Message(serverThread, customCmdBuffAddr, customCmdBuffSize);
  186. MessageHeader clientHeader = GetClientMessageHeader(clientProcess, clientMsg);
  187. MessageHeader serverHeader = GetServerMessageHeader(serverMsg);
  188. KernelResult serverResult = KernelResult.NotFound;
  189. KernelResult clientResult = KernelResult.Success;
  190. void CleanUpForError()
  191. {
  192. if (request.BufferDescriptorTable.UnmapServerBuffers(serverProcess.MemoryManager) == KernelResult.Success)
  193. {
  194. request.BufferDescriptorTable.RestoreClientBuffers(clientProcess.MemoryManager);
  195. }
  196. CloseAllHandles(serverMsg, clientHeader, serverProcess);
  197. KernelContext.CriticalSection.Enter();
  198. _activeRequest = null;
  199. if (_requests.Count != 0)
  200. {
  201. Signal();
  202. }
  203. KernelContext.CriticalSection.Leave();
  204. WakeClientThread(request, clientResult);
  205. }
  206. if (clientHeader.ReceiveListType < 2 &&
  207. clientHeader.ReceiveListOffset > clientMsg.Size)
  208. {
  209. CleanUpForError();
  210. return KernelResult.InvalidCombination;
  211. }
  212. else if (clientHeader.ReceiveListType == 2 &&
  213. clientHeader.ReceiveListOffset + 8 > clientMsg.Size)
  214. {
  215. CleanUpForError();
  216. return KernelResult.InvalidCombination;
  217. }
  218. else if (clientHeader.ReceiveListType > 2 &&
  219. clientHeader.ReceiveListType * 8 - 0x10 + clientHeader.ReceiveListOffset > clientMsg.Size)
  220. {
  221. CleanUpForError();
  222. return KernelResult.InvalidCombination;
  223. }
  224. if (clientHeader.ReceiveListOffsetInWords < clientHeader.MessageSizeInWords)
  225. {
  226. CleanUpForError();
  227. return KernelResult.InvalidCombination;
  228. }
  229. if (clientHeader.MessageSizeInWords * 4 > clientMsg.Size)
  230. {
  231. CleanUpForError();
  232. return KernelResult.CmdBufferTooSmall;
  233. }
  234. ulong[] receiveList = GetReceiveList(
  235. serverProcess,
  236. serverMsg,
  237. serverHeader.ReceiveListType,
  238. serverHeader.ReceiveListOffset);
  239. serverProcess.CpuMemory.Write(serverMsg.Address + 0, clientHeader.Word0);
  240. serverProcess.CpuMemory.Write(serverMsg.Address + 4, clientHeader.Word1);
  241. uint offset;
  242. // Copy handles.
  243. if (clientHeader.HasHandles)
  244. {
  245. if (clientHeader.MoveHandlesCount != 0)
  246. {
  247. CleanUpForError();
  248. return KernelResult.InvalidCombination;
  249. }
  250. serverProcess.CpuMemory.Write(serverMsg.Address + 8, clientHeader.Word2);
  251. offset = 3;
  252. if (clientHeader.HasPid)
  253. {
  254. serverProcess.CpuMemory.Write(serverMsg.Address + offset * 4, clientProcess.Pid);
  255. offset += 2;
  256. }
  257. for (int index = 0; index < clientHeader.CopyHandlesCount; index++)
  258. {
  259. int newHandle = 0;
  260. int handle = clientProcess.CpuMemory.Read<int>(clientMsg.Address + offset * 4);
  261. if (clientResult == KernelResult.Success && handle != 0)
  262. {
  263. clientResult = GetCopyObjectHandle(clientThread, serverProcess, handle, out newHandle);
  264. }
  265. serverProcess.CpuMemory.Write(serverMsg.Address + offset * 4, newHandle);
  266. offset++;
  267. }
  268. for (int index = 0; index < clientHeader.MoveHandlesCount; index++)
  269. {
  270. int newHandle = 0;
  271. int handle = clientProcess.CpuMemory.Read<int>(clientMsg.Address + offset * 4);
  272. if (handle != 0)
  273. {
  274. if (clientResult == KernelResult.Success)
  275. {
  276. clientResult = GetMoveObjectHandle(clientProcess, serverProcess, handle, out newHandle);
  277. }
  278. else
  279. {
  280. clientProcess.HandleTable.CloseHandle(handle);
  281. }
  282. }
  283. serverProcess.CpuMemory.Write(serverMsg.Address + offset * 4, newHandle);
  284. offset++;
  285. }
  286. if (clientResult != KernelResult.Success)
  287. {
  288. CleanUpForError();
  289. return serverResult;
  290. }
  291. }
  292. else
  293. {
  294. offset = 2;
  295. }
  296. // Copy pointer/receive list buffers.
  297. uint recvListDstOffset = 0;
  298. for (int index = 0; index < clientHeader.PointerBuffersCount; index++)
  299. {
  300. ulong pointerDesc = clientProcess.CpuMemory.Read<ulong>(clientMsg.Address + offset * 4);
  301. PointerBufferDesc descriptor = new PointerBufferDesc(pointerDesc);
  302. if (descriptor.BufferSize != 0)
  303. {
  304. clientResult = GetReceiveListAddress(
  305. descriptor,
  306. serverMsg,
  307. serverHeader.ReceiveListType,
  308. clientHeader.MessageSizeInWords,
  309. receiveList,
  310. ref recvListDstOffset,
  311. out ulong recvListBufferAddress);
  312. if (clientResult != KernelResult.Success)
  313. {
  314. CleanUpForError();
  315. return serverResult;
  316. }
  317. clientResult = clientProcess.MemoryManager.CopyDataToCurrentProcess(
  318. recvListBufferAddress,
  319. descriptor.BufferSize,
  320. descriptor.BufferAddress,
  321. MemoryState.IsPoolAllocated,
  322. MemoryState.IsPoolAllocated,
  323. KMemoryPermission.Read,
  324. MemoryAttribute.Uncached,
  325. MemoryAttribute.None);
  326. if (clientResult != KernelResult.Success)
  327. {
  328. CleanUpForError();
  329. return serverResult;
  330. }
  331. descriptor.BufferAddress = recvListBufferAddress;
  332. }
  333. else
  334. {
  335. descriptor.BufferAddress = 0;
  336. }
  337. serverProcess.CpuMemory.Write(serverMsg.Address + offset * 4, descriptor.Pack());
  338. offset += 2;
  339. }
  340. // Copy send, receive and exchange buffers.
  341. uint totalBuffersCount =
  342. clientHeader.SendBuffersCount +
  343. clientHeader.ReceiveBuffersCount +
  344. clientHeader.ExchangeBuffersCount;
  345. for (int index = 0; index < totalBuffersCount; index++)
  346. {
  347. ulong clientDescAddress = clientMsg.Address + offset * 4;
  348. uint descWord0 = clientProcess.CpuMemory.Read<uint>(clientDescAddress + 0);
  349. uint descWord1 = clientProcess.CpuMemory.Read<uint>(clientDescAddress + 4);
  350. uint descWord2 = clientProcess.CpuMemory.Read<uint>(clientDescAddress + 8);
  351. bool isSendDesc = index < clientHeader.SendBuffersCount;
  352. bool isExchangeDesc = index >= clientHeader.SendBuffersCount + clientHeader.ReceiveBuffersCount;
  353. bool notReceiveDesc = isSendDesc || isExchangeDesc;
  354. bool isReceiveDesc = !notReceiveDesc;
  355. KMemoryPermission permission = index >= clientHeader.SendBuffersCount
  356. ? KMemoryPermission.ReadAndWrite
  357. : KMemoryPermission.Read;
  358. uint sizeHigh4 = (descWord2 >> 24) & 0xf;
  359. ulong bufferSize = descWord0 | (ulong)sizeHigh4 << 32;
  360. ulong dstAddress = 0;
  361. if (bufferSize != 0)
  362. {
  363. ulong bufferAddress;
  364. bufferAddress = descWord2 >> 28;
  365. bufferAddress |= ((descWord2 >> 2) & 7) << 4;
  366. bufferAddress = (bufferAddress << 32) | descWord1;
  367. MemoryState state = IpcMemoryStates[(descWord2 + 1) & 3];
  368. clientResult = serverProcess.MemoryManager.MapBufferFromClientProcess(
  369. bufferSize,
  370. bufferAddress,
  371. clientProcess.MemoryManager,
  372. permission,
  373. state,
  374. notReceiveDesc,
  375. out dstAddress);
  376. if (clientResult != KernelResult.Success)
  377. {
  378. CleanUpForError();
  379. return serverResult;
  380. }
  381. if (isSendDesc)
  382. {
  383. clientResult = request.BufferDescriptorTable.AddSendBuffer(bufferAddress, dstAddress, bufferSize, state);
  384. }
  385. else if (isReceiveDesc)
  386. {
  387. clientResult = request.BufferDescriptorTable.AddReceiveBuffer(bufferAddress, dstAddress, bufferSize, state);
  388. }
  389. else /* if (isExchangeDesc) */
  390. {
  391. clientResult = request.BufferDescriptorTable.AddExchangeBuffer(bufferAddress, dstAddress, bufferSize, state);
  392. }
  393. if (clientResult != KernelResult.Success)
  394. {
  395. CleanUpForError();
  396. return serverResult;
  397. }
  398. }
  399. descWord1 = (uint)dstAddress;
  400. descWord2 &= 3;
  401. descWord2 |= sizeHigh4 << 24;
  402. descWord2 |= (uint)(dstAddress >> 34) & 0x3ffffffc;
  403. descWord2 |= (uint)(dstAddress >> 4) & 0xf0000000;
  404. ulong serverDescAddress = serverMsg.Address + offset * 4;
  405. serverProcess.CpuMemory.Write(serverDescAddress + 0, descWord0);
  406. serverProcess.CpuMemory.Write(serverDescAddress + 4, descWord1);
  407. serverProcess.CpuMemory.Write(serverDescAddress + 8, descWord2);
  408. offset += 3;
  409. }
  410. // Copy raw data.
  411. if (clientHeader.RawDataSizeInWords != 0)
  412. {
  413. ulong copySrc = clientMsg.Address + offset * 4;
  414. ulong copyDst = serverMsg.Address + offset * 4;
  415. ulong copySize = clientHeader.RawDataSizeInWords * 4;
  416. if (serverMsg.IsCustom || clientMsg.IsCustom)
  417. {
  418. KMemoryPermission permission = clientMsg.IsCustom
  419. ? KMemoryPermission.None
  420. : KMemoryPermission.Read;
  421. clientResult = clientProcess.MemoryManager.CopyDataToCurrentProcess(
  422. copyDst,
  423. copySize,
  424. copySrc,
  425. MemoryState.IsPoolAllocated,
  426. MemoryState.IsPoolAllocated,
  427. permission,
  428. MemoryAttribute.Uncached,
  429. MemoryAttribute.None);
  430. }
  431. else
  432. {
  433. serverProcess.CpuMemory.Write(copyDst, clientProcess.CpuMemory.GetSpan(copySrc, (int)copySize));
  434. }
  435. if (clientResult != KernelResult.Success)
  436. {
  437. CleanUpForError();
  438. return serverResult;
  439. }
  440. }
  441. return KernelResult.Success;
  442. }
  443. public KernelResult Reply(ulong customCmdBuffAddr = 0, ulong customCmdBuffSize = 0)
  444. {
  445. KThread serverThread = KernelStatic.GetCurrentThread();
  446. KProcess serverProcess = serverThread.Owner;
  447. KernelContext.CriticalSection.Enter();
  448. if (_activeRequest == null)
  449. {
  450. KernelContext.CriticalSection.Leave();
  451. return KernelResult.InvalidState;
  452. }
  453. KSessionRequest request = _activeRequest;
  454. _activeRequest = null;
  455. if (_requests.Count != 0)
  456. {
  457. Signal();
  458. }
  459. KernelContext.CriticalSection.Leave();
  460. KThread clientThread = request.ClientThread;
  461. KProcess clientProcess = clientThread.Owner;
  462. Message clientMsg = new Message(request);
  463. Message serverMsg = new Message(serverThread, customCmdBuffAddr, customCmdBuffSize);
  464. MessageHeader clientHeader = GetClientMessageHeader(clientProcess, clientMsg);
  465. MessageHeader serverHeader = GetServerMessageHeader(serverMsg);
  466. KernelResult clientResult = KernelResult.Success;
  467. KernelResult serverResult = KernelResult.Success;
  468. void CleanUpForError()
  469. {
  470. CloseAllHandles(clientMsg, serverHeader, clientProcess);
  471. FinishRequest(request, clientResult);
  472. }
  473. if (clientHeader.ReceiveListType < 2 &&
  474. clientHeader.ReceiveListOffset > clientMsg.Size)
  475. {
  476. CleanUpForError();
  477. return KernelResult.InvalidCombination;
  478. }
  479. else if (clientHeader.ReceiveListType == 2 &&
  480. clientHeader.ReceiveListOffset + 8 > clientMsg.Size)
  481. {
  482. CleanUpForError();
  483. return KernelResult.InvalidCombination;
  484. }
  485. else if (clientHeader.ReceiveListType > 2 &&
  486. clientHeader.ReceiveListType * 8 - 0x10 + clientHeader.ReceiveListOffset > clientMsg.Size)
  487. {
  488. CleanUpForError();
  489. return KernelResult.InvalidCombination;
  490. }
  491. if (clientHeader.ReceiveListOffsetInWords < clientHeader.MessageSizeInWords)
  492. {
  493. CleanUpForError();
  494. return KernelResult.InvalidCombination;
  495. }
  496. if (serverHeader.MessageSizeInWords * 4 > clientMsg.Size)
  497. {
  498. CleanUpForError();
  499. return KernelResult.CmdBufferTooSmall;
  500. }
  501. if (serverHeader.SendBuffersCount != 0 ||
  502. serverHeader.ReceiveBuffersCount != 0 ||
  503. serverHeader.ExchangeBuffersCount != 0)
  504. {
  505. CleanUpForError();
  506. return KernelResult.InvalidCombination;
  507. }
  508. // Read receive list.
  509. ulong[] receiveList = GetReceiveList(
  510. clientProcess,
  511. clientMsg,
  512. clientHeader.ReceiveListType,
  513. clientHeader.ReceiveListOffset);
  514. // Copy receive and exchange buffers.
  515. clientResult = request.BufferDescriptorTable.CopyBuffersToClient(clientProcess.MemoryManager);
  516. if (clientResult != KernelResult.Success)
  517. {
  518. CleanUpForError();
  519. return serverResult;
  520. }
  521. // Copy header.
  522. clientProcess.CpuMemory.Write(clientMsg.Address + 0, serverHeader.Word0);
  523. clientProcess.CpuMemory.Write(clientMsg.Address + 4, serverHeader.Word1);
  524. // Copy handles.
  525. uint offset;
  526. if (serverHeader.HasHandles)
  527. {
  528. offset = 3;
  529. clientProcess.CpuMemory.Write(clientMsg.Address + 8, serverHeader.Word2);
  530. if (serverHeader.HasPid)
  531. {
  532. clientProcess.CpuMemory.Write(clientMsg.Address + offset * 4, serverProcess.Pid);
  533. offset += 2;
  534. }
  535. for (int index = 0; index < serverHeader.CopyHandlesCount; index++)
  536. {
  537. int newHandle = 0;
  538. int handle = serverProcess.CpuMemory.Read<int>(serverMsg.Address + offset * 4);
  539. if (handle != 0)
  540. {
  541. GetCopyObjectHandle(serverThread, clientProcess, handle, out newHandle);
  542. }
  543. clientProcess.CpuMemory.Write(clientMsg.Address + offset * 4, newHandle);
  544. offset++;
  545. }
  546. for (int index = 0; index < serverHeader.MoveHandlesCount; index++)
  547. {
  548. int newHandle = 0;
  549. int handle = serverProcess.CpuMemory.Read<int>(serverMsg.Address + offset * 4);
  550. if (handle != 0)
  551. {
  552. if (clientResult == KernelResult.Success)
  553. {
  554. clientResult = GetMoveObjectHandle(serverProcess, clientProcess, handle, out newHandle);
  555. }
  556. else
  557. {
  558. serverProcess.HandleTable.CloseHandle(handle);
  559. }
  560. }
  561. clientProcess.CpuMemory.Write(clientMsg.Address + offset * 4, newHandle);
  562. offset++;
  563. }
  564. }
  565. else
  566. {
  567. offset = 2;
  568. }
  569. // Copy pointer/receive list buffers.
  570. uint recvListDstOffset = 0;
  571. for (int index = 0; index < serverHeader.PointerBuffersCount; index++)
  572. {
  573. ulong pointerDesc = serverProcess.CpuMemory.Read<ulong>(serverMsg.Address + offset * 4);
  574. PointerBufferDesc descriptor = new PointerBufferDesc(pointerDesc);
  575. ulong recvListBufferAddress = 0;
  576. if (descriptor.BufferSize != 0)
  577. {
  578. clientResult = GetReceiveListAddress(
  579. descriptor,
  580. clientMsg,
  581. clientHeader.ReceiveListType,
  582. serverHeader.MessageSizeInWords,
  583. receiveList,
  584. ref recvListDstOffset,
  585. out recvListBufferAddress);
  586. if (clientResult != KernelResult.Success)
  587. {
  588. CleanUpForError();
  589. return serverResult;
  590. }
  591. clientResult = clientProcess.MemoryManager.CopyDataFromCurrentProcess(
  592. recvListBufferAddress,
  593. descriptor.BufferSize,
  594. MemoryState.IsPoolAllocated,
  595. MemoryState.IsPoolAllocated,
  596. KMemoryPermission.Read,
  597. MemoryAttribute.Uncached,
  598. MemoryAttribute.None,
  599. descriptor.BufferAddress);
  600. if (clientResult != KernelResult.Success)
  601. {
  602. CleanUpForError();
  603. return serverResult;
  604. }
  605. }
  606. ulong dstDescAddress = clientMsg.Address + offset * 4;
  607. ulong clientPointerDesc =
  608. (recvListBufferAddress << 32) |
  609. ((recvListBufferAddress >> 20) & 0xf000) |
  610. ((recvListBufferAddress >> 30) & 0xffc0);
  611. clientPointerDesc |= pointerDesc & 0xffff000f;
  612. clientProcess.CpuMemory.Write(dstDescAddress + 0, clientPointerDesc);
  613. offset += 2;
  614. }
  615. // Set send, receive and exchange buffer descriptors to zero.
  616. uint totalBuffersCount =
  617. serverHeader.SendBuffersCount +
  618. serverHeader.ReceiveBuffersCount +
  619. serverHeader.ExchangeBuffersCount;
  620. for (int index = 0; index < totalBuffersCount; index++)
  621. {
  622. ulong dstDescAddress = clientMsg.Address + offset * 4;
  623. clientProcess.CpuMemory.Write(dstDescAddress + 0, 0);
  624. clientProcess.CpuMemory.Write(dstDescAddress + 4, 0);
  625. clientProcess.CpuMemory.Write(dstDescAddress + 8, 0);
  626. offset += 3;
  627. }
  628. // Copy raw data.
  629. if (serverHeader.RawDataSizeInWords != 0)
  630. {
  631. ulong copyDst = clientMsg.Address + offset * 4;
  632. ulong copySrc = serverMsg.Address + offset * 4;
  633. ulong copySize = serverHeader.RawDataSizeInWords * 4;
  634. if (serverMsg.IsCustom || clientMsg.IsCustom)
  635. {
  636. KMemoryPermission permission = clientMsg.IsCustom
  637. ? KMemoryPermission.None
  638. : KMemoryPermission.Read;
  639. clientResult = clientProcess.MemoryManager.CopyDataFromCurrentProcess(
  640. copyDst,
  641. copySize,
  642. MemoryState.IsPoolAllocated,
  643. MemoryState.IsPoolAllocated,
  644. permission,
  645. MemoryAttribute.Uncached,
  646. MemoryAttribute.None,
  647. copySrc);
  648. }
  649. else
  650. {
  651. clientProcess.CpuMemory.Write(copyDst, serverProcess.CpuMemory.GetSpan(copySrc, (int)copySize));
  652. }
  653. }
  654. // Unmap buffers from server.
  655. FinishRequest(request, clientResult);
  656. return serverResult;
  657. }
  658. private MessageHeader GetClientMessageHeader(KProcess clientProcess, Message clientMsg)
  659. {
  660. uint word0 = clientProcess.CpuMemory.Read<uint>(clientMsg.Address + 0);
  661. uint word1 = clientProcess.CpuMemory.Read<uint>(clientMsg.Address + 4);
  662. uint word2 = clientProcess.CpuMemory.Read<uint>(clientMsg.Address + 8);
  663. return new MessageHeader(word0, word1, word2);
  664. }
  665. private MessageHeader GetServerMessageHeader(Message serverMsg)
  666. {
  667. KProcess currentProcess = KernelStatic.GetCurrentProcess();
  668. uint word0 = currentProcess.CpuMemory.Read<uint>(serverMsg.Address + 0);
  669. uint word1 = currentProcess.CpuMemory.Read<uint>(serverMsg.Address + 4);
  670. uint word2 = currentProcess.CpuMemory.Read<uint>(serverMsg.Address + 8);
  671. return new MessageHeader(word0, word1, word2);
  672. }
  673. private KernelResult GetCopyObjectHandle(KThread srcThread, KProcess dstProcess, int srcHandle, out int dstHandle)
  674. {
  675. dstHandle = 0;
  676. KProcess srcProcess = srcThread.Owner;
  677. KAutoObject obj;
  678. if (srcHandle == KHandleTable.SelfProcessHandle)
  679. {
  680. obj = srcProcess;
  681. }
  682. else if (srcHandle == KHandleTable.SelfThreadHandle)
  683. {
  684. obj = srcThread;
  685. }
  686. else
  687. {
  688. obj = srcProcess.HandleTable.GetObject<KAutoObject>(srcHandle);
  689. }
  690. if (obj != null)
  691. {
  692. return dstProcess.HandleTable.GenerateHandle(obj, out dstHandle);
  693. }
  694. else
  695. {
  696. return KernelResult.InvalidHandle;
  697. }
  698. }
  699. private KernelResult GetMoveObjectHandle(KProcess srcProcess, KProcess dstProcess, int srcHandle, out int dstHandle)
  700. {
  701. dstHandle = 0;
  702. KAutoObject obj = srcProcess.HandleTable.GetObject<KAutoObject>(srcHandle);
  703. if (obj != null)
  704. {
  705. KernelResult result = dstProcess.HandleTable.GenerateHandle(obj, out dstHandle);
  706. srcProcess.HandleTable.CloseHandle(srcHandle);
  707. return result;
  708. }
  709. else
  710. {
  711. return KernelResult.InvalidHandle;
  712. }
  713. }
  714. private ulong[] GetReceiveList(KProcess ownerProcess, Message message, uint recvListType, uint recvListOffset)
  715. {
  716. int recvListSize = 0;
  717. if (recvListType >= 3)
  718. {
  719. recvListSize = (int)recvListType - 2;
  720. }
  721. else if (recvListType == 2)
  722. {
  723. recvListSize = 1;
  724. }
  725. ulong[] receiveList = new ulong[recvListSize];
  726. ulong recvListAddress = message.Address + recvListOffset;
  727. for (int index = 0; index < recvListSize; index++)
  728. {
  729. receiveList[index] = ownerProcess.CpuMemory.Read<ulong>(recvListAddress + (ulong)index * 8);
  730. }
  731. return receiveList;
  732. }
  733. private KernelResult GetReceiveListAddress(
  734. PointerBufferDesc descriptor,
  735. Message message,
  736. uint recvListType,
  737. uint messageSizeInWords,
  738. ulong[] receiveList,
  739. ref uint dstOffset,
  740. out ulong address)
  741. {
  742. ulong recvListBufferAddress = address = 0;
  743. if (recvListType == 0)
  744. {
  745. return KernelResult.OutOfResource;
  746. }
  747. else if (recvListType == 1 || recvListType == 2)
  748. {
  749. ulong recvListBaseAddr;
  750. ulong recvListEndAddr;
  751. if (recvListType == 1)
  752. {
  753. recvListBaseAddr = message.Address + messageSizeInWords * 4;
  754. recvListEndAddr = message.Address + message.Size;
  755. }
  756. else /* if (recvListType == 2) */
  757. {
  758. ulong packed = receiveList[0];
  759. recvListBaseAddr = packed & 0x7fffffffff;
  760. uint size = (uint)(packed >> 48);
  761. if (size == 0)
  762. {
  763. return KernelResult.OutOfResource;
  764. }
  765. recvListEndAddr = recvListBaseAddr + size;
  766. }
  767. recvListBufferAddress = BitUtils.AlignUp(recvListBaseAddr + dstOffset, 0x10);
  768. ulong endAddress = recvListBufferAddress + descriptor.BufferSize;
  769. dstOffset = (uint)endAddress - (uint)recvListBaseAddr;
  770. if (recvListBufferAddress + descriptor.BufferSize <= recvListBufferAddress ||
  771. recvListBufferAddress + descriptor.BufferSize > recvListEndAddr)
  772. {
  773. return KernelResult.OutOfResource;
  774. }
  775. }
  776. else /* if (recvListType > 2) */
  777. {
  778. if (descriptor.ReceiveIndex >= receiveList.Length)
  779. {
  780. return KernelResult.OutOfResource;
  781. }
  782. ulong packed = receiveList[descriptor.ReceiveIndex];
  783. recvListBufferAddress = packed & 0x7fffffffff;
  784. uint size = (uint)(packed >> 48);
  785. if (recvListBufferAddress == 0 || size == 0 || size < descriptor.BufferSize)
  786. {
  787. return KernelResult.OutOfResource;
  788. }
  789. }
  790. address = recvListBufferAddress;
  791. return KernelResult.Success;
  792. }
  793. private void CloseAllHandles(Message message, MessageHeader header, KProcess process)
  794. {
  795. if (header.HasHandles)
  796. {
  797. uint totalHandeslCount = header.CopyHandlesCount + header.MoveHandlesCount;
  798. uint offset = 3;
  799. if (header.HasPid)
  800. {
  801. process.CpuMemory.Write(message.Address + offset * 4, 0L);
  802. offset += 2;
  803. }
  804. for (int index = 0; index < totalHandeslCount; index++)
  805. {
  806. int handle = process.CpuMemory.Read<int>(message.Address + offset * 4);
  807. if (handle != 0)
  808. {
  809. process.HandleTable.CloseHandle(handle);
  810. process.CpuMemory.Write(message.Address + offset * 4, 0);
  811. }
  812. offset++;
  813. }
  814. }
  815. }
  816. public override bool IsSignaled()
  817. {
  818. if (_parent.ClientSession.State != ChannelState.Open)
  819. {
  820. return true;
  821. }
  822. return _requests.Count != 0 && _activeRequest == null;
  823. }
  824. protected override void Destroy()
  825. {
  826. _parent.DisconnectServer();
  827. CancelAllRequestsServerDisconnected();
  828. _parent.DecrementReferenceCount();
  829. }
  830. private void CancelAllRequestsServerDisconnected()
  831. {
  832. foreach (KSessionRequest request in IterateWithRemovalOfAllRequests())
  833. {
  834. FinishRequest(request, KernelResult.PortRemoteClosed);
  835. }
  836. }
  837. public void CancelAllRequestsClientDisconnected()
  838. {
  839. foreach (KSessionRequest request in IterateWithRemovalOfAllRequests())
  840. {
  841. if (request.ClientThread.ShallBeTerminated ||
  842. request.ClientThread.SchedFlags == ThreadSchedState.TerminationPending)
  843. {
  844. continue;
  845. }
  846. // Client sessions can only be disconnected on async requests (because
  847. // the client would be otherwise blocked waiting for the response), so
  848. // we only need to handle the async case here.
  849. if (request.AsyncEvent != null)
  850. {
  851. SendResultToAsyncRequestClient(request, KernelResult.PortRemoteClosed);
  852. }
  853. }
  854. WakeServerThreads(KernelResult.PortRemoteClosed);
  855. }
  856. private IEnumerable<KSessionRequest> IterateWithRemovalOfAllRequests()
  857. {
  858. KernelContext.CriticalSection.Enter();
  859. if (_activeRequest != null)
  860. {
  861. KSessionRequest request = _activeRequest;
  862. _activeRequest = null;
  863. KernelContext.CriticalSection.Leave();
  864. yield return request;
  865. }
  866. else
  867. {
  868. KernelContext.CriticalSection.Leave();
  869. }
  870. while (DequeueRequest(out KSessionRequest request))
  871. {
  872. yield return request;
  873. }
  874. }
  875. private bool DequeueRequest(out KSessionRequest request)
  876. {
  877. request = null;
  878. KernelContext.CriticalSection.Enter();
  879. bool hasRequest = _requests.First != null;
  880. if (hasRequest)
  881. {
  882. request = _requests.First.Value;
  883. _requests.RemoveFirst();
  884. }
  885. KernelContext.CriticalSection.Leave();
  886. return hasRequest;
  887. }
  888. private void FinishRequest(KSessionRequest request, KernelResult result)
  889. {
  890. KProcess clientProcess = request.ClientThread.Owner;
  891. KProcess serverProcess = request.ServerProcess;
  892. KernelResult unmapResult = KernelResult.Success;
  893. if (serverProcess != null)
  894. {
  895. unmapResult = request.BufferDescriptorTable.UnmapServerBuffers(serverProcess.MemoryManager);
  896. }
  897. if (unmapResult == KernelResult.Success)
  898. {
  899. request.BufferDescriptorTable.RestoreClientBuffers(clientProcess.MemoryManager);
  900. }
  901. WakeClientThread(request, result);
  902. }
  903. private void WakeClientThread(KSessionRequest request, KernelResult result)
  904. {
  905. // Wait client thread waiting for a response for the given request.
  906. if (request.AsyncEvent != null)
  907. {
  908. SendResultToAsyncRequestClient(request, result);
  909. }
  910. else
  911. {
  912. KernelContext.CriticalSection.Enter();
  913. WakeAndSetResult(request.ClientThread, result);
  914. KernelContext.CriticalSection.Leave();
  915. }
  916. }
  917. private void SendResultToAsyncRequestClient(KSessionRequest request, KernelResult result)
  918. {
  919. KProcess clientProcess = request.ClientThread.Owner;
  920. if (result != KernelResult.Success)
  921. {
  922. ulong address = request.CustomCmdBuffAddr;
  923. clientProcess.CpuMemory.Write<ulong>(address, 0);
  924. clientProcess.CpuMemory.Write(address + 8, (int)result);
  925. }
  926. clientProcess.MemoryManager.UnborrowIpcBuffer(request.CustomCmdBuffAddr, request.CustomCmdBuffSize);
  927. request.AsyncEvent.Signal();
  928. }
  929. private void WakeServerThreads(KernelResult result)
  930. {
  931. // Wake all server threads waiting for requests.
  932. KernelContext.CriticalSection.Enter();
  933. foreach (KThread thread in WaitingThreads)
  934. {
  935. WakeAndSetResult(thread, result);
  936. }
  937. KernelContext.CriticalSection.Leave();
  938. }
  939. private void WakeAndSetResult(KThread thread, KernelResult result)
  940. {
  941. if ((thread.SchedFlags & ThreadSchedState.LowMask) == ThreadSchedState.Paused)
  942. {
  943. thread.SignaledObj = null;
  944. thread.ObjSyncResult = result;
  945. thread.Reschedule(ThreadSchedState.Running);
  946. }
  947. }
  948. }
  949. }