x86.c 201 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188318931903191319231933194319531963197319831993200320132023203320432053206320732083209321032113212321332143215321632173218321932203221322232233224322532263227322832293230323132323233323432353236323732383239324032413242324332443245324632473248324932503251325232533254325532563257325832593260326132623263326432653266326732683269327032713272327332743275327632773278327932803281328232833284328532863287328832893290329132923293329432953296329732983299330033013302330333043305330633073308330933103311331233133314331533163317331833193320332133223323332433253326332733283329333033313332333333343335333633373338333933403341334233433344334533463347334833493350335133523353335433553356335733583359336033613362336333643365336633673368336933703371337233733374337533763377337833793380338133823383338433853386338733883389339033913392339333943395339633973398339934003401340234033404340534063407340834093410341134123413341434153416341734183419342034213422342334243425342634273428342934303431343234333434343534363437343834393440344134423443344434453446344734483449345034513452345334543455345634573458345934603461346234633464346534663467346834693470347134723473347434753476347734783479348034813482348334843485348634873488348934903491349234933494349534963497349834993500350135023503350435053506350735083509351035113512351335143515351635173518351935203521352235233524352535263527352835293530353135323533353435353536353735383539354035413542354335443545354635473548354935503551355235533554355535563557355835593560356135623563356435653566356735683569357035713572357335743575357635773578357935803581358235833584358535863587358835893590359135923593359435953596359735983599360036013602360336043605360636073608360936103611361236133614361536163617361836193620362136223623362436253626362736283629363036313632363336343635363636373638363936403641364236433644364536463647364836493650365136523653365436553656365736583659366036613662366336643665366636673668366936703671367236733674367536763677367836793680368136823683368436853686368736883689369036913692369336943695369636973698369937003701370237033704370537063707370837093710371137123713371437153716371737183719372037213722372337243725372637273728372937303731373237333734373537363737373837393740374137423743374437453746374737483749375037513752375337543755375637573758375937603761376237633764376537663767376837693770377137723773377437753776377737783779378037813782378337843785378637873788378937903791379237933794379537963797379837993800380138023803380438053806380738083809381038113812381338143815381638173818381938203821382238233824382538263827382838293830383138323833383438353836383738383839384038413842384338443845384638473848384938503851385238533854385538563857385838593860386138623863386438653866386738683869387038713872387338743875387638773878387938803881388238833884388538863887388838893890389138923893389438953896389738983899390039013902390339043905390639073908390939103911391239133914391539163917391839193920392139223923392439253926392739283929393039313932393339343935393639373938393939403941394239433944394539463947394839493950395139523953395439553956395739583959396039613962396339643965396639673968396939703971397239733974397539763977397839793980398139823983398439853986398739883989399039913992399339943995399639973998399940004001400240034004400540064007400840094010401140124013401440154016401740184019402040214022402340244025402640274028402940304031403240334034403540364037403840394040404140424043404440454046404740484049405040514052405340544055405640574058405940604061406240634064406540664067406840694070407140724073407440754076407740784079408040814082408340844085408640874088408940904091409240934094409540964097409840994100410141024103410441054106410741084109411041114112411341144115411641174118411941204121412241234124412541264127412841294130413141324133413441354136413741384139414041414142414341444145414641474148414941504151415241534154415541564157415841594160416141624163416441654166416741684169417041714172417341744175417641774178417941804181418241834184418541864187418841894190419141924193419441954196419741984199420042014202420342044205420642074208420942104211421242134214421542164217421842194220422142224223422442254226422742284229423042314232423342344235423642374238423942404241424242434244424542464247424842494250425142524253425442554256425742584259426042614262426342644265426642674268426942704271427242734274427542764277427842794280428142824283428442854286428742884289429042914292429342944295429642974298429943004301430243034304430543064307430843094310431143124313431443154316431743184319432043214322432343244325432643274328432943304331433243334334433543364337433843394340434143424343434443454346434743484349435043514352435343544355435643574358435943604361436243634364436543664367436843694370437143724373437443754376437743784379438043814382438343844385438643874388438943904391439243934394439543964397439843994400440144024403440444054406440744084409441044114412441344144415441644174418441944204421442244234424442544264427442844294430443144324433443444354436443744384439444044414442444344444445444644474448444944504451445244534454445544564457445844594460446144624463446444654466446744684469447044714472447344744475447644774478447944804481448244834484448544864487448844894490449144924493449444954496449744984499450045014502450345044505450645074508450945104511451245134514451545164517451845194520452145224523452445254526452745284529453045314532453345344535453645374538453945404541454245434544454545464547454845494550455145524553455445554556455745584559456045614562456345644565456645674568456945704571457245734574457545764577457845794580458145824583458445854586458745884589459045914592459345944595459645974598459946004601460246034604460546064607460846094610461146124613461446154616461746184619462046214622462346244625462646274628462946304631463246334634463546364637463846394640464146424643464446454646464746484649465046514652465346544655465646574658465946604661466246634664466546664667466846694670467146724673467446754676467746784679468046814682468346844685468646874688468946904691469246934694469546964697469846994700470147024703470447054706470747084709471047114712471347144715471647174718471947204721472247234724472547264727472847294730473147324733473447354736473747384739474047414742474347444745474647474748474947504751475247534754475547564757475847594760476147624763476447654766476747684769477047714772477347744775477647774778477947804781478247834784478547864787478847894790479147924793479447954796479747984799480048014802480348044805480648074808480948104811481248134814481548164817481848194820482148224823482448254826482748284829483048314832483348344835483648374838483948404841484248434844484548464847484848494850485148524853485448554856485748584859486048614862486348644865486648674868486948704871487248734874487548764877487848794880488148824883488448854886488748884889489048914892489348944895489648974898489949004901490249034904490549064907490849094910491149124913491449154916491749184919492049214922492349244925492649274928492949304931493249334934493549364937493849394940494149424943494449454946494749484949495049514952495349544955495649574958495949604961496249634964496549664967496849694970497149724973497449754976497749784979498049814982498349844985498649874988498949904991499249934994499549964997499849995000500150025003500450055006500750085009501050115012501350145015501650175018501950205021502250235024502550265027502850295030503150325033503450355036503750385039504050415042504350445045504650475048504950505051505250535054505550565057505850595060506150625063506450655066506750685069507050715072507350745075507650775078507950805081508250835084508550865087508850895090509150925093509450955096509750985099510051015102510351045105510651075108510951105111511251135114511551165117511851195120512151225123512451255126512751285129513051315132513351345135513651375138513951405141514251435144514551465147514851495150515151525153515451555156515751585159516051615162516351645165516651675168516951705171517251735174517551765177517851795180518151825183518451855186518751885189519051915192519351945195519651975198519952005201520252035204520552065207520852095210521152125213521452155216521752185219522052215222522352245225522652275228522952305231523252335234523552365237523852395240524152425243524452455246524752485249525052515252525352545255525652575258525952605261526252635264526552665267526852695270527152725273527452755276527752785279528052815282528352845285528652875288528952905291529252935294529552965297529852995300530153025303530453055306530753085309531053115312531353145315531653175318531953205321532253235324532553265327532853295330533153325333533453355336533753385339534053415342534353445345534653475348534953505351535253535354535553565357535853595360536153625363536453655366536753685369537053715372537353745375537653775378537953805381538253835384538553865387538853895390539153925393539453955396539753985399540054015402540354045405540654075408540954105411541254135414541554165417541854195420542154225423542454255426542754285429543054315432543354345435543654375438543954405441544254435444544554465447544854495450545154525453545454555456545754585459546054615462546354645465546654675468546954705471547254735474547554765477547854795480548154825483548454855486548754885489549054915492549354945495549654975498549955005501550255035504550555065507550855095510551155125513551455155516551755185519552055215522552355245525552655275528552955305531553255335534553555365537553855395540554155425543554455455546554755485549555055515552555355545555555655575558555955605561556255635564556555665567556855695570557155725573557455755576557755785579558055815582558355845585558655875588558955905591559255935594559555965597559855995600560156025603560456055606560756085609561056115612561356145615561656175618561956205621562256235624562556265627562856295630563156325633563456355636563756385639564056415642564356445645564656475648564956505651565256535654565556565657565856595660566156625663566456655666566756685669567056715672567356745675567656775678567956805681568256835684568556865687568856895690569156925693569456955696569756985699570057015702570357045705570657075708570957105711571257135714571557165717571857195720572157225723572457255726572757285729573057315732573357345735573657375738573957405741574257435744574557465747574857495750575157525753575457555756575757585759576057615762576357645765576657675768576957705771577257735774577557765777577857795780578157825783578457855786578757885789579057915792579357945795579657975798579958005801580258035804580558065807580858095810581158125813581458155816581758185819582058215822582358245825582658275828582958305831583258335834583558365837583858395840584158425843584458455846584758485849585058515852585358545855585658575858585958605861586258635864586558665867586858695870587158725873587458755876587758785879588058815882588358845885588658875888588958905891589258935894589558965897589858995900590159025903590459055906590759085909591059115912591359145915591659175918591959205921592259235924592559265927592859295930593159325933593459355936593759385939594059415942594359445945594659475948594959505951595259535954595559565957595859595960596159625963596459655966596759685969597059715972597359745975597659775978597959805981598259835984598559865987598859895990599159925993599459955996599759985999600060016002600360046005600660076008600960106011601260136014601560166017601860196020602160226023602460256026602760286029603060316032603360346035603660376038603960406041604260436044604560466047604860496050605160526053605460556056605760586059606060616062606360646065606660676068606960706071607260736074607560766077607860796080608160826083608460856086608760886089609060916092609360946095609660976098609961006101610261036104610561066107610861096110611161126113611461156116611761186119612061216122612361246125612661276128612961306131613261336134613561366137613861396140614161426143614461456146614761486149615061516152615361546155615661576158615961606161616261636164616561666167616861696170617161726173617461756176617761786179618061816182618361846185618661876188618961906191619261936194619561966197619861996200620162026203620462056206620762086209621062116212621362146215621662176218621962206221622262236224622562266227622862296230623162326233623462356236623762386239624062416242624362446245624662476248624962506251625262536254625562566257625862596260626162626263626462656266626762686269627062716272627362746275627662776278627962806281628262836284628562866287628862896290629162926293629462956296629762986299630063016302630363046305630663076308630963106311631263136314631563166317631863196320632163226323632463256326632763286329633063316332633363346335633663376338633963406341634263436344634563466347634863496350635163526353635463556356635763586359636063616362636363646365636663676368636963706371637263736374637563766377637863796380638163826383638463856386638763886389639063916392639363946395639663976398639964006401640264036404640564066407640864096410641164126413641464156416641764186419642064216422642364246425642664276428642964306431643264336434643564366437643864396440644164426443644464456446644764486449645064516452645364546455645664576458645964606461646264636464646564666467646864696470647164726473647464756476647764786479648064816482648364846485648664876488648964906491649264936494649564966497649864996500650165026503650465056506650765086509651065116512651365146515651665176518651965206521652265236524652565266527652865296530653165326533653465356536653765386539654065416542654365446545654665476548654965506551655265536554655565566557655865596560656165626563656465656566656765686569657065716572657365746575657665776578657965806581658265836584658565866587658865896590659165926593659465956596659765986599660066016602660366046605660666076608660966106611661266136614661566166617661866196620662166226623662466256626662766286629663066316632663366346635663666376638663966406641664266436644664566466647664866496650665166526653665466556656665766586659666066616662666366646665666666676668666966706671667266736674667566766677667866796680668166826683668466856686668766886689669066916692669366946695669666976698669967006701670267036704670567066707670867096710671167126713671467156716671767186719672067216722672367246725672667276728672967306731673267336734673567366737673867396740674167426743674467456746674767486749675067516752675367546755675667576758675967606761676267636764676567666767676867696770677167726773677467756776677767786779678067816782678367846785678667876788678967906791679267936794679567966797679867996800680168026803680468056806680768086809681068116812681368146815681668176818681968206821682268236824682568266827682868296830683168326833683468356836683768386839684068416842684368446845684668476848684968506851685268536854685568566857685868596860686168626863686468656866686768686869687068716872687368746875687668776878687968806881688268836884688568866887688868896890689168926893689468956896689768986899690069016902690369046905690669076908690969106911691269136914691569166917691869196920692169226923692469256926692769286929693069316932693369346935693669376938693969406941694269436944694569466947694869496950695169526953695469556956695769586959696069616962696369646965696669676968696969706971697269736974697569766977697869796980698169826983698469856986698769886989699069916992699369946995699669976998699970007001700270037004700570067007700870097010701170127013701470157016701770187019702070217022702370247025702670277028702970307031703270337034703570367037703870397040704170427043704470457046704770487049705070517052705370547055705670577058705970607061706270637064706570667067706870697070707170727073707470757076707770787079708070817082708370847085708670877088708970907091709270937094709570967097709870997100710171027103710471057106710771087109711071117112711371147115711671177118711971207121712271237124712571267127712871297130713171327133713471357136713771387139714071417142714371447145714671477148714971507151715271537154715571567157715871597160716171627163716471657166716771687169717071717172717371747175717671777178717971807181718271837184718571867187718871897190719171927193719471957196719771987199720072017202720372047205720672077208720972107211721272137214721572167217721872197220722172227223722472257226722772287229723072317232723372347235723672377238723972407241724272437244724572467247724872497250725172527253725472557256725772587259726072617262726372647265726672677268726972707271727272737274727572767277727872797280728172827283728472857286728772887289729072917292729372947295729672977298729973007301730273037304730573067307730873097310731173127313731473157316731773187319732073217322732373247325732673277328732973307331733273337334733573367337733873397340734173427343734473457346734773487349735073517352735373547355735673577358735973607361736273637364736573667367736873697370737173727373737473757376737773787379738073817382738373847385738673877388738973907391739273937394739573967397739873997400740174027403740474057406740774087409741074117412741374147415741674177418741974207421742274237424742574267427742874297430743174327433743474357436743774387439744074417442744374447445744674477448744974507451745274537454745574567457745874597460746174627463746474657466746774687469747074717472747374747475747674777478747974807481748274837484748574867487748874897490749174927493749474957496749774987499750075017502750375047505750675077508750975107511751275137514751575167517751875197520752175227523752475257526752775287529753075317532753375347535753675377538753975407541754275437544754575467547754875497550755175527553755475557556755775587559756075617562756375647565756675677568756975707571757275737574757575767577757875797580758175827583758475857586758775887589759075917592759375947595759675977598759976007601760276037604760576067607760876097610761176127613761476157616761776187619762076217622762376247625762676277628762976307631763276337634763576367637763876397640764176427643764476457646764776487649765076517652765376547655765676577658765976607661766276637664766576667667766876697670767176727673767476757676767776787679768076817682768376847685768676877688768976907691769276937694769576967697769876997700770177027703770477057706770777087709771077117712771377147715771677177718771977207721772277237724772577267727772877297730773177327733773477357736773777387739774077417742774377447745774677477748774977507751775277537754775577567757775877597760776177627763776477657766776777687769777077717772777377747775777677777778777977807781778277837784778577867787778877897790779177927793779477957796779777987799780078017802780378047805780678077808780978107811781278137814781578167817781878197820782178227823782478257826782778287829783078317832783378347835783678377838783978407841784278437844784578467847784878497850785178527853785478557856785778587859786078617862786378647865786678677868786978707871787278737874787578767877787878797880788178827883788478857886788778887889789078917892789378947895789678977898789979007901790279037904790579067907790879097910791179127913791479157916791779187919792079217922792379247925792679277928792979307931793279337934793579367937793879397940794179427943794479457946794779487949795079517952
  1. /*
  2. * Kernel-based Virtual Machine driver for Linux
  3. *
  4. * derived from drivers/kvm/kvm_main.c
  5. *
  6. * Copyright (C) 2006 Qumranet, Inc.
  7. * Copyright (C) 2008 Qumranet, Inc.
  8. * Copyright IBM Corporation, 2008
  9. * Copyright 2010 Red Hat, Inc. and/or its affiliates.
  10. *
  11. * Authors:
  12. * Avi Kivity <avi@qumranet.com>
  13. * Yaniv Kamay <yaniv@qumranet.com>
  14. * Amit Shah <amit.shah@qumranet.com>
  15. * Ben-Ami Yassour <benami@il.ibm.com>
  16. *
  17. * This work is licensed under the terms of the GNU GPL, version 2. See
  18. * the COPYING file in the top-level directory.
  19. *
  20. */
  21. #include <linux/kvm_host.h>
  22. #include "irq.h"
  23. #include "mmu.h"
  24. #include "i8254.h"
  25. #include "tss.h"
  26. #include "kvm_cache_regs.h"
  27. #include "x86.h"
  28. #include "cpuid.h"
  29. #include "assigned-dev.h"
  30. #include <linux/clocksource.h>
  31. #include <linux/interrupt.h>
  32. #include <linux/kvm.h>
  33. #include <linux/fs.h>
  34. #include <linux/vmalloc.h>
  35. #include <linux/module.h>
  36. #include <linux/mman.h>
  37. #include <linux/highmem.h>
  38. #include <linux/iommu.h>
  39. #include <linux/intel-iommu.h>
  40. #include <linux/cpufreq.h>
  41. #include <linux/user-return-notifier.h>
  42. #include <linux/srcu.h>
  43. #include <linux/slab.h>
  44. #include <linux/perf_event.h>
  45. #include <linux/uaccess.h>
  46. #include <linux/hash.h>
  47. #include <linux/pci.h>
  48. #include <linux/timekeeper_internal.h>
  49. #include <linux/pvclock_gtod.h>
  50. #include <trace/events/kvm.h>
  51. #define CREATE_TRACE_POINTS
  52. #include "trace.h"
  53. #include <asm/debugreg.h>
  54. #include <asm/msr.h>
  55. #include <asm/desc.h>
  56. #include <asm/mtrr.h>
  57. #include <asm/mce.h>
  58. #include <asm/i387.h>
  59. #include <asm/fpu-internal.h> /* Ugh! */
  60. #include <asm/xcr.h>
  61. #include <asm/pvclock.h>
  62. #include <asm/div64.h>
  63. #define MAX_IO_MSRS 256
  64. #define KVM_MAX_MCE_BANKS 32
  65. #define KVM_MCE_CAP_SUPPORTED (MCG_CTL_P | MCG_SER_P)
  66. #define emul_to_vcpu(ctxt) \
  67. container_of(ctxt, struct kvm_vcpu, arch.emulate_ctxt)
  68. /* EFER defaults:
  69. * - enable syscall per default because its emulated by KVM
  70. * - enable LME and LMA per default on 64 bit KVM
  71. */
  72. #ifdef CONFIG_X86_64
  73. static
  74. u64 __read_mostly efer_reserved_bits = ~((u64)(EFER_SCE | EFER_LME | EFER_LMA));
  75. #else
  76. static u64 __read_mostly efer_reserved_bits = ~((u64)EFER_SCE);
  77. #endif
  78. #define VM_STAT(x) offsetof(struct kvm, stat.x), KVM_STAT_VM
  79. #define VCPU_STAT(x) offsetof(struct kvm_vcpu, stat.x), KVM_STAT_VCPU
  80. static void update_cr8_intercept(struct kvm_vcpu *vcpu);
  81. static void process_nmi(struct kvm_vcpu *vcpu);
  82. static void __kvm_set_rflags(struct kvm_vcpu *vcpu, unsigned long rflags);
  83. struct kvm_x86_ops *kvm_x86_ops;
  84. EXPORT_SYMBOL_GPL(kvm_x86_ops);
  85. static bool ignore_msrs = 0;
  86. module_param(ignore_msrs, bool, S_IRUGO | S_IWUSR);
  87. unsigned int min_timer_period_us = 500;
  88. module_param(min_timer_period_us, uint, S_IRUGO | S_IWUSR);
  89. bool kvm_has_tsc_control;
  90. EXPORT_SYMBOL_GPL(kvm_has_tsc_control);
  91. u32 kvm_max_guest_tsc_khz;
  92. EXPORT_SYMBOL_GPL(kvm_max_guest_tsc_khz);
  93. /* tsc tolerance in parts per million - default to 1/2 of the NTP threshold */
  94. static u32 tsc_tolerance_ppm = 250;
  95. module_param(tsc_tolerance_ppm, uint, S_IRUGO | S_IWUSR);
  96. /* lapic timer advance (tscdeadline mode only) in nanoseconds */
  97. unsigned int lapic_timer_advance_ns = 0;
  98. module_param(lapic_timer_advance_ns, uint, S_IRUGO | S_IWUSR);
  99. static bool backwards_tsc_observed = false;
  100. #define KVM_NR_SHARED_MSRS 16
  101. struct kvm_shared_msrs_global {
  102. int nr;
  103. u32 msrs[KVM_NR_SHARED_MSRS];
  104. };
  105. struct kvm_shared_msrs {
  106. struct user_return_notifier urn;
  107. bool registered;
  108. struct kvm_shared_msr_values {
  109. u64 host;
  110. u64 curr;
  111. } values[KVM_NR_SHARED_MSRS];
  112. };
  113. static struct kvm_shared_msrs_global __read_mostly shared_msrs_global;
  114. static struct kvm_shared_msrs __percpu *shared_msrs;
  115. struct kvm_stats_debugfs_item debugfs_entries[] = {
  116. { "pf_fixed", VCPU_STAT(pf_fixed) },
  117. { "pf_guest", VCPU_STAT(pf_guest) },
  118. { "tlb_flush", VCPU_STAT(tlb_flush) },
  119. { "invlpg", VCPU_STAT(invlpg) },
  120. { "exits", VCPU_STAT(exits) },
  121. { "io_exits", VCPU_STAT(io_exits) },
  122. { "mmio_exits", VCPU_STAT(mmio_exits) },
  123. { "signal_exits", VCPU_STAT(signal_exits) },
  124. { "irq_window", VCPU_STAT(irq_window_exits) },
  125. { "nmi_window", VCPU_STAT(nmi_window_exits) },
  126. { "halt_exits", VCPU_STAT(halt_exits) },
  127. { "halt_successful_poll", VCPU_STAT(halt_successful_poll) },
  128. { "halt_wakeup", VCPU_STAT(halt_wakeup) },
  129. { "hypercalls", VCPU_STAT(hypercalls) },
  130. { "request_irq", VCPU_STAT(request_irq_exits) },
  131. { "irq_exits", VCPU_STAT(irq_exits) },
  132. { "host_state_reload", VCPU_STAT(host_state_reload) },
  133. { "efer_reload", VCPU_STAT(efer_reload) },
  134. { "fpu_reload", VCPU_STAT(fpu_reload) },
  135. { "insn_emulation", VCPU_STAT(insn_emulation) },
  136. { "insn_emulation_fail", VCPU_STAT(insn_emulation_fail) },
  137. { "irq_injections", VCPU_STAT(irq_injections) },
  138. { "nmi_injections", VCPU_STAT(nmi_injections) },
  139. { "mmu_shadow_zapped", VM_STAT(mmu_shadow_zapped) },
  140. { "mmu_pte_write", VM_STAT(mmu_pte_write) },
  141. { "mmu_pte_updated", VM_STAT(mmu_pte_updated) },
  142. { "mmu_pde_zapped", VM_STAT(mmu_pde_zapped) },
  143. { "mmu_flooded", VM_STAT(mmu_flooded) },
  144. { "mmu_recycled", VM_STAT(mmu_recycled) },
  145. { "mmu_cache_miss", VM_STAT(mmu_cache_miss) },
  146. { "mmu_unsync", VM_STAT(mmu_unsync) },
  147. { "remote_tlb_flush", VM_STAT(remote_tlb_flush) },
  148. { "largepages", VM_STAT(lpages) },
  149. { NULL }
  150. };
  151. u64 __read_mostly host_xcr0;
  152. static int emulator_fix_hypercall(struct x86_emulate_ctxt *ctxt);
  153. static inline void kvm_async_pf_hash_reset(struct kvm_vcpu *vcpu)
  154. {
  155. int i;
  156. for (i = 0; i < roundup_pow_of_two(ASYNC_PF_PER_VCPU); i++)
  157. vcpu->arch.apf.gfns[i] = ~0;
  158. }
  159. static void kvm_on_user_return(struct user_return_notifier *urn)
  160. {
  161. unsigned slot;
  162. struct kvm_shared_msrs *locals
  163. = container_of(urn, struct kvm_shared_msrs, urn);
  164. struct kvm_shared_msr_values *values;
  165. for (slot = 0; slot < shared_msrs_global.nr; ++slot) {
  166. values = &locals->values[slot];
  167. if (values->host != values->curr) {
  168. wrmsrl(shared_msrs_global.msrs[slot], values->host);
  169. values->curr = values->host;
  170. }
  171. }
  172. locals->registered = false;
  173. user_return_notifier_unregister(urn);
  174. }
  175. static void shared_msr_update(unsigned slot, u32 msr)
  176. {
  177. u64 value;
  178. unsigned int cpu = smp_processor_id();
  179. struct kvm_shared_msrs *smsr = per_cpu_ptr(shared_msrs, cpu);
  180. /* only read, and nobody should modify it at this time,
  181. * so don't need lock */
  182. if (slot >= shared_msrs_global.nr) {
  183. printk(KERN_ERR "kvm: invalid MSR slot!");
  184. return;
  185. }
  186. rdmsrl_safe(msr, &value);
  187. smsr->values[slot].host = value;
  188. smsr->values[slot].curr = value;
  189. }
  190. void kvm_define_shared_msr(unsigned slot, u32 msr)
  191. {
  192. BUG_ON(slot >= KVM_NR_SHARED_MSRS);
  193. if (slot >= shared_msrs_global.nr)
  194. shared_msrs_global.nr = slot + 1;
  195. shared_msrs_global.msrs[slot] = msr;
  196. /* we need ensured the shared_msr_global have been updated */
  197. smp_wmb();
  198. }
  199. EXPORT_SYMBOL_GPL(kvm_define_shared_msr);
  200. static void kvm_shared_msr_cpu_online(void)
  201. {
  202. unsigned i;
  203. for (i = 0; i < shared_msrs_global.nr; ++i)
  204. shared_msr_update(i, shared_msrs_global.msrs[i]);
  205. }
  206. int kvm_set_shared_msr(unsigned slot, u64 value, u64 mask)
  207. {
  208. unsigned int cpu = smp_processor_id();
  209. struct kvm_shared_msrs *smsr = per_cpu_ptr(shared_msrs, cpu);
  210. int err;
  211. if (((value ^ smsr->values[slot].curr) & mask) == 0)
  212. return 0;
  213. smsr->values[slot].curr = value;
  214. err = wrmsrl_safe(shared_msrs_global.msrs[slot], value);
  215. if (err)
  216. return 1;
  217. if (!smsr->registered) {
  218. smsr->urn.on_user_return = kvm_on_user_return;
  219. user_return_notifier_register(&smsr->urn);
  220. smsr->registered = true;
  221. }
  222. return 0;
  223. }
  224. EXPORT_SYMBOL_GPL(kvm_set_shared_msr);
  225. static void drop_user_return_notifiers(void)
  226. {
  227. unsigned int cpu = smp_processor_id();
  228. struct kvm_shared_msrs *smsr = per_cpu_ptr(shared_msrs, cpu);
  229. if (smsr->registered)
  230. kvm_on_user_return(&smsr->urn);
  231. }
  232. u64 kvm_get_apic_base(struct kvm_vcpu *vcpu)
  233. {
  234. return vcpu->arch.apic_base;
  235. }
  236. EXPORT_SYMBOL_GPL(kvm_get_apic_base);
  237. int kvm_set_apic_base(struct kvm_vcpu *vcpu, struct msr_data *msr_info)
  238. {
  239. u64 old_state = vcpu->arch.apic_base &
  240. (MSR_IA32_APICBASE_ENABLE | X2APIC_ENABLE);
  241. u64 new_state = msr_info->data &
  242. (MSR_IA32_APICBASE_ENABLE | X2APIC_ENABLE);
  243. u64 reserved_bits = ((~0ULL) << cpuid_maxphyaddr(vcpu)) |
  244. 0x2ff | (guest_cpuid_has_x2apic(vcpu) ? 0 : X2APIC_ENABLE);
  245. if (!msr_info->host_initiated &&
  246. ((msr_info->data & reserved_bits) != 0 ||
  247. new_state == X2APIC_ENABLE ||
  248. (new_state == MSR_IA32_APICBASE_ENABLE &&
  249. old_state == (MSR_IA32_APICBASE_ENABLE | X2APIC_ENABLE)) ||
  250. (new_state == (MSR_IA32_APICBASE_ENABLE | X2APIC_ENABLE) &&
  251. old_state == 0)))
  252. return 1;
  253. kvm_lapic_set_base(vcpu, msr_info->data);
  254. return 0;
  255. }
  256. EXPORT_SYMBOL_GPL(kvm_set_apic_base);
  257. asmlinkage __visible void kvm_spurious_fault(void)
  258. {
  259. /* Fault while not rebooting. We want the trace. */
  260. BUG();
  261. }
  262. EXPORT_SYMBOL_GPL(kvm_spurious_fault);
  263. #define EXCPT_BENIGN 0
  264. #define EXCPT_CONTRIBUTORY 1
  265. #define EXCPT_PF 2
  266. static int exception_class(int vector)
  267. {
  268. switch (vector) {
  269. case PF_VECTOR:
  270. return EXCPT_PF;
  271. case DE_VECTOR:
  272. case TS_VECTOR:
  273. case NP_VECTOR:
  274. case SS_VECTOR:
  275. case GP_VECTOR:
  276. return EXCPT_CONTRIBUTORY;
  277. default:
  278. break;
  279. }
  280. return EXCPT_BENIGN;
  281. }
  282. #define EXCPT_FAULT 0
  283. #define EXCPT_TRAP 1
  284. #define EXCPT_ABORT 2
  285. #define EXCPT_INTERRUPT 3
  286. static int exception_type(int vector)
  287. {
  288. unsigned int mask;
  289. if (WARN_ON(vector > 31 || vector == NMI_VECTOR))
  290. return EXCPT_INTERRUPT;
  291. mask = 1 << vector;
  292. /* #DB is trap, as instruction watchpoints are handled elsewhere */
  293. if (mask & ((1 << DB_VECTOR) | (1 << BP_VECTOR) | (1 << OF_VECTOR)))
  294. return EXCPT_TRAP;
  295. if (mask & ((1 << DF_VECTOR) | (1 << MC_VECTOR)))
  296. return EXCPT_ABORT;
  297. /* Reserved exceptions will result in fault */
  298. return EXCPT_FAULT;
  299. }
  300. static void kvm_multiple_exception(struct kvm_vcpu *vcpu,
  301. unsigned nr, bool has_error, u32 error_code,
  302. bool reinject)
  303. {
  304. u32 prev_nr;
  305. int class1, class2;
  306. kvm_make_request(KVM_REQ_EVENT, vcpu);
  307. if (!vcpu->arch.exception.pending) {
  308. queue:
  309. if (has_error && !is_protmode(vcpu))
  310. has_error = false;
  311. vcpu->arch.exception.pending = true;
  312. vcpu->arch.exception.has_error_code = has_error;
  313. vcpu->arch.exception.nr = nr;
  314. vcpu->arch.exception.error_code = error_code;
  315. vcpu->arch.exception.reinject = reinject;
  316. return;
  317. }
  318. /* to check exception */
  319. prev_nr = vcpu->arch.exception.nr;
  320. if (prev_nr == DF_VECTOR) {
  321. /* triple fault -> shutdown */
  322. kvm_make_request(KVM_REQ_TRIPLE_FAULT, vcpu);
  323. return;
  324. }
  325. class1 = exception_class(prev_nr);
  326. class2 = exception_class(nr);
  327. if ((class1 == EXCPT_CONTRIBUTORY && class2 == EXCPT_CONTRIBUTORY)
  328. || (class1 == EXCPT_PF && class2 != EXCPT_BENIGN)) {
  329. /* generate double fault per SDM Table 5-5 */
  330. vcpu->arch.exception.pending = true;
  331. vcpu->arch.exception.has_error_code = true;
  332. vcpu->arch.exception.nr = DF_VECTOR;
  333. vcpu->arch.exception.error_code = 0;
  334. } else
  335. /* replace previous exception with a new one in a hope
  336. that instruction re-execution will regenerate lost
  337. exception */
  338. goto queue;
  339. }
  340. void kvm_queue_exception(struct kvm_vcpu *vcpu, unsigned nr)
  341. {
  342. kvm_multiple_exception(vcpu, nr, false, 0, false);
  343. }
  344. EXPORT_SYMBOL_GPL(kvm_queue_exception);
  345. void kvm_requeue_exception(struct kvm_vcpu *vcpu, unsigned nr)
  346. {
  347. kvm_multiple_exception(vcpu, nr, false, 0, true);
  348. }
  349. EXPORT_SYMBOL_GPL(kvm_requeue_exception);
  350. void kvm_complete_insn_gp(struct kvm_vcpu *vcpu, int err)
  351. {
  352. if (err)
  353. kvm_inject_gp(vcpu, 0);
  354. else
  355. kvm_x86_ops->skip_emulated_instruction(vcpu);
  356. }
  357. EXPORT_SYMBOL_GPL(kvm_complete_insn_gp);
  358. void kvm_inject_page_fault(struct kvm_vcpu *vcpu, struct x86_exception *fault)
  359. {
  360. ++vcpu->stat.pf_guest;
  361. vcpu->arch.cr2 = fault->address;
  362. kvm_queue_exception_e(vcpu, PF_VECTOR, fault->error_code);
  363. }
  364. EXPORT_SYMBOL_GPL(kvm_inject_page_fault);
  365. static bool kvm_propagate_fault(struct kvm_vcpu *vcpu, struct x86_exception *fault)
  366. {
  367. if (mmu_is_nested(vcpu) && !fault->nested_page_fault)
  368. vcpu->arch.nested_mmu.inject_page_fault(vcpu, fault);
  369. else
  370. vcpu->arch.mmu.inject_page_fault(vcpu, fault);
  371. return fault->nested_page_fault;
  372. }
  373. void kvm_inject_nmi(struct kvm_vcpu *vcpu)
  374. {
  375. atomic_inc(&vcpu->arch.nmi_queued);
  376. kvm_make_request(KVM_REQ_NMI, vcpu);
  377. }
  378. EXPORT_SYMBOL_GPL(kvm_inject_nmi);
  379. void kvm_queue_exception_e(struct kvm_vcpu *vcpu, unsigned nr, u32 error_code)
  380. {
  381. kvm_multiple_exception(vcpu, nr, true, error_code, false);
  382. }
  383. EXPORT_SYMBOL_GPL(kvm_queue_exception_e);
  384. void kvm_requeue_exception_e(struct kvm_vcpu *vcpu, unsigned nr, u32 error_code)
  385. {
  386. kvm_multiple_exception(vcpu, nr, true, error_code, true);
  387. }
  388. EXPORT_SYMBOL_GPL(kvm_requeue_exception_e);
  389. /*
  390. * Checks if cpl <= required_cpl; if true, return true. Otherwise queue
  391. * a #GP and return false.
  392. */
  393. bool kvm_require_cpl(struct kvm_vcpu *vcpu, int required_cpl)
  394. {
  395. if (kvm_x86_ops->get_cpl(vcpu) <= required_cpl)
  396. return true;
  397. kvm_queue_exception_e(vcpu, GP_VECTOR, 0);
  398. return false;
  399. }
  400. EXPORT_SYMBOL_GPL(kvm_require_cpl);
  401. bool kvm_require_dr(struct kvm_vcpu *vcpu, int dr)
  402. {
  403. if ((dr != 4 && dr != 5) || !kvm_read_cr4_bits(vcpu, X86_CR4_DE))
  404. return true;
  405. kvm_queue_exception(vcpu, UD_VECTOR);
  406. return false;
  407. }
  408. EXPORT_SYMBOL_GPL(kvm_require_dr);
  409. /*
  410. * This function will be used to read from the physical memory of the currently
  411. * running guest. The difference to kvm_read_guest_page is that this function
  412. * can read from guest physical or from the guest's guest physical memory.
  413. */
  414. int kvm_read_guest_page_mmu(struct kvm_vcpu *vcpu, struct kvm_mmu *mmu,
  415. gfn_t ngfn, void *data, int offset, int len,
  416. u32 access)
  417. {
  418. struct x86_exception exception;
  419. gfn_t real_gfn;
  420. gpa_t ngpa;
  421. ngpa = gfn_to_gpa(ngfn);
  422. real_gfn = mmu->translate_gpa(vcpu, ngpa, access, &exception);
  423. if (real_gfn == UNMAPPED_GVA)
  424. return -EFAULT;
  425. real_gfn = gpa_to_gfn(real_gfn);
  426. return kvm_read_guest_page(vcpu->kvm, real_gfn, data, offset, len);
  427. }
  428. EXPORT_SYMBOL_GPL(kvm_read_guest_page_mmu);
  429. static int kvm_read_nested_guest_page(struct kvm_vcpu *vcpu, gfn_t gfn,
  430. void *data, int offset, int len, u32 access)
  431. {
  432. return kvm_read_guest_page_mmu(vcpu, vcpu->arch.walk_mmu, gfn,
  433. data, offset, len, access);
  434. }
  435. /*
  436. * Load the pae pdptrs. Return true is they are all valid.
  437. */
  438. int load_pdptrs(struct kvm_vcpu *vcpu, struct kvm_mmu *mmu, unsigned long cr3)
  439. {
  440. gfn_t pdpt_gfn = cr3 >> PAGE_SHIFT;
  441. unsigned offset = ((cr3 & (PAGE_SIZE-1)) >> 5) << 2;
  442. int i;
  443. int ret;
  444. u64 pdpte[ARRAY_SIZE(mmu->pdptrs)];
  445. ret = kvm_read_guest_page_mmu(vcpu, mmu, pdpt_gfn, pdpte,
  446. offset * sizeof(u64), sizeof(pdpte),
  447. PFERR_USER_MASK|PFERR_WRITE_MASK);
  448. if (ret < 0) {
  449. ret = 0;
  450. goto out;
  451. }
  452. for (i = 0; i < ARRAY_SIZE(pdpte); ++i) {
  453. if (is_present_gpte(pdpte[i]) &&
  454. (pdpte[i] & vcpu->arch.mmu.rsvd_bits_mask[0][2])) {
  455. ret = 0;
  456. goto out;
  457. }
  458. }
  459. ret = 1;
  460. memcpy(mmu->pdptrs, pdpte, sizeof(mmu->pdptrs));
  461. __set_bit(VCPU_EXREG_PDPTR,
  462. (unsigned long *)&vcpu->arch.regs_avail);
  463. __set_bit(VCPU_EXREG_PDPTR,
  464. (unsigned long *)&vcpu->arch.regs_dirty);
  465. out:
  466. return ret;
  467. }
  468. EXPORT_SYMBOL_GPL(load_pdptrs);
  469. static bool pdptrs_changed(struct kvm_vcpu *vcpu)
  470. {
  471. u64 pdpte[ARRAY_SIZE(vcpu->arch.walk_mmu->pdptrs)];
  472. bool changed = true;
  473. int offset;
  474. gfn_t gfn;
  475. int r;
  476. if (is_long_mode(vcpu) || !is_pae(vcpu))
  477. return false;
  478. if (!test_bit(VCPU_EXREG_PDPTR,
  479. (unsigned long *)&vcpu->arch.regs_avail))
  480. return true;
  481. gfn = (kvm_read_cr3(vcpu) & ~31u) >> PAGE_SHIFT;
  482. offset = (kvm_read_cr3(vcpu) & ~31u) & (PAGE_SIZE - 1);
  483. r = kvm_read_nested_guest_page(vcpu, gfn, pdpte, offset, sizeof(pdpte),
  484. PFERR_USER_MASK | PFERR_WRITE_MASK);
  485. if (r < 0)
  486. goto out;
  487. changed = memcmp(pdpte, vcpu->arch.walk_mmu->pdptrs, sizeof(pdpte)) != 0;
  488. out:
  489. return changed;
  490. }
  491. int kvm_set_cr0(struct kvm_vcpu *vcpu, unsigned long cr0)
  492. {
  493. unsigned long old_cr0 = kvm_read_cr0(vcpu);
  494. unsigned long update_bits = X86_CR0_PG | X86_CR0_WP |
  495. X86_CR0_CD | X86_CR0_NW;
  496. cr0 |= X86_CR0_ET;
  497. #ifdef CONFIG_X86_64
  498. if (cr0 & 0xffffffff00000000UL)
  499. return 1;
  500. #endif
  501. cr0 &= ~CR0_RESERVED_BITS;
  502. if ((cr0 & X86_CR0_NW) && !(cr0 & X86_CR0_CD))
  503. return 1;
  504. if ((cr0 & X86_CR0_PG) && !(cr0 & X86_CR0_PE))
  505. return 1;
  506. if (!is_paging(vcpu) && (cr0 & X86_CR0_PG)) {
  507. #ifdef CONFIG_X86_64
  508. if ((vcpu->arch.efer & EFER_LME)) {
  509. int cs_db, cs_l;
  510. if (!is_pae(vcpu))
  511. return 1;
  512. kvm_x86_ops->get_cs_db_l_bits(vcpu, &cs_db, &cs_l);
  513. if (cs_l)
  514. return 1;
  515. } else
  516. #endif
  517. if (is_pae(vcpu) && !load_pdptrs(vcpu, vcpu->arch.walk_mmu,
  518. kvm_read_cr3(vcpu)))
  519. return 1;
  520. }
  521. if (!(cr0 & X86_CR0_PG) && kvm_read_cr4_bits(vcpu, X86_CR4_PCIDE))
  522. return 1;
  523. kvm_x86_ops->set_cr0(vcpu, cr0);
  524. if ((cr0 ^ old_cr0) & X86_CR0_PG) {
  525. kvm_clear_async_pf_completion_queue(vcpu);
  526. kvm_async_pf_hash_reset(vcpu);
  527. }
  528. if ((cr0 ^ old_cr0) & update_bits)
  529. kvm_mmu_reset_context(vcpu);
  530. return 0;
  531. }
  532. EXPORT_SYMBOL_GPL(kvm_set_cr0);
  533. void kvm_lmsw(struct kvm_vcpu *vcpu, unsigned long msw)
  534. {
  535. (void)kvm_set_cr0(vcpu, kvm_read_cr0_bits(vcpu, ~0x0eul) | (msw & 0x0f));
  536. }
  537. EXPORT_SYMBOL_GPL(kvm_lmsw);
  538. static void kvm_load_guest_xcr0(struct kvm_vcpu *vcpu)
  539. {
  540. if (kvm_read_cr4_bits(vcpu, X86_CR4_OSXSAVE) &&
  541. !vcpu->guest_xcr0_loaded) {
  542. /* kvm_set_xcr() also depends on this */
  543. xsetbv(XCR_XFEATURE_ENABLED_MASK, vcpu->arch.xcr0);
  544. vcpu->guest_xcr0_loaded = 1;
  545. }
  546. }
  547. static void kvm_put_guest_xcr0(struct kvm_vcpu *vcpu)
  548. {
  549. if (vcpu->guest_xcr0_loaded) {
  550. if (vcpu->arch.xcr0 != host_xcr0)
  551. xsetbv(XCR_XFEATURE_ENABLED_MASK, host_xcr0);
  552. vcpu->guest_xcr0_loaded = 0;
  553. }
  554. }
  555. static int __kvm_set_xcr(struct kvm_vcpu *vcpu, u32 index, u64 xcr)
  556. {
  557. u64 xcr0 = xcr;
  558. u64 old_xcr0 = vcpu->arch.xcr0;
  559. u64 valid_bits;
  560. /* Only support XCR_XFEATURE_ENABLED_MASK(xcr0) now */
  561. if (index != XCR_XFEATURE_ENABLED_MASK)
  562. return 1;
  563. if (!(xcr0 & XSTATE_FP))
  564. return 1;
  565. if ((xcr0 & XSTATE_YMM) && !(xcr0 & XSTATE_SSE))
  566. return 1;
  567. /*
  568. * Do not allow the guest to set bits that we do not support
  569. * saving. However, xcr0 bit 0 is always set, even if the
  570. * emulated CPU does not support XSAVE (see fx_init).
  571. */
  572. valid_bits = vcpu->arch.guest_supported_xcr0 | XSTATE_FP;
  573. if (xcr0 & ~valid_bits)
  574. return 1;
  575. if ((!(xcr0 & XSTATE_BNDREGS)) != (!(xcr0 & XSTATE_BNDCSR)))
  576. return 1;
  577. if (xcr0 & XSTATE_AVX512) {
  578. if (!(xcr0 & XSTATE_YMM))
  579. return 1;
  580. if ((xcr0 & XSTATE_AVX512) != XSTATE_AVX512)
  581. return 1;
  582. }
  583. kvm_put_guest_xcr0(vcpu);
  584. vcpu->arch.xcr0 = xcr0;
  585. if ((xcr0 ^ old_xcr0) & XSTATE_EXTEND_MASK)
  586. kvm_update_cpuid(vcpu);
  587. return 0;
  588. }
  589. int kvm_set_xcr(struct kvm_vcpu *vcpu, u32 index, u64 xcr)
  590. {
  591. if (kvm_x86_ops->get_cpl(vcpu) != 0 ||
  592. __kvm_set_xcr(vcpu, index, xcr)) {
  593. kvm_inject_gp(vcpu, 0);
  594. return 1;
  595. }
  596. return 0;
  597. }
  598. EXPORT_SYMBOL_GPL(kvm_set_xcr);
  599. int kvm_set_cr4(struct kvm_vcpu *vcpu, unsigned long cr4)
  600. {
  601. unsigned long old_cr4 = kvm_read_cr4(vcpu);
  602. unsigned long pdptr_bits = X86_CR4_PGE | X86_CR4_PSE |
  603. X86_CR4_PAE | X86_CR4_SMEP;
  604. if (cr4 & CR4_RESERVED_BITS)
  605. return 1;
  606. if (!guest_cpuid_has_xsave(vcpu) && (cr4 & X86_CR4_OSXSAVE))
  607. return 1;
  608. if (!guest_cpuid_has_smep(vcpu) && (cr4 & X86_CR4_SMEP))
  609. return 1;
  610. if (!guest_cpuid_has_smap(vcpu) && (cr4 & X86_CR4_SMAP))
  611. return 1;
  612. if (!guest_cpuid_has_fsgsbase(vcpu) && (cr4 & X86_CR4_FSGSBASE))
  613. return 1;
  614. if (is_long_mode(vcpu)) {
  615. if (!(cr4 & X86_CR4_PAE))
  616. return 1;
  617. } else if (is_paging(vcpu) && (cr4 & X86_CR4_PAE)
  618. && ((cr4 ^ old_cr4) & pdptr_bits)
  619. && !load_pdptrs(vcpu, vcpu->arch.walk_mmu,
  620. kvm_read_cr3(vcpu)))
  621. return 1;
  622. if ((cr4 & X86_CR4_PCIDE) && !(old_cr4 & X86_CR4_PCIDE)) {
  623. if (!guest_cpuid_has_pcid(vcpu))
  624. return 1;
  625. /* PCID can not be enabled when cr3[11:0]!=000H or EFER.LMA=0 */
  626. if ((kvm_read_cr3(vcpu) & X86_CR3_PCID_MASK) || !is_long_mode(vcpu))
  627. return 1;
  628. }
  629. if (kvm_x86_ops->set_cr4(vcpu, cr4))
  630. return 1;
  631. if (((cr4 ^ old_cr4) & pdptr_bits) ||
  632. (!(cr4 & X86_CR4_PCIDE) && (old_cr4 & X86_CR4_PCIDE)))
  633. kvm_mmu_reset_context(vcpu);
  634. if ((cr4 ^ old_cr4) & X86_CR4_SMAP)
  635. update_permission_bitmask(vcpu, vcpu->arch.walk_mmu, false);
  636. if ((cr4 ^ old_cr4) & X86_CR4_OSXSAVE)
  637. kvm_update_cpuid(vcpu);
  638. return 0;
  639. }
  640. EXPORT_SYMBOL_GPL(kvm_set_cr4);
  641. int kvm_set_cr3(struct kvm_vcpu *vcpu, unsigned long cr3)
  642. {
  643. #ifdef CONFIG_X86_64
  644. cr3 &= ~CR3_PCID_INVD;
  645. #endif
  646. if (cr3 == kvm_read_cr3(vcpu) && !pdptrs_changed(vcpu)) {
  647. kvm_mmu_sync_roots(vcpu);
  648. kvm_make_request(KVM_REQ_TLB_FLUSH, vcpu);
  649. return 0;
  650. }
  651. if (is_long_mode(vcpu)) {
  652. if (cr3 & CR3_L_MODE_RESERVED_BITS)
  653. return 1;
  654. } else if (is_pae(vcpu) && is_paging(vcpu) &&
  655. !load_pdptrs(vcpu, vcpu->arch.walk_mmu, cr3))
  656. return 1;
  657. vcpu->arch.cr3 = cr3;
  658. __set_bit(VCPU_EXREG_CR3, (ulong *)&vcpu->arch.regs_avail);
  659. kvm_mmu_new_cr3(vcpu);
  660. return 0;
  661. }
  662. EXPORT_SYMBOL_GPL(kvm_set_cr3);
  663. int kvm_set_cr8(struct kvm_vcpu *vcpu, unsigned long cr8)
  664. {
  665. if (cr8 & CR8_RESERVED_BITS)
  666. return 1;
  667. if (irqchip_in_kernel(vcpu->kvm))
  668. kvm_lapic_set_tpr(vcpu, cr8);
  669. else
  670. vcpu->arch.cr8 = cr8;
  671. return 0;
  672. }
  673. EXPORT_SYMBOL_GPL(kvm_set_cr8);
  674. unsigned long kvm_get_cr8(struct kvm_vcpu *vcpu)
  675. {
  676. if (irqchip_in_kernel(vcpu->kvm))
  677. return kvm_lapic_get_cr8(vcpu);
  678. else
  679. return vcpu->arch.cr8;
  680. }
  681. EXPORT_SYMBOL_GPL(kvm_get_cr8);
  682. static void kvm_update_dr0123(struct kvm_vcpu *vcpu)
  683. {
  684. int i;
  685. if (!(vcpu->guest_debug & KVM_GUESTDBG_USE_HW_BP)) {
  686. for (i = 0; i < KVM_NR_DB_REGS; i++)
  687. vcpu->arch.eff_db[i] = vcpu->arch.db[i];
  688. vcpu->arch.switch_db_regs |= KVM_DEBUGREG_RELOAD;
  689. }
  690. }
  691. static void kvm_update_dr6(struct kvm_vcpu *vcpu)
  692. {
  693. if (!(vcpu->guest_debug & KVM_GUESTDBG_USE_HW_BP))
  694. kvm_x86_ops->set_dr6(vcpu, vcpu->arch.dr6);
  695. }
  696. static void kvm_update_dr7(struct kvm_vcpu *vcpu)
  697. {
  698. unsigned long dr7;
  699. if (vcpu->guest_debug & KVM_GUESTDBG_USE_HW_BP)
  700. dr7 = vcpu->arch.guest_debug_dr7;
  701. else
  702. dr7 = vcpu->arch.dr7;
  703. kvm_x86_ops->set_dr7(vcpu, dr7);
  704. vcpu->arch.switch_db_regs &= ~KVM_DEBUGREG_BP_ENABLED;
  705. if (dr7 & DR7_BP_EN_MASK)
  706. vcpu->arch.switch_db_regs |= KVM_DEBUGREG_BP_ENABLED;
  707. }
  708. static u64 kvm_dr6_fixed(struct kvm_vcpu *vcpu)
  709. {
  710. u64 fixed = DR6_FIXED_1;
  711. if (!guest_cpuid_has_rtm(vcpu))
  712. fixed |= DR6_RTM;
  713. return fixed;
  714. }
  715. static int __kvm_set_dr(struct kvm_vcpu *vcpu, int dr, unsigned long val)
  716. {
  717. switch (dr) {
  718. case 0 ... 3:
  719. vcpu->arch.db[dr] = val;
  720. if (!(vcpu->guest_debug & KVM_GUESTDBG_USE_HW_BP))
  721. vcpu->arch.eff_db[dr] = val;
  722. break;
  723. case 4:
  724. /* fall through */
  725. case 6:
  726. if (val & 0xffffffff00000000ULL)
  727. return -1; /* #GP */
  728. vcpu->arch.dr6 = (val & DR6_VOLATILE) | kvm_dr6_fixed(vcpu);
  729. kvm_update_dr6(vcpu);
  730. break;
  731. case 5:
  732. /* fall through */
  733. default: /* 7 */
  734. if (val & 0xffffffff00000000ULL)
  735. return -1; /* #GP */
  736. vcpu->arch.dr7 = (val & DR7_VOLATILE) | DR7_FIXED_1;
  737. kvm_update_dr7(vcpu);
  738. break;
  739. }
  740. return 0;
  741. }
  742. int kvm_set_dr(struct kvm_vcpu *vcpu, int dr, unsigned long val)
  743. {
  744. if (__kvm_set_dr(vcpu, dr, val)) {
  745. kvm_inject_gp(vcpu, 0);
  746. return 1;
  747. }
  748. return 0;
  749. }
  750. EXPORT_SYMBOL_GPL(kvm_set_dr);
  751. int kvm_get_dr(struct kvm_vcpu *vcpu, int dr, unsigned long *val)
  752. {
  753. switch (dr) {
  754. case 0 ... 3:
  755. *val = vcpu->arch.db[dr];
  756. break;
  757. case 4:
  758. /* fall through */
  759. case 6:
  760. if (vcpu->guest_debug & KVM_GUESTDBG_USE_HW_BP)
  761. *val = vcpu->arch.dr6;
  762. else
  763. *val = kvm_x86_ops->get_dr6(vcpu);
  764. break;
  765. case 5:
  766. /* fall through */
  767. default: /* 7 */
  768. *val = vcpu->arch.dr7;
  769. break;
  770. }
  771. return 0;
  772. }
  773. EXPORT_SYMBOL_GPL(kvm_get_dr);
  774. bool kvm_rdpmc(struct kvm_vcpu *vcpu)
  775. {
  776. u32 ecx = kvm_register_read(vcpu, VCPU_REGS_RCX);
  777. u64 data;
  778. int err;
  779. err = kvm_pmu_read_pmc(vcpu, ecx, &data);
  780. if (err)
  781. return err;
  782. kvm_register_write(vcpu, VCPU_REGS_RAX, (u32)data);
  783. kvm_register_write(vcpu, VCPU_REGS_RDX, data >> 32);
  784. return err;
  785. }
  786. EXPORT_SYMBOL_GPL(kvm_rdpmc);
  787. /*
  788. * List of msr numbers which we expose to userspace through KVM_GET_MSRS
  789. * and KVM_SET_MSRS, and KVM_GET_MSR_INDEX_LIST.
  790. *
  791. * This list is modified at module load time to reflect the
  792. * capabilities of the host cpu. This capabilities test skips MSRs that are
  793. * kvm-specific. Those are put in the beginning of the list.
  794. */
  795. #define KVM_SAVE_MSRS_BEGIN 12
  796. static u32 msrs_to_save[] = {
  797. MSR_KVM_SYSTEM_TIME, MSR_KVM_WALL_CLOCK,
  798. MSR_KVM_SYSTEM_TIME_NEW, MSR_KVM_WALL_CLOCK_NEW,
  799. HV_X64_MSR_GUEST_OS_ID, HV_X64_MSR_HYPERCALL,
  800. HV_X64_MSR_TIME_REF_COUNT, HV_X64_MSR_REFERENCE_TSC,
  801. HV_X64_MSR_APIC_ASSIST_PAGE, MSR_KVM_ASYNC_PF_EN, MSR_KVM_STEAL_TIME,
  802. MSR_KVM_PV_EOI_EN,
  803. MSR_IA32_SYSENTER_CS, MSR_IA32_SYSENTER_ESP, MSR_IA32_SYSENTER_EIP,
  804. MSR_STAR,
  805. #ifdef CONFIG_X86_64
  806. MSR_CSTAR, MSR_KERNEL_GS_BASE, MSR_SYSCALL_MASK, MSR_LSTAR,
  807. #endif
  808. MSR_IA32_TSC, MSR_IA32_CR_PAT, MSR_VM_HSAVE_PA,
  809. MSR_IA32_FEATURE_CONTROL, MSR_IA32_BNDCFGS
  810. };
  811. static unsigned num_msrs_to_save;
  812. static const u32 emulated_msrs[] = {
  813. MSR_IA32_TSC_ADJUST,
  814. MSR_IA32_TSCDEADLINE,
  815. MSR_IA32_MISC_ENABLE,
  816. MSR_IA32_MCG_STATUS,
  817. MSR_IA32_MCG_CTL,
  818. };
  819. bool kvm_valid_efer(struct kvm_vcpu *vcpu, u64 efer)
  820. {
  821. if (efer & efer_reserved_bits)
  822. return false;
  823. if (efer & EFER_FFXSR) {
  824. struct kvm_cpuid_entry2 *feat;
  825. feat = kvm_find_cpuid_entry(vcpu, 0x80000001, 0);
  826. if (!feat || !(feat->edx & bit(X86_FEATURE_FXSR_OPT)))
  827. return false;
  828. }
  829. if (efer & EFER_SVME) {
  830. struct kvm_cpuid_entry2 *feat;
  831. feat = kvm_find_cpuid_entry(vcpu, 0x80000001, 0);
  832. if (!feat || !(feat->ecx & bit(X86_FEATURE_SVM)))
  833. return false;
  834. }
  835. return true;
  836. }
  837. EXPORT_SYMBOL_GPL(kvm_valid_efer);
  838. static int set_efer(struct kvm_vcpu *vcpu, u64 efer)
  839. {
  840. u64 old_efer = vcpu->arch.efer;
  841. if (!kvm_valid_efer(vcpu, efer))
  842. return 1;
  843. if (is_paging(vcpu)
  844. && (vcpu->arch.efer & EFER_LME) != (efer & EFER_LME))
  845. return 1;
  846. efer &= ~EFER_LMA;
  847. efer |= vcpu->arch.efer & EFER_LMA;
  848. kvm_x86_ops->set_efer(vcpu, efer);
  849. /* Update reserved bits */
  850. if ((efer ^ old_efer) & EFER_NX)
  851. kvm_mmu_reset_context(vcpu);
  852. return 0;
  853. }
  854. void kvm_enable_efer_bits(u64 mask)
  855. {
  856. efer_reserved_bits &= ~mask;
  857. }
  858. EXPORT_SYMBOL_GPL(kvm_enable_efer_bits);
  859. /*
  860. * Writes msr value into into the appropriate "register".
  861. * Returns 0 on success, non-0 otherwise.
  862. * Assumes vcpu_load() was already called.
  863. */
  864. int kvm_set_msr(struct kvm_vcpu *vcpu, struct msr_data *msr)
  865. {
  866. switch (msr->index) {
  867. case MSR_FS_BASE:
  868. case MSR_GS_BASE:
  869. case MSR_KERNEL_GS_BASE:
  870. case MSR_CSTAR:
  871. case MSR_LSTAR:
  872. if (is_noncanonical_address(msr->data))
  873. return 1;
  874. break;
  875. case MSR_IA32_SYSENTER_EIP:
  876. case MSR_IA32_SYSENTER_ESP:
  877. /*
  878. * IA32_SYSENTER_ESP and IA32_SYSENTER_EIP cause #GP if
  879. * non-canonical address is written on Intel but not on
  880. * AMD (which ignores the top 32-bits, because it does
  881. * not implement 64-bit SYSENTER).
  882. *
  883. * 64-bit code should hence be able to write a non-canonical
  884. * value on AMD. Making the address canonical ensures that
  885. * vmentry does not fail on Intel after writing a non-canonical
  886. * value, and that something deterministic happens if the guest
  887. * invokes 64-bit SYSENTER.
  888. */
  889. msr->data = get_canonical(msr->data);
  890. }
  891. return kvm_x86_ops->set_msr(vcpu, msr);
  892. }
  893. EXPORT_SYMBOL_GPL(kvm_set_msr);
  894. /*
  895. * Adapt set_msr() to msr_io()'s calling convention
  896. */
  897. static int do_set_msr(struct kvm_vcpu *vcpu, unsigned index, u64 *data)
  898. {
  899. struct msr_data msr;
  900. msr.data = *data;
  901. msr.index = index;
  902. msr.host_initiated = true;
  903. return kvm_set_msr(vcpu, &msr);
  904. }
  905. #ifdef CONFIG_X86_64
  906. struct pvclock_gtod_data {
  907. seqcount_t seq;
  908. struct { /* extract of a clocksource struct */
  909. int vclock_mode;
  910. cycle_t cycle_last;
  911. cycle_t mask;
  912. u32 mult;
  913. u32 shift;
  914. } clock;
  915. u64 boot_ns;
  916. u64 nsec_base;
  917. };
  918. static struct pvclock_gtod_data pvclock_gtod_data;
  919. static void update_pvclock_gtod(struct timekeeper *tk)
  920. {
  921. struct pvclock_gtod_data *vdata = &pvclock_gtod_data;
  922. u64 boot_ns;
  923. boot_ns = ktime_to_ns(ktime_add(tk->tkr_mono.base, tk->offs_boot));
  924. write_seqcount_begin(&vdata->seq);
  925. /* copy pvclock gtod data */
  926. vdata->clock.vclock_mode = tk->tkr_mono.clock->archdata.vclock_mode;
  927. vdata->clock.cycle_last = tk->tkr_mono.cycle_last;
  928. vdata->clock.mask = tk->tkr_mono.mask;
  929. vdata->clock.mult = tk->tkr_mono.mult;
  930. vdata->clock.shift = tk->tkr_mono.shift;
  931. vdata->boot_ns = boot_ns;
  932. vdata->nsec_base = tk->tkr_mono.xtime_nsec;
  933. write_seqcount_end(&vdata->seq);
  934. }
  935. #endif
  936. void kvm_set_pending_timer(struct kvm_vcpu *vcpu)
  937. {
  938. /*
  939. * Note: KVM_REQ_PENDING_TIMER is implicitly checked in
  940. * vcpu_enter_guest. This function is only called from
  941. * the physical CPU that is running vcpu.
  942. */
  943. kvm_make_request(KVM_REQ_PENDING_TIMER, vcpu);
  944. }
  945. static void kvm_write_wall_clock(struct kvm *kvm, gpa_t wall_clock)
  946. {
  947. int version;
  948. int r;
  949. struct pvclock_wall_clock wc;
  950. struct timespec boot;
  951. if (!wall_clock)
  952. return;
  953. r = kvm_read_guest(kvm, wall_clock, &version, sizeof(version));
  954. if (r)
  955. return;
  956. if (version & 1)
  957. ++version; /* first time write, random junk */
  958. ++version;
  959. kvm_write_guest(kvm, wall_clock, &version, sizeof(version));
  960. /*
  961. * The guest calculates current wall clock time by adding
  962. * system time (updated by kvm_guest_time_update below) to the
  963. * wall clock specified here. guest system time equals host
  964. * system time for us, thus we must fill in host boot time here.
  965. */
  966. getboottime(&boot);
  967. if (kvm->arch.kvmclock_offset) {
  968. struct timespec ts = ns_to_timespec(kvm->arch.kvmclock_offset);
  969. boot = timespec_sub(boot, ts);
  970. }
  971. wc.sec = boot.tv_sec;
  972. wc.nsec = boot.tv_nsec;
  973. wc.version = version;
  974. kvm_write_guest(kvm, wall_clock, &wc, sizeof(wc));
  975. version++;
  976. kvm_write_guest(kvm, wall_clock, &version, sizeof(version));
  977. }
  978. static uint32_t div_frac(uint32_t dividend, uint32_t divisor)
  979. {
  980. uint32_t quotient, remainder;
  981. /* Don't try to replace with do_div(), this one calculates
  982. * "(dividend << 32) / divisor" */
  983. __asm__ ( "divl %4"
  984. : "=a" (quotient), "=d" (remainder)
  985. : "0" (0), "1" (dividend), "r" (divisor) );
  986. return quotient;
  987. }
  988. static void kvm_get_time_scale(uint32_t scaled_khz, uint32_t base_khz,
  989. s8 *pshift, u32 *pmultiplier)
  990. {
  991. uint64_t scaled64;
  992. int32_t shift = 0;
  993. uint64_t tps64;
  994. uint32_t tps32;
  995. tps64 = base_khz * 1000LL;
  996. scaled64 = scaled_khz * 1000LL;
  997. while (tps64 > scaled64*2 || tps64 & 0xffffffff00000000ULL) {
  998. tps64 >>= 1;
  999. shift--;
  1000. }
  1001. tps32 = (uint32_t)tps64;
  1002. while (tps32 <= scaled64 || scaled64 & 0xffffffff00000000ULL) {
  1003. if (scaled64 & 0xffffffff00000000ULL || tps32 & 0x80000000)
  1004. scaled64 >>= 1;
  1005. else
  1006. tps32 <<= 1;
  1007. shift++;
  1008. }
  1009. *pshift = shift;
  1010. *pmultiplier = div_frac(scaled64, tps32);
  1011. pr_debug("%s: base_khz %u => %u, shift %d, mul %u\n",
  1012. __func__, base_khz, scaled_khz, shift, *pmultiplier);
  1013. }
  1014. static inline u64 get_kernel_ns(void)
  1015. {
  1016. return ktime_get_boot_ns();
  1017. }
  1018. #ifdef CONFIG_X86_64
  1019. static atomic_t kvm_guest_has_master_clock = ATOMIC_INIT(0);
  1020. #endif
  1021. static DEFINE_PER_CPU(unsigned long, cpu_tsc_khz);
  1022. static unsigned long max_tsc_khz;
  1023. static inline u64 nsec_to_cycles(struct kvm_vcpu *vcpu, u64 nsec)
  1024. {
  1025. return pvclock_scale_delta(nsec, vcpu->arch.virtual_tsc_mult,
  1026. vcpu->arch.virtual_tsc_shift);
  1027. }
  1028. static u32 adjust_tsc_khz(u32 khz, s32 ppm)
  1029. {
  1030. u64 v = (u64)khz * (1000000 + ppm);
  1031. do_div(v, 1000000);
  1032. return v;
  1033. }
  1034. static void kvm_set_tsc_khz(struct kvm_vcpu *vcpu, u32 this_tsc_khz)
  1035. {
  1036. u32 thresh_lo, thresh_hi;
  1037. int use_scaling = 0;
  1038. /* tsc_khz can be zero if TSC calibration fails */
  1039. if (this_tsc_khz == 0)
  1040. return;
  1041. /* Compute a scale to convert nanoseconds in TSC cycles */
  1042. kvm_get_time_scale(this_tsc_khz, NSEC_PER_SEC / 1000,
  1043. &vcpu->arch.virtual_tsc_shift,
  1044. &vcpu->arch.virtual_tsc_mult);
  1045. vcpu->arch.virtual_tsc_khz = this_tsc_khz;
  1046. /*
  1047. * Compute the variation in TSC rate which is acceptable
  1048. * within the range of tolerance and decide if the
  1049. * rate being applied is within that bounds of the hardware
  1050. * rate. If so, no scaling or compensation need be done.
  1051. */
  1052. thresh_lo = adjust_tsc_khz(tsc_khz, -tsc_tolerance_ppm);
  1053. thresh_hi = adjust_tsc_khz(tsc_khz, tsc_tolerance_ppm);
  1054. if (this_tsc_khz < thresh_lo || this_tsc_khz > thresh_hi) {
  1055. pr_debug("kvm: requested TSC rate %u falls outside tolerance [%u,%u]\n", this_tsc_khz, thresh_lo, thresh_hi);
  1056. use_scaling = 1;
  1057. }
  1058. kvm_x86_ops->set_tsc_khz(vcpu, this_tsc_khz, use_scaling);
  1059. }
  1060. static u64 compute_guest_tsc(struct kvm_vcpu *vcpu, s64 kernel_ns)
  1061. {
  1062. u64 tsc = pvclock_scale_delta(kernel_ns-vcpu->arch.this_tsc_nsec,
  1063. vcpu->arch.virtual_tsc_mult,
  1064. vcpu->arch.virtual_tsc_shift);
  1065. tsc += vcpu->arch.this_tsc_write;
  1066. return tsc;
  1067. }
  1068. static void kvm_track_tsc_matching(struct kvm_vcpu *vcpu)
  1069. {
  1070. #ifdef CONFIG_X86_64
  1071. bool vcpus_matched;
  1072. struct kvm_arch *ka = &vcpu->kvm->arch;
  1073. struct pvclock_gtod_data *gtod = &pvclock_gtod_data;
  1074. vcpus_matched = (ka->nr_vcpus_matched_tsc + 1 ==
  1075. atomic_read(&vcpu->kvm->online_vcpus));
  1076. /*
  1077. * Once the masterclock is enabled, always perform request in
  1078. * order to update it.
  1079. *
  1080. * In order to enable masterclock, the host clocksource must be TSC
  1081. * and the vcpus need to have matched TSCs. When that happens,
  1082. * perform request to enable masterclock.
  1083. */
  1084. if (ka->use_master_clock ||
  1085. (gtod->clock.vclock_mode == VCLOCK_TSC && vcpus_matched))
  1086. kvm_make_request(KVM_REQ_MASTERCLOCK_UPDATE, vcpu);
  1087. trace_kvm_track_tsc(vcpu->vcpu_id, ka->nr_vcpus_matched_tsc,
  1088. atomic_read(&vcpu->kvm->online_vcpus),
  1089. ka->use_master_clock, gtod->clock.vclock_mode);
  1090. #endif
  1091. }
  1092. static void update_ia32_tsc_adjust_msr(struct kvm_vcpu *vcpu, s64 offset)
  1093. {
  1094. u64 curr_offset = kvm_x86_ops->read_tsc_offset(vcpu);
  1095. vcpu->arch.ia32_tsc_adjust_msr += offset - curr_offset;
  1096. }
  1097. void kvm_write_tsc(struct kvm_vcpu *vcpu, struct msr_data *msr)
  1098. {
  1099. struct kvm *kvm = vcpu->kvm;
  1100. u64 offset, ns, elapsed;
  1101. unsigned long flags;
  1102. s64 usdiff;
  1103. bool matched;
  1104. bool already_matched;
  1105. u64 data = msr->data;
  1106. raw_spin_lock_irqsave(&kvm->arch.tsc_write_lock, flags);
  1107. offset = kvm_x86_ops->compute_tsc_offset(vcpu, data);
  1108. ns = get_kernel_ns();
  1109. elapsed = ns - kvm->arch.last_tsc_nsec;
  1110. if (vcpu->arch.virtual_tsc_khz) {
  1111. int faulted = 0;
  1112. /* n.b - signed multiplication and division required */
  1113. usdiff = data - kvm->arch.last_tsc_write;
  1114. #ifdef CONFIG_X86_64
  1115. usdiff = (usdiff * 1000) / vcpu->arch.virtual_tsc_khz;
  1116. #else
  1117. /* do_div() only does unsigned */
  1118. asm("1: idivl %[divisor]\n"
  1119. "2: xor %%edx, %%edx\n"
  1120. " movl $0, %[faulted]\n"
  1121. "3:\n"
  1122. ".section .fixup,\"ax\"\n"
  1123. "4: movl $1, %[faulted]\n"
  1124. " jmp 3b\n"
  1125. ".previous\n"
  1126. _ASM_EXTABLE(1b, 4b)
  1127. : "=A"(usdiff), [faulted] "=r" (faulted)
  1128. : "A"(usdiff * 1000), [divisor] "rm"(vcpu->arch.virtual_tsc_khz));
  1129. #endif
  1130. do_div(elapsed, 1000);
  1131. usdiff -= elapsed;
  1132. if (usdiff < 0)
  1133. usdiff = -usdiff;
  1134. /* idivl overflow => difference is larger than USEC_PER_SEC */
  1135. if (faulted)
  1136. usdiff = USEC_PER_SEC;
  1137. } else
  1138. usdiff = USEC_PER_SEC; /* disable TSC match window below */
  1139. /*
  1140. * Special case: TSC write with a small delta (1 second) of virtual
  1141. * cycle time against real time is interpreted as an attempt to
  1142. * synchronize the CPU.
  1143. *
  1144. * For a reliable TSC, we can match TSC offsets, and for an unstable
  1145. * TSC, we add elapsed time in this computation. We could let the
  1146. * compensation code attempt to catch up if we fall behind, but
  1147. * it's better to try to match offsets from the beginning.
  1148. */
  1149. if (usdiff < USEC_PER_SEC &&
  1150. vcpu->arch.virtual_tsc_khz == kvm->arch.last_tsc_khz) {
  1151. if (!check_tsc_unstable()) {
  1152. offset = kvm->arch.cur_tsc_offset;
  1153. pr_debug("kvm: matched tsc offset for %llu\n", data);
  1154. } else {
  1155. u64 delta = nsec_to_cycles(vcpu, elapsed);
  1156. data += delta;
  1157. offset = kvm_x86_ops->compute_tsc_offset(vcpu, data);
  1158. pr_debug("kvm: adjusted tsc offset by %llu\n", delta);
  1159. }
  1160. matched = true;
  1161. already_matched = (vcpu->arch.this_tsc_generation == kvm->arch.cur_tsc_generation);
  1162. } else {
  1163. /*
  1164. * We split periods of matched TSC writes into generations.
  1165. * For each generation, we track the original measured
  1166. * nanosecond time, offset, and write, so if TSCs are in
  1167. * sync, we can match exact offset, and if not, we can match
  1168. * exact software computation in compute_guest_tsc()
  1169. *
  1170. * These values are tracked in kvm->arch.cur_xxx variables.
  1171. */
  1172. kvm->arch.cur_tsc_generation++;
  1173. kvm->arch.cur_tsc_nsec = ns;
  1174. kvm->arch.cur_tsc_write = data;
  1175. kvm->arch.cur_tsc_offset = offset;
  1176. matched = false;
  1177. pr_debug("kvm: new tsc generation %llu, clock %llu\n",
  1178. kvm->arch.cur_tsc_generation, data);
  1179. }
  1180. /*
  1181. * We also track th most recent recorded KHZ, write and time to
  1182. * allow the matching interval to be extended at each write.
  1183. */
  1184. kvm->arch.last_tsc_nsec = ns;
  1185. kvm->arch.last_tsc_write = data;
  1186. kvm->arch.last_tsc_khz = vcpu->arch.virtual_tsc_khz;
  1187. vcpu->arch.last_guest_tsc = data;
  1188. /* Keep track of which generation this VCPU has synchronized to */
  1189. vcpu->arch.this_tsc_generation = kvm->arch.cur_tsc_generation;
  1190. vcpu->arch.this_tsc_nsec = kvm->arch.cur_tsc_nsec;
  1191. vcpu->arch.this_tsc_write = kvm->arch.cur_tsc_write;
  1192. if (guest_cpuid_has_tsc_adjust(vcpu) && !msr->host_initiated)
  1193. update_ia32_tsc_adjust_msr(vcpu, offset);
  1194. kvm_x86_ops->write_tsc_offset(vcpu, offset);
  1195. raw_spin_unlock_irqrestore(&kvm->arch.tsc_write_lock, flags);
  1196. spin_lock(&kvm->arch.pvclock_gtod_sync_lock);
  1197. if (!matched) {
  1198. kvm->arch.nr_vcpus_matched_tsc = 0;
  1199. } else if (!already_matched) {
  1200. kvm->arch.nr_vcpus_matched_tsc++;
  1201. }
  1202. kvm_track_tsc_matching(vcpu);
  1203. spin_unlock(&kvm->arch.pvclock_gtod_sync_lock);
  1204. }
  1205. EXPORT_SYMBOL_GPL(kvm_write_tsc);
  1206. #ifdef CONFIG_X86_64
  1207. static cycle_t read_tsc(void)
  1208. {
  1209. cycle_t ret;
  1210. u64 last;
  1211. /*
  1212. * Empirically, a fence (of type that depends on the CPU)
  1213. * before rdtsc is enough to ensure that rdtsc is ordered
  1214. * with respect to loads. The various CPU manuals are unclear
  1215. * as to whether rdtsc can be reordered with later loads,
  1216. * but no one has ever seen it happen.
  1217. */
  1218. rdtsc_barrier();
  1219. ret = (cycle_t)vget_cycles();
  1220. last = pvclock_gtod_data.clock.cycle_last;
  1221. if (likely(ret >= last))
  1222. return ret;
  1223. /*
  1224. * GCC likes to generate cmov here, but this branch is extremely
  1225. * predictable (it's just a funciton of time and the likely is
  1226. * very likely) and there's a data dependence, so force GCC
  1227. * to generate a branch instead. I don't barrier() because
  1228. * we don't actually need a barrier, and if this function
  1229. * ever gets inlined it will generate worse code.
  1230. */
  1231. asm volatile ("");
  1232. return last;
  1233. }
  1234. static inline u64 vgettsc(cycle_t *cycle_now)
  1235. {
  1236. long v;
  1237. struct pvclock_gtod_data *gtod = &pvclock_gtod_data;
  1238. *cycle_now = read_tsc();
  1239. v = (*cycle_now - gtod->clock.cycle_last) & gtod->clock.mask;
  1240. return v * gtod->clock.mult;
  1241. }
  1242. static int do_monotonic_boot(s64 *t, cycle_t *cycle_now)
  1243. {
  1244. struct pvclock_gtod_data *gtod = &pvclock_gtod_data;
  1245. unsigned long seq;
  1246. int mode;
  1247. u64 ns;
  1248. do {
  1249. seq = read_seqcount_begin(&gtod->seq);
  1250. mode = gtod->clock.vclock_mode;
  1251. ns = gtod->nsec_base;
  1252. ns += vgettsc(cycle_now);
  1253. ns >>= gtod->clock.shift;
  1254. ns += gtod->boot_ns;
  1255. } while (unlikely(read_seqcount_retry(&gtod->seq, seq)));
  1256. *t = ns;
  1257. return mode;
  1258. }
  1259. /* returns true if host is using tsc clocksource */
  1260. static bool kvm_get_time_and_clockread(s64 *kernel_ns, cycle_t *cycle_now)
  1261. {
  1262. /* checked again under seqlock below */
  1263. if (pvclock_gtod_data.clock.vclock_mode != VCLOCK_TSC)
  1264. return false;
  1265. return do_monotonic_boot(kernel_ns, cycle_now) == VCLOCK_TSC;
  1266. }
  1267. #endif
  1268. /*
  1269. *
  1270. * Assuming a stable TSC across physical CPUS, and a stable TSC
  1271. * across virtual CPUs, the following condition is possible.
  1272. * Each numbered line represents an event visible to both
  1273. * CPUs at the next numbered event.
  1274. *
  1275. * "timespecX" represents host monotonic time. "tscX" represents
  1276. * RDTSC value.
  1277. *
  1278. * VCPU0 on CPU0 | VCPU1 on CPU1
  1279. *
  1280. * 1. read timespec0,tsc0
  1281. * 2. | timespec1 = timespec0 + N
  1282. * | tsc1 = tsc0 + M
  1283. * 3. transition to guest | transition to guest
  1284. * 4. ret0 = timespec0 + (rdtsc - tsc0) |
  1285. * 5. | ret1 = timespec1 + (rdtsc - tsc1)
  1286. * | ret1 = timespec0 + N + (rdtsc - (tsc0 + M))
  1287. *
  1288. * Since ret0 update is visible to VCPU1 at time 5, to obey monotonicity:
  1289. *
  1290. * - ret0 < ret1
  1291. * - timespec0 + (rdtsc - tsc0) < timespec0 + N + (rdtsc - (tsc0 + M))
  1292. * ...
  1293. * - 0 < N - M => M < N
  1294. *
  1295. * That is, when timespec0 != timespec1, M < N. Unfortunately that is not
  1296. * always the case (the difference between two distinct xtime instances
  1297. * might be smaller then the difference between corresponding TSC reads,
  1298. * when updating guest vcpus pvclock areas).
  1299. *
  1300. * To avoid that problem, do not allow visibility of distinct
  1301. * system_timestamp/tsc_timestamp values simultaneously: use a master
  1302. * copy of host monotonic time values. Update that master copy
  1303. * in lockstep.
  1304. *
  1305. * Rely on synchronization of host TSCs and guest TSCs for monotonicity.
  1306. *
  1307. */
  1308. static void pvclock_update_vm_gtod_copy(struct kvm *kvm)
  1309. {
  1310. #ifdef CONFIG_X86_64
  1311. struct kvm_arch *ka = &kvm->arch;
  1312. int vclock_mode;
  1313. bool host_tsc_clocksource, vcpus_matched;
  1314. vcpus_matched = (ka->nr_vcpus_matched_tsc + 1 ==
  1315. atomic_read(&kvm->online_vcpus));
  1316. /*
  1317. * If the host uses TSC clock, then passthrough TSC as stable
  1318. * to the guest.
  1319. */
  1320. host_tsc_clocksource = kvm_get_time_and_clockread(
  1321. &ka->master_kernel_ns,
  1322. &ka->master_cycle_now);
  1323. ka->use_master_clock = host_tsc_clocksource && vcpus_matched
  1324. && !backwards_tsc_observed
  1325. && !ka->boot_vcpu_runs_old_kvmclock;
  1326. if (ka->use_master_clock)
  1327. atomic_set(&kvm_guest_has_master_clock, 1);
  1328. vclock_mode = pvclock_gtod_data.clock.vclock_mode;
  1329. trace_kvm_update_master_clock(ka->use_master_clock, vclock_mode,
  1330. vcpus_matched);
  1331. #endif
  1332. }
  1333. static void kvm_gen_update_masterclock(struct kvm *kvm)
  1334. {
  1335. #ifdef CONFIG_X86_64
  1336. int i;
  1337. struct kvm_vcpu *vcpu;
  1338. struct kvm_arch *ka = &kvm->arch;
  1339. spin_lock(&ka->pvclock_gtod_sync_lock);
  1340. kvm_make_mclock_inprogress_request(kvm);
  1341. /* no guest entries from this point */
  1342. pvclock_update_vm_gtod_copy(kvm);
  1343. kvm_for_each_vcpu(i, vcpu, kvm)
  1344. kvm_make_request(KVM_REQ_CLOCK_UPDATE, vcpu);
  1345. /* guest entries allowed */
  1346. kvm_for_each_vcpu(i, vcpu, kvm)
  1347. clear_bit(KVM_REQ_MCLOCK_INPROGRESS, &vcpu->requests);
  1348. spin_unlock(&ka->pvclock_gtod_sync_lock);
  1349. #endif
  1350. }
  1351. static int kvm_guest_time_update(struct kvm_vcpu *v)
  1352. {
  1353. unsigned long flags, this_tsc_khz;
  1354. struct kvm_vcpu_arch *vcpu = &v->arch;
  1355. struct kvm_arch *ka = &v->kvm->arch;
  1356. s64 kernel_ns;
  1357. u64 tsc_timestamp, host_tsc;
  1358. struct pvclock_vcpu_time_info guest_hv_clock;
  1359. u8 pvclock_flags;
  1360. bool use_master_clock;
  1361. kernel_ns = 0;
  1362. host_tsc = 0;
  1363. /*
  1364. * If the host uses TSC clock, then passthrough TSC as stable
  1365. * to the guest.
  1366. */
  1367. spin_lock(&ka->pvclock_gtod_sync_lock);
  1368. use_master_clock = ka->use_master_clock;
  1369. if (use_master_clock) {
  1370. host_tsc = ka->master_cycle_now;
  1371. kernel_ns = ka->master_kernel_ns;
  1372. }
  1373. spin_unlock(&ka->pvclock_gtod_sync_lock);
  1374. /* Keep irq disabled to prevent changes to the clock */
  1375. local_irq_save(flags);
  1376. this_tsc_khz = __this_cpu_read(cpu_tsc_khz);
  1377. if (unlikely(this_tsc_khz == 0)) {
  1378. local_irq_restore(flags);
  1379. kvm_make_request(KVM_REQ_CLOCK_UPDATE, v);
  1380. return 1;
  1381. }
  1382. if (!use_master_clock) {
  1383. host_tsc = native_read_tsc();
  1384. kernel_ns = get_kernel_ns();
  1385. }
  1386. tsc_timestamp = kvm_x86_ops->read_l1_tsc(v, host_tsc);
  1387. /*
  1388. * We may have to catch up the TSC to match elapsed wall clock
  1389. * time for two reasons, even if kvmclock is used.
  1390. * 1) CPU could have been running below the maximum TSC rate
  1391. * 2) Broken TSC compensation resets the base at each VCPU
  1392. * entry to avoid unknown leaps of TSC even when running
  1393. * again on the same CPU. This may cause apparent elapsed
  1394. * time to disappear, and the guest to stand still or run
  1395. * very slowly.
  1396. */
  1397. if (vcpu->tsc_catchup) {
  1398. u64 tsc = compute_guest_tsc(v, kernel_ns);
  1399. if (tsc > tsc_timestamp) {
  1400. adjust_tsc_offset_guest(v, tsc - tsc_timestamp);
  1401. tsc_timestamp = tsc;
  1402. }
  1403. }
  1404. local_irq_restore(flags);
  1405. if (!vcpu->pv_time_enabled)
  1406. return 0;
  1407. if (unlikely(vcpu->hw_tsc_khz != this_tsc_khz)) {
  1408. kvm_get_time_scale(NSEC_PER_SEC / 1000, this_tsc_khz,
  1409. &vcpu->hv_clock.tsc_shift,
  1410. &vcpu->hv_clock.tsc_to_system_mul);
  1411. vcpu->hw_tsc_khz = this_tsc_khz;
  1412. }
  1413. /* With all the info we got, fill in the values */
  1414. vcpu->hv_clock.tsc_timestamp = tsc_timestamp;
  1415. vcpu->hv_clock.system_time = kernel_ns + v->kvm->arch.kvmclock_offset;
  1416. vcpu->last_guest_tsc = tsc_timestamp;
  1417. if (unlikely(kvm_read_guest_cached(v->kvm, &vcpu->pv_time,
  1418. &guest_hv_clock, sizeof(guest_hv_clock))))
  1419. return 0;
  1420. /*
  1421. * The interface expects us to write an even number signaling that the
  1422. * update is finished. Since the guest won't see the intermediate
  1423. * state, we just increase by 2 at the end.
  1424. */
  1425. vcpu->hv_clock.version = guest_hv_clock.version + 2;
  1426. /* retain PVCLOCK_GUEST_STOPPED if set in guest copy */
  1427. pvclock_flags = (guest_hv_clock.flags & PVCLOCK_GUEST_STOPPED);
  1428. if (vcpu->pvclock_set_guest_stopped_request) {
  1429. pvclock_flags |= PVCLOCK_GUEST_STOPPED;
  1430. vcpu->pvclock_set_guest_stopped_request = false;
  1431. }
  1432. /* If the host uses TSC clocksource, then it is stable */
  1433. if (use_master_clock)
  1434. pvclock_flags |= PVCLOCK_TSC_STABLE_BIT;
  1435. vcpu->hv_clock.flags = pvclock_flags;
  1436. trace_kvm_pvclock_update(v->vcpu_id, &vcpu->hv_clock);
  1437. kvm_write_guest_cached(v->kvm, &vcpu->pv_time,
  1438. &vcpu->hv_clock,
  1439. sizeof(vcpu->hv_clock));
  1440. return 0;
  1441. }
  1442. /*
  1443. * kvmclock updates which are isolated to a given vcpu, such as
  1444. * vcpu->cpu migration, should not allow system_timestamp from
  1445. * the rest of the vcpus to remain static. Otherwise ntp frequency
  1446. * correction applies to one vcpu's system_timestamp but not
  1447. * the others.
  1448. *
  1449. * So in those cases, request a kvmclock update for all vcpus.
  1450. * We need to rate-limit these requests though, as they can
  1451. * considerably slow guests that have a large number of vcpus.
  1452. * The time for a remote vcpu to update its kvmclock is bound
  1453. * by the delay we use to rate-limit the updates.
  1454. */
  1455. #define KVMCLOCK_UPDATE_DELAY msecs_to_jiffies(100)
  1456. static void kvmclock_update_fn(struct work_struct *work)
  1457. {
  1458. int i;
  1459. struct delayed_work *dwork = to_delayed_work(work);
  1460. struct kvm_arch *ka = container_of(dwork, struct kvm_arch,
  1461. kvmclock_update_work);
  1462. struct kvm *kvm = container_of(ka, struct kvm, arch);
  1463. struct kvm_vcpu *vcpu;
  1464. kvm_for_each_vcpu(i, vcpu, kvm) {
  1465. kvm_make_request(KVM_REQ_CLOCK_UPDATE, vcpu);
  1466. kvm_vcpu_kick(vcpu);
  1467. }
  1468. }
  1469. static void kvm_gen_kvmclock_update(struct kvm_vcpu *v)
  1470. {
  1471. struct kvm *kvm = v->kvm;
  1472. kvm_make_request(KVM_REQ_CLOCK_UPDATE, v);
  1473. schedule_delayed_work(&kvm->arch.kvmclock_update_work,
  1474. KVMCLOCK_UPDATE_DELAY);
  1475. }
  1476. #define KVMCLOCK_SYNC_PERIOD (300 * HZ)
  1477. static void kvmclock_sync_fn(struct work_struct *work)
  1478. {
  1479. struct delayed_work *dwork = to_delayed_work(work);
  1480. struct kvm_arch *ka = container_of(dwork, struct kvm_arch,
  1481. kvmclock_sync_work);
  1482. struct kvm *kvm = container_of(ka, struct kvm, arch);
  1483. schedule_delayed_work(&kvm->arch.kvmclock_update_work, 0);
  1484. schedule_delayed_work(&kvm->arch.kvmclock_sync_work,
  1485. KVMCLOCK_SYNC_PERIOD);
  1486. }
  1487. static bool msr_mtrr_valid(unsigned msr)
  1488. {
  1489. switch (msr) {
  1490. case 0x200 ... 0x200 + 2 * KVM_NR_VAR_MTRR - 1:
  1491. case MSR_MTRRfix64K_00000:
  1492. case MSR_MTRRfix16K_80000:
  1493. case MSR_MTRRfix16K_A0000:
  1494. case MSR_MTRRfix4K_C0000:
  1495. case MSR_MTRRfix4K_C8000:
  1496. case MSR_MTRRfix4K_D0000:
  1497. case MSR_MTRRfix4K_D8000:
  1498. case MSR_MTRRfix4K_E0000:
  1499. case MSR_MTRRfix4K_E8000:
  1500. case MSR_MTRRfix4K_F0000:
  1501. case MSR_MTRRfix4K_F8000:
  1502. case MSR_MTRRdefType:
  1503. case MSR_IA32_CR_PAT:
  1504. return true;
  1505. case 0x2f8:
  1506. return true;
  1507. }
  1508. return false;
  1509. }
  1510. static bool valid_pat_type(unsigned t)
  1511. {
  1512. return t < 8 && (1 << t) & 0xf3; /* 0, 1, 4, 5, 6, 7 */
  1513. }
  1514. static bool valid_mtrr_type(unsigned t)
  1515. {
  1516. return t < 8 && (1 << t) & 0x73; /* 0, 1, 4, 5, 6 */
  1517. }
  1518. bool kvm_mtrr_valid(struct kvm_vcpu *vcpu, u32 msr, u64 data)
  1519. {
  1520. int i;
  1521. u64 mask;
  1522. if (!msr_mtrr_valid(msr))
  1523. return false;
  1524. if (msr == MSR_IA32_CR_PAT) {
  1525. for (i = 0; i < 8; i++)
  1526. if (!valid_pat_type((data >> (i * 8)) & 0xff))
  1527. return false;
  1528. return true;
  1529. } else if (msr == MSR_MTRRdefType) {
  1530. if (data & ~0xcff)
  1531. return false;
  1532. return valid_mtrr_type(data & 0xff);
  1533. } else if (msr >= MSR_MTRRfix64K_00000 && msr <= MSR_MTRRfix4K_F8000) {
  1534. for (i = 0; i < 8 ; i++)
  1535. if (!valid_mtrr_type((data >> (i * 8)) & 0xff))
  1536. return false;
  1537. return true;
  1538. }
  1539. /* variable MTRRs */
  1540. WARN_ON(!(msr >= 0x200 && msr < 0x200 + 2 * KVM_NR_VAR_MTRR));
  1541. mask = (~0ULL) << cpuid_maxphyaddr(vcpu);
  1542. if ((msr & 1) == 0) {
  1543. /* MTRR base */
  1544. if (!valid_mtrr_type(data & 0xff))
  1545. return false;
  1546. mask |= 0xf00;
  1547. } else
  1548. /* MTRR mask */
  1549. mask |= 0x7ff;
  1550. if (data & mask) {
  1551. kvm_inject_gp(vcpu, 0);
  1552. return false;
  1553. }
  1554. return true;
  1555. }
  1556. EXPORT_SYMBOL_GPL(kvm_mtrr_valid);
  1557. static int set_msr_mtrr(struct kvm_vcpu *vcpu, u32 msr, u64 data)
  1558. {
  1559. u64 *p = (u64 *)&vcpu->arch.mtrr_state.fixed_ranges;
  1560. if (!kvm_mtrr_valid(vcpu, msr, data))
  1561. return 1;
  1562. if (msr == MSR_MTRRdefType) {
  1563. vcpu->arch.mtrr_state.def_type = data;
  1564. vcpu->arch.mtrr_state.enabled = (data & 0xc00) >> 10;
  1565. } else if (msr == MSR_MTRRfix64K_00000)
  1566. p[0] = data;
  1567. else if (msr == MSR_MTRRfix16K_80000 || msr == MSR_MTRRfix16K_A0000)
  1568. p[1 + msr - MSR_MTRRfix16K_80000] = data;
  1569. else if (msr >= MSR_MTRRfix4K_C0000 && msr <= MSR_MTRRfix4K_F8000)
  1570. p[3 + msr - MSR_MTRRfix4K_C0000] = data;
  1571. else if (msr == MSR_IA32_CR_PAT)
  1572. vcpu->arch.pat = data;
  1573. else { /* Variable MTRRs */
  1574. int idx, is_mtrr_mask;
  1575. u64 *pt;
  1576. idx = (msr - 0x200) / 2;
  1577. is_mtrr_mask = msr - 0x200 - 2 * idx;
  1578. if (!is_mtrr_mask)
  1579. pt =
  1580. (u64 *)&vcpu->arch.mtrr_state.var_ranges[idx].base_lo;
  1581. else
  1582. pt =
  1583. (u64 *)&vcpu->arch.mtrr_state.var_ranges[idx].mask_lo;
  1584. *pt = data;
  1585. }
  1586. kvm_mmu_reset_context(vcpu);
  1587. return 0;
  1588. }
  1589. static int set_msr_mce(struct kvm_vcpu *vcpu, u32 msr, u64 data)
  1590. {
  1591. u64 mcg_cap = vcpu->arch.mcg_cap;
  1592. unsigned bank_num = mcg_cap & 0xff;
  1593. switch (msr) {
  1594. case MSR_IA32_MCG_STATUS:
  1595. vcpu->arch.mcg_status = data;
  1596. break;
  1597. case MSR_IA32_MCG_CTL:
  1598. if (!(mcg_cap & MCG_CTL_P))
  1599. return 1;
  1600. if (data != 0 && data != ~(u64)0)
  1601. return -1;
  1602. vcpu->arch.mcg_ctl = data;
  1603. break;
  1604. default:
  1605. if (msr >= MSR_IA32_MC0_CTL &&
  1606. msr < MSR_IA32_MCx_CTL(bank_num)) {
  1607. u32 offset = msr - MSR_IA32_MC0_CTL;
  1608. /* only 0 or all 1s can be written to IA32_MCi_CTL
  1609. * some Linux kernels though clear bit 10 in bank 4 to
  1610. * workaround a BIOS/GART TBL issue on AMD K8s, ignore
  1611. * this to avoid an uncatched #GP in the guest
  1612. */
  1613. if ((offset & 0x3) == 0 &&
  1614. data != 0 && (data | (1 << 10)) != ~(u64)0)
  1615. return -1;
  1616. vcpu->arch.mce_banks[offset] = data;
  1617. break;
  1618. }
  1619. return 1;
  1620. }
  1621. return 0;
  1622. }
  1623. static int xen_hvm_config(struct kvm_vcpu *vcpu, u64 data)
  1624. {
  1625. struct kvm *kvm = vcpu->kvm;
  1626. int lm = is_long_mode(vcpu);
  1627. u8 *blob_addr = lm ? (u8 *)(long)kvm->arch.xen_hvm_config.blob_addr_64
  1628. : (u8 *)(long)kvm->arch.xen_hvm_config.blob_addr_32;
  1629. u8 blob_size = lm ? kvm->arch.xen_hvm_config.blob_size_64
  1630. : kvm->arch.xen_hvm_config.blob_size_32;
  1631. u32 page_num = data & ~PAGE_MASK;
  1632. u64 page_addr = data & PAGE_MASK;
  1633. u8 *page;
  1634. int r;
  1635. r = -E2BIG;
  1636. if (page_num >= blob_size)
  1637. goto out;
  1638. r = -ENOMEM;
  1639. page = memdup_user(blob_addr + (page_num * PAGE_SIZE), PAGE_SIZE);
  1640. if (IS_ERR(page)) {
  1641. r = PTR_ERR(page);
  1642. goto out;
  1643. }
  1644. if (kvm_write_guest(kvm, page_addr, page, PAGE_SIZE))
  1645. goto out_free;
  1646. r = 0;
  1647. out_free:
  1648. kfree(page);
  1649. out:
  1650. return r;
  1651. }
  1652. static bool kvm_hv_hypercall_enabled(struct kvm *kvm)
  1653. {
  1654. return kvm->arch.hv_hypercall & HV_X64_MSR_HYPERCALL_ENABLE;
  1655. }
  1656. static bool kvm_hv_msr_partition_wide(u32 msr)
  1657. {
  1658. bool r = false;
  1659. switch (msr) {
  1660. case HV_X64_MSR_GUEST_OS_ID:
  1661. case HV_X64_MSR_HYPERCALL:
  1662. case HV_X64_MSR_REFERENCE_TSC:
  1663. case HV_X64_MSR_TIME_REF_COUNT:
  1664. r = true;
  1665. break;
  1666. }
  1667. return r;
  1668. }
  1669. static int set_msr_hyperv_pw(struct kvm_vcpu *vcpu, u32 msr, u64 data)
  1670. {
  1671. struct kvm *kvm = vcpu->kvm;
  1672. switch (msr) {
  1673. case HV_X64_MSR_GUEST_OS_ID:
  1674. kvm->arch.hv_guest_os_id = data;
  1675. /* setting guest os id to zero disables hypercall page */
  1676. if (!kvm->arch.hv_guest_os_id)
  1677. kvm->arch.hv_hypercall &= ~HV_X64_MSR_HYPERCALL_ENABLE;
  1678. break;
  1679. case HV_X64_MSR_HYPERCALL: {
  1680. u64 gfn;
  1681. unsigned long addr;
  1682. u8 instructions[4];
  1683. /* if guest os id is not set hypercall should remain disabled */
  1684. if (!kvm->arch.hv_guest_os_id)
  1685. break;
  1686. if (!(data & HV_X64_MSR_HYPERCALL_ENABLE)) {
  1687. kvm->arch.hv_hypercall = data;
  1688. break;
  1689. }
  1690. gfn = data >> HV_X64_MSR_HYPERCALL_PAGE_ADDRESS_SHIFT;
  1691. addr = gfn_to_hva(kvm, gfn);
  1692. if (kvm_is_error_hva(addr))
  1693. return 1;
  1694. kvm_x86_ops->patch_hypercall(vcpu, instructions);
  1695. ((unsigned char *)instructions)[3] = 0xc3; /* ret */
  1696. if (__copy_to_user((void __user *)addr, instructions, 4))
  1697. return 1;
  1698. kvm->arch.hv_hypercall = data;
  1699. mark_page_dirty(kvm, gfn);
  1700. break;
  1701. }
  1702. case HV_X64_MSR_REFERENCE_TSC: {
  1703. u64 gfn;
  1704. HV_REFERENCE_TSC_PAGE tsc_ref;
  1705. memset(&tsc_ref, 0, sizeof(tsc_ref));
  1706. kvm->arch.hv_tsc_page = data;
  1707. if (!(data & HV_X64_MSR_TSC_REFERENCE_ENABLE))
  1708. break;
  1709. gfn = data >> HV_X64_MSR_TSC_REFERENCE_ADDRESS_SHIFT;
  1710. if (kvm_write_guest(kvm, gfn << HV_X64_MSR_TSC_REFERENCE_ADDRESS_SHIFT,
  1711. &tsc_ref, sizeof(tsc_ref)))
  1712. return 1;
  1713. mark_page_dirty(kvm, gfn);
  1714. break;
  1715. }
  1716. default:
  1717. vcpu_unimpl(vcpu, "HYPER-V unimplemented wrmsr: 0x%x "
  1718. "data 0x%llx\n", msr, data);
  1719. return 1;
  1720. }
  1721. return 0;
  1722. }
  1723. static int set_msr_hyperv(struct kvm_vcpu *vcpu, u32 msr, u64 data)
  1724. {
  1725. switch (msr) {
  1726. case HV_X64_MSR_APIC_ASSIST_PAGE: {
  1727. u64 gfn;
  1728. unsigned long addr;
  1729. if (!(data & HV_X64_MSR_APIC_ASSIST_PAGE_ENABLE)) {
  1730. vcpu->arch.hv_vapic = data;
  1731. if (kvm_lapic_enable_pv_eoi(vcpu, 0))
  1732. return 1;
  1733. break;
  1734. }
  1735. gfn = data >> HV_X64_MSR_APIC_ASSIST_PAGE_ADDRESS_SHIFT;
  1736. addr = gfn_to_hva(vcpu->kvm, gfn);
  1737. if (kvm_is_error_hva(addr))
  1738. return 1;
  1739. if (__clear_user((void __user *)addr, PAGE_SIZE))
  1740. return 1;
  1741. vcpu->arch.hv_vapic = data;
  1742. mark_page_dirty(vcpu->kvm, gfn);
  1743. if (kvm_lapic_enable_pv_eoi(vcpu, gfn_to_gpa(gfn) | KVM_MSR_ENABLED))
  1744. return 1;
  1745. break;
  1746. }
  1747. case HV_X64_MSR_EOI:
  1748. return kvm_hv_vapic_msr_write(vcpu, APIC_EOI, data);
  1749. case HV_X64_MSR_ICR:
  1750. return kvm_hv_vapic_msr_write(vcpu, APIC_ICR, data);
  1751. case HV_X64_MSR_TPR:
  1752. return kvm_hv_vapic_msr_write(vcpu, APIC_TASKPRI, data);
  1753. default:
  1754. vcpu_unimpl(vcpu, "HYPER-V unimplemented wrmsr: 0x%x "
  1755. "data 0x%llx\n", msr, data);
  1756. return 1;
  1757. }
  1758. return 0;
  1759. }
  1760. static int kvm_pv_enable_async_pf(struct kvm_vcpu *vcpu, u64 data)
  1761. {
  1762. gpa_t gpa = data & ~0x3f;
  1763. /* Bits 2:5 are reserved, Should be zero */
  1764. if (data & 0x3c)
  1765. return 1;
  1766. vcpu->arch.apf.msr_val = data;
  1767. if (!(data & KVM_ASYNC_PF_ENABLED)) {
  1768. kvm_clear_async_pf_completion_queue(vcpu);
  1769. kvm_async_pf_hash_reset(vcpu);
  1770. return 0;
  1771. }
  1772. if (kvm_gfn_to_hva_cache_init(vcpu->kvm, &vcpu->arch.apf.data, gpa,
  1773. sizeof(u32)))
  1774. return 1;
  1775. vcpu->arch.apf.send_user_only = !(data & KVM_ASYNC_PF_SEND_ALWAYS);
  1776. kvm_async_pf_wakeup_all(vcpu);
  1777. return 0;
  1778. }
  1779. static void kvmclock_reset(struct kvm_vcpu *vcpu)
  1780. {
  1781. vcpu->arch.pv_time_enabled = false;
  1782. }
  1783. static void accumulate_steal_time(struct kvm_vcpu *vcpu)
  1784. {
  1785. u64 delta;
  1786. if (!(vcpu->arch.st.msr_val & KVM_MSR_ENABLED))
  1787. return;
  1788. delta = current->sched_info.run_delay - vcpu->arch.st.last_steal;
  1789. vcpu->arch.st.last_steal = current->sched_info.run_delay;
  1790. vcpu->arch.st.accum_steal = delta;
  1791. }
  1792. static void record_steal_time(struct kvm_vcpu *vcpu)
  1793. {
  1794. if (!(vcpu->arch.st.msr_val & KVM_MSR_ENABLED))
  1795. return;
  1796. if (unlikely(kvm_read_guest_cached(vcpu->kvm, &vcpu->arch.st.stime,
  1797. &vcpu->arch.st.steal, sizeof(struct kvm_steal_time))))
  1798. return;
  1799. vcpu->arch.st.steal.steal += vcpu->arch.st.accum_steal;
  1800. vcpu->arch.st.steal.version += 2;
  1801. vcpu->arch.st.accum_steal = 0;
  1802. kvm_write_guest_cached(vcpu->kvm, &vcpu->arch.st.stime,
  1803. &vcpu->arch.st.steal, sizeof(struct kvm_steal_time));
  1804. }
  1805. int kvm_set_msr_common(struct kvm_vcpu *vcpu, struct msr_data *msr_info)
  1806. {
  1807. bool pr = false;
  1808. u32 msr = msr_info->index;
  1809. u64 data = msr_info->data;
  1810. switch (msr) {
  1811. case MSR_AMD64_NB_CFG:
  1812. case MSR_IA32_UCODE_REV:
  1813. case MSR_IA32_UCODE_WRITE:
  1814. case MSR_VM_HSAVE_PA:
  1815. case MSR_AMD64_PATCH_LOADER:
  1816. case MSR_AMD64_BU_CFG2:
  1817. break;
  1818. case MSR_EFER:
  1819. return set_efer(vcpu, data);
  1820. case MSR_K7_HWCR:
  1821. data &= ~(u64)0x40; /* ignore flush filter disable */
  1822. data &= ~(u64)0x100; /* ignore ignne emulation enable */
  1823. data &= ~(u64)0x8; /* ignore TLB cache disable */
  1824. data &= ~(u64)0x40000; /* ignore Mc status write enable */
  1825. if (data != 0) {
  1826. vcpu_unimpl(vcpu, "unimplemented HWCR wrmsr: 0x%llx\n",
  1827. data);
  1828. return 1;
  1829. }
  1830. break;
  1831. case MSR_FAM10H_MMIO_CONF_BASE:
  1832. if (data != 0) {
  1833. vcpu_unimpl(vcpu, "unimplemented MMIO_CONF_BASE wrmsr: "
  1834. "0x%llx\n", data);
  1835. return 1;
  1836. }
  1837. break;
  1838. case MSR_IA32_DEBUGCTLMSR:
  1839. if (!data) {
  1840. /* We support the non-activated case already */
  1841. break;
  1842. } else if (data & ~(DEBUGCTLMSR_LBR | DEBUGCTLMSR_BTF)) {
  1843. /* Values other than LBR and BTF are vendor-specific,
  1844. thus reserved and should throw a #GP */
  1845. return 1;
  1846. }
  1847. vcpu_unimpl(vcpu, "%s: MSR_IA32_DEBUGCTLMSR 0x%llx, nop\n",
  1848. __func__, data);
  1849. break;
  1850. case 0x200 ... 0x2ff:
  1851. return set_msr_mtrr(vcpu, msr, data);
  1852. case MSR_IA32_APICBASE:
  1853. return kvm_set_apic_base(vcpu, msr_info);
  1854. case APIC_BASE_MSR ... APIC_BASE_MSR + 0x3ff:
  1855. return kvm_x2apic_msr_write(vcpu, msr, data);
  1856. case MSR_IA32_TSCDEADLINE:
  1857. kvm_set_lapic_tscdeadline_msr(vcpu, data);
  1858. break;
  1859. case MSR_IA32_TSC_ADJUST:
  1860. if (guest_cpuid_has_tsc_adjust(vcpu)) {
  1861. if (!msr_info->host_initiated) {
  1862. s64 adj = data - vcpu->arch.ia32_tsc_adjust_msr;
  1863. kvm_x86_ops->adjust_tsc_offset(vcpu, adj, true);
  1864. }
  1865. vcpu->arch.ia32_tsc_adjust_msr = data;
  1866. }
  1867. break;
  1868. case MSR_IA32_MISC_ENABLE:
  1869. vcpu->arch.ia32_misc_enable_msr = data;
  1870. break;
  1871. case MSR_KVM_WALL_CLOCK_NEW:
  1872. case MSR_KVM_WALL_CLOCK:
  1873. vcpu->kvm->arch.wall_clock = data;
  1874. kvm_write_wall_clock(vcpu->kvm, data);
  1875. break;
  1876. case MSR_KVM_SYSTEM_TIME_NEW:
  1877. case MSR_KVM_SYSTEM_TIME: {
  1878. u64 gpa_offset;
  1879. struct kvm_arch *ka = &vcpu->kvm->arch;
  1880. kvmclock_reset(vcpu);
  1881. if (vcpu->vcpu_id == 0 && !msr_info->host_initiated) {
  1882. bool tmp = (msr == MSR_KVM_SYSTEM_TIME);
  1883. if (ka->boot_vcpu_runs_old_kvmclock != tmp)
  1884. set_bit(KVM_REQ_MASTERCLOCK_UPDATE,
  1885. &vcpu->requests);
  1886. ka->boot_vcpu_runs_old_kvmclock = tmp;
  1887. }
  1888. vcpu->arch.time = data;
  1889. kvm_make_request(KVM_REQ_GLOBAL_CLOCK_UPDATE, vcpu);
  1890. /* we verify if the enable bit is set... */
  1891. if (!(data & 1))
  1892. break;
  1893. gpa_offset = data & ~(PAGE_MASK | 1);
  1894. if (kvm_gfn_to_hva_cache_init(vcpu->kvm,
  1895. &vcpu->arch.pv_time, data & ~1ULL,
  1896. sizeof(struct pvclock_vcpu_time_info)))
  1897. vcpu->arch.pv_time_enabled = false;
  1898. else
  1899. vcpu->arch.pv_time_enabled = true;
  1900. break;
  1901. }
  1902. case MSR_KVM_ASYNC_PF_EN:
  1903. if (kvm_pv_enable_async_pf(vcpu, data))
  1904. return 1;
  1905. break;
  1906. case MSR_KVM_STEAL_TIME:
  1907. if (unlikely(!sched_info_on()))
  1908. return 1;
  1909. if (data & KVM_STEAL_RESERVED_MASK)
  1910. return 1;
  1911. if (kvm_gfn_to_hva_cache_init(vcpu->kvm, &vcpu->arch.st.stime,
  1912. data & KVM_STEAL_VALID_BITS,
  1913. sizeof(struct kvm_steal_time)))
  1914. return 1;
  1915. vcpu->arch.st.msr_val = data;
  1916. if (!(data & KVM_MSR_ENABLED))
  1917. break;
  1918. vcpu->arch.st.last_steal = current->sched_info.run_delay;
  1919. preempt_disable();
  1920. accumulate_steal_time(vcpu);
  1921. preempt_enable();
  1922. kvm_make_request(KVM_REQ_STEAL_UPDATE, vcpu);
  1923. break;
  1924. case MSR_KVM_PV_EOI_EN:
  1925. if (kvm_lapic_enable_pv_eoi(vcpu, data))
  1926. return 1;
  1927. break;
  1928. case MSR_IA32_MCG_CTL:
  1929. case MSR_IA32_MCG_STATUS:
  1930. case MSR_IA32_MC0_CTL ... MSR_IA32_MCx_CTL(KVM_MAX_MCE_BANKS) - 1:
  1931. return set_msr_mce(vcpu, msr, data);
  1932. /* Performance counters are not protected by a CPUID bit,
  1933. * so we should check all of them in the generic path for the sake of
  1934. * cross vendor migration.
  1935. * Writing a zero into the event select MSRs disables them,
  1936. * which we perfectly emulate ;-). Any other value should be at least
  1937. * reported, some guests depend on them.
  1938. */
  1939. case MSR_K7_EVNTSEL0:
  1940. case MSR_K7_EVNTSEL1:
  1941. case MSR_K7_EVNTSEL2:
  1942. case MSR_K7_EVNTSEL3:
  1943. if (data != 0)
  1944. vcpu_unimpl(vcpu, "unimplemented perfctr wrmsr: "
  1945. "0x%x data 0x%llx\n", msr, data);
  1946. break;
  1947. /* at least RHEL 4 unconditionally writes to the perfctr registers,
  1948. * so we ignore writes to make it happy.
  1949. */
  1950. case MSR_K7_PERFCTR0:
  1951. case MSR_K7_PERFCTR1:
  1952. case MSR_K7_PERFCTR2:
  1953. case MSR_K7_PERFCTR3:
  1954. vcpu_unimpl(vcpu, "unimplemented perfctr wrmsr: "
  1955. "0x%x data 0x%llx\n", msr, data);
  1956. break;
  1957. case MSR_P6_PERFCTR0:
  1958. case MSR_P6_PERFCTR1:
  1959. pr = true;
  1960. case MSR_P6_EVNTSEL0:
  1961. case MSR_P6_EVNTSEL1:
  1962. if (kvm_pmu_msr(vcpu, msr))
  1963. return kvm_pmu_set_msr(vcpu, msr_info);
  1964. if (pr || data != 0)
  1965. vcpu_unimpl(vcpu, "disabled perfctr wrmsr: "
  1966. "0x%x data 0x%llx\n", msr, data);
  1967. break;
  1968. case MSR_K7_CLK_CTL:
  1969. /*
  1970. * Ignore all writes to this no longer documented MSR.
  1971. * Writes are only relevant for old K7 processors,
  1972. * all pre-dating SVM, but a recommended workaround from
  1973. * AMD for these chips. It is possible to specify the
  1974. * affected processor models on the command line, hence
  1975. * the need to ignore the workaround.
  1976. */
  1977. break;
  1978. case HV_X64_MSR_GUEST_OS_ID ... HV_X64_MSR_SINT15:
  1979. if (kvm_hv_msr_partition_wide(msr)) {
  1980. int r;
  1981. mutex_lock(&vcpu->kvm->lock);
  1982. r = set_msr_hyperv_pw(vcpu, msr, data);
  1983. mutex_unlock(&vcpu->kvm->lock);
  1984. return r;
  1985. } else
  1986. return set_msr_hyperv(vcpu, msr, data);
  1987. break;
  1988. case MSR_IA32_BBL_CR_CTL3:
  1989. /* Drop writes to this legacy MSR -- see rdmsr
  1990. * counterpart for further detail.
  1991. */
  1992. vcpu_unimpl(vcpu, "ignored wrmsr: 0x%x data %llx\n", msr, data);
  1993. break;
  1994. case MSR_AMD64_OSVW_ID_LENGTH:
  1995. if (!guest_cpuid_has_osvw(vcpu))
  1996. return 1;
  1997. vcpu->arch.osvw.length = data;
  1998. break;
  1999. case MSR_AMD64_OSVW_STATUS:
  2000. if (!guest_cpuid_has_osvw(vcpu))
  2001. return 1;
  2002. vcpu->arch.osvw.status = data;
  2003. break;
  2004. default:
  2005. if (msr && (msr == vcpu->kvm->arch.xen_hvm_config.msr))
  2006. return xen_hvm_config(vcpu, data);
  2007. if (kvm_pmu_msr(vcpu, msr))
  2008. return kvm_pmu_set_msr(vcpu, msr_info);
  2009. if (!ignore_msrs) {
  2010. vcpu_unimpl(vcpu, "unhandled wrmsr: 0x%x data %llx\n",
  2011. msr, data);
  2012. return 1;
  2013. } else {
  2014. vcpu_unimpl(vcpu, "ignored wrmsr: 0x%x data %llx\n",
  2015. msr, data);
  2016. break;
  2017. }
  2018. }
  2019. return 0;
  2020. }
  2021. EXPORT_SYMBOL_GPL(kvm_set_msr_common);
  2022. /*
  2023. * Reads an msr value (of 'msr_index') into 'pdata'.
  2024. * Returns 0 on success, non-0 otherwise.
  2025. * Assumes vcpu_load() was already called.
  2026. */
  2027. int kvm_get_msr(struct kvm_vcpu *vcpu, u32 msr_index, u64 *pdata)
  2028. {
  2029. return kvm_x86_ops->get_msr(vcpu, msr_index, pdata);
  2030. }
  2031. EXPORT_SYMBOL_GPL(kvm_get_msr);
  2032. static int get_msr_mtrr(struct kvm_vcpu *vcpu, u32 msr, u64 *pdata)
  2033. {
  2034. u64 *p = (u64 *)&vcpu->arch.mtrr_state.fixed_ranges;
  2035. if (!msr_mtrr_valid(msr))
  2036. return 1;
  2037. if (msr == MSR_MTRRdefType)
  2038. *pdata = vcpu->arch.mtrr_state.def_type +
  2039. (vcpu->arch.mtrr_state.enabled << 10);
  2040. else if (msr == MSR_MTRRfix64K_00000)
  2041. *pdata = p[0];
  2042. else if (msr == MSR_MTRRfix16K_80000 || msr == MSR_MTRRfix16K_A0000)
  2043. *pdata = p[1 + msr - MSR_MTRRfix16K_80000];
  2044. else if (msr >= MSR_MTRRfix4K_C0000 && msr <= MSR_MTRRfix4K_F8000)
  2045. *pdata = p[3 + msr - MSR_MTRRfix4K_C0000];
  2046. else if (msr == MSR_IA32_CR_PAT)
  2047. *pdata = vcpu->arch.pat;
  2048. else { /* Variable MTRRs */
  2049. int idx, is_mtrr_mask;
  2050. u64 *pt;
  2051. idx = (msr - 0x200) / 2;
  2052. is_mtrr_mask = msr - 0x200 - 2 * idx;
  2053. if (!is_mtrr_mask)
  2054. pt =
  2055. (u64 *)&vcpu->arch.mtrr_state.var_ranges[idx].base_lo;
  2056. else
  2057. pt =
  2058. (u64 *)&vcpu->arch.mtrr_state.var_ranges[idx].mask_lo;
  2059. *pdata = *pt;
  2060. }
  2061. return 0;
  2062. }
  2063. static int get_msr_mce(struct kvm_vcpu *vcpu, u32 msr, u64 *pdata)
  2064. {
  2065. u64 data;
  2066. u64 mcg_cap = vcpu->arch.mcg_cap;
  2067. unsigned bank_num = mcg_cap & 0xff;
  2068. switch (msr) {
  2069. case MSR_IA32_P5_MC_ADDR:
  2070. case MSR_IA32_P5_MC_TYPE:
  2071. data = 0;
  2072. break;
  2073. case MSR_IA32_MCG_CAP:
  2074. data = vcpu->arch.mcg_cap;
  2075. break;
  2076. case MSR_IA32_MCG_CTL:
  2077. if (!(mcg_cap & MCG_CTL_P))
  2078. return 1;
  2079. data = vcpu->arch.mcg_ctl;
  2080. break;
  2081. case MSR_IA32_MCG_STATUS:
  2082. data = vcpu->arch.mcg_status;
  2083. break;
  2084. default:
  2085. if (msr >= MSR_IA32_MC0_CTL &&
  2086. msr < MSR_IA32_MCx_CTL(bank_num)) {
  2087. u32 offset = msr - MSR_IA32_MC0_CTL;
  2088. data = vcpu->arch.mce_banks[offset];
  2089. break;
  2090. }
  2091. return 1;
  2092. }
  2093. *pdata = data;
  2094. return 0;
  2095. }
  2096. static int get_msr_hyperv_pw(struct kvm_vcpu *vcpu, u32 msr, u64 *pdata)
  2097. {
  2098. u64 data = 0;
  2099. struct kvm *kvm = vcpu->kvm;
  2100. switch (msr) {
  2101. case HV_X64_MSR_GUEST_OS_ID:
  2102. data = kvm->arch.hv_guest_os_id;
  2103. break;
  2104. case HV_X64_MSR_HYPERCALL:
  2105. data = kvm->arch.hv_hypercall;
  2106. break;
  2107. case HV_X64_MSR_TIME_REF_COUNT: {
  2108. data =
  2109. div_u64(get_kernel_ns() + kvm->arch.kvmclock_offset, 100);
  2110. break;
  2111. }
  2112. case HV_X64_MSR_REFERENCE_TSC:
  2113. data = kvm->arch.hv_tsc_page;
  2114. break;
  2115. default:
  2116. vcpu_unimpl(vcpu, "Hyper-V unhandled rdmsr: 0x%x\n", msr);
  2117. return 1;
  2118. }
  2119. *pdata = data;
  2120. return 0;
  2121. }
  2122. static int get_msr_hyperv(struct kvm_vcpu *vcpu, u32 msr, u64 *pdata)
  2123. {
  2124. u64 data = 0;
  2125. switch (msr) {
  2126. case HV_X64_MSR_VP_INDEX: {
  2127. int r;
  2128. struct kvm_vcpu *v;
  2129. kvm_for_each_vcpu(r, v, vcpu->kvm) {
  2130. if (v == vcpu) {
  2131. data = r;
  2132. break;
  2133. }
  2134. }
  2135. break;
  2136. }
  2137. case HV_X64_MSR_EOI:
  2138. return kvm_hv_vapic_msr_read(vcpu, APIC_EOI, pdata);
  2139. case HV_X64_MSR_ICR:
  2140. return kvm_hv_vapic_msr_read(vcpu, APIC_ICR, pdata);
  2141. case HV_X64_MSR_TPR:
  2142. return kvm_hv_vapic_msr_read(vcpu, APIC_TASKPRI, pdata);
  2143. case HV_X64_MSR_APIC_ASSIST_PAGE:
  2144. data = vcpu->arch.hv_vapic;
  2145. break;
  2146. default:
  2147. vcpu_unimpl(vcpu, "Hyper-V unhandled rdmsr: 0x%x\n", msr);
  2148. return 1;
  2149. }
  2150. *pdata = data;
  2151. return 0;
  2152. }
  2153. int kvm_get_msr_common(struct kvm_vcpu *vcpu, u32 msr, u64 *pdata)
  2154. {
  2155. u64 data;
  2156. switch (msr) {
  2157. case MSR_IA32_PLATFORM_ID:
  2158. case MSR_IA32_EBL_CR_POWERON:
  2159. case MSR_IA32_DEBUGCTLMSR:
  2160. case MSR_IA32_LASTBRANCHFROMIP:
  2161. case MSR_IA32_LASTBRANCHTOIP:
  2162. case MSR_IA32_LASTINTFROMIP:
  2163. case MSR_IA32_LASTINTTOIP:
  2164. case MSR_K8_SYSCFG:
  2165. case MSR_K7_HWCR:
  2166. case MSR_VM_HSAVE_PA:
  2167. case MSR_K7_EVNTSEL0:
  2168. case MSR_K7_EVNTSEL1:
  2169. case MSR_K7_EVNTSEL2:
  2170. case MSR_K7_EVNTSEL3:
  2171. case MSR_K7_PERFCTR0:
  2172. case MSR_K7_PERFCTR1:
  2173. case MSR_K7_PERFCTR2:
  2174. case MSR_K7_PERFCTR3:
  2175. case MSR_K8_INT_PENDING_MSG:
  2176. case MSR_AMD64_NB_CFG:
  2177. case MSR_FAM10H_MMIO_CONF_BASE:
  2178. case MSR_AMD64_BU_CFG2:
  2179. data = 0;
  2180. break;
  2181. case MSR_P6_PERFCTR0:
  2182. case MSR_P6_PERFCTR1:
  2183. case MSR_P6_EVNTSEL0:
  2184. case MSR_P6_EVNTSEL1:
  2185. if (kvm_pmu_msr(vcpu, msr))
  2186. return kvm_pmu_get_msr(vcpu, msr, pdata);
  2187. data = 0;
  2188. break;
  2189. case MSR_IA32_UCODE_REV:
  2190. data = 0x100000000ULL;
  2191. break;
  2192. case MSR_MTRRcap:
  2193. data = 0x500 | KVM_NR_VAR_MTRR;
  2194. break;
  2195. case 0x200 ... 0x2ff:
  2196. return get_msr_mtrr(vcpu, msr, pdata);
  2197. case 0xcd: /* fsb frequency */
  2198. data = 3;
  2199. break;
  2200. /*
  2201. * MSR_EBC_FREQUENCY_ID
  2202. * Conservative value valid for even the basic CPU models.
  2203. * Models 0,1: 000 in bits 23:21 indicating a bus speed of
  2204. * 100MHz, model 2 000 in bits 18:16 indicating 100MHz,
  2205. * and 266MHz for model 3, or 4. Set Core Clock
  2206. * Frequency to System Bus Frequency Ratio to 1 (bits
  2207. * 31:24) even though these are only valid for CPU
  2208. * models > 2, however guests may end up dividing or
  2209. * multiplying by zero otherwise.
  2210. */
  2211. case MSR_EBC_FREQUENCY_ID:
  2212. data = 1 << 24;
  2213. break;
  2214. case MSR_IA32_APICBASE:
  2215. data = kvm_get_apic_base(vcpu);
  2216. break;
  2217. case APIC_BASE_MSR ... APIC_BASE_MSR + 0x3ff:
  2218. return kvm_x2apic_msr_read(vcpu, msr, pdata);
  2219. break;
  2220. case MSR_IA32_TSCDEADLINE:
  2221. data = kvm_get_lapic_tscdeadline_msr(vcpu);
  2222. break;
  2223. case MSR_IA32_TSC_ADJUST:
  2224. data = (u64)vcpu->arch.ia32_tsc_adjust_msr;
  2225. break;
  2226. case MSR_IA32_MISC_ENABLE:
  2227. data = vcpu->arch.ia32_misc_enable_msr;
  2228. break;
  2229. case MSR_IA32_PERF_STATUS:
  2230. /* TSC increment by tick */
  2231. data = 1000ULL;
  2232. /* CPU multiplier */
  2233. data |= (((uint64_t)4ULL) << 40);
  2234. break;
  2235. case MSR_EFER:
  2236. data = vcpu->arch.efer;
  2237. break;
  2238. case MSR_KVM_WALL_CLOCK:
  2239. case MSR_KVM_WALL_CLOCK_NEW:
  2240. data = vcpu->kvm->arch.wall_clock;
  2241. break;
  2242. case MSR_KVM_SYSTEM_TIME:
  2243. case MSR_KVM_SYSTEM_TIME_NEW:
  2244. data = vcpu->arch.time;
  2245. break;
  2246. case MSR_KVM_ASYNC_PF_EN:
  2247. data = vcpu->arch.apf.msr_val;
  2248. break;
  2249. case MSR_KVM_STEAL_TIME:
  2250. data = vcpu->arch.st.msr_val;
  2251. break;
  2252. case MSR_KVM_PV_EOI_EN:
  2253. data = vcpu->arch.pv_eoi.msr_val;
  2254. break;
  2255. case MSR_IA32_P5_MC_ADDR:
  2256. case MSR_IA32_P5_MC_TYPE:
  2257. case MSR_IA32_MCG_CAP:
  2258. case MSR_IA32_MCG_CTL:
  2259. case MSR_IA32_MCG_STATUS:
  2260. case MSR_IA32_MC0_CTL ... MSR_IA32_MCx_CTL(KVM_MAX_MCE_BANKS) - 1:
  2261. return get_msr_mce(vcpu, msr, pdata);
  2262. case MSR_K7_CLK_CTL:
  2263. /*
  2264. * Provide expected ramp-up count for K7. All other
  2265. * are set to zero, indicating minimum divisors for
  2266. * every field.
  2267. *
  2268. * This prevents guest kernels on AMD host with CPU
  2269. * type 6, model 8 and higher from exploding due to
  2270. * the rdmsr failing.
  2271. */
  2272. data = 0x20000000;
  2273. break;
  2274. case HV_X64_MSR_GUEST_OS_ID ... HV_X64_MSR_SINT15:
  2275. if (kvm_hv_msr_partition_wide(msr)) {
  2276. int r;
  2277. mutex_lock(&vcpu->kvm->lock);
  2278. r = get_msr_hyperv_pw(vcpu, msr, pdata);
  2279. mutex_unlock(&vcpu->kvm->lock);
  2280. return r;
  2281. } else
  2282. return get_msr_hyperv(vcpu, msr, pdata);
  2283. break;
  2284. case MSR_IA32_BBL_CR_CTL3:
  2285. /* This legacy MSR exists but isn't fully documented in current
  2286. * silicon. It is however accessed by winxp in very narrow
  2287. * scenarios where it sets bit #19, itself documented as
  2288. * a "reserved" bit. Best effort attempt to source coherent
  2289. * read data here should the balance of the register be
  2290. * interpreted by the guest:
  2291. *
  2292. * L2 cache control register 3: 64GB range, 256KB size,
  2293. * enabled, latency 0x1, configured
  2294. */
  2295. data = 0xbe702111;
  2296. break;
  2297. case MSR_AMD64_OSVW_ID_LENGTH:
  2298. if (!guest_cpuid_has_osvw(vcpu))
  2299. return 1;
  2300. data = vcpu->arch.osvw.length;
  2301. break;
  2302. case MSR_AMD64_OSVW_STATUS:
  2303. if (!guest_cpuid_has_osvw(vcpu))
  2304. return 1;
  2305. data = vcpu->arch.osvw.status;
  2306. break;
  2307. default:
  2308. if (kvm_pmu_msr(vcpu, msr))
  2309. return kvm_pmu_get_msr(vcpu, msr, pdata);
  2310. if (!ignore_msrs) {
  2311. vcpu_unimpl(vcpu, "unhandled rdmsr: 0x%x\n", msr);
  2312. return 1;
  2313. } else {
  2314. vcpu_unimpl(vcpu, "ignored rdmsr: 0x%x\n", msr);
  2315. data = 0;
  2316. }
  2317. break;
  2318. }
  2319. *pdata = data;
  2320. return 0;
  2321. }
  2322. EXPORT_SYMBOL_GPL(kvm_get_msr_common);
  2323. /*
  2324. * Read or write a bunch of msrs. All parameters are kernel addresses.
  2325. *
  2326. * @return number of msrs set successfully.
  2327. */
  2328. static int __msr_io(struct kvm_vcpu *vcpu, struct kvm_msrs *msrs,
  2329. struct kvm_msr_entry *entries,
  2330. int (*do_msr)(struct kvm_vcpu *vcpu,
  2331. unsigned index, u64 *data))
  2332. {
  2333. int i, idx;
  2334. idx = srcu_read_lock(&vcpu->kvm->srcu);
  2335. for (i = 0; i < msrs->nmsrs; ++i)
  2336. if (do_msr(vcpu, entries[i].index, &entries[i].data))
  2337. break;
  2338. srcu_read_unlock(&vcpu->kvm->srcu, idx);
  2339. return i;
  2340. }
  2341. /*
  2342. * Read or write a bunch of msrs. Parameters are user addresses.
  2343. *
  2344. * @return number of msrs set successfully.
  2345. */
  2346. static int msr_io(struct kvm_vcpu *vcpu, struct kvm_msrs __user *user_msrs,
  2347. int (*do_msr)(struct kvm_vcpu *vcpu,
  2348. unsigned index, u64 *data),
  2349. int writeback)
  2350. {
  2351. struct kvm_msrs msrs;
  2352. struct kvm_msr_entry *entries;
  2353. int r, n;
  2354. unsigned size;
  2355. r = -EFAULT;
  2356. if (copy_from_user(&msrs, user_msrs, sizeof msrs))
  2357. goto out;
  2358. r = -E2BIG;
  2359. if (msrs.nmsrs >= MAX_IO_MSRS)
  2360. goto out;
  2361. size = sizeof(struct kvm_msr_entry) * msrs.nmsrs;
  2362. entries = memdup_user(user_msrs->entries, size);
  2363. if (IS_ERR(entries)) {
  2364. r = PTR_ERR(entries);
  2365. goto out;
  2366. }
  2367. r = n = __msr_io(vcpu, &msrs, entries, do_msr);
  2368. if (r < 0)
  2369. goto out_free;
  2370. r = -EFAULT;
  2371. if (writeback && copy_to_user(user_msrs->entries, entries, size))
  2372. goto out_free;
  2373. r = n;
  2374. out_free:
  2375. kfree(entries);
  2376. out:
  2377. return r;
  2378. }
  2379. int kvm_vm_ioctl_check_extension(struct kvm *kvm, long ext)
  2380. {
  2381. int r;
  2382. switch (ext) {
  2383. case KVM_CAP_IRQCHIP:
  2384. case KVM_CAP_HLT:
  2385. case KVM_CAP_MMU_SHADOW_CACHE_CONTROL:
  2386. case KVM_CAP_SET_TSS_ADDR:
  2387. case KVM_CAP_EXT_CPUID:
  2388. case KVM_CAP_EXT_EMUL_CPUID:
  2389. case KVM_CAP_CLOCKSOURCE:
  2390. case KVM_CAP_PIT:
  2391. case KVM_CAP_NOP_IO_DELAY:
  2392. case KVM_CAP_MP_STATE:
  2393. case KVM_CAP_SYNC_MMU:
  2394. case KVM_CAP_USER_NMI:
  2395. case KVM_CAP_REINJECT_CONTROL:
  2396. case KVM_CAP_IRQ_INJECT_STATUS:
  2397. case KVM_CAP_IOEVENTFD:
  2398. case KVM_CAP_IOEVENTFD_NO_LENGTH:
  2399. case KVM_CAP_PIT2:
  2400. case KVM_CAP_PIT_STATE2:
  2401. case KVM_CAP_SET_IDENTITY_MAP_ADDR:
  2402. case KVM_CAP_XEN_HVM:
  2403. case KVM_CAP_ADJUST_CLOCK:
  2404. case KVM_CAP_VCPU_EVENTS:
  2405. case KVM_CAP_HYPERV:
  2406. case KVM_CAP_HYPERV_VAPIC:
  2407. case KVM_CAP_HYPERV_SPIN:
  2408. case KVM_CAP_PCI_SEGMENT:
  2409. case KVM_CAP_DEBUGREGS:
  2410. case KVM_CAP_X86_ROBUST_SINGLESTEP:
  2411. case KVM_CAP_XSAVE:
  2412. case KVM_CAP_ASYNC_PF:
  2413. case KVM_CAP_GET_TSC_KHZ:
  2414. case KVM_CAP_KVMCLOCK_CTRL:
  2415. case KVM_CAP_READONLY_MEM:
  2416. case KVM_CAP_HYPERV_TIME:
  2417. case KVM_CAP_IOAPIC_POLARITY_IGNORED:
  2418. case KVM_CAP_TSC_DEADLINE_TIMER:
  2419. #ifdef CONFIG_KVM_DEVICE_ASSIGNMENT
  2420. case KVM_CAP_ASSIGN_DEV_IRQ:
  2421. case KVM_CAP_PCI_2_3:
  2422. #endif
  2423. r = 1;
  2424. break;
  2425. case KVM_CAP_COALESCED_MMIO:
  2426. r = KVM_COALESCED_MMIO_PAGE_OFFSET;
  2427. break;
  2428. case KVM_CAP_VAPIC:
  2429. r = !kvm_x86_ops->cpu_has_accelerated_tpr();
  2430. break;
  2431. case KVM_CAP_NR_VCPUS:
  2432. r = KVM_SOFT_MAX_VCPUS;
  2433. break;
  2434. case KVM_CAP_MAX_VCPUS:
  2435. r = KVM_MAX_VCPUS;
  2436. break;
  2437. case KVM_CAP_NR_MEMSLOTS:
  2438. r = KVM_USER_MEM_SLOTS;
  2439. break;
  2440. case KVM_CAP_PV_MMU: /* obsolete */
  2441. r = 0;
  2442. break;
  2443. #ifdef CONFIG_KVM_DEVICE_ASSIGNMENT
  2444. case KVM_CAP_IOMMU:
  2445. r = iommu_present(&pci_bus_type);
  2446. break;
  2447. #endif
  2448. case KVM_CAP_MCE:
  2449. r = KVM_MAX_MCE_BANKS;
  2450. break;
  2451. case KVM_CAP_XCRS:
  2452. r = cpu_has_xsave;
  2453. break;
  2454. case KVM_CAP_TSC_CONTROL:
  2455. r = kvm_has_tsc_control;
  2456. break;
  2457. default:
  2458. r = 0;
  2459. break;
  2460. }
  2461. return r;
  2462. }
  2463. long kvm_arch_dev_ioctl(struct file *filp,
  2464. unsigned int ioctl, unsigned long arg)
  2465. {
  2466. void __user *argp = (void __user *)arg;
  2467. long r;
  2468. switch (ioctl) {
  2469. case KVM_GET_MSR_INDEX_LIST: {
  2470. struct kvm_msr_list __user *user_msr_list = argp;
  2471. struct kvm_msr_list msr_list;
  2472. unsigned n;
  2473. r = -EFAULT;
  2474. if (copy_from_user(&msr_list, user_msr_list, sizeof msr_list))
  2475. goto out;
  2476. n = msr_list.nmsrs;
  2477. msr_list.nmsrs = num_msrs_to_save + ARRAY_SIZE(emulated_msrs);
  2478. if (copy_to_user(user_msr_list, &msr_list, sizeof msr_list))
  2479. goto out;
  2480. r = -E2BIG;
  2481. if (n < msr_list.nmsrs)
  2482. goto out;
  2483. r = -EFAULT;
  2484. if (copy_to_user(user_msr_list->indices, &msrs_to_save,
  2485. num_msrs_to_save * sizeof(u32)))
  2486. goto out;
  2487. if (copy_to_user(user_msr_list->indices + num_msrs_to_save,
  2488. &emulated_msrs,
  2489. ARRAY_SIZE(emulated_msrs) * sizeof(u32)))
  2490. goto out;
  2491. r = 0;
  2492. break;
  2493. }
  2494. case KVM_GET_SUPPORTED_CPUID:
  2495. case KVM_GET_EMULATED_CPUID: {
  2496. struct kvm_cpuid2 __user *cpuid_arg = argp;
  2497. struct kvm_cpuid2 cpuid;
  2498. r = -EFAULT;
  2499. if (copy_from_user(&cpuid, cpuid_arg, sizeof cpuid))
  2500. goto out;
  2501. r = kvm_dev_ioctl_get_cpuid(&cpuid, cpuid_arg->entries,
  2502. ioctl);
  2503. if (r)
  2504. goto out;
  2505. r = -EFAULT;
  2506. if (copy_to_user(cpuid_arg, &cpuid, sizeof cpuid))
  2507. goto out;
  2508. r = 0;
  2509. break;
  2510. }
  2511. case KVM_X86_GET_MCE_CAP_SUPPORTED: {
  2512. u64 mce_cap;
  2513. mce_cap = KVM_MCE_CAP_SUPPORTED;
  2514. r = -EFAULT;
  2515. if (copy_to_user(argp, &mce_cap, sizeof mce_cap))
  2516. goto out;
  2517. r = 0;
  2518. break;
  2519. }
  2520. default:
  2521. r = -EINVAL;
  2522. }
  2523. out:
  2524. return r;
  2525. }
  2526. static void wbinvd_ipi(void *garbage)
  2527. {
  2528. wbinvd();
  2529. }
  2530. static bool need_emulate_wbinvd(struct kvm_vcpu *vcpu)
  2531. {
  2532. return kvm_arch_has_noncoherent_dma(vcpu->kvm);
  2533. }
  2534. void kvm_arch_vcpu_load(struct kvm_vcpu *vcpu, int cpu)
  2535. {
  2536. /* Address WBINVD may be executed by guest */
  2537. if (need_emulate_wbinvd(vcpu)) {
  2538. if (kvm_x86_ops->has_wbinvd_exit())
  2539. cpumask_set_cpu(cpu, vcpu->arch.wbinvd_dirty_mask);
  2540. else if (vcpu->cpu != -1 && vcpu->cpu != cpu)
  2541. smp_call_function_single(vcpu->cpu,
  2542. wbinvd_ipi, NULL, 1);
  2543. }
  2544. kvm_x86_ops->vcpu_load(vcpu, cpu);
  2545. /* Apply any externally detected TSC adjustments (due to suspend) */
  2546. if (unlikely(vcpu->arch.tsc_offset_adjustment)) {
  2547. adjust_tsc_offset_host(vcpu, vcpu->arch.tsc_offset_adjustment);
  2548. vcpu->arch.tsc_offset_adjustment = 0;
  2549. kvm_make_request(KVM_REQ_CLOCK_UPDATE, vcpu);
  2550. }
  2551. if (unlikely(vcpu->cpu != cpu) || check_tsc_unstable()) {
  2552. s64 tsc_delta = !vcpu->arch.last_host_tsc ? 0 :
  2553. native_read_tsc() - vcpu->arch.last_host_tsc;
  2554. if (tsc_delta < 0)
  2555. mark_tsc_unstable("KVM discovered backwards TSC");
  2556. if (check_tsc_unstable()) {
  2557. u64 offset = kvm_x86_ops->compute_tsc_offset(vcpu,
  2558. vcpu->arch.last_guest_tsc);
  2559. kvm_x86_ops->write_tsc_offset(vcpu, offset);
  2560. vcpu->arch.tsc_catchup = 1;
  2561. }
  2562. /*
  2563. * On a host with synchronized TSC, there is no need to update
  2564. * kvmclock on vcpu->cpu migration
  2565. */
  2566. if (!vcpu->kvm->arch.use_master_clock || vcpu->cpu == -1)
  2567. kvm_make_request(KVM_REQ_GLOBAL_CLOCK_UPDATE, vcpu);
  2568. if (vcpu->cpu != cpu)
  2569. kvm_migrate_timers(vcpu);
  2570. vcpu->cpu = cpu;
  2571. }
  2572. accumulate_steal_time(vcpu);
  2573. kvm_make_request(KVM_REQ_STEAL_UPDATE, vcpu);
  2574. }
  2575. void kvm_arch_vcpu_put(struct kvm_vcpu *vcpu)
  2576. {
  2577. kvm_x86_ops->vcpu_put(vcpu);
  2578. kvm_put_guest_fpu(vcpu);
  2579. vcpu->arch.last_host_tsc = native_read_tsc();
  2580. }
  2581. static int kvm_vcpu_ioctl_get_lapic(struct kvm_vcpu *vcpu,
  2582. struct kvm_lapic_state *s)
  2583. {
  2584. kvm_x86_ops->sync_pir_to_irr(vcpu);
  2585. memcpy(s->regs, vcpu->arch.apic->regs, sizeof *s);
  2586. return 0;
  2587. }
  2588. static int kvm_vcpu_ioctl_set_lapic(struct kvm_vcpu *vcpu,
  2589. struct kvm_lapic_state *s)
  2590. {
  2591. kvm_apic_post_state_restore(vcpu, s);
  2592. update_cr8_intercept(vcpu);
  2593. return 0;
  2594. }
  2595. static int kvm_vcpu_ioctl_interrupt(struct kvm_vcpu *vcpu,
  2596. struct kvm_interrupt *irq)
  2597. {
  2598. if (irq->irq >= KVM_NR_INTERRUPTS)
  2599. return -EINVAL;
  2600. if (irqchip_in_kernel(vcpu->kvm))
  2601. return -ENXIO;
  2602. kvm_queue_interrupt(vcpu, irq->irq, false);
  2603. kvm_make_request(KVM_REQ_EVENT, vcpu);
  2604. return 0;
  2605. }
  2606. static int kvm_vcpu_ioctl_nmi(struct kvm_vcpu *vcpu)
  2607. {
  2608. kvm_inject_nmi(vcpu);
  2609. return 0;
  2610. }
  2611. static int vcpu_ioctl_tpr_access_reporting(struct kvm_vcpu *vcpu,
  2612. struct kvm_tpr_access_ctl *tac)
  2613. {
  2614. if (tac->flags)
  2615. return -EINVAL;
  2616. vcpu->arch.tpr_access_reporting = !!tac->enabled;
  2617. return 0;
  2618. }
  2619. static int kvm_vcpu_ioctl_x86_setup_mce(struct kvm_vcpu *vcpu,
  2620. u64 mcg_cap)
  2621. {
  2622. int r;
  2623. unsigned bank_num = mcg_cap & 0xff, bank;
  2624. r = -EINVAL;
  2625. if (!bank_num || bank_num >= KVM_MAX_MCE_BANKS)
  2626. goto out;
  2627. if (mcg_cap & ~(KVM_MCE_CAP_SUPPORTED | 0xff | 0xff0000))
  2628. goto out;
  2629. r = 0;
  2630. vcpu->arch.mcg_cap = mcg_cap;
  2631. /* Init IA32_MCG_CTL to all 1s */
  2632. if (mcg_cap & MCG_CTL_P)
  2633. vcpu->arch.mcg_ctl = ~(u64)0;
  2634. /* Init IA32_MCi_CTL to all 1s */
  2635. for (bank = 0; bank < bank_num; bank++)
  2636. vcpu->arch.mce_banks[bank*4] = ~(u64)0;
  2637. out:
  2638. return r;
  2639. }
  2640. static int kvm_vcpu_ioctl_x86_set_mce(struct kvm_vcpu *vcpu,
  2641. struct kvm_x86_mce *mce)
  2642. {
  2643. u64 mcg_cap = vcpu->arch.mcg_cap;
  2644. unsigned bank_num = mcg_cap & 0xff;
  2645. u64 *banks = vcpu->arch.mce_banks;
  2646. if (mce->bank >= bank_num || !(mce->status & MCI_STATUS_VAL))
  2647. return -EINVAL;
  2648. /*
  2649. * if IA32_MCG_CTL is not all 1s, the uncorrected error
  2650. * reporting is disabled
  2651. */
  2652. if ((mce->status & MCI_STATUS_UC) && (mcg_cap & MCG_CTL_P) &&
  2653. vcpu->arch.mcg_ctl != ~(u64)0)
  2654. return 0;
  2655. banks += 4 * mce->bank;
  2656. /*
  2657. * if IA32_MCi_CTL is not all 1s, the uncorrected error
  2658. * reporting is disabled for the bank
  2659. */
  2660. if ((mce->status & MCI_STATUS_UC) && banks[0] != ~(u64)0)
  2661. return 0;
  2662. if (mce->status & MCI_STATUS_UC) {
  2663. if ((vcpu->arch.mcg_status & MCG_STATUS_MCIP) ||
  2664. !kvm_read_cr4_bits(vcpu, X86_CR4_MCE)) {
  2665. kvm_make_request(KVM_REQ_TRIPLE_FAULT, vcpu);
  2666. return 0;
  2667. }
  2668. if (banks[1] & MCI_STATUS_VAL)
  2669. mce->status |= MCI_STATUS_OVER;
  2670. banks[2] = mce->addr;
  2671. banks[3] = mce->misc;
  2672. vcpu->arch.mcg_status = mce->mcg_status;
  2673. banks[1] = mce->status;
  2674. kvm_queue_exception(vcpu, MC_VECTOR);
  2675. } else if (!(banks[1] & MCI_STATUS_VAL)
  2676. || !(banks[1] & MCI_STATUS_UC)) {
  2677. if (banks[1] & MCI_STATUS_VAL)
  2678. mce->status |= MCI_STATUS_OVER;
  2679. banks[2] = mce->addr;
  2680. banks[3] = mce->misc;
  2681. banks[1] = mce->status;
  2682. } else
  2683. banks[1] |= MCI_STATUS_OVER;
  2684. return 0;
  2685. }
  2686. static void kvm_vcpu_ioctl_x86_get_vcpu_events(struct kvm_vcpu *vcpu,
  2687. struct kvm_vcpu_events *events)
  2688. {
  2689. process_nmi(vcpu);
  2690. events->exception.injected =
  2691. vcpu->arch.exception.pending &&
  2692. !kvm_exception_is_soft(vcpu->arch.exception.nr);
  2693. events->exception.nr = vcpu->arch.exception.nr;
  2694. events->exception.has_error_code = vcpu->arch.exception.has_error_code;
  2695. events->exception.pad = 0;
  2696. events->exception.error_code = vcpu->arch.exception.error_code;
  2697. events->interrupt.injected =
  2698. vcpu->arch.interrupt.pending && !vcpu->arch.interrupt.soft;
  2699. events->interrupt.nr = vcpu->arch.interrupt.nr;
  2700. events->interrupt.soft = 0;
  2701. events->interrupt.shadow = kvm_x86_ops->get_interrupt_shadow(vcpu);
  2702. events->nmi.injected = vcpu->arch.nmi_injected;
  2703. events->nmi.pending = vcpu->arch.nmi_pending != 0;
  2704. events->nmi.masked = kvm_x86_ops->get_nmi_mask(vcpu);
  2705. events->nmi.pad = 0;
  2706. events->sipi_vector = 0; /* never valid when reporting to user space */
  2707. events->flags = (KVM_VCPUEVENT_VALID_NMI_PENDING
  2708. | KVM_VCPUEVENT_VALID_SHADOW);
  2709. memset(&events->reserved, 0, sizeof(events->reserved));
  2710. }
  2711. static int kvm_vcpu_ioctl_x86_set_vcpu_events(struct kvm_vcpu *vcpu,
  2712. struct kvm_vcpu_events *events)
  2713. {
  2714. if (events->flags & ~(KVM_VCPUEVENT_VALID_NMI_PENDING
  2715. | KVM_VCPUEVENT_VALID_SIPI_VECTOR
  2716. | KVM_VCPUEVENT_VALID_SHADOW))
  2717. return -EINVAL;
  2718. process_nmi(vcpu);
  2719. vcpu->arch.exception.pending = events->exception.injected;
  2720. vcpu->arch.exception.nr = events->exception.nr;
  2721. vcpu->arch.exception.has_error_code = events->exception.has_error_code;
  2722. vcpu->arch.exception.error_code = events->exception.error_code;
  2723. vcpu->arch.interrupt.pending = events->interrupt.injected;
  2724. vcpu->arch.interrupt.nr = events->interrupt.nr;
  2725. vcpu->arch.interrupt.soft = events->interrupt.soft;
  2726. if (events->flags & KVM_VCPUEVENT_VALID_SHADOW)
  2727. kvm_x86_ops->set_interrupt_shadow(vcpu,
  2728. events->interrupt.shadow);
  2729. vcpu->arch.nmi_injected = events->nmi.injected;
  2730. if (events->flags & KVM_VCPUEVENT_VALID_NMI_PENDING)
  2731. vcpu->arch.nmi_pending = events->nmi.pending;
  2732. kvm_x86_ops->set_nmi_mask(vcpu, events->nmi.masked);
  2733. if (events->flags & KVM_VCPUEVENT_VALID_SIPI_VECTOR &&
  2734. kvm_vcpu_has_lapic(vcpu))
  2735. vcpu->arch.apic->sipi_vector = events->sipi_vector;
  2736. kvm_make_request(KVM_REQ_EVENT, vcpu);
  2737. return 0;
  2738. }
  2739. static void kvm_vcpu_ioctl_x86_get_debugregs(struct kvm_vcpu *vcpu,
  2740. struct kvm_debugregs *dbgregs)
  2741. {
  2742. unsigned long val;
  2743. memcpy(dbgregs->db, vcpu->arch.db, sizeof(vcpu->arch.db));
  2744. kvm_get_dr(vcpu, 6, &val);
  2745. dbgregs->dr6 = val;
  2746. dbgregs->dr7 = vcpu->arch.dr7;
  2747. dbgregs->flags = 0;
  2748. memset(&dbgregs->reserved, 0, sizeof(dbgregs->reserved));
  2749. }
  2750. static int kvm_vcpu_ioctl_x86_set_debugregs(struct kvm_vcpu *vcpu,
  2751. struct kvm_debugregs *dbgregs)
  2752. {
  2753. if (dbgregs->flags)
  2754. return -EINVAL;
  2755. memcpy(vcpu->arch.db, dbgregs->db, sizeof(vcpu->arch.db));
  2756. kvm_update_dr0123(vcpu);
  2757. vcpu->arch.dr6 = dbgregs->dr6;
  2758. kvm_update_dr6(vcpu);
  2759. vcpu->arch.dr7 = dbgregs->dr7;
  2760. kvm_update_dr7(vcpu);
  2761. return 0;
  2762. }
  2763. #define XSTATE_COMPACTION_ENABLED (1ULL << 63)
  2764. static void fill_xsave(u8 *dest, struct kvm_vcpu *vcpu)
  2765. {
  2766. struct xsave_struct *xsave = &vcpu->arch.guest_fpu.state->xsave;
  2767. u64 xstate_bv = xsave->xsave_hdr.xstate_bv;
  2768. u64 valid;
  2769. /*
  2770. * Copy legacy XSAVE area, to avoid complications with CPUID
  2771. * leaves 0 and 1 in the loop below.
  2772. */
  2773. memcpy(dest, xsave, XSAVE_HDR_OFFSET);
  2774. /* Set XSTATE_BV */
  2775. *(u64 *)(dest + XSAVE_HDR_OFFSET) = xstate_bv;
  2776. /*
  2777. * Copy each region from the possibly compacted offset to the
  2778. * non-compacted offset.
  2779. */
  2780. valid = xstate_bv & ~XSTATE_FPSSE;
  2781. while (valid) {
  2782. u64 feature = valid & -valid;
  2783. int index = fls64(feature) - 1;
  2784. void *src = get_xsave_addr(xsave, feature);
  2785. if (src) {
  2786. u32 size, offset, ecx, edx;
  2787. cpuid_count(XSTATE_CPUID, index,
  2788. &size, &offset, &ecx, &edx);
  2789. memcpy(dest + offset, src, size);
  2790. }
  2791. valid -= feature;
  2792. }
  2793. }
  2794. static void load_xsave(struct kvm_vcpu *vcpu, u8 *src)
  2795. {
  2796. struct xsave_struct *xsave = &vcpu->arch.guest_fpu.state->xsave;
  2797. u64 xstate_bv = *(u64 *)(src + XSAVE_HDR_OFFSET);
  2798. u64 valid;
  2799. /*
  2800. * Copy legacy XSAVE area, to avoid complications with CPUID
  2801. * leaves 0 and 1 in the loop below.
  2802. */
  2803. memcpy(xsave, src, XSAVE_HDR_OFFSET);
  2804. /* Set XSTATE_BV and possibly XCOMP_BV. */
  2805. xsave->xsave_hdr.xstate_bv = xstate_bv;
  2806. if (cpu_has_xsaves)
  2807. xsave->xsave_hdr.xcomp_bv = host_xcr0 | XSTATE_COMPACTION_ENABLED;
  2808. /*
  2809. * Copy each region from the non-compacted offset to the
  2810. * possibly compacted offset.
  2811. */
  2812. valid = xstate_bv & ~XSTATE_FPSSE;
  2813. while (valid) {
  2814. u64 feature = valid & -valid;
  2815. int index = fls64(feature) - 1;
  2816. void *dest = get_xsave_addr(xsave, feature);
  2817. if (dest) {
  2818. u32 size, offset, ecx, edx;
  2819. cpuid_count(XSTATE_CPUID, index,
  2820. &size, &offset, &ecx, &edx);
  2821. memcpy(dest, src + offset, size);
  2822. } else
  2823. WARN_ON_ONCE(1);
  2824. valid -= feature;
  2825. }
  2826. }
  2827. static void kvm_vcpu_ioctl_x86_get_xsave(struct kvm_vcpu *vcpu,
  2828. struct kvm_xsave *guest_xsave)
  2829. {
  2830. if (cpu_has_xsave) {
  2831. memset(guest_xsave, 0, sizeof(struct kvm_xsave));
  2832. fill_xsave((u8 *) guest_xsave->region, vcpu);
  2833. } else {
  2834. memcpy(guest_xsave->region,
  2835. &vcpu->arch.guest_fpu.state->fxsave,
  2836. sizeof(struct i387_fxsave_struct));
  2837. *(u64 *)&guest_xsave->region[XSAVE_HDR_OFFSET / sizeof(u32)] =
  2838. XSTATE_FPSSE;
  2839. }
  2840. }
  2841. static int kvm_vcpu_ioctl_x86_set_xsave(struct kvm_vcpu *vcpu,
  2842. struct kvm_xsave *guest_xsave)
  2843. {
  2844. u64 xstate_bv =
  2845. *(u64 *)&guest_xsave->region[XSAVE_HDR_OFFSET / sizeof(u32)];
  2846. if (cpu_has_xsave) {
  2847. /*
  2848. * Here we allow setting states that are not present in
  2849. * CPUID leaf 0xD, index 0, EDX:EAX. This is for compatibility
  2850. * with old userspace.
  2851. */
  2852. if (xstate_bv & ~kvm_supported_xcr0())
  2853. return -EINVAL;
  2854. load_xsave(vcpu, (u8 *)guest_xsave->region);
  2855. } else {
  2856. if (xstate_bv & ~XSTATE_FPSSE)
  2857. return -EINVAL;
  2858. memcpy(&vcpu->arch.guest_fpu.state->fxsave,
  2859. guest_xsave->region, sizeof(struct i387_fxsave_struct));
  2860. }
  2861. return 0;
  2862. }
  2863. static void kvm_vcpu_ioctl_x86_get_xcrs(struct kvm_vcpu *vcpu,
  2864. struct kvm_xcrs *guest_xcrs)
  2865. {
  2866. if (!cpu_has_xsave) {
  2867. guest_xcrs->nr_xcrs = 0;
  2868. return;
  2869. }
  2870. guest_xcrs->nr_xcrs = 1;
  2871. guest_xcrs->flags = 0;
  2872. guest_xcrs->xcrs[0].xcr = XCR_XFEATURE_ENABLED_MASK;
  2873. guest_xcrs->xcrs[0].value = vcpu->arch.xcr0;
  2874. }
  2875. static int kvm_vcpu_ioctl_x86_set_xcrs(struct kvm_vcpu *vcpu,
  2876. struct kvm_xcrs *guest_xcrs)
  2877. {
  2878. int i, r = 0;
  2879. if (!cpu_has_xsave)
  2880. return -EINVAL;
  2881. if (guest_xcrs->nr_xcrs > KVM_MAX_XCRS || guest_xcrs->flags)
  2882. return -EINVAL;
  2883. for (i = 0; i < guest_xcrs->nr_xcrs; i++)
  2884. /* Only support XCR0 currently */
  2885. if (guest_xcrs->xcrs[i].xcr == XCR_XFEATURE_ENABLED_MASK) {
  2886. r = __kvm_set_xcr(vcpu, XCR_XFEATURE_ENABLED_MASK,
  2887. guest_xcrs->xcrs[i].value);
  2888. break;
  2889. }
  2890. if (r)
  2891. r = -EINVAL;
  2892. return r;
  2893. }
  2894. /*
  2895. * kvm_set_guest_paused() indicates to the guest kernel that it has been
  2896. * stopped by the hypervisor. This function will be called from the host only.
  2897. * EINVAL is returned when the host attempts to set the flag for a guest that
  2898. * does not support pv clocks.
  2899. */
  2900. static int kvm_set_guest_paused(struct kvm_vcpu *vcpu)
  2901. {
  2902. if (!vcpu->arch.pv_time_enabled)
  2903. return -EINVAL;
  2904. vcpu->arch.pvclock_set_guest_stopped_request = true;
  2905. kvm_make_request(KVM_REQ_CLOCK_UPDATE, vcpu);
  2906. return 0;
  2907. }
  2908. long kvm_arch_vcpu_ioctl(struct file *filp,
  2909. unsigned int ioctl, unsigned long arg)
  2910. {
  2911. struct kvm_vcpu *vcpu = filp->private_data;
  2912. void __user *argp = (void __user *)arg;
  2913. int r;
  2914. union {
  2915. struct kvm_lapic_state *lapic;
  2916. struct kvm_xsave *xsave;
  2917. struct kvm_xcrs *xcrs;
  2918. void *buffer;
  2919. } u;
  2920. u.buffer = NULL;
  2921. switch (ioctl) {
  2922. case KVM_GET_LAPIC: {
  2923. r = -EINVAL;
  2924. if (!vcpu->arch.apic)
  2925. goto out;
  2926. u.lapic = kzalloc(sizeof(struct kvm_lapic_state), GFP_KERNEL);
  2927. r = -ENOMEM;
  2928. if (!u.lapic)
  2929. goto out;
  2930. r = kvm_vcpu_ioctl_get_lapic(vcpu, u.lapic);
  2931. if (r)
  2932. goto out;
  2933. r = -EFAULT;
  2934. if (copy_to_user(argp, u.lapic, sizeof(struct kvm_lapic_state)))
  2935. goto out;
  2936. r = 0;
  2937. break;
  2938. }
  2939. case KVM_SET_LAPIC: {
  2940. r = -EINVAL;
  2941. if (!vcpu->arch.apic)
  2942. goto out;
  2943. u.lapic = memdup_user(argp, sizeof(*u.lapic));
  2944. if (IS_ERR(u.lapic))
  2945. return PTR_ERR(u.lapic);
  2946. r = kvm_vcpu_ioctl_set_lapic(vcpu, u.lapic);
  2947. break;
  2948. }
  2949. case KVM_INTERRUPT: {
  2950. struct kvm_interrupt irq;
  2951. r = -EFAULT;
  2952. if (copy_from_user(&irq, argp, sizeof irq))
  2953. goto out;
  2954. r = kvm_vcpu_ioctl_interrupt(vcpu, &irq);
  2955. break;
  2956. }
  2957. case KVM_NMI: {
  2958. r = kvm_vcpu_ioctl_nmi(vcpu);
  2959. break;
  2960. }
  2961. case KVM_SET_CPUID: {
  2962. struct kvm_cpuid __user *cpuid_arg = argp;
  2963. struct kvm_cpuid cpuid;
  2964. r = -EFAULT;
  2965. if (copy_from_user(&cpuid, cpuid_arg, sizeof cpuid))
  2966. goto out;
  2967. r = kvm_vcpu_ioctl_set_cpuid(vcpu, &cpuid, cpuid_arg->entries);
  2968. break;
  2969. }
  2970. case KVM_SET_CPUID2: {
  2971. struct kvm_cpuid2 __user *cpuid_arg = argp;
  2972. struct kvm_cpuid2 cpuid;
  2973. r = -EFAULT;
  2974. if (copy_from_user(&cpuid, cpuid_arg, sizeof cpuid))
  2975. goto out;
  2976. r = kvm_vcpu_ioctl_set_cpuid2(vcpu, &cpuid,
  2977. cpuid_arg->entries);
  2978. break;
  2979. }
  2980. case KVM_GET_CPUID2: {
  2981. struct kvm_cpuid2 __user *cpuid_arg = argp;
  2982. struct kvm_cpuid2 cpuid;
  2983. r = -EFAULT;
  2984. if (copy_from_user(&cpuid, cpuid_arg, sizeof cpuid))
  2985. goto out;
  2986. r = kvm_vcpu_ioctl_get_cpuid2(vcpu, &cpuid,
  2987. cpuid_arg->entries);
  2988. if (r)
  2989. goto out;
  2990. r = -EFAULT;
  2991. if (copy_to_user(cpuid_arg, &cpuid, sizeof cpuid))
  2992. goto out;
  2993. r = 0;
  2994. break;
  2995. }
  2996. case KVM_GET_MSRS:
  2997. r = msr_io(vcpu, argp, kvm_get_msr, 1);
  2998. break;
  2999. case KVM_SET_MSRS:
  3000. r = msr_io(vcpu, argp, do_set_msr, 0);
  3001. break;
  3002. case KVM_TPR_ACCESS_REPORTING: {
  3003. struct kvm_tpr_access_ctl tac;
  3004. r = -EFAULT;
  3005. if (copy_from_user(&tac, argp, sizeof tac))
  3006. goto out;
  3007. r = vcpu_ioctl_tpr_access_reporting(vcpu, &tac);
  3008. if (r)
  3009. goto out;
  3010. r = -EFAULT;
  3011. if (copy_to_user(argp, &tac, sizeof tac))
  3012. goto out;
  3013. r = 0;
  3014. break;
  3015. };
  3016. case KVM_SET_VAPIC_ADDR: {
  3017. struct kvm_vapic_addr va;
  3018. r = -EINVAL;
  3019. if (!irqchip_in_kernel(vcpu->kvm))
  3020. goto out;
  3021. r = -EFAULT;
  3022. if (copy_from_user(&va, argp, sizeof va))
  3023. goto out;
  3024. r = kvm_lapic_set_vapic_addr(vcpu, va.vapic_addr);
  3025. break;
  3026. }
  3027. case KVM_X86_SETUP_MCE: {
  3028. u64 mcg_cap;
  3029. r = -EFAULT;
  3030. if (copy_from_user(&mcg_cap, argp, sizeof mcg_cap))
  3031. goto out;
  3032. r = kvm_vcpu_ioctl_x86_setup_mce(vcpu, mcg_cap);
  3033. break;
  3034. }
  3035. case KVM_X86_SET_MCE: {
  3036. struct kvm_x86_mce mce;
  3037. r = -EFAULT;
  3038. if (copy_from_user(&mce, argp, sizeof mce))
  3039. goto out;
  3040. r = kvm_vcpu_ioctl_x86_set_mce(vcpu, &mce);
  3041. break;
  3042. }
  3043. case KVM_GET_VCPU_EVENTS: {
  3044. struct kvm_vcpu_events events;
  3045. kvm_vcpu_ioctl_x86_get_vcpu_events(vcpu, &events);
  3046. r = -EFAULT;
  3047. if (copy_to_user(argp, &events, sizeof(struct kvm_vcpu_events)))
  3048. break;
  3049. r = 0;
  3050. break;
  3051. }
  3052. case KVM_SET_VCPU_EVENTS: {
  3053. struct kvm_vcpu_events events;
  3054. r = -EFAULT;
  3055. if (copy_from_user(&events, argp, sizeof(struct kvm_vcpu_events)))
  3056. break;
  3057. r = kvm_vcpu_ioctl_x86_set_vcpu_events(vcpu, &events);
  3058. break;
  3059. }
  3060. case KVM_GET_DEBUGREGS: {
  3061. struct kvm_debugregs dbgregs;
  3062. kvm_vcpu_ioctl_x86_get_debugregs(vcpu, &dbgregs);
  3063. r = -EFAULT;
  3064. if (copy_to_user(argp, &dbgregs,
  3065. sizeof(struct kvm_debugregs)))
  3066. break;
  3067. r = 0;
  3068. break;
  3069. }
  3070. case KVM_SET_DEBUGREGS: {
  3071. struct kvm_debugregs dbgregs;
  3072. r = -EFAULT;
  3073. if (copy_from_user(&dbgregs, argp,
  3074. sizeof(struct kvm_debugregs)))
  3075. break;
  3076. r = kvm_vcpu_ioctl_x86_set_debugregs(vcpu, &dbgregs);
  3077. break;
  3078. }
  3079. case KVM_GET_XSAVE: {
  3080. u.xsave = kzalloc(sizeof(struct kvm_xsave), GFP_KERNEL);
  3081. r = -ENOMEM;
  3082. if (!u.xsave)
  3083. break;
  3084. kvm_vcpu_ioctl_x86_get_xsave(vcpu, u.xsave);
  3085. r = -EFAULT;
  3086. if (copy_to_user(argp, u.xsave, sizeof(struct kvm_xsave)))
  3087. break;
  3088. r = 0;
  3089. break;
  3090. }
  3091. case KVM_SET_XSAVE: {
  3092. u.xsave = memdup_user(argp, sizeof(*u.xsave));
  3093. if (IS_ERR(u.xsave))
  3094. return PTR_ERR(u.xsave);
  3095. r = kvm_vcpu_ioctl_x86_set_xsave(vcpu, u.xsave);
  3096. break;
  3097. }
  3098. case KVM_GET_XCRS: {
  3099. u.xcrs = kzalloc(sizeof(struct kvm_xcrs), GFP_KERNEL);
  3100. r = -ENOMEM;
  3101. if (!u.xcrs)
  3102. break;
  3103. kvm_vcpu_ioctl_x86_get_xcrs(vcpu, u.xcrs);
  3104. r = -EFAULT;
  3105. if (copy_to_user(argp, u.xcrs,
  3106. sizeof(struct kvm_xcrs)))
  3107. break;
  3108. r = 0;
  3109. break;
  3110. }
  3111. case KVM_SET_XCRS: {
  3112. u.xcrs = memdup_user(argp, sizeof(*u.xcrs));
  3113. if (IS_ERR(u.xcrs))
  3114. return PTR_ERR(u.xcrs);
  3115. r = kvm_vcpu_ioctl_x86_set_xcrs(vcpu, u.xcrs);
  3116. break;
  3117. }
  3118. case KVM_SET_TSC_KHZ: {
  3119. u32 user_tsc_khz;
  3120. r = -EINVAL;
  3121. user_tsc_khz = (u32)arg;
  3122. if (user_tsc_khz >= kvm_max_guest_tsc_khz)
  3123. goto out;
  3124. if (user_tsc_khz == 0)
  3125. user_tsc_khz = tsc_khz;
  3126. kvm_set_tsc_khz(vcpu, user_tsc_khz);
  3127. r = 0;
  3128. goto out;
  3129. }
  3130. case KVM_GET_TSC_KHZ: {
  3131. r = vcpu->arch.virtual_tsc_khz;
  3132. goto out;
  3133. }
  3134. case KVM_KVMCLOCK_CTRL: {
  3135. r = kvm_set_guest_paused(vcpu);
  3136. goto out;
  3137. }
  3138. default:
  3139. r = -EINVAL;
  3140. }
  3141. out:
  3142. kfree(u.buffer);
  3143. return r;
  3144. }
  3145. int kvm_arch_vcpu_fault(struct kvm_vcpu *vcpu, struct vm_fault *vmf)
  3146. {
  3147. return VM_FAULT_SIGBUS;
  3148. }
  3149. static int kvm_vm_ioctl_set_tss_addr(struct kvm *kvm, unsigned long addr)
  3150. {
  3151. int ret;
  3152. if (addr > (unsigned int)(-3 * PAGE_SIZE))
  3153. return -EINVAL;
  3154. ret = kvm_x86_ops->set_tss_addr(kvm, addr);
  3155. return ret;
  3156. }
  3157. static int kvm_vm_ioctl_set_identity_map_addr(struct kvm *kvm,
  3158. u64 ident_addr)
  3159. {
  3160. kvm->arch.ept_identity_map_addr = ident_addr;
  3161. return 0;
  3162. }
  3163. static int kvm_vm_ioctl_set_nr_mmu_pages(struct kvm *kvm,
  3164. u32 kvm_nr_mmu_pages)
  3165. {
  3166. if (kvm_nr_mmu_pages < KVM_MIN_ALLOC_MMU_PAGES)
  3167. return -EINVAL;
  3168. mutex_lock(&kvm->slots_lock);
  3169. kvm_mmu_change_mmu_pages(kvm, kvm_nr_mmu_pages);
  3170. kvm->arch.n_requested_mmu_pages = kvm_nr_mmu_pages;
  3171. mutex_unlock(&kvm->slots_lock);
  3172. return 0;
  3173. }
  3174. static int kvm_vm_ioctl_get_nr_mmu_pages(struct kvm *kvm)
  3175. {
  3176. return kvm->arch.n_max_mmu_pages;
  3177. }
  3178. static int kvm_vm_ioctl_get_irqchip(struct kvm *kvm, struct kvm_irqchip *chip)
  3179. {
  3180. int r;
  3181. r = 0;
  3182. switch (chip->chip_id) {
  3183. case KVM_IRQCHIP_PIC_MASTER:
  3184. memcpy(&chip->chip.pic,
  3185. &pic_irqchip(kvm)->pics[0],
  3186. sizeof(struct kvm_pic_state));
  3187. break;
  3188. case KVM_IRQCHIP_PIC_SLAVE:
  3189. memcpy(&chip->chip.pic,
  3190. &pic_irqchip(kvm)->pics[1],
  3191. sizeof(struct kvm_pic_state));
  3192. break;
  3193. case KVM_IRQCHIP_IOAPIC:
  3194. r = kvm_get_ioapic(kvm, &chip->chip.ioapic);
  3195. break;
  3196. default:
  3197. r = -EINVAL;
  3198. break;
  3199. }
  3200. return r;
  3201. }
  3202. static int kvm_vm_ioctl_set_irqchip(struct kvm *kvm, struct kvm_irqchip *chip)
  3203. {
  3204. int r;
  3205. r = 0;
  3206. switch (chip->chip_id) {
  3207. case KVM_IRQCHIP_PIC_MASTER:
  3208. spin_lock(&pic_irqchip(kvm)->lock);
  3209. memcpy(&pic_irqchip(kvm)->pics[0],
  3210. &chip->chip.pic,
  3211. sizeof(struct kvm_pic_state));
  3212. spin_unlock(&pic_irqchip(kvm)->lock);
  3213. break;
  3214. case KVM_IRQCHIP_PIC_SLAVE:
  3215. spin_lock(&pic_irqchip(kvm)->lock);
  3216. memcpy(&pic_irqchip(kvm)->pics[1],
  3217. &chip->chip.pic,
  3218. sizeof(struct kvm_pic_state));
  3219. spin_unlock(&pic_irqchip(kvm)->lock);
  3220. break;
  3221. case KVM_IRQCHIP_IOAPIC:
  3222. r = kvm_set_ioapic(kvm, &chip->chip.ioapic);
  3223. break;
  3224. default:
  3225. r = -EINVAL;
  3226. break;
  3227. }
  3228. kvm_pic_update_irq(pic_irqchip(kvm));
  3229. return r;
  3230. }
  3231. static int kvm_vm_ioctl_get_pit(struct kvm *kvm, struct kvm_pit_state *ps)
  3232. {
  3233. int r = 0;
  3234. mutex_lock(&kvm->arch.vpit->pit_state.lock);
  3235. memcpy(ps, &kvm->arch.vpit->pit_state, sizeof(struct kvm_pit_state));
  3236. mutex_unlock(&kvm->arch.vpit->pit_state.lock);
  3237. return r;
  3238. }
  3239. static int kvm_vm_ioctl_set_pit(struct kvm *kvm, struct kvm_pit_state *ps)
  3240. {
  3241. int r = 0;
  3242. mutex_lock(&kvm->arch.vpit->pit_state.lock);
  3243. memcpy(&kvm->arch.vpit->pit_state, ps, sizeof(struct kvm_pit_state));
  3244. kvm_pit_load_count(kvm, 0, ps->channels[0].count, 0);
  3245. mutex_unlock(&kvm->arch.vpit->pit_state.lock);
  3246. return r;
  3247. }
  3248. static int kvm_vm_ioctl_get_pit2(struct kvm *kvm, struct kvm_pit_state2 *ps)
  3249. {
  3250. int r = 0;
  3251. mutex_lock(&kvm->arch.vpit->pit_state.lock);
  3252. memcpy(ps->channels, &kvm->arch.vpit->pit_state.channels,
  3253. sizeof(ps->channels));
  3254. ps->flags = kvm->arch.vpit->pit_state.flags;
  3255. mutex_unlock(&kvm->arch.vpit->pit_state.lock);
  3256. memset(&ps->reserved, 0, sizeof(ps->reserved));
  3257. return r;
  3258. }
  3259. static int kvm_vm_ioctl_set_pit2(struct kvm *kvm, struct kvm_pit_state2 *ps)
  3260. {
  3261. int r = 0, start = 0;
  3262. u32 prev_legacy, cur_legacy;
  3263. mutex_lock(&kvm->arch.vpit->pit_state.lock);
  3264. prev_legacy = kvm->arch.vpit->pit_state.flags & KVM_PIT_FLAGS_HPET_LEGACY;
  3265. cur_legacy = ps->flags & KVM_PIT_FLAGS_HPET_LEGACY;
  3266. if (!prev_legacy && cur_legacy)
  3267. start = 1;
  3268. memcpy(&kvm->arch.vpit->pit_state.channels, &ps->channels,
  3269. sizeof(kvm->arch.vpit->pit_state.channels));
  3270. kvm->arch.vpit->pit_state.flags = ps->flags;
  3271. kvm_pit_load_count(kvm, 0, kvm->arch.vpit->pit_state.channels[0].count, start);
  3272. mutex_unlock(&kvm->arch.vpit->pit_state.lock);
  3273. return r;
  3274. }
  3275. static int kvm_vm_ioctl_reinject(struct kvm *kvm,
  3276. struct kvm_reinject_control *control)
  3277. {
  3278. if (!kvm->arch.vpit)
  3279. return -ENXIO;
  3280. mutex_lock(&kvm->arch.vpit->pit_state.lock);
  3281. kvm->arch.vpit->pit_state.reinject = control->pit_reinject;
  3282. mutex_unlock(&kvm->arch.vpit->pit_state.lock);
  3283. return 0;
  3284. }
  3285. /**
  3286. * kvm_vm_ioctl_get_dirty_log - get and clear the log of dirty pages in a slot
  3287. * @kvm: kvm instance
  3288. * @log: slot id and address to which we copy the log
  3289. *
  3290. * Steps 1-4 below provide general overview of dirty page logging. See
  3291. * kvm_get_dirty_log_protect() function description for additional details.
  3292. *
  3293. * We call kvm_get_dirty_log_protect() to handle steps 1-3, upon return we
  3294. * always flush the TLB (step 4) even if previous step failed and the dirty
  3295. * bitmap may be corrupt. Regardless of previous outcome the KVM logging API
  3296. * does not preclude user space subsequent dirty log read. Flushing TLB ensures
  3297. * writes will be marked dirty for next log read.
  3298. *
  3299. * 1. Take a snapshot of the bit and clear it if needed.
  3300. * 2. Write protect the corresponding page.
  3301. * 3. Copy the snapshot to the userspace.
  3302. * 4. Flush TLB's if needed.
  3303. */
  3304. int kvm_vm_ioctl_get_dirty_log(struct kvm *kvm, struct kvm_dirty_log *log)
  3305. {
  3306. bool is_dirty = false;
  3307. int r;
  3308. mutex_lock(&kvm->slots_lock);
  3309. /*
  3310. * Flush potentially hardware-cached dirty pages to dirty_bitmap.
  3311. */
  3312. if (kvm_x86_ops->flush_log_dirty)
  3313. kvm_x86_ops->flush_log_dirty(kvm);
  3314. r = kvm_get_dirty_log_protect(kvm, log, &is_dirty);
  3315. /*
  3316. * All the TLBs can be flushed out of mmu lock, see the comments in
  3317. * kvm_mmu_slot_remove_write_access().
  3318. */
  3319. lockdep_assert_held(&kvm->slots_lock);
  3320. if (is_dirty)
  3321. kvm_flush_remote_tlbs(kvm);
  3322. mutex_unlock(&kvm->slots_lock);
  3323. return r;
  3324. }
  3325. int kvm_vm_ioctl_irq_line(struct kvm *kvm, struct kvm_irq_level *irq_event,
  3326. bool line_status)
  3327. {
  3328. if (!irqchip_in_kernel(kvm))
  3329. return -ENXIO;
  3330. irq_event->status = kvm_set_irq(kvm, KVM_USERSPACE_IRQ_SOURCE_ID,
  3331. irq_event->irq, irq_event->level,
  3332. line_status);
  3333. return 0;
  3334. }
  3335. long kvm_arch_vm_ioctl(struct file *filp,
  3336. unsigned int ioctl, unsigned long arg)
  3337. {
  3338. struct kvm *kvm = filp->private_data;
  3339. void __user *argp = (void __user *)arg;
  3340. int r = -ENOTTY;
  3341. /*
  3342. * This union makes it completely explicit to gcc-3.x
  3343. * that these two variables' stack usage should be
  3344. * combined, not added together.
  3345. */
  3346. union {
  3347. struct kvm_pit_state ps;
  3348. struct kvm_pit_state2 ps2;
  3349. struct kvm_pit_config pit_config;
  3350. } u;
  3351. switch (ioctl) {
  3352. case KVM_SET_TSS_ADDR:
  3353. r = kvm_vm_ioctl_set_tss_addr(kvm, arg);
  3354. break;
  3355. case KVM_SET_IDENTITY_MAP_ADDR: {
  3356. u64 ident_addr;
  3357. r = -EFAULT;
  3358. if (copy_from_user(&ident_addr, argp, sizeof ident_addr))
  3359. goto out;
  3360. r = kvm_vm_ioctl_set_identity_map_addr(kvm, ident_addr);
  3361. break;
  3362. }
  3363. case KVM_SET_NR_MMU_PAGES:
  3364. r = kvm_vm_ioctl_set_nr_mmu_pages(kvm, arg);
  3365. break;
  3366. case KVM_GET_NR_MMU_PAGES:
  3367. r = kvm_vm_ioctl_get_nr_mmu_pages(kvm);
  3368. break;
  3369. case KVM_CREATE_IRQCHIP: {
  3370. struct kvm_pic *vpic;
  3371. mutex_lock(&kvm->lock);
  3372. r = -EEXIST;
  3373. if (kvm->arch.vpic)
  3374. goto create_irqchip_unlock;
  3375. r = -EINVAL;
  3376. if (atomic_read(&kvm->online_vcpus))
  3377. goto create_irqchip_unlock;
  3378. r = -ENOMEM;
  3379. vpic = kvm_create_pic(kvm);
  3380. if (vpic) {
  3381. r = kvm_ioapic_init(kvm);
  3382. if (r) {
  3383. mutex_lock(&kvm->slots_lock);
  3384. kvm_io_bus_unregister_dev(kvm, KVM_PIO_BUS,
  3385. &vpic->dev_master);
  3386. kvm_io_bus_unregister_dev(kvm, KVM_PIO_BUS,
  3387. &vpic->dev_slave);
  3388. kvm_io_bus_unregister_dev(kvm, KVM_PIO_BUS,
  3389. &vpic->dev_eclr);
  3390. mutex_unlock(&kvm->slots_lock);
  3391. kfree(vpic);
  3392. goto create_irqchip_unlock;
  3393. }
  3394. } else
  3395. goto create_irqchip_unlock;
  3396. smp_wmb();
  3397. kvm->arch.vpic = vpic;
  3398. smp_wmb();
  3399. r = kvm_setup_default_irq_routing(kvm);
  3400. if (r) {
  3401. mutex_lock(&kvm->slots_lock);
  3402. mutex_lock(&kvm->irq_lock);
  3403. kvm_ioapic_destroy(kvm);
  3404. kvm_destroy_pic(kvm);
  3405. mutex_unlock(&kvm->irq_lock);
  3406. mutex_unlock(&kvm->slots_lock);
  3407. }
  3408. create_irqchip_unlock:
  3409. mutex_unlock(&kvm->lock);
  3410. break;
  3411. }
  3412. case KVM_CREATE_PIT:
  3413. u.pit_config.flags = KVM_PIT_SPEAKER_DUMMY;
  3414. goto create_pit;
  3415. case KVM_CREATE_PIT2:
  3416. r = -EFAULT;
  3417. if (copy_from_user(&u.pit_config, argp,
  3418. sizeof(struct kvm_pit_config)))
  3419. goto out;
  3420. create_pit:
  3421. mutex_lock(&kvm->slots_lock);
  3422. r = -EEXIST;
  3423. if (kvm->arch.vpit)
  3424. goto create_pit_unlock;
  3425. r = -ENOMEM;
  3426. kvm->arch.vpit = kvm_create_pit(kvm, u.pit_config.flags);
  3427. if (kvm->arch.vpit)
  3428. r = 0;
  3429. create_pit_unlock:
  3430. mutex_unlock(&kvm->slots_lock);
  3431. break;
  3432. case KVM_GET_IRQCHIP: {
  3433. /* 0: PIC master, 1: PIC slave, 2: IOAPIC */
  3434. struct kvm_irqchip *chip;
  3435. chip = memdup_user(argp, sizeof(*chip));
  3436. if (IS_ERR(chip)) {
  3437. r = PTR_ERR(chip);
  3438. goto out;
  3439. }
  3440. r = -ENXIO;
  3441. if (!irqchip_in_kernel(kvm))
  3442. goto get_irqchip_out;
  3443. r = kvm_vm_ioctl_get_irqchip(kvm, chip);
  3444. if (r)
  3445. goto get_irqchip_out;
  3446. r = -EFAULT;
  3447. if (copy_to_user(argp, chip, sizeof *chip))
  3448. goto get_irqchip_out;
  3449. r = 0;
  3450. get_irqchip_out:
  3451. kfree(chip);
  3452. break;
  3453. }
  3454. case KVM_SET_IRQCHIP: {
  3455. /* 0: PIC master, 1: PIC slave, 2: IOAPIC */
  3456. struct kvm_irqchip *chip;
  3457. chip = memdup_user(argp, sizeof(*chip));
  3458. if (IS_ERR(chip)) {
  3459. r = PTR_ERR(chip);
  3460. goto out;
  3461. }
  3462. r = -ENXIO;
  3463. if (!irqchip_in_kernel(kvm))
  3464. goto set_irqchip_out;
  3465. r = kvm_vm_ioctl_set_irqchip(kvm, chip);
  3466. if (r)
  3467. goto set_irqchip_out;
  3468. r = 0;
  3469. set_irqchip_out:
  3470. kfree(chip);
  3471. break;
  3472. }
  3473. case KVM_GET_PIT: {
  3474. r = -EFAULT;
  3475. if (copy_from_user(&u.ps, argp, sizeof(struct kvm_pit_state)))
  3476. goto out;
  3477. r = -ENXIO;
  3478. if (!kvm->arch.vpit)
  3479. goto out;
  3480. r = kvm_vm_ioctl_get_pit(kvm, &u.ps);
  3481. if (r)
  3482. goto out;
  3483. r = -EFAULT;
  3484. if (copy_to_user(argp, &u.ps, sizeof(struct kvm_pit_state)))
  3485. goto out;
  3486. r = 0;
  3487. break;
  3488. }
  3489. case KVM_SET_PIT: {
  3490. r = -EFAULT;
  3491. if (copy_from_user(&u.ps, argp, sizeof u.ps))
  3492. goto out;
  3493. r = -ENXIO;
  3494. if (!kvm->arch.vpit)
  3495. goto out;
  3496. r = kvm_vm_ioctl_set_pit(kvm, &u.ps);
  3497. break;
  3498. }
  3499. case KVM_GET_PIT2: {
  3500. r = -ENXIO;
  3501. if (!kvm->arch.vpit)
  3502. goto out;
  3503. r = kvm_vm_ioctl_get_pit2(kvm, &u.ps2);
  3504. if (r)
  3505. goto out;
  3506. r = -EFAULT;
  3507. if (copy_to_user(argp, &u.ps2, sizeof(u.ps2)))
  3508. goto out;
  3509. r = 0;
  3510. break;
  3511. }
  3512. case KVM_SET_PIT2: {
  3513. r = -EFAULT;
  3514. if (copy_from_user(&u.ps2, argp, sizeof(u.ps2)))
  3515. goto out;
  3516. r = -ENXIO;
  3517. if (!kvm->arch.vpit)
  3518. goto out;
  3519. r = kvm_vm_ioctl_set_pit2(kvm, &u.ps2);
  3520. break;
  3521. }
  3522. case KVM_REINJECT_CONTROL: {
  3523. struct kvm_reinject_control control;
  3524. r = -EFAULT;
  3525. if (copy_from_user(&control, argp, sizeof(control)))
  3526. goto out;
  3527. r = kvm_vm_ioctl_reinject(kvm, &control);
  3528. break;
  3529. }
  3530. case KVM_XEN_HVM_CONFIG: {
  3531. r = -EFAULT;
  3532. if (copy_from_user(&kvm->arch.xen_hvm_config, argp,
  3533. sizeof(struct kvm_xen_hvm_config)))
  3534. goto out;
  3535. r = -EINVAL;
  3536. if (kvm->arch.xen_hvm_config.flags)
  3537. goto out;
  3538. r = 0;
  3539. break;
  3540. }
  3541. case KVM_SET_CLOCK: {
  3542. struct kvm_clock_data user_ns;
  3543. u64 now_ns;
  3544. s64 delta;
  3545. r = -EFAULT;
  3546. if (copy_from_user(&user_ns, argp, sizeof(user_ns)))
  3547. goto out;
  3548. r = -EINVAL;
  3549. if (user_ns.flags)
  3550. goto out;
  3551. r = 0;
  3552. local_irq_disable();
  3553. now_ns = get_kernel_ns();
  3554. delta = user_ns.clock - now_ns;
  3555. local_irq_enable();
  3556. kvm->arch.kvmclock_offset = delta;
  3557. kvm_gen_update_masterclock(kvm);
  3558. break;
  3559. }
  3560. case KVM_GET_CLOCK: {
  3561. struct kvm_clock_data user_ns;
  3562. u64 now_ns;
  3563. local_irq_disable();
  3564. now_ns = get_kernel_ns();
  3565. user_ns.clock = kvm->arch.kvmclock_offset + now_ns;
  3566. local_irq_enable();
  3567. user_ns.flags = 0;
  3568. memset(&user_ns.pad, 0, sizeof(user_ns.pad));
  3569. r = -EFAULT;
  3570. if (copy_to_user(argp, &user_ns, sizeof(user_ns)))
  3571. goto out;
  3572. r = 0;
  3573. break;
  3574. }
  3575. default:
  3576. r = kvm_vm_ioctl_assigned_device(kvm, ioctl, arg);
  3577. }
  3578. out:
  3579. return r;
  3580. }
  3581. static void kvm_init_msr_list(void)
  3582. {
  3583. u32 dummy[2];
  3584. unsigned i, j;
  3585. /* skip the first msrs in the list. KVM-specific */
  3586. for (i = j = KVM_SAVE_MSRS_BEGIN; i < ARRAY_SIZE(msrs_to_save); i++) {
  3587. if (rdmsr_safe(msrs_to_save[i], &dummy[0], &dummy[1]) < 0)
  3588. continue;
  3589. /*
  3590. * Even MSRs that are valid in the host may not be exposed
  3591. * to the guests in some cases. We could work around this
  3592. * in VMX with the generic MSR save/load machinery, but it
  3593. * is not really worthwhile since it will really only
  3594. * happen with nested virtualization.
  3595. */
  3596. switch (msrs_to_save[i]) {
  3597. case MSR_IA32_BNDCFGS:
  3598. if (!kvm_x86_ops->mpx_supported())
  3599. continue;
  3600. break;
  3601. default:
  3602. break;
  3603. }
  3604. if (j < i)
  3605. msrs_to_save[j] = msrs_to_save[i];
  3606. j++;
  3607. }
  3608. num_msrs_to_save = j;
  3609. }
  3610. static int vcpu_mmio_write(struct kvm_vcpu *vcpu, gpa_t addr, int len,
  3611. const void *v)
  3612. {
  3613. int handled = 0;
  3614. int n;
  3615. do {
  3616. n = min(len, 8);
  3617. if (!(vcpu->arch.apic &&
  3618. !kvm_iodevice_write(vcpu, &vcpu->arch.apic->dev, addr, n, v))
  3619. && kvm_io_bus_write(vcpu, KVM_MMIO_BUS, addr, n, v))
  3620. break;
  3621. handled += n;
  3622. addr += n;
  3623. len -= n;
  3624. v += n;
  3625. } while (len);
  3626. return handled;
  3627. }
  3628. static int vcpu_mmio_read(struct kvm_vcpu *vcpu, gpa_t addr, int len, void *v)
  3629. {
  3630. int handled = 0;
  3631. int n;
  3632. do {
  3633. n = min(len, 8);
  3634. if (!(vcpu->arch.apic &&
  3635. !kvm_iodevice_read(vcpu, &vcpu->arch.apic->dev,
  3636. addr, n, v))
  3637. && kvm_io_bus_read(vcpu, KVM_MMIO_BUS, addr, n, v))
  3638. break;
  3639. trace_kvm_mmio(KVM_TRACE_MMIO_READ, n, addr, *(u64 *)v);
  3640. handled += n;
  3641. addr += n;
  3642. len -= n;
  3643. v += n;
  3644. } while (len);
  3645. return handled;
  3646. }
  3647. static void kvm_set_segment(struct kvm_vcpu *vcpu,
  3648. struct kvm_segment *var, int seg)
  3649. {
  3650. kvm_x86_ops->set_segment(vcpu, var, seg);
  3651. }
  3652. void kvm_get_segment(struct kvm_vcpu *vcpu,
  3653. struct kvm_segment *var, int seg)
  3654. {
  3655. kvm_x86_ops->get_segment(vcpu, var, seg);
  3656. }
  3657. gpa_t translate_nested_gpa(struct kvm_vcpu *vcpu, gpa_t gpa, u32 access,
  3658. struct x86_exception *exception)
  3659. {
  3660. gpa_t t_gpa;
  3661. BUG_ON(!mmu_is_nested(vcpu));
  3662. /* NPT walks are always user-walks */
  3663. access |= PFERR_USER_MASK;
  3664. t_gpa = vcpu->arch.mmu.gva_to_gpa(vcpu, gpa, access, exception);
  3665. return t_gpa;
  3666. }
  3667. gpa_t kvm_mmu_gva_to_gpa_read(struct kvm_vcpu *vcpu, gva_t gva,
  3668. struct x86_exception *exception)
  3669. {
  3670. u32 access = (kvm_x86_ops->get_cpl(vcpu) == 3) ? PFERR_USER_MASK : 0;
  3671. return vcpu->arch.walk_mmu->gva_to_gpa(vcpu, gva, access, exception);
  3672. }
  3673. gpa_t kvm_mmu_gva_to_gpa_fetch(struct kvm_vcpu *vcpu, gva_t gva,
  3674. struct x86_exception *exception)
  3675. {
  3676. u32 access = (kvm_x86_ops->get_cpl(vcpu) == 3) ? PFERR_USER_MASK : 0;
  3677. access |= PFERR_FETCH_MASK;
  3678. return vcpu->arch.walk_mmu->gva_to_gpa(vcpu, gva, access, exception);
  3679. }
  3680. gpa_t kvm_mmu_gva_to_gpa_write(struct kvm_vcpu *vcpu, gva_t gva,
  3681. struct x86_exception *exception)
  3682. {
  3683. u32 access = (kvm_x86_ops->get_cpl(vcpu) == 3) ? PFERR_USER_MASK : 0;
  3684. access |= PFERR_WRITE_MASK;
  3685. return vcpu->arch.walk_mmu->gva_to_gpa(vcpu, gva, access, exception);
  3686. }
  3687. /* uses this to access any guest's mapped memory without checking CPL */
  3688. gpa_t kvm_mmu_gva_to_gpa_system(struct kvm_vcpu *vcpu, gva_t gva,
  3689. struct x86_exception *exception)
  3690. {
  3691. return vcpu->arch.walk_mmu->gva_to_gpa(vcpu, gva, 0, exception);
  3692. }
  3693. static int kvm_read_guest_virt_helper(gva_t addr, void *val, unsigned int bytes,
  3694. struct kvm_vcpu *vcpu, u32 access,
  3695. struct x86_exception *exception)
  3696. {
  3697. void *data = val;
  3698. int r = X86EMUL_CONTINUE;
  3699. while (bytes) {
  3700. gpa_t gpa = vcpu->arch.walk_mmu->gva_to_gpa(vcpu, addr, access,
  3701. exception);
  3702. unsigned offset = addr & (PAGE_SIZE-1);
  3703. unsigned toread = min(bytes, (unsigned)PAGE_SIZE - offset);
  3704. int ret;
  3705. if (gpa == UNMAPPED_GVA)
  3706. return X86EMUL_PROPAGATE_FAULT;
  3707. ret = kvm_read_guest_page(vcpu->kvm, gpa >> PAGE_SHIFT, data,
  3708. offset, toread);
  3709. if (ret < 0) {
  3710. r = X86EMUL_IO_NEEDED;
  3711. goto out;
  3712. }
  3713. bytes -= toread;
  3714. data += toread;
  3715. addr += toread;
  3716. }
  3717. out:
  3718. return r;
  3719. }
  3720. /* used for instruction fetching */
  3721. static int kvm_fetch_guest_virt(struct x86_emulate_ctxt *ctxt,
  3722. gva_t addr, void *val, unsigned int bytes,
  3723. struct x86_exception *exception)
  3724. {
  3725. struct kvm_vcpu *vcpu = emul_to_vcpu(ctxt);
  3726. u32 access = (kvm_x86_ops->get_cpl(vcpu) == 3) ? PFERR_USER_MASK : 0;
  3727. unsigned offset;
  3728. int ret;
  3729. /* Inline kvm_read_guest_virt_helper for speed. */
  3730. gpa_t gpa = vcpu->arch.walk_mmu->gva_to_gpa(vcpu, addr, access|PFERR_FETCH_MASK,
  3731. exception);
  3732. if (unlikely(gpa == UNMAPPED_GVA))
  3733. return X86EMUL_PROPAGATE_FAULT;
  3734. offset = addr & (PAGE_SIZE-1);
  3735. if (WARN_ON(offset + bytes > PAGE_SIZE))
  3736. bytes = (unsigned)PAGE_SIZE - offset;
  3737. ret = kvm_read_guest_page(vcpu->kvm, gpa >> PAGE_SHIFT, val,
  3738. offset, bytes);
  3739. if (unlikely(ret < 0))
  3740. return X86EMUL_IO_NEEDED;
  3741. return X86EMUL_CONTINUE;
  3742. }
  3743. int kvm_read_guest_virt(struct x86_emulate_ctxt *ctxt,
  3744. gva_t addr, void *val, unsigned int bytes,
  3745. struct x86_exception *exception)
  3746. {
  3747. struct kvm_vcpu *vcpu = emul_to_vcpu(ctxt);
  3748. u32 access = (kvm_x86_ops->get_cpl(vcpu) == 3) ? PFERR_USER_MASK : 0;
  3749. return kvm_read_guest_virt_helper(addr, val, bytes, vcpu, access,
  3750. exception);
  3751. }
  3752. EXPORT_SYMBOL_GPL(kvm_read_guest_virt);
  3753. static int kvm_read_guest_virt_system(struct x86_emulate_ctxt *ctxt,
  3754. gva_t addr, void *val, unsigned int bytes,
  3755. struct x86_exception *exception)
  3756. {
  3757. struct kvm_vcpu *vcpu = emul_to_vcpu(ctxt);
  3758. return kvm_read_guest_virt_helper(addr, val, bytes, vcpu, 0, exception);
  3759. }
  3760. int kvm_write_guest_virt_system(struct x86_emulate_ctxt *ctxt,
  3761. gva_t addr, void *val,
  3762. unsigned int bytes,
  3763. struct x86_exception *exception)
  3764. {
  3765. struct kvm_vcpu *vcpu = emul_to_vcpu(ctxt);
  3766. void *data = val;
  3767. int r = X86EMUL_CONTINUE;
  3768. while (bytes) {
  3769. gpa_t gpa = vcpu->arch.walk_mmu->gva_to_gpa(vcpu, addr,
  3770. PFERR_WRITE_MASK,
  3771. exception);
  3772. unsigned offset = addr & (PAGE_SIZE-1);
  3773. unsigned towrite = min(bytes, (unsigned)PAGE_SIZE - offset);
  3774. int ret;
  3775. if (gpa == UNMAPPED_GVA)
  3776. return X86EMUL_PROPAGATE_FAULT;
  3777. ret = kvm_write_guest(vcpu->kvm, gpa, data, towrite);
  3778. if (ret < 0) {
  3779. r = X86EMUL_IO_NEEDED;
  3780. goto out;
  3781. }
  3782. bytes -= towrite;
  3783. data += towrite;
  3784. addr += towrite;
  3785. }
  3786. out:
  3787. return r;
  3788. }
  3789. EXPORT_SYMBOL_GPL(kvm_write_guest_virt_system);
  3790. static int vcpu_mmio_gva_to_gpa(struct kvm_vcpu *vcpu, unsigned long gva,
  3791. gpa_t *gpa, struct x86_exception *exception,
  3792. bool write)
  3793. {
  3794. u32 access = ((kvm_x86_ops->get_cpl(vcpu) == 3) ? PFERR_USER_MASK : 0)
  3795. | (write ? PFERR_WRITE_MASK : 0);
  3796. if (vcpu_match_mmio_gva(vcpu, gva)
  3797. && !permission_fault(vcpu, vcpu->arch.walk_mmu,
  3798. vcpu->arch.access, access)) {
  3799. *gpa = vcpu->arch.mmio_gfn << PAGE_SHIFT |
  3800. (gva & (PAGE_SIZE - 1));
  3801. trace_vcpu_match_mmio(gva, *gpa, write, false);
  3802. return 1;
  3803. }
  3804. *gpa = vcpu->arch.walk_mmu->gva_to_gpa(vcpu, gva, access, exception);
  3805. if (*gpa == UNMAPPED_GVA)
  3806. return -1;
  3807. /* For APIC access vmexit */
  3808. if ((*gpa & PAGE_MASK) == APIC_DEFAULT_PHYS_BASE)
  3809. return 1;
  3810. if (vcpu_match_mmio_gpa(vcpu, *gpa)) {
  3811. trace_vcpu_match_mmio(gva, *gpa, write, true);
  3812. return 1;
  3813. }
  3814. return 0;
  3815. }
  3816. int emulator_write_phys(struct kvm_vcpu *vcpu, gpa_t gpa,
  3817. const void *val, int bytes)
  3818. {
  3819. int ret;
  3820. ret = kvm_write_guest(vcpu->kvm, gpa, val, bytes);
  3821. if (ret < 0)
  3822. return 0;
  3823. kvm_mmu_pte_write(vcpu, gpa, val, bytes);
  3824. return 1;
  3825. }
  3826. struct read_write_emulator_ops {
  3827. int (*read_write_prepare)(struct kvm_vcpu *vcpu, void *val,
  3828. int bytes);
  3829. int (*read_write_emulate)(struct kvm_vcpu *vcpu, gpa_t gpa,
  3830. void *val, int bytes);
  3831. int (*read_write_mmio)(struct kvm_vcpu *vcpu, gpa_t gpa,
  3832. int bytes, void *val);
  3833. int (*read_write_exit_mmio)(struct kvm_vcpu *vcpu, gpa_t gpa,
  3834. void *val, int bytes);
  3835. bool write;
  3836. };
  3837. static int read_prepare(struct kvm_vcpu *vcpu, void *val, int bytes)
  3838. {
  3839. if (vcpu->mmio_read_completed) {
  3840. trace_kvm_mmio(KVM_TRACE_MMIO_READ, bytes,
  3841. vcpu->mmio_fragments[0].gpa, *(u64 *)val);
  3842. vcpu->mmio_read_completed = 0;
  3843. return 1;
  3844. }
  3845. return 0;
  3846. }
  3847. static int read_emulate(struct kvm_vcpu *vcpu, gpa_t gpa,
  3848. void *val, int bytes)
  3849. {
  3850. return !kvm_read_guest(vcpu->kvm, gpa, val, bytes);
  3851. }
  3852. static int write_emulate(struct kvm_vcpu *vcpu, gpa_t gpa,
  3853. void *val, int bytes)
  3854. {
  3855. return emulator_write_phys(vcpu, gpa, val, bytes);
  3856. }
  3857. static int write_mmio(struct kvm_vcpu *vcpu, gpa_t gpa, int bytes, void *val)
  3858. {
  3859. trace_kvm_mmio(KVM_TRACE_MMIO_WRITE, bytes, gpa, *(u64 *)val);
  3860. return vcpu_mmio_write(vcpu, gpa, bytes, val);
  3861. }
  3862. static int read_exit_mmio(struct kvm_vcpu *vcpu, gpa_t gpa,
  3863. void *val, int bytes)
  3864. {
  3865. trace_kvm_mmio(KVM_TRACE_MMIO_READ_UNSATISFIED, bytes, gpa, 0);
  3866. return X86EMUL_IO_NEEDED;
  3867. }
  3868. static int write_exit_mmio(struct kvm_vcpu *vcpu, gpa_t gpa,
  3869. void *val, int bytes)
  3870. {
  3871. struct kvm_mmio_fragment *frag = &vcpu->mmio_fragments[0];
  3872. memcpy(vcpu->run->mmio.data, frag->data, min(8u, frag->len));
  3873. return X86EMUL_CONTINUE;
  3874. }
  3875. static const struct read_write_emulator_ops read_emultor = {
  3876. .read_write_prepare = read_prepare,
  3877. .read_write_emulate = read_emulate,
  3878. .read_write_mmio = vcpu_mmio_read,
  3879. .read_write_exit_mmio = read_exit_mmio,
  3880. };
  3881. static const struct read_write_emulator_ops write_emultor = {
  3882. .read_write_emulate = write_emulate,
  3883. .read_write_mmio = write_mmio,
  3884. .read_write_exit_mmio = write_exit_mmio,
  3885. .write = true,
  3886. };
  3887. static int emulator_read_write_onepage(unsigned long addr, void *val,
  3888. unsigned int bytes,
  3889. struct x86_exception *exception,
  3890. struct kvm_vcpu *vcpu,
  3891. const struct read_write_emulator_ops *ops)
  3892. {
  3893. gpa_t gpa;
  3894. int handled, ret;
  3895. bool write = ops->write;
  3896. struct kvm_mmio_fragment *frag;
  3897. ret = vcpu_mmio_gva_to_gpa(vcpu, addr, &gpa, exception, write);
  3898. if (ret < 0)
  3899. return X86EMUL_PROPAGATE_FAULT;
  3900. /* For APIC access vmexit */
  3901. if (ret)
  3902. goto mmio;
  3903. if (ops->read_write_emulate(vcpu, gpa, val, bytes))
  3904. return X86EMUL_CONTINUE;
  3905. mmio:
  3906. /*
  3907. * Is this MMIO handled locally?
  3908. */
  3909. handled = ops->read_write_mmio(vcpu, gpa, bytes, val);
  3910. if (handled == bytes)
  3911. return X86EMUL_CONTINUE;
  3912. gpa += handled;
  3913. bytes -= handled;
  3914. val += handled;
  3915. WARN_ON(vcpu->mmio_nr_fragments >= KVM_MAX_MMIO_FRAGMENTS);
  3916. frag = &vcpu->mmio_fragments[vcpu->mmio_nr_fragments++];
  3917. frag->gpa = gpa;
  3918. frag->data = val;
  3919. frag->len = bytes;
  3920. return X86EMUL_CONTINUE;
  3921. }
  3922. static int emulator_read_write(struct x86_emulate_ctxt *ctxt,
  3923. unsigned long addr,
  3924. void *val, unsigned int bytes,
  3925. struct x86_exception *exception,
  3926. const struct read_write_emulator_ops *ops)
  3927. {
  3928. struct kvm_vcpu *vcpu = emul_to_vcpu(ctxt);
  3929. gpa_t gpa;
  3930. int rc;
  3931. if (ops->read_write_prepare &&
  3932. ops->read_write_prepare(vcpu, val, bytes))
  3933. return X86EMUL_CONTINUE;
  3934. vcpu->mmio_nr_fragments = 0;
  3935. /* Crossing a page boundary? */
  3936. if (((addr + bytes - 1) ^ addr) & PAGE_MASK) {
  3937. int now;
  3938. now = -addr & ~PAGE_MASK;
  3939. rc = emulator_read_write_onepage(addr, val, now, exception,
  3940. vcpu, ops);
  3941. if (rc != X86EMUL_CONTINUE)
  3942. return rc;
  3943. addr += now;
  3944. if (ctxt->mode != X86EMUL_MODE_PROT64)
  3945. addr = (u32)addr;
  3946. val += now;
  3947. bytes -= now;
  3948. }
  3949. rc = emulator_read_write_onepage(addr, val, bytes, exception,
  3950. vcpu, ops);
  3951. if (rc != X86EMUL_CONTINUE)
  3952. return rc;
  3953. if (!vcpu->mmio_nr_fragments)
  3954. return rc;
  3955. gpa = vcpu->mmio_fragments[0].gpa;
  3956. vcpu->mmio_needed = 1;
  3957. vcpu->mmio_cur_fragment = 0;
  3958. vcpu->run->mmio.len = min(8u, vcpu->mmio_fragments[0].len);
  3959. vcpu->run->mmio.is_write = vcpu->mmio_is_write = ops->write;
  3960. vcpu->run->exit_reason = KVM_EXIT_MMIO;
  3961. vcpu->run->mmio.phys_addr = gpa;
  3962. return ops->read_write_exit_mmio(vcpu, gpa, val, bytes);
  3963. }
  3964. static int emulator_read_emulated(struct x86_emulate_ctxt *ctxt,
  3965. unsigned long addr,
  3966. void *val,
  3967. unsigned int bytes,
  3968. struct x86_exception *exception)
  3969. {
  3970. return emulator_read_write(ctxt, addr, val, bytes,
  3971. exception, &read_emultor);
  3972. }
  3973. static int emulator_write_emulated(struct x86_emulate_ctxt *ctxt,
  3974. unsigned long addr,
  3975. const void *val,
  3976. unsigned int bytes,
  3977. struct x86_exception *exception)
  3978. {
  3979. return emulator_read_write(ctxt, addr, (void *)val, bytes,
  3980. exception, &write_emultor);
  3981. }
  3982. #define CMPXCHG_TYPE(t, ptr, old, new) \
  3983. (cmpxchg((t *)(ptr), *(t *)(old), *(t *)(new)) == *(t *)(old))
  3984. #ifdef CONFIG_X86_64
  3985. # define CMPXCHG64(ptr, old, new) CMPXCHG_TYPE(u64, ptr, old, new)
  3986. #else
  3987. # define CMPXCHG64(ptr, old, new) \
  3988. (cmpxchg64((u64 *)(ptr), *(u64 *)(old), *(u64 *)(new)) == *(u64 *)(old))
  3989. #endif
  3990. static int emulator_cmpxchg_emulated(struct x86_emulate_ctxt *ctxt,
  3991. unsigned long addr,
  3992. const void *old,
  3993. const void *new,
  3994. unsigned int bytes,
  3995. struct x86_exception *exception)
  3996. {
  3997. struct kvm_vcpu *vcpu = emul_to_vcpu(ctxt);
  3998. gpa_t gpa;
  3999. struct page *page;
  4000. char *kaddr;
  4001. bool exchanged;
  4002. /* guests cmpxchg8b have to be emulated atomically */
  4003. if (bytes > 8 || (bytes & (bytes - 1)))
  4004. goto emul_write;
  4005. gpa = kvm_mmu_gva_to_gpa_write(vcpu, addr, NULL);
  4006. if (gpa == UNMAPPED_GVA ||
  4007. (gpa & PAGE_MASK) == APIC_DEFAULT_PHYS_BASE)
  4008. goto emul_write;
  4009. if (((gpa + bytes - 1) & PAGE_MASK) != (gpa & PAGE_MASK))
  4010. goto emul_write;
  4011. page = gfn_to_page(vcpu->kvm, gpa >> PAGE_SHIFT);
  4012. if (is_error_page(page))
  4013. goto emul_write;
  4014. kaddr = kmap_atomic(page);
  4015. kaddr += offset_in_page(gpa);
  4016. switch (bytes) {
  4017. case 1:
  4018. exchanged = CMPXCHG_TYPE(u8, kaddr, old, new);
  4019. break;
  4020. case 2:
  4021. exchanged = CMPXCHG_TYPE(u16, kaddr, old, new);
  4022. break;
  4023. case 4:
  4024. exchanged = CMPXCHG_TYPE(u32, kaddr, old, new);
  4025. break;
  4026. case 8:
  4027. exchanged = CMPXCHG64(kaddr, old, new);
  4028. break;
  4029. default:
  4030. BUG();
  4031. }
  4032. kunmap_atomic(kaddr);
  4033. kvm_release_page_dirty(page);
  4034. if (!exchanged)
  4035. return X86EMUL_CMPXCHG_FAILED;
  4036. mark_page_dirty(vcpu->kvm, gpa >> PAGE_SHIFT);
  4037. kvm_mmu_pte_write(vcpu, gpa, new, bytes);
  4038. return X86EMUL_CONTINUE;
  4039. emul_write:
  4040. printk_once(KERN_WARNING "kvm: emulating exchange as write\n");
  4041. return emulator_write_emulated(ctxt, addr, new, bytes, exception);
  4042. }
  4043. static int kernel_pio(struct kvm_vcpu *vcpu, void *pd)
  4044. {
  4045. /* TODO: String I/O for in kernel device */
  4046. int r;
  4047. if (vcpu->arch.pio.in)
  4048. r = kvm_io_bus_read(vcpu, KVM_PIO_BUS, vcpu->arch.pio.port,
  4049. vcpu->arch.pio.size, pd);
  4050. else
  4051. r = kvm_io_bus_write(vcpu, KVM_PIO_BUS,
  4052. vcpu->arch.pio.port, vcpu->arch.pio.size,
  4053. pd);
  4054. return r;
  4055. }
  4056. static int emulator_pio_in_out(struct kvm_vcpu *vcpu, int size,
  4057. unsigned short port, void *val,
  4058. unsigned int count, bool in)
  4059. {
  4060. vcpu->arch.pio.port = port;
  4061. vcpu->arch.pio.in = in;
  4062. vcpu->arch.pio.count = count;
  4063. vcpu->arch.pio.size = size;
  4064. if (!kernel_pio(vcpu, vcpu->arch.pio_data)) {
  4065. vcpu->arch.pio.count = 0;
  4066. return 1;
  4067. }
  4068. vcpu->run->exit_reason = KVM_EXIT_IO;
  4069. vcpu->run->io.direction = in ? KVM_EXIT_IO_IN : KVM_EXIT_IO_OUT;
  4070. vcpu->run->io.size = size;
  4071. vcpu->run->io.data_offset = KVM_PIO_PAGE_OFFSET * PAGE_SIZE;
  4072. vcpu->run->io.count = count;
  4073. vcpu->run->io.port = port;
  4074. return 0;
  4075. }
  4076. static int emulator_pio_in_emulated(struct x86_emulate_ctxt *ctxt,
  4077. int size, unsigned short port, void *val,
  4078. unsigned int count)
  4079. {
  4080. struct kvm_vcpu *vcpu = emul_to_vcpu(ctxt);
  4081. int ret;
  4082. if (vcpu->arch.pio.count)
  4083. goto data_avail;
  4084. ret = emulator_pio_in_out(vcpu, size, port, val, count, true);
  4085. if (ret) {
  4086. data_avail:
  4087. memcpy(val, vcpu->arch.pio_data, size * count);
  4088. trace_kvm_pio(KVM_PIO_IN, port, size, count, vcpu->arch.pio_data);
  4089. vcpu->arch.pio.count = 0;
  4090. return 1;
  4091. }
  4092. return 0;
  4093. }
  4094. static int emulator_pio_out_emulated(struct x86_emulate_ctxt *ctxt,
  4095. int size, unsigned short port,
  4096. const void *val, unsigned int count)
  4097. {
  4098. struct kvm_vcpu *vcpu = emul_to_vcpu(ctxt);
  4099. memcpy(vcpu->arch.pio_data, val, size * count);
  4100. trace_kvm_pio(KVM_PIO_OUT, port, size, count, vcpu->arch.pio_data);
  4101. return emulator_pio_in_out(vcpu, size, port, (void *)val, count, false);
  4102. }
  4103. static unsigned long get_segment_base(struct kvm_vcpu *vcpu, int seg)
  4104. {
  4105. return kvm_x86_ops->get_segment_base(vcpu, seg);
  4106. }
  4107. static void emulator_invlpg(struct x86_emulate_ctxt *ctxt, ulong address)
  4108. {
  4109. kvm_mmu_invlpg(emul_to_vcpu(ctxt), address);
  4110. }
  4111. int kvm_emulate_wbinvd_noskip(struct kvm_vcpu *vcpu)
  4112. {
  4113. if (!need_emulate_wbinvd(vcpu))
  4114. return X86EMUL_CONTINUE;
  4115. if (kvm_x86_ops->has_wbinvd_exit()) {
  4116. int cpu = get_cpu();
  4117. cpumask_set_cpu(cpu, vcpu->arch.wbinvd_dirty_mask);
  4118. smp_call_function_many(vcpu->arch.wbinvd_dirty_mask,
  4119. wbinvd_ipi, NULL, 1);
  4120. put_cpu();
  4121. cpumask_clear(vcpu->arch.wbinvd_dirty_mask);
  4122. } else
  4123. wbinvd();
  4124. return X86EMUL_CONTINUE;
  4125. }
  4126. int kvm_emulate_wbinvd(struct kvm_vcpu *vcpu)
  4127. {
  4128. kvm_x86_ops->skip_emulated_instruction(vcpu);
  4129. return kvm_emulate_wbinvd_noskip(vcpu);
  4130. }
  4131. EXPORT_SYMBOL_GPL(kvm_emulate_wbinvd);
  4132. static void emulator_wbinvd(struct x86_emulate_ctxt *ctxt)
  4133. {
  4134. kvm_emulate_wbinvd_noskip(emul_to_vcpu(ctxt));
  4135. }
  4136. static int emulator_get_dr(struct x86_emulate_ctxt *ctxt, int dr,
  4137. unsigned long *dest)
  4138. {
  4139. return kvm_get_dr(emul_to_vcpu(ctxt), dr, dest);
  4140. }
  4141. static int emulator_set_dr(struct x86_emulate_ctxt *ctxt, int dr,
  4142. unsigned long value)
  4143. {
  4144. return __kvm_set_dr(emul_to_vcpu(ctxt), dr, value);
  4145. }
  4146. static u64 mk_cr_64(u64 curr_cr, u32 new_val)
  4147. {
  4148. return (curr_cr & ~((1ULL << 32) - 1)) | new_val;
  4149. }
  4150. static unsigned long emulator_get_cr(struct x86_emulate_ctxt *ctxt, int cr)
  4151. {
  4152. struct kvm_vcpu *vcpu = emul_to_vcpu(ctxt);
  4153. unsigned long value;
  4154. switch (cr) {
  4155. case 0:
  4156. value = kvm_read_cr0(vcpu);
  4157. break;
  4158. case 2:
  4159. value = vcpu->arch.cr2;
  4160. break;
  4161. case 3:
  4162. value = kvm_read_cr3(vcpu);
  4163. break;
  4164. case 4:
  4165. value = kvm_read_cr4(vcpu);
  4166. break;
  4167. case 8:
  4168. value = kvm_get_cr8(vcpu);
  4169. break;
  4170. default:
  4171. kvm_err("%s: unexpected cr %u\n", __func__, cr);
  4172. return 0;
  4173. }
  4174. return value;
  4175. }
  4176. static int emulator_set_cr(struct x86_emulate_ctxt *ctxt, int cr, ulong val)
  4177. {
  4178. struct kvm_vcpu *vcpu = emul_to_vcpu(ctxt);
  4179. int res = 0;
  4180. switch (cr) {
  4181. case 0:
  4182. res = kvm_set_cr0(vcpu, mk_cr_64(kvm_read_cr0(vcpu), val));
  4183. break;
  4184. case 2:
  4185. vcpu->arch.cr2 = val;
  4186. break;
  4187. case 3:
  4188. res = kvm_set_cr3(vcpu, val);
  4189. break;
  4190. case 4:
  4191. res = kvm_set_cr4(vcpu, mk_cr_64(kvm_read_cr4(vcpu), val));
  4192. break;
  4193. case 8:
  4194. res = kvm_set_cr8(vcpu, val);
  4195. break;
  4196. default:
  4197. kvm_err("%s: unexpected cr %u\n", __func__, cr);
  4198. res = -1;
  4199. }
  4200. return res;
  4201. }
  4202. static int emulator_get_cpl(struct x86_emulate_ctxt *ctxt)
  4203. {
  4204. return kvm_x86_ops->get_cpl(emul_to_vcpu(ctxt));
  4205. }
  4206. static void emulator_get_gdt(struct x86_emulate_ctxt *ctxt, struct desc_ptr *dt)
  4207. {
  4208. kvm_x86_ops->get_gdt(emul_to_vcpu(ctxt), dt);
  4209. }
  4210. static void emulator_get_idt(struct x86_emulate_ctxt *ctxt, struct desc_ptr *dt)
  4211. {
  4212. kvm_x86_ops->get_idt(emul_to_vcpu(ctxt), dt);
  4213. }
  4214. static void emulator_set_gdt(struct x86_emulate_ctxt *ctxt, struct desc_ptr *dt)
  4215. {
  4216. kvm_x86_ops->set_gdt(emul_to_vcpu(ctxt), dt);
  4217. }
  4218. static void emulator_set_idt(struct x86_emulate_ctxt *ctxt, struct desc_ptr *dt)
  4219. {
  4220. kvm_x86_ops->set_idt(emul_to_vcpu(ctxt), dt);
  4221. }
  4222. static unsigned long emulator_get_cached_segment_base(
  4223. struct x86_emulate_ctxt *ctxt, int seg)
  4224. {
  4225. return get_segment_base(emul_to_vcpu(ctxt), seg);
  4226. }
  4227. static bool emulator_get_segment(struct x86_emulate_ctxt *ctxt, u16 *selector,
  4228. struct desc_struct *desc, u32 *base3,
  4229. int seg)
  4230. {
  4231. struct kvm_segment var;
  4232. kvm_get_segment(emul_to_vcpu(ctxt), &var, seg);
  4233. *selector = var.selector;
  4234. if (var.unusable) {
  4235. memset(desc, 0, sizeof(*desc));
  4236. return false;
  4237. }
  4238. if (var.g)
  4239. var.limit >>= 12;
  4240. set_desc_limit(desc, var.limit);
  4241. set_desc_base(desc, (unsigned long)var.base);
  4242. #ifdef CONFIG_X86_64
  4243. if (base3)
  4244. *base3 = var.base >> 32;
  4245. #endif
  4246. desc->type = var.type;
  4247. desc->s = var.s;
  4248. desc->dpl = var.dpl;
  4249. desc->p = var.present;
  4250. desc->avl = var.avl;
  4251. desc->l = var.l;
  4252. desc->d = var.db;
  4253. desc->g = var.g;
  4254. return true;
  4255. }
  4256. static void emulator_set_segment(struct x86_emulate_ctxt *ctxt, u16 selector,
  4257. struct desc_struct *desc, u32 base3,
  4258. int seg)
  4259. {
  4260. struct kvm_vcpu *vcpu = emul_to_vcpu(ctxt);
  4261. struct kvm_segment var;
  4262. var.selector = selector;
  4263. var.base = get_desc_base(desc);
  4264. #ifdef CONFIG_X86_64
  4265. var.base |= ((u64)base3) << 32;
  4266. #endif
  4267. var.limit = get_desc_limit(desc);
  4268. if (desc->g)
  4269. var.limit = (var.limit << 12) | 0xfff;
  4270. var.type = desc->type;
  4271. var.dpl = desc->dpl;
  4272. var.db = desc->d;
  4273. var.s = desc->s;
  4274. var.l = desc->l;
  4275. var.g = desc->g;
  4276. var.avl = desc->avl;
  4277. var.present = desc->p;
  4278. var.unusable = !var.present;
  4279. var.padding = 0;
  4280. kvm_set_segment(vcpu, &var, seg);
  4281. return;
  4282. }
  4283. static int emulator_get_msr(struct x86_emulate_ctxt *ctxt,
  4284. u32 msr_index, u64 *pdata)
  4285. {
  4286. return kvm_get_msr(emul_to_vcpu(ctxt), msr_index, pdata);
  4287. }
  4288. static int emulator_set_msr(struct x86_emulate_ctxt *ctxt,
  4289. u32 msr_index, u64 data)
  4290. {
  4291. struct msr_data msr;
  4292. msr.data = data;
  4293. msr.index = msr_index;
  4294. msr.host_initiated = false;
  4295. return kvm_set_msr(emul_to_vcpu(ctxt), &msr);
  4296. }
  4297. static int emulator_check_pmc(struct x86_emulate_ctxt *ctxt,
  4298. u32 pmc)
  4299. {
  4300. return kvm_pmu_check_pmc(emul_to_vcpu(ctxt), pmc);
  4301. }
  4302. static int emulator_read_pmc(struct x86_emulate_ctxt *ctxt,
  4303. u32 pmc, u64 *pdata)
  4304. {
  4305. return kvm_pmu_read_pmc(emul_to_vcpu(ctxt), pmc, pdata);
  4306. }
  4307. static void emulator_halt(struct x86_emulate_ctxt *ctxt)
  4308. {
  4309. emul_to_vcpu(ctxt)->arch.halt_request = 1;
  4310. }
  4311. static void emulator_get_fpu(struct x86_emulate_ctxt *ctxt)
  4312. {
  4313. preempt_disable();
  4314. kvm_load_guest_fpu(emul_to_vcpu(ctxt));
  4315. /*
  4316. * CR0.TS may reference the host fpu state, not the guest fpu state,
  4317. * so it may be clear at this point.
  4318. */
  4319. clts();
  4320. }
  4321. static void emulator_put_fpu(struct x86_emulate_ctxt *ctxt)
  4322. {
  4323. preempt_enable();
  4324. }
  4325. static int emulator_intercept(struct x86_emulate_ctxt *ctxt,
  4326. struct x86_instruction_info *info,
  4327. enum x86_intercept_stage stage)
  4328. {
  4329. return kvm_x86_ops->check_intercept(emul_to_vcpu(ctxt), info, stage);
  4330. }
  4331. static void emulator_get_cpuid(struct x86_emulate_ctxt *ctxt,
  4332. u32 *eax, u32 *ebx, u32 *ecx, u32 *edx)
  4333. {
  4334. kvm_cpuid(emul_to_vcpu(ctxt), eax, ebx, ecx, edx);
  4335. }
  4336. static ulong emulator_read_gpr(struct x86_emulate_ctxt *ctxt, unsigned reg)
  4337. {
  4338. return kvm_register_read(emul_to_vcpu(ctxt), reg);
  4339. }
  4340. static void emulator_write_gpr(struct x86_emulate_ctxt *ctxt, unsigned reg, ulong val)
  4341. {
  4342. kvm_register_write(emul_to_vcpu(ctxt), reg, val);
  4343. }
  4344. static void emulator_set_nmi_mask(struct x86_emulate_ctxt *ctxt, bool masked)
  4345. {
  4346. kvm_x86_ops->set_nmi_mask(emul_to_vcpu(ctxt), masked);
  4347. }
  4348. static const struct x86_emulate_ops emulate_ops = {
  4349. .read_gpr = emulator_read_gpr,
  4350. .write_gpr = emulator_write_gpr,
  4351. .read_std = kvm_read_guest_virt_system,
  4352. .write_std = kvm_write_guest_virt_system,
  4353. .fetch = kvm_fetch_guest_virt,
  4354. .read_emulated = emulator_read_emulated,
  4355. .write_emulated = emulator_write_emulated,
  4356. .cmpxchg_emulated = emulator_cmpxchg_emulated,
  4357. .invlpg = emulator_invlpg,
  4358. .pio_in_emulated = emulator_pio_in_emulated,
  4359. .pio_out_emulated = emulator_pio_out_emulated,
  4360. .get_segment = emulator_get_segment,
  4361. .set_segment = emulator_set_segment,
  4362. .get_cached_segment_base = emulator_get_cached_segment_base,
  4363. .get_gdt = emulator_get_gdt,
  4364. .get_idt = emulator_get_idt,
  4365. .set_gdt = emulator_set_gdt,
  4366. .set_idt = emulator_set_idt,
  4367. .get_cr = emulator_get_cr,
  4368. .set_cr = emulator_set_cr,
  4369. .cpl = emulator_get_cpl,
  4370. .get_dr = emulator_get_dr,
  4371. .set_dr = emulator_set_dr,
  4372. .set_msr = emulator_set_msr,
  4373. .get_msr = emulator_get_msr,
  4374. .check_pmc = emulator_check_pmc,
  4375. .read_pmc = emulator_read_pmc,
  4376. .halt = emulator_halt,
  4377. .wbinvd = emulator_wbinvd,
  4378. .fix_hypercall = emulator_fix_hypercall,
  4379. .get_fpu = emulator_get_fpu,
  4380. .put_fpu = emulator_put_fpu,
  4381. .intercept = emulator_intercept,
  4382. .get_cpuid = emulator_get_cpuid,
  4383. .set_nmi_mask = emulator_set_nmi_mask,
  4384. };
  4385. static void toggle_interruptibility(struct kvm_vcpu *vcpu, u32 mask)
  4386. {
  4387. u32 int_shadow = kvm_x86_ops->get_interrupt_shadow(vcpu);
  4388. /*
  4389. * an sti; sti; sequence only disable interrupts for the first
  4390. * instruction. So, if the last instruction, be it emulated or
  4391. * not, left the system with the INT_STI flag enabled, it
  4392. * means that the last instruction is an sti. We should not
  4393. * leave the flag on in this case. The same goes for mov ss
  4394. */
  4395. if (int_shadow & mask)
  4396. mask = 0;
  4397. if (unlikely(int_shadow || mask)) {
  4398. kvm_x86_ops->set_interrupt_shadow(vcpu, mask);
  4399. if (!mask)
  4400. kvm_make_request(KVM_REQ_EVENT, vcpu);
  4401. }
  4402. }
  4403. static bool inject_emulated_exception(struct kvm_vcpu *vcpu)
  4404. {
  4405. struct x86_emulate_ctxt *ctxt = &vcpu->arch.emulate_ctxt;
  4406. if (ctxt->exception.vector == PF_VECTOR)
  4407. return kvm_propagate_fault(vcpu, &ctxt->exception);
  4408. if (ctxt->exception.error_code_valid)
  4409. kvm_queue_exception_e(vcpu, ctxt->exception.vector,
  4410. ctxt->exception.error_code);
  4411. else
  4412. kvm_queue_exception(vcpu, ctxt->exception.vector);
  4413. return false;
  4414. }
  4415. static void init_emulate_ctxt(struct kvm_vcpu *vcpu)
  4416. {
  4417. struct x86_emulate_ctxt *ctxt = &vcpu->arch.emulate_ctxt;
  4418. int cs_db, cs_l;
  4419. kvm_x86_ops->get_cs_db_l_bits(vcpu, &cs_db, &cs_l);
  4420. ctxt->eflags = kvm_get_rflags(vcpu);
  4421. ctxt->eip = kvm_rip_read(vcpu);
  4422. ctxt->mode = (!is_protmode(vcpu)) ? X86EMUL_MODE_REAL :
  4423. (ctxt->eflags & X86_EFLAGS_VM) ? X86EMUL_MODE_VM86 :
  4424. (cs_l && is_long_mode(vcpu)) ? X86EMUL_MODE_PROT64 :
  4425. cs_db ? X86EMUL_MODE_PROT32 :
  4426. X86EMUL_MODE_PROT16;
  4427. ctxt->guest_mode = is_guest_mode(vcpu);
  4428. init_decode_cache(ctxt);
  4429. vcpu->arch.emulate_regs_need_sync_from_vcpu = false;
  4430. }
  4431. int kvm_inject_realmode_interrupt(struct kvm_vcpu *vcpu, int irq, int inc_eip)
  4432. {
  4433. struct x86_emulate_ctxt *ctxt = &vcpu->arch.emulate_ctxt;
  4434. int ret;
  4435. init_emulate_ctxt(vcpu);
  4436. ctxt->op_bytes = 2;
  4437. ctxt->ad_bytes = 2;
  4438. ctxt->_eip = ctxt->eip + inc_eip;
  4439. ret = emulate_int_real(ctxt, irq);
  4440. if (ret != X86EMUL_CONTINUE)
  4441. return EMULATE_FAIL;
  4442. ctxt->eip = ctxt->_eip;
  4443. kvm_rip_write(vcpu, ctxt->eip);
  4444. kvm_set_rflags(vcpu, ctxt->eflags);
  4445. if (irq == NMI_VECTOR)
  4446. vcpu->arch.nmi_pending = 0;
  4447. else
  4448. vcpu->arch.interrupt.pending = false;
  4449. return EMULATE_DONE;
  4450. }
  4451. EXPORT_SYMBOL_GPL(kvm_inject_realmode_interrupt);
  4452. static int handle_emulation_failure(struct kvm_vcpu *vcpu)
  4453. {
  4454. int r = EMULATE_DONE;
  4455. ++vcpu->stat.insn_emulation_fail;
  4456. trace_kvm_emulate_insn_failed(vcpu);
  4457. if (!is_guest_mode(vcpu) && kvm_x86_ops->get_cpl(vcpu) == 0) {
  4458. vcpu->run->exit_reason = KVM_EXIT_INTERNAL_ERROR;
  4459. vcpu->run->internal.suberror = KVM_INTERNAL_ERROR_EMULATION;
  4460. vcpu->run->internal.ndata = 0;
  4461. r = EMULATE_FAIL;
  4462. }
  4463. kvm_queue_exception(vcpu, UD_VECTOR);
  4464. return r;
  4465. }
  4466. static bool reexecute_instruction(struct kvm_vcpu *vcpu, gva_t cr2,
  4467. bool write_fault_to_shadow_pgtable,
  4468. int emulation_type)
  4469. {
  4470. gpa_t gpa = cr2;
  4471. pfn_t pfn;
  4472. if (emulation_type & EMULTYPE_NO_REEXECUTE)
  4473. return false;
  4474. if (!vcpu->arch.mmu.direct_map) {
  4475. /*
  4476. * Write permission should be allowed since only
  4477. * write access need to be emulated.
  4478. */
  4479. gpa = kvm_mmu_gva_to_gpa_write(vcpu, cr2, NULL);
  4480. /*
  4481. * If the mapping is invalid in guest, let cpu retry
  4482. * it to generate fault.
  4483. */
  4484. if (gpa == UNMAPPED_GVA)
  4485. return true;
  4486. }
  4487. /*
  4488. * Do not retry the unhandleable instruction if it faults on the
  4489. * readonly host memory, otherwise it will goto a infinite loop:
  4490. * retry instruction -> write #PF -> emulation fail -> retry
  4491. * instruction -> ...
  4492. */
  4493. pfn = gfn_to_pfn(vcpu->kvm, gpa_to_gfn(gpa));
  4494. /*
  4495. * If the instruction failed on the error pfn, it can not be fixed,
  4496. * report the error to userspace.
  4497. */
  4498. if (is_error_noslot_pfn(pfn))
  4499. return false;
  4500. kvm_release_pfn_clean(pfn);
  4501. /* The instructions are well-emulated on direct mmu. */
  4502. if (vcpu->arch.mmu.direct_map) {
  4503. unsigned int indirect_shadow_pages;
  4504. spin_lock(&vcpu->kvm->mmu_lock);
  4505. indirect_shadow_pages = vcpu->kvm->arch.indirect_shadow_pages;
  4506. spin_unlock(&vcpu->kvm->mmu_lock);
  4507. if (indirect_shadow_pages)
  4508. kvm_mmu_unprotect_page(vcpu->kvm, gpa_to_gfn(gpa));
  4509. return true;
  4510. }
  4511. /*
  4512. * if emulation was due to access to shadowed page table
  4513. * and it failed try to unshadow page and re-enter the
  4514. * guest to let CPU execute the instruction.
  4515. */
  4516. kvm_mmu_unprotect_page(vcpu->kvm, gpa_to_gfn(gpa));
  4517. /*
  4518. * If the access faults on its page table, it can not
  4519. * be fixed by unprotecting shadow page and it should
  4520. * be reported to userspace.
  4521. */
  4522. return !write_fault_to_shadow_pgtable;
  4523. }
  4524. static bool retry_instruction(struct x86_emulate_ctxt *ctxt,
  4525. unsigned long cr2, int emulation_type)
  4526. {
  4527. struct kvm_vcpu *vcpu = emul_to_vcpu(ctxt);
  4528. unsigned long last_retry_eip, last_retry_addr, gpa = cr2;
  4529. last_retry_eip = vcpu->arch.last_retry_eip;
  4530. last_retry_addr = vcpu->arch.last_retry_addr;
  4531. /*
  4532. * If the emulation is caused by #PF and it is non-page_table
  4533. * writing instruction, it means the VM-EXIT is caused by shadow
  4534. * page protected, we can zap the shadow page and retry this
  4535. * instruction directly.
  4536. *
  4537. * Note: if the guest uses a non-page-table modifying instruction
  4538. * on the PDE that points to the instruction, then we will unmap
  4539. * the instruction and go to an infinite loop. So, we cache the
  4540. * last retried eip and the last fault address, if we meet the eip
  4541. * and the address again, we can break out of the potential infinite
  4542. * loop.
  4543. */
  4544. vcpu->arch.last_retry_eip = vcpu->arch.last_retry_addr = 0;
  4545. if (!(emulation_type & EMULTYPE_RETRY))
  4546. return false;
  4547. if (x86_page_table_writing_insn(ctxt))
  4548. return false;
  4549. if (ctxt->eip == last_retry_eip && last_retry_addr == cr2)
  4550. return false;
  4551. vcpu->arch.last_retry_eip = ctxt->eip;
  4552. vcpu->arch.last_retry_addr = cr2;
  4553. if (!vcpu->arch.mmu.direct_map)
  4554. gpa = kvm_mmu_gva_to_gpa_write(vcpu, cr2, NULL);
  4555. kvm_mmu_unprotect_page(vcpu->kvm, gpa_to_gfn(gpa));
  4556. return true;
  4557. }
  4558. static int complete_emulated_mmio(struct kvm_vcpu *vcpu);
  4559. static int complete_emulated_pio(struct kvm_vcpu *vcpu);
  4560. static int kvm_vcpu_check_hw_bp(unsigned long addr, u32 type, u32 dr7,
  4561. unsigned long *db)
  4562. {
  4563. u32 dr6 = 0;
  4564. int i;
  4565. u32 enable, rwlen;
  4566. enable = dr7;
  4567. rwlen = dr7 >> 16;
  4568. for (i = 0; i < 4; i++, enable >>= 2, rwlen >>= 4)
  4569. if ((enable & 3) && (rwlen & 15) == type && db[i] == addr)
  4570. dr6 |= (1 << i);
  4571. return dr6;
  4572. }
  4573. static void kvm_vcpu_check_singlestep(struct kvm_vcpu *vcpu, unsigned long rflags, int *r)
  4574. {
  4575. struct kvm_run *kvm_run = vcpu->run;
  4576. /*
  4577. * rflags is the old, "raw" value of the flags. The new value has
  4578. * not been saved yet.
  4579. *
  4580. * This is correct even for TF set by the guest, because "the
  4581. * processor will not generate this exception after the instruction
  4582. * that sets the TF flag".
  4583. */
  4584. if (unlikely(rflags & X86_EFLAGS_TF)) {
  4585. if (vcpu->guest_debug & KVM_GUESTDBG_SINGLESTEP) {
  4586. kvm_run->debug.arch.dr6 = DR6_BS | DR6_FIXED_1 |
  4587. DR6_RTM;
  4588. kvm_run->debug.arch.pc = vcpu->arch.singlestep_rip;
  4589. kvm_run->debug.arch.exception = DB_VECTOR;
  4590. kvm_run->exit_reason = KVM_EXIT_DEBUG;
  4591. *r = EMULATE_USER_EXIT;
  4592. } else {
  4593. vcpu->arch.emulate_ctxt.eflags &= ~X86_EFLAGS_TF;
  4594. /*
  4595. * "Certain debug exceptions may clear bit 0-3. The
  4596. * remaining contents of the DR6 register are never
  4597. * cleared by the processor".
  4598. */
  4599. vcpu->arch.dr6 &= ~15;
  4600. vcpu->arch.dr6 |= DR6_BS | DR6_RTM;
  4601. kvm_queue_exception(vcpu, DB_VECTOR);
  4602. }
  4603. }
  4604. }
  4605. static bool kvm_vcpu_check_breakpoint(struct kvm_vcpu *vcpu, int *r)
  4606. {
  4607. if (unlikely(vcpu->guest_debug & KVM_GUESTDBG_USE_HW_BP) &&
  4608. (vcpu->arch.guest_debug_dr7 & DR7_BP_EN_MASK)) {
  4609. struct kvm_run *kvm_run = vcpu->run;
  4610. unsigned long eip = kvm_get_linear_rip(vcpu);
  4611. u32 dr6 = kvm_vcpu_check_hw_bp(eip, 0,
  4612. vcpu->arch.guest_debug_dr7,
  4613. vcpu->arch.eff_db);
  4614. if (dr6 != 0) {
  4615. kvm_run->debug.arch.dr6 = dr6 | DR6_FIXED_1 | DR6_RTM;
  4616. kvm_run->debug.arch.pc = eip;
  4617. kvm_run->debug.arch.exception = DB_VECTOR;
  4618. kvm_run->exit_reason = KVM_EXIT_DEBUG;
  4619. *r = EMULATE_USER_EXIT;
  4620. return true;
  4621. }
  4622. }
  4623. if (unlikely(vcpu->arch.dr7 & DR7_BP_EN_MASK) &&
  4624. !(kvm_get_rflags(vcpu) & X86_EFLAGS_RF)) {
  4625. unsigned long eip = kvm_get_linear_rip(vcpu);
  4626. u32 dr6 = kvm_vcpu_check_hw_bp(eip, 0,
  4627. vcpu->arch.dr7,
  4628. vcpu->arch.db);
  4629. if (dr6 != 0) {
  4630. vcpu->arch.dr6 &= ~15;
  4631. vcpu->arch.dr6 |= dr6 | DR6_RTM;
  4632. kvm_queue_exception(vcpu, DB_VECTOR);
  4633. *r = EMULATE_DONE;
  4634. return true;
  4635. }
  4636. }
  4637. return false;
  4638. }
  4639. int x86_emulate_instruction(struct kvm_vcpu *vcpu,
  4640. unsigned long cr2,
  4641. int emulation_type,
  4642. void *insn,
  4643. int insn_len)
  4644. {
  4645. int r;
  4646. struct x86_emulate_ctxt *ctxt = &vcpu->arch.emulate_ctxt;
  4647. bool writeback = true;
  4648. bool write_fault_to_spt = vcpu->arch.write_fault_to_shadow_pgtable;
  4649. /*
  4650. * Clear write_fault_to_shadow_pgtable here to ensure it is
  4651. * never reused.
  4652. */
  4653. vcpu->arch.write_fault_to_shadow_pgtable = false;
  4654. kvm_clear_exception_queue(vcpu);
  4655. if (!(emulation_type & EMULTYPE_NO_DECODE)) {
  4656. init_emulate_ctxt(vcpu);
  4657. /*
  4658. * We will reenter on the same instruction since
  4659. * we do not set complete_userspace_io. This does not
  4660. * handle watchpoints yet, those would be handled in
  4661. * the emulate_ops.
  4662. */
  4663. if (kvm_vcpu_check_breakpoint(vcpu, &r))
  4664. return r;
  4665. ctxt->interruptibility = 0;
  4666. ctxt->have_exception = false;
  4667. ctxt->exception.vector = -1;
  4668. ctxt->perm_ok = false;
  4669. ctxt->ud = emulation_type & EMULTYPE_TRAP_UD;
  4670. r = x86_decode_insn(ctxt, insn, insn_len);
  4671. trace_kvm_emulate_insn_start(vcpu);
  4672. ++vcpu->stat.insn_emulation;
  4673. if (r != EMULATION_OK) {
  4674. if (emulation_type & EMULTYPE_TRAP_UD)
  4675. return EMULATE_FAIL;
  4676. if (reexecute_instruction(vcpu, cr2, write_fault_to_spt,
  4677. emulation_type))
  4678. return EMULATE_DONE;
  4679. if (emulation_type & EMULTYPE_SKIP)
  4680. return EMULATE_FAIL;
  4681. return handle_emulation_failure(vcpu);
  4682. }
  4683. }
  4684. if (emulation_type & EMULTYPE_SKIP) {
  4685. kvm_rip_write(vcpu, ctxt->_eip);
  4686. if (ctxt->eflags & X86_EFLAGS_RF)
  4687. kvm_set_rflags(vcpu, ctxt->eflags & ~X86_EFLAGS_RF);
  4688. return EMULATE_DONE;
  4689. }
  4690. if (retry_instruction(ctxt, cr2, emulation_type))
  4691. return EMULATE_DONE;
  4692. /* this is needed for vmware backdoor interface to work since it
  4693. changes registers values during IO operation */
  4694. if (vcpu->arch.emulate_regs_need_sync_from_vcpu) {
  4695. vcpu->arch.emulate_regs_need_sync_from_vcpu = false;
  4696. emulator_invalidate_register_cache(ctxt);
  4697. }
  4698. restart:
  4699. r = x86_emulate_insn(ctxt);
  4700. if (r == EMULATION_INTERCEPTED)
  4701. return EMULATE_DONE;
  4702. if (r == EMULATION_FAILED) {
  4703. if (reexecute_instruction(vcpu, cr2, write_fault_to_spt,
  4704. emulation_type))
  4705. return EMULATE_DONE;
  4706. return handle_emulation_failure(vcpu);
  4707. }
  4708. if (ctxt->have_exception) {
  4709. r = EMULATE_DONE;
  4710. if (inject_emulated_exception(vcpu))
  4711. return r;
  4712. } else if (vcpu->arch.pio.count) {
  4713. if (!vcpu->arch.pio.in) {
  4714. /* FIXME: return into emulator if single-stepping. */
  4715. vcpu->arch.pio.count = 0;
  4716. } else {
  4717. writeback = false;
  4718. vcpu->arch.complete_userspace_io = complete_emulated_pio;
  4719. }
  4720. r = EMULATE_USER_EXIT;
  4721. } else if (vcpu->mmio_needed) {
  4722. if (!vcpu->mmio_is_write)
  4723. writeback = false;
  4724. r = EMULATE_USER_EXIT;
  4725. vcpu->arch.complete_userspace_io = complete_emulated_mmio;
  4726. } else if (r == EMULATION_RESTART)
  4727. goto restart;
  4728. else
  4729. r = EMULATE_DONE;
  4730. if (writeback) {
  4731. unsigned long rflags = kvm_x86_ops->get_rflags(vcpu);
  4732. toggle_interruptibility(vcpu, ctxt->interruptibility);
  4733. vcpu->arch.emulate_regs_need_sync_to_vcpu = false;
  4734. kvm_rip_write(vcpu, ctxt->eip);
  4735. if (r == EMULATE_DONE)
  4736. kvm_vcpu_check_singlestep(vcpu, rflags, &r);
  4737. if (!ctxt->have_exception ||
  4738. exception_type(ctxt->exception.vector) == EXCPT_TRAP)
  4739. __kvm_set_rflags(vcpu, ctxt->eflags);
  4740. /*
  4741. * For STI, interrupts are shadowed; so KVM_REQ_EVENT will
  4742. * do nothing, and it will be requested again as soon as
  4743. * the shadow expires. But we still need to check here,
  4744. * because POPF has no interrupt shadow.
  4745. */
  4746. if (unlikely((ctxt->eflags & ~rflags) & X86_EFLAGS_IF))
  4747. kvm_make_request(KVM_REQ_EVENT, vcpu);
  4748. } else
  4749. vcpu->arch.emulate_regs_need_sync_to_vcpu = true;
  4750. return r;
  4751. }
  4752. EXPORT_SYMBOL_GPL(x86_emulate_instruction);
  4753. int kvm_fast_pio_out(struct kvm_vcpu *vcpu, int size, unsigned short port)
  4754. {
  4755. unsigned long val = kvm_register_read(vcpu, VCPU_REGS_RAX);
  4756. int ret = emulator_pio_out_emulated(&vcpu->arch.emulate_ctxt,
  4757. size, port, &val, 1);
  4758. /* do not return to emulator after return from userspace */
  4759. vcpu->arch.pio.count = 0;
  4760. return ret;
  4761. }
  4762. EXPORT_SYMBOL_GPL(kvm_fast_pio_out);
  4763. static void tsc_bad(void *info)
  4764. {
  4765. __this_cpu_write(cpu_tsc_khz, 0);
  4766. }
  4767. static void tsc_khz_changed(void *data)
  4768. {
  4769. struct cpufreq_freqs *freq = data;
  4770. unsigned long khz = 0;
  4771. if (data)
  4772. khz = freq->new;
  4773. else if (!boot_cpu_has(X86_FEATURE_CONSTANT_TSC))
  4774. khz = cpufreq_quick_get(raw_smp_processor_id());
  4775. if (!khz)
  4776. khz = tsc_khz;
  4777. __this_cpu_write(cpu_tsc_khz, khz);
  4778. }
  4779. static int kvmclock_cpufreq_notifier(struct notifier_block *nb, unsigned long val,
  4780. void *data)
  4781. {
  4782. struct cpufreq_freqs *freq = data;
  4783. struct kvm *kvm;
  4784. struct kvm_vcpu *vcpu;
  4785. int i, send_ipi = 0;
  4786. /*
  4787. * We allow guests to temporarily run on slowing clocks,
  4788. * provided we notify them after, or to run on accelerating
  4789. * clocks, provided we notify them before. Thus time never
  4790. * goes backwards.
  4791. *
  4792. * However, we have a problem. We can't atomically update
  4793. * the frequency of a given CPU from this function; it is
  4794. * merely a notifier, which can be called from any CPU.
  4795. * Changing the TSC frequency at arbitrary points in time
  4796. * requires a recomputation of local variables related to
  4797. * the TSC for each VCPU. We must flag these local variables
  4798. * to be updated and be sure the update takes place with the
  4799. * new frequency before any guests proceed.
  4800. *
  4801. * Unfortunately, the combination of hotplug CPU and frequency
  4802. * change creates an intractable locking scenario; the order
  4803. * of when these callouts happen is undefined with respect to
  4804. * CPU hotplug, and they can race with each other. As such,
  4805. * merely setting per_cpu(cpu_tsc_khz) = X during a hotadd is
  4806. * undefined; you can actually have a CPU frequency change take
  4807. * place in between the computation of X and the setting of the
  4808. * variable. To protect against this problem, all updates of
  4809. * the per_cpu tsc_khz variable are done in an interrupt
  4810. * protected IPI, and all callers wishing to update the value
  4811. * must wait for a synchronous IPI to complete (which is trivial
  4812. * if the caller is on the CPU already). This establishes the
  4813. * necessary total order on variable updates.
  4814. *
  4815. * Note that because a guest time update may take place
  4816. * anytime after the setting of the VCPU's request bit, the
  4817. * correct TSC value must be set before the request. However,
  4818. * to ensure the update actually makes it to any guest which
  4819. * starts running in hardware virtualization between the set
  4820. * and the acquisition of the spinlock, we must also ping the
  4821. * CPU after setting the request bit.
  4822. *
  4823. */
  4824. if (val == CPUFREQ_PRECHANGE && freq->old > freq->new)
  4825. return 0;
  4826. if (val == CPUFREQ_POSTCHANGE && freq->old < freq->new)
  4827. return 0;
  4828. smp_call_function_single(freq->cpu, tsc_khz_changed, freq, 1);
  4829. spin_lock(&kvm_lock);
  4830. list_for_each_entry(kvm, &vm_list, vm_list) {
  4831. kvm_for_each_vcpu(i, vcpu, kvm) {
  4832. if (vcpu->cpu != freq->cpu)
  4833. continue;
  4834. kvm_make_request(KVM_REQ_CLOCK_UPDATE, vcpu);
  4835. if (vcpu->cpu != smp_processor_id())
  4836. send_ipi = 1;
  4837. }
  4838. }
  4839. spin_unlock(&kvm_lock);
  4840. if (freq->old < freq->new && send_ipi) {
  4841. /*
  4842. * We upscale the frequency. Must make the guest
  4843. * doesn't see old kvmclock values while running with
  4844. * the new frequency, otherwise we risk the guest sees
  4845. * time go backwards.
  4846. *
  4847. * In case we update the frequency for another cpu
  4848. * (which might be in guest context) send an interrupt
  4849. * to kick the cpu out of guest context. Next time
  4850. * guest context is entered kvmclock will be updated,
  4851. * so the guest will not see stale values.
  4852. */
  4853. smp_call_function_single(freq->cpu, tsc_khz_changed, freq, 1);
  4854. }
  4855. return 0;
  4856. }
  4857. static struct notifier_block kvmclock_cpufreq_notifier_block = {
  4858. .notifier_call = kvmclock_cpufreq_notifier
  4859. };
  4860. static int kvmclock_cpu_notifier(struct notifier_block *nfb,
  4861. unsigned long action, void *hcpu)
  4862. {
  4863. unsigned int cpu = (unsigned long)hcpu;
  4864. switch (action) {
  4865. case CPU_ONLINE:
  4866. case CPU_DOWN_FAILED:
  4867. smp_call_function_single(cpu, tsc_khz_changed, NULL, 1);
  4868. break;
  4869. case CPU_DOWN_PREPARE:
  4870. smp_call_function_single(cpu, tsc_bad, NULL, 1);
  4871. break;
  4872. }
  4873. return NOTIFY_OK;
  4874. }
  4875. static struct notifier_block kvmclock_cpu_notifier_block = {
  4876. .notifier_call = kvmclock_cpu_notifier,
  4877. .priority = -INT_MAX
  4878. };
  4879. static void kvm_timer_init(void)
  4880. {
  4881. int cpu;
  4882. max_tsc_khz = tsc_khz;
  4883. cpu_notifier_register_begin();
  4884. if (!boot_cpu_has(X86_FEATURE_CONSTANT_TSC)) {
  4885. #ifdef CONFIG_CPU_FREQ
  4886. struct cpufreq_policy policy;
  4887. memset(&policy, 0, sizeof(policy));
  4888. cpu = get_cpu();
  4889. cpufreq_get_policy(&policy, cpu);
  4890. if (policy.cpuinfo.max_freq)
  4891. max_tsc_khz = policy.cpuinfo.max_freq;
  4892. put_cpu();
  4893. #endif
  4894. cpufreq_register_notifier(&kvmclock_cpufreq_notifier_block,
  4895. CPUFREQ_TRANSITION_NOTIFIER);
  4896. }
  4897. pr_debug("kvm: max_tsc_khz = %ld\n", max_tsc_khz);
  4898. for_each_online_cpu(cpu)
  4899. smp_call_function_single(cpu, tsc_khz_changed, NULL, 1);
  4900. __register_hotcpu_notifier(&kvmclock_cpu_notifier_block);
  4901. cpu_notifier_register_done();
  4902. }
  4903. static DEFINE_PER_CPU(struct kvm_vcpu *, current_vcpu);
  4904. int kvm_is_in_guest(void)
  4905. {
  4906. return __this_cpu_read(current_vcpu) != NULL;
  4907. }
  4908. static int kvm_is_user_mode(void)
  4909. {
  4910. int user_mode = 3;
  4911. if (__this_cpu_read(current_vcpu))
  4912. user_mode = kvm_x86_ops->get_cpl(__this_cpu_read(current_vcpu));
  4913. return user_mode != 0;
  4914. }
  4915. static unsigned long kvm_get_guest_ip(void)
  4916. {
  4917. unsigned long ip = 0;
  4918. if (__this_cpu_read(current_vcpu))
  4919. ip = kvm_rip_read(__this_cpu_read(current_vcpu));
  4920. return ip;
  4921. }
  4922. static struct perf_guest_info_callbacks kvm_guest_cbs = {
  4923. .is_in_guest = kvm_is_in_guest,
  4924. .is_user_mode = kvm_is_user_mode,
  4925. .get_guest_ip = kvm_get_guest_ip,
  4926. };
  4927. void kvm_before_handle_nmi(struct kvm_vcpu *vcpu)
  4928. {
  4929. __this_cpu_write(current_vcpu, vcpu);
  4930. }
  4931. EXPORT_SYMBOL_GPL(kvm_before_handle_nmi);
  4932. void kvm_after_handle_nmi(struct kvm_vcpu *vcpu)
  4933. {
  4934. __this_cpu_write(current_vcpu, NULL);
  4935. }
  4936. EXPORT_SYMBOL_GPL(kvm_after_handle_nmi);
  4937. static void kvm_set_mmio_spte_mask(void)
  4938. {
  4939. u64 mask;
  4940. int maxphyaddr = boot_cpu_data.x86_phys_bits;
  4941. /*
  4942. * Set the reserved bits and the present bit of an paging-structure
  4943. * entry to generate page fault with PFER.RSV = 1.
  4944. */
  4945. /* Mask the reserved physical address bits. */
  4946. mask = rsvd_bits(maxphyaddr, 51);
  4947. /* Bit 62 is always reserved for 32bit host. */
  4948. mask |= 0x3ull << 62;
  4949. /* Set the present bit. */
  4950. mask |= 1ull;
  4951. #ifdef CONFIG_X86_64
  4952. /*
  4953. * If reserved bit is not supported, clear the present bit to disable
  4954. * mmio page fault.
  4955. */
  4956. if (maxphyaddr == 52)
  4957. mask &= ~1ull;
  4958. #endif
  4959. kvm_mmu_set_mmio_spte_mask(mask);
  4960. }
  4961. #ifdef CONFIG_X86_64
  4962. static void pvclock_gtod_update_fn(struct work_struct *work)
  4963. {
  4964. struct kvm *kvm;
  4965. struct kvm_vcpu *vcpu;
  4966. int i;
  4967. spin_lock(&kvm_lock);
  4968. list_for_each_entry(kvm, &vm_list, vm_list)
  4969. kvm_for_each_vcpu(i, vcpu, kvm)
  4970. kvm_make_request(KVM_REQ_MASTERCLOCK_UPDATE, vcpu);
  4971. atomic_set(&kvm_guest_has_master_clock, 0);
  4972. spin_unlock(&kvm_lock);
  4973. }
  4974. static DECLARE_WORK(pvclock_gtod_work, pvclock_gtod_update_fn);
  4975. /*
  4976. * Notification about pvclock gtod data update.
  4977. */
  4978. static int pvclock_gtod_notify(struct notifier_block *nb, unsigned long unused,
  4979. void *priv)
  4980. {
  4981. struct pvclock_gtod_data *gtod = &pvclock_gtod_data;
  4982. struct timekeeper *tk = priv;
  4983. update_pvclock_gtod(tk);
  4984. /* disable master clock if host does not trust, or does not
  4985. * use, TSC clocksource
  4986. */
  4987. if (gtod->clock.vclock_mode != VCLOCK_TSC &&
  4988. atomic_read(&kvm_guest_has_master_clock) != 0)
  4989. queue_work(system_long_wq, &pvclock_gtod_work);
  4990. return 0;
  4991. }
  4992. static struct notifier_block pvclock_gtod_notifier = {
  4993. .notifier_call = pvclock_gtod_notify,
  4994. };
  4995. #endif
  4996. int kvm_arch_init(void *opaque)
  4997. {
  4998. int r;
  4999. struct kvm_x86_ops *ops = opaque;
  5000. if (kvm_x86_ops) {
  5001. printk(KERN_ERR "kvm: already loaded the other module\n");
  5002. r = -EEXIST;
  5003. goto out;
  5004. }
  5005. if (!ops->cpu_has_kvm_support()) {
  5006. printk(KERN_ERR "kvm: no hardware support\n");
  5007. r = -EOPNOTSUPP;
  5008. goto out;
  5009. }
  5010. if (ops->disabled_by_bios()) {
  5011. printk(KERN_ERR "kvm: disabled by bios\n");
  5012. r = -EOPNOTSUPP;
  5013. goto out;
  5014. }
  5015. r = -ENOMEM;
  5016. shared_msrs = alloc_percpu(struct kvm_shared_msrs);
  5017. if (!shared_msrs) {
  5018. printk(KERN_ERR "kvm: failed to allocate percpu kvm_shared_msrs\n");
  5019. goto out;
  5020. }
  5021. r = kvm_mmu_module_init();
  5022. if (r)
  5023. goto out_free_percpu;
  5024. kvm_set_mmio_spte_mask();
  5025. kvm_x86_ops = ops;
  5026. kvm_mmu_set_mask_ptes(PT_USER_MASK, PT_ACCESSED_MASK,
  5027. PT_DIRTY_MASK, PT64_NX_MASK, 0);
  5028. kvm_timer_init();
  5029. perf_register_guest_info_callbacks(&kvm_guest_cbs);
  5030. if (cpu_has_xsave)
  5031. host_xcr0 = xgetbv(XCR_XFEATURE_ENABLED_MASK);
  5032. kvm_lapic_init();
  5033. #ifdef CONFIG_X86_64
  5034. pvclock_gtod_register_notifier(&pvclock_gtod_notifier);
  5035. #endif
  5036. return 0;
  5037. out_free_percpu:
  5038. free_percpu(shared_msrs);
  5039. out:
  5040. return r;
  5041. }
  5042. void kvm_arch_exit(void)
  5043. {
  5044. perf_unregister_guest_info_callbacks(&kvm_guest_cbs);
  5045. if (!boot_cpu_has(X86_FEATURE_CONSTANT_TSC))
  5046. cpufreq_unregister_notifier(&kvmclock_cpufreq_notifier_block,
  5047. CPUFREQ_TRANSITION_NOTIFIER);
  5048. unregister_hotcpu_notifier(&kvmclock_cpu_notifier_block);
  5049. #ifdef CONFIG_X86_64
  5050. pvclock_gtod_unregister_notifier(&pvclock_gtod_notifier);
  5051. #endif
  5052. kvm_x86_ops = NULL;
  5053. kvm_mmu_module_exit();
  5054. free_percpu(shared_msrs);
  5055. }
  5056. int kvm_vcpu_halt(struct kvm_vcpu *vcpu)
  5057. {
  5058. ++vcpu->stat.halt_exits;
  5059. if (irqchip_in_kernel(vcpu->kvm)) {
  5060. vcpu->arch.mp_state = KVM_MP_STATE_HALTED;
  5061. return 1;
  5062. } else {
  5063. vcpu->run->exit_reason = KVM_EXIT_HLT;
  5064. return 0;
  5065. }
  5066. }
  5067. EXPORT_SYMBOL_GPL(kvm_vcpu_halt);
  5068. int kvm_emulate_halt(struct kvm_vcpu *vcpu)
  5069. {
  5070. kvm_x86_ops->skip_emulated_instruction(vcpu);
  5071. return kvm_vcpu_halt(vcpu);
  5072. }
  5073. EXPORT_SYMBOL_GPL(kvm_emulate_halt);
  5074. int kvm_hv_hypercall(struct kvm_vcpu *vcpu)
  5075. {
  5076. u64 param, ingpa, outgpa, ret;
  5077. uint16_t code, rep_idx, rep_cnt, res = HV_STATUS_SUCCESS, rep_done = 0;
  5078. bool fast, longmode;
  5079. /*
  5080. * hypercall generates UD from non zero cpl and real mode
  5081. * per HYPER-V spec
  5082. */
  5083. if (kvm_x86_ops->get_cpl(vcpu) != 0 || !is_protmode(vcpu)) {
  5084. kvm_queue_exception(vcpu, UD_VECTOR);
  5085. return 0;
  5086. }
  5087. longmode = is_64_bit_mode(vcpu);
  5088. if (!longmode) {
  5089. param = ((u64)kvm_register_read(vcpu, VCPU_REGS_RDX) << 32) |
  5090. (kvm_register_read(vcpu, VCPU_REGS_RAX) & 0xffffffff);
  5091. ingpa = ((u64)kvm_register_read(vcpu, VCPU_REGS_RBX) << 32) |
  5092. (kvm_register_read(vcpu, VCPU_REGS_RCX) & 0xffffffff);
  5093. outgpa = ((u64)kvm_register_read(vcpu, VCPU_REGS_RDI) << 32) |
  5094. (kvm_register_read(vcpu, VCPU_REGS_RSI) & 0xffffffff);
  5095. }
  5096. #ifdef CONFIG_X86_64
  5097. else {
  5098. param = kvm_register_read(vcpu, VCPU_REGS_RCX);
  5099. ingpa = kvm_register_read(vcpu, VCPU_REGS_RDX);
  5100. outgpa = kvm_register_read(vcpu, VCPU_REGS_R8);
  5101. }
  5102. #endif
  5103. code = param & 0xffff;
  5104. fast = (param >> 16) & 0x1;
  5105. rep_cnt = (param >> 32) & 0xfff;
  5106. rep_idx = (param >> 48) & 0xfff;
  5107. trace_kvm_hv_hypercall(code, fast, rep_cnt, rep_idx, ingpa, outgpa);
  5108. switch (code) {
  5109. case HV_X64_HV_NOTIFY_LONG_SPIN_WAIT:
  5110. kvm_vcpu_on_spin(vcpu);
  5111. break;
  5112. default:
  5113. res = HV_STATUS_INVALID_HYPERCALL_CODE;
  5114. break;
  5115. }
  5116. ret = res | (((u64)rep_done & 0xfff) << 32);
  5117. if (longmode) {
  5118. kvm_register_write(vcpu, VCPU_REGS_RAX, ret);
  5119. } else {
  5120. kvm_register_write(vcpu, VCPU_REGS_RDX, ret >> 32);
  5121. kvm_register_write(vcpu, VCPU_REGS_RAX, ret & 0xffffffff);
  5122. }
  5123. return 1;
  5124. }
  5125. /*
  5126. * kvm_pv_kick_cpu_op: Kick a vcpu.
  5127. *
  5128. * @apicid - apicid of vcpu to be kicked.
  5129. */
  5130. static void kvm_pv_kick_cpu_op(struct kvm *kvm, unsigned long flags, int apicid)
  5131. {
  5132. struct kvm_lapic_irq lapic_irq;
  5133. lapic_irq.shorthand = 0;
  5134. lapic_irq.dest_mode = 0;
  5135. lapic_irq.dest_id = apicid;
  5136. lapic_irq.delivery_mode = APIC_DM_REMRD;
  5137. kvm_irq_delivery_to_apic(kvm, NULL, &lapic_irq, NULL);
  5138. }
  5139. int kvm_emulate_hypercall(struct kvm_vcpu *vcpu)
  5140. {
  5141. unsigned long nr, a0, a1, a2, a3, ret;
  5142. int op_64_bit, r = 1;
  5143. kvm_x86_ops->skip_emulated_instruction(vcpu);
  5144. if (kvm_hv_hypercall_enabled(vcpu->kvm))
  5145. return kvm_hv_hypercall(vcpu);
  5146. nr = kvm_register_read(vcpu, VCPU_REGS_RAX);
  5147. a0 = kvm_register_read(vcpu, VCPU_REGS_RBX);
  5148. a1 = kvm_register_read(vcpu, VCPU_REGS_RCX);
  5149. a2 = kvm_register_read(vcpu, VCPU_REGS_RDX);
  5150. a3 = kvm_register_read(vcpu, VCPU_REGS_RSI);
  5151. trace_kvm_hypercall(nr, a0, a1, a2, a3);
  5152. op_64_bit = is_64_bit_mode(vcpu);
  5153. if (!op_64_bit) {
  5154. nr &= 0xFFFFFFFF;
  5155. a0 &= 0xFFFFFFFF;
  5156. a1 &= 0xFFFFFFFF;
  5157. a2 &= 0xFFFFFFFF;
  5158. a3 &= 0xFFFFFFFF;
  5159. }
  5160. if (kvm_x86_ops->get_cpl(vcpu) != 0) {
  5161. ret = -KVM_EPERM;
  5162. goto out;
  5163. }
  5164. switch (nr) {
  5165. case KVM_HC_VAPIC_POLL_IRQ:
  5166. ret = 0;
  5167. break;
  5168. case KVM_HC_KICK_CPU:
  5169. kvm_pv_kick_cpu_op(vcpu->kvm, a0, a1);
  5170. ret = 0;
  5171. break;
  5172. default:
  5173. ret = -KVM_ENOSYS;
  5174. break;
  5175. }
  5176. out:
  5177. if (!op_64_bit)
  5178. ret = (u32)ret;
  5179. kvm_register_write(vcpu, VCPU_REGS_RAX, ret);
  5180. ++vcpu->stat.hypercalls;
  5181. return r;
  5182. }
  5183. EXPORT_SYMBOL_GPL(kvm_emulate_hypercall);
  5184. static int emulator_fix_hypercall(struct x86_emulate_ctxt *ctxt)
  5185. {
  5186. struct kvm_vcpu *vcpu = emul_to_vcpu(ctxt);
  5187. char instruction[3];
  5188. unsigned long rip = kvm_rip_read(vcpu);
  5189. kvm_x86_ops->patch_hypercall(vcpu, instruction);
  5190. return emulator_write_emulated(ctxt, rip, instruction, 3, NULL);
  5191. }
  5192. /*
  5193. * Check if userspace requested an interrupt window, and that the
  5194. * interrupt window is open.
  5195. *
  5196. * No need to exit to userspace if we already have an interrupt queued.
  5197. */
  5198. static int dm_request_for_irq_injection(struct kvm_vcpu *vcpu)
  5199. {
  5200. return (!irqchip_in_kernel(vcpu->kvm) && !kvm_cpu_has_interrupt(vcpu) &&
  5201. vcpu->run->request_interrupt_window &&
  5202. kvm_arch_interrupt_allowed(vcpu));
  5203. }
  5204. static void post_kvm_run_save(struct kvm_vcpu *vcpu)
  5205. {
  5206. struct kvm_run *kvm_run = vcpu->run;
  5207. kvm_run->if_flag = (kvm_get_rflags(vcpu) & X86_EFLAGS_IF) != 0;
  5208. kvm_run->cr8 = kvm_get_cr8(vcpu);
  5209. kvm_run->apic_base = kvm_get_apic_base(vcpu);
  5210. if (irqchip_in_kernel(vcpu->kvm))
  5211. kvm_run->ready_for_interrupt_injection = 1;
  5212. else
  5213. kvm_run->ready_for_interrupt_injection =
  5214. kvm_arch_interrupt_allowed(vcpu) &&
  5215. !kvm_cpu_has_interrupt(vcpu) &&
  5216. !kvm_event_needs_reinjection(vcpu);
  5217. }
  5218. static void update_cr8_intercept(struct kvm_vcpu *vcpu)
  5219. {
  5220. int max_irr, tpr;
  5221. if (!kvm_x86_ops->update_cr8_intercept)
  5222. return;
  5223. if (!vcpu->arch.apic)
  5224. return;
  5225. if (!vcpu->arch.apic->vapic_addr)
  5226. max_irr = kvm_lapic_find_highest_irr(vcpu);
  5227. else
  5228. max_irr = -1;
  5229. if (max_irr != -1)
  5230. max_irr >>= 4;
  5231. tpr = kvm_lapic_get_cr8(vcpu);
  5232. kvm_x86_ops->update_cr8_intercept(vcpu, tpr, max_irr);
  5233. }
  5234. static int inject_pending_event(struct kvm_vcpu *vcpu, bool req_int_win)
  5235. {
  5236. int r;
  5237. /* try to reinject previous events if any */
  5238. if (vcpu->arch.exception.pending) {
  5239. trace_kvm_inj_exception(vcpu->arch.exception.nr,
  5240. vcpu->arch.exception.has_error_code,
  5241. vcpu->arch.exception.error_code);
  5242. if (exception_type(vcpu->arch.exception.nr) == EXCPT_FAULT)
  5243. __kvm_set_rflags(vcpu, kvm_get_rflags(vcpu) |
  5244. X86_EFLAGS_RF);
  5245. if (vcpu->arch.exception.nr == DB_VECTOR &&
  5246. (vcpu->arch.dr7 & DR7_GD)) {
  5247. vcpu->arch.dr7 &= ~DR7_GD;
  5248. kvm_update_dr7(vcpu);
  5249. }
  5250. kvm_x86_ops->queue_exception(vcpu, vcpu->arch.exception.nr,
  5251. vcpu->arch.exception.has_error_code,
  5252. vcpu->arch.exception.error_code,
  5253. vcpu->arch.exception.reinject);
  5254. return 0;
  5255. }
  5256. if (vcpu->arch.nmi_injected) {
  5257. kvm_x86_ops->set_nmi(vcpu);
  5258. return 0;
  5259. }
  5260. if (vcpu->arch.interrupt.pending) {
  5261. kvm_x86_ops->set_irq(vcpu);
  5262. return 0;
  5263. }
  5264. if (is_guest_mode(vcpu) && kvm_x86_ops->check_nested_events) {
  5265. r = kvm_x86_ops->check_nested_events(vcpu, req_int_win);
  5266. if (r != 0)
  5267. return r;
  5268. }
  5269. /* try to inject new event if pending */
  5270. if (vcpu->arch.nmi_pending) {
  5271. if (kvm_x86_ops->nmi_allowed(vcpu)) {
  5272. --vcpu->arch.nmi_pending;
  5273. vcpu->arch.nmi_injected = true;
  5274. kvm_x86_ops->set_nmi(vcpu);
  5275. }
  5276. } else if (kvm_cpu_has_injectable_intr(vcpu)) {
  5277. /*
  5278. * Because interrupts can be injected asynchronously, we are
  5279. * calling check_nested_events again here to avoid a race condition.
  5280. * See https://lkml.org/lkml/2014/7/2/60 for discussion about this
  5281. * proposal and current concerns. Perhaps we should be setting
  5282. * KVM_REQ_EVENT only on certain events and not unconditionally?
  5283. */
  5284. if (is_guest_mode(vcpu) && kvm_x86_ops->check_nested_events) {
  5285. r = kvm_x86_ops->check_nested_events(vcpu, req_int_win);
  5286. if (r != 0)
  5287. return r;
  5288. }
  5289. if (kvm_x86_ops->interrupt_allowed(vcpu)) {
  5290. kvm_queue_interrupt(vcpu, kvm_cpu_get_interrupt(vcpu),
  5291. false);
  5292. kvm_x86_ops->set_irq(vcpu);
  5293. }
  5294. }
  5295. return 0;
  5296. }
  5297. static void process_nmi(struct kvm_vcpu *vcpu)
  5298. {
  5299. unsigned limit = 2;
  5300. /*
  5301. * x86 is limited to one NMI running, and one NMI pending after it.
  5302. * If an NMI is already in progress, limit further NMIs to just one.
  5303. * Otherwise, allow two (and we'll inject the first one immediately).
  5304. */
  5305. if (kvm_x86_ops->get_nmi_mask(vcpu) || vcpu->arch.nmi_injected)
  5306. limit = 1;
  5307. vcpu->arch.nmi_pending += atomic_xchg(&vcpu->arch.nmi_queued, 0);
  5308. vcpu->arch.nmi_pending = min(vcpu->arch.nmi_pending, limit);
  5309. kvm_make_request(KVM_REQ_EVENT, vcpu);
  5310. }
  5311. static void vcpu_scan_ioapic(struct kvm_vcpu *vcpu)
  5312. {
  5313. u64 eoi_exit_bitmap[4];
  5314. u32 tmr[8];
  5315. if (!kvm_apic_hw_enabled(vcpu->arch.apic))
  5316. return;
  5317. memset(eoi_exit_bitmap, 0, 32);
  5318. memset(tmr, 0, 32);
  5319. kvm_ioapic_scan_entry(vcpu, eoi_exit_bitmap, tmr);
  5320. kvm_x86_ops->load_eoi_exitmap(vcpu, eoi_exit_bitmap);
  5321. kvm_apic_update_tmr(vcpu, tmr);
  5322. }
  5323. static void kvm_vcpu_flush_tlb(struct kvm_vcpu *vcpu)
  5324. {
  5325. ++vcpu->stat.tlb_flush;
  5326. kvm_x86_ops->tlb_flush(vcpu);
  5327. }
  5328. void kvm_vcpu_reload_apic_access_page(struct kvm_vcpu *vcpu)
  5329. {
  5330. struct page *page = NULL;
  5331. if (!irqchip_in_kernel(vcpu->kvm))
  5332. return;
  5333. if (!kvm_x86_ops->set_apic_access_page_addr)
  5334. return;
  5335. page = gfn_to_page(vcpu->kvm, APIC_DEFAULT_PHYS_BASE >> PAGE_SHIFT);
  5336. kvm_x86_ops->set_apic_access_page_addr(vcpu, page_to_phys(page));
  5337. /*
  5338. * Do not pin apic access page in memory, the MMU notifier
  5339. * will call us again if it is migrated or swapped out.
  5340. */
  5341. put_page(page);
  5342. }
  5343. EXPORT_SYMBOL_GPL(kvm_vcpu_reload_apic_access_page);
  5344. void kvm_arch_mmu_notifier_invalidate_page(struct kvm *kvm,
  5345. unsigned long address)
  5346. {
  5347. /*
  5348. * The physical address of apic access page is stored in the VMCS.
  5349. * Update it when it becomes invalid.
  5350. */
  5351. if (address == gfn_to_hva(kvm, APIC_DEFAULT_PHYS_BASE >> PAGE_SHIFT))
  5352. kvm_make_all_cpus_request(kvm, KVM_REQ_APIC_PAGE_RELOAD);
  5353. }
  5354. /*
  5355. * Returns 1 to let vcpu_run() continue the guest execution loop without
  5356. * exiting to the userspace. Otherwise, the value will be returned to the
  5357. * userspace.
  5358. */
  5359. static int vcpu_enter_guest(struct kvm_vcpu *vcpu)
  5360. {
  5361. int r;
  5362. bool req_int_win = !irqchip_in_kernel(vcpu->kvm) &&
  5363. vcpu->run->request_interrupt_window;
  5364. bool req_immediate_exit = false;
  5365. if (vcpu->requests) {
  5366. if (kvm_check_request(KVM_REQ_MMU_RELOAD, vcpu))
  5367. kvm_mmu_unload(vcpu);
  5368. if (kvm_check_request(KVM_REQ_MIGRATE_TIMER, vcpu))
  5369. __kvm_migrate_timers(vcpu);
  5370. if (kvm_check_request(KVM_REQ_MASTERCLOCK_UPDATE, vcpu))
  5371. kvm_gen_update_masterclock(vcpu->kvm);
  5372. if (kvm_check_request(KVM_REQ_GLOBAL_CLOCK_UPDATE, vcpu))
  5373. kvm_gen_kvmclock_update(vcpu);
  5374. if (kvm_check_request(KVM_REQ_CLOCK_UPDATE, vcpu)) {
  5375. r = kvm_guest_time_update(vcpu);
  5376. if (unlikely(r))
  5377. goto out;
  5378. }
  5379. if (kvm_check_request(KVM_REQ_MMU_SYNC, vcpu))
  5380. kvm_mmu_sync_roots(vcpu);
  5381. if (kvm_check_request(KVM_REQ_TLB_FLUSH, vcpu))
  5382. kvm_vcpu_flush_tlb(vcpu);
  5383. if (kvm_check_request(KVM_REQ_REPORT_TPR_ACCESS, vcpu)) {
  5384. vcpu->run->exit_reason = KVM_EXIT_TPR_ACCESS;
  5385. r = 0;
  5386. goto out;
  5387. }
  5388. if (kvm_check_request(KVM_REQ_TRIPLE_FAULT, vcpu)) {
  5389. vcpu->run->exit_reason = KVM_EXIT_SHUTDOWN;
  5390. r = 0;
  5391. goto out;
  5392. }
  5393. if (kvm_check_request(KVM_REQ_DEACTIVATE_FPU, vcpu)) {
  5394. vcpu->fpu_active = 0;
  5395. kvm_x86_ops->fpu_deactivate(vcpu);
  5396. }
  5397. if (kvm_check_request(KVM_REQ_APF_HALT, vcpu)) {
  5398. /* Page is swapped out. Do synthetic halt */
  5399. vcpu->arch.apf.halted = true;
  5400. r = 1;
  5401. goto out;
  5402. }
  5403. if (kvm_check_request(KVM_REQ_STEAL_UPDATE, vcpu))
  5404. record_steal_time(vcpu);
  5405. if (kvm_check_request(KVM_REQ_NMI, vcpu))
  5406. process_nmi(vcpu);
  5407. if (kvm_check_request(KVM_REQ_PMU, vcpu))
  5408. kvm_handle_pmu_event(vcpu);
  5409. if (kvm_check_request(KVM_REQ_PMI, vcpu))
  5410. kvm_deliver_pmi(vcpu);
  5411. if (kvm_check_request(KVM_REQ_SCAN_IOAPIC, vcpu))
  5412. vcpu_scan_ioapic(vcpu);
  5413. if (kvm_check_request(KVM_REQ_APIC_PAGE_RELOAD, vcpu))
  5414. kvm_vcpu_reload_apic_access_page(vcpu);
  5415. }
  5416. if (kvm_check_request(KVM_REQ_EVENT, vcpu) || req_int_win) {
  5417. kvm_apic_accept_events(vcpu);
  5418. if (vcpu->arch.mp_state == KVM_MP_STATE_INIT_RECEIVED) {
  5419. r = 1;
  5420. goto out;
  5421. }
  5422. if (inject_pending_event(vcpu, req_int_win) != 0)
  5423. req_immediate_exit = true;
  5424. /* enable NMI/IRQ window open exits if needed */
  5425. else if (vcpu->arch.nmi_pending)
  5426. kvm_x86_ops->enable_nmi_window(vcpu);
  5427. else if (kvm_cpu_has_injectable_intr(vcpu) || req_int_win)
  5428. kvm_x86_ops->enable_irq_window(vcpu);
  5429. if (kvm_lapic_enabled(vcpu)) {
  5430. /*
  5431. * Update architecture specific hints for APIC
  5432. * virtual interrupt delivery.
  5433. */
  5434. if (kvm_x86_ops->hwapic_irr_update)
  5435. kvm_x86_ops->hwapic_irr_update(vcpu,
  5436. kvm_lapic_find_highest_irr(vcpu));
  5437. update_cr8_intercept(vcpu);
  5438. kvm_lapic_sync_to_vapic(vcpu);
  5439. }
  5440. }
  5441. r = kvm_mmu_reload(vcpu);
  5442. if (unlikely(r)) {
  5443. goto cancel_injection;
  5444. }
  5445. preempt_disable();
  5446. kvm_x86_ops->prepare_guest_switch(vcpu);
  5447. if (vcpu->fpu_active)
  5448. kvm_load_guest_fpu(vcpu);
  5449. kvm_load_guest_xcr0(vcpu);
  5450. vcpu->mode = IN_GUEST_MODE;
  5451. srcu_read_unlock(&vcpu->kvm->srcu, vcpu->srcu_idx);
  5452. /* We should set ->mode before check ->requests,
  5453. * see the comment in make_all_cpus_request.
  5454. */
  5455. smp_mb__after_srcu_read_unlock();
  5456. local_irq_disable();
  5457. if (vcpu->mode == EXITING_GUEST_MODE || vcpu->requests
  5458. || need_resched() || signal_pending(current)) {
  5459. vcpu->mode = OUTSIDE_GUEST_MODE;
  5460. smp_wmb();
  5461. local_irq_enable();
  5462. preempt_enable();
  5463. vcpu->srcu_idx = srcu_read_lock(&vcpu->kvm->srcu);
  5464. r = 1;
  5465. goto cancel_injection;
  5466. }
  5467. if (req_immediate_exit)
  5468. smp_send_reschedule(vcpu->cpu);
  5469. kvm_guest_enter();
  5470. if (unlikely(vcpu->arch.switch_db_regs)) {
  5471. set_debugreg(0, 7);
  5472. set_debugreg(vcpu->arch.eff_db[0], 0);
  5473. set_debugreg(vcpu->arch.eff_db[1], 1);
  5474. set_debugreg(vcpu->arch.eff_db[2], 2);
  5475. set_debugreg(vcpu->arch.eff_db[3], 3);
  5476. set_debugreg(vcpu->arch.dr6, 6);
  5477. vcpu->arch.switch_db_regs &= ~KVM_DEBUGREG_RELOAD;
  5478. }
  5479. trace_kvm_entry(vcpu->vcpu_id);
  5480. wait_lapic_expire(vcpu);
  5481. kvm_x86_ops->run(vcpu);
  5482. /*
  5483. * Do this here before restoring debug registers on the host. And
  5484. * since we do this before handling the vmexit, a DR access vmexit
  5485. * can (a) read the correct value of the debug registers, (b) set
  5486. * KVM_DEBUGREG_WONT_EXIT again.
  5487. */
  5488. if (unlikely(vcpu->arch.switch_db_regs & KVM_DEBUGREG_WONT_EXIT)) {
  5489. int i;
  5490. WARN_ON(vcpu->guest_debug & KVM_GUESTDBG_USE_HW_BP);
  5491. kvm_x86_ops->sync_dirty_debug_regs(vcpu);
  5492. for (i = 0; i < KVM_NR_DB_REGS; i++)
  5493. vcpu->arch.eff_db[i] = vcpu->arch.db[i];
  5494. }
  5495. /*
  5496. * If the guest has used debug registers, at least dr7
  5497. * will be disabled while returning to the host.
  5498. * If we don't have active breakpoints in the host, we don't
  5499. * care about the messed up debug address registers. But if
  5500. * we have some of them active, restore the old state.
  5501. */
  5502. if (hw_breakpoint_active())
  5503. hw_breakpoint_restore();
  5504. vcpu->arch.last_guest_tsc = kvm_x86_ops->read_l1_tsc(vcpu,
  5505. native_read_tsc());
  5506. vcpu->mode = OUTSIDE_GUEST_MODE;
  5507. smp_wmb();
  5508. /* Interrupt is enabled by handle_external_intr() */
  5509. kvm_x86_ops->handle_external_intr(vcpu);
  5510. ++vcpu->stat.exits;
  5511. /*
  5512. * We must have an instruction between local_irq_enable() and
  5513. * kvm_guest_exit(), so the timer interrupt isn't delayed by
  5514. * the interrupt shadow. The stat.exits increment will do nicely.
  5515. * But we need to prevent reordering, hence this barrier():
  5516. */
  5517. barrier();
  5518. kvm_guest_exit();
  5519. preempt_enable();
  5520. vcpu->srcu_idx = srcu_read_lock(&vcpu->kvm->srcu);
  5521. /*
  5522. * Profile KVM exit RIPs:
  5523. */
  5524. if (unlikely(prof_on == KVM_PROFILING)) {
  5525. unsigned long rip = kvm_rip_read(vcpu);
  5526. profile_hit(KVM_PROFILING, (void *)rip);
  5527. }
  5528. if (unlikely(vcpu->arch.tsc_always_catchup))
  5529. kvm_make_request(KVM_REQ_CLOCK_UPDATE, vcpu);
  5530. if (vcpu->arch.apic_attention)
  5531. kvm_lapic_sync_from_vapic(vcpu);
  5532. r = kvm_x86_ops->handle_exit(vcpu);
  5533. return r;
  5534. cancel_injection:
  5535. kvm_x86_ops->cancel_injection(vcpu);
  5536. if (unlikely(vcpu->arch.apic_attention))
  5537. kvm_lapic_sync_from_vapic(vcpu);
  5538. out:
  5539. return r;
  5540. }
  5541. static inline int vcpu_block(struct kvm *kvm, struct kvm_vcpu *vcpu)
  5542. {
  5543. if (!kvm_arch_vcpu_runnable(vcpu)) {
  5544. srcu_read_unlock(&kvm->srcu, vcpu->srcu_idx);
  5545. kvm_vcpu_block(vcpu);
  5546. vcpu->srcu_idx = srcu_read_lock(&kvm->srcu);
  5547. if (!kvm_check_request(KVM_REQ_UNHALT, vcpu))
  5548. return 1;
  5549. }
  5550. kvm_apic_accept_events(vcpu);
  5551. switch(vcpu->arch.mp_state) {
  5552. case KVM_MP_STATE_HALTED:
  5553. vcpu->arch.pv.pv_unhalted = false;
  5554. vcpu->arch.mp_state =
  5555. KVM_MP_STATE_RUNNABLE;
  5556. case KVM_MP_STATE_RUNNABLE:
  5557. vcpu->arch.apf.halted = false;
  5558. break;
  5559. case KVM_MP_STATE_INIT_RECEIVED:
  5560. break;
  5561. default:
  5562. return -EINTR;
  5563. break;
  5564. }
  5565. return 1;
  5566. }
  5567. static int vcpu_run(struct kvm_vcpu *vcpu)
  5568. {
  5569. int r;
  5570. struct kvm *kvm = vcpu->kvm;
  5571. vcpu->srcu_idx = srcu_read_lock(&kvm->srcu);
  5572. for (;;) {
  5573. if (vcpu->arch.mp_state == KVM_MP_STATE_RUNNABLE &&
  5574. !vcpu->arch.apf.halted)
  5575. r = vcpu_enter_guest(vcpu);
  5576. else
  5577. r = vcpu_block(kvm, vcpu);
  5578. if (r <= 0)
  5579. break;
  5580. clear_bit(KVM_REQ_PENDING_TIMER, &vcpu->requests);
  5581. if (kvm_cpu_has_pending_timer(vcpu))
  5582. kvm_inject_pending_timer_irqs(vcpu);
  5583. if (dm_request_for_irq_injection(vcpu)) {
  5584. r = -EINTR;
  5585. vcpu->run->exit_reason = KVM_EXIT_INTR;
  5586. ++vcpu->stat.request_irq_exits;
  5587. break;
  5588. }
  5589. kvm_check_async_pf_completion(vcpu);
  5590. if (signal_pending(current)) {
  5591. r = -EINTR;
  5592. vcpu->run->exit_reason = KVM_EXIT_INTR;
  5593. ++vcpu->stat.signal_exits;
  5594. break;
  5595. }
  5596. if (need_resched()) {
  5597. srcu_read_unlock(&kvm->srcu, vcpu->srcu_idx);
  5598. cond_resched();
  5599. vcpu->srcu_idx = srcu_read_lock(&kvm->srcu);
  5600. }
  5601. }
  5602. srcu_read_unlock(&kvm->srcu, vcpu->srcu_idx);
  5603. return r;
  5604. }
  5605. static inline int complete_emulated_io(struct kvm_vcpu *vcpu)
  5606. {
  5607. int r;
  5608. vcpu->srcu_idx = srcu_read_lock(&vcpu->kvm->srcu);
  5609. r = emulate_instruction(vcpu, EMULTYPE_NO_DECODE);
  5610. srcu_read_unlock(&vcpu->kvm->srcu, vcpu->srcu_idx);
  5611. if (r != EMULATE_DONE)
  5612. return 0;
  5613. return 1;
  5614. }
  5615. static int complete_emulated_pio(struct kvm_vcpu *vcpu)
  5616. {
  5617. BUG_ON(!vcpu->arch.pio.count);
  5618. return complete_emulated_io(vcpu);
  5619. }
  5620. /*
  5621. * Implements the following, as a state machine:
  5622. *
  5623. * read:
  5624. * for each fragment
  5625. * for each mmio piece in the fragment
  5626. * write gpa, len
  5627. * exit
  5628. * copy data
  5629. * execute insn
  5630. *
  5631. * write:
  5632. * for each fragment
  5633. * for each mmio piece in the fragment
  5634. * write gpa, len
  5635. * copy data
  5636. * exit
  5637. */
  5638. static int complete_emulated_mmio(struct kvm_vcpu *vcpu)
  5639. {
  5640. struct kvm_run *run = vcpu->run;
  5641. struct kvm_mmio_fragment *frag;
  5642. unsigned len;
  5643. BUG_ON(!vcpu->mmio_needed);
  5644. /* Complete previous fragment */
  5645. frag = &vcpu->mmio_fragments[vcpu->mmio_cur_fragment];
  5646. len = min(8u, frag->len);
  5647. if (!vcpu->mmio_is_write)
  5648. memcpy(frag->data, run->mmio.data, len);
  5649. if (frag->len <= 8) {
  5650. /* Switch to the next fragment. */
  5651. frag++;
  5652. vcpu->mmio_cur_fragment++;
  5653. } else {
  5654. /* Go forward to the next mmio piece. */
  5655. frag->data += len;
  5656. frag->gpa += len;
  5657. frag->len -= len;
  5658. }
  5659. if (vcpu->mmio_cur_fragment >= vcpu->mmio_nr_fragments) {
  5660. vcpu->mmio_needed = 0;
  5661. /* FIXME: return into emulator if single-stepping. */
  5662. if (vcpu->mmio_is_write)
  5663. return 1;
  5664. vcpu->mmio_read_completed = 1;
  5665. return complete_emulated_io(vcpu);
  5666. }
  5667. run->exit_reason = KVM_EXIT_MMIO;
  5668. run->mmio.phys_addr = frag->gpa;
  5669. if (vcpu->mmio_is_write)
  5670. memcpy(run->mmio.data, frag->data, min(8u, frag->len));
  5671. run->mmio.len = min(8u, frag->len);
  5672. run->mmio.is_write = vcpu->mmio_is_write;
  5673. vcpu->arch.complete_userspace_io = complete_emulated_mmio;
  5674. return 0;
  5675. }
  5676. int kvm_arch_vcpu_ioctl_run(struct kvm_vcpu *vcpu, struct kvm_run *kvm_run)
  5677. {
  5678. int r;
  5679. sigset_t sigsaved;
  5680. if (!tsk_used_math(current) && init_fpu(current))
  5681. return -ENOMEM;
  5682. if (vcpu->sigset_active)
  5683. sigprocmask(SIG_SETMASK, &vcpu->sigset, &sigsaved);
  5684. if (unlikely(vcpu->arch.mp_state == KVM_MP_STATE_UNINITIALIZED)) {
  5685. kvm_vcpu_block(vcpu);
  5686. kvm_apic_accept_events(vcpu);
  5687. clear_bit(KVM_REQ_UNHALT, &vcpu->requests);
  5688. r = -EAGAIN;
  5689. goto out;
  5690. }
  5691. /* re-sync apic's tpr */
  5692. if (!irqchip_in_kernel(vcpu->kvm)) {
  5693. if (kvm_set_cr8(vcpu, kvm_run->cr8) != 0) {
  5694. r = -EINVAL;
  5695. goto out;
  5696. }
  5697. }
  5698. if (unlikely(vcpu->arch.complete_userspace_io)) {
  5699. int (*cui)(struct kvm_vcpu *) = vcpu->arch.complete_userspace_io;
  5700. vcpu->arch.complete_userspace_io = NULL;
  5701. r = cui(vcpu);
  5702. if (r <= 0)
  5703. goto out;
  5704. } else
  5705. WARN_ON(vcpu->arch.pio.count || vcpu->mmio_needed);
  5706. r = vcpu_run(vcpu);
  5707. out:
  5708. post_kvm_run_save(vcpu);
  5709. if (vcpu->sigset_active)
  5710. sigprocmask(SIG_SETMASK, &sigsaved, NULL);
  5711. return r;
  5712. }
  5713. int kvm_arch_vcpu_ioctl_get_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs)
  5714. {
  5715. if (vcpu->arch.emulate_regs_need_sync_to_vcpu) {
  5716. /*
  5717. * We are here if userspace calls get_regs() in the middle of
  5718. * instruction emulation. Registers state needs to be copied
  5719. * back from emulation context to vcpu. Userspace shouldn't do
  5720. * that usually, but some bad designed PV devices (vmware
  5721. * backdoor interface) need this to work
  5722. */
  5723. emulator_writeback_register_cache(&vcpu->arch.emulate_ctxt);
  5724. vcpu->arch.emulate_regs_need_sync_to_vcpu = false;
  5725. }
  5726. regs->rax = kvm_register_read(vcpu, VCPU_REGS_RAX);
  5727. regs->rbx = kvm_register_read(vcpu, VCPU_REGS_RBX);
  5728. regs->rcx = kvm_register_read(vcpu, VCPU_REGS_RCX);
  5729. regs->rdx = kvm_register_read(vcpu, VCPU_REGS_RDX);
  5730. regs->rsi = kvm_register_read(vcpu, VCPU_REGS_RSI);
  5731. regs->rdi = kvm_register_read(vcpu, VCPU_REGS_RDI);
  5732. regs->rsp = kvm_register_read(vcpu, VCPU_REGS_RSP);
  5733. regs->rbp = kvm_register_read(vcpu, VCPU_REGS_RBP);
  5734. #ifdef CONFIG_X86_64
  5735. regs->r8 = kvm_register_read(vcpu, VCPU_REGS_R8);
  5736. regs->r9 = kvm_register_read(vcpu, VCPU_REGS_R9);
  5737. regs->r10 = kvm_register_read(vcpu, VCPU_REGS_R10);
  5738. regs->r11 = kvm_register_read(vcpu, VCPU_REGS_R11);
  5739. regs->r12 = kvm_register_read(vcpu, VCPU_REGS_R12);
  5740. regs->r13 = kvm_register_read(vcpu, VCPU_REGS_R13);
  5741. regs->r14 = kvm_register_read(vcpu, VCPU_REGS_R14);
  5742. regs->r15 = kvm_register_read(vcpu, VCPU_REGS_R15);
  5743. #endif
  5744. regs->rip = kvm_rip_read(vcpu);
  5745. regs->rflags = kvm_get_rflags(vcpu);
  5746. return 0;
  5747. }
  5748. int kvm_arch_vcpu_ioctl_set_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs)
  5749. {
  5750. vcpu->arch.emulate_regs_need_sync_from_vcpu = true;
  5751. vcpu->arch.emulate_regs_need_sync_to_vcpu = false;
  5752. kvm_register_write(vcpu, VCPU_REGS_RAX, regs->rax);
  5753. kvm_register_write(vcpu, VCPU_REGS_RBX, regs->rbx);
  5754. kvm_register_write(vcpu, VCPU_REGS_RCX, regs->rcx);
  5755. kvm_register_write(vcpu, VCPU_REGS_RDX, regs->rdx);
  5756. kvm_register_write(vcpu, VCPU_REGS_RSI, regs->rsi);
  5757. kvm_register_write(vcpu, VCPU_REGS_RDI, regs->rdi);
  5758. kvm_register_write(vcpu, VCPU_REGS_RSP, regs->rsp);
  5759. kvm_register_write(vcpu, VCPU_REGS_RBP, regs->rbp);
  5760. #ifdef CONFIG_X86_64
  5761. kvm_register_write(vcpu, VCPU_REGS_R8, regs->r8);
  5762. kvm_register_write(vcpu, VCPU_REGS_R9, regs->r9);
  5763. kvm_register_write(vcpu, VCPU_REGS_R10, regs->r10);
  5764. kvm_register_write(vcpu, VCPU_REGS_R11, regs->r11);
  5765. kvm_register_write(vcpu, VCPU_REGS_R12, regs->r12);
  5766. kvm_register_write(vcpu, VCPU_REGS_R13, regs->r13);
  5767. kvm_register_write(vcpu, VCPU_REGS_R14, regs->r14);
  5768. kvm_register_write(vcpu, VCPU_REGS_R15, regs->r15);
  5769. #endif
  5770. kvm_rip_write(vcpu, regs->rip);
  5771. kvm_set_rflags(vcpu, regs->rflags);
  5772. vcpu->arch.exception.pending = false;
  5773. kvm_make_request(KVM_REQ_EVENT, vcpu);
  5774. return 0;
  5775. }
  5776. void kvm_get_cs_db_l_bits(struct kvm_vcpu *vcpu, int *db, int *l)
  5777. {
  5778. struct kvm_segment cs;
  5779. kvm_get_segment(vcpu, &cs, VCPU_SREG_CS);
  5780. *db = cs.db;
  5781. *l = cs.l;
  5782. }
  5783. EXPORT_SYMBOL_GPL(kvm_get_cs_db_l_bits);
  5784. int kvm_arch_vcpu_ioctl_get_sregs(struct kvm_vcpu *vcpu,
  5785. struct kvm_sregs *sregs)
  5786. {
  5787. struct desc_ptr dt;
  5788. kvm_get_segment(vcpu, &sregs->cs, VCPU_SREG_CS);
  5789. kvm_get_segment(vcpu, &sregs->ds, VCPU_SREG_DS);
  5790. kvm_get_segment(vcpu, &sregs->es, VCPU_SREG_ES);
  5791. kvm_get_segment(vcpu, &sregs->fs, VCPU_SREG_FS);
  5792. kvm_get_segment(vcpu, &sregs->gs, VCPU_SREG_GS);
  5793. kvm_get_segment(vcpu, &sregs->ss, VCPU_SREG_SS);
  5794. kvm_get_segment(vcpu, &sregs->tr, VCPU_SREG_TR);
  5795. kvm_get_segment(vcpu, &sregs->ldt, VCPU_SREG_LDTR);
  5796. kvm_x86_ops->get_idt(vcpu, &dt);
  5797. sregs->idt.limit = dt.size;
  5798. sregs->idt.base = dt.address;
  5799. kvm_x86_ops->get_gdt(vcpu, &dt);
  5800. sregs->gdt.limit = dt.size;
  5801. sregs->gdt.base = dt.address;
  5802. sregs->cr0 = kvm_read_cr0(vcpu);
  5803. sregs->cr2 = vcpu->arch.cr2;
  5804. sregs->cr3 = kvm_read_cr3(vcpu);
  5805. sregs->cr4 = kvm_read_cr4(vcpu);
  5806. sregs->cr8 = kvm_get_cr8(vcpu);
  5807. sregs->efer = vcpu->arch.efer;
  5808. sregs->apic_base = kvm_get_apic_base(vcpu);
  5809. memset(sregs->interrupt_bitmap, 0, sizeof sregs->interrupt_bitmap);
  5810. if (vcpu->arch.interrupt.pending && !vcpu->arch.interrupt.soft)
  5811. set_bit(vcpu->arch.interrupt.nr,
  5812. (unsigned long *)sregs->interrupt_bitmap);
  5813. return 0;
  5814. }
  5815. int kvm_arch_vcpu_ioctl_get_mpstate(struct kvm_vcpu *vcpu,
  5816. struct kvm_mp_state *mp_state)
  5817. {
  5818. kvm_apic_accept_events(vcpu);
  5819. if (vcpu->arch.mp_state == KVM_MP_STATE_HALTED &&
  5820. vcpu->arch.pv.pv_unhalted)
  5821. mp_state->mp_state = KVM_MP_STATE_RUNNABLE;
  5822. else
  5823. mp_state->mp_state = vcpu->arch.mp_state;
  5824. return 0;
  5825. }
  5826. int kvm_arch_vcpu_ioctl_set_mpstate(struct kvm_vcpu *vcpu,
  5827. struct kvm_mp_state *mp_state)
  5828. {
  5829. if (!kvm_vcpu_has_lapic(vcpu) &&
  5830. mp_state->mp_state != KVM_MP_STATE_RUNNABLE)
  5831. return -EINVAL;
  5832. if (mp_state->mp_state == KVM_MP_STATE_SIPI_RECEIVED) {
  5833. vcpu->arch.mp_state = KVM_MP_STATE_INIT_RECEIVED;
  5834. set_bit(KVM_APIC_SIPI, &vcpu->arch.apic->pending_events);
  5835. } else
  5836. vcpu->arch.mp_state = mp_state->mp_state;
  5837. kvm_make_request(KVM_REQ_EVENT, vcpu);
  5838. return 0;
  5839. }
  5840. int kvm_task_switch(struct kvm_vcpu *vcpu, u16 tss_selector, int idt_index,
  5841. int reason, bool has_error_code, u32 error_code)
  5842. {
  5843. struct x86_emulate_ctxt *ctxt = &vcpu->arch.emulate_ctxt;
  5844. int ret;
  5845. init_emulate_ctxt(vcpu);
  5846. ret = emulator_task_switch(ctxt, tss_selector, idt_index, reason,
  5847. has_error_code, error_code);
  5848. if (ret)
  5849. return EMULATE_FAIL;
  5850. kvm_rip_write(vcpu, ctxt->eip);
  5851. kvm_set_rflags(vcpu, ctxt->eflags);
  5852. kvm_make_request(KVM_REQ_EVENT, vcpu);
  5853. return EMULATE_DONE;
  5854. }
  5855. EXPORT_SYMBOL_GPL(kvm_task_switch);
  5856. int kvm_arch_vcpu_ioctl_set_sregs(struct kvm_vcpu *vcpu,
  5857. struct kvm_sregs *sregs)
  5858. {
  5859. struct msr_data apic_base_msr;
  5860. int mmu_reset_needed = 0;
  5861. int pending_vec, max_bits, idx;
  5862. struct desc_ptr dt;
  5863. if (!guest_cpuid_has_xsave(vcpu) && (sregs->cr4 & X86_CR4_OSXSAVE))
  5864. return -EINVAL;
  5865. dt.size = sregs->idt.limit;
  5866. dt.address = sregs->idt.base;
  5867. kvm_x86_ops->set_idt(vcpu, &dt);
  5868. dt.size = sregs->gdt.limit;
  5869. dt.address = sregs->gdt.base;
  5870. kvm_x86_ops->set_gdt(vcpu, &dt);
  5871. vcpu->arch.cr2 = sregs->cr2;
  5872. mmu_reset_needed |= kvm_read_cr3(vcpu) != sregs->cr3;
  5873. vcpu->arch.cr3 = sregs->cr3;
  5874. __set_bit(VCPU_EXREG_CR3, (ulong *)&vcpu->arch.regs_avail);
  5875. kvm_set_cr8(vcpu, sregs->cr8);
  5876. mmu_reset_needed |= vcpu->arch.efer != sregs->efer;
  5877. kvm_x86_ops->set_efer(vcpu, sregs->efer);
  5878. apic_base_msr.data = sregs->apic_base;
  5879. apic_base_msr.host_initiated = true;
  5880. kvm_set_apic_base(vcpu, &apic_base_msr);
  5881. mmu_reset_needed |= kvm_read_cr0(vcpu) != sregs->cr0;
  5882. kvm_x86_ops->set_cr0(vcpu, sregs->cr0);
  5883. vcpu->arch.cr0 = sregs->cr0;
  5884. mmu_reset_needed |= kvm_read_cr4(vcpu) != sregs->cr4;
  5885. kvm_x86_ops->set_cr4(vcpu, sregs->cr4);
  5886. if (sregs->cr4 & X86_CR4_OSXSAVE)
  5887. kvm_update_cpuid(vcpu);
  5888. idx = srcu_read_lock(&vcpu->kvm->srcu);
  5889. if (!is_long_mode(vcpu) && is_pae(vcpu)) {
  5890. load_pdptrs(vcpu, vcpu->arch.walk_mmu, kvm_read_cr3(vcpu));
  5891. mmu_reset_needed = 1;
  5892. }
  5893. srcu_read_unlock(&vcpu->kvm->srcu, idx);
  5894. if (mmu_reset_needed)
  5895. kvm_mmu_reset_context(vcpu);
  5896. max_bits = KVM_NR_INTERRUPTS;
  5897. pending_vec = find_first_bit(
  5898. (const unsigned long *)sregs->interrupt_bitmap, max_bits);
  5899. if (pending_vec < max_bits) {
  5900. kvm_queue_interrupt(vcpu, pending_vec, false);
  5901. pr_debug("Set back pending irq %d\n", pending_vec);
  5902. }
  5903. kvm_set_segment(vcpu, &sregs->cs, VCPU_SREG_CS);
  5904. kvm_set_segment(vcpu, &sregs->ds, VCPU_SREG_DS);
  5905. kvm_set_segment(vcpu, &sregs->es, VCPU_SREG_ES);
  5906. kvm_set_segment(vcpu, &sregs->fs, VCPU_SREG_FS);
  5907. kvm_set_segment(vcpu, &sregs->gs, VCPU_SREG_GS);
  5908. kvm_set_segment(vcpu, &sregs->ss, VCPU_SREG_SS);
  5909. kvm_set_segment(vcpu, &sregs->tr, VCPU_SREG_TR);
  5910. kvm_set_segment(vcpu, &sregs->ldt, VCPU_SREG_LDTR);
  5911. update_cr8_intercept(vcpu);
  5912. /* Older userspace won't unhalt the vcpu on reset. */
  5913. if (kvm_vcpu_is_bsp(vcpu) && kvm_rip_read(vcpu) == 0xfff0 &&
  5914. sregs->cs.selector == 0xf000 && sregs->cs.base == 0xffff0000 &&
  5915. !is_protmode(vcpu))
  5916. vcpu->arch.mp_state = KVM_MP_STATE_RUNNABLE;
  5917. kvm_make_request(KVM_REQ_EVENT, vcpu);
  5918. return 0;
  5919. }
  5920. int kvm_arch_vcpu_ioctl_set_guest_debug(struct kvm_vcpu *vcpu,
  5921. struct kvm_guest_debug *dbg)
  5922. {
  5923. unsigned long rflags;
  5924. int i, r;
  5925. if (dbg->control & (KVM_GUESTDBG_INJECT_DB | KVM_GUESTDBG_INJECT_BP)) {
  5926. r = -EBUSY;
  5927. if (vcpu->arch.exception.pending)
  5928. goto out;
  5929. if (dbg->control & KVM_GUESTDBG_INJECT_DB)
  5930. kvm_queue_exception(vcpu, DB_VECTOR);
  5931. else
  5932. kvm_queue_exception(vcpu, BP_VECTOR);
  5933. }
  5934. /*
  5935. * Read rflags as long as potentially injected trace flags are still
  5936. * filtered out.
  5937. */
  5938. rflags = kvm_get_rflags(vcpu);
  5939. vcpu->guest_debug = dbg->control;
  5940. if (!(vcpu->guest_debug & KVM_GUESTDBG_ENABLE))
  5941. vcpu->guest_debug = 0;
  5942. if (vcpu->guest_debug & KVM_GUESTDBG_USE_HW_BP) {
  5943. for (i = 0; i < KVM_NR_DB_REGS; ++i)
  5944. vcpu->arch.eff_db[i] = dbg->arch.debugreg[i];
  5945. vcpu->arch.guest_debug_dr7 = dbg->arch.debugreg[7];
  5946. } else {
  5947. for (i = 0; i < KVM_NR_DB_REGS; i++)
  5948. vcpu->arch.eff_db[i] = vcpu->arch.db[i];
  5949. }
  5950. kvm_update_dr7(vcpu);
  5951. if (vcpu->guest_debug & KVM_GUESTDBG_SINGLESTEP)
  5952. vcpu->arch.singlestep_rip = kvm_rip_read(vcpu) +
  5953. get_segment_base(vcpu, VCPU_SREG_CS);
  5954. /*
  5955. * Trigger an rflags update that will inject or remove the trace
  5956. * flags.
  5957. */
  5958. kvm_set_rflags(vcpu, rflags);
  5959. kvm_x86_ops->update_db_bp_intercept(vcpu);
  5960. r = 0;
  5961. out:
  5962. return r;
  5963. }
  5964. /*
  5965. * Translate a guest virtual address to a guest physical address.
  5966. */
  5967. int kvm_arch_vcpu_ioctl_translate(struct kvm_vcpu *vcpu,
  5968. struct kvm_translation *tr)
  5969. {
  5970. unsigned long vaddr = tr->linear_address;
  5971. gpa_t gpa;
  5972. int idx;
  5973. idx = srcu_read_lock(&vcpu->kvm->srcu);
  5974. gpa = kvm_mmu_gva_to_gpa_system(vcpu, vaddr, NULL);
  5975. srcu_read_unlock(&vcpu->kvm->srcu, idx);
  5976. tr->physical_address = gpa;
  5977. tr->valid = gpa != UNMAPPED_GVA;
  5978. tr->writeable = 1;
  5979. tr->usermode = 0;
  5980. return 0;
  5981. }
  5982. int kvm_arch_vcpu_ioctl_get_fpu(struct kvm_vcpu *vcpu, struct kvm_fpu *fpu)
  5983. {
  5984. struct i387_fxsave_struct *fxsave =
  5985. &vcpu->arch.guest_fpu.state->fxsave;
  5986. memcpy(fpu->fpr, fxsave->st_space, 128);
  5987. fpu->fcw = fxsave->cwd;
  5988. fpu->fsw = fxsave->swd;
  5989. fpu->ftwx = fxsave->twd;
  5990. fpu->last_opcode = fxsave->fop;
  5991. fpu->last_ip = fxsave->rip;
  5992. fpu->last_dp = fxsave->rdp;
  5993. memcpy(fpu->xmm, fxsave->xmm_space, sizeof fxsave->xmm_space);
  5994. return 0;
  5995. }
  5996. int kvm_arch_vcpu_ioctl_set_fpu(struct kvm_vcpu *vcpu, struct kvm_fpu *fpu)
  5997. {
  5998. struct i387_fxsave_struct *fxsave =
  5999. &vcpu->arch.guest_fpu.state->fxsave;
  6000. memcpy(fxsave->st_space, fpu->fpr, 128);
  6001. fxsave->cwd = fpu->fcw;
  6002. fxsave->swd = fpu->fsw;
  6003. fxsave->twd = fpu->ftwx;
  6004. fxsave->fop = fpu->last_opcode;
  6005. fxsave->rip = fpu->last_ip;
  6006. fxsave->rdp = fpu->last_dp;
  6007. memcpy(fxsave->xmm_space, fpu->xmm, sizeof fxsave->xmm_space);
  6008. return 0;
  6009. }
  6010. int fx_init(struct kvm_vcpu *vcpu)
  6011. {
  6012. int err;
  6013. err = fpu_alloc(&vcpu->arch.guest_fpu);
  6014. if (err)
  6015. return err;
  6016. fpu_finit(&vcpu->arch.guest_fpu);
  6017. if (cpu_has_xsaves)
  6018. vcpu->arch.guest_fpu.state->xsave.xsave_hdr.xcomp_bv =
  6019. host_xcr0 | XSTATE_COMPACTION_ENABLED;
  6020. /*
  6021. * Ensure guest xcr0 is valid for loading
  6022. */
  6023. vcpu->arch.xcr0 = XSTATE_FP;
  6024. vcpu->arch.cr0 |= X86_CR0_ET;
  6025. return 0;
  6026. }
  6027. EXPORT_SYMBOL_GPL(fx_init);
  6028. static void fx_free(struct kvm_vcpu *vcpu)
  6029. {
  6030. fpu_free(&vcpu->arch.guest_fpu);
  6031. }
  6032. void kvm_load_guest_fpu(struct kvm_vcpu *vcpu)
  6033. {
  6034. if (vcpu->guest_fpu_loaded)
  6035. return;
  6036. /*
  6037. * Restore all possible states in the guest,
  6038. * and assume host would use all available bits.
  6039. * Guest xcr0 would be loaded later.
  6040. */
  6041. kvm_put_guest_xcr0(vcpu);
  6042. vcpu->guest_fpu_loaded = 1;
  6043. __kernel_fpu_begin();
  6044. fpu_restore_checking(&vcpu->arch.guest_fpu);
  6045. trace_kvm_fpu(1);
  6046. }
  6047. void kvm_put_guest_fpu(struct kvm_vcpu *vcpu)
  6048. {
  6049. kvm_put_guest_xcr0(vcpu);
  6050. if (!vcpu->guest_fpu_loaded)
  6051. return;
  6052. vcpu->guest_fpu_loaded = 0;
  6053. fpu_save_init(&vcpu->arch.guest_fpu);
  6054. __kernel_fpu_end();
  6055. ++vcpu->stat.fpu_reload;
  6056. kvm_make_request(KVM_REQ_DEACTIVATE_FPU, vcpu);
  6057. trace_kvm_fpu(0);
  6058. }
  6059. void kvm_arch_vcpu_free(struct kvm_vcpu *vcpu)
  6060. {
  6061. kvmclock_reset(vcpu);
  6062. free_cpumask_var(vcpu->arch.wbinvd_dirty_mask);
  6063. fx_free(vcpu);
  6064. kvm_x86_ops->vcpu_free(vcpu);
  6065. }
  6066. struct kvm_vcpu *kvm_arch_vcpu_create(struct kvm *kvm,
  6067. unsigned int id)
  6068. {
  6069. if (check_tsc_unstable() && atomic_read(&kvm->online_vcpus) != 0)
  6070. printk_once(KERN_WARNING
  6071. "kvm: SMP vm created on host with unstable TSC; "
  6072. "guest TSC will not be reliable\n");
  6073. return kvm_x86_ops->vcpu_create(kvm, id);
  6074. }
  6075. int kvm_arch_vcpu_setup(struct kvm_vcpu *vcpu)
  6076. {
  6077. int r;
  6078. vcpu->arch.mtrr_state.have_fixed = 1;
  6079. r = vcpu_load(vcpu);
  6080. if (r)
  6081. return r;
  6082. kvm_vcpu_reset(vcpu);
  6083. kvm_mmu_setup(vcpu);
  6084. vcpu_put(vcpu);
  6085. return r;
  6086. }
  6087. void kvm_arch_vcpu_postcreate(struct kvm_vcpu *vcpu)
  6088. {
  6089. struct msr_data msr;
  6090. struct kvm *kvm = vcpu->kvm;
  6091. if (vcpu_load(vcpu))
  6092. return;
  6093. msr.data = 0x0;
  6094. msr.index = MSR_IA32_TSC;
  6095. msr.host_initiated = true;
  6096. kvm_write_tsc(vcpu, &msr);
  6097. vcpu_put(vcpu);
  6098. schedule_delayed_work(&kvm->arch.kvmclock_sync_work,
  6099. KVMCLOCK_SYNC_PERIOD);
  6100. }
  6101. void kvm_arch_vcpu_destroy(struct kvm_vcpu *vcpu)
  6102. {
  6103. int r;
  6104. vcpu->arch.apf.msr_val = 0;
  6105. r = vcpu_load(vcpu);
  6106. BUG_ON(r);
  6107. kvm_mmu_unload(vcpu);
  6108. vcpu_put(vcpu);
  6109. fx_free(vcpu);
  6110. kvm_x86_ops->vcpu_free(vcpu);
  6111. }
  6112. void kvm_vcpu_reset(struct kvm_vcpu *vcpu)
  6113. {
  6114. atomic_set(&vcpu->arch.nmi_queued, 0);
  6115. vcpu->arch.nmi_pending = 0;
  6116. vcpu->arch.nmi_injected = false;
  6117. kvm_clear_interrupt_queue(vcpu);
  6118. kvm_clear_exception_queue(vcpu);
  6119. memset(vcpu->arch.db, 0, sizeof(vcpu->arch.db));
  6120. kvm_update_dr0123(vcpu);
  6121. vcpu->arch.dr6 = DR6_INIT;
  6122. kvm_update_dr6(vcpu);
  6123. vcpu->arch.dr7 = DR7_FIXED_1;
  6124. kvm_update_dr7(vcpu);
  6125. vcpu->arch.cr2 = 0;
  6126. kvm_make_request(KVM_REQ_EVENT, vcpu);
  6127. vcpu->arch.apf.msr_val = 0;
  6128. vcpu->arch.st.msr_val = 0;
  6129. kvmclock_reset(vcpu);
  6130. kvm_clear_async_pf_completion_queue(vcpu);
  6131. kvm_async_pf_hash_reset(vcpu);
  6132. vcpu->arch.apf.halted = false;
  6133. kvm_pmu_reset(vcpu);
  6134. memset(vcpu->arch.regs, 0, sizeof(vcpu->arch.regs));
  6135. vcpu->arch.regs_avail = ~0;
  6136. vcpu->arch.regs_dirty = ~0;
  6137. kvm_x86_ops->vcpu_reset(vcpu);
  6138. }
  6139. void kvm_vcpu_deliver_sipi_vector(struct kvm_vcpu *vcpu, u8 vector)
  6140. {
  6141. struct kvm_segment cs;
  6142. kvm_get_segment(vcpu, &cs, VCPU_SREG_CS);
  6143. cs.selector = vector << 8;
  6144. cs.base = vector << 12;
  6145. kvm_set_segment(vcpu, &cs, VCPU_SREG_CS);
  6146. kvm_rip_write(vcpu, 0);
  6147. }
  6148. int kvm_arch_hardware_enable(void)
  6149. {
  6150. struct kvm *kvm;
  6151. struct kvm_vcpu *vcpu;
  6152. int i;
  6153. int ret;
  6154. u64 local_tsc;
  6155. u64 max_tsc = 0;
  6156. bool stable, backwards_tsc = false;
  6157. kvm_shared_msr_cpu_online();
  6158. ret = kvm_x86_ops->hardware_enable();
  6159. if (ret != 0)
  6160. return ret;
  6161. local_tsc = native_read_tsc();
  6162. stable = !check_tsc_unstable();
  6163. list_for_each_entry(kvm, &vm_list, vm_list) {
  6164. kvm_for_each_vcpu(i, vcpu, kvm) {
  6165. if (!stable && vcpu->cpu == smp_processor_id())
  6166. kvm_make_request(KVM_REQ_CLOCK_UPDATE, vcpu);
  6167. if (stable && vcpu->arch.last_host_tsc > local_tsc) {
  6168. backwards_tsc = true;
  6169. if (vcpu->arch.last_host_tsc > max_tsc)
  6170. max_tsc = vcpu->arch.last_host_tsc;
  6171. }
  6172. }
  6173. }
  6174. /*
  6175. * Sometimes, even reliable TSCs go backwards. This happens on
  6176. * platforms that reset TSC during suspend or hibernate actions, but
  6177. * maintain synchronization. We must compensate. Fortunately, we can
  6178. * detect that condition here, which happens early in CPU bringup,
  6179. * before any KVM threads can be running. Unfortunately, we can't
  6180. * bring the TSCs fully up to date with real time, as we aren't yet far
  6181. * enough into CPU bringup that we know how much real time has actually
  6182. * elapsed; our helper function, get_kernel_ns() will be using boot
  6183. * variables that haven't been updated yet.
  6184. *
  6185. * So we simply find the maximum observed TSC above, then record the
  6186. * adjustment to TSC in each VCPU. When the VCPU later gets loaded,
  6187. * the adjustment will be applied. Note that we accumulate
  6188. * adjustments, in case multiple suspend cycles happen before some VCPU
  6189. * gets a chance to run again. In the event that no KVM threads get a
  6190. * chance to run, we will miss the entire elapsed period, as we'll have
  6191. * reset last_host_tsc, so VCPUs will not have the TSC adjusted and may
  6192. * loose cycle time. This isn't too big a deal, since the loss will be
  6193. * uniform across all VCPUs (not to mention the scenario is extremely
  6194. * unlikely). It is possible that a second hibernate recovery happens
  6195. * much faster than a first, causing the observed TSC here to be
  6196. * smaller; this would require additional padding adjustment, which is
  6197. * why we set last_host_tsc to the local tsc observed here.
  6198. *
  6199. * N.B. - this code below runs only on platforms with reliable TSC,
  6200. * as that is the only way backwards_tsc is set above. Also note
  6201. * that this runs for ALL vcpus, which is not a bug; all VCPUs should
  6202. * have the same delta_cyc adjustment applied if backwards_tsc
  6203. * is detected. Note further, this adjustment is only done once,
  6204. * as we reset last_host_tsc on all VCPUs to stop this from being
  6205. * called multiple times (one for each physical CPU bringup).
  6206. *
  6207. * Platforms with unreliable TSCs don't have to deal with this, they
  6208. * will be compensated by the logic in vcpu_load, which sets the TSC to
  6209. * catchup mode. This will catchup all VCPUs to real time, but cannot
  6210. * guarantee that they stay in perfect synchronization.
  6211. */
  6212. if (backwards_tsc) {
  6213. u64 delta_cyc = max_tsc - local_tsc;
  6214. backwards_tsc_observed = true;
  6215. list_for_each_entry(kvm, &vm_list, vm_list) {
  6216. kvm_for_each_vcpu(i, vcpu, kvm) {
  6217. vcpu->arch.tsc_offset_adjustment += delta_cyc;
  6218. vcpu->arch.last_host_tsc = local_tsc;
  6219. kvm_make_request(KVM_REQ_MASTERCLOCK_UPDATE, vcpu);
  6220. }
  6221. /*
  6222. * We have to disable TSC offset matching.. if you were
  6223. * booting a VM while issuing an S4 host suspend....
  6224. * you may have some problem. Solving this issue is
  6225. * left as an exercise to the reader.
  6226. */
  6227. kvm->arch.last_tsc_nsec = 0;
  6228. kvm->arch.last_tsc_write = 0;
  6229. }
  6230. }
  6231. return 0;
  6232. }
  6233. void kvm_arch_hardware_disable(void)
  6234. {
  6235. kvm_x86_ops->hardware_disable();
  6236. drop_user_return_notifiers();
  6237. }
  6238. int kvm_arch_hardware_setup(void)
  6239. {
  6240. int r;
  6241. r = kvm_x86_ops->hardware_setup();
  6242. if (r != 0)
  6243. return r;
  6244. kvm_init_msr_list();
  6245. return 0;
  6246. }
  6247. void kvm_arch_hardware_unsetup(void)
  6248. {
  6249. kvm_x86_ops->hardware_unsetup();
  6250. }
  6251. void kvm_arch_check_processor_compat(void *rtn)
  6252. {
  6253. kvm_x86_ops->check_processor_compatibility(rtn);
  6254. }
  6255. bool kvm_vcpu_compatible(struct kvm_vcpu *vcpu)
  6256. {
  6257. return irqchip_in_kernel(vcpu->kvm) == (vcpu->arch.apic != NULL);
  6258. }
  6259. struct static_key kvm_no_apic_vcpu __read_mostly;
  6260. int kvm_arch_vcpu_init(struct kvm_vcpu *vcpu)
  6261. {
  6262. struct page *page;
  6263. struct kvm *kvm;
  6264. int r;
  6265. BUG_ON(vcpu->kvm == NULL);
  6266. kvm = vcpu->kvm;
  6267. vcpu->arch.pv.pv_unhalted = false;
  6268. vcpu->arch.emulate_ctxt.ops = &emulate_ops;
  6269. if (!irqchip_in_kernel(kvm) || kvm_vcpu_is_reset_bsp(vcpu))
  6270. vcpu->arch.mp_state = KVM_MP_STATE_RUNNABLE;
  6271. else
  6272. vcpu->arch.mp_state = KVM_MP_STATE_UNINITIALIZED;
  6273. page = alloc_page(GFP_KERNEL | __GFP_ZERO);
  6274. if (!page) {
  6275. r = -ENOMEM;
  6276. goto fail;
  6277. }
  6278. vcpu->arch.pio_data = page_address(page);
  6279. kvm_set_tsc_khz(vcpu, max_tsc_khz);
  6280. r = kvm_mmu_create(vcpu);
  6281. if (r < 0)
  6282. goto fail_free_pio_data;
  6283. if (irqchip_in_kernel(kvm)) {
  6284. r = kvm_create_lapic(vcpu);
  6285. if (r < 0)
  6286. goto fail_mmu_destroy;
  6287. } else
  6288. static_key_slow_inc(&kvm_no_apic_vcpu);
  6289. vcpu->arch.mce_banks = kzalloc(KVM_MAX_MCE_BANKS * sizeof(u64) * 4,
  6290. GFP_KERNEL);
  6291. if (!vcpu->arch.mce_banks) {
  6292. r = -ENOMEM;
  6293. goto fail_free_lapic;
  6294. }
  6295. vcpu->arch.mcg_cap = KVM_MAX_MCE_BANKS;
  6296. if (!zalloc_cpumask_var(&vcpu->arch.wbinvd_dirty_mask, GFP_KERNEL)) {
  6297. r = -ENOMEM;
  6298. goto fail_free_mce_banks;
  6299. }
  6300. r = fx_init(vcpu);
  6301. if (r)
  6302. goto fail_free_wbinvd_dirty_mask;
  6303. vcpu->arch.ia32_tsc_adjust_msr = 0x0;
  6304. vcpu->arch.pv_time_enabled = false;
  6305. vcpu->arch.guest_supported_xcr0 = 0;
  6306. vcpu->arch.guest_xstate_size = XSAVE_HDR_SIZE + XSAVE_HDR_OFFSET;
  6307. vcpu->arch.maxphyaddr = cpuid_query_maxphyaddr(vcpu);
  6308. kvm_async_pf_hash_reset(vcpu);
  6309. kvm_pmu_init(vcpu);
  6310. return 0;
  6311. fail_free_wbinvd_dirty_mask:
  6312. free_cpumask_var(vcpu->arch.wbinvd_dirty_mask);
  6313. fail_free_mce_banks:
  6314. kfree(vcpu->arch.mce_banks);
  6315. fail_free_lapic:
  6316. kvm_free_lapic(vcpu);
  6317. fail_mmu_destroy:
  6318. kvm_mmu_destroy(vcpu);
  6319. fail_free_pio_data:
  6320. free_page((unsigned long)vcpu->arch.pio_data);
  6321. fail:
  6322. return r;
  6323. }
  6324. void kvm_arch_vcpu_uninit(struct kvm_vcpu *vcpu)
  6325. {
  6326. int idx;
  6327. kvm_pmu_destroy(vcpu);
  6328. kfree(vcpu->arch.mce_banks);
  6329. kvm_free_lapic(vcpu);
  6330. idx = srcu_read_lock(&vcpu->kvm->srcu);
  6331. kvm_mmu_destroy(vcpu);
  6332. srcu_read_unlock(&vcpu->kvm->srcu, idx);
  6333. free_page((unsigned long)vcpu->arch.pio_data);
  6334. if (!irqchip_in_kernel(vcpu->kvm))
  6335. static_key_slow_dec(&kvm_no_apic_vcpu);
  6336. }
  6337. void kvm_arch_sched_in(struct kvm_vcpu *vcpu, int cpu)
  6338. {
  6339. kvm_x86_ops->sched_in(vcpu, cpu);
  6340. }
  6341. int kvm_arch_init_vm(struct kvm *kvm, unsigned long type)
  6342. {
  6343. if (type)
  6344. return -EINVAL;
  6345. INIT_HLIST_HEAD(&kvm->arch.mask_notifier_list);
  6346. INIT_LIST_HEAD(&kvm->arch.active_mmu_pages);
  6347. INIT_LIST_HEAD(&kvm->arch.zapped_obsolete_pages);
  6348. INIT_LIST_HEAD(&kvm->arch.assigned_dev_head);
  6349. atomic_set(&kvm->arch.noncoherent_dma_count, 0);
  6350. /* Reserve bit 0 of irq_sources_bitmap for userspace irq source */
  6351. set_bit(KVM_USERSPACE_IRQ_SOURCE_ID, &kvm->arch.irq_sources_bitmap);
  6352. /* Reserve bit 1 of irq_sources_bitmap for irqfd-resampler */
  6353. set_bit(KVM_IRQFD_RESAMPLE_IRQ_SOURCE_ID,
  6354. &kvm->arch.irq_sources_bitmap);
  6355. raw_spin_lock_init(&kvm->arch.tsc_write_lock);
  6356. mutex_init(&kvm->arch.apic_map_lock);
  6357. spin_lock_init(&kvm->arch.pvclock_gtod_sync_lock);
  6358. pvclock_update_vm_gtod_copy(kvm);
  6359. INIT_DELAYED_WORK(&kvm->arch.kvmclock_update_work, kvmclock_update_fn);
  6360. INIT_DELAYED_WORK(&kvm->arch.kvmclock_sync_work, kvmclock_sync_fn);
  6361. return 0;
  6362. }
  6363. static void kvm_unload_vcpu_mmu(struct kvm_vcpu *vcpu)
  6364. {
  6365. int r;
  6366. r = vcpu_load(vcpu);
  6367. BUG_ON(r);
  6368. kvm_mmu_unload(vcpu);
  6369. vcpu_put(vcpu);
  6370. }
  6371. static void kvm_free_vcpus(struct kvm *kvm)
  6372. {
  6373. unsigned int i;
  6374. struct kvm_vcpu *vcpu;
  6375. /*
  6376. * Unpin any mmu pages first.
  6377. */
  6378. kvm_for_each_vcpu(i, vcpu, kvm) {
  6379. kvm_clear_async_pf_completion_queue(vcpu);
  6380. kvm_unload_vcpu_mmu(vcpu);
  6381. }
  6382. kvm_for_each_vcpu(i, vcpu, kvm)
  6383. kvm_arch_vcpu_free(vcpu);
  6384. mutex_lock(&kvm->lock);
  6385. for (i = 0; i < atomic_read(&kvm->online_vcpus); i++)
  6386. kvm->vcpus[i] = NULL;
  6387. atomic_set(&kvm->online_vcpus, 0);
  6388. mutex_unlock(&kvm->lock);
  6389. }
  6390. void kvm_arch_sync_events(struct kvm *kvm)
  6391. {
  6392. cancel_delayed_work_sync(&kvm->arch.kvmclock_sync_work);
  6393. cancel_delayed_work_sync(&kvm->arch.kvmclock_update_work);
  6394. kvm_free_all_assigned_devices(kvm);
  6395. kvm_free_pit(kvm);
  6396. }
  6397. void kvm_arch_destroy_vm(struct kvm *kvm)
  6398. {
  6399. if (current->mm == kvm->mm) {
  6400. /*
  6401. * Free memory regions allocated on behalf of userspace,
  6402. * unless the the memory map has changed due to process exit
  6403. * or fd copying.
  6404. */
  6405. struct kvm_userspace_memory_region mem;
  6406. memset(&mem, 0, sizeof(mem));
  6407. mem.slot = APIC_ACCESS_PAGE_PRIVATE_MEMSLOT;
  6408. kvm_set_memory_region(kvm, &mem);
  6409. mem.slot = IDENTITY_PAGETABLE_PRIVATE_MEMSLOT;
  6410. kvm_set_memory_region(kvm, &mem);
  6411. mem.slot = TSS_PRIVATE_MEMSLOT;
  6412. kvm_set_memory_region(kvm, &mem);
  6413. }
  6414. kvm_iommu_unmap_guest(kvm);
  6415. kfree(kvm->arch.vpic);
  6416. kfree(kvm->arch.vioapic);
  6417. kvm_free_vcpus(kvm);
  6418. kfree(rcu_dereference_check(kvm->arch.apic_map, 1));
  6419. }
  6420. void kvm_arch_free_memslot(struct kvm *kvm, struct kvm_memory_slot *free,
  6421. struct kvm_memory_slot *dont)
  6422. {
  6423. int i;
  6424. for (i = 0; i < KVM_NR_PAGE_SIZES; ++i) {
  6425. if (!dont || free->arch.rmap[i] != dont->arch.rmap[i]) {
  6426. kvfree(free->arch.rmap[i]);
  6427. free->arch.rmap[i] = NULL;
  6428. }
  6429. if (i == 0)
  6430. continue;
  6431. if (!dont || free->arch.lpage_info[i - 1] !=
  6432. dont->arch.lpage_info[i - 1]) {
  6433. kvfree(free->arch.lpage_info[i - 1]);
  6434. free->arch.lpage_info[i - 1] = NULL;
  6435. }
  6436. }
  6437. }
  6438. int kvm_arch_create_memslot(struct kvm *kvm, struct kvm_memory_slot *slot,
  6439. unsigned long npages)
  6440. {
  6441. int i;
  6442. for (i = 0; i < KVM_NR_PAGE_SIZES; ++i) {
  6443. unsigned long ugfn;
  6444. int lpages;
  6445. int level = i + 1;
  6446. lpages = gfn_to_index(slot->base_gfn + npages - 1,
  6447. slot->base_gfn, level) + 1;
  6448. slot->arch.rmap[i] =
  6449. kvm_kvzalloc(lpages * sizeof(*slot->arch.rmap[i]));
  6450. if (!slot->arch.rmap[i])
  6451. goto out_free;
  6452. if (i == 0)
  6453. continue;
  6454. slot->arch.lpage_info[i - 1] = kvm_kvzalloc(lpages *
  6455. sizeof(*slot->arch.lpage_info[i - 1]));
  6456. if (!slot->arch.lpage_info[i - 1])
  6457. goto out_free;
  6458. if (slot->base_gfn & (KVM_PAGES_PER_HPAGE(level) - 1))
  6459. slot->arch.lpage_info[i - 1][0].write_count = 1;
  6460. if ((slot->base_gfn + npages) & (KVM_PAGES_PER_HPAGE(level) - 1))
  6461. slot->arch.lpage_info[i - 1][lpages - 1].write_count = 1;
  6462. ugfn = slot->userspace_addr >> PAGE_SHIFT;
  6463. /*
  6464. * If the gfn and userspace address are not aligned wrt each
  6465. * other, or if explicitly asked to, disable large page
  6466. * support for this slot
  6467. */
  6468. if ((slot->base_gfn ^ ugfn) & (KVM_PAGES_PER_HPAGE(level) - 1) ||
  6469. !kvm_largepages_enabled()) {
  6470. unsigned long j;
  6471. for (j = 0; j < lpages; ++j)
  6472. slot->arch.lpage_info[i - 1][j].write_count = 1;
  6473. }
  6474. }
  6475. return 0;
  6476. out_free:
  6477. for (i = 0; i < KVM_NR_PAGE_SIZES; ++i) {
  6478. kvfree(slot->arch.rmap[i]);
  6479. slot->arch.rmap[i] = NULL;
  6480. if (i == 0)
  6481. continue;
  6482. kvfree(slot->arch.lpage_info[i - 1]);
  6483. slot->arch.lpage_info[i - 1] = NULL;
  6484. }
  6485. return -ENOMEM;
  6486. }
  6487. void kvm_arch_memslots_updated(struct kvm *kvm)
  6488. {
  6489. /*
  6490. * memslots->generation has been incremented.
  6491. * mmio generation may have reached its maximum value.
  6492. */
  6493. kvm_mmu_invalidate_mmio_sptes(kvm);
  6494. }
  6495. int kvm_arch_prepare_memory_region(struct kvm *kvm,
  6496. struct kvm_memory_slot *memslot,
  6497. struct kvm_userspace_memory_region *mem,
  6498. enum kvm_mr_change change)
  6499. {
  6500. /*
  6501. * Only private memory slots need to be mapped here since
  6502. * KVM_SET_MEMORY_REGION ioctl is no longer supported.
  6503. */
  6504. if ((memslot->id >= KVM_USER_MEM_SLOTS) && (change == KVM_MR_CREATE)) {
  6505. unsigned long userspace_addr;
  6506. /*
  6507. * MAP_SHARED to prevent internal slot pages from being moved
  6508. * by fork()/COW.
  6509. */
  6510. userspace_addr = vm_mmap(NULL, 0, memslot->npages * PAGE_SIZE,
  6511. PROT_READ | PROT_WRITE,
  6512. MAP_SHARED | MAP_ANONYMOUS, 0);
  6513. if (IS_ERR((void *)userspace_addr))
  6514. return PTR_ERR((void *)userspace_addr);
  6515. memslot->userspace_addr = userspace_addr;
  6516. }
  6517. return 0;
  6518. }
  6519. static void kvm_mmu_slot_apply_flags(struct kvm *kvm,
  6520. struct kvm_memory_slot *new)
  6521. {
  6522. /* Still write protect RO slot */
  6523. if (new->flags & KVM_MEM_READONLY) {
  6524. kvm_mmu_slot_remove_write_access(kvm, new);
  6525. return;
  6526. }
  6527. /*
  6528. * Call kvm_x86_ops dirty logging hooks when they are valid.
  6529. *
  6530. * kvm_x86_ops->slot_disable_log_dirty is called when:
  6531. *
  6532. * - KVM_MR_CREATE with dirty logging is disabled
  6533. * - KVM_MR_FLAGS_ONLY with dirty logging is disabled in new flag
  6534. *
  6535. * The reason is, in case of PML, we need to set D-bit for any slots
  6536. * with dirty logging disabled in order to eliminate unnecessary GPA
  6537. * logging in PML buffer (and potential PML buffer full VMEXT). This
  6538. * guarantees leaving PML enabled during guest's lifetime won't have
  6539. * any additonal overhead from PML when guest is running with dirty
  6540. * logging disabled for memory slots.
  6541. *
  6542. * kvm_x86_ops->slot_enable_log_dirty is called when switching new slot
  6543. * to dirty logging mode.
  6544. *
  6545. * If kvm_x86_ops dirty logging hooks are invalid, use write protect.
  6546. *
  6547. * In case of write protect:
  6548. *
  6549. * Write protect all pages for dirty logging.
  6550. *
  6551. * All the sptes including the large sptes which point to this
  6552. * slot are set to readonly. We can not create any new large
  6553. * spte on this slot until the end of the logging.
  6554. *
  6555. * See the comments in fast_page_fault().
  6556. */
  6557. if (new->flags & KVM_MEM_LOG_DIRTY_PAGES) {
  6558. if (kvm_x86_ops->slot_enable_log_dirty)
  6559. kvm_x86_ops->slot_enable_log_dirty(kvm, new);
  6560. else
  6561. kvm_mmu_slot_remove_write_access(kvm, new);
  6562. } else {
  6563. if (kvm_x86_ops->slot_disable_log_dirty)
  6564. kvm_x86_ops->slot_disable_log_dirty(kvm, new);
  6565. }
  6566. }
  6567. void kvm_arch_commit_memory_region(struct kvm *kvm,
  6568. struct kvm_userspace_memory_region *mem,
  6569. const struct kvm_memory_slot *old,
  6570. enum kvm_mr_change change)
  6571. {
  6572. struct kvm_memory_slot *new;
  6573. int nr_mmu_pages = 0;
  6574. if ((mem->slot >= KVM_USER_MEM_SLOTS) && (change == KVM_MR_DELETE)) {
  6575. int ret;
  6576. ret = vm_munmap(old->userspace_addr,
  6577. old->npages * PAGE_SIZE);
  6578. if (ret < 0)
  6579. printk(KERN_WARNING
  6580. "kvm_vm_ioctl_set_memory_region: "
  6581. "failed to munmap memory\n");
  6582. }
  6583. if (!kvm->arch.n_requested_mmu_pages)
  6584. nr_mmu_pages = kvm_mmu_calculate_mmu_pages(kvm);
  6585. if (nr_mmu_pages)
  6586. kvm_mmu_change_mmu_pages(kvm, nr_mmu_pages);
  6587. /* It's OK to get 'new' slot here as it has already been installed */
  6588. new = id_to_memslot(kvm->memslots, mem->slot);
  6589. /*
  6590. * Dirty logging tracks sptes in 4k granularity, meaning that large
  6591. * sptes have to be split. If live migration is successful, the guest
  6592. * in the source machine will be destroyed and large sptes will be
  6593. * created in the destination. However, if the guest continues to run
  6594. * in the source machine (for example if live migration fails), small
  6595. * sptes will remain around and cause bad performance.
  6596. *
  6597. * Scan sptes if dirty logging has been stopped, dropping those
  6598. * which can be collapsed into a single large-page spte. Later
  6599. * page faults will create the large-page sptes.
  6600. */
  6601. if ((change != KVM_MR_DELETE) &&
  6602. (old->flags & KVM_MEM_LOG_DIRTY_PAGES) &&
  6603. !(new->flags & KVM_MEM_LOG_DIRTY_PAGES))
  6604. kvm_mmu_zap_collapsible_sptes(kvm, new);
  6605. /*
  6606. * Set up write protection and/or dirty logging for the new slot.
  6607. *
  6608. * For KVM_MR_DELETE and KVM_MR_MOVE, the shadow pages of old slot have
  6609. * been zapped so no dirty logging staff is needed for old slot. For
  6610. * KVM_MR_FLAGS_ONLY, the old slot is essentially the same one as the
  6611. * new and it's also covered when dealing with the new slot.
  6612. */
  6613. if (change != KVM_MR_DELETE)
  6614. kvm_mmu_slot_apply_flags(kvm, new);
  6615. }
  6616. void kvm_arch_flush_shadow_all(struct kvm *kvm)
  6617. {
  6618. kvm_mmu_invalidate_zap_all_pages(kvm);
  6619. }
  6620. void kvm_arch_flush_shadow_memslot(struct kvm *kvm,
  6621. struct kvm_memory_slot *slot)
  6622. {
  6623. kvm_mmu_invalidate_zap_all_pages(kvm);
  6624. }
  6625. int kvm_arch_vcpu_runnable(struct kvm_vcpu *vcpu)
  6626. {
  6627. if (is_guest_mode(vcpu) && kvm_x86_ops->check_nested_events)
  6628. kvm_x86_ops->check_nested_events(vcpu, false);
  6629. return (vcpu->arch.mp_state == KVM_MP_STATE_RUNNABLE &&
  6630. !vcpu->arch.apf.halted)
  6631. || !list_empty_careful(&vcpu->async_pf.done)
  6632. || kvm_apic_has_events(vcpu)
  6633. || vcpu->arch.pv.pv_unhalted
  6634. || atomic_read(&vcpu->arch.nmi_queued) ||
  6635. (kvm_arch_interrupt_allowed(vcpu) &&
  6636. kvm_cpu_has_interrupt(vcpu));
  6637. }
  6638. int kvm_arch_vcpu_should_kick(struct kvm_vcpu *vcpu)
  6639. {
  6640. return kvm_vcpu_exiting_guest_mode(vcpu) == IN_GUEST_MODE;
  6641. }
  6642. int kvm_arch_interrupt_allowed(struct kvm_vcpu *vcpu)
  6643. {
  6644. return kvm_x86_ops->interrupt_allowed(vcpu);
  6645. }
  6646. unsigned long kvm_get_linear_rip(struct kvm_vcpu *vcpu)
  6647. {
  6648. if (is_64_bit_mode(vcpu))
  6649. return kvm_rip_read(vcpu);
  6650. return (u32)(get_segment_base(vcpu, VCPU_SREG_CS) +
  6651. kvm_rip_read(vcpu));
  6652. }
  6653. EXPORT_SYMBOL_GPL(kvm_get_linear_rip);
  6654. bool kvm_is_linear_rip(struct kvm_vcpu *vcpu, unsigned long linear_rip)
  6655. {
  6656. return kvm_get_linear_rip(vcpu) == linear_rip;
  6657. }
  6658. EXPORT_SYMBOL_GPL(kvm_is_linear_rip);
  6659. unsigned long kvm_get_rflags(struct kvm_vcpu *vcpu)
  6660. {
  6661. unsigned long rflags;
  6662. rflags = kvm_x86_ops->get_rflags(vcpu);
  6663. if (vcpu->guest_debug & KVM_GUESTDBG_SINGLESTEP)
  6664. rflags &= ~X86_EFLAGS_TF;
  6665. return rflags;
  6666. }
  6667. EXPORT_SYMBOL_GPL(kvm_get_rflags);
  6668. static void __kvm_set_rflags(struct kvm_vcpu *vcpu, unsigned long rflags)
  6669. {
  6670. if (vcpu->guest_debug & KVM_GUESTDBG_SINGLESTEP &&
  6671. kvm_is_linear_rip(vcpu, vcpu->arch.singlestep_rip))
  6672. rflags |= X86_EFLAGS_TF;
  6673. kvm_x86_ops->set_rflags(vcpu, rflags);
  6674. }
  6675. void kvm_set_rflags(struct kvm_vcpu *vcpu, unsigned long rflags)
  6676. {
  6677. __kvm_set_rflags(vcpu, rflags);
  6678. kvm_make_request(KVM_REQ_EVENT, vcpu);
  6679. }
  6680. EXPORT_SYMBOL_GPL(kvm_set_rflags);
  6681. void kvm_arch_async_page_ready(struct kvm_vcpu *vcpu, struct kvm_async_pf *work)
  6682. {
  6683. int r;
  6684. if ((vcpu->arch.mmu.direct_map != work->arch.direct_map) ||
  6685. work->wakeup_all)
  6686. return;
  6687. r = kvm_mmu_reload(vcpu);
  6688. if (unlikely(r))
  6689. return;
  6690. if (!vcpu->arch.mmu.direct_map &&
  6691. work->arch.cr3 != vcpu->arch.mmu.get_cr3(vcpu))
  6692. return;
  6693. vcpu->arch.mmu.page_fault(vcpu, work->gva, 0, true);
  6694. }
  6695. static inline u32 kvm_async_pf_hash_fn(gfn_t gfn)
  6696. {
  6697. return hash_32(gfn & 0xffffffff, order_base_2(ASYNC_PF_PER_VCPU));
  6698. }
  6699. static inline u32 kvm_async_pf_next_probe(u32 key)
  6700. {
  6701. return (key + 1) & (roundup_pow_of_two(ASYNC_PF_PER_VCPU) - 1);
  6702. }
  6703. static void kvm_add_async_pf_gfn(struct kvm_vcpu *vcpu, gfn_t gfn)
  6704. {
  6705. u32 key = kvm_async_pf_hash_fn(gfn);
  6706. while (vcpu->arch.apf.gfns[key] != ~0)
  6707. key = kvm_async_pf_next_probe(key);
  6708. vcpu->arch.apf.gfns[key] = gfn;
  6709. }
  6710. static u32 kvm_async_pf_gfn_slot(struct kvm_vcpu *vcpu, gfn_t gfn)
  6711. {
  6712. int i;
  6713. u32 key = kvm_async_pf_hash_fn(gfn);
  6714. for (i = 0; i < roundup_pow_of_two(ASYNC_PF_PER_VCPU) &&
  6715. (vcpu->arch.apf.gfns[key] != gfn &&
  6716. vcpu->arch.apf.gfns[key] != ~0); i++)
  6717. key = kvm_async_pf_next_probe(key);
  6718. return key;
  6719. }
  6720. bool kvm_find_async_pf_gfn(struct kvm_vcpu *vcpu, gfn_t gfn)
  6721. {
  6722. return vcpu->arch.apf.gfns[kvm_async_pf_gfn_slot(vcpu, gfn)] == gfn;
  6723. }
  6724. static void kvm_del_async_pf_gfn(struct kvm_vcpu *vcpu, gfn_t gfn)
  6725. {
  6726. u32 i, j, k;
  6727. i = j = kvm_async_pf_gfn_slot(vcpu, gfn);
  6728. while (true) {
  6729. vcpu->arch.apf.gfns[i] = ~0;
  6730. do {
  6731. j = kvm_async_pf_next_probe(j);
  6732. if (vcpu->arch.apf.gfns[j] == ~0)
  6733. return;
  6734. k = kvm_async_pf_hash_fn(vcpu->arch.apf.gfns[j]);
  6735. /*
  6736. * k lies cyclically in ]i,j]
  6737. * | i.k.j |
  6738. * |....j i.k.| or |.k..j i...|
  6739. */
  6740. } while ((i <= j) ? (i < k && k <= j) : (i < k || k <= j));
  6741. vcpu->arch.apf.gfns[i] = vcpu->arch.apf.gfns[j];
  6742. i = j;
  6743. }
  6744. }
  6745. static int apf_put_user(struct kvm_vcpu *vcpu, u32 val)
  6746. {
  6747. return kvm_write_guest_cached(vcpu->kvm, &vcpu->arch.apf.data, &val,
  6748. sizeof(val));
  6749. }
  6750. void kvm_arch_async_page_not_present(struct kvm_vcpu *vcpu,
  6751. struct kvm_async_pf *work)
  6752. {
  6753. struct x86_exception fault;
  6754. trace_kvm_async_pf_not_present(work->arch.token, work->gva);
  6755. kvm_add_async_pf_gfn(vcpu, work->arch.gfn);
  6756. if (!(vcpu->arch.apf.msr_val & KVM_ASYNC_PF_ENABLED) ||
  6757. (vcpu->arch.apf.send_user_only &&
  6758. kvm_x86_ops->get_cpl(vcpu) == 0))
  6759. kvm_make_request(KVM_REQ_APF_HALT, vcpu);
  6760. else if (!apf_put_user(vcpu, KVM_PV_REASON_PAGE_NOT_PRESENT)) {
  6761. fault.vector = PF_VECTOR;
  6762. fault.error_code_valid = true;
  6763. fault.error_code = 0;
  6764. fault.nested_page_fault = false;
  6765. fault.address = work->arch.token;
  6766. kvm_inject_page_fault(vcpu, &fault);
  6767. }
  6768. }
  6769. void kvm_arch_async_page_present(struct kvm_vcpu *vcpu,
  6770. struct kvm_async_pf *work)
  6771. {
  6772. struct x86_exception fault;
  6773. trace_kvm_async_pf_ready(work->arch.token, work->gva);
  6774. if (work->wakeup_all)
  6775. work->arch.token = ~0; /* broadcast wakeup */
  6776. else
  6777. kvm_del_async_pf_gfn(vcpu, work->arch.gfn);
  6778. if ((vcpu->arch.apf.msr_val & KVM_ASYNC_PF_ENABLED) &&
  6779. !apf_put_user(vcpu, KVM_PV_REASON_PAGE_READY)) {
  6780. fault.vector = PF_VECTOR;
  6781. fault.error_code_valid = true;
  6782. fault.error_code = 0;
  6783. fault.nested_page_fault = false;
  6784. fault.address = work->arch.token;
  6785. kvm_inject_page_fault(vcpu, &fault);
  6786. }
  6787. vcpu->arch.apf.halted = false;
  6788. vcpu->arch.mp_state = KVM_MP_STATE_RUNNABLE;
  6789. }
  6790. bool kvm_arch_can_inject_async_page_present(struct kvm_vcpu *vcpu)
  6791. {
  6792. if (!(vcpu->arch.apf.msr_val & KVM_ASYNC_PF_ENABLED))
  6793. return true;
  6794. else
  6795. return !kvm_event_needs_reinjection(vcpu) &&
  6796. kvm_x86_ops->interrupt_allowed(vcpu);
  6797. }
  6798. void kvm_arch_register_noncoherent_dma(struct kvm *kvm)
  6799. {
  6800. atomic_inc(&kvm->arch.noncoherent_dma_count);
  6801. }
  6802. EXPORT_SYMBOL_GPL(kvm_arch_register_noncoherent_dma);
  6803. void kvm_arch_unregister_noncoherent_dma(struct kvm *kvm)
  6804. {
  6805. atomic_dec(&kvm->arch.noncoherent_dma_count);
  6806. }
  6807. EXPORT_SYMBOL_GPL(kvm_arch_unregister_noncoherent_dma);
  6808. bool kvm_arch_has_noncoherent_dma(struct kvm *kvm)
  6809. {
  6810. return atomic_read(&kvm->arch.noncoherent_dma_count);
  6811. }
  6812. EXPORT_SYMBOL_GPL(kvm_arch_has_noncoherent_dma);
  6813. EXPORT_TRACEPOINT_SYMBOL_GPL(kvm_exit);
  6814. EXPORT_TRACEPOINT_SYMBOL_GPL(kvm_inj_virq);
  6815. EXPORT_TRACEPOINT_SYMBOL_GPL(kvm_page_fault);
  6816. EXPORT_TRACEPOINT_SYMBOL_GPL(kvm_msr);
  6817. EXPORT_TRACEPOINT_SYMBOL_GPL(kvm_cr);
  6818. EXPORT_TRACEPOINT_SYMBOL_GPL(kvm_nested_vmrun);
  6819. EXPORT_TRACEPOINT_SYMBOL_GPL(kvm_nested_vmexit);
  6820. EXPORT_TRACEPOINT_SYMBOL_GPL(kvm_nested_vmexit_inject);
  6821. EXPORT_TRACEPOINT_SYMBOL_GPL(kvm_nested_intr_vmexit);
  6822. EXPORT_TRACEPOINT_SYMBOL_GPL(kvm_invlpga);
  6823. EXPORT_TRACEPOINT_SYMBOL_GPL(kvm_skinit);
  6824. EXPORT_TRACEPOINT_SYMBOL_GPL(kvm_nested_intercepts);
  6825. EXPORT_TRACEPOINT_SYMBOL_GPL(kvm_write_tsc_offset);
  6826. EXPORT_TRACEPOINT_SYMBOL_GPL(kvm_ple_window);
  6827. EXPORT_TRACEPOINT_SYMBOL_GPL(kvm_pml_full);