| 12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185 |
- using Ryujinx.Common;
- using Ryujinx.Cpu;
- using Ryujinx.HLE.HOS.Kernel.Common;
- using Ryujinx.HLE.HOS.Kernel.Process;
- using System;
- using System.Collections.Generic;
- namespace Ryujinx.HLE.HOS.Kernel.Memory
- {
- class KMemoryManager
- {
- private static readonly int[] MappingUnitSizes = new int[]
- {
- 0x1000,
- 0x10000,
- 0x200000,
- 0x400000,
- 0x2000000,
- 0x40000000
- };
- public const int PageSize = 0x1000;
- private const int KMemoryBlockSize = 0x40;
- // We need 2 blocks for the case where a big block
- // needs to be split in 2, plus one block that will be the new one inserted.
- private const int MaxBlocksNeededForInsertion = 2;
- private LinkedList<KMemoryBlock> _blocks;
- private MemoryManager _cpuMemory;
- private KernelContext _context;
- public ulong AddrSpaceStart { get; private set; }
- public ulong AddrSpaceEnd { get; private set; }
- public ulong CodeRegionStart { get; private set; }
- public ulong CodeRegionEnd { get; private set; }
- public ulong HeapRegionStart { get; private set; }
- public ulong HeapRegionEnd { get; private set; }
- private ulong _currentHeapAddr;
- public ulong AliasRegionStart { get; private set; }
- public ulong AliasRegionEnd { get; private set; }
- public ulong StackRegionStart { get; private set; }
- public ulong StackRegionEnd { get; private set; }
- public ulong TlsIoRegionStart { get; private set; }
- public ulong TlsIoRegionEnd { get; private set; }
- private ulong _heapCapacity;
- public ulong PhysicalMemoryUsage { get; private set; }
- private MemoryRegion _memRegion;
- private bool _aslrDisabled;
- public int AddrSpaceWidth { get; private set; }
- private bool _isKernel;
- private bool _aslrEnabled;
- private KMemoryBlockAllocator _blockAllocator;
- private int _contextId;
- private MersenneTwister _randomNumberGenerator;
- public KMemoryManager(KernelContext context, MemoryManager cpuMemory)
- {
- _context = context;
- _cpuMemory = cpuMemory;
- _blocks = new LinkedList<KMemoryBlock>();
- _isKernel = false;
- }
- private static readonly int[] AddrSpaceSizes = new int[] { 32, 36, 32, 39 };
- public KernelResult InitializeForProcess(
- AddressSpaceType addrSpaceType,
- bool aslrEnabled,
- bool aslrDisabled,
- MemoryRegion memRegion,
- ulong address,
- ulong size,
- KMemoryBlockAllocator blockAllocator)
- {
- if ((uint)addrSpaceType > (uint)AddressSpaceType.Addr39Bits)
- {
- throw new ArgumentException(nameof(addrSpaceType));
- }
- _contextId = _context.ContextIdManager.GetId();
- ulong addrSpaceBase = 0;
- ulong addrSpaceSize = 1UL << AddrSpaceSizes[(int)addrSpaceType];
- KernelResult result = CreateUserAddressSpace(
- addrSpaceType,
- aslrEnabled,
- aslrDisabled,
- addrSpaceBase,
- addrSpaceSize,
- memRegion,
- address,
- size,
- blockAllocator);
- if (result != KernelResult.Success)
- {
- _context.ContextIdManager.PutId(_contextId);
- }
- return result;
- }
- private class Region
- {
- public ulong Start;
- public ulong End;
- public ulong Size;
- public ulong AslrOffset;
- }
- private KernelResult CreateUserAddressSpace(
- AddressSpaceType addrSpaceType,
- bool aslrEnabled,
- bool aslrDisabled,
- ulong addrSpaceStart,
- ulong addrSpaceEnd,
- MemoryRegion memRegion,
- ulong address,
- ulong size,
- KMemoryBlockAllocator blockAllocator)
- {
- ulong endAddr = address + size;
- Region aliasRegion = new Region();
- Region heapRegion = new Region();
- Region stackRegion = new Region();
- Region tlsIoRegion = new Region();
- ulong codeRegionSize;
- ulong stackAndTlsIoStart;
- ulong stackAndTlsIoEnd;
- ulong baseAddress;
- switch (addrSpaceType)
- {
- case AddressSpaceType.Addr32Bits:
- aliasRegion.Size = 0x40000000;
- heapRegion.Size = 0x40000000;
- stackRegion.Size = 0;
- tlsIoRegion.Size = 0;
- CodeRegionStart = 0x200000;
- codeRegionSize = 0x3fe00000;
- stackAndTlsIoStart = 0x200000;
- stackAndTlsIoEnd = 0x40000000;
- baseAddress = 0x200000;
- AddrSpaceWidth = 32;
- break;
- case AddressSpaceType.Addr36Bits:
- aliasRegion.Size = 0x180000000;
- heapRegion.Size = 0x180000000;
- stackRegion.Size = 0;
- tlsIoRegion.Size = 0;
- CodeRegionStart = 0x8000000;
- codeRegionSize = 0x78000000;
- stackAndTlsIoStart = 0x8000000;
- stackAndTlsIoEnd = 0x80000000;
- baseAddress = 0x8000000;
- AddrSpaceWidth = 36;
- break;
- case AddressSpaceType.Addr32BitsNoMap:
- aliasRegion.Size = 0;
- heapRegion.Size = 0x80000000;
- stackRegion.Size = 0;
- tlsIoRegion.Size = 0;
- CodeRegionStart = 0x200000;
- codeRegionSize = 0x3fe00000;
- stackAndTlsIoStart = 0x200000;
- stackAndTlsIoEnd = 0x40000000;
- baseAddress = 0x200000;
- AddrSpaceWidth = 32;
- break;
- case AddressSpaceType.Addr39Bits:
- aliasRegion.Size = 0x1000000000;
- heapRegion.Size = 0x180000000;
- stackRegion.Size = 0x80000000;
- tlsIoRegion.Size = 0x1000000000;
- CodeRegionStart = BitUtils.AlignDown(address, 0x200000);
- codeRegionSize = BitUtils.AlignUp (endAddr, 0x200000) - CodeRegionStart;
- stackAndTlsIoStart = 0;
- stackAndTlsIoEnd = 0;
- baseAddress = 0x8000000;
- AddrSpaceWidth = 39;
- break;
- default: throw new ArgumentException(nameof(addrSpaceType));
- }
- CodeRegionEnd = CodeRegionStart + codeRegionSize;
- ulong mapBaseAddress;
- ulong mapAvailableSize;
- if (CodeRegionStart - baseAddress >= addrSpaceEnd - CodeRegionEnd)
- {
- // Has more space before the start of the code region.
- mapBaseAddress = baseAddress;
- mapAvailableSize = CodeRegionStart - baseAddress;
- }
- else
- {
- // Has more space after the end of the code region.
- mapBaseAddress = CodeRegionEnd;
- mapAvailableSize = addrSpaceEnd - CodeRegionEnd;
- }
- ulong mapTotalSize = aliasRegion.Size + heapRegion.Size + stackRegion.Size + tlsIoRegion.Size;
- ulong aslrMaxOffset = mapAvailableSize - mapTotalSize;
- _aslrEnabled = aslrEnabled;
- AddrSpaceStart = addrSpaceStart;
- AddrSpaceEnd = addrSpaceEnd;
- _blockAllocator = blockAllocator;
- if (mapAvailableSize < mapTotalSize)
- {
- return KernelResult.OutOfMemory;
- }
- if (aslrEnabled)
- {
- aliasRegion.AslrOffset = GetRandomValue(0, aslrMaxOffset >> 21) << 21;
- heapRegion.AslrOffset = GetRandomValue(0, aslrMaxOffset >> 21) << 21;
- stackRegion.AslrOffset = GetRandomValue(0, aslrMaxOffset >> 21) << 21;
- tlsIoRegion.AslrOffset = GetRandomValue(0, aslrMaxOffset >> 21) << 21;
- }
- // Regions are sorted based on ASLR offset.
- // When ASLR is disabled, the order is Map, Heap, NewMap and TlsIo.
- aliasRegion.Start = mapBaseAddress + aliasRegion.AslrOffset;
- aliasRegion.End = aliasRegion.Start + aliasRegion.Size;
- heapRegion.Start = mapBaseAddress + heapRegion.AslrOffset;
- heapRegion.End = heapRegion.Start + heapRegion.Size;
- stackRegion.Start = mapBaseAddress + stackRegion.AslrOffset;
- stackRegion.End = stackRegion.Start + stackRegion.Size;
- tlsIoRegion.Start = mapBaseAddress + tlsIoRegion.AslrOffset;
- tlsIoRegion.End = tlsIoRegion.Start + tlsIoRegion.Size;
- SortRegion(heapRegion, aliasRegion);
- if (stackRegion.Size != 0)
- {
- SortRegion(stackRegion, aliasRegion);
- SortRegion(stackRegion, heapRegion);
- }
- else
- {
- stackRegion.Start = stackAndTlsIoStart;
- stackRegion.End = stackAndTlsIoEnd;
- }
- if (tlsIoRegion.Size != 0)
- {
- SortRegion(tlsIoRegion, aliasRegion);
- SortRegion(tlsIoRegion, heapRegion);
- SortRegion(tlsIoRegion, stackRegion);
- }
- else
- {
- tlsIoRegion.Start = stackAndTlsIoStart;
- tlsIoRegion.End = stackAndTlsIoEnd;
- }
- AliasRegionStart = aliasRegion.Start;
- AliasRegionEnd = aliasRegion.End;
- HeapRegionStart = heapRegion.Start;
- HeapRegionEnd = heapRegion.End;
- StackRegionStart = stackRegion.Start;
- StackRegionEnd = stackRegion.End;
- TlsIoRegionStart = tlsIoRegion.Start;
- TlsIoRegionEnd = tlsIoRegion.End;
- _currentHeapAddr = HeapRegionStart;
- _heapCapacity = 0;
- PhysicalMemoryUsage = 0;
- _memRegion = memRegion;
- _aslrDisabled = aslrDisabled;
- return InitializeBlocks(addrSpaceStart, addrSpaceEnd);
- }
- private ulong GetRandomValue(ulong min, ulong max)
- {
- return (ulong)GetRandomValue((long)min, (long)max);
- }
- private long GetRandomValue(long min, long max)
- {
- if (_randomNumberGenerator == null)
- {
- _randomNumberGenerator = new MersenneTwister(0);
- }
- return _randomNumberGenerator.GenRandomNumber(min, max);
- }
- private static void SortRegion(Region lhs, Region rhs)
- {
- if (lhs.AslrOffset < rhs.AslrOffset)
- {
- rhs.Start += lhs.Size;
- rhs.End += lhs.Size;
- }
- else
- {
- lhs.Start += rhs.Size;
- lhs.End += rhs.Size;
- }
- }
- private KernelResult InitializeBlocks(ulong addrSpaceStart, ulong addrSpaceEnd)
- {
- // First insertion will always need only a single block,
- // because there's nothing else to split.
- if (!_blockAllocator.CanAllocate(1))
- {
- return KernelResult.OutOfResource;
- }
- ulong addrSpacePagesCount = (addrSpaceEnd - addrSpaceStart) / PageSize;
- _blocks.AddFirst(new KMemoryBlock(
- addrSpaceStart,
- addrSpacePagesCount,
- MemoryState.Unmapped,
- MemoryPermission.None,
- MemoryAttribute.None));
- return KernelResult.Success;
- }
- public KernelResult MapPages(
- ulong address,
- KPageList pageList,
- MemoryState state,
- MemoryPermission permission)
- {
- ulong pagesCount = pageList.GetPagesCount();
- ulong size = pagesCount * PageSize;
- if (!ValidateRegionForState(address, size, state))
- {
- return KernelResult.InvalidMemState;
- }
- lock (_blocks)
- {
- if (!IsUnmapped(address, pagesCount * PageSize))
- {
- return KernelResult.InvalidMemState;
- }
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion))
- {
- return KernelResult.OutOfResource;
- }
- KernelResult result = MapPages(address, pageList, permission);
- if (result == KernelResult.Success)
- {
- InsertBlock(address, pagesCount, state, permission);
- }
- return result;
- }
- }
- public KernelResult UnmapPages(ulong address, KPageList pageList, MemoryState stateExpected)
- {
- ulong pagesCount = pageList.GetPagesCount();
- ulong size = pagesCount * PageSize;
- ulong endAddr = address + size;
- ulong addrSpacePagesCount = (AddrSpaceEnd - AddrSpaceStart) / PageSize;
- if (AddrSpaceStart > address)
- {
- return KernelResult.InvalidMemState;
- }
- if (addrSpacePagesCount < pagesCount)
- {
- return KernelResult.InvalidMemState;
- }
- if (endAddr - 1 > AddrSpaceEnd - 1)
- {
- return KernelResult.InvalidMemState;
- }
- lock (_blocks)
- {
- KPageList currentPageList = new KPageList();
- AddVaRangeToPageList(currentPageList, address, pagesCount);
- if (!currentPageList.IsEqual(pageList))
- {
- return KernelResult.InvalidMemRange;
- }
- if (CheckRange(
- address,
- size,
- MemoryState.Mask,
- stateExpected,
- MemoryPermission.None,
- MemoryPermission.None,
- MemoryAttribute.Mask,
- MemoryAttribute.None,
- MemoryAttribute.IpcAndDeviceMapped,
- out MemoryState state,
- out _,
- out _))
- {
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion))
- {
- return KernelResult.OutOfResource;
- }
- KernelResult result = MmuUnmap(address, pagesCount);
- if (result == KernelResult.Success)
- {
- InsertBlock(address, pagesCount, MemoryState.Unmapped);
- }
- return result;
- }
- else
- {
- return KernelResult.InvalidMemState;
- }
- }
- }
- public KernelResult MapNormalMemory(long address, long size, MemoryPermission permission)
- {
- // TODO.
- return KernelResult.Success;
- }
- public KernelResult MapIoMemory(long address, long size, MemoryPermission permission)
- {
- // TODO.
- return KernelResult.Success;
- }
- public KernelResult AllocateOrMapPa(
- ulong neededPagesCount,
- int alignment,
- ulong srcPa,
- bool map,
- ulong regionStart,
- ulong regionPagesCount,
- MemoryState state,
- MemoryPermission permission,
- out ulong address)
- {
- address = 0;
- ulong regionSize = regionPagesCount * PageSize;
- ulong regionEndAddr = regionStart + regionSize;
- if (!ValidateRegionForState(regionStart, regionSize, state))
- {
- return KernelResult.InvalidMemState;
- }
- if (regionPagesCount <= neededPagesCount)
- {
- return KernelResult.OutOfMemory;
- }
- lock (_blocks)
- {
- address = AllocateVa(regionStart, regionPagesCount, neededPagesCount, alignment);
- if (address == 0)
- {
- return KernelResult.OutOfMemory;
- }
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion))
- {
- return KernelResult.OutOfResource;
- }
- MemoryOperation operation = map
- ? MemoryOperation.MapPa
- : MemoryOperation.Allocate;
- KernelResult result = DoMmuOperation(
- address,
- neededPagesCount,
- srcPa,
- map,
- permission,
- operation);
- if (result != KernelResult.Success)
- {
- return result;
- }
- InsertBlock(address, neededPagesCount, state, permission);
- }
- return KernelResult.Success;
- }
- public KernelResult MapNewProcessCode(
- ulong address,
- ulong pagesCount,
- MemoryState state,
- MemoryPermission permission)
- {
- ulong size = pagesCount * PageSize;
- if (!ValidateRegionForState(address, size, state))
- {
- return KernelResult.InvalidMemState;
- }
- lock (_blocks)
- {
- if (!IsUnmapped(address, size))
- {
- return KernelResult.InvalidMemState;
- }
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion))
- {
- return KernelResult.OutOfResource;
- }
- KernelResult result = DoMmuOperation(
- address,
- pagesCount,
- 0,
- false,
- permission,
- MemoryOperation.Allocate);
- if (result == KernelResult.Success)
- {
- InsertBlock(address, pagesCount, state, permission);
- }
- return result;
- }
- }
- public KernelResult MapProcessCodeMemory(ulong dst, ulong src, ulong size)
- {
- ulong pagesCount = size / PageSize;
- lock (_blocks)
- {
- bool success = CheckRange(
- src,
- size,
- MemoryState.Mask,
- MemoryState.Heap,
- MemoryPermission.Mask,
- MemoryPermission.ReadAndWrite,
- MemoryAttribute.Mask,
- MemoryAttribute.None,
- MemoryAttribute.IpcAndDeviceMapped,
- out MemoryState state,
- out MemoryPermission permission,
- out _);
- success &= IsUnmapped(dst, size);
- if (success)
- {
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion * 2))
- {
- return KernelResult.OutOfResource;
- }
- KPageList pageList = new KPageList();
- AddVaRangeToPageList(pageList, src, pagesCount);
- KernelResult result = MmuChangePermission(src, pagesCount, MemoryPermission.None);
- if (result != KernelResult.Success)
- {
- return result;
- }
- result = MapPages(dst, pageList, MemoryPermission.None);
- if (result != KernelResult.Success)
- {
- MmuChangePermission(src, pagesCount, permission);
- return result;
- }
- InsertBlock(src, pagesCount, state, MemoryPermission.None, MemoryAttribute.Borrowed);
- InsertBlock(dst, pagesCount, MemoryState.ModCodeStatic);
- return KernelResult.Success;
- }
- else
- {
- return KernelResult.InvalidMemState;
- }
- }
- }
- public KernelResult UnmapProcessCodeMemory(ulong dst, ulong src, ulong size)
- {
- ulong pagesCount = size / PageSize;
- lock (_blocks)
- {
- bool success = CheckRange(
- src,
- size,
- MemoryState.Mask,
- MemoryState.Heap,
- MemoryPermission.None,
- MemoryPermission.None,
- MemoryAttribute.Mask,
- MemoryAttribute.Borrowed,
- MemoryAttribute.IpcAndDeviceMapped,
- out _,
- out _,
- out _);
- success &= CheckRange(
- dst,
- PageSize,
- MemoryState.UnmapProcessCodeMemoryAllowed,
- MemoryState.UnmapProcessCodeMemoryAllowed,
- MemoryPermission.None,
- MemoryPermission.None,
- MemoryAttribute.Mask,
- MemoryAttribute.None,
- MemoryAttribute.IpcAndDeviceMapped,
- out MemoryState state,
- out _,
- out _);
- success &= CheckRange(
- dst,
- size,
- MemoryState.Mask,
- state,
- MemoryPermission.None,
- MemoryPermission.None,
- MemoryAttribute.Mask,
- MemoryAttribute.None);
- if (success)
- {
- KernelResult result = MmuUnmap(dst, pagesCount);
- if (result != KernelResult.Success)
- {
- return result;
- }
- // TODO: Missing some checks here.
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion * 2))
- {
- return KernelResult.OutOfResource;
- }
- InsertBlock(dst, pagesCount, MemoryState.Unmapped);
- InsertBlock(src, pagesCount, MemoryState.Heap, MemoryPermission.ReadAndWrite);
- return KernelResult.Success;
- }
- else
- {
- return KernelResult.InvalidMemState;
- }
- }
- }
- public KernelResult SetHeapSize(ulong size, out ulong address)
- {
- address = 0;
- if (size > HeapRegionEnd - HeapRegionStart)
- {
- return KernelResult.OutOfMemory;
- }
- KProcess currentProcess = _context.Scheduler.GetCurrentProcess();
- ulong currentHeapSize = GetHeapSize();
- if (currentHeapSize <= size)
- {
- // Expand.
- ulong diffSize = size - currentHeapSize;
- lock (_blocks)
- {
- if (currentProcess.ResourceLimit != null && diffSize != 0 &&
- !currentProcess.ResourceLimit.Reserve(LimitableResource.Memory, diffSize))
- {
- return KernelResult.ResLimitExceeded;
- }
- ulong pagesCount = diffSize / PageSize;
- KMemoryRegionManager region = GetMemoryRegionManager();
- KernelResult result = region.AllocatePages(pagesCount, _aslrDisabled, out KPageList pageList);
- void CleanUpForError()
- {
- if (pageList != null)
- {
- region.FreePages(pageList);
- }
- if (currentProcess.ResourceLimit != null && diffSize != 0)
- {
- currentProcess.ResourceLimit.Release(LimitableResource.Memory, diffSize);
- }
- }
- if (result != KernelResult.Success)
- {
- CleanUpForError();
- return result;
- }
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion))
- {
- CleanUpForError();
- return KernelResult.OutOfResource;
- }
- if (!IsUnmapped(_currentHeapAddr, diffSize))
- {
- CleanUpForError();
- return KernelResult.InvalidMemState;
- }
- result = DoMmuOperation(
- _currentHeapAddr,
- pagesCount,
- pageList,
- MemoryPermission.ReadAndWrite,
- MemoryOperation.MapVa);
- if (result != KernelResult.Success)
- {
- CleanUpForError();
- return result;
- }
- InsertBlock(_currentHeapAddr, pagesCount, MemoryState.Heap, MemoryPermission.ReadAndWrite);
- }
- }
- else
- {
- // Shrink.
- ulong freeAddr = HeapRegionStart + size;
- ulong diffSize = currentHeapSize - size;
- lock (_blocks)
- {
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion))
- {
- return KernelResult.OutOfResource;
- }
- if (!CheckRange(
- freeAddr,
- diffSize,
- MemoryState.Mask,
- MemoryState.Heap,
- MemoryPermission.Mask,
- MemoryPermission.ReadAndWrite,
- MemoryAttribute.Mask,
- MemoryAttribute.None,
- MemoryAttribute.IpcAndDeviceMapped,
- out _,
- out _,
- out _))
- {
- return KernelResult.InvalidMemState;
- }
- ulong pagesCount = diffSize / PageSize;
- KernelResult result = MmuUnmap(freeAddr, pagesCount);
- if (result != KernelResult.Success)
- {
- return result;
- }
- currentProcess.ResourceLimit?.Release(LimitableResource.Memory, BitUtils.AlignDown(diffSize, PageSize));
- InsertBlock(freeAddr, pagesCount, MemoryState.Unmapped);
- }
- }
- _currentHeapAddr = HeapRegionStart + size;
- address = HeapRegionStart;
- return KernelResult.Success;
- }
- public ulong GetTotalHeapSize()
- {
- lock (_blocks)
- {
- return GetHeapSize() + PhysicalMemoryUsage;
- }
- }
- private ulong GetHeapSize()
- {
- return _currentHeapAddr - HeapRegionStart;
- }
- public KernelResult SetHeapCapacity(ulong capacity)
- {
- lock (_blocks)
- {
- _heapCapacity = capacity;
- }
- return KernelResult.Success;
- }
- public KernelResult SetMemoryAttribute(
- ulong address,
- ulong size,
- MemoryAttribute attributeMask,
- MemoryAttribute attributeValue)
- {
- lock (_blocks)
- {
- if (CheckRange(
- address,
- size,
- MemoryState.AttributeChangeAllowed,
- MemoryState.AttributeChangeAllowed,
- MemoryPermission.None,
- MemoryPermission.None,
- MemoryAttribute.BorrowedAndIpcMapped,
- MemoryAttribute.None,
- MemoryAttribute.DeviceMappedAndUncached,
- out MemoryState state,
- out MemoryPermission permission,
- out MemoryAttribute attribute))
- {
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion))
- {
- return KernelResult.OutOfResource;
- }
- ulong pagesCount = size / PageSize;
- attribute &= ~attributeMask;
- attribute |= attributeMask & attributeValue;
- InsertBlock(address, pagesCount, state, permission, attribute);
- return KernelResult.Success;
- }
- else
- {
- return KernelResult.InvalidMemState;
- }
- }
- }
- public KMemoryInfo QueryMemory(ulong address)
- {
- if (address >= AddrSpaceStart &&
- address < AddrSpaceEnd)
- {
- lock (_blocks)
- {
- return FindBlock(address).GetInfo();
- }
- }
- else
- {
- return new KMemoryInfo(
- AddrSpaceEnd,
- ~AddrSpaceEnd + 1,
- MemoryState.Reserved,
- MemoryPermission.None,
- MemoryAttribute.None,
- MemoryPermission.None,
- 0,
- 0);
- }
- }
- public KernelResult Map(ulong dst, ulong src, ulong size)
- {
- bool success;
- lock (_blocks)
- {
- success = CheckRange(
- src,
- size,
- MemoryState.MapAllowed,
- MemoryState.MapAllowed,
- MemoryPermission.Mask,
- MemoryPermission.ReadAndWrite,
- MemoryAttribute.Mask,
- MemoryAttribute.None,
- MemoryAttribute.IpcAndDeviceMapped,
- out MemoryState srcState,
- out _,
- out _);
- success &= IsUnmapped(dst, size);
- if (success)
- {
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion * 2))
- {
- return KernelResult.OutOfResource;
- }
- ulong pagesCount = size / PageSize;
- KPageList pageList = new KPageList();
- AddVaRangeToPageList(pageList, src, pagesCount);
- KernelResult result = MmuChangePermission(src, pagesCount, MemoryPermission.None);
- if (result != KernelResult.Success)
- {
- return result;
- }
- result = MapPages(dst, pageList, MemoryPermission.ReadAndWrite);
- if (result != KernelResult.Success)
- {
- if (MmuChangePermission(src, pagesCount, MemoryPermission.ReadAndWrite) != KernelResult.Success)
- {
- throw new InvalidOperationException("Unexpected failure reverting memory permission.");
- }
- return result;
- }
- InsertBlock(src, pagesCount, srcState, MemoryPermission.None, MemoryAttribute.Borrowed);
- InsertBlock(dst, pagesCount, MemoryState.Stack, MemoryPermission.ReadAndWrite);
- return KernelResult.Success;
- }
- else
- {
- return KernelResult.InvalidMemState;
- }
- }
- }
- public KernelResult UnmapForKernel(ulong address, ulong pagesCount, MemoryState stateExpected)
- {
- ulong size = pagesCount * PageSize;
- lock (_blocks)
- {
- if (CheckRange(
- address,
- size,
- MemoryState.Mask,
- stateExpected,
- MemoryPermission.None,
- MemoryPermission.None,
- MemoryAttribute.Mask,
- MemoryAttribute.None,
- MemoryAttribute.IpcAndDeviceMapped,
- out _,
- out _,
- out _))
- {
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion))
- {
- return KernelResult.OutOfResource;
- }
- KernelResult result = MmuUnmap(address, pagesCount);
- if (result == KernelResult.Success)
- {
- InsertBlock(address, pagesCount, MemoryState.Unmapped);
- }
- return KernelResult.Success;
- }
- else
- {
- return KernelResult.InvalidMemState;
- }
- }
- }
- public KernelResult Unmap(ulong dst, ulong src, ulong size)
- {
- bool success;
- lock (_blocks)
- {
- success = CheckRange(
- src,
- size,
- MemoryState.MapAllowed,
- MemoryState.MapAllowed,
- MemoryPermission.Mask,
- MemoryPermission.None,
- MemoryAttribute.Mask,
- MemoryAttribute.Borrowed,
- MemoryAttribute.IpcAndDeviceMapped,
- out MemoryState srcState,
- out _,
- out _);
- success &= CheckRange(
- dst,
- size,
- MemoryState.Mask,
- MemoryState.Stack,
- MemoryPermission.None,
- MemoryPermission.None,
- MemoryAttribute.Mask,
- MemoryAttribute.None,
- MemoryAttribute.IpcAndDeviceMapped,
- out _,
- out MemoryPermission dstPermission,
- out _);
- if (success)
- {
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion * 2))
- {
- return KernelResult.OutOfResource;
- }
- ulong pagesCount = size / PageSize;
- KPageList srcPageList = new KPageList();
- KPageList dstPageList = new KPageList();
- AddVaRangeToPageList(srcPageList, src, pagesCount);
- AddVaRangeToPageList(dstPageList, dst, pagesCount);
- if (!dstPageList.IsEqual(srcPageList))
- {
- return KernelResult.InvalidMemRange;
- }
- KernelResult result = MmuUnmap(dst, pagesCount);
- if (result != KernelResult.Success)
- {
- return result;
- }
- result = MmuChangePermission(src, pagesCount, MemoryPermission.ReadAndWrite);
- if (result != KernelResult.Success)
- {
- MapPages(dst, dstPageList, dstPermission);
- return result;
- }
- InsertBlock(src, pagesCount, srcState, MemoryPermission.ReadAndWrite);
- InsertBlock(dst, pagesCount, MemoryState.Unmapped);
- return KernelResult.Success;
- }
- else
- {
- return KernelResult.InvalidMemState;
- }
- }
- }
- public KernelResult ReserveTransferMemory(ulong address, ulong size, MemoryPermission permission)
- {
- lock (_blocks)
- {
- if (CheckRange(
- address,
- size,
- MemoryState.TransferMemoryAllowed | MemoryState.IsPoolAllocated,
- MemoryState.TransferMemoryAllowed | MemoryState.IsPoolAllocated,
- MemoryPermission.Mask,
- MemoryPermission.ReadAndWrite,
- MemoryAttribute.Mask,
- MemoryAttribute.None,
- MemoryAttribute.IpcAndDeviceMapped,
- out MemoryState state,
- out _,
- out MemoryAttribute attribute))
- {
- // TODO: Missing checks.
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion))
- {
- return KernelResult.OutOfResource;
- }
- ulong pagesCount = size / PageSize;
- attribute |= MemoryAttribute.Borrowed;
- InsertBlock(address, pagesCount, state, permission, attribute);
- return KernelResult.Success;
- }
- else
- {
- return KernelResult.InvalidMemState;
- }
- }
- }
- public KernelResult ResetTransferMemory(ulong address, ulong size)
- {
- lock (_blocks)
- {
- if (CheckRange(
- address,
- size,
- MemoryState.TransferMemoryAllowed | MemoryState.IsPoolAllocated,
- MemoryState.TransferMemoryAllowed | MemoryState.IsPoolAllocated,
- MemoryPermission.None,
- MemoryPermission.None,
- MemoryAttribute.Mask,
- MemoryAttribute.Borrowed,
- MemoryAttribute.IpcAndDeviceMapped,
- out MemoryState state,
- out _,
- out _))
- {
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion))
- {
- return KernelResult.OutOfResource;
- }
- ulong pagesCount = size / PageSize;
- InsertBlock(address, pagesCount, state, MemoryPermission.ReadAndWrite);
- return KernelResult.Success;
- }
- else
- {
- return KernelResult.InvalidMemState;
- }
- }
- }
- public KernelResult SetProcessMemoryPermission(ulong address, ulong size, MemoryPermission permission)
- {
- lock (_blocks)
- {
- if (CheckRange(
- address,
- size,
- MemoryState.ProcessPermissionChangeAllowed,
- MemoryState.ProcessPermissionChangeAllowed,
- MemoryPermission.None,
- MemoryPermission.None,
- MemoryAttribute.Mask,
- MemoryAttribute.None,
- MemoryAttribute.IpcAndDeviceMapped,
- out MemoryState oldState,
- out MemoryPermission oldPermission,
- out _))
- {
- MemoryState newState = oldState;
- // If writing into the code region is allowed, then we need
- // to change it to mutable.
- if ((permission & MemoryPermission.Write) != 0)
- {
- if (oldState == MemoryState.CodeStatic)
- {
- newState = MemoryState.CodeMutable;
- }
- else if (oldState == MemoryState.ModCodeStatic)
- {
- newState = MemoryState.ModCodeMutable;
- }
- else
- {
- throw new InvalidOperationException($"Memory state \"{oldState}\" not valid for this operation.");
- }
- }
- if (newState != oldState || permission != oldPermission)
- {
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion))
- {
- return KernelResult.OutOfResource;
- }
- ulong pagesCount = size / PageSize;
- MemoryOperation operation = (permission & MemoryPermission.Execute) != 0
- ? MemoryOperation.ChangePermsAndAttributes
- : MemoryOperation.ChangePermRw;
- KernelResult result = DoMmuOperation(address, pagesCount, 0, false, permission, operation);
- if (result != KernelResult.Success)
- {
- return result;
- }
- InsertBlock(address, pagesCount, newState, permission);
- }
- return KernelResult.Success;
- }
- else
- {
- return KernelResult.InvalidMemState;
- }
- }
- }
- public KernelResult MapPhysicalMemory(ulong address, ulong size)
- {
- ulong endAddr = address + size;
- lock (_blocks)
- {
- ulong mappedSize = 0;
- foreach (KMemoryInfo info in IterateOverRange(address, endAddr))
- {
- if (info.State != MemoryState.Unmapped)
- {
- mappedSize += GetSizeInRange(info, address, endAddr);
- }
- }
- if (mappedSize == size)
- {
- return KernelResult.Success;
- }
- ulong remainingSize = size - mappedSize;
- ulong remainingPages = remainingSize / PageSize;
- KProcess currentProcess = _context.Scheduler.GetCurrentProcess();
- if (currentProcess.ResourceLimit != null &&
- !currentProcess.ResourceLimit.Reserve(LimitableResource.Memory, remainingSize))
- {
- return KernelResult.ResLimitExceeded;
- }
- KMemoryRegionManager region = GetMemoryRegionManager();
- KernelResult result = region.AllocatePages(remainingPages, _aslrDisabled, out KPageList pageList);
- void CleanUpForError()
- {
- if (pageList != null)
- {
- region.FreePages(pageList);
- }
- currentProcess.ResourceLimit?.Release(LimitableResource.Memory, remainingSize);
- }
- if (result != KernelResult.Success)
- {
- CleanUpForError();
- return result;
- }
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion))
- {
- CleanUpForError();
- return KernelResult.OutOfResource;
- }
- MapPhysicalMemory(pageList, address, endAddr);
- PhysicalMemoryUsage += remainingSize;
- ulong pagesCount = size / PageSize;
- InsertBlock(
- address,
- pagesCount,
- MemoryState.Unmapped,
- MemoryPermission.None,
- MemoryAttribute.None,
- MemoryState.Heap,
- MemoryPermission.ReadAndWrite,
- MemoryAttribute.None);
- }
- return KernelResult.Success;
- }
- public KernelResult UnmapPhysicalMemory(ulong address, ulong size)
- {
- ulong endAddr = address + size;
- lock (_blocks)
- {
- // Scan, ensure that the region can be unmapped (all blocks are heap or
- // already unmapped), fill pages list for freeing memory.
- ulong heapMappedSize = 0;
- KPageList pageList = new KPageList();
- foreach (KMemoryInfo info in IterateOverRange(address, endAddr))
- {
- if (info.State == MemoryState.Heap)
- {
- if (info.Attribute != MemoryAttribute.None)
- {
- return KernelResult.InvalidMemState;
- }
- ulong blockSize = GetSizeInRange(info, address, endAddr);
- ulong blockAddress = GetAddrInRange(info, address);
- AddVaRangeToPageList(pageList, blockAddress, blockSize / PageSize);
- heapMappedSize += blockSize;
- }
- else if (info.State != MemoryState.Unmapped)
- {
- return KernelResult.InvalidMemState;
- }
- }
- if (heapMappedSize == 0)
- {
- return KernelResult.Success;
- }
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion))
- {
- return KernelResult.OutOfResource;
- }
- // Try to unmap all the heap mapped memory inside range.
- KernelResult result = KernelResult.Success;
- foreach (KMemoryInfo info in IterateOverRange(address, endAddr))
- {
- if (info.State == MemoryState.Heap)
- {
- ulong blockSize = GetSizeInRange(info, address, endAddr);
- ulong blockAddress = GetAddrInRange(info, address);
- ulong blockPagesCount = blockSize / PageSize;
- result = MmuUnmap(blockAddress, blockPagesCount);
- if (result != KernelResult.Success)
- {
- // If we failed to unmap, we need to remap everything back again.
- MapPhysicalMemory(pageList, address, blockAddress + blockSize);
- break;
- }
- }
- }
- if (result == KernelResult.Success)
- {
- GetMemoryRegionManager().FreePages(pageList);
- PhysicalMemoryUsage -= heapMappedSize;
- KProcess currentProcess = _context.Scheduler.GetCurrentProcess();
- currentProcess.ResourceLimit?.Release(LimitableResource.Memory, heapMappedSize);
- ulong pagesCount = size / PageSize;
- InsertBlock(address, pagesCount, MemoryState.Unmapped);
- }
- return result;
- }
- }
- private void MapPhysicalMemory(KPageList pageList, ulong address, ulong endAddr)
- {
- LinkedListNode<KPageNode> pageListNode = pageList.Nodes.First;
- KPageNode pageNode = pageListNode.Value;
- ulong srcPa = pageNode.Address;
- ulong srcPaPages = pageNode.PagesCount;
- foreach (KMemoryInfo info in IterateOverRange(address, endAddr))
- {
- if (info.State == MemoryState.Unmapped)
- {
- ulong blockSize = GetSizeInRange(info, address, endAddr);
- ulong dstVaPages = blockSize / PageSize;
- ulong dstVa = GetAddrInRange(info, address);
- while (dstVaPages > 0)
- {
- if (srcPaPages == 0)
- {
- pageListNode = pageListNode.Next;
- pageNode = pageListNode.Value;
- srcPa = pageNode.Address;
- srcPaPages = pageNode.PagesCount;
- }
- ulong pagesCount = srcPaPages;
- if (pagesCount > dstVaPages)
- {
- pagesCount = dstVaPages;
- }
- DoMmuOperation(
- dstVa,
- pagesCount,
- srcPa,
- true,
- MemoryPermission.ReadAndWrite,
- MemoryOperation.MapPa);
- dstVa += pagesCount * PageSize;
- srcPa += pagesCount * PageSize;
- srcPaPages -= pagesCount;
- dstVaPages -= pagesCount;
- }
- }
- }
- }
- public KernelResult CopyDataToCurrentProcess(
- ulong dst,
- ulong size,
- ulong src,
- MemoryState stateMask,
- MemoryState stateExpected,
- MemoryPermission permission,
- MemoryAttribute attributeMask,
- MemoryAttribute attributeExpected)
- {
- // Client -> server.
- return CopyDataFromOrToCurrentProcess(
- size,
- src,
- dst,
- stateMask,
- stateExpected,
- permission,
- attributeMask,
- attributeExpected,
- toServer: true);
- }
- public KernelResult CopyDataFromCurrentProcess(
- ulong dst,
- ulong size,
- MemoryState stateMask,
- MemoryState stateExpected,
- MemoryPermission permission,
- MemoryAttribute attributeMask,
- MemoryAttribute attributeExpected,
- ulong src)
- {
- // Server -> client.
- return CopyDataFromOrToCurrentProcess(
- size,
- dst,
- src,
- stateMask,
- stateExpected,
- permission,
- attributeMask,
- attributeExpected,
- toServer: false);
- }
- private KernelResult CopyDataFromOrToCurrentProcess(
- ulong size,
- ulong clientAddress,
- ulong serverAddress,
- MemoryState stateMask,
- MemoryState stateExpected,
- MemoryPermission permission,
- MemoryAttribute attributeMask,
- MemoryAttribute attributeExpected,
- bool toServer)
- {
- if (AddrSpaceStart > clientAddress)
- {
- return KernelResult.InvalidMemState;
- }
- ulong srcEndAddr = clientAddress + size;
- if (srcEndAddr <= clientAddress || srcEndAddr - 1 > AddrSpaceEnd - 1)
- {
- return KernelResult.InvalidMemState;
- }
- lock (_blocks)
- {
- if (CheckRange(
- clientAddress,
- size,
- stateMask,
- stateExpected,
- permission,
- permission,
- attributeMask | MemoryAttribute.Uncached,
- attributeExpected))
- {
- KProcess currentProcess = _context.Scheduler.GetCurrentProcess();
- serverAddress = currentProcess.MemoryManager.GetDramAddressFromVa(serverAddress);
- if (toServer)
- {
- _context.Memory.Copy(serverAddress, GetDramAddressFromVa(clientAddress), size);
- }
- else
- {
- _context.Memory.Copy(GetDramAddressFromVa(clientAddress), serverAddress, size);
- }
- return KernelResult.Success;
- }
- else
- {
- return KernelResult.InvalidMemState;
- }
- }
- }
- public KernelResult MapBufferFromClientProcess(
- ulong size,
- ulong src,
- KMemoryManager sourceMemMgr,
- MemoryPermission permission,
- MemoryState state,
- bool copyData,
- out ulong dst)
- {
- dst = 0;
- KernelResult result = sourceMemMgr.GetPagesForMappingIntoAnotherProcess(
- src,
- size,
- permission,
- state,
- copyData,
- _aslrDisabled,
- _memRegion,
- out KPageList pageList);
- if (result != KernelResult.Success)
- {
- return result;
- }
- result = MapPagesFromAnotherProcess(size, src, permission, state, pageList, out ulong va);
- if (result != KernelResult.Success)
- {
- sourceMemMgr.UnmapIpcRestorePermission(src, size, state);
- }
- else
- {
- dst = va;
- }
- return result;
- }
- private KernelResult GetPagesForMappingIntoAnotherProcess(
- ulong address,
- ulong size,
- MemoryPermission permission,
- MemoryState state,
- bool copyData,
- bool aslrDisabled,
- MemoryRegion region,
- out KPageList pageList)
- {
- pageList = null;
- if (AddrSpaceStart > address)
- {
- return KernelResult.InvalidMemState;
- }
- ulong endAddr = address + size;
- if (endAddr <= address || endAddr - 1 > AddrSpaceEnd - 1)
- {
- return KernelResult.InvalidMemState;
- }
- MemoryState stateMask;
- switch (state)
- {
- case MemoryState.IpcBuffer0: stateMask = MemoryState.IpcSendAllowedType0; break;
- case MemoryState.IpcBuffer1: stateMask = MemoryState.IpcSendAllowedType1; break;
- case MemoryState.IpcBuffer3: stateMask = MemoryState.IpcSendAllowedType3; break;
- default: return KernelResult.InvalidCombination;
- }
- MemoryPermission permissionMask = permission == MemoryPermission.ReadAndWrite
- ? MemoryPermission.None
- : MemoryPermission.Read;
- MemoryAttribute attributeMask = MemoryAttribute.Borrowed | MemoryAttribute.Uncached;
- if (state == MemoryState.IpcBuffer0)
- {
- attributeMask |= MemoryAttribute.DeviceMapped;
- }
- ulong addressRounded = BitUtils.AlignUp (address, PageSize);
- ulong endAddrRounded = BitUtils.AlignUp (endAddr, PageSize);
- ulong endAddrTruncated = BitUtils.AlignDown(endAddr, PageSize);
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion))
- {
- return KernelResult.OutOfResource;
- }
- ulong visitedSize = 0;
- void CleanUpForError()
- {
- ulong endAddrVisited = address + visitedSize;
- foreach (KMemoryInfo info in IterateOverRange(address, endAddrVisited))
- {
- if ((info.Permission & MemoryPermission.ReadAndWrite) != permissionMask && info.IpcRefCount == 0)
- {
- ulong blockAddress = GetAddrInRange(info, addressRounded);
- ulong blockSize = GetSizeInRange(info, addressRounded, endAddrVisited);
- ulong blockPagesCount = blockSize / PageSize;
- if (DoMmuOperation(
- blockAddress,
- blockPagesCount,
- 0,
- false,
- info.Permission,
- MemoryOperation.ChangePermRw) != KernelResult.Success)
- {
- throw new InvalidOperationException("Unexpected failure trying to restore permission.");
- }
- }
- }
- }
- lock (_blocks)
- {
- KernelResult result;
- foreach (KMemoryInfo info in IterateOverRange(address, endAddrRounded))
- {
- // Check if the block state matches what we expect.
- if ((info.State & stateMask) != stateMask ||
- (info.Permission & permission) != permission ||
- (info.Attribute & attributeMask) != MemoryAttribute.None)
- {
- CleanUpForError();
- return KernelResult.InvalidMemState;
- }
- ulong blockAddress = GetAddrInRange(info, addressRounded);
- ulong blockSize = GetSizeInRange(info, addressRounded, endAddrTruncated);
- ulong blockPagesCount = blockSize / PageSize;
- if ((info.Permission & MemoryPermission.ReadAndWrite) != permissionMask && info.IpcRefCount == 0)
- {
- result = DoMmuOperation(
- blockAddress,
- blockPagesCount,
- 0,
- false,
- permissionMask,
- MemoryOperation.ChangePermRw);
- if (result != KernelResult.Success)
- {
- CleanUpForError();
- return result;
- }
- }
- visitedSize += blockSize;
- }
- result = GetPagesForIpcTransfer(address, size, copyData, aslrDisabled, region, out pageList);
- if (result != KernelResult.Success)
- {
- CleanUpForError();
- return result;
- }
- if (visitedSize != 0)
- {
- InsertBlock(address, visitedSize / PageSize, SetIpcMappingPermissions, permissionMask);
- }
- }
- return KernelResult.Success;
- }
- private KernelResult GetPagesForIpcTransfer(
- ulong address,
- ulong size,
- bool copyData,
- bool aslrDisabled,
- MemoryRegion region,
- out KPageList pageList)
- {
- pageList = null;
- ulong addressTruncated = BitUtils.AlignDown(address, PageSize);
- ulong addressRounded = BitUtils.AlignUp (address, PageSize);
- ulong endAddr = address + size;
- ulong dstFirstPagePa = AllocateSinglePage(region, aslrDisabled);
- if (dstFirstPagePa == 0)
- {
- return KernelResult.OutOfMemory;
- }
- ulong dstLastPagePa = 0;
- void CleanUpForError()
- {
- FreeSinglePage(region, dstFirstPagePa);
- if (dstLastPagePa != 0)
- {
- FreeSinglePage(region, dstLastPagePa);
- }
- }
- ulong firstPageFillAddress = dstFirstPagePa;
- if (!ConvertVaToPa(addressTruncated, out ulong srcFirstPagePa))
- {
- CleanUpForError();
- return KernelResult.InvalidMemState;
- }
- ulong unusedSizeAfter;
- // When the start address is unaligned, we can't safely map the
- // first page as it would expose other undesirable information on the
- // target process. So, instead we allocate new pages, copy the data
- // inside the range, and then clear the remaining space.
- // The same also holds for the last page, if the end address
- // (address + size) is also not aligned.
- if (copyData)
- {
- ulong unusedSizeBefore = address - addressTruncated;
- _context.Memory.ZeroFill(dstFirstPagePa, unusedSizeBefore);
- ulong copySize = addressRounded <= endAddr ? addressRounded - address : size;
- _context.Memory.Copy(
- GetDramAddressFromPa(dstFirstPagePa + unusedSizeBefore),
- GetDramAddressFromPa(srcFirstPagePa + unusedSizeBefore), copySize);
- firstPageFillAddress += unusedSizeBefore + copySize;
- unusedSizeAfter = addressRounded > endAddr ? addressRounded - endAddr : 0;
- }
- else
- {
- unusedSizeAfter = PageSize;
- }
- if (unusedSizeAfter != 0)
- {
- _context.Memory.ZeroFill(firstPageFillAddress, unusedSizeAfter);
- }
- KPageList pages = new KPageList();
- if (pages.AddRange(dstFirstPagePa, 1) != KernelResult.Success)
- {
- CleanUpForError();
- return KernelResult.OutOfResource;
- }
- ulong endAddrTruncated = BitUtils.AlignDown(endAddr, PageSize);
- ulong endAddrRounded = BitUtils.AlignUp (endAddr, PageSize);
- if (endAddrTruncated > addressRounded)
- {
- ulong alignedPagesCount = (endAddrTruncated - addressRounded) / PageSize;
- AddVaRangeToPageList(pages, addressRounded, alignedPagesCount);
- }
- if (endAddrTruncated != endAddrRounded)
- {
- // End is also not aligned...
- dstLastPagePa = AllocateSinglePage(region, aslrDisabled);
- if (dstLastPagePa == 0)
- {
- CleanUpForError();
- return KernelResult.OutOfMemory;
- }
- ulong lastPageFillAddr = dstLastPagePa;
- if (!ConvertVaToPa(endAddrTruncated, out ulong srcLastPagePa))
- {
- CleanUpForError();
- return KernelResult.InvalidMemState;
- }
- if (copyData)
- {
- ulong copySize = endAddr - endAddrTruncated;
- _context.Memory.Copy(
- GetDramAddressFromPa(dstLastPagePa),
- GetDramAddressFromPa(srcLastPagePa), copySize);
- lastPageFillAddr += copySize;
- unusedSizeAfter = PageSize - copySize;
- }
- else
- {
- unusedSizeAfter = PageSize;
- }
- _context.Memory.ZeroFill(lastPageFillAddr, unusedSizeAfter);
- if (pages.AddRange(dstFirstPagePa, 1) != KernelResult.Success)
- {
- CleanUpForError();
- return KernelResult.OutOfResource;
- }
- }
- pageList = pages;
- return KernelResult.Success;
- }
- private ulong AllocateSinglePage(MemoryRegion region, bool aslrDisabled)
- {
- KMemoryRegionManager regionMgr = _context.MemoryRegions[(int)region];
- return regionMgr.AllocatePagesContiguous(1, aslrDisabled);
- }
- private void FreeSinglePage(MemoryRegion region, ulong address)
- {
- KMemoryRegionManager regionMgr = _context.MemoryRegions[(int)region];
- regionMgr.FreePage(address);
- }
- private KernelResult MapPagesFromAnotherProcess(
- ulong size,
- ulong address,
- MemoryPermission permission,
- MemoryState state,
- KPageList pageList,
- out ulong mappedVa)
- {
- mappedVa = 0;
- lock (_blocks)
- {
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion))
- {
- return KernelResult.OutOfResource;
- }
- ulong endAddr = address + size;
- ulong addressTruncated = BitUtils.AlignDown(address, PageSize);
- ulong endAddrRounded = BitUtils.AlignUp (endAddr, PageSize);
- ulong neededSize = endAddrRounded - addressTruncated;
- ulong neededPagesCount = neededSize / PageSize;
- ulong regionPagesCount = (AliasRegionEnd - AliasRegionStart) / PageSize;
- ulong va = 0;
- for (int unit = MappingUnitSizes.Length - 1; unit >= 0 && va == 0; unit--)
- {
- int alignment = MappingUnitSizes[unit];
- va = AllocateVa(AliasRegionStart, regionPagesCount, neededPagesCount, alignment);
- }
- if (va == 0)
- {
- return KernelResult.OutOfVaSpace;
- }
- if (pageList.Nodes.Count != 0)
- {
- KernelResult result = MapPages(va, pageList, permission);
- if (result != KernelResult.Success)
- {
- return result;
- }
- }
- InsertBlock(va, neededPagesCount, state, permission);
- mappedVa = va;
- }
- return KernelResult.Success;
- }
- public KernelResult UnmapNoAttributeIfStateEquals(ulong address, ulong size, MemoryState state)
- {
- if (AddrSpaceStart > address)
- {
- return KernelResult.InvalidMemState;
- }
- ulong endAddr = address + size;
- if (endAddr <= address || endAddr - 1 > AddrSpaceEnd - 1)
- {
- return KernelResult.InvalidMemState;
- }
- lock (_blocks)
- {
- if (CheckRange(
- address,
- size,
- MemoryState.Mask,
- state,
- MemoryPermission.Read,
- MemoryPermission.Read,
- MemoryAttribute.Mask,
- MemoryAttribute.None,
- MemoryAttribute.IpcAndDeviceMapped,
- out _,
- out _,
- out _))
- {
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion))
- {
- return KernelResult.OutOfResource;
- }
- ulong addressTruncated = BitUtils.AlignDown(address, PageSize);
- ulong endAddrRounded = BitUtils.AlignUp (endAddr, PageSize);
- ulong pagesCount = (endAddrRounded - addressTruncated) / PageSize;
- KernelResult result = DoMmuOperation(
- addressTruncated,
- pagesCount,
- 0,
- false,
- MemoryPermission.None,
- MemoryOperation.Unmap);
- if (result == KernelResult.Success)
- {
- InsertBlock(addressTruncated, pagesCount, MemoryState.Unmapped);
- }
- return result;
- }
- else
- {
- return KernelResult.InvalidMemState;
- }
- }
- }
- public KernelResult UnmapIpcRestorePermission(ulong address, ulong size, MemoryState state)
- {
- ulong endAddr = address + size;
- ulong addressRounded = BitUtils.AlignUp (address, PageSize);
- ulong endAddrTruncated = BitUtils.AlignDown(endAddr, PageSize);
- ulong pagesCount = (endAddrTruncated - addressRounded) / PageSize;
- MemoryState stateMask;
- switch (state)
- {
- case MemoryState.IpcBuffer0: stateMask = MemoryState.IpcSendAllowedType0; break;
- case MemoryState.IpcBuffer1: stateMask = MemoryState.IpcSendAllowedType1; break;
- case MemoryState.IpcBuffer3: stateMask = MemoryState.IpcSendAllowedType3; break;
- default: return KernelResult.InvalidCombination;
- }
- MemoryAttribute attributeMask =
- MemoryAttribute.Borrowed |
- MemoryAttribute.IpcMapped |
- MemoryAttribute.Uncached;
- if (state == MemoryState.IpcBuffer0)
- {
- attributeMask |= MemoryAttribute.DeviceMapped;
- }
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion))
- {
- return KernelResult.OutOfResource;
- }
- lock (_blocks)
- {
- foreach (KMemoryInfo info in IterateOverRange(address, endAddrTruncated))
- {
- // Check if the block state matches what we expect.
- if ((info.State & stateMask) != stateMask ||
- (info.Attribute & attributeMask) != MemoryAttribute.IpcMapped)
- {
- return KernelResult.InvalidMemState;
- }
- if (info.Permission != info.SourcePermission && info.IpcRefCount == 1)
- {
- ulong blockAddress = GetAddrInRange(info, addressRounded);
- ulong blockSize = GetSizeInRange(info, addressRounded, endAddrTruncated);
- ulong blockPagesCount = blockSize / PageSize;
- KernelResult result = DoMmuOperation(
- blockAddress,
- blockPagesCount,
- 0,
- false,
- info.SourcePermission,
- MemoryOperation.ChangePermRw);
- if (result != KernelResult.Success)
- {
- return result;
- }
- }
- }
- }
- InsertBlock(address, pagesCount, RestoreIpcMappingPermissions);
- return KernelResult.Success;
- }
- public KernelResult UnborrowIpcBuffer(ulong address, ulong size)
- {
- return ClearAttributesAndChangePermission(
- address,
- size,
- MemoryState.IpcBufferAllowed,
- MemoryState.IpcBufferAllowed,
- MemoryPermission.None,
- MemoryPermission.None,
- MemoryAttribute.Mask,
- MemoryAttribute.Borrowed,
- MemoryPermission.ReadAndWrite,
- MemoryAttribute.Borrowed);
- }
- private KernelResult ClearAttributesAndChangePermission(
- ulong address,
- ulong size,
- MemoryState stateMask,
- MemoryState stateExpected,
- MemoryPermission permissionMask,
- MemoryPermission permissionExpected,
- MemoryAttribute attributeMask,
- MemoryAttribute attributeExpected,
- MemoryPermission newPermission,
- MemoryAttribute attributeClearMask,
- KPageList pageList = null)
- {
- lock (_blocks)
- {
- if (CheckRange(
- address,
- size,
- stateMask | MemoryState.IsPoolAllocated,
- stateExpected | MemoryState.IsPoolAllocated,
- permissionMask,
- permissionExpected,
- attributeMask,
- attributeExpected,
- MemoryAttribute.IpcAndDeviceMapped,
- out MemoryState oldState,
- out MemoryPermission oldPermission,
- out MemoryAttribute oldAttribute))
- {
- ulong pagesCount = size / PageSize;
- if (pageList != null)
- {
- KPageList currPageList = new KPageList();
- AddVaRangeToPageList(currPageList, address, pagesCount);
- if (!currPageList.IsEqual(pageList))
- {
- return KernelResult.InvalidMemRange;
- }
- }
- if (!_blockAllocator.CanAllocate(MaxBlocksNeededForInsertion))
- {
- return KernelResult.OutOfResource;
- }
- if (newPermission == MemoryPermission.None)
- {
- newPermission = oldPermission;
- }
- if (newPermission != oldPermission)
- {
- KernelResult result = DoMmuOperation(
- address,
- pagesCount,
- 0,
- false,
- newPermission,
- MemoryOperation.ChangePermRw);
- if (result != KernelResult.Success)
- {
- return result;
- }
- }
- MemoryAttribute newAttribute = oldAttribute & ~attributeClearMask;
- InsertBlock(address, pagesCount, oldState, newPermission, newAttribute);
- return KernelResult.Success;
- }
- else
- {
- return KernelResult.InvalidMemState;
- }
- }
- }
- private void AddVaRangeToPageList(KPageList pageList, ulong start, ulong pagesCount)
- {
- ulong address = start;
- while (address < start + pagesCount * PageSize)
- {
- if (!ConvertVaToPa(address, out ulong pa))
- {
- throw new InvalidOperationException("Unexpected failure translating virtual address.");
- }
- pageList.AddRange(pa, 1);
- address += PageSize;
- }
- }
- private static ulong GetAddrInRange(KMemoryInfo info, ulong start)
- {
- if (info.Address < start)
- {
- return start;
- }
- return info.Address;
- }
- private static ulong GetSizeInRange(KMemoryInfo info, ulong start, ulong end)
- {
- ulong endAddr = info.Size + info.Address;
- ulong size = info.Size;
- if (info.Address < start)
- {
- size -= start - info.Address;
- }
- if (endAddr > end)
- {
- size -= endAddr - end;
- }
- return size;
- }
- private bool IsUnmapped(ulong address, ulong size)
- {
- return CheckRange(
- address,
- size,
- MemoryState.Mask,
- MemoryState.Unmapped,
- MemoryPermission.Mask,
- MemoryPermission.None,
- MemoryAttribute.Mask,
- MemoryAttribute.None,
- MemoryAttribute.IpcAndDeviceMapped,
- out _,
- out _,
- out _);
- }
- private bool CheckRange(
- ulong address,
- ulong size,
- MemoryState stateMask,
- MemoryState stateExpected,
- MemoryPermission permissionMask,
- MemoryPermission permissionExpected,
- MemoryAttribute attributeMask,
- MemoryAttribute attributeExpected,
- MemoryAttribute attributeIgnoreMask,
- out MemoryState outState,
- out MemoryPermission outPermission,
- out MemoryAttribute outAttribute)
- {
- ulong endAddr = address + size;
- LinkedListNode<KMemoryBlock> node = FindBlockNode(address);
- KMemoryInfo info = node.Value.GetInfo();
- MemoryState firstState = info.State;
- MemoryPermission firstPermission = info.Permission;
- MemoryAttribute firstAttribute = info.Attribute;
- do
- {
- info = node.Value.GetInfo();
- // Check if the block state matches what we expect.
- if ( firstState != info.State ||
- firstPermission != info.Permission ||
- (info.Attribute & attributeMask) != attributeExpected ||
- (firstAttribute | attributeIgnoreMask) != (info.Attribute | attributeIgnoreMask) ||
- (firstState & stateMask) != stateExpected ||
- (firstPermission & permissionMask) != permissionExpected)
- {
- outState = MemoryState.Unmapped;
- outPermission = MemoryPermission.None;
- outAttribute = MemoryAttribute.None;
- return false;
- }
- }
- while (info.Address + info.Size - 1 < endAddr - 1 && (node = node.Next) != null);
- outState = firstState;
- outPermission = firstPermission;
- outAttribute = firstAttribute & ~attributeIgnoreMask;
- return true;
- }
- private bool CheckRange(
- ulong address,
- ulong size,
- MemoryState stateMask,
- MemoryState stateExpected,
- MemoryPermission permissionMask,
- MemoryPermission permissionExpected,
- MemoryAttribute attributeMask,
- MemoryAttribute attributeExpected)
- {
- foreach (KMemoryInfo info in IterateOverRange(address, address + size))
- {
- // Check if the block state matches what we expect.
- if ((info.State & stateMask) != stateExpected ||
- (info.Permission & permissionMask) != permissionExpected ||
- (info.Attribute & attributeMask) != attributeExpected)
- {
- return false;
- }
- }
- return true;
- }
- private IEnumerable<KMemoryInfo> IterateOverRange(ulong start, ulong end)
- {
- LinkedListNode<KMemoryBlock> node = FindBlockNode(start);
- KMemoryInfo info;
- do
- {
- info = node.Value.GetInfo();
- yield return info;
- }
- while (info.Address + info.Size - 1 < end - 1 && (node = node.Next) != null);
- }
- private void InsertBlock(
- ulong baseAddress,
- ulong pagesCount,
- MemoryState oldState,
- MemoryPermission oldPermission,
- MemoryAttribute oldAttribute,
- MemoryState newState,
- MemoryPermission newPermission,
- MemoryAttribute newAttribute)
- {
- // Insert new block on the list only on areas where the state
- // of the block matches the state specified on the old* state
- // arguments, otherwise leave it as is.
- int oldCount = _blocks.Count;
- oldAttribute |= MemoryAttribute.IpcAndDeviceMapped;
- ulong endAddr = baseAddress + pagesCount * PageSize;
- LinkedListNode<KMemoryBlock> node = _blocks.First;
- while (node != null)
- {
- LinkedListNode<KMemoryBlock> newNode = node;
- KMemoryBlock currBlock = node.Value;
- ulong currBaseAddr = currBlock.BaseAddress;
- ulong currEndAddr = currBlock.PagesCount * PageSize + currBaseAddr;
- if (baseAddress < currEndAddr && currBaseAddr < endAddr)
- {
- MemoryAttribute currBlockAttr = currBlock.Attribute | MemoryAttribute.IpcAndDeviceMapped;
- if (currBlock.State != oldState ||
- currBlock.Permission != oldPermission ||
- currBlockAttr != oldAttribute)
- {
- node = node.Next;
- continue;
- }
- if (baseAddress > currBaseAddr)
- {
- _blocks.AddBefore(node, currBlock.SplitRightAtAddress(baseAddress));
- }
- if (endAddr < currEndAddr)
- {
- newNode = _blocks.AddBefore(node, currBlock.SplitRightAtAddress(endAddr));
- }
- newNode.Value.SetState(newPermission, newState, newAttribute);
- newNode = MergeEqualStateNeighbors(newNode);
- }
- if (currEndAddr - 1 >= endAddr - 1)
- {
- break;
- }
- node = newNode.Next;
- }
- _blockAllocator.Count += _blocks.Count - oldCount;
- }
- private void InsertBlock(
- ulong baseAddress,
- ulong pagesCount,
- MemoryState state,
- MemoryPermission permission = MemoryPermission.None,
- MemoryAttribute attribute = MemoryAttribute.None)
- {
- // Inserts new block at the list, replacing and splitting
- // existing blocks as needed.
- int oldCount = _blocks.Count;
- ulong endAddr = baseAddress + pagesCount * PageSize;
- LinkedListNode<KMemoryBlock> node = _blocks.First;
- while (node != null)
- {
- LinkedListNode<KMemoryBlock> newNode = node;
- KMemoryBlock currBlock = node.Value;
- ulong currBaseAddr = currBlock.BaseAddress;
- ulong currEndAddr = currBlock.PagesCount * PageSize + currBaseAddr;
- if (baseAddress < currEndAddr && currBaseAddr < endAddr)
- {
- if (baseAddress > currBaseAddr)
- {
- _blocks.AddBefore(node, currBlock.SplitRightAtAddress(baseAddress));
- }
- if (endAddr < currEndAddr)
- {
- newNode = _blocks.AddBefore(node, currBlock.SplitRightAtAddress(endAddr));
- }
- newNode.Value.SetState(permission, state, attribute);
- newNode = MergeEqualStateNeighbors(newNode);
- }
- if (currEndAddr - 1 >= endAddr - 1)
- {
- break;
- }
- node = newNode.Next;
- }
- _blockAllocator.Count += _blocks.Count - oldCount;
- }
- private static void SetIpcMappingPermissions(KMemoryBlock block, MemoryPermission permission)
- {
- block.SetIpcMappingPermission(permission);
- }
- private static void RestoreIpcMappingPermissions(KMemoryBlock block, MemoryPermission permission)
- {
- block.RestoreIpcMappingPermission();
- }
- private delegate void BlockMutator(KMemoryBlock block, MemoryPermission newPerm);
- private void InsertBlock(
- ulong baseAddress,
- ulong pagesCount,
- BlockMutator blockMutate,
- MemoryPermission permission = MemoryPermission.None)
- {
- // Inserts new block at the list, replacing and splitting
- // existing blocks as needed, then calling the callback
- // function on the new block.
- int oldCount = _blocks.Count;
- ulong endAddr = baseAddress + pagesCount * PageSize;
- LinkedListNode<KMemoryBlock> node = _blocks.First;
- while (node != null)
- {
- LinkedListNode<KMemoryBlock> newNode = node;
- KMemoryBlock currBlock = node.Value;
- ulong currBaseAddr = currBlock.BaseAddress;
- ulong currEndAddr = currBlock.PagesCount * PageSize + currBaseAddr;
- if (baseAddress < currEndAddr && currBaseAddr < endAddr)
- {
- if (baseAddress > currBaseAddr)
- {
- _blocks.AddBefore(node, currBlock.SplitRightAtAddress(baseAddress));
- }
- if (endAddr < currEndAddr)
- {
- newNode = _blocks.AddBefore(node, currBlock.SplitRightAtAddress(endAddr));
- }
- KMemoryBlock newBlock = newNode.Value;
- blockMutate(newBlock, permission);
- newNode = MergeEqualStateNeighbors(newNode);
- }
- if (currEndAddr - 1 >= endAddr - 1)
- {
- break;
- }
- node = newNode.Next;
- }
- _blockAllocator.Count += _blocks.Count - oldCount;
- }
- private LinkedListNode<KMemoryBlock> MergeEqualStateNeighbors(LinkedListNode<KMemoryBlock> node)
- {
- KMemoryBlock block = node.Value;
- if (node.Previous != null)
- {
- KMemoryBlock previousBlock = node.Previous.Value;
- if (BlockStateEquals(block, previousBlock))
- {
- LinkedListNode<KMemoryBlock> previousNode = node.Previous;
- _blocks.Remove(node);
- previousBlock.AddPages(block.PagesCount);
- node = previousNode;
- block = previousBlock;
- }
- }
- if (node.Next != null)
- {
- KMemoryBlock nextBlock = node.Next.Value;
- if (BlockStateEquals(block, nextBlock))
- {
- _blocks.Remove(node.Next);
- block.AddPages(nextBlock.PagesCount);
- }
- }
- return node;
- }
- private static bool BlockStateEquals(KMemoryBlock lhs, KMemoryBlock rhs)
- {
- return lhs.State == rhs.State &&
- lhs.Permission == rhs.Permission &&
- lhs.Attribute == rhs.Attribute &&
- lhs.SourcePermission == rhs.SourcePermission &&
- lhs.DeviceRefCount == rhs.DeviceRefCount &&
- lhs.IpcRefCount == rhs.IpcRefCount;
- }
- private ulong AllocateVa(
- ulong regionStart,
- ulong regionPagesCount,
- ulong neededPagesCount,
- int alignment)
- {
- ulong address = 0;
- ulong regionEndAddr = regionStart + regionPagesCount * PageSize;
- ulong reservedPagesCount = _isKernel ? 1UL : 4UL;
- if (_aslrEnabled)
- {
- ulong totalNeededSize = (reservedPagesCount + neededPagesCount) * PageSize;
- ulong remainingPages = regionPagesCount - neededPagesCount;
- ulong aslrMaxOffset = ((remainingPages + reservedPagesCount) * PageSize) / (ulong)alignment;
- for (int attempt = 0; attempt < 8; attempt++)
- {
- address = BitUtils.AlignDown(regionStart + GetRandomValue(0, aslrMaxOffset) * (ulong)alignment, alignment);
- ulong endAddr = address + totalNeededSize;
- KMemoryInfo info = FindBlock(address).GetInfo();
- if (info.State != MemoryState.Unmapped)
- {
- continue;
- }
- ulong currBaseAddr = info.Address + reservedPagesCount * PageSize;
- ulong currEndAddr = info.Address + info.Size;
- if (address >= regionStart &&
- address >= currBaseAddr &&
- endAddr - 1 <= regionEndAddr - 1 &&
- endAddr - 1 <= currEndAddr - 1)
- {
- break;
- }
- }
- if (address == 0)
- {
- ulong aslrPage = GetRandomValue(0, aslrMaxOffset);
- address = FindFirstFit(
- regionStart + aslrPage * PageSize,
- regionPagesCount - aslrPage,
- neededPagesCount,
- alignment,
- 0,
- reservedPagesCount);
- }
- }
- if (address == 0)
- {
- address = FindFirstFit(
- regionStart,
- regionPagesCount,
- neededPagesCount,
- alignment,
- 0,
- reservedPagesCount);
- }
- return address;
- }
- private ulong FindFirstFit(
- ulong regionStart,
- ulong regionPagesCount,
- ulong neededPagesCount,
- int alignment,
- ulong reservedStart,
- ulong reservedPagesCount)
- {
- ulong reservedSize = reservedPagesCount * PageSize;
- ulong totalNeededSize = reservedSize + neededPagesCount * PageSize;
- ulong regionEndAddr = regionStart + regionPagesCount * PageSize;
- LinkedListNode<KMemoryBlock> node = FindBlockNode(regionStart);
- KMemoryInfo info = node.Value.GetInfo();
- while (regionEndAddr >= info.Address)
- {
- if (info.State == MemoryState.Unmapped)
- {
- ulong currBaseAddr = info.Address + reservedSize;
- ulong currEndAddr = info.Address + info.Size - 1;
- ulong address = BitUtils.AlignDown(currBaseAddr, alignment) + reservedStart;
- if (currBaseAddr > address)
- {
- address += (ulong)alignment;
- }
- ulong allocationEndAddr = address + totalNeededSize - 1;
- if (allocationEndAddr <= regionEndAddr &&
- allocationEndAddr <= currEndAddr &&
- address < allocationEndAddr)
- {
- return address;
- }
- }
- node = node.Next;
- if (node == null)
- {
- break;
- }
- info = node.Value.GetInfo();
- }
- return 0;
- }
- private KMemoryBlock FindBlock(ulong address)
- {
- return FindBlockNode(address)?.Value;
- }
- private LinkedListNode<KMemoryBlock> FindBlockNode(ulong address)
- {
- lock (_blocks)
- {
- LinkedListNode<KMemoryBlock> node = _blocks.First;
- while (node != null)
- {
- KMemoryBlock block = node.Value;
- ulong currEndAddr = block.PagesCount * PageSize + block.BaseAddress;
- if (block.BaseAddress <= address && currEndAddr - 1 >= address)
- {
- return node;
- }
- node = node.Next;
- }
- }
- return null;
- }
- private bool ValidateRegionForState(ulong address, ulong size, MemoryState state)
- {
- ulong endAddr = address + size;
- ulong regionBaseAddr = GetBaseAddrForState(state);
- ulong regionEndAddr = regionBaseAddr + GetSizeForState(state);
- bool InsideRegion()
- {
- return regionBaseAddr <= address &&
- endAddr > address &&
- endAddr - 1 <= regionEndAddr - 1;
- }
- bool OutsideHeapRegion()
- {
- return endAddr <= HeapRegionStart ||
- address >= HeapRegionEnd;
- }
- bool OutsideMapRegion()
- {
- return endAddr <= AliasRegionStart ||
- address >= AliasRegionEnd;
- }
- switch (state)
- {
- case MemoryState.Io:
- case MemoryState.Normal:
- case MemoryState.CodeStatic:
- case MemoryState.CodeMutable:
- case MemoryState.SharedMemory:
- case MemoryState.ModCodeStatic:
- case MemoryState.ModCodeMutable:
- case MemoryState.Stack:
- case MemoryState.ThreadLocal:
- case MemoryState.TransferMemoryIsolated:
- case MemoryState.TransferMemory:
- case MemoryState.ProcessMemory:
- case MemoryState.CodeReadOnly:
- case MemoryState.CodeWritable:
- return InsideRegion() && OutsideHeapRegion() && OutsideMapRegion();
- case MemoryState.Heap:
- return InsideRegion() && OutsideMapRegion();
- case MemoryState.IpcBuffer0:
- case MemoryState.IpcBuffer1:
- case MemoryState.IpcBuffer3:
- return InsideRegion() && OutsideHeapRegion();
- case MemoryState.KernelStack:
- return InsideRegion();
- }
- throw new ArgumentException($"Invalid state value \"{state}\".");
- }
- private ulong GetBaseAddrForState(MemoryState state)
- {
- switch (state)
- {
- case MemoryState.Io:
- case MemoryState.Normal:
- case MemoryState.ThreadLocal:
- return TlsIoRegionStart;
- case MemoryState.CodeStatic:
- case MemoryState.CodeMutable:
- case MemoryState.SharedMemory:
- case MemoryState.ModCodeStatic:
- case MemoryState.ModCodeMutable:
- case MemoryState.TransferMemoryIsolated:
- case MemoryState.TransferMemory:
- case MemoryState.ProcessMemory:
- case MemoryState.CodeReadOnly:
- case MemoryState.CodeWritable:
- return GetAddrSpaceBaseAddr();
- case MemoryState.Heap:
- return HeapRegionStart;
- case MemoryState.IpcBuffer0:
- case MemoryState.IpcBuffer1:
- case MemoryState.IpcBuffer3:
- return AliasRegionStart;
- case MemoryState.Stack:
- return StackRegionStart;
- case MemoryState.KernelStack:
- return AddrSpaceStart;
- }
- throw new ArgumentException($"Invalid state value \"{state}\".");
- }
- private ulong GetSizeForState(MemoryState state)
- {
- switch (state)
- {
- case MemoryState.Io:
- case MemoryState.Normal:
- case MemoryState.ThreadLocal:
- return TlsIoRegionEnd - TlsIoRegionStart;
- case MemoryState.CodeStatic:
- case MemoryState.CodeMutable:
- case MemoryState.SharedMemory:
- case MemoryState.ModCodeStatic:
- case MemoryState.ModCodeMutable:
- case MemoryState.TransferMemoryIsolated:
- case MemoryState.TransferMemory:
- case MemoryState.ProcessMemory:
- case MemoryState.CodeReadOnly:
- case MemoryState.CodeWritable:
- return GetAddrSpaceSize();
- case MemoryState.Heap:
- return HeapRegionEnd - HeapRegionStart;
- case MemoryState.IpcBuffer0:
- case MemoryState.IpcBuffer1:
- case MemoryState.IpcBuffer3:
- return AliasRegionEnd - AliasRegionStart;
- case MemoryState.Stack:
- return StackRegionEnd - StackRegionStart;
- case MemoryState.KernelStack:
- return AddrSpaceEnd - AddrSpaceStart;
- }
- throw new ArgumentException($"Invalid state value \"{state}\".");
- }
- public ulong GetAddrSpaceBaseAddr()
- {
- if (AddrSpaceWidth == 36 || AddrSpaceWidth == 39)
- {
- return 0x8000000;
- }
- else if (AddrSpaceWidth == 32)
- {
- return 0x200000;
- }
- else
- {
- throw new InvalidOperationException("Invalid address space width!");
- }
- }
- public ulong GetAddrSpaceSize()
- {
- if (AddrSpaceWidth == 36)
- {
- return 0xff8000000;
- }
- else if (AddrSpaceWidth == 39)
- {
- return 0x7ff8000000;
- }
- else if (AddrSpaceWidth == 32)
- {
- return 0xffe00000;
- }
- else
- {
- throw new InvalidOperationException("Invalid address space width!");
- }
- }
- private KernelResult MapPages(ulong address, KPageList pageList, MemoryPermission permission)
- {
- ulong currAddr = address;
- KernelResult result = KernelResult.Success;
- foreach (KPageNode pageNode in pageList)
- {
- result = DoMmuOperation(
- currAddr,
- pageNode.PagesCount,
- pageNode.Address,
- true,
- permission,
- MemoryOperation.MapPa);
- if (result != KernelResult.Success)
- {
- KMemoryInfo info = FindBlock(currAddr).GetInfo();
- ulong pagesCount = (address - currAddr) / PageSize;
- result = MmuUnmap(address, pagesCount);
- break;
- }
- currAddr += pageNode.PagesCount * PageSize;
- }
- return result;
- }
- private KernelResult MmuUnmap(ulong address, ulong pagesCount)
- {
- return DoMmuOperation(
- address,
- pagesCount,
- 0,
- false,
- MemoryPermission.None,
- MemoryOperation.Unmap);
- }
- private KernelResult MmuChangePermission(ulong address, ulong pagesCount, MemoryPermission permission)
- {
- return DoMmuOperation(
- address,
- pagesCount,
- 0,
- false,
- permission,
- MemoryOperation.ChangePermRw);
- }
- private KernelResult DoMmuOperation(
- ulong dstVa,
- ulong pagesCount,
- ulong srcPa,
- bool map,
- MemoryPermission permission,
- MemoryOperation operation)
- {
- if (map != (operation == MemoryOperation.MapPa))
- {
- throw new ArgumentException(nameof(map) + " value is invalid for this operation.");
- }
- KernelResult result;
- switch (operation)
- {
- case MemoryOperation.MapPa:
- {
- ulong size = pagesCount * PageSize;
- _cpuMemory.Map(dstVa, srcPa - DramMemoryMap.DramBase, size);
- result = KernelResult.Success;
- break;
- }
- case MemoryOperation.Allocate:
- {
- KMemoryRegionManager region = GetMemoryRegionManager();
- result = region.AllocatePages(pagesCount, _aslrDisabled, out KPageList pageList);
- if (result == KernelResult.Success)
- {
- result = MmuMapPages(dstVa, pageList);
- }
- break;
- }
- case MemoryOperation.Unmap:
- {
- ulong size = pagesCount * PageSize;
- _cpuMemory.Unmap(dstVa, size);
- result = KernelResult.Success;
- break;
- }
- case MemoryOperation.ChangePermRw: result = KernelResult.Success; break;
- case MemoryOperation.ChangePermsAndAttributes: result = KernelResult.Success; break;
- default: throw new ArgumentException($"Invalid operation \"{operation}\".");
- }
- return result;
- }
- private KernelResult DoMmuOperation(
- ulong address,
- ulong pagesCount,
- KPageList pageList,
- MemoryPermission permission,
- MemoryOperation operation)
- {
- if (operation != MemoryOperation.MapVa)
- {
- throw new ArgumentException($"Invalid memory operation \"{operation}\" specified.");
- }
- return MmuMapPages(address, pageList);
- }
- private KMemoryRegionManager GetMemoryRegionManager()
- {
- return _context.MemoryRegions[(int)_memRegion];
- }
- private KernelResult MmuMapPages(ulong address, KPageList pageList)
- {
- foreach (KPageNode pageNode in pageList)
- {
- ulong size = pageNode.PagesCount * PageSize;
- _cpuMemory.Map(address, pageNode.Address - DramMemoryMap.DramBase, size);
- address += size;
- }
- return KernelResult.Success;
- }
- public ulong GetDramAddressFromVa(ulong va)
- {
- return _cpuMemory.GetPhysicalAddress(va);
- }
- public bool ConvertVaToPa(ulong va, out ulong pa)
- {
- pa = DramMemoryMap.DramBase + _cpuMemory.GetPhysicalAddress(va);
- return true;
- }
- public static ulong GetDramAddressFromPa(ulong pa)
- {
- return pa - DramMemoryMap.DramBase;
- }
- public long GetMmUsedPages()
- {
- lock (_blocks)
- {
- return BitUtils.DivRoundUp(GetMmUsedSize(), PageSize);
- }
- }
- private long GetMmUsedSize()
- {
- return _blocks.Count * KMemoryBlockSize;
- }
- public bool IsInvalidRegion(ulong address, ulong size)
- {
- return address + size - 1 > GetAddrSpaceBaseAddr() + GetAddrSpaceSize() - 1;
- }
- public bool InsideAddrSpace(ulong address, ulong size)
- {
- return AddrSpaceStart <= address && address + size - 1 <= AddrSpaceEnd - 1;
- }
- public bool InsideAliasRegion(ulong address, ulong size)
- {
- return address + size > AliasRegionStart && AliasRegionEnd > address;
- }
- public bool InsideHeapRegion(ulong address, ulong size)
- {
- return address + size > HeapRegionStart && HeapRegionEnd > address;
- }
- public bool InsideStackRegion(ulong address, ulong size)
- {
- return address + size > StackRegionStart && StackRegionEnd > address;
- }
- public bool OutsideAliasRegion(ulong address, ulong size)
- {
- return AliasRegionStart > address || address + size - 1 > AliasRegionEnd - 1;
- }
- public bool OutsideAddrSpace(ulong address, ulong size)
- {
- return AddrSpaceStart > address || address + size - 1 > AddrSpaceEnd - 1;
- }
- public bool OutsideStackRegion(ulong address, ulong size)
- {
- return StackRegionStart > address || address + size - 1 > StackRegionEnd - 1;
- }
- }
- }
|