1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586358735883589359035913592359335943595359635973598359936003601360236033604360536063607360836093610361136123613361436153616361736183619362036213622362336243625362636273628362936303631363236333634363536363637363836393640364136423643364436453646364736483649365036513652365336543655365636573658365936603661366236633664366536663667366836693670367136723673367436753676367736783679368036813682368336843685368636873688368936903691369236933694369536963697369836993700370137023703370437053706370737083709371037113712371337143715371637173718371937203721372237233724372537263727372837293730373137323733373437353736373737383739374037413742374337443745374637473748374937503751375237533754375537563757375837593760376137623763376437653766376737683769377037713772377337743775377637773778377937803781378237833784378537863787378837893790379137923793379437953796379737983799380038013802380338043805380638073808380938103811381238133814381538163817381838193820382138223823382438253826382738283829383038313832383338343835383638373838383938403841384238433844384538463847384838493850385138523853385438553856385738583859386038613862 |
- /*
- * Virtio Support
- *
- * Copyright IBM, Corp. 2007
- *
- * Authors:
- * Anthony Liguori <aliguori@us.ibm.com>
- *
- * This work is licensed under the terms of the GNU GPL, version 2. See
- * the COPYING file in the top-level directory.
- *
- */
- #include "qemu/osdep.h"
- #include "qapi/error.h"
- #include "cpu.h"
- #include "trace.h"
- #include "exec/address-spaces.h"
- #include "qemu/error-report.h"
- #include "qemu/main-loop.h"
- #include "qemu/module.h"
- #include "hw/virtio/virtio.h"
- #include "migration/qemu-file-types.h"
- #include "qemu/atomic.h"
- #include "hw/virtio/virtio-bus.h"
- #include "hw/qdev-properties.h"
- #include "hw/virtio/virtio-access.h"
- #include "sysemu/dma.h"
- #include "sysemu/runstate.h"
- #include "standard-headers/linux/virtio_ids.h"
- /*
- * The alignment to use between consumer and producer parts of vring.
- * x86 pagesize again. This is the default, used by transports like PCI
- * which don't provide a means for the guest to tell the host the alignment.
- */
- #define VIRTIO_PCI_VRING_ALIGN 4096
- typedef struct VRingDesc
- {
- uint64_t addr;
- uint32_t len;
- uint16_t flags;
- uint16_t next;
- } VRingDesc;
- typedef struct VRingPackedDesc {
- uint64_t addr;
- uint32_t len;
- uint16_t id;
- uint16_t flags;
- } VRingPackedDesc;
- typedef struct VRingAvail
- {
- uint16_t flags;
- uint16_t idx;
- uint16_t ring[];
- } VRingAvail;
- typedef struct VRingUsedElem
- {
- uint32_t id;
- uint32_t len;
- } VRingUsedElem;
- typedef struct VRingUsed
- {
- uint16_t flags;
- uint16_t idx;
- VRingUsedElem ring[];
- } VRingUsed;
- typedef struct VRingMemoryRegionCaches {
- struct rcu_head rcu;
- MemoryRegionCache desc;
- MemoryRegionCache avail;
- MemoryRegionCache used;
- } VRingMemoryRegionCaches;
- typedef struct VRing
- {
- unsigned int num;
- unsigned int num_default;
- unsigned int align;
- hwaddr desc;
- hwaddr avail;
- hwaddr used;
- VRingMemoryRegionCaches *caches;
- } VRing;
- typedef struct VRingPackedDescEvent {
- uint16_t off_wrap;
- uint16_t flags;
- } VRingPackedDescEvent ;
- struct VirtQueue
- {
- VRing vring;
- VirtQueueElement *used_elems;
- /* Next head to pop */
- uint16_t last_avail_idx;
- bool last_avail_wrap_counter;
- /* Last avail_idx read from VQ. */
- uint16_t shadow_avail_idx;
- bool shadow_avail_wrap_counter;
- uint16_t used_idx;
- bool used_wrap_counter;
- /* Last used index value we have signalled on */
- uint16_t signalled_used;
- /* Last used index value we have signalled on */
- bool signalled_used_valid;
- /* Notification enabled? */
- bool notification;
- uint16_t queue_index;
- unsigned int inuse;
- uint16_t vector;
- VirtIOHandleOutput handle_output;
- VirtIOHandleAIOOutput handle_aio_output;
- VirtIODevice *vdev;
- EventNotifier guest_notifier;
- EventNotifier host_notifier;
- bool host_notifier_enabled;
- QLIST_ENTRY(VirtQueue) node;
- };
- static void virtio_free_region_cache(VRingMemoryRegionCaches *caches)
- {
- if (!caches) {
- return;
- }
- address_space_cache_destroy(&caches->desc);
- address_space_cache_destroy(&caches->avail);
- address_space_cache_destroy(&caches->used);
- g_free(caches);
- }
- static void virtio_virtqueue_reset_region_cache(struct VirtQueue *vq)
- {
- VRingMemoryRegionCaches *caches;
- caches = atomic_read(&vq->vring.caches);
- atomic_rcu_set(&vq->vring.caches, NULL);
- if (caches) {
- call_rcu(caches, virtio_free_region_cache, rcu);
- }
- }
- static void virtio_init_region_cache(VirtIODevice *vdev, int n)
- {
- VirtQueue *vq = &vdev->vq[n];
- VRingMemoryRegionCaches *old = vq->vring.caches;
- VRingMemoryRegionCaches *new = NULL;
- hwaddr addr, size;
- int64_t len;
- bool packed;
- addr = vq->vring.desc;
- if (!addr) {
- goto out_no_cache;
- }
- new = g_new0(VRingMemoryRegionCaches, 1);
- size = virtio_queue_get_desc_size(vdev, n);
- packed = virtio_vdev_has_feature(vq->vdev, VIRTIO_F_RING_PACKED) ?
- true : false;
- len = address_space_cache_init(&new->desc, vdev->dma_as,
- addr, size, packed);
- if (len < size) {
- virtio_error(vdev, "Cannot map desc");
- goto err_desc;
- }
- size = virtio_queue_get_used_size(vdev, n);
- len = address_space_cache_init(&new->used, vdev->dma_as,
- vq->vring.used, size, true);
- if (len < size) {
- virtio_error(vdev, "Cannot map used");
- goto err_used;
- }
- size = virtio_queue_get_avail_size(vdev, n);
- len = address_space_cache_init(&new->avail, vdev->dma_as,
- vq->vring.avail, size, false);
- if (len < size) {
- virtio_error(vdev, "Cannot map avail");
- goto err_avail;
- }
- atomic_rcu_set(&vq->vring.caches, new);
- if (old) {
- call_rcu(old, virtio_free_region_cache, rcu);
- }
- return;
- err_avail:
- address_space_cache_destroy(&new->avail);
- err_used:
- address_space_cache_destroy(&new->used);
- err_desc:
- address_space_cache_destroy(&new->desc);
- out_no_cache:
- g_free(new);
- virtio_virtqueue_reset_region_cache(vq);
- }
- /* virt queue functions */
- void virtio_queue_update_rings(VirtIODevice *vdev, int n)
- {
- VRing *vring = &vdev->vq[n].vring;
- if (!vring->num || !vring->desc || !vring->align) {
- /* not yet setup -> nothing to do */
- return;
- }
- vring->avail = vring->desc + vring->num * sizeof(VRingDesc);
- vring->used = vring_align(vring->avail +
- offsetof(VRingAvail, ring[vring->num]),
- vring->align);
- virtio_init_region_cache(vdev, n);
- }
- /* Called within rcu_read_lock(). */
- static void vring_split_desc_read(VirtIODevice *vdev, VRingDesc *desc,
- MemoryRegionCache *cache, int i)
- {
- address_space_read_cached(cache, i * sizeof(VRingDesc),
- desc, sizeof(VRingDesc));
- virtio_tswap64s(vdev, &desc->addr);
- virtio_tswap32s(vdev, &desc->len);
- virtio_tswap16s(vdev, &desc->flags);
- virtio_tswap16s(vdev, &desc->next);
- }
- static void vring_packed_event_read(VirtIODevice *vdev,
- MemoryRegionCache *cache,
- VRingPackedDescEvent *e)
- {
- hwaddr off_off = offsetof(VRingPackedDescEvent, off_wrap);
- hwaddr off_flags = offsetof(VRingPackedDescEvent, flags);
- address_space_read_cached(cache, off_flags, &e->flags,
- sizeof(e->flags));
- /* Make sure flags is seen before off_wrap */
- smp_rmb();
- address_space_read_cached(cache, off_off, &e->off_wrap,
- sizeof(e->off_wrap));
- virtio_tswap16s(vdev, &e->off_wrap);
- virtio_tswap16s(vdev, &e->flags);
- }
- static void vring_packed_off_wrap_write(VirtIODevice *vdev,
- MemoryRegionCache *cache,
- uint16_t off_wrap)
- {
- hwaddr off = offsetof(VRingPackedDescEvent, off_wrap);
- virtio_tswap16s(vdev, &off_wrap);
- address_space_write_cached(cache, off, &off_wrap, sizeof(off_wrap));
- address_space_cache_invalidate(cache, off, sizeof(off_wrap));
- }
- static void vring_packed_flags_write(VirtIODevice *vdev,
- MemoryRegionCache *cache, uint16_t flags)
- {
- hwaddr off = offsetof(VRingPackedDescEvent, flags);
- virtio_tswap16s(vdev, &flags);
- address_space_write_cached(cache, off, &flags, sizeof(flags));
- address_space_cache_invalidate(cache, off, sizeof(flags));
- }
- /* Called within rcu_read_lock(). */
- static VRingMemoryRegionCaches *vring_get_region_caches(struct VirtQueue *vq)
- {
- return atomic_rcu_read(&vq->vring.caches);
- }
- /* Called within rcu_read_lock(). */
- static inline uint16_t vring_avail_flags(VirtQueue *vq)
- {
- VRingMemoryRegionCaches *caches = vring_get_region_caches(vq);
- hwaddr pa = offsetof(VRingAvail, flags);
- if (!caches) {
- return 0;
- }
- return virtio_lduw_phys_cached(vq->vdev, &caches->avail, pa);
- }
- /* Called within rcu_read_lock(). */
- static inline uint16_t vring_avail_idx(VirtQueue *vq)
- {
- VRingMemoryRegionCaches *caches = vring_get_region_caches(vq);
- hwaddr pa = offsetof(VRingAvail, idx);
- if (!caches) {
- return 0;
- }
- vq->shadow_avail_idx = virtio_lduw_phys_cached(vq->vdev, &caches->avail, pa);
- return vq->shadow_avail_idx;
- }
- /* Called within rcu_read_lock(). */
- static inline uint16_t vring_avail_ring(VirtQueue *vq, int i)
- {
- VRingMemoryRegionCaches *caches = vring_get_region_caches(vq);
- hwaddr pa = offsetof(VRingAvail, ring[i]);
- if (!caches) {
- return 0;
- }
- return virtio_lduw_phys_cached(vq->vdev, &caches->avail, pa);
- }
- /* Called within rcu_read_lock(). */
- static inline uint16_t vring_get_used_event(VirtQueue *vq)
- {
- return vring_avail_ring(vq, vq->vring.num);
- }
- /* Called within rcu_read_lock(). */
- static inline void vring_used_write(VirtQueue *vq, VRingUsedElem *uelem,
- int i)
- {
- VRingMemoryRegionCaches *caches = vring_get_region_caches(vq);
- hwaddr pa = offsetof(VRingUsed, ring[i]);
- if (!caches) {
- return;
- }
- virtio_tswap32s(vq->vdev, &uelem->id);
- virtio_tswap32s(vq->vdev, &uelem->len);
- address_space_write_cached(&caches->used, pa, uelem, sizeof(VRingUsedElem));
- address_space_cache_invalidate(&caches->used, pa, sizeof(VRingUsedElem));
- }
- /* Called within rcu_read_lock(). */
- static uint16_t vring_used_idx(VirtQueue *vq)
- {
- VRingMemoryRegionCaches *caches = vring_get_region_caches(vq);
- hwaddr pa = offsetof(VRingUsed, idx);
- if (!caches) {
- return 0;
- }
- return virtio_lduw_phys_cached(vq->vdev, &caches->used, pa);
- }
- /* Called within rcu_read_lock(). */
- static inline void vring_used_idx_set(VirtQueue *vq, uint16_t val)
- {
- VRingMemoryRegionCaches *caches = vring_get_region_caches(vq);
- hwaddr pa = offsetof(VRingUsed, idx);
- if (caches) {
- virtio_stw_phys_cached(vq->vdev, &caches->used, pa, val);
- address_space_cache_invalidate(&caches->used, pa, sizeof(val));
- }
- vq->used_idx = val;
- }
- /* Called within rcu_read_lock(). */
- static inline void vring_used_flags_set_bit(VirtQueue *vq, int mask)
- {
- VRingMemoryRegionCaches *caches = vring_get_region_caches(vq);
- VirtIODevice *vdev = vq->vdev;
- hwaddr pa = offsetof(VRingUsed, flags);
- uint16_t flags;
- if (!caches) {
- return;
- }
- flags = virtio_lduw_phys_cached(vq->vdev, &caches->used, pa);
- virtio_stw_phys_cached(vdev, &caches->used, pa, flags | mask);
- address_space_cache_invalidate(&caches->used, pa, sizeof(flags));
- }
- /* Called within rcu_read_lock(). */
- static inline void vring_used_flags_unset_bit(VirtQueue *vq, int mask)
- {
- VRingMemoryRegionCaches *caches = vring_get_region_caches(vq);
- VirtIODevice *vdev = vq->vdev;
- hwaddr pa = offsetof(VRingUsed, flags);
- uint16_t flags;
- if (!caches) {
- return;
- }
- flags = virtio_lduw_phys_cached(vq->vdev, &caches->used, pa);
- virtio_stw_phys_cached(vdev, &caches->used, pa, flags & ~mask);
- address_space_cache_invalidate(&caches->used, pa, sizeof(flags));
- }
- /* Called within rcu_read_lock(). */
- static inline void vring_set_avail_event(VirtQueue *vq, uint16_t val)
- {
- VRingMemoryRegionCaches *caches;
- hwaddr pa;
- if (!vq->notification) {
- return;
- }
- caches = vring_get_region_caches(vq);
- if (!caches) {
- return;
- }
- pa = offsetof(VRingUsed, ring[vq->vring.num]);
- virtio_stw_phys_cached(vq->vdev, &caches->used, pa, val);
- address_space_cache_invalidate(&caches->used, pa, sizeof(val));
- }
- static void virtio_queue_split_set_notification(VirtQueue *vq, int enable)
- {
- RCU_READ_LOCK_GUARD();
- if (virtio_vdev_has_feature(vq->vdev, VIRTIO_RING_F_EVENT_IDX)) {
- vring_set_avail_event(vq, vring_avail_idx(vq));
- } else if (enable) {
- vring_used_flags_unset_bit(vq, VRING_USED_F_NO_NOTIFY);
- } else {
- vring_used_flags_set_bit(vq, VRING_USED_F_NO_NOTIFY);
- }
- if (enable) {
- /* Expose avail event/used flags before caller checks the avail idx. */
- smp_mb();
- }
- }
- static void virtio_queue_packed_set_notification(VirtQueue *vq, int enable)
- {
- uint16_t off_wrap;
- VRingPackedDescEvent e;
- VRingMemoryRegionCaches *caches;
- RCU_READ_LOCK_GUARD();
- caches = vring_get_region_caches(vq);
- if (!caches) {
- return;
- }
- vring_packed_event_read(vq->vdev, &caches->used, &e);
- if (!enable) {
- e.flags = VRING_PACKED_EVENT_FLAG_DISABLE;
- } else if (virtio_vdev_has_feature(vq->vdev, VIRTIO_RING_F_EVENT_IDX)) {
- off_wrap = vq->shadow_avail_idx | vq->shadow_avail_wrap_counter << 15;
- vring_packed_off_wrap_write(vq->vdev, &caches->used, off_wrap);
- /* Make sure off_wrap is wrote before flags */
- smp_wmb();
- e.flags = VRING_PACKED_EVENT_FLAG_DESC;
- } else {
- e.flags = VRING_PACKED_EVENT_FLAG_ENABLE;
- }
- vring_packed_flags_write(vq->vdev, &caches->used, e.flags);
- if (enable) {
- /* Expose avail event/used flags before caller checks the avail idx. */
- smp_mb();
- }
- }
- bool virtio_queue_get_notification(VirtQueue *vq)
- {
- return vq->notification;
- }
- void virtio_queue_set_notification(VirtQueue *vq, int enable)
- {
- vq->notification = enable;
- if (!vq->vring.desc) {
- return;
- }
- if (virtio_vdev_has_feature(vq->vdev, VIRTIO_F_RING_PACKED)) {
- virtio_queue_packed_set_notification(vq, enable);
- } else {
- virtio_queue_split_set_notification(vq, enable);
- }
- }
- int virtio_queue_ready(VirtQueue *vq)
- {
- return vq->vring.avail != 0;
- }
- static void vring_packed_desc_read_flags(VirtIODevice *vdev,
- uint16_t *flags,
- MemoryRegionCache *cache,
- int i)
- {
- address_space_read_cached(cache,
- i * sizeof(VRingPackedDesc) +
- offsetof(VRingPackedDesc, flags),
- flags, sizeof(*flags));
- virtio_tswap16s(vdev, flags);
- }
- static void vring_packed_desc_read(VirtIODevice *vdev,
- VRingPackedDesc *desc,
- MemoryRegionCache *cache,
- int i, bool strict_order)
- {
- hwaddr off = i * sizeof(VRingPackedDesc);
- vring_packed_desc_read_flags(vdev, &desc->flags, cache, i);
- if (strict_order) {
- /* Make sure flags is read before the rest fields. */
- smp_rmb();
- }
- address_space_read_cached(cache, off + offsetof(VRingPackedDesc, addr),
- &desc->addr, sizeof(desc->addr));
- address_space_read_cached(cache, off + offsetof(VRingPackedDesc, id),
- &desc->id, sizeof(desc->id));
- address_space_read_cached(cache, off + offsetof(VRingPackedDesc, len),
- &desc->len, sizeof(desc->len));
- virtio_tswap64s(vdev, &desc->addr);
- virtio_tswap16s(vdev, &desc->id);
- virtio_tswap32s(vdev, &desc->len);
- }
- static void vring_packed_desc_write_data(VirtIODevice *vdev,
- VRingPackedDesc *desc,
- MemoryRegionCache *cache,
- int i)
- {
- hwaddr off_id = i * sizeof(VRingPackedDesc) +
- offsetof(VRingPackedDesc, id);
- hwaddr off_len = i * sizeof(VRingPackedDesc) +
- offsetof(VRingPackedDesc, len);
- virtio_tswap32s(vdev, &desc->len);
- virtio_tswap16s(vdev, &desc->id);
- address_space_write_cached(cache, off_id, &desc->id, sizeof(desc->id));
- address_space_cache_invalidate(cache, off_id, sizeof(desc->id));
- address_space_write_cached(cache, off_len, &desc->len, sizeof(desc->len));
- address_space_cache_invalidate(cache, off_len, sizeof(desc->len));
- }
- static void vring_packed_desc_write_flags(VirtIODevice *vdev,
- VRingPackedDesc *desc,
- MemoryRegionCache *cache,
- int i)
- {
- hwaddr off = i * sizeof(VRingPackedDesc) + offsetof(VRingPackedDesc, flags);
- virtio_tswap16s(vdev, &desc->flags);
- address_space_write_cached(cache, off, &desc->flags, sizeof(desc->flags));
- address_space_cache_invalidate(cache, off, sizeof(desc->flags));
- }
- static void vring_packed_desc_write(VirtIODevice *vdev,
- VRingPackedDesc *desc,
- MemoryRegionCache *cache,
- int i, bool strict_order)
- {
- vring_packed_desc_write_data(vdev, desc, cache, i);
- if (strict_order) {
- /* Make sure data is wrote before flags. */
- smp_wmb();
- }
- vring_packed_desc_write_flags(vdev, desc, cache, i);
- }
- static inline bool is_desc_avail(uint16_t flags, bool wrap_counter)
- {
- bool avail, used;
- avail = !!(flags & (1 << VRING_PACKED_DESC_F_AVAIL));
- used = !!(flags & (1 << VRING_PACKED_DESC_F_USED));
- return (avail != used) && (avail == wrap_counter);
- }
- /* Fetch avail_idx from VQ memory only when we really need to know if
- * guest has added some buffers.
- * Called within rcu_read_lock(). */
- static int virtio_queue_empty_rcu(VirtQueue *vq)
- {
- if (virtio_device_disabled(vq->vdev)) {
- return 1;
- }
- if (unlikely(!vq->vring.avail)) {
- return 1;
- }
- if (vq->shadow_avail_idx != vq->last_avail_idx) {
- return 0;
- }
- return vring_avail_idx(vq) == vq->last_avail_idx;
- }
- static int virtio_queue_split_empty(VirtQueue *vq)
- {
- bool empty;
- if (virtio_device_disabled(vq->vdev)) {
- return 1;
- }
- if (unlikely(!vq->vring.avail)) {
- return 1;
- }
- if (vq->shadow_avail_idx != vq->last_avail_idx) {
- return 0;
- }
- RCU_READ_LOCK_GUARD();
- empty = vring_avail_idx(vq) == vq->last_avail_idx;
- return empty;
- }
- static int virtio_queue_packed_empty_rcu(VirtQueue *vq)
- {
- struct VRingPackedDesc desc;
- VRingMemoryRegionCaches *cache;
- if (unlikely(!vq->vring.desc)) {
- return 1;
- }
- cache = vring_get_region_caches(vq);
- if (!cache) {
- return 1;
- }
- vring_packed_desc_read_flags(vq->vdev, &desc.flags, &cache->desc,
- vq->last_avail_idx);
- return !is_desc_avail(desc.flags, vq->last_avail_wrap_counter);
- }
- static int virtio_queue_packed_empty(VirtQueue *vq)
- {
- RCU_READ_LOCK_GUARD();
- return virtio_queue_packed_empty_rcu(vq);
- }
- int virtio_queue_empty(VirtQueue *vq)
- {
- if (virtio_vdev_has_feature(vq->vdev, VIRTIO_F_RING_PACKED)) {
- return virtio_queue_packed_empty(vq);
- } else {
- return virtio_queue_split_empty(vq);
- }
- }
- static void virtqueue_unmap_sg(VirtQueue *vq, const VirtQueueElement *elem,
- unsigned int len)
- {
- AddressSpace *dma_as = vq->vdev->dma_as;
- unsigned int offset;
- int i;
- offset = 0;
- for (i = 0; i < elem->in_num; i++) {
- size_t size = MIN(len - offset, elem->in_sg[i].iov_len);
- dma_memory_unmap(dma_as, elem->in_sg[i].iov_base,
- elem->in_sg[i].iov_len,
- DMA_DIRECTION_FROM_DEVICE, size);
- offset += size;
- }
- for (i = 0; i < elem->out_num; i++)
- dma_memory_unmap(dma_as, elem->out_sg[i].iov_base,
- elem->out_sg[i].iov_len,
- DMA_DIRECTION_TO_DEVICE,
- elem->out_sg[i].iov_len);
- }
- /* virtqueue_detach_element:
- * @vq: The #VirtQueue
- * @elem: The #VirtQueueElement
- * @len: number of bytes written
- *
- * Detach the element from the virtqueue. This function is suitable for device
- * reset or other situations where a #VirtQueueElement is simply freed and will
- * not be pushed or discarded.
- */
- void virtqueue_detach_element(VirtQueue *vq, const VirtQueueElement *elem,
- unsigned int len)
- {
- vq->inuse -= elem->ndescs;
- virtqueue_unmap_sg(vq, elem, len);
- }
- static void virtqueue_split_rewind(VirtQueue *vq, unsigned int num)
- {
- vq->last_avail_idx -= num;
- }
- static void virtqueue_packed_rewind(VirtQueue *vq, unsigned int num)
- {
- if (vq->last_avail_idx < num) {
- vq->last_avail_idx = vq->vring.num + vq->last_avail_idx - num;
- vq->last_avail_wrap_counter ^= 1;
- } else {
- vq->last_avail_idx -= num;
- }
- }
- /* virtqueue_unpop:
- * @vq: The #VirtQueue
- * @elem: The #VirtQueueElement
- * @len: number of bytes written
- *
- * Pretend the most recent element wasn't popped from the virtqueue. The next
- * call to virtqueue_pop() will refetch the element.
- */
- void virtqueue_unpop(VirtQueue *vq, const VirtQueueElement *elem,
- unsigned int len)
- {
- if (virtio_vdev_has_feature(vq->vdev, VIRTIO_F_RING_PACKED)) {
- virtqueue_packed_rewind(vq, 1);
- } else {
- virtqueue_split_rewind(vq, 1);
- }
- virtqueue_detach_element(vq, elem, len);
- }
- /* virtqueue_rewind:
- * @vq: The #VirtQueue
- * @num: Number of elements to push back
- *
- * Pretend that elements weren't popped from the virtqueue. The next
- * virtqueue_pop() will refetch the oldest element.
- *
- * Use virtqueue_unpop() instead if you have a VirtQueueElement.
- *
- * Returns: true on success, false if @num is greater than the number of in use
- * elements.
- */
- bool virtqueue_rewind(VirtQueue *vq, unsigned int num)
- {
- if (num > vq->inuse) {
- return false;
- }
- vq->inuse -= num;
- if (virtio_vdev_has_feature(vq->vdev, VIRTIO_F_RING_PACKED)) {
- virtqueue_packed_rewind(vq, num);
- } else {
- virtqueue_split_rewind(vq, num);
- }
- return true;
- }
- static void virtqueue_split_fill(VirtQueue *vq, const VirtQueueElement *elem,
- unsigned int len, unsigned int idx)
- {
- VRingUsedElem uelem;
- if (unlikely(!vq->vring.used)) {
- return;
- }
- idx = (idx + vq->used_idx) % vq->vring.num;
- uelem.id = elem->index;
- uelem.len = len;
- vring_used_write(vq, &uelem, idx);
- }
- static void virtqueue_packed_fill(VirtQueue *vq, const VirtQueueElement *elem,
- unsigned int len, unsigned int idx)
- {
- vq->used_elems[idx].index = elem->index;
- vq->used_elems[idx].len = len;
- vq->used_elems[idx].ndescs = elem->ndescs;
- }
- static void virtqueue_packed_fill_desc(VirtQueue *vq,
- const VirtQueueElement *elem,
- unsigned int idx,
- bool strict_order)
- {
- uint16_t head;
- VRingMemoryRegionCaches *caches;
- VRingPackedDesc desc = {
- .id = elem->index,
- .len = elem->len,
- };
- bool wrap_counter = vq->used_wrap_counter;
- if (unlikely(!vq->vring.desc)) {
- return;
- }
- head = vq->used_idx + idx;
- if (head >= vq->vring.num) {
- head -= vq->vring.num;
- wrap_counter ^= 1;
- }
- if (wrap_counter) {
- desc.flags |= (1 << VRING_PACKED_DESC_F_AVAIL);
- desc.flags |= (1 << VRING_PACKED_DESC_F_USED);
- } else {
- desc.flags &= ~(1 << VRING_PACKED_DESC_F_AVAIL);
- desc.flags &= ~(1 << VRING_PACKED_DESC_F_USED);
- }
- caches = vring_get_region_caches(vq);
- if (!caches) {
- return;
- }
- vring_packed_desc_write(vq->vdev, &desc, &caches->desc, head, strict_order);
- }
- /* Called within rcu_read_lock(). */
- void virtqueue_fill(VirtQueue *vq, const VirtQueueElement *elem,
- unsigned int len, unsigned int idx)
- {
- trace_virtqueue_fill(vq, elem, len, idx);
- virtqueue_unmap_sg(vq, elem, len);
- if (virtio_device_disabled(vq->vdev)) {
- return;
- }
- if (virtio_vdev_has_feature(vq->vdev, VIRTIO_F_RING_PACKED)) {
- virtqueue_packed_fill(vq, elem, len, idx);
- } else {
- virtqueue_split_fill(vq, elem, len, idx);
- }
- }
- /* Called within rcu_read_lock(). */
- static void virtqueue_split_flush(VirtQueue *vq, unsigned int count)
- {
- uint16_t old, new;
- if (unlikely(!vq->vring.used)) {
- return;
- }
- /* Make sure buffer is written before we update index. */
- smp_wmb();
- trace_virtqueue_flush(vq, count);
- old = vq->used_idx;
- new = old + count;
- vring_used_idx_set(vq, new);
- vq->inuse -= count;
- if (unlikely((int16_t)(new - vq->signalled_used) < (uint16_t)(new - old)))
- vq->signalled_used_valid = false;
- }
- static void virtqueue_packed_flush(VirtQueue *vq, unsigned int count)
- {
- unsigned int i, ndescs = 0;
- if (unlikely(!vq->vring.desc)) {
- return;
- }
- for (i = 1; i < count; i++) {
- virtqueue_packed_fill_desc(vq, &vq->used_elems[i], i, false);
- ndescs += vq->used_elems[i].ndescs;
- }
- virtqueue_packed_fill_desc(vq, &vq->used_elems[0], 0, true);
- ndescs += vq->used_elems[0].ndescs;
- vq->inuse -= ndescs;
- vq->used_idx += ndescs;
- if (vq->used_idx >= vq->vring.num) {
- vq->used_idx -= vq->vring.num;
- vq->used_wrap_counter ^= 1;
- }
- }
- void virtqueue_flush(VirtQueue *vq, unsigned int count)
- {
- if (virtio_device_disabled(vq->vdev)) {
- vq->inuse -= count;
- return;
- }
- if (virtio_vdev_has_feature(vq->vdev, VIRTIO_F_RING_PACKED)) {
- virtqueue_packed_flush(vq, count);
- } else {
- virtqueue_split_flush(vq, count);
- }
- }
- void virtqueue_push(VirtQueue *vq, const VirtQueueElement *elem,
- unsigned int len)
- {
- RCU_READ_LOCK_GUARD();
- virtqueue_fill(vq, elem, len, 0);
- virtqueue_flush(vq, 1);
- }
- /* Called within rcu_read_lock(). */
- static int virtqueue_num_heads(VirtQueue *vq, unsigned int idx)
- {
- uint16_t num_heads = vring_avail_idx(vq) - idx;
- /* Check it isn't doing very strange things with descriptor numbers. */
- if (num_heads > vq->vring.num) {
- virtio_error(vq->vdev, "Guest moved used index from %u to %u",
- idx, vq->shadow_avail_idx);
- return -EINVAL;
- }
- /* On success, callers read a descriptor at vq->last_avail_idx.
- * Make sure descriptor read does not bypass avail index read. */
- if (num_heads) {
- smp_rmb();
- }
- return num_heads;
- }
- /* Called within rcu_read_lock(). */
- static bool virtqueue_get_head(VirtQueue *vq, unsigned int idx,
- unsigned int *head)
- {
- /* Grab the next descriptor number they're advertising, and increment
- * the index we've seen. */
- *head = vring_avail_ring(vq, idx % vq->vring.num);
- /* If their number is silly, that's a fatal mistake. */
- if (*head >= vq->vring.num) {
- virtio_error(vq->vdev, "Guest says index %u is available", *head);
- return false;
- }
- return true;
- }
- enum {
- VIRTQUEUE_READ_DESC_ERROR = -1,
- VIRTQUEUE_READ_DESC_DONE = 0, /* end of chain */
- VIRTQUEUE_READ_DESC_MORE = 1, /* more buffers in chain */
- };
- static int virtqueue_split_read_next_desc(VirtIODevice *vdev, VRingDesc *desc,
- MemoryRegionCache *desc_cache,
- unsigned int max, unsigned int *next)
- {
- /* If this descriptor says it doesn't chain, we're done. */
- if (!(desc->flags & VRING_DESC_F_NEXT)) {
- return VIRTQUEUE_READ_DESC_DONE;
- }
- /* Check they're not leading us off end of descriptors. */
- *next = desc->next;
- /* Make sure compiler knows to grab that: we don't want it changing! */
- smp_wmb();
- if (*next >= max) {
- virtio_error(vdev, "Desc next is %u", *next);
- return VIRTQUEUE_READ_DESC_ERROR;
- }
- vring_split_desc_read(vdev, desc, desc_cache, *next);
- return VIRTQUEUE_READ_DESC_MORE;
- }
- static void virtqueue_split_get_avail_bytes(VirtQueue *vq,
- unsigned int *in_bytes, unsigned int *out_bytes,
- unsigned max_in_bytes, unsigned max_out_bytes)
- {
- VirtIODevice *vdev = vq->vdev;
- unsigned int max, idx;
- unsigned int total_bufs, in_total, out_total;
- VRingMemoryRegionCaches *caches;
- MemoryRegionCache indirect_desc_cache = MEMORY_REGION_CACHE_INVALID;
- int64_t len = 0;
- int rc;
- RCU_READ_LOCK_GUARD();
- idx = vq->last_avail_idx;
- total_bufs = in_total = out_total = 0;
- max = vq->vring.num;
- caches = vring_get_region_caches(vq);
- if (!caches) {
- goto err;
- }
- while ((rc = virtqueue_num_heads(vq, idx)) > 0) {
- MemoryRegionCache *desc_cache = &caches->desc;
- unsigned int num_bufs;
- VRingDesc desc;
- unsigned int i;
- num_bufs = total_bufs;
- if (!virtqueue_get_head(vq, idx++, &i)) {
- goto err;
- }
- vring_split_desc_read(vdev, &desc, desc_cache, i);
- if (desc.flags & VRING_DESC_F_INDIRECT) {
- if (!desc.len || (desc.len % sizeof(VRingDesc))) {
- virtio_error(vdev, "Invalid size for indirect buffer table");
- goto err;
- }
- /* If we've got too many, that implies a descriptor loop. */
- if (num_bufs >= max) {
- virtio_error(vdev, "Looped descriptor");
- goto err;
- }
- /* loop over the indirect descriptor table */
- len = address_space_cache_init(&indirect_desc_cache,
- vdev->dma_as,
- desc.addr, desc.len, false);
- desc_cache = &indirect_desc_cache;
- if (len < desc.len) {
- virtio_error(vdev, "Cannot map indirect buffer");
- goto err;
- }
- max = desc.len / sizeof(VRingDesc);
- num_bufs = i = 0;
- vring_split_desc_read(vdev, &desc, desc_cache, i);
- }
- do {
- /* If we've got too many, that implies a descriptor loop. */
- if (++num_bufs > max) {
- virtio_error(vdev, "Looped descriptor");
- goto err;
- }
- if (desc.flags & VRING_DESC_F_WRITE) {
- in_total += desc.len;
- } else {
- out_total += desc.len;
- }
- if (in_total >= max_in_bytes && out_total >= max_out_bytes) {
- goto done;
- }
- rc = virtqueue_split_read_next_desc(vdev, &desc, desc_cache, max, &i);
- } while (rc == VIRTQUEUE_READ_DESC_MORE);
- if (rc == VIRTQUEUE_READ_DESC_ERROR) {
- goto err;
- }
- if (desc_cache == &indirect_desc_cache) {
- address_space_cache_destroy(&indirect_desc_cache);
- total_bufs++;
- } else {
- total_bufs = num_bufs;
- }
- }
- if (rc < 0) {
- goto err;
- }
- done:
- address_space_cache_destroy(&indirect_desc_cache);
- if (in_bytes) {
- *in_bytes = in_total;
- }
- if (out_bytes) {
- *out_bytes = out_total;
- }
- return;
- err:
- in_total = out_total = 0;
- goto done;
- }
- static int virtqueue_packed_read_next_desc(VirtQueue *vq,
- VRingPackedDesc *desc,
- MemoryRegionCache
- *desc_cache,
- unsigned int max,
- unsigned int *next,
- bool indirect)
- {
- /* If this descriptor says it doesn't chain, we're done. */
- if (!indirect && !(desc->flags & VRING_DESC_F_NEXT)) {
- return VIRTQUEUE_READ_DESC_DONE;
- }
- ++*next;
- if (*next == max) {
- if (indirect) {
- return VIRTQUEUE_READ_DESC_DONE;
- } else {
- (*next) -= vq->vring.num;
- }
- }
- vring_packed_desc_read(vq->vdev, desc, desc_cache, *next, false);
- return VIRTQUEUE_READ_DESC_MORE;
- }
- static void virtqueue_packed_get_avail_bytes(VirtQueue *vq,
- unsigned int *in_bytes,
- unsigned int *out_bytes,
- unsigned max_in_bytes,
- unsigned max_out_bytes)
- {
- VirtIODevice *vdev = vq->vdev;
- unsigned int max, idx;
- unsigned int total_bufs, in_total, out_total;
- MemoryRegionCache *desc_cache;
- VRingMemoryRegionCaches *caches;
- MemoryRegionCache indirect_desc_cache = MEMORY_REGION_CACHE_INVALID;
- int64_t len = 0;
- VRingPackedDesc desc;
- bool wrap_counter;
- RCU_READ_LOCK_GUARD();
- idx = vq->last_avail_idx;
- wrap_counter = vq->last_avail_wrap_counter;
- total_bufs = in_total = out_total = 0;
- max = vq->vring.num;
- caches = vring_get_region_caches(vq);
- if (!caches) {
- goto err;
- }
- for (;;) {
- unsigned int num_bufs = total_bufs;
- unsigned int i = idx;
- int rc;
- desc_cache = &caches->desc;
- vring_packed_desc_read(vdev, &desc, desc_cache, idx, true);
- if (!is_desc_avail(desc.flags, wrap_counter)) {
- break;
- }
- if (desc.flags & VRING_DESC_F_INDIRECT) {
- if (desc.len % sizeof(VRingPackedDesc)) {
- virtio_error(vdev, "Invalid size for indirect buffer table");
- goto err;
- }
- /* If we've got too many, that implies a descriptor loop. */
- if (num_bufs >= max) {
- virtio_error(vdev, "Looped descriptor");
- goto err;
- }
- /* loop over the indirect descriptor table */
- len = address_space_cache_init(&indirect_desc_cache,
- vdev->dma_as,
- desc.addr, desc.len, false);
- desc_cache = &indirect_desc_cache;
- if (len < desc.len) {
- virtio_error(vdev, "Cannot map indirect buffer");
- goto err;
- }
- max = desc.len / sizeof(VRingPackedDesc);
- num_bufs = i = 0;
- vring_packed_desc_read(vdev, &desc, desc_cache, i, false);
- }
- do {
- /* If we've got too many, that implies a descriptor loop. */
- if (++num_bufs > max) {
- virtio_error(vdev, "Looped descriptor");
- goto err;
- }
- if (desc.flags & VRING_DESC_F_WRITE) {
- in_total += desc.len;
- } else {
- out_total += desc.len;
- }
- if (in_total >= max_in_bytes && out_total >= max_out_bytes) {
- goto done;
- }
- rc = virtqueue_packed_read_next_desc(vq, &desc, desc_cache, max,
- &i, desc_cache ==
- &indirect_desc_cache);
- } while (rc == VIRTQUEUE_READ_DESC_MORE);
- if (desc_cache == &indirect_desc_cache) {
- address_space_cache_destroy(&indirect_desc_cache);
- total_bufs++;
- idx++;
- } else {
- idx += num_bufs - total_bufs;
- total_bufs = num_bufs;
- }
- if (idx >= vq->vring.num) {
- idx -= vq->vring.num;
- wrap_counter ^= 1;
- }
- }
- /* Record the index and wrap counter for a kick we want */
- vq->shadow_avail_idx = idx;
- vq->shadow_avail_wrap_counter = wrap_counter;
- done:
- address_space_cache_destroy(&indirect_desc_cache);
- if (in_bytes) {
- *in_bytes = in_total;
- }
- if (out_bytes) {
- *out_bytes = out_total;
- }
- return;
- err:
- in_total = out_total = 0;
- goto done;
- }
- void virtqueue_get_avail_bytes(VirtQueue *vq, unsigned int *in_bytes,
- unsigned int *out_bytes,
- unsigned max_in_bytes, unsigned max_out_bytes)
- {
- uint16_t desc_size;
- VRingMemoryRegionCaches *caches;
- if (unlikely(!vq->vring.desc)) {
- goto err;
- }
- caches = vring_get_region_caches(vq);
- if (!caches) {
- goto err;
- }
- desc_size = virtio_vdev_has_feature(vq->vdev, VIRTIO_F_RING_PACKED) ?
- sizeof(VRingPackedDesc) : sizeof(VRingDesc);
- if (caches->desc.len < vq->vring.num * desc_size) {
- virtio_error(vq->vdev, "Cannot map descriptor ring");
- goto err;
- }
- if (virtio_vdev_has_feature(vq->vdev, VIRTIO_F_RING_PACKED)) {
- virtqueue_packed_get_avail_bytes(vq, in_bytes, out_bytes,
- max_in_bytes, max_out_bytes);
- } else {
- virtqueue_split_get_avail_bytes(vq, in_bytes, out_bytes,
- max_in_bytes, max_out_bytes);
- }
- return;
- err:
- if (in_bytes) {
- *in_bytes = 0;
- }
- if (out_bytes) {
- *out_bytes = 0;
- }
- }
- int virtqueue_avail_bytes(VirtQueue *vq, unsigned int in_bytes,
- unsigned int out_bytes)
- {
- unsigned int in_total, out_total;
- virtqueue_get_avail_bytes(vq, &in_total, &out_total, in_bytes, out_bytes);
- return in_bytes <= in_total && out_bytes <= out_total;
- }
- static bool virtqueue_map_desc(VirtIODevice *vdev, unsigned int *p_num_sg,
- hwaddr *addr, struct iovec *iov,
- unsigned int max_num_sg, bool is_write,
- hwaddr pa, size_t sz)
- {
- bool ok = false;
- unsigned num_sg = *p_num_sg;
- assert(num_sg <= max_num_sg);
- if (!sz) {
- virtio_error(vdev, "virtio: zero sized buffers are not allowed");
- goto out;
- }
- while (sz) {
- hwaddr len = sz;
- if (num_sg == max_num_sg) {
- virtio_error(vdev, "virtio: too many write descriptors in "
- "indirect table");
- goto out;
- }
- iov[num_sg].iov_base = dma_memory_map(vdev->dma_as, pa, &len,
- is_write ?
- DMA_DIRECTION_FROM_DEVICE :
- DMA_DIRECTION_TO_DEVICE);
- if (!iov[num_sg].iov_base) {
- virtio_error(vdev, "virtio: bogus descriptor or out of resources");
- goto out;
- }
- iov[num_sg].iov_len = len;
- addr[num_sg] = pa;
- sz -= len;
- pa += len;
- num_sg++;
- }
- ok = true;
- out:
- *p_num_sg = num_sg;
- return ok;
- }
- /* Only used by error code paths before we have a VirtQueueElement (therefore
- * virtqueue_unmap_sg() can't be used). Assumes buffers weren't written to
- * yet.
- */
- static void virtqueue_undo_map_desc(unsigned int out_num, unsigned int in_num,
- struct iovec *iov)
- {
- unsigned int i;
- for (i = 0; i < out_num + in_num; i++) {
- int is_write = i >= out_num;
- cpu_physical_memory_unmap(iov->iov_base, iov->iov_len, is_write, 0);
- iov++;
- }
- }
- static void virtqueue_map_iovec(VirtIODevice *vdev, struct iovec *sg,
- hwaddr *addr, unsigned int num_sg,
- bool is_write)
- {
- unsigned int i;
- hwaddr len;
- for (i = 0; i < num_sg; i++) {
- len = sg[i].iov_len;
- sg[i].iov_base = dma_memory_map(vdev->dma_as,
- addr[i], &len, is_write ?
- DMA_DIRECTION_FROM_DEVICE :
- DMA_DIRECTION_TO_DEVICE);
- if (!sg[i].iov_base) {
- error_report("virtio: error trying to map MMIO memory");
- exit(1);
- }
- if (len != sg[i].iov_len) {
- error_report("virtio: unexpected memory split");
- exit(1);
- }
- }
- }
- void virtqueue_map(VirtIODevice *vdev, VirtQueueElement *elem)
- {
- virtqueue_map_iovec(vdev, elem->in_sg, elem->in_addr, elem->in_num, true);
- virtqueue_map_iovec(vdev, elem->out_sg, elem->out_addr, elem->out_num,
- false);
- }
- static void *virtqueue_alloc_element(size_t sz, unsigned out_num, unsigned in_num)
- {
- VirtQueueElement *elem;
- size_t in_addr_ofs = QEMU_ALIGN_UP(sz, __alignof__(elem->in_addr[0]));
- size_t out_addr_ofs = in_addr_ofs + in_num * sizeof(elem->in_addr[0]);
- size_t out_addr_end = out_addr_ofs + out_num * sizeof(elem->out_addr[0]);
- size_t in_sg_ofs = QEMU_ALIGN_UP(out_addr_end, __alignof__(elem->in_sg[0]));
- size_t out_sg_ofs = in_sg_ofs + in_num * sizeof(elem->in_sg[0]);
- size_t out_sg_end = out_sg_ofs + out_num * sizeof(elem->out_sg[0]);
- assert(sz >= sizeof(VirtQueueElement));
- elem = g_malloc(out_sg_end);
- trace_virtqueue_alloc_element(elem, sz, in_num, out_num);
- elem->out_num = out_num;
- elem->in_num = in_num;
- elem->in_addr = (void *)elem + in_addr_ofs;
- elem->out_addr = (void *)elem + out_addr_ofs;
- elem->in_sg = (void *)elem + in_sg_ofs;
- elem->out_sg = (void *)elem + out_sg_ofs;
- return elem;
- }
- static void *virtqueue_split_pop(VirtQueue *vq, size_t sz)
- {
- unsigned int i, head, max;
- VRingMemoryRegionCaches *caches;
- MemoryRegionCache indirect_desc_cache = MEMORY_REGION_CACHE_INVALID;
- MemoryRegionCache *desc_cache;
- int64_t len;
- VirtIODevice *vdev = vq->vdev;
- VirtQueueElement *elem = NULL;
- unsigned out_num, in_num, elem_entries;
- hwaddr addr[VIRTQUEUE_MAX_SIZE];
- struct iovec iov[VIRTQUEUE_MAX_SIZE];
- VRingDesc desc;
- int rc;
- RCU_READ_LOCK_GUARD();
- if (virtio_queue_empty_rcu(vq)) {
- goto done;
- }
- /* Needed after virtio_queue_empty(), see comment in
- * virtqueue_num_heads(). */
- smp_rmb();
- /* When we start there are none of either input nor output. */
- out_num = in_num = elem_entries = 0;
- max = vq->vring.num;
- if (vq->inuse >= vq->vring.num) {
- virtio_error(vdev, "Virtqueue size exceeded");
- goto done;
- }
- if (!virtqueue_get_head(vq, vq->last_avail_idx++, &head)) {
- goto done;
- }
- if (virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX)) {
- vring_set_avail_event(vq, vq->last_avail_idx);
- }
- i = head;
- caches = vring_get_region_caches(vq);
- if (!caches) {
- virtio_error(vdev, "Region caches not initialized");
- goto done;
- }
- if (caches->desc.len < max * sizeof(VRingDesc)) {
- virtio_error(vdev, "Cannot map descriptor ring");
- goto done;
- }
- desc_cache = &caches->desc;
- vring_split_desc_read(vdev, &desc, desc_cache, i);
- if (desc.flags & VRING_DESC_F_INDIRECT) {
- if (!desc.len || (desc.len % sizeof(VRingDesc))) {
- virtio_error(vdev, "Invalid size for indirect buffer table");
- goto done;
- }
- /* loop over the indirect descriptor table */
- len = address_space_cache_init(&indirect_desc_cache, vdev->dma_as,
- desc.addr, desc.len, false);
- desc_cache = &indirect_desc_cache;
- if (len < desc.len) {
- virtio_error(vdev, "Cannot map indirect buffer");
- goto done;
- }
- max = desc.len / sizeof(VRingDesc);
- i = 0;
- vring_split_desc_read(vdev, &desc, desc_cache, i);
- }
- /* Collect all the descriptors */
- do {
- bool map_ok;
- if (desc.flags & VRING_DESC_F_WRITE) {
- map_ok = virtqueue_map_desc(vdev, &in_num, addr + out_num,
- iov + out_num,
- VIRTQUEUE_MAX_SIZE - out_num, true,
- desc.addr, desc.len);
- } else {
- if (in_num) {
- virtio_error(vdev, "Incorrect order for descriptors");
- goto err_undo_map;
- }
- map_ok = virtqueue_map_desc(vdev, &out_num, addr, iov,
- VIRTQUEUE_MAX_SIZE, false,
- desc.addr, desc.len);
- }
- if (!map_ok) {
- goto err_undo_map;
- }
- /* If we've got too many, that implies a descriptor loop. */
- if (++elem_entries > max) {
- virtio_error(vdev, "Looped descriptor");
- goto err_undo_map;
- }
- rc = virtqueue_split_read_next_desc(vdev, &desc, desc_cache, max, &i);
- } while (rc == VIRTQUEUE_READ_DESC_MORE);
- if (rc == VIRTQUEUE_READ_DESC_ERROR) {
- goto err_undo_map;
- }
- /* Now copy what we have collected and mapped */
- elem = virtqueue_alloc_element(sz, out_num, in_num);
- elem->index = head;
- elem->ndescs = 1;
- for (i = 0; i < out_num; i++) {
- elem->out_addr[i] = addr[i];
- elem->out_sg[i] = iov[i];
- }
- for (i = 0; i < in_num; i++) {
- elem->in_addr[i] = addr[out_num + i];
- elem->in_sg[i] = iov[out_num + i];
- }
- vq->inuse++;
- trace_virtqueue_pop(vq, elem, elem->in_num, elem->out_num);
- done:
- address_space_cache_destroy(&indirect_desc_cache);
- return elem;
- err_undo_map:
- virtqueue_undo_map_desc(out_num, in_num, iov);
- goto done;
- }
- static void *virtqueue_packed_pop(VirtQueue *vq, size_t sz)
- {
- unsigned int i, max;
- VRingMemoryRegionCaches *caches;
- MemoryRegionCache indirect_desc_cache = MEMORY_REGION_CACHE_INVALID;
- MemoryRegionCache *desc_cache;
- int64_t len;
- VirtIODevice *vdev = vq->vdev;
- VirtQueueElement *elem = NULL;
- unsigned out_num, in_num, elem_entries;
- hwaddr addr[VIRTQUEUE_MAX_SIZE];
- struct iovec iov[VIRTQUEUE_MAX_SIZE];
- VRingPackedDesc desc;
- uint16_t id;
- int rc;
- RCU_READ_LOCK_GUARD();
- if (virtio_queue_packed_empty_rcu(vq)) {
- goto done;
- }
- /* When we start there are none of either input nor output. */
- out_num = in_num = elem_entries = 0;
- max = vq->vring.num;
- if (vq->inuse >= vq->vring.num) {
- virtio_error(vdev, "Virtqueue size exceeded");
- goto done;
- }
- i = vq->last_avail_idx;
- caches = vring_get_region_caches(vq);
- if (!caches) {
- virtio_error(vdev, "Region caches not initialized");
- goto done;
- }
- if (caches->desc.len < max * sizeof(VRingDesc)) {
- virtio_error(vdev, "Cannot map descriptor ring");
- goto done;
- }
- desc_cache = &caches->desc;
- vring_packed_desc_read(vdev, &desc, desc_cache, i, true);
- id = desc.id;
- if (desc.flags & VRING_DESC_F_INDIRECT) {
- if (desc.len % sizeof(VRingPackedDesc)) {
- virtio_error(vdev, "Invalid size for indirect buffer table");
- goto done;
- }
- /* loop over the indirect descriptor table */
- len = address_space_cache_init(&indirect_desc_cache, vdev->dma_as,
- desc.addr, desc.len, false);
- desc_cache = &indirect_desc_cache;
- if (len < desc.len) {
- virtio_error(vdev, "Cannot map indirect buffer");
- goto done;
- }
- max = desc.len / sizeof(VRingPackedDesc);
- i = 0;
- vring_packed_desc_read(vdev, &desc, desc_cache, i, false);
- }
- /* Collect all the descriptors */
- do {
- bool map_ok;
- if (desc.flags & VRING_DESC_F_WRITE) {
- map_ok = virtqueue_map_desc(vdev, &in_num, addr + out_num,
- iov + out_num,
- VIRTQUEUE_MAX_SIZE - out_num, true,
- desc.addr, desc.len);
- } else {
- if (in_num) {
- virtio_error(vdev, "Incorrect order for descriptors");
- goto err_undo_map;
- }
- map_ok = virtqueue_map_desc(vdev, &out_num, addr, iov,
- VIRTQUEUE_MAX_SIZE, false,
- desc.addr, desc.len);
- }
- if (!map_ok) {
- goto err_undo_map;
- }
- /* If we've got too many, that implies a descriptor loop. */
- if (++elem_entries > max) {
- virtio_error(vdev, "Looped descriptor");
- goto err_undo_map;
- }
- rc = virtqueue_packed_read_next_desc(vq, &desc, desc_cache, max, &i,
- desc_cache ==
- &indirect_desc_cache);
- } while (rc == VIRTQUEUE_READ_DESC_MORE);
- /* Now copy what we have collected and mapped */
- elem = virtqueue_alloc_element(sz, out_num, in_num);
- for (i = 0; i < out_num; i++) {
- elem->out_addr[i] = addr[i];
- elem->out_sg[i] = iov[i];
- }
- for (i = 0; i < in_num; i++) {
- elem->in_addr[i] = addr[out_num + i];
- elem->in_sg[i] = iov[out_num + i];
- }
- elem->index = id;
- elem->ndescs = (desc_cache == &indirect_desc_cache) ? 1 : elem_entries;
- vq->last_avail_idx += elem->ndescs;
- vq->inuse += elem->ndescs;
- if (vq->last_avail_idx >= vq->vring.num) {
- vq->last_avail_idx -= vq->vring.num;
- vq->last_avail_wrap_counter ^= 1;
- }
- vq->shadow_avail_idx = vq->last_avail_idx;
- vq->shadow_avail_wrap_counter = vq->last_avail_wrap_counter;
- trace_virtqueue_pop(vq, elem, elem->in_num, elem->out_num);
- done:
- address_space_cache_destroy(&indirect_desc_cache);
- return elem;
- err_undo_map:
- virtqueue_undo_map_desc(out_num, in_num, iov);
- goto done;
- }
- void *virtqueue_pop(VirtQueue *vq, size_t sz)
- {
- if (virtio_device_disabled(vq->vdev)) {
- return NULL;
- }
- if (virtio_vdev_has_feature(vq->vdev, VIRTIO_F_RING_PACKED)) {
- return virtqueue_packed_pop(vq, sz);
- } else {
- return virtqueue_split_pop(vq, sz);
- }
- }
- static unsigned int virtqueue_packed_drop_all(VirtQueue *vq)
- {
- VRingMemoryRegionCaches *caches;
- MemoryRegionCache *desc_cache;
- unsigned int dropped = 0;
- VirtQueueElement elem = {};
- VirtIODevice *vdev = vq->vdev;
- VRingPackedDesc desc;
- caches = vring_get_region_caches(vq);
- if (!caches) {
- return 0;
- }
- desc_cache = &caches->desc;
- virtio_queue_set_notification(vq, 0);
- while (vq->inuse < vq->vring.num) {
- unsigned int idx = vq->last_avail_idx;
- /*
- * works similar to virtqueue_pop but does not map buffers
- * and does not allocate any memory.
- */
- vring_packed_desc_read(vdev, &desc, desc_cache,
- vq->last_avail_idx , true);
- if (!is_desc_avail(desc.flags, vq->last_avail_wrap_counter)) {
- break;
- }
- elem.index = desc.id;
- elem.ndescs = 1;
- while (virtqueue_packed_read_next_desc(vq, &desc, desc_cache,
- vq->vring.num, &idx, false)) {
- ++elem.ndescs;
- }
- /*
- * immediately push the element, nothing to unmap
- * as both in_num and out_num are set to 0.
- */
- virtqueue_push(vq, &elem, 0);
- dropped++;
- vq->last_avail_idx += elem.ndescs;
- if (vq->last_avail_idx >= vq->vring.num) {
- vq->last_avail_idx -= vq->vring.num;
- vq->last_avail_wrap_counter ^= 1;
- }
- }
- return dropped;
- }
- static unsigned int virtqueue_split_drop_all(VirtQueue *vq)
- {
- unsigned int dropped = 0;
- VirtQueueElement elem = {};
- VirtIODevice *vdev = vq->vdev;
- bool fEventIdx = virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX);
- while (!virtio_queue_empty(vq) && vq->inuse < vq->vring.num) {
- /* works similar to virtqueue_pop but does not map buffers
- * and does not allocate any memory */
- smp_rmb();
- if (!virtqueue_get_head(vq, vq->last_avail_idx, &elem.index)) {
- break;
- }
- vq->inuse++;
- vq->last_avail_idx++;
- if (fEventIdx) {
- vring_set_avail_event(vq, vq->last_avail_idx);
- }
- /* immediately push the element, nothing to unmap
- * as both in_num and out_num are set to 0 */
- virtqueue_push(vq, &elem, 0);
- dropped++;
- }
- return dropped;
- }
- /* virtqueue_drop_all:
- * @vq: The #VirtQueue
- * Drops all queued buffers and indicates them to the guest
- * as if they are done. Useful when buffers can not be
- * processed but must be returned to the guest.
- */
- unsigned int virtqueue_drop_all(VirtQueue *vq)
- {
- struct VirtIODevice *vdev = vq->vdev;
- if (virtio_device_disabled(vq->vdev)) {
- return 0;
- }
- if (virtio_vdev_has_feature(vdev, VIRTIO_F_RING_PACKED)) {
- return virtqueue_packed_drop_all(vq);
- } else {
- return virtqueue_split_drop_all(vq);
- }
- }
- /* Reading and writing a structure directly to QEMUFile is *awful*, but
- * it is what QEMU has always done by mistake. We can change it sooner
- * or later by bumping the version number of the affected vm states.
- * In the meanwhile, since the in-memory layout of VirtQueueElement
- * has changed, we need to marshal to and from the layout that was
- * used before the change.
- */
- typedef struct VirtQueueElementOld {
- unsigned int index;
- unsigned int out_num;
- unsigned int in_num;
- hwaddr in_addr[VIRTQUEUE_MAX_SIZE];
- hwaddr out_addr[VIRTQUEUE_MAX_SIZE];
- struct iovec in_sg[VIRTQUEUE_MAX_SIZE];
- struct iovec out_sg[VIRTQUEUE_MAX_SIZE];
- } VirtQueueElementOld;
- void *qemu_get_virtqueue_element(VirtIODevice *vdev, QEMUFile *f, size_t sz)
- {
- VirtQueueElement *elem;
- VirtQueueElementOld data;
- int i;
- qemu_get_buffer(f, (uint8_t *)&data, sizeof(VirtQueueElementOld));
- /* TODO: teach all callers that this can fail, and return failure instead
- * of asserting here.
- * This is just one thing (there are probably more) that must be
- * fixed before we can allow NDEBUG compilation.
- */
- assert(ARRAY_SIZE(data.in_addr) >= data.in_num);
- assert(ARRAY_SIZE(data.out_addr) >= data.out_num);
- elem = virtqueue_alloc_element(sz, data.out_num, data.in_num);
- elem->index = data.index;
- for (i = 0; i < elem->in_num; i++) {
- elem->in_addr[i] = data.in_addr[i];
- }
- for (i = 0; i < elem->out_num; i++) {
- elem->out_addr[i] = data.out_addr[i];
- }
- for (i = 0; i < elem->in_num; i++) {
- /* Base is overwritten by virtqueue_map. */
- elem->in_sg[i].iov_base = 0;
- elem->in_sg[i].iov_len = data.in_sg[i].iov_len;
- }
- for (i = 0; i < elem->out_num; i++) {
- /* Base is overwritten by virtqueue_map. */
- elem->out_sg[i].iov_base = 0;
- elem->out_sg[i].iov_len = data.out_sg[i].iov_len;
- }
- if (virtio_host_has_feature(vdev, VIRTIO_F_RING_PACKED)) {
- qemu_get_be32s(f, &elem->ndescs);
- }
- virtqueue_map(vdev, elem);
- return elem;
- }
- void qemu_put_virtqueue_element(VirtIODevice *vdev, QEMUFile *f,
- VirtQueueElement *elem)
- {
- VirtQueueElementOld data;
- int i;
- memset(&data, 0, sizeof(data));
- data.index = elem->index;
- data.in_num = elem->in_num;
- data.out_num = elem->out_num;
- for (i = 0; i < elem->in_num; i++) {
- data.in_addr[i] = elem->in_addr[i];
- }
- for (i = 0; i < elem->out_num; i++) {
- data.out_addr[i] = elem->out_addr[i];
- }
- for (i = 0; i < elem->in_num; i++) {
- /* Base is overwritten by virtqueue_map when loading. Do not
- * save it, as it would leak the QEMU address space layout. */
- data.in_sg[i].iov_len = elem->in_sg[i].iov_len;
- }
- for (i = 0; i < elem->out_num; i++) {
- /* Do not save iov_base as above. */
- data.out_sg[i].iov_len = elem->out_sg[i].iov_len;
- }
- if (virtio_host_has_feature(vdev, VIRTIO_F_RING_PACKED)) {
- qemu_put_be32s(f, &elem->ndescs);
- }
- qemu_put_buffer(f, (uint8_t *)&data, sizeof(VirtQueueElementOld));
- }
- /* virtio device */
- static void virtio_notify_vector(VirtIODevice *vdev, uint16_t vector)
- {
- BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
- VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
- if (virtio_device_disabled(vdev)) {
- return;
- }
- if (k->notify) {
- k->notify(qbus->parent, vector);
- }
- }
- void virtio_update_irq(VirtIODevice *vdev)
- {
- virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
- }
- static int virtio_validate_features(VirtIODevice *vdev)
- {
- VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
- if (virtio_host_has_feature(vdev, VIRTIO_F_IOMMU_PLATFORM) &&
- !virtio_vdev_has_feature(vdev, VIRTIO_F_IOMMU_PLATFORM)) {
- return -EFAULT;
- }
- if (k->validate_features) {
- return k->validate_features(vdev);
- } else {
- return 0;
- }
- }
- int virtio_set_status(VirtIODevice *vdev, uint8_t val)
- {
- VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
- trace_virtio_set_status(vdev, val);
- if (virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
- if (!(vdev->status & VIRTIO_CONFIG_S_FEATURES_OK) &&
- val & VIRTIO_CONFIG_S_FEATURES_OK) {
- int ret = virtio_validate_features(vdev);
- if (ret) {
- return ret;
- }
- }
- }
- if ((vdev->status & VIRTIO_CONFIG_S_DRIVER_OK) !=
- (val & VIRTIO_CONFIG_S_DRIVER_OK)) {
- virtio_set_started(vdev, val & VIRTIO_CONFIG_S_DRIVER_OK);
- }
- if (k->set_status) {
- k->set_status(vdev, val);
- }
- vdev->status = val;
- return 0;
- }
- static enum virtio_device_endian virtio_default_endian(void)
- {
- if (target_words_bigendian()) {
- return VIRTIO_DEVICE_ENDIAN_BIG;
- } else {
- return VIRTIO_DEVICE_ENDIAN_LITTLE;
- }
- }
- static enum virtio_device_endian virtio_current_cpu_endian(void)
- {
- CPUClass *cc = CPU_GET_CLASS(current_cpu);
- if (cc->virtio_is_big_endian(current_cpu)) {
- return VIRTIO_DEVICE_ENDIAN_BIG;
- } else {
- return VIRTIO_DEVICE_ENDIAN_LITTLE;
- }
- }
- void virtio_reset(void *opaque)
- {
- VirtIODevice *vdev = opaque;
- VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
- int i;
- virtio_set_status(vdev, 0);
- if (current_cpu) {
- /* Guest initiated reset */
- vdev->device_endian = virtio_current_cpu_endian();
- } else {
- /* System reset */
- vdev->device_endian = virtio_default_endian();
- }
- if (k->reset) {
- k->reset(vdev);
- }
- vdev->start_on_kick = false;
- vdev->started = false;
- vdev->broken = false;
- vdev->guest_features = 0;
- vdev->queue_sel = 0;
- vdev->status = 0;
- vdev->disabled = false;
- atomic_set(&vdev->isr, 0);
- vdev->config_vector = VIRTIO_NO_VECTOR;
- virtio_notify_vector(vdev, vdev->config_vector);
- for(i = 0; i < VIRTIO_QUEUE_MAX; i++) {
- vdev->vq[i].vring.desc = 0;
- vdev->vq[i].vring.avail = 0;
- vdev->vq[i].vring.used = 0;
- vdev->vq[i].last_avail_idx = 0;
- vdev->vq[i].shadow_avail_idx = 0;
- vdev->vq[i].used_idx = 0;
- vdev->vq[i].last_avail_wrap_counter = true;
- vdev->vq[i].shadow_avail_wrap_counter = true;
- vdev->vq[i].used_wrap_counter = true;
- virtio_queue_set_vector(vdev, i, VIRTIO_NO_VECTOR);
- vdev->vq[i].signalled_used = 0;
- vdev->vq[i].signalled_used_valid = false;
- vdev->vq[i].notification = true;
- vdev->vq[i].vring.num = vdev->vq[i].vring.num_default;
- vdev->vq[i].inuse = 0;
- virtio_virtqueue_reset_region_cache(&vdev->vq[i]);
- }
- }
- uint32_t virtio_config_readb(VirtIODevice *vdev, uint32_t addr)
- {
- VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
- uint8_t val;
- if (addr + sizeof(val) > vdev->config_len) {
- return (uint32_t)-1;
- }
- k->get_config(vdev, vdev->config);
- val = ldub_p(vdev->config + addr);
- return val;
- }
- uint32_t virtio_config_readw(VirtIODevice *vdev, uint32_t addr)
- {
- VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
- uint16_t val;
- if (addr + sizeof(val) > vdev->config_len) {
- return (uint32_t)-1;
- }
- k->get_config(vdev, vdev->config);
- val = lduw_p(vdev->config + addr);
- return val;
- }
- uint32_t virtio_config_readl(VirtIODevice *vdev, uint32_t addr)
- {
- VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
- uint32_t val;
- if (addr + sizeof(val) > vdev->config_len) {
- return (uint32_t)-1;
- }
- k->get_config(vdev, vdev->config);
- val = ldl_p(vdev->config + addr);
- return val;
- }
- void virtio_config_writeb(VirtIODevice *vdev, uint32_t addr, uint32_t data)
- {
- VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
- uint8_t val = data;
- if (addr + sizeof(val) > vdev->config_len) {
- return;
- }
- stb_p(vdev->config + addr, val);
- if (k->set_config) {
- k->set_config(vdev, vdev->config);
- }
- }
- void virtio_config_writew(VirtIODevice *vdev, uint32_t addr, uint32_t data)
- {
- VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
- uint16_t val = data;
- if (addr + sizeof(val) > vdev->config_len) {
- return;
- }
- stw_p(vdev->config + addr, val);
- if (k->set_config) {
- k->set_config(vdev, vdev->config);
- }
- }
- void virtio_config_writel(VirtIODevice *vdev, uint32_t addr, uint32_t data)
- {
- VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
- uint32_t val = data;
- if (addr + sizeof(val) > vdev->config_len) {
- return;
- }
- stl_p(vdev->config + addr, val);
- if (k->set_config) {
- k->set_config(vdev, vdev->config);
- }
- }
- uint32_t virtio_config_modern_readb(VirtIODevice *vdev, uint32_t addr)
- {
- VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
- uint8_t val;
- if (addr + sizeof(val) > vdev->config_len) {
- return (uint32_t)-1;
- }
- k->get_config(vdev, vdev->config);
- val = ldub_p(vdev->config + addr);
- return val;
- }
- uint32_t virtio_config_modern_readw(VirtIODevice *vdev, uint32_t addr)
- {
- VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
- uint16_t val;
- if (addr + sizeof(val) > vdev->config_len) {
- return (uint32_t)-1;
- }
- k->get_config(vdev, vdev->config);
- val = lduw_le_p(vdev->config + addr);
- return val;
- }
- uint32_t virtio_config_modern_readl(VirtIODevice *vdev, uint32_t addr)
- {
- VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
- uint32_t val;
- if (addr + sizeof(val) > vdev->config_len) {
- return (uint32_t)-1;
- }
- k->get_config(vdev, vdev->config);
- val = ldl_le_p(vdev->config + addr);
- return val;
- }
- void virtio_config_modern_writeb(VirtIODevice *vdev,
- uint32_t addr, uint32_t data)
- {
- VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
- uint8_t val = data;
- if (addr + sizeof(val) > vdev->config_len) {
- return;
- }
- stb_p(vdev->config + addr, val);
- if (k->set_config) {
- k->set_config(vdev, vdev->config);
- }
- }
- void virtio_config_modern_writew(VirtIODevice *vdev,
- uint32_t addr, uint32_t data)
- {
- VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
- uint16_t val = data;
- if (addr + sizeof(val) > vdev->config_len) {
- return;
- }
- stw_le_p(vdev->config + addr, val);
- if (k->set_config) {
- k->set_config(vdev, vdev->config);
- }
- }
- void virtio_config_modern_writel(VirtIODevice *vdev,
- uint32_t addr, uint32_t data)
- {
- VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
- uint32_t val = data;
- if (addr + sizeof(val) > vdev->config_len) {
- return;
- }
- stl_le_p(vdev->config + addr, val);
- if (k->set_config) {
- k->set_config(vdev, vdev->config);
- }
- }
- void virtio_queue_set_addr(VirtIODevice *vdev, int n, hwaddr addr)
- {
- if (!vdev->vq[n].vring.num) {
- return;
- }
- vdev->vq[n].vring.desc = addr;
- virtio_queue_update_rings(vdev, n);
- }
- hwaddr virtio_queue_get_addr(VirtIODevice *vdev, int n)
- {
- return vdev->vq[n].vring.desc;
- }
- void virtio_queue_set_rings(VirtIODevice *vdev, int n, hwaddr desc,
- hwaddr avail, hwaddr used)
- {
- if (!vdev->vq[n].vring.num) {
- return;
- }
- vdev->vq[n].vring.desc = desc;
- vdev->vq[n].vring.avail = avail;
- vdev->vq[n].vring.used = used;
- virtio_init_region_cache(vdev, n);
- }
- void virtio_queue_set_num(VirtIODevice *vdev, int n, int num)
- {
- /* Don't allow guest to flip queue between existent and
- * nonexistent states, or to set it to an invalid size.
- */
- if (!!num != !!vdev->vq[n].vring.num ||
- num > VIRTQUEUE_MAX_SIZE ||
- num < 0) {
- return;
- }
- vdev->vq[n].vring.num = num;
- }
- VirtQueue *virtio_vector_first_queue(VirtIODevice *vdev, uint16_t vector)
- {
- return QLIST_FIRST(&vdev->vector_queues[vector]);
- }
- VirtQueue *virtio_vector_next_queue(VirtQueue *vq)
- {
- return QLIST_NEXT(vq, node);
- }
- int virtio_queue_get_num(VirtIODevice *vdev, int n)
- {
- return vdev->vq[n].vring.num;
- }
- int virtio_queue_get_max_num(VirtIODevice *vdev, int n)
- {
- return vdev->vq[n].vring.num_default;
- }
- int virtio_get_num_queues(VirtIODevice *vdev)
- {
- int i;
- for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
- if (!virtio_queue_get_num(vdev, i)) {
- break;
- }
- }
- return i;
- }
- void virtio_queue_set_align(VirtIODevice *vdev, int n, int align)
- {
- BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
- VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
- /* virtio-1 compliant devices cannot change the alignment */
- if (virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
- error_report("tried to modify queue alignment for virtio-1 device");
- return;
- }
- /* Check that the transport told us it was going to do this
- * (so a buggy transport will immediately assert rather than
- * silently failing to migrate this state)
- */
- assert(k->has_variable_vring_alignment);
- if (align) {
- vdev->vq[n].vring.align = align;
- virtio_queue_update_rings(vdev, n);
- }
- }
- static bool virtio_queue_notify_aio_vq(VirtQueue *vq)
- {
- bool ret = false;
- if (vq->vring.desc && vq->handle_aio_output) {
- VirtIODevice *vdev = vq->vdev;
- trace_virtio_queue_notify(vdev, vq - vdev->vq, vq);
- ret = vq->handle_aio_output(vdev, vq);
- if (unlikely(vdev->start_on_kick)) {
- virtio_set_started(vdev, true);
- }
- }
- return ret;
- }
- static void virtio_queue_notify_vq(VirtQueue *vq)
- {
- if (vq->vring.desc && vq->handle_output) {
- VirtIODevice *vdev = vq->vdev;
- if (unlikely(vdev->broken)) {
- return;
- }
- trace_virtio_queue_notify(vdev, vq - vdev->vq, vq);
- vq->handle_output(vdev, vq);
- if (unlikely(vdev->start_on_kick)) {
- virtio_set_started(vdev, true);
- }
- }
- }
- void virtio_queue_notify(VirtIODevice *vdev, int n)
- {
- VirtQueue *vq = &vdev->vq[n];
- if (unlikely(!vq->vring.desc || vdev->broken)) {
- return;
- }
- trace_virtio_queue_notify(vdev, vq - vdev->vq, vq);
- if (vq->host_notifier_enabled) {
- event_notifier_set(&vq->host_notifier);
- } else if (vq->handle_output) {
- vq->handle_output(vdev, vq);
- if (unlikely(vdev->start_on_kick)) {
- virtio_set_started(vdev, true);
- }
- }
- }
- uint16_t virtio_queue_vector(VirtIODevice *vdev, int n)
- {
- return n < VIRTIO_QUEUE_MAX ? vdev->vq[n].vector :
- VIRTIO_NO_VECTOR;
- }
- void virtio_queue_set_vector(VirtIODevice *vdev, int n, uint16_t vector)
- {
- VirtQueue *vq = &vdev->vq[n];
- if (n < VIRTIO_QUEUE_MAX) {
- if (vdev->vector_queues &&
- vdev->vq[n].vector != VIRTIO_NO_VECTOR) {
- QLIST_REMOVE(vq, node);
- }
- vdev->vq[n].vector = vector;
- if (vdev->vector_queues &&
- vector != VIRTIO_NO_VECTOR) {
- QLIST_INSERT_HEAD(&vdev->vector_queues[vector], vq, node);
- }
- }
- }
- VirtQueue *virtio_add_queue(VirtIODevice *vdev, int queue_size,
- VirtIOHandleOutput handle_output)
- {
- int i;
- for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
- if (vdev->vq[i].vring.num == 0)
- break;
- }
- if (i == VIRTIO_QUEUE_MAX || queue_size > VIRTQUEUE_MAX_SIZE)
- abort();
- vdev->vq[i].vring.num = queue_size;
- vdev->vq[i].vring.num_default = queue_size;
- vdev->vq[i].vring.align = VIRTIO_PCI_VRING_ALIGN;
- vdev->vq[i].handle_output = handle_output;
- vdev->vq[i].handle_aio_output = NULL;
- vdev->vq[i].used_elems = g_malloc0(sizeof(VirtQueueElement) *
- queue_size);
- return &vdev->vq[i];
- }
- void virtio_delete_queue(VirtQueue *vq)
- {
- vq->vring.num = 0;
- vq->vring.num_default = 0;
- vq->handle_output = NULL;
- vq->handle_aio_output = NULL;
- g_free(vq->used_elems);
- vq->used_elems = NULL;
- virtio_virtqueue_reset_region_cache(vq);
- }
- void virtio_del_queue(VirtIODevice *vdev, int n)
- {
- if (n < 0 || n >= VIRTIO_QUEUE_MAX) {
- abort();
- }
- virtio_delete_queue(&vdev->vq[n]);
- }
- static void virtio_set_isr(VirtIODevice *vdev, int value)
- {
- uint8_t old = atomic_read(&vdev->isr);
- /* Do not write ISR if it does not change, so that its cacheline remains
- * shared in the common case where the guest does not read it.
- */
- if ((old & value) != value) {
- atomic_or(&vdev->isr, value);
- }
- }
- static bool virtio_split_should_notify(VirtIODevice *vdev, VirtQueue *vq)
- {
- uint16_t old, new;
- bool v;
- /* We need to expose used array entries before checking used event. */
- smp_mb();
- /* Always notify when queue is empty (when feature acknowledge) */
- if (virtio_vdev_has_feature(vdev, VIRTIO_F_NOTIFY_ON_EMPTY) &&
- !vq->inuse && virtio_queue_empty(vq)) {
- return true;
- }
- if (!virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX)) {
- return !(vring_avail_flags(vq) & VRING_AVAIL_F_NO_INTERRUPT);
- }
- v = vq->signalled_used_valid;
- vq->signalled_used_valid = true;
- old = vq->signalled_used;
- new = vq->signalled_used = vq->used_idx;
- return !v || vring_need_event(vring_get_used_event(vq), new, old);
- }
- static bool vring_packed_need_event(VirtQueue *vq, bool wrap,
- uint16_t off_wrap, uint16_t new,
- uint16_t old)
- {
- int off = off_wrap & ~(1 << 15);
- if (wrap != off_wrap >> 15) {
- off -= vq->vring.num;
- }
- return vring_need_event(off, new, old);
- }
- static bool virtio_packed_should_notify(VirtIODevice *vdev, VirtQueue *vq)
- {
- VRingPackedDescEvent e;
- uint16_t old, new;
- bool v;
- VRingMemoryRegionCaches *caches;
- caches = vring_get_region_caches(vq);
- if (!caches) {
- return false;
- }
- vring_packed_event_read(vdev, &caches->avail, &e);
- old = vq->signalled_used;
- new = vq->signalled_used = vq->used_idx;
- v = vq->signalled_used_valid;
- vq->signalled_used_valid = true;
- if (e.flags == VRING_PACKED_EVENT_FLAG_DISABLE) {
- return false;
- } else if (e.flags == VRING_PACKED_EVENT_FLAG_ENABLE) {
- return true;
- }
- return !v || vring_packed_need_event(vq, vq->used_wrap_counter,
- e.off_wrap, new, old);
- }
- /* Called within rcu_read_lock(). */
- static bool virtio_should_notify(VirtIODevice *vdev, VirtQueue *vq)
- {
- if (virtio_vdev_has_feature(vdev, VIRTIO_F_RING_PACKED)) {
- return virtio_packed_should_notify(vdev, vq);
- } else {
- return virtio_split_should_notify(vdev, vq);
- }
- }
- void virtio_notify_irqfd(VirtIODevice *vdev, VirtQueue *vq)
- {
- WITH_RCU_READ_LOCK_GUARD() {
- if (!virtio_should_notify(vdev, vq)) {
- return;
- }
- }
- trace_virtio_notify_irqfd(vdev, vq);
- /*
- * virtio spec 1.0 says ISR bit 0 should be ignored with MSI, but
- * windows drivers included in virtio-win 1.8.0 (circa 2015) are
- * incorrectly polling this bit during crashdump and hibernation
- * in MSI mode, causing a hang if this bit is never updated.
- * Recent releases of Windows do not really shut down, but rather
- * log out and hibernate to make the next startup faster. Hence,
- * this manifested as a more serious hang during shutdown with
- *
- * Next driver release from 2016 fixed this problem, so working around it
- * is not a must, but it's easy to do so let's do it here.
- *
- * Note: it's safe to update ISR from any thread as it was switched
- * to an atomic operation.
- */
- virtio_set_isr(vq->vdev, 0x1);
- event_notifier_set(&vq->guest_notifier);
- }
- static void virtio_irq(VirtQueue *vq)
- {
- virtio_set_isr(vq->vdev, 0x1);
- virtio_notify_vector(vq->vdev, vq->vector);
- }
- void virtio_notify(VirtIODevice *vdev, VirtQueue *vq)
- {
- WITH_RCU_READ_LOCK_GUARD() {
- if (!virtio_should_notify(vdev, vq)) {
- return;
- }
- }
- trace_virtio_notify(vdev, vq);
- virtio_irq(vq);
- }
- void virtio_notify_config(VirtIODevice *vdev)
- {
- if (!(vdev->status & VIRTIO_CONFIG_S_DRIVER_OK))
- return;
- virtio_set_isr(vdev, 0x3);
- vdev->generation++;
- virtio_notify_vector(vdev, vdev->config_vector);
- }
- static bool virtio_device_endian_needed(void *opaque)
- {
- VirtIODevice *vdev = opaque;
- assert(vdev->device_endian != VIRTIO_DEVICE_ENDIAN_UNKNOWN);
- if (!virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
- return vdev->device_endian != virtio_default_endian();
- }
- /* Devices conforming to VIRTIO 1.0 or later are always LE. */
- return vdev->device_endian != VIRTIO_DEVICE_ENDIAN_LITTLE;
- }
- static bool virtio_64bit_features_needed(void *opaque)
- {
- VirtIODevice *vdev = opaque;
- return (vdev->host_features >> 32) != 0;
- }
- static bool virtio_virtqueue_needed(void *opaque)
- {
- VirtIODevice *vdev = opaque;
- return virtio_host_has_feature(vdev, VIRTIO_F_VERSION_1);
- }
- static bool virtio_packed_virtqueue_needed(void *opaque)
- {
- VirtIODevice *vdev = opaque;
- return virtio_host_has_feature(vdev, VIRTIO_F_RING_PACKED);
- }
- static bool virtio_ringsize_needed(void *opaque)
- {
- VirtIODevice *vdev = opaque;
- int i;
- for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
- if (vdev->vq[i].vring.num != vdev->vq[i].vring.num_default) {
- return true;
- }
- }
- return false;
- }
- static bool virtio_extra_state_needed(void *opaque)
- {
- VirtIODevice *vdev = opaque;
- BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
- VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
- return k->has_extra_state &&
- k->has_extra_state(qbus->parent);
- }
- static bool virtio_broken_needed(void *opaque)
- {
- VirtIODevice *vdev = opaque;
- return vdev->broken;
- }
- static bool virtio_started_needed(void *opaque)
- {
- VirtIODevice *vdev = opaque;
- return vdev->started;
- }
- static bool virtio_disabled_needed(void *opaque)
- {
- VirtIODevice *vdev = opaque;
- return vdev->disabled;
- }
- static const VMStateDescription vmstate_virtqueue = {
- .name = "virtqueue_state",
- .version_id = 1,
- .minimum_version_id = 1,
- .fields = (VMStateField[]) {
- VMSTATE_UINT64(vring.avail, struct VirtQueue),
- VMSTATE_UINT64(vring.used, struct VirtQueue),
- VMSTATE_END_OF_LIST()
- }
- };
- static const VMStateDescription vmstate_packed_virtqueue = {
- .name = "packed_virtqueue_state",
- .version_id = 1,
- .minimum_version_id = 1,
- .fields = (VMStateField[]) {
- VMSTATE_UINT16(last_avail_idx, struct VirtQueue),
- VMSTATE_BOOL(last_avail_wrap_counter, struct VirtQueue),
- VMSTATE_UINT16(used_idx, struct VirtQueue),
- VMSTATE_BOOL(used_wrap_counter, struct VirtQueue),
- VMSTATE_UINT32(inuse, struct VirtQueue),
- VMSTATE_END_OF_LIST()
- }
- };
- static const VMStateDescription vmstate_virtio_virtqueues = {
- .name = "virtio/virtqueues",
- .version_id = 1,
- .minimum_version_id = 1,
- .needed = &virtio_virtqueue_needed,
- .fields = (VMStateField[]) {
- VMSTATE_STRUCT_VARRAY_POINTER_KNOWN(vq, struct VirtIODevice,
- VIRTIO_QUEUE_MAX, 0, vmstate_virtqueue, VirtQueue),
- VMSTATE_END_OF_LIST()
- }
- };
- static const VMStateDescription vmstate_virtio_packed_virtqueues = {
- .name = "virtio/packed_virtqueues",
- .version_id = 1,
- .minimum_version_id = 1,
- .needed = &virtio_packed_virtqueue_needed,
- .fields = (VMStateField[]) {
- VMSTATE_STRUCT_VARRAY_POINTER_KNOWN(vq, struct VirtIODevice,
- VIRTIO_QUEUE_MAX, 0, vmstate_packed_virtqueue, VirtQueue),
- VMSTATE_END_OF_LIST()
- }
- };
- static const VMStateDescription vmstate_ringsize = {
- .name = "ringsize_state",
- .version_id = 1,
- .minimum_version_id = 1,
- .fields = (VMStateField[]) {
- VMSTATE_UINT32(vring.num_default, struct VirtQueue),
- VMSTATE_END_OF_LIST()
- }
- };
- static const VMStateDescription vmstate_virtio_ringsize = {
- .name = "virtio/ringsize",
- .version_id = 1,
- .minimum_version_id = 1,
- .needed = &virtio_ringsize_needed,
- .fields = (VMStateField[]) {
- VMSTATE_STRUCT_VARRAY_POINTER_KNOWN(vq, struct VirtIODevice,
- VIRTIO_QUEUE_MAX, 0, vmstate_ringsize, VirtQueue),
- VMSTATE_END_OF_LIST()
- }
- };
- static int get_extra_state(QEMUFile *f, void *pv, size_t size,
- const VMStateField *field)
- {
- VirtIODevice *vdev = pv;
- BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
- VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
- if (!k->load_extra_state) {
- return -1;
- } else {
- return k->load_extra_state(qbus->parent, f);
- }
- }
- static int put_extra_state(QEMUFile *f, void *pv, size_t size,
- const VMStateField *field, QJSON *vmdesc)
- {
- VirtIODevice *vdev = pv;
- BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
- VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
- k->save_extra_state(qbus->parent, f);
- return 0;
- }
- static const VMStateInfo vmstate_info_extra_state = {
- .name = "virtqueue_extra_state",
- .get = get_extra_state,
- .put = put_extra_state,
- };
- static const VMStateDescription vmstate_virtio_extra_state = {
- .name = "virtio/extra_state",
- .version_id = 1,
- .minimum_version_id = 1,
- .needed = &virtio_extra_state_needed,
- .fields = (VMStateField[]) {
- {
- .name = "extra_state",
- .version_id = 0,
- .field_exists = NULL,
- .size = 0,
- .info = &vmstate_info_extra_state,
- .flags = VMS_SINGLE,
- .offset = 0,
- },
- VMSTATE_END_OF_LIST()
- }
- };
- static const VMStateDescription vmstate_virtio_device_endian = {
- .name = "virtio/device_endian",
- .version_id = 1,
- .minimum_version_id = 1,
- .needed = &virtio_device_endian_needed,
- .fields = (VMStateField[]) {
- VMSTATE_UINT8(device_endian, VirtIODevice),
- VMSTATE_END_OF_LIST()
- }
- };
- static const VMStateDescription vmstate_virtio_64bit_features = {
- .name = "virtio/64bit_features",
- .version_id = 1,
- .minimum_version_id = 1,
- .needed = &virtio_64bit_features_needed,
- .fields = (VMStateField[]) {
- VMSTATE_UINT64(guest_features, VirtIODevice),
- VMSTATE_END_OF_LIST()
- }
- };
- static const VMStateDescription vmstate_virtio_broken = {
- .name = "virtio/broken",
- .version_id = 1,
- .minimum_version_id = 1,
- .needed = &virtio_broken_needed,
- .fields = (VMStateField[]) {
- VMSTATE_BOOL(broken, VirtIODevice),
- VMSTATE_END_OF_LIST()
- }
- };
- static const VMStateDescription vmstate_virtio_started = {
- .name = "virtio/started",
- .version_id = 1,
- .minimum_version_id = 1,
- .needed = &virtio_started_needed,
- .fields = (VMStateField[]) {
- VMSTATE_BOOL(started, VirtIODevice),
- VMSTATE_END_OF_LIST()
- }
- };
- static const VMStateDescription vmstate_virtio_disabled = {
- .name = "virtio/disabled",
- .version_id = 1,
- .minimum_version_id = 1,
- .needed = &virtio_disabled_needed,
- .fields = (VMStateField[]) {
- VMSTATE_BOOL(disabled, VirtIODevice),
- VMSTATE_END_OF_LIST()
- }
- };
- static const VMStateDescription vmstate_virtio = {
- .name = "virtio",
- .version_id = 1,
- .minimum_version_id = 1,
- .minimum_version_id_old = 1,
- .fields = (VMStateField[]) {
- VMSTATE_END_OF_LIST()
- },
- .subsections = (const VMStateDescription*[]) {
- &vmstate_virtio_device_endian,
- &vmstate_virtio_64bit_features,
- &vmstate_virtio_virtqueues,
- &vmstate_virtio_ringsize,
- &vmstate_virtio_broken,
- &vmstate_virtio_extra_state,
- &vmstate_virtio_started,
- &vmstate_virtio_packed_virtqueues,
- &vmstate_virtio_disabled,
- NULL
- }
- };
- int virtio_save(VirtIODevice *vdev, QEMUFile *f)
- {
- BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
- VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
- VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(vdev);
- uint32_t guest_features_lo = (vdev->guest_features & 0xffffffff);
- int i;
- if (k->save_config) {
- k->save_config(qbus->parent, f);
- }
- qemu_put_8s(f, &vdev->status);
- qemu_put_8s(f, &vdev->isr);
- qemu_put_be16s(f, &vdev->queue_sel);
- qemu_put_be32s(f, &guest_features_lo);
- qemu_put_be32(f, vdev->config_len);
- qemu_put_buffer(f, vdev->config, vdev->config_len);
- for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
- if (vdev->vq[i].vring.num == 0)
- break;
- }
- qemu_put_be32(f, i);
- for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
- if (vdev->vq[i].vring.num == 0)
- break;
- qemu_put_be32(f, vdev->vq[i].vring.num);
- if (k->has_variable_vring_alignment) {
- qemu_put_be32(f, vdev->vq[i].vring.align);
- }
- /*
- * Save desc now, the rest of the ring addresses are saved in
- * subsections for VIRTIO-1 devices.
- */
- qemu_put_be64(f, vdev->vq[i].vring.desc);
- qemu_put_be16s(f, &vdev->vq[i].last_avail_idx);
- if (k->save_queue) {
- k->save_queue(qbus->parent, i, f);
- }
- }
- if (vdc->save != NULL) {
- vdc->save(vdev, f);
- }
- if (vdc->vmsd) {
- int ret = vmstate_save_state(f, vdc->vmsd, vdev, NULL);
- if (ret) {
- return ret;
- }
- }
- /* Subsections */
- return vmstate_save_state(f, &vmstate_virtio, vdev, NULL);
- }
- /* A wrapper for use as a VMState .put function */
- static int virtio_device_put(QEMUFile *f, void *opaque, size_t size,
- const VMStateField *field, QJSON *vmdesc)
- {
- return virtio_save(VIRTIO_DEVICE(opaque), f);
- }
- /* A wrapper for use as a VMState .get function */
- static int virtio_device_get(QEMUFile *f, void *opaque, size_t size,
- const VMStateField *field)
- {
- VirtIODevice *vdev = VIRTIO_DEVICE(opaque);
- DeviceClass *dc = DEVICE_CLASS(VIRTIO_DEVICE_GET_CLASS(vdev));
- return virtio_load(vdev, f, dc->vmsd->version_id);
- }
- const VMStateInfo virtio_vmstate_info = {
- .name = "virtio",
- .get = virtio_device_get,
- .put = virtio_device_put,
- };
- static int virtio_set_features_nocheck(VirtIODevice *vdev, uint64_t val)
- {
- VirtioDeviceClass *k = VIRTIO_DEVICE_GET_CLASS(vdev);
- bool bad = (val & ~(vdev->host_features)) != 0;
- val &= vdev->host_features;
- if (k->set_features) {
- k->set_features(vdev, val);
- }
- vdev->guest_features = val;
- return bad ? -1 : 0;
- }
- int virtio_set_features(VirtIODevice *vdev, uint64_t val)
- {
- int ret;
- /*
- * The driver must not attempt to set features after feature negotiation
- * has finished.
- */
- if (vdev->status & VIRTIO_CONFIG_S_FEATURES_OK) {
- return -EINVAL;
- }
- ret = virtio_set_features_nocheck(vdev, val);
- if (!ret) {
- if (virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX)) {
- /* VIRTIO_RING_F_EVENT_IDX changes the size of the caches. */
- int i;
- for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
- if (vdev->vq[i].vring.num != 0) {
- virtio_init_region_cache(vdev, i);
- }
- }
- }
- if (!virtio_device_started(vdev, vdev->status) &&
- !virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
- vdev->start_on_kick = true;
- }
- }
- return ret;
- }
- size_t virtio_feature_get_config_size(VirtIOFeature *feature_sizes,
- uint64_t host_features)
- {
- size_t config_size = 0;
- int i;
- for (i = 0; feature_sizes[i].flags != 0; i++) {
- if (host_features & feature_sizes[i].flags) {
- config_size = MAX(feature_sizes[i].end, config_size);
- }
- }
- return config_size;
- }
- int virtio_load(VirtIODevice *vdev, QEMUFile *f, int version_id)
- {
- int i, ret;
- int32_t config_len;
- uint32_t num;
- uint32_t features;
- BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
- VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
- VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(vdev);
- /*
- * We poison the endianness to ensure it does not get used before
- * subsections have been loaded.
- */
- vdev->device_endian = VIRTIO_DEVICE_ENDIAN_UNKNOWN;
- if (k->load_config) {
- ret = k->load_config(qbus->parent, f);
- if (ret)
- return ret;
- }
- qemu_get_8s(f, &vdev->status);
- qemu_get_8s(f, &vdev->isr);
- qemu_get_be16s(f, &vdev->queue_sel);
- if (vdev->queue_sel >= VIRTIO_QUEUE_MAX) {
- return -1;
- }
- qemu_get_be32s(f, &features);
- /*
- * Temporarily set guest_features low bits - needed by
- * virtio net load code testing for VIRTIO_NET_F_CTRL_GUEST_OFFLOADS
- * VIRTIO_NET_F_GUEST_ANNOUNCE and VIRTIO_NET_F_CTRL_VQ.
- *
- * Note: devices should always test host features in future - don't create
- * new dependencies like this.
- */
- vdev->guest_features = features;
- config_len = qemu_get_be32(f);
- /*
- * There are cases where the incoming config can be bigger or smaller
- * than what we have; so load what we have space for, and skip
- * any excess that's in the stream.
- */
- qemu_get_buffer(f, vdev->config, MIN(config_len, vdev->config_len));
- while (config_len > vdev->config_len) {
- qemu_get_byte(f);
- config_len--;
- }
- num = qemu_get_be32(f);
- if (num > VIRTIO_QUEUE_MAX) {
- error_report("Invalid number of virtqueues: 0x%x", num);
- return -1;
- }
- for (i = 0; i < num; i++) {
- vdev->vq[i].vring.num = qemu_get_be32(f);
- if (k->has_variable_vring_alignment) {
- vdev->vq[i].vring.align = qemu_get_be32(f);
- }
- vdev->vq[i].vring.desc = qemu_get_be64(f);
- qemu_get_be16s(f, &vdev->vq[i].last_avail_idx);
- vdev->vq[i].signalled_used_valid = false;
- vdev->vq[i].notification = true;
- if (!vdev->vq[i].vring.desc && vdev->vq[i].last_avail_idx) {
- error_report("VQ %d address 0x0 "
- "inconsistent with Host index 0x%x",
- i, vdev->vq[i].last_avail_idx);
- return -1;
- }
- if (k->load_queue) {
- ret = k->load_queue(qbus->parent, i, f);
- if (ret)
- return ret;
- }
- }
- virtio_notify_vector(vdev, VIRTIO_NO_VECTOR);
- if (vdc->load != NULL) {
- ret = vdc->load(vdev, f, version_id);
- if (ret) {
- return ret;
- }
- }
- if (vdc->vmsd) {
- ret = vmstate_load_state(f, vdc->vmsd, vdev, version_id);
- if (ret) {
- return ret;
- }
- }
- /* Subsections */
- ret = vmstate_load_state(f, &vmstate_virtio, vdev, 1);
- if (ret) {
- return ret;
- }
- if (vdev->device_endian == VIRTIO_DEVICE_ENDIAN_UNKNOWN) {
- vdev->device_endian = virtio_default_endian();
- }
- if (virtio_64bit_features_needed(vdev)) {
- /*
- * Subsection load filled vdev->guest_features. Run them
- * through virtio_set_features to sanity-check them against
- * host_features.
- */
- uint64_t features64 = vdev->guest_features;
- if (virtio_set_features_nocheck(vdev, features64) < 0) {
- error_report("Features 0x%" PRIx64 " unsupported. "
- "Allowed features: 0x%" PRIx64,
- features64, vdev->host_features);
- return -1;
- }
- } else {
- if (virtio_set_features_nocheck(vdev, features) < 0) {
- error_report("Features 0x%x unsupported. "
- "Allowed features: 0x%" PRIx64,
- features, vdev->host_features);
- return -1;
- }
- }
- if (!virtio_device_started(vdev, vdev->status) &&
- !virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
- vdev->start_on_kick = true;
- }
- RCU_READ_LOCK_GUARD();
- for (i = 0; i < num; i++) {
- if (vdev->vq[i].vring.desc) {
- uint16_t nheads;
- /*
- * VIRTIO-1 devices migrate desc, used, and avail ring addresses so
- * only the region cache needs to be set up. Legacy devices need
- * to calculate used and avail ring addresses based on the desc
- * address.
- */
- if (virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
- virtio_init_region_cache(vdev, i);
- } else {
- virtio_queue_update_rings(vdev, i);
- }
- if (virtio_vdev_has_feature(vdev, VIRTIO_F_RING_PACKED)) {
- vdev->vq[i].shadow_avail_idx = vdev->vq[i].last_avail_idx;
- vdev->vq[i].shadow_avail_wrap_counter =
- vdev->vq[i].last_avail_wrap_counter;
- continue;
- }
- nheads = vring_avail_idx(&vdev->vq[i]) - vdev->vq[i].last_avail_idx;
- /* Check it isn't doing strange things with descriptor numbers. */
- if (nheads > vdev->vq[i].vring.num) {
- error_report("VQ %d size 0x%x Guest index 0x%x "
- "inconsistent with Host index 0x%x: delta 0x%x",
- i, vdev->vq[i].vring.num,
- vring_avail_idx(&vdev->vq[i]),
- vdev->vq[i].last_avail_idx, nheads);
- return -1;
- }
- vdev->vq[i].used_idx = vring_used_idx(&vdev->vq[i]);
- vdev->vq[i].shadow_avail_idx = vring_avail_idx(&vdev->vq[i]);
- /*
- * Some devices migrate VirtQueueElements that have been popped
- * from the avail ring but not yet returned to the used ring.
- * Since max ring size < UINT16_MAX it's safe to use modulo
- * UINT16_MAX + 1 subtraction.
- */
- vdev->vq[i].inuse = (uint16_t)(vdev->vq[i].last_avail_idx -
- vdev->vq[i].used_idx);
- if (vdev->vq[i].inuse > vdev->vq[i].vring.num) {
- error_report("VQ %d size 0x%x < last_avail_idx 0x%x - "
- "used_idx 0x%x",
- i, vdev->vq[i].vring.num,
- vdev->vq[i].last_avail_idx,
- vdev->vq[i].used_idx);
- return -1;
- }
- }
- }
- if (vdc->post_load) {
- ret = vdc->post_load(vdev);
- if (ret) {
- return ret;
- }
- }
- return 0;
- }
- void virtio_cleanup(VirtIODevice *vdev)
- {
- qemu_del_vm_change_state_handler(vdev->vmstate);
- }
- static void virtio_vmstate_change(void *opaque, int running, RunState state)
- {
- VirtIODevice *vdev = opaque;
- BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
- VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
- bool backend_run = running && virtio_device_started(vdev, vdev->status);
- vdev->vm_running = running;
- if (backend_run) {
- virtio_set_status(vdev, vdev->status);
- }
- if (k->vmstate_change) {
- k->vmstate_change(qbus->parent, backend_run);
- }
- if (!backend_run) {
- virtio_set_status(vdev, vdev->status);
- }
- }
- void virtio_instance_init_common(Object *proxy_obj, void *data,
- size_t vdev_size, const char *vdev_name)
- {
- DeviceState *vdev = data;
- object_initialize_child_with_props(proxy_obj, "virtio-backend", vdev,
- vdev_size, vdev_name, &error_abort,
- NULL);
- qdev_alias_all_properties(vdev, proxy_obj);
- }
- void virtio_init(VirtIODevice *vdev, const char *name,
- uint16_t device_id, size_t config_size)
- {
- BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
- VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
- int i;
- int nvectors = k->query_nvectors ? k->query_nvectors(qbus->parent) : 0;
- if (nvectors) {
- vdev->vector_queues =
- g_malloc0(sizeof(*vdev->vector_queues) * nvectors);
- }
- vdev->start_on_kick = false;
- vdev->started = false;
- vdev->device_id = device_id;
- vdev->status = 0;
- atomic_set(&vdev->isr, 0);
- vdev->queue_sel = 0;
- vdev->config_vector = VIRTIO_NO_VECTOR;
- vdev->vq = g_malloc0(sizeof(VirtQueue) * VIRTIO_QUEUE_MAX);
- vdev->vm_running = runstate_is_running();
- vdev->broken = false;
- for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
- vdev->vq[i].vector = VIRTIO_NO_VECTOR;
- vdev->vq[i].vdev = vdev;
- vdev->vq[i].queue_index = i;
- vdev->vq[i].host_notifier_enabled = false;
- }
- vdev->name = name;
- vdev->config_len = config_size;
- if (vdev->config_len) {
- vdev->config = g_malloc0(config_size);
- } else {
- vdev->config = NULL;
- }
- vdev->vmstate = qdev_add_vm_change_state_handler(DEVICE(vdev),
- virtio_vmstate_change, vdev);
- vdev->device_endian = virtio_default_endian();
- vdev->use_guest_notifier_mask = true;
- }
- /*
- * Only devices that have already been around prior to defining the virtio
- * standard support legacy mode; this includes devices not specified in the
- * standard. All newer devices conform to the virtio standard only.
- */
- bool virtio_legacy_allowed(VirtIODevice *vdev)
- {
- switch (vdev->device_id) {
- case VIRTIO_ID_NET:
- case VIRTIO_ID_BLOCK:
- case VIRTIO_ID_CONSOLE:
- case VIRTIO_ID_RNG:
- case VIRTIO_ID_BALLOON:
- case VIRTIO_ID_RPMSG:
- case VIRTIO_ID_SCSI:
- case VIRTIO_ID_9P:
- case VIRTIO_ID_RPROC_SERIAL:
- case VIRTIO_ID_CAIF:
- return true;
- default:
- return false;
- }
- }
- hwaddr virtio_queue_get_desc_addr(VirtIODevice *vdev, int n)
- {
- return vdev->vq[n].vring.desc;
- }
- bool virtio_queue_enabled_legacy(VirtIODevice *vdev, int n)
- {
- return virtio_queue_get_desc_addr(vdev, n) != 0;
- }
- bool virtio_queue_enabled(VirtIODevice *vdev, int n)
- {
- BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
- VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
- if (k->queue_enabled) {
- return k->queue_enabled(qbus->parent, n);
- }
- return virtio_queue_enabled_legacy(vdev, n);
- }
- hwaddr virtio_queue_get_avail_addr(VirtIODevice *vdev, int n)
- {
- return vdev->vq[n].vring.avail;
- }
- hwaddr virtio_queue_get_used_addr(VirtIODevice *vdev, int n)
- {
- return vdev->vq[n].vring.used;
- }
- hwaddr virtio_queue_get_desc_size(VirtIODevice *vdev, int n)
- {
- return sizeof(VRingDesc) * vdev->vq[n].vring.num;
- }
- hwaddr virtio_queue_get_avail_size(VirtIODevice *vdev, int n)
- {
- int s;
- if (virtio_vdev_has_feature(vdev, VIRTIO_F_RING_PACKED)) {
- return sizeof(struct VRingPackedDescEvent);
- }
- s = virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX) ? 2 : 0;
- return offsetof(VRingAvail, ring) +
- sizeof(uint16_t) * vdev->vq[n].vring.num + s;
- }
- hwaddr virtio_queue_get_used_size(VirtIODevice *vdev, int n)
- {
- int s;
- if (virtio_vdev_has_feature(vdev, VIRTIO_F_RING_PACKED)) {
- return sizeof(struct VRingPackedDescEvent);
- }
- s = virtio_vdev_has_feature(vdev, VIRTIO_RING_F_EVENT_IDX) ? 2 : 0;
- return offsetof(VRingUsed, ring) +
- sizeof(VRingUsedElem) * vdev->vq[n].vring.num + s;
- }
- static unsigned int virtio_queue_packed_get_last_avail_idx(VirtIODevice *vdev,
- int n)
- {
- unsigned int avail, used;
- avail = vdev->vq[n].last_avail_idx;
- avail |= ((uint16_t)vdev->vq[n].last_avail_wrap_counter) << 15;
- used = vdev->vq[n].used_idx;
- used |= ((uint16_t)vdev->vq[n].used_wrap_counter) << 15;
- return avail | used << 16;
- }
- static uint16_t virtio_queue_split_get_last_avail_idx(VirtIODevice *vdev,
- int n)
- {
- return vdev->vq[n].last_avail_idx;
- }
- unsigned int virtio_queue_get_last_avail_idx(VirtIODevice *vdev, int n)
- {
- if (virtio_vdev_has_feature(vdev, VIRTIO_F_RING_PACKED)) {
- return virtio_queue_packed_get_last_avail_idx(vdev, n);
- } else {
- return virtio_queue_split_get_last_avail_idx(vdev, n);
- }
- }
- static void virtio_queue_packed_set_last_avail_idx(VirtIODevice *vdev,
- int n, unsigned int idx)
- {
- struct VirtQueue *vq = &vdev->vq[n];
- vq->last_avail_idx = vq->shadow_avail_idx = idx & 0x7fff;
- vq->last_avail_wrap_counter =
- vq->shadow_avail_wrap_counter = !!(idx & 0x8000);
- idx >>= 16;
- vq->used_idx = idx & 0x7ffff;
- vq->used_wrap_counter = !!(idx & 0x8000);
- }
- static void virtio_queue_split_set_last_avail_idx(VirtIODevice *vdev,
- int n, unsigned int idx)
- {
- vdev->vq[n].last_avail_idx = idx;
- vdev->vq[n].shadow_avail_idx = idx;
- }
- void virtio_queue_set_last_avail_idx(VirtIODevice *vdev, int n,
- unsigned int idx)
- {
- if (virtio_vdev_has_feature(vdev, VIRTIO_F_RING_PACKED)) {
- virtio_queue_packed_set_last_avail_idx(vdev, n, idx);
- } else {
- virtio_queue_split_set_last_avail_idx(vdev, n, idx);
- }
- }
- static void virtio_queue_packed_restore_last_avail_idx(VirtIODevice *vdev,
- int n)
- {
- /* We don't have a reference like avail idx in shared memory */
- return;
- }
- static void virtio_queue_split_restore_last_avail_idx(VirtIODevice *vdev,
- int n)
- {
- RCU_READ_LOCK_GUARD();
- if (vdev->vq[n].vring.desc) {
- vdev->vq[n].last_avail_idx = vring_used_idx(&vdev->vq[n]);
- vdev->vq[n].shadow_avail_idx = vdev->vq[n].last_avail_idx;
- }
- }
- void virtio_queue_restore_last_avail_idx(VirtIODevice *vdev, int n)
- {
- if (virtio_vdev_has_feature(vdev, VIRTIO_F_RING_PACKED)) {
- virtio_queue_packed_restore_last_avail_idx(vdev, n);
- } else {
- virtio_queue_split_restore_last_avail_idx(vdev, n);
- }
- }
- static void virtio_queue_packed_update_used_idx(VirtIODevice *vdev, int n)
- {
- /* used idx was updated through set_last_avail_idx() */
- return;
- }
- static void virtio_split_packed_update_used_idx(VirtIODevice *vdev, int n)
- {
- RCU_READ_LOCK_GUARD();
- if (vdev->vq[n].vring.desc) {
- vdev->vq[n].used_idx = vring_used_idx(&vdev->vq[n]);
- }
- }
- void virtio_queue_update_used_idx(VirtIODevice *vdev, int n)
- {
- if (virtio_vdev_has_feature(vdev, VIRTIO_F_RING_PACKED)) {
- return virtio_queue_packed_update_used_idx(vdev, n);
- } else {
- return virtio_split_packed_update_used_idx(vdev, n);
- }
- }
- void virtio_queue_invalidate_signalled_used(VirtIODevice *vdev, int n)
- {
- vdev->vq[n].signalled_used_valid = false;
- }
- VirtQueue *virtio_get_queue(VirtIODevice *vdev, int n)
- {
- return vdev->vq + n;
- }
- uint16_t virtio_get_queue_index(VirtQueue *vq)
- {
- return vq->queue_index;
- }
- static void virtio_queue_guest_notifier_read(EventNotifier *n)
- {
- VirtQueue *vq = container_of(n, VirtQueue, guest_notifier);
- if (event_notifier_test_and_clear(n)) {
- virtio_irq(vq);
- }
- }
- void virtio_queue_set_guest_notifier_fd_handler(VirtQueue *vq, bool assign,
- bool with_irqfd)
- {
- if (assign && !with_irqfd) {
- event_notifier_set_handler(&vq->guest_notifier,
- virtio_queue_guest_notifier_read);
- } else {
- event_notifier_set_handler(&vq->guest_notifier, NULL);
- }
- if (!assign) {
- /* Test and clear notifier before closing it,
- * in case poll callback didn't have time to run. */
- virtio_queue_guest_notifier_read(&vq->guest_notifier);
- }
- }
- EventNotifier *virtio_queue_get_guest_notifier(VirtQueue *vq)
- {
- return &vq->guest_notifier;
- }
- static void virtio_queue_host_notifier_aio_read(EventNotifier *n)
- {
- VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
- if (event_notifier_test_and_clear(n)) {
- virtio_queue_notify_aio_vq(vq);
- }
- }
- static void virtio_queue_host_notifier_aio_poll_begin(EventNotifier *n)
- {
- VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
- virtio_queue_set_notification(vq, 0);
- }
- static bool virtio_queue_host_notifier_aio_poll(void *opaque)
- {
- EventNotifier *n = opaque;
- VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
- if (!vq->vring.desc || virtio_queue_empty(vq)) {
- return false;
- }
- return virtio_queue_notify_aio_vq(vq);
- }
- static void virtio_queue_host_notifier_aio_poll_end(EventNotifier *n)
- {
- VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
- /* Caller polls once more after this to catch requests that race with us */
- virtio_queue_set_notification(vq, 1);
- }
- void virtio_queue_aio_set_host_notifier_handler(VirtQueue *vq, AioContext *ctx,
- VirtIOHandleAIOOutput handle_output)
- {
- if (handle_output) {
- vq->handle_aio_output = handle_output;
- aio_set_event_notifier(ctx, &vq->host_notifier, true,
- virtio_queue_host_notifier_aio_read,
- virtio_queue_host_notifier_aio_poll);
- aio_set_event_notifier_poll(ctx, &vq->host_notifier,
- virtio_queue_host_notifier_aio_poll_begin,
- virtio_queue_host_notifier_aio_poll_end);
- } else {
- aio_set_event_notifier(ctx, &vq->host_notifier, true, NULL, NULL);
- /* Test and clear notifier before after disabling event,
- * in case poll callback didn't have time to run. */
- virtio_queue_host_notifier_aio_read(&vq->host_notifier);
- vq->handle_aio_output = NULL;
- }
- }
- void virtio_queue_host_notifier_read(EventNotifier *n)
- {
- VirtQueue *vq = container_of(n, VirtQueue, host_notifier);
- if (event_notifier_test_and_clear(n)) {
- virtio_queue_notify_vq(vq);
- }
- }
- EventNotifier *virtio_queue_get_host_notifier(VirtQueue *vq)
- {
- return &vq->host_notifier;
- }
- void virtio_queue_set_host_notifier_enabled(VirtQueue *vq, bool enabled)
- {
- vq->host_notifier_enabled = enabled;
- }
- int virtio_queue_set_host_notifier_mr(VirtIODevice *vdev, int n,
- MemoryRegion *mr, bool assign)
- {
- BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
- VirtioBusClass *k = VIRTIO_BUS_GET_CLASS(qbus);
- if (k->set_host_notifier_mr) {
- return k->set_host_notifier_mr(qbus->parent, n, mr, assign);
- }
- return -1;
- }
- void virtio_device_set_child_bus_name(VirtIODevice *vdev, char *bus_name)
- {
- g_free(vdev->bus_name);
- vdev->bus_name = g_strdup(bus_name);
- }
- void GCC_FMT_ATTR(2, 3) virtio_error(VirtIODevice *vdev, const char *fmt, ...)
- {
- va_list ap;
- va_start(ap, fmt);
- error_vreport(fmt, ap);
- va_end(ap);
- if (virtio_vdev_has_feature(vdev, VIRTIO_F_VERSION_1)) {
- vdev->status = vdev->status | VIRTIO_CONFIG_S_NEEDS_RESET;
- virtio_notify_config(vdev);
- }
- vdev->broken = true;
- }
- static void virtio_memory_listener_commit(MemoryListener *listener)
- {
- VirtIODevice *vdev = container_of(listener, VirtIODevice, listener);
- int i;
- for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
- if (vdev->vq[i].vring.num == 0) {
- break;
- }
- virtio_init_region_cache(vdev, i);
- }
- }
- static void virtio_device_realize(DeviceState *dev, Error **errp)
- {
- VirtIODevice *vdev = VIRTIO_DEVICE(dev);
- VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(dev);
- Error *err = NULL;
- /* Devices should either use vmsd or the load/save methods */
- assert(!vdc->vmsd || !vdc->load);
- if (vdc->realize != NULL) {
- vdc->realize(dev, &err);
- if (err != NULL) {
- error_propagate(errp, err);
- return;
- }
- }
- virtio_bus_device_plugged(vdev, &err);
- if (err != NULL) {
- error_propagate(errp, err);
- vdc->unrealize(dev);
- return;
- }
- vdev->listener.commit = virtio_memory_listener_commit;
- memory_listener_register(&vdev->listener, vdev->dma_as);
- }
- static void virtio_device_unrealize(DeviceState *dev)
- {
- VirtIODevice *vdev = VIRTIO_DEVICE(dev);
- VirtioDeviceClass *vdc = VIRTIO_DEVICE_GET_CLASS(dev);
- virtio_bus_device_unplugged(vdev);
- if (vdc->unrealize != NULL) {
- vdc->unrealize(dev);
- }
- g_free(vdev->bus_name);
- vdev->bus_name = NULL;
- }
- static void virtio_device_free_virtqueues(VirtIODevice *vdev)
- {
- int i;
- if (!vdev->vq) {
- return;
- }
- for (i = 0; i < VIRTIO_QUEUE_MAX; i++) {
- if (vdev->vq[i].vring.num == 0) {
- break;
- }
- virtio_virtqueue_reset_region_cache(&vdev->vq[i]);
- }
- g_free(vdev->vq);
- }
- static void virtio_device_instance_finalize(Object *obj)
- {
- VirtIODevice *vdev = VIRTIO_DEVICE(obj);
- memory_listener_unregister(&vdev->listener);
- virtio_device_free_virtqueues(vdev);
- g_free(vdev->config);
- g_free(vdev->vector_queues);
- }
- static Property virtio_properties[] = {
- DEFINE_VIRTIO_COMMON_FEATURES(VirtIODevice, host_features),
- DEFINE_PROP_BOOL("use-started", VirtIODevice, use_started, true),
- DEFINE_PROP_BOOL("use-disabled-flag", VirtIODevice, use_disabled_flag, true),
- DEFINE_PROP_END_OF_LIST(),
- };
- static int virtio_device_start_ioeventfd_impl(VirtIODevice *vdev)
- {
- VirtioBusState *qbus = VIRTIO_BUS(qdev_get_parent_bus(DEVICE(vdev)));
- int i, n, r, err;
- memory_region_transaction_begin();
- for (n = 0; n < VIRTIO_QUEUE_MAX; n++) {
- VirtQueue *vq = &vdev->vq[n];
- if (!virtio_queue_get_num(vdev, n)) {
- continue;
- }
- r = virtio_bus_set_host_notifier(qbus, n, true);
- if (r < 0) {
- err = r;
- goto assign_error;
- }
- event_notifier_set_handler(&vq->host_notifier,
- virtio_queue_host_notifier_read);
- }
- for (n = 0; n < VIRTIO_QUEUE_MAX; n++) {
- /* Kick right away to begin processing requests already in vring */
- VirtQueue *vq = &vdev->vq[n];
- if (!vq->vring.num) {
- continue;
- }
- event_notifier_set(&vq->host_notifier);
- }
- memory_region_transaction_commit();
- return 0;
- assign_error:
- i = n; /* save n for a second iteration after transaction is committed. */
- while (--n >= 0) {
- VirtQueue *vq = &vdev->vq[n];
- if (!virtio_queue_get_num(vdev, n)) {
- continue;
- }
- event_notifier_set_handler(&vq->host_notifier, NULL);
- r = virtio_bus_set_host_notifier(qbus, n, false);
- assert(r >= 0);
- }
- memory_region_transaction_commit();
- while (--i >= 0) {
- if (!virtio_queue_get_num(vdev, i)) {
- continue;
- }
- virtio_bus_cleanup_host_notifier(qbus, i);
- }
- return err;
- }
- int virtio_device_start_ioeventfd(VirtIODevice *vdev)
- {
- BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
- VirtioBusState *vbus = VIRTIO_BUS(qbus);
- return virtio_bus_start_ioeventfd(vbus);
- }
- static void virtio_device_stop_ioeventfd_impl(VirtIODevice *vdev)
- {
- VirtioBusState *qbus = VIRTIO_BUS(qdev_get_parent_bus(DEVICE(vdev)));
- int n, r;
- memory_region_transaction_begin();
- for (n = 0; n < VIRTIO_QUEUE_MAX; n++) {
- VirtQueue *vq = &vdev->vq[n];
- if (!virtio_queue_get_num(vdev, n)) {
- continue;
- }
- event_notifier_set_handler(&vq->host_notifier, NULL);
- r = virtio_bus_set_host_notifier(qbus, n, false);
- assert(r >= 0);
- }
- memory_region_transaction_commit();
- for (n = 0; n < VIRTIO_QUEUE_MAX; n++) {
- if (!virtio_queue_get_num(vdev, n)) {
- continue;
- }
- virtio_bus_cleanup_host_notifier(qbus, n);
- }
- }
- int virtio_device_grab_ioeventfd(VirtIODevice *vdev)
- {
- BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
- VirtioBusState *vbus = VIRTIO_BUS(qbus);
- return virtio_bus_grab_ioeventfd(vbus);
- }
- void virtio_device_release_ioeventfd(VirtIODevice *vdev)
- {
- BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
- VirtioBusState *vbus = VIRTIO_BUS(qbus);
- virtio_bus_release_ioeventfd(vbus);
- }
- static void virtio_device_class_init(ObjectClass *klass, void *data)
- {
- /* Set the default value here. */
- VirtioDeviceClass *vdc = VIRTIO_DEVICE_CLASS(klass);
- DeviceClass *dc = DEVICE_CLASS(klass);
- dc->realize = virtio_device_realize;
- dc->unrealize = virtio_device_unrealize;
- dc->bus_type = TYPE_VIRTIO_BUS;
- device_class_set_props(dc, virtio_properties);
- vdc->start_ioeventfd = virtio_device_start_ioeventfd_impl;
- vdc->stop_ioeventfd = virtio_device_stop_ioeventfd_impl;
- vdc->legacy_features |= VIRTIO_LEGACY_FEATURES;
- }
- bool virtio_device_ioeventfd_enabled(VirtIODevice *vdev)
- {
- BusState *qbus = qdev_get_parent_bus(DEVICE(vdev));
- VirtioBusState *vbus = VIRTIO_BUS(qbus);
- return virtio_bus_ioeventfd_enabled(vbus);
- }
- static const TypeInfo virtio_device_info = {
- .name = TYPE_VIRTIO_DEVICE,
- .parent = TYPE_DEVICE,
- .instance_size = sizeof(VirtIODevice),
- .class_init = virtio_device_class_init,
- .instance_finalize = virtio_device_instance_finalize,
- .abstract = true,
- .class_size = sizeof(VirtioDeviceClass),
- };
- static void virtio_register_types(void)
- {
- type_register_static(&virtio_device_info);
- }
- type_init(virtio_register_types)
|