| 12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486 |
- // SPDX-License-Identifier: GPL-2.0-only
- /*
- * VDUSE: vDPA Device in Userspace
- *
- * Copyright (C) 2020-2021 Bytedance Inc. and/or its affiliates. All rights reserved.
- *
- * Author: Xie Yongji <xieyongji@bytedance.com>
- *
- */
- #include "linux/virtio_net.h"
- #include <linux/cleanup.h>
- #include <linux/init.h>
- #include <linux/module.h>
- #include <linux/cdev.h>
- #include <linux/device.h>
- #include <linux/eventfd.h>
- #include <linux/slab.h>
- #include <linux/wait.h>
- #include <linux/dma-map-ops.h>
- #include <linux/poll.h>
- #include <linux/file.h>
- #include <linux/uio.h>
- #include <linux/vdpa.h>
- #include <linux/nospec.h>
- #include <linux/virtio.h>
- #include <linux/vmalloc.h>
- #include <linux/sched/mm.h>
- #include <uapi/linux/vduse.h>
- #include <uapi/linux/vdpa.h>
- #include <uapi/linux/virtio_config.h>
- #include <uapi/linux/virtio_ids.h>
- #include <uapi/linux/virtio_blk.h>
- #include <uapi/linux/virtio_ring.h>
- #include <linux/mod_devicetable.h>
- #include "iova_domain.h"
- #define DRV_AUTHOR "Yongji Xie <xieyongji@bytedance.com>"
- #define DRV_DESC "vDPA Device in Userspace"
- #define DRV_LICENSE "GPL v2"
- #define VDUSE_DEV_MAX (1U << MINORBITS)
- #define VDUSE_DEV_MAX_GROUPS 0xffff
- #define VDUSE_DEV_MAX_AS 0xffff
- #define VDUSE_MAX_BOUNCE_SIZE (1024 * 1024 * 1024)
- #define VDUSE_MIN_BOUNCE_SIZE (1024 * 1024)
- #define VDUSE_BOUNCE_SIZE (64 * 1024 * 1024)
- /* 128 MB reserved for virtqueue creation */
- #define VDUSE_IOVA_SIZE (VDUSE_MAX_BOUNCE_SIZE + 128 * 1024 * 1024)
- #define VDUSE_MSG_DEFAULT_TIMEOUT 30
- #define IRQ_UNBOUND -1
- /*
- * VDUSE instance have not asked the vduse API version, so assume 0.
- *
- * Old devices may not ask for the device version and assume it is 0. Keep
- * this value for these. From the moment the VDUSE instance ask for the
- * version, convert to the latests supported one and continue regular flow
- */
- #define VDUSE_API_VERSION_NOT_ASKED U64_MAX
- struct vduse_virtqueue {
- u16 index;
- u16 num_max;
- u32 num;
- u64 desc_addr;
- u64 driver_addr;
- u64 device_addr;
- struct vdpa_vq_state state;
- bool ready;
- bool kicked;
- u32 group;
- spinlock_t kick_lock;
- spinlock_t irq_lock;
- struct eventfd_ctx *kickfd;
- struct vdpa_callback cb;
- struct work_struct inject;
- struct work_struct kick;
- int irq_effective_cpu;
- struct cpumask irq_affinity;
- struct kobject kobj;
- };
- struct vduse_dev;
- struct vduse_vdpa {
- struct vdpa_device vdpa;
- struct vduse_dev *dev;
- };
- struct vduse_umem {
- unsigned long iova;
- unsigned long npages;
- struct page **pages;
- struct mm_struct *mm;
- };
- struct vduse_as {
- struct vduse_iova_domain *domain;
- struct vduse_umem *umem;
- struct mutex mem_lock;
- };
- struct vduse_vq_group {
- rwlock_t as_lock;
- struct vduse_as *as; /* Protected by as_lock */
- struct vduse_dev *dev;
- };
- struct vduse_dev {
- struct vduse_vdpa *vdev;
- struct device *dev;
- struct vduse_virtqueue **vqs;
- struct vduse_as *as;
- char *name;
- struct mutex lock;
- spinlock_t msg_lock;
- u64 msg_unique;
- u32 msg_timeout;
- wait_queue_head_t waitq;
- struct list_head send_list;
- struct list_head recv_list;
- struct vdpa_callback config_cb;
- struct work_struct inject;
- spinlock_t irq_lock;
- struct rw_semaphore rwsem;
- int minor;
- bool broken;
- bool connected;
- u64 api_version;
- u64 device_features;
- u64 driver_features;
- u32 device_id;
- u32 vendor_id;
- u32 generation;
- u32 config_size;
- void *config;
- u8 status;
- u32 vq_num;
- u32 vq_align;
- u32 ngroups;
- u32 nas;
- struct vduse_vq_group *groups;
- unsigned int bounce_size;
- struct mutex domain_lock;
- };
- struct vduse_dev_msg {
- struct vduse_dev_request req;
- struct vduse_dev_response resp;
- struct list_head list;
- wait_queue_head_t waitq;
- bool completed;
- };
- struct vduse_control {
- u64 api_version;
- };
- static DEFINE_MUTEX(vduse_lock);
- static DEFINE_IDR(vduse_idr);
- static dev_t vduse_major;
- static struct cdev vduse_ctrl_cdev;
- static struct cdev vduse_cdev;
- static struct workqueue_struct *vduse_irq_wq;
- static struct workqueue_struct *vduse_irq_bound_wq;
- static u32 allowed_device_id[] = {
- VIRTIO_ID_BLOCK,
- VIRTIO_ID_NET,
- VIRTIO_ID_FS,
- };
- static inline struct vduse_dev *vdpa_to_vduse(struct vdpa_device *vdpa)
- {
- struct vduse_vdpa *vdev = container_of(vdpa, struct vduse_vdpa, vdpa);
- return vdev->dev;
- }
- static inline struct vduse_dev *dev_to_vduse(struct device *dev)
- {
- struct vdpa_device *vdpa = dev_to_vdpa(dev);
- return vdpa_to_vduse(vdpa);
- }
- static struct vduse_dev_msg *vduse_find_msg(struct list_head *head,
- uint32_t request_id)
- {
- struct vduse_dev_msg *msg;
- list_for_each_entry(msg, head, list) {
- if (msg->req.request_id == request_id) {
- list_del(&msg->list);
- return msg;
- }
- }
- return NULL;
- }
- static struct vduse_dev_msg *vduse_dequeue_msg(struct list_head *head)
- {
- struct vduse_dev_msg *msg = NULL;
- if (!list_empty(head)) {
- msg = list_first_entry(head, struct vduse_dev_msg, list);
- list_del(&msg->list);
- }
- return msg;
- }
- static void vduse_enqueue_msg(struct list_head *head,
- struct vduse_dev_msg *msg)
- {
- list_add_tail(&msg->list, head);
- }
- static void vduse_dev_broken(struct vduse_dev *dev)
- {
- struct vduse_dev_msg *msg, *tmp;
- if (unlikely(dev->broken))
- return;
- list_splice_init(&dev->recv_list, &dev->send_list);
- list_for_each_entry_safe(msg, tmp, &dev->send_list, list) {
- list_del(&msg->list);
- msg->completed = 1;
- msg->resp.result = VDUSE_REQ_RESULT_FAILED;
- wake_up(&msg->waitq);
- }
- dev->broken = true;
- wake_up(&dev->waitq);
- }
- static int vduse_dev_msg_sync(struct vduse_dev *dev,
- struct vduse_dev_msg *msg)
- {
- int ret;
- if (unlikely(dev->broken))
- return -EIO;
- init_waitqueue_head(&msg->waitq);
- spin_lock(&dev->msg_lock);
- if (unlikely(dev->broken)) {
- spin_unlock(&dev->msg_lock);
- return -EIO;
- }
- msg->req.request_id = dev->msg_unique++;
- vduse_enqueue_msg(&dev->send_list, msg);
- wake_up(&dev->waitq);
- spin_unlock(&dev->msg_lock);
- if (dev->msg_timeout)
- ret = wait_event_killable_timeout(msg->waitq, msg->completed,
- (long)dev->msg_timeout * HZ);
- else
- ret = wait_event_killable(msg->waitq, msg->completed);
- spin_lock(&dev->msg_lock);
- if (!msg->completed) {
- list_del(&msg->list);
- msg->resp.result = VDUSE_REQ_RESULT_FAILED;
- /* Mark the device as malfunction when there is a timeout */
- if (!ret)
- vduse_dev_broken(dev);
- }
- ret = (msg->resp.result == VDUSE_REQ_RESULT_OK) ? 0 : -EIO;
- spin_unlock(&dev->msg_lock);
- return ret;
- }
- static int vduse_dev_get_vq_state_packed(struct vduse_dev *dev,
- struct vduse_virtqueue *vq,
- struct vdpa_vq_state_packed *packed)
- {
- struct vduse_dev_msg msg = { 0 };
- int ret;
- msg.req.type = VDUSE_GET_VQ_STATE;
- msg.req.vq_state.index = vq->index;
- ret = vduse_dev_msg_sync(dev, &msg);
- if (ret)
- return ret;
- packed->last_avail_counter =
- msg.resp.vq_state.packed.last_avail_counter & 0x0001;
- packed->last_avail_idx =
- msg.resp.vq_state.packed.last_avail_idx & 0x7FFF;
- packed->last_used_counter =
- msg.resp.vq_state.packed.last_used_counter & 0x0001;
- packed->last_used_idx =
- msg.resp.vq_state.packed.last_used_idx & 0x7FFF;
- return 0;
- }
- static int vduse_dev_get_vq_state_split(struct vduse_dev *dev,
- struct vduse_virtqueue *vq,
- struct vdpa_vq_state_split *split)
- {
- struct vduse_dev_msg msg = { 0 };
- int ret;
- msg.req.type = VDUSE_GET_VQ_STATE;
- msg.req.vq_state.index = vq->index;
- ret = vduse_dev_msg_sync(dev, &msg);
- if (ret)
- return ret;
- split->avail_index = msg.resp.vq_state.split.avail_index;
- return 0;
- }
- static int vduse_dev_set_status(struct vduse_dev *dev, u8 status)
- {
- struct vduse_dev_msg msg = { 0 };
- msg.req.type = VDUSE_SET_STATUS;
- msg.req.s.status = status;
- return vduse_dev_msg_sync(dev, &msg);
- }
- static int vduse_dev_update_iotlb(struct vduse_dev *dev, u32 asid,
- u64 start, u64 last)
- {
- struct vduse_dev_msg msg = { 0 };
- if (last < start)
- return -EINVAL;
- msg.req.type = VDUSE_UPDATE_IOTLB;
- if (dev->api_version < VDUSE_API_VERSION_1) {
- msg.req.iova.start = start;
- msg.req.iova.last = last;
- } else {
- msg.req.iova_v2.start = start;
- msg.req.iova_v2.last = last;
- msg.req.iova_v2.asid = asid;
- }
- return vduse_dev_msg_sync(dev, &msg);
- }
- static ssize_t vduse_dev_read_iter(struct kiocb *iocb, struct iov_iter *to)
- {
- struct file *file = iocb->ki_filp;
- struct vduse_dev *dev = file->private_data;
- struct vduse_dev_msg *msg;
- int size = sizeof(struct vduse_dev_request);
- ssize_t ret;
- if (iov_iter_count(to) < size)
- return -EINVAL;
- spin_lock(&dev->msg_lock);
- while (1) {
- msg = vduse_dequeue_msg(&dev->send_list);
- if (msg)
- break;
- ret = -EAGAIN;
- if (file->f_flags & O_NONBLOCK)
- goto unlock;
- spin_unlock(&dev->msg_lock);
- ret = wait_event_interruptible_exclusive(dev->waitq,
- !list_empty(&dev->send_list));
- if (ret)
- return ret;
- spin_lock(&dev->msg_lock);
- }
- spin_unlock(&dev->msg_lock);
- ret = copy_to_iter(&msg->req, size, to);
- spin_lock(&dev->msg_lock);
- if (ret != size) {
- ret = -EFAULT;
- vduse_enqueue_msg(&dev->send_list, msg);
- goto unlock;
- }
- vduse_enqueue_msg(&dev->recv_list, msg);
- unlock:
- spin_unlock(&dev->msg_lock);
- return ret;
- }
- static bool is_mem_zero(const char *ptr, int size)
- {
- int i;
- for (i = 0; i < size; i++) {
- if (ptr[i])
- return false;
- }
- return true;
- }
- static ssize_t vduse_dev_write_iter(struct kiocb *iocb, struct iov_iter *from)
- {
- struct file *file = iocb->ki_filp;
- struct vduse_dev *dev = file->private_data;
- struct vduse_dev_response resp;
- struct vduse_dev_msg *msg;
- size_t ret;
- ret = copy_from_iter(&resp, sizeof(resp), from);
- if (ret != sizeof(resp))
- return -EINVAL;
- if (!is_mem_zero((const char *)resp.reserved, sizeof(resp.reserved)))
- return -EINVAL;
- spin_lock(&dev->msg_lock);
- msg = vduse_find_msg(&dev->recv_list, resp.request_id);
- if (!msg) {
- ret = -ENOENT;
- goto unlock;
- }
- memcpy(&msg->resp, &resp, sizeof(resp));
- msg->completed = 1;
- wake_up(&msg->waitq);
- unlock:
- spin_unlock(&dev->msg_lock);
- return ret;
- }
- static __poll_t vduse_dev_poll(struct file *file, poll_table *wait)
- {
- struct vduse_dev *dev = file->private_data;
- __poll_t mask = 0;
- poll_wait(file, &dev->waitq, wait);
- spin_lock(&dev->msg_lock);
- if (unlikely(dev->broken))
- mask |= EPOLLERR;
- if (!list_empty(&dev->send_list))
- mask |= EPOLLIN | EPOLLRDNORM;
- if (!list_empty(&dev->recv_list))
- mask |= EPOLLOUT | EPOLLWRNORM;
- spin_unlock(&dev->msg_lock);
- return mask;
- }
- static void vduse_dev_reset(struct vduse_dev *dev)
- {
- int i;
- /* The coherent mappings are handled in vduse_dev_free_coherent() */
- for (i = 0; i < dev->nas; i++) {
- struct vduse_iova_domain *domain = dev->as[i].domain;
- if (domain && domain->bounce_map)
- vduse_domain_reset_bounce_map(domain);
- }
- down_write(&dev->rwsem);
- dev->status = 0;
- dev->driver_features = 0;
- dev->generation++;
- spin_lock(&dev->irq_lock);
- dev->config_cb.callback = NULL;
- dev->config_cb.private = NULL;
- spin_unlock(&dev->irq_lock);
- flush_work(&dev->inject);
- for (i = 0; i < dev->vq_num; i++) {
- struct vduse_virtqueue *vq = dev->vqs[i];
- vq->ready = false;
- vq->desc_addr = 0;
- vq->driver_addr = 0;
- vq->device_addr = 0;
- vq->num = 0;
- memset(&vq->state, 0, sizeof(vq->state));
- spin_lock(&vq->kick_lock);
- vq->kicked = false;
- if (vq->kickfd)
- eventfd_ctx_put(vq->kickfd);
- vq->kickfd = NULL;
- spin_unlock(&vq->kick_lock);
- spin_lock(&vq->irq_lock);
- vq->cb.callback = NULL;
- vq->cb.private = NULL;
- vq->cb.trigger = NULL;
- spin_unlock(&vq->irq_lock);
- flush_work(&vq->inject);
- flush_work(&vq->kick);
- }
- up_write(&dev->rwsem);
- }
- static int vduse_vdpa_set_vq_address(struct vdpa_device *vdpa, u16 idx,
- u64 desc_area, u64 driver_area,
- u64 device_area)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- struct vduse_virtqueue *vq = dev->vqs[idx];
- vq->desc_addr = desc_area;
- vq->driver_addr = driver_area;
- vq->device_addr = device_area;
- return 0;
- }
- static void vduse_vq_kick(struct vduse_virtqueue *vq)
- {
- spin_lock(&vq->kick_lock);
- if (!vq->ready)
- goto unlock;
- if (vq->kickfd)
- eventfd_signal(vq->kickfd);
- else
- vq->kicked = true;
- unlock:
- spin_unlock(&vq->kick_lock);
- }
- static void vduse_vq_kick_work(struct work_struct *work)
- {
- struct vduse_virtqueue *vq = container_of(work,
- struct vduse_virtqueue, kick);
- vduse_vq_kick(vq);
- }
- static void vduse_vdpa_kick_vq(struct vdpa_device *vdpa, u16 idx)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- struct vduse_virtqueue *vq = dev->vqs[idx];
- if (!eventfd_signal_allowed()) {
- schedule_work(&vq->kick);
- return;
- }
- vduse_vq_kick(vq);
- }
- static void vduse_vdpa_set_vq_cb(struct vdpa_device *vdpa, u16 idx,
- struct vdpa_callback *cb)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- struct vduse_virtqueue *vq = dev->vqs[idx];
- spin_lock(&vq->irq_lock);
- vq->cb.callback = cb->callback;
- vq->cb.private = cb->private;
- vq->cb.trigger = cb->trigger;
- spin_unlock(&vq->irq_lock);
- }
- static void vduse_vdpa_set_vq_num(struct vdpa_device *vdpa, u16 idx, u32 num)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- struct vduse_virtqueue *vq = dev->vqs[idx];
- vq->num = num;
- }
- static u16 vduse_vdpa_get_vq_size(struct vdpa_device *vdpa, u16 idx)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- struct vduse_virtqueue *vq = dev->vqs[idx];
- if (vq->num)
- return vq->num;
- else
- return vq->num_max;
- }
- static void vduse_vdpa_set_vq_ready(struct vdpa_device *vdpa,
- u16 idx, bool ready)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- struct vduse_virtqueue *vq = dev->vqs[idx];
- vq->ready = ready;
- }
- static bool vduse_vdpa_get_vq_ready(struct vdpa_device *vdpa, u16 idx)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- struct vduse_virtqueue *vq = dev->vqs[idx];
- return vq->ready;
- }
- static int vduse_vdpa_set_vq_state(struct vdpa_device *vdpa, u16 idx,
- const struct vdpa_vq_state *state)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- struct vduse_virtqueue *vq = dev->vqs[idx];
- if (dev->driver_features & BIT_ULL(VIRTIO_F_RING_PACKED)) {
- vq->state.packed.last_avail_counter =
- state->packed.last_avail_counter;
- vq->state.packed.last_avail_idx = state->packed.last_avail_idx;
- vq->state.packed.last_used_counter =
- state->packed.last_used_counter;
- vq->state.packed.last_used_idx = state->packed.last_used_idx;
- } else
- vq->state.split.avail_index = state->split.avail_index;
- return 0;
- }
- static u32 vduse_get_vq_group(struct vdpa_device *vdpa, u16 idx)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- if (dev->api_version < VDUSE_API_VERSION_1)
- return 0;
- return dev->vqs[idx]->group;
- }
- static union virtio_map vduse_get_vq_map(struct vdpa_device *vdpa, u16 idx)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- u32 vq_group = vduse_get_vq_group(vdpa, idx);
- union virtio_map ret = {
- .group = &dev->groups[vq_group],
- };
- return ret;
- }
- DEFINE_GUARD(vq_group_as_read_lock, struct vduse_vq_group *,
- if (_T->dev->nas > 1)
- read_lock(&_T->as_lock),
- if (_T->dev->nas > 1)
- read_unlock(&_T->as_lock))
- DEFINE_GUARD(vq_group_as_write_lock, struct vduse_vq_group *,
- if (_T->dev->nas > 1)
- write_lock(&_T->as_lock),
- if (_T->dev->nas > 1)
- write_unlock(&_T->as_lock))
- static int vduse_set_group_asid(struct vdpa_device *vdpa, unsigned int group,
- unsigned int asid)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- struct vduse_dev_msg msg = { 0 };
- int r;
- if (dev->api_version < VDUSE_API_VERSION_1)
- return -EINVAL;
- msg.req.type = VDUSE_SET_VQ_GROUP_ASID;
- msg.req.vq_group_asid.group = group;
- msg.req.vq_group_asid.asid = asid;
- r = vduse_dev_msg_sync(dev, &msg);
- if (r < 0)
- return r;
- guard(vq_group_as_write_lock)(&dev->groups[group]);
- dev->groups[group].as = &dev->as[asid];
- return 0;
- }
- static int vduse_vdpa_get_vq_state(struct vdpa_device *vdpa, u16 idx,
- struct vdpa_vq_state *state)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- struct vduse_virtqueue *vq = dev->vqs[idx];
- if (dev->driver_features & BIT_ULL(VIRTIO_F_RING_PACKED))
- return vduse_dev_get_vq_state_packed(dev, vq, &state->packed);
- return vduse_dev_get_vq_state_split(dev, vq, &state->split);
- }
- static u32 vduse_vdpa_get_vq_align(struct vdpa_device *vdpa)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- return dev->vq_align;
- }
- static u64 vduse_vdpa_get_device_features(struct vdpa_device *vdpa)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- return dev->device_features;
- }
- static int vduse_vdpa_set_driver_features(struct vdpa_device *vdpa, u64 features)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- dev->driver_features = features;
- return 0;
- }
- static u64 vduse_vdpa_get_driver_features(struct vdpa_device *vdpa)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- return dev->driver_features;
- }
- static void vduse_vdpa_set_config_cb(struct vdpa_device *vdpa,
- struct vdpa_callback *cb)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- spin_lock(&dev->irq_lock);
- dev->config_cb.callback = cb->callback;
- dev->config_cb.private = cb->private;
- spin_unlock(&dev->irq_lock);
- }
- static u16 vduse_vdpa_get_vq_num_max(struct vdpa_device *vdpa)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- u16 num_max = 0;
- int i;
- for (i = 0; i < dev->vq_num; i++)
- if (num_max < dev->vqs[i]->num_max)
- num_max = dev->vqs[i]->num_max;
- return num_max;
- }
- static u32 vduse_vdpa_get_device_id(struct vdpa_device *vdpa)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- return dev->device_id;
- }
- static u32 vduse_vdpa_get_vendor_id(struct vdpa_device *vdpa)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- return dev->vendor_id;
- }
- static u8 vduse_vdpa_get_status(struct vdpa_device *vdpa)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- return dev->status;
- }
- static void vduse_vdpa_set_status(struct vdpa_device *vdpa, u8 status)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- if (vduse_dev_set_status(dev, status))
- return;
- dev->status = status;
- }
- static size_t vduse_vdpa_get_config_size(struct vdpa_device *vdpa)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- return dev->config_size;
- }
- static void vduse_vdpa_get_config(struct vdpa_device *vdpa, unsigned int offset,
- void *buf, unsigned int len)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- /* Initialize the buffer in case of partial copy. */
- memset(buf, 0, len);
- if (offset > dev->config_size)
- return;
- if (len > dev->config_size - offset)
- len = dev->config_size - offset;
- memcpy(buf, dev->config + offset, len);
- }
- static void vduse_vdpa_set_config(struct vdpa_device *vdpa, unsigned int offset,
- const void *buf, unsigned int len)
- {
- /* Now we only support read-only configuration space */
- }
- static int vduse_vdpa_reset(struct vdpa_device *vdpa)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- int ret = vduse_dev_set_status(dev, 0);
- vduse_dev_reset(dev);
- return ret;
- }
- static u32 vduse_vdpa_get_generation(struct vdpa_device *vdpa)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- return dev->generation;
- }
- static int vduse_vdpa_set_vq_affinity(struct vdpa_device *vdpa, u16 idx,
- const struct cpumask *cpu_mask)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- if (cpu_mask)
- cpumask_copy(&dev->vqs[idx]->irq_affinity, cpu_mask);
- else
- cpumask_setall(&dev->vqs[idx]->irq_affinity);
- return 0;
- }
- static const struct cpumask *
- vduse_vdpa_get_vq_affinity(struct vdpa_device *vdpa, u16 idx)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- return &dev->vqs[idx]->irq_affinity;
- }
- static int vduse_vdpa_set_map(struct vdpa_device *vdpa,
- unsigned int asid,
- struct vhost_iotlb *iotlb)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- int ret;
- ret = vduse_domain_set_map(dev->as[asid].domain, iotlb);
- if (ret)
- return ret;
- ret = vduse_dev_update_iotlb(dev, asid, 0ULL, ULLONG_MAX);
- if (ret) {
- vduse_domain_clear_map(dev->as[asid].domain, iotlb);
- return ret;
- }
- return 0;
- }
- static void vduse_vdpa_free(struct vdpa_device *vdpa)
- {
- struct vduse_dev *dev = vdpa_to_vduse(vdpa);
- dev->vdev = NULL;
- }
- static const struct vdpa_config_ops vduse_vdpa_config_ops = {
- .set_vq_address = vduse_vdpa_set_vq_address,
- .kick_vq = vduse_vdpa_kick_vq,
- .set_vq_cb = vduse_vdpa_set_vq_cb,
- .set_vq_num = vduse_vdpa_set_vq_num,
- .get_vq_size = vduse_vdpa_get_vq_size,
- .get_vq_group = vduse_get_vq_group,
- .set_vq_ready = vduse_vdpa_set_vq_ready,
- .get_vq_ready = vduse_vdpa_get_vq_ready,
- .set_vq_state = vduse_vdpa_set_vq_state,
- .get_vq_state = vduse_vdpa_get_vq_state,
- .get_vq_align = vduse_vdpa_get_vq_align,
- .get_device_features = vduse_vdpa_get_device_features,
- .set_driver_features = vduse_vdpa_set_driver_features,
- .get_driver_features = vduse_vdpa_get_driver_features,
- .set_config_cb = vduse_vdpa_set_config_cb,
- .get_vq_num_max = vduse_vdpa_get_vq_num_max,
- .get_device_id = vduse_vdpa_get_device_id,
- .get_vendor_id = vduse_vdpa_get_vendor_id,
- .get_status = vduse_vdpa_get_status,
- .set_status = vduse_vdpa_set_status,
- .get_config_size = vduse_vdpa_get_config_size,
- .get_config = vduse_vdpa_get_config,
- .set_config = vduse_vdpa_set_config,
- .get_generation = vduse_vdpa_get_generation,
- .set_vq_affinity = vduse_vdpa_set_vq_affinity,
- .get_vq_affinity = vduse_vdpa_get_vq_affinity,
- .reset = vduse_vdpa_reset,
- .set_map = vduse_vdpa_set_map,
- .set_group_asid = vduse_set_group_asid,
- .get_vq_map = vduse_get_vq_map,
- .free = vduse_vdpa_free,
- };
- static void vduse_dev_sync_single_for_device(union virtio_map token,
- dma_addr_t dma_addr, size_t size,
- enum dma_data_direction dir)
- {
- struct vduse_iova_domain *domain;
- if (!token.group)
- return;
- guard(vq_group_as_read_lock)(token.group);
- domain = token.group->as->domain;
- vduse_domain_sync_single_for_device(domain, dma_addr, size, dir);
- }
- static void vduse_dev_sync_single_for_cpu(union virtio_map token,
- dma_addr_t dma_addr, size_t size,
- enum dma_data_direction dir)
- {
- struct vduse_iova_domain *domain;
- if (!token.group)
- return;
- guard(vq_group_as_read_lock)(token.group);
- domain = token.group->as->domain;
- vduse_domain_sync_single_for_cpu(domain, dma_addr, size, dir);
- }
- static dma_addr_t vduse_dev_map_page(union virtio_map token, struct page *page,
- unsigned long offset, size_t size,
- enum dma_data_direction dir,
- unsigned long attrs)
- {
- struct vduse_iova_domain *domain;
- if (!token.group)
- return DMA_MAPPING_ERROR;
- guard(vq_group_as_read_lock)(token.group);
- domain = token.group->as->domain;
- return vduse_domain_map_page(domain, page, offset, size, dir, attrs);
- }
- static void vduse_dev_unmap_page(union virtio_map token, dma_addr_t dma_addr,
- size_t size, enum dma_data_direction dir,
- unsigned long attrs)
- {
- struct vduse_iova_domain *domain;
- if (!token.group)
- return;
- guard(vq_group_as_read_lock)(token.group);
- domain = token.group->as->domain;
- vduse_domain_unmap_page(domain, dma_addr, size, dir, attrs);
- }
- static void *vduse_dev_alloc_coherent(union virtio_map token, size_t size,
- dma_addr_t *dma_addr, gfp_t flag)
- {
- void *addr;
- *dma_addr = DMA_MAPPING_ERROR;
- if (!token.group)
- return NULL;
- addr = alloc_pages_exact(size, flag);
- if (!addr)
- return NULL;
- {
- struct vduse_iova_domain *domain;
- guard(vq_group_as_read_lock)(token.group);
- domain = token.group->as->domain;
- *dma_addr = vduse_domain_alloc_coherent(domain, size, addr);
- if (*dma_addr == DMA_MAPPING_ERROR)
- goto err;
- }
- return addr;
- err:
- free_pages_exact(addr, size);
- return NULL;
- }
- static void vduse_dev_free_coherent(union virtio_map token, size_t size,
- void *vaddr, dma_addr_t dma_addr,
- unsigned long attrs)
- {
- if (!token.group)
- return;
- {
- struct vduse_iova_domain *domain;
- guard(vq_group_as_read_lock)(token.group);
- domain = token.group->as->domain;
- vduse_domain_free_coherent(domain, size, dma_addr, attrs);
- }
- free_pages_exact(vaddr, size);
- }
- static bool vduse_dev_need_sync(union virtio_map token, dma_addr_t dma_addr)
- {
- if (!token.group)
- return false;
- guard(vq_group_as_read_lock)(token.group);
- return dma_addr < token.group->as->domain->bounce_size;
- }
- static int vduse_dev_mapping_error(union virtio_map token, dma_addr_t dma_addr)
- {
- if (unlikely(dma_addr == DMA_MAPPING_ERROR))
- return -ENOMEM;
- return 0;
- }
- static size_t vduse_dev_max_mapping_size(union virtio_map token)
- {
- if (!token.group)
- return 0;
- guard(vq_group_as_read_lock)(token.group);
- return token.group->as->domain->bounce_size;
- }
- static const struct virtio_map_ops vduse_map_ops = {
- .sync_single_for_device = vduse_dev_sync_single_for_device,
- .sync_single_for_cpu = vduse_dev_sync_single_for_cpu,
- .map_page = vduse_dev_map_page,
- .unmap_page = vduse_dev_unmap_page,
- .alloc = vduse_dev_alloc_coherent,
- .free = vduse_dev_free_coherent,
- .need_sync = vduse_dev_need_sync,
- .mapping_error = vduse_dev_mapping_error,
- .max_mapping_size = vduse_dev_max_mapping_size,
- };
- static unsigned int perm_to_file_flags(u8 perm)
- {
- unsigned int flags = 0;
- switch (perm) {
- case VDUSE_ACCESS_WO:
- flags |= O_WRONLY;
- break;
- case VDUSE_ACCESS_RO:
- flags |= O_RDONLY;
- break;
- case VDUSE_ACCESS_RW:
- flags |= O_RDWR;
- break;
- default:
- WARN(1, "invalidate vhost IOTLB permission\n");
- break;
- }
- return flags;
- }
- static int vduse_kickfd_setup(struct vduse_dev *dev,
- struct vduse_vq_eventfd *eventfd)
- {
- struct eventfd_ctx *ctx = NULL;
- struct vduse_virtqueue *vq;
- u32 index;
- if (eventfd->index >= dev->vq_num)
- return -EINVAL;
- index = array_index_nospec(eventfd->index, dev->vq_num);
- vq = dev->vqs[index];
- if (eventfd->fd >= 0) {
- ctx = eventfd_ctx_fdget(eventfd->fd);
- if (IS_ERR(ctx))
- return PTR_ERR(ctx);
- } else if (eventfd->fd != VDUSE_EVENTFD_DEASSIGN)
- return 0;
- spin_lock(&vq->kick_lock);
- if (vq->kickfd)
- eventfd_ctx_put(vq->kickfd);
- vq->kickfd = ctx;
- if (vq->ready && vq->kicked && vq->kickfd) {
- eventfd_signal(vq->kickfd);
- vq->kicked = false;
- }
- spin_unlock(&vq->kick_lock);
- return 0;
- }
- static bool vduse_dev_is_ready(struct vduse_dev *dev)
- {
- int i;
- for (i = 0; i < dev->vq_num; i++)
- if (!dev->vqs[i]->num_max)
- return false;
- return true;
- }
- static void vduse_dev_irq_inject(struct work_struct *work)
- {
- struct vduse_dev *dev = container_of(work, struct vduse_dev, inject);
- spin_lock_bh(&dev->irq_lock);
- if (dev->config_cb.callback)
- dev->config_cb.callback(dev->config_cb.private);
- spin_unlock_bh(&dev->irq_lock);
- }
- static void vduse_vq_irq_inject(struct work_struct *work)
- {
- struct vduse_virtqueue *vq = container_of(work,
- struct vduse_virtqueue, inject);
- spin_lock_bh(&vq->irq_lock);
- if (vq->ready && vq->cb.callback)
- vq->cb.callback(vq->cb.private);
- spin_unlock_bh(&vq->irq_lock);
- }
- static bool vduse_vq_signal_irqfd(struct vduse_virtqueue *vq)
- {
- bool signal = false;
- if (!vq->cb.trigger)
- return false;
- spin_lock_irq(&vq->irq_lock);
- if (vq->ready && vq->cb.trigger) {
- eventfd_signal(vq->cb.trigger);
- signal = true;
- }
- spin_unlock_irq(&vq->irq_lock);
- return signal;
- }
- static int vduse_dev_queue_irq_work(struct vduse_dev *dev,
- struct work_struct *irq_work,
- int irq_effective_cpu)
- {
- int ret = -EINVAL;
- down_read(&dev->rwsem);
- if (!(dev->status & VIRTIO_CONFIG_S_DRIVER_OK))
- goto unlock;
- ret = 0;
- if (irq_effective_cpu == IRQ_UNBOUND)
- queue_work(vduse_irq_wq, irq_work);
- else
- queue_work_on(irq_effective_cpu,
- vduse_irq_bound_wq, irq_work);
- unlock:
- up_read(&dev->rwsem);
- return ret;
- }
- static int vduse_dev_dereg_umem(struct vduse_dev *dev, u32 asid,
- u64 iova, u64 size)
- {
- int ret;
- mutex_lock(&dev->as[asid].mem_lock);
- ret = -ENOENT;
- if (!dev->as[asid].umem)
- goto unlock;
- ret = -EINVAL;
- if (!dev->as[asid].domain)
- goto unlock;
- if (dev->as[asid].umem->iova != iova ||
- size != dev->as[asid].domain->bounce_size)
- goto unlock;
- vduse_domain_remove_user_bounce_pages(dev->as[asid].domain);
- unpin_user_pages_dirty_lock(dev->as[asid].umem->pages,
- dev->as[asid].umem->npages, true);
- atomic64_sub(dev->as[asid].umem->npages, &dev->as[asid].umem->mm->pinned_vm);
- mmdrop(dev->as[asid].umem->mm);
- vfree(dev->as[asid].umem->pages);
- kfree(dev->as[asid].umem);
- dev->as[asid].umem = NULL;
- ret = 0;
- unlock:
- mutex_unlock(&dev->as[asid].mem_lock);
- return ret;
- }
- static int vduse_dev_reg_umem(struct vduse_dev *dev,
- u32 asid, u64 iova, u64 uaddr, u64 size)
- {
- struct page **page_list = NULL;
- struct vduse_umem *umem = NULL;
- long pinned = 0;
- unsigned long npages, lock_limit;
- int ret;
- if (!dev->as[asid].domain || !dev->as[asid].domain->bounce_map ||
- size != dev->as[asid].domain->bounce_size ||
- iova != 0 || uaddr & ~PAGE_MASK)
- return -EINVAL;
- mutex_lock(&dev->as[asid].mem_lock);
- ret = -EEXIST;
- if (dev->as[asid].umem)
- goto unlock;
- ret = -ENOMEM;
- npages = size >> PAGE_SHIFT;
- page_list = __vmalloc(array_size(npages, sizeof(struct page *)),
- GFP_KERNEL_ACCOUNT);
- umem = kzalloc_obj(*umem);
- if (!page_list || !umem)
- goto unlock;
- mmap_read_lock(current->mm);
- lock_limit = PFN_DOWN(rlimit(RLIMIT_MEMLOCK));
- if (npages + atomic64_read(¤t->mm->pinned_vm) > lock_limit)
- goto out;
- pinned = pin_user_pages(uaddr, npages, FOLL_LONGTERM | FOLL_WRITE,
- page_list);
- if (pinned != npages) {
- ret = pinned < 0 ? pinned : -ENOMEM;
- goto out;
- }
- ret = vduse_domain_add_user_bounce_pages(dev->as[asid].domain,
- page_list, pinned);
- if (ret)
- goto out;
- atomic64_add(npages, ¤t->mm->pinned_vm);
- umem->pages = page_list;
- umem->npages = pinned;
- umem->iova = iova;
- umem->mm = current->mm;
- mmgrab(current->mm);
- dev->as[asid].umem = umem;
- out:
- if (ret && pinned > 0)
- unpin_user_pages(page_list, pinned);
- mmap_read_unlock(current->mm);
- unlock:
- if (ret) {
- vfree(page_list);
- kfree(umem);
- }
- mutex_unlock(&dev->as[asid].mem_lock);
- return ret;
- }
- static void vduse_vq_update_effective_cpu(struct vduse_virtqueue *vq)
- {
- int curr_cpu = vq->irq_effective_cpu;
- while (true) {
- curr_cpu = cpumask_next(curr_cpu, &vq->irq_affinity);
- if (cpu_online(curr_cpu))
- break;
- if (curr_cpu >= nr_cpu_ids)
- curr_cpu = IRQ_UNBOUND;
- }
- vq->irq_effective_cpu = curr_cpu;
- }
- static int vduse_dev_iotlb_entry(struct vduse_dev *dev,
- struct vduse_iotlb_entry_v2 *entry,
- struct file **f, uint64_t *capability)
- {
- u32 asid;
- int r = -EINVAL;
- struct vhost_iotlb_map *map;
- if (entry->start > entry->last || entry->asid >= dev->nas)
- return -EINVAL;
- asid = array_index_nospec(entry->asid, dev->nas);
- mutex_lock(&dev->domain_lock);
- if (!dev->as[asid].domain)
- goto out;
- spin_lock(&dev->as[asid].domain->iotlb_lock);
- map = vhost_iotlb_itree_first(dev->as[asid].domain->iotlb,
- entry->start, entry->last);
- if (map) {
- if (f) {
- const struct vdpa_map_file *map_file;
- map_file = (struct vdpa_map_file *)map->opaque;
- entry->offset = map_file->offset;
- *f = get_file(map_file->file);
- }
- entry->start = map->start;
- entry->last = map->last;
- entry->perm = map->perm;
- if (capability) {
- *capability = 0;
- if (dev->as[asid].domain->bounce_map && map->start == 0 &&
- map->last == dev->as[asid].domain->bounce_size - 1)
- *capability |= VDUSE_IOVA_CAP_UMEM;
- }
- r = 0;
- }
- spin_unlock(&dev->as[asid].domain->iotlb_lock);
- out:
- mutex_unlock(&dev->domain_lock);
- return r;
- }
- static long vduse_dev_ioctl(struct file *file, unsigned int cmd,
- unsigned long arg)
- {
- struct vduse_dev *dev = file->private_data;
- void __user *argp = (void __user *)arg;
- int ret;
- if (unlikely(dev->broken))
- return -EPERM;
- switch (cmd) {
- case VDUSE_IOTLB_GET_FD:
- case VDUSE_IOTLB_GET_FD2: {
- struct vduse_iotlb_entry_v2 entry = {0};
- struct file *f = NULL;
- ret = -ENOIOCTLCMD;
- if (dev->api_version < VDUSE_API_VERSION_1 &&
- cmd == VDUSE_IOTLB_GET_FD2)
- break;
- ret = -EFAULT;
- if (copy_from_user(&entry, argp, _IOC_SIZE(cmd)))
- break;
- ret = -EINVAL;
- if (!is_mem_zero((const char *)entry.reserved,
- sizeof(entry.reserved)))
- break;
- ret = vduse_dev_iotlb_entry(dev, &entry, &f, NULL);
- if (ret)
- break;
- ret = -EINVAL;
- if (!f)
- break;
- ret = copy_to_user(argp, &entry, _IOC_SIZE(cmd));
- if (ret) {
- ret = -EFAULT;
- fput(f);
- break;
- }
- ret = receive_fd(f, NULL, perm_to_file_flags(entry.perm));
- fput(f);
- break;
- }
- case VDUSE_DEV_GET_FEATURES:
- /*
- * Just mirror what driver wrote here.
- * The driver is expected to check FEATURE_OK later.
- */
- ret = put_user(dev->driver_features, (u64 __user *)argp);
- break;
- case VDUSE_DEV_SET_CONFIG: {
- struct vduse_config_data config;
- unsigned long size = offsetof(struct vduse_config_data,
- buffer);
- ret = -EFAULT;
- if (copy_from_user(&config, argp, size))
- break;
- ret = -EINVAL;
- if (config.offset > dev->config_size ||
- config.length == 0 ||
- config.length > dev->config_size - config.offset)
- break;
- ret = -EFAULT;
- if (copy_from_user(dev->config + config.offset, argp + size,
- config.length))
- break;
- ret = 0;
- break;
- }
- case VDUSE_DEV_INJECT_CONFIG_IRQ:
- ret = vduse_dev_queue_irq_work(dev, &dev->inject, IRQ_UNBOUND);
- break;
- case VDUSE_VQ_SETUP: {
- struct vduse_vq_config config;
- u32 index;
- ret = -EFAULT;
- if (copy_from_user(&config, argp, sizeof(config)))
- break;
- ret = -EINVAL;
- if (config.index >= dev->vq_num)
- break;
- if (dev->api_version < VDUSE_API_VERSION_1) {
- if (config.group)
- break;
- } else {
- if (config.group >= dev->ngroups)
- break;
- if (dev->status & VIRTIO_CONFIG_S_DRIVER_OK)
- break;
- }
- if (config.reserved1 ||
- !is_mem_zero((const char *)config.reserved2,
- sizeof(config.reserved2)))
- break;
- index = array_index_nospec(config.index, dev->vq_num);
- dev->vqs[index]->num_max = config.max_size;
- dev->vqs[index]->group = config.group;
- ret = 0;
- break;
- }
- case VDUSE_VQ_GET_INFO: {
- struct vduse_vq_info vq_info;
- struct vduse_virtqueue *vq;
- u32 index;
- ret = -EFAULT;
- if (copy_from_user(&vq_info, argp, sizeof(vq_info)))
- break;
- ret = -EINVAL;
- if (vq_info.index >= dev->vq_num)
- break;
- index = array_index_nospec(vq_info.index, dev->vq_num);
- vq = dev->vqs[index];
- vq_info.desc_addr = vq->desc_addr;
- vq_info.driver_addr = vq->driver_addr;
- vq_info.device_addr = vq->device_addr;
- vq_info.num = vq->num;
- if (dev->driver_features & BIT_ULL(VIRTIO_F_RING_PACKED)) {
- vq_info.packed.last_avail_counter =
- vq->state.packed.last_avail_counter;
- vq_info.packed.last_avail_idx =
- vq->state.packed.last_avail_idx;
- vq_info.packed.last_used_counter =
- vq->state.packed.last_used_counter;
- vq_info.packed.last_used_idx =
- vq->state.packed.last_used_idx;
- } else
- vq_info.split.avail_index =
- vq->state.split.avail_index;
- vq_info.ready = vq->ready;
- ret = -EFAULT;
- if (copy_to_user(argp, &vq_info, sizeof(vq_info)))
- break;
- ret = 0;
- break;
- }
- case VDUSE_VQ_SETUP_KICKFD: {
- struct vduse_vq_eventfd eventfd;
- ret = -EFAULT;
- if (copy_from_user(&eventfd, argp, sizeof(eventfd)))
- break;
- ret = vduse_kickfd_setup(dev, &eventfd);
- break;
- }
- case VDUSE_VQ_INJECT_IRQ: {
- u32 index;
- ret = -EFAULT;
- if (get_user(index, (u32 __user *)argp))
- break;
- ret = -EINVAL;
- if (index >= dev->vq_num)
- break;
- ret = 0;
- index = array_index_nospec(index, dev->vq_num);
- if (!vduse_vq_signal_irqfd(dev->vqs[index])) {
- vduse_vq_update_effective_cpu(dev->vqs[index]);
- ret = vduse_dev_queue_irq_work(dev,
- &dev->vqs[index]->inject,
- dev->vqs[index]->irq_effective_cpu);
- }
- break;
- }
- case VDUSE_IOTLB_REG_UMEM: {
- struct vduse_iova_umem umem;
- u32 asid;
- ret = -EFAULT;
- if (copy_from_user(&umem, argp, sizeof(umem)))
- break;
- ret = -EINVAL;
- if (!is_mem_zero((const char *)umem.reserved,
- sizeof(umem.reserved)) ||
- (dev->api_version < VDUSE_API_VERSION_1 &&
- umem.asid != 0) || umem.asid >= dev->nas)
- break;
- mutex_lock(&dev->domain_lock);
- asid = array_index_nospec(umem.asid, dev->nas);
- ret = vduse_dev_reg_umem(dev, asid, umem.iova,
- umem.uaddr, umem.size);
- mutex_unlock(&dev->domain_lock);
- break;
- }
- case VDUSE_IOTLB_DEREG_UMEM: {
- struct vduse_iova_umem umem;
- u32 asid;
- ret = -EFAULT;
- if (copy_from_user(&umem, argp, sizeof(umem)))
- break;
- ret = -EINVAL;
- if (!is_mem_zero((const char *)umem.reserved,
- sizeof(umem.reserved)) ||
- (dev->api_version < VDUSE_API_VERSION_1 &&
- umem.asid != 0) ||
- umem.asid >= dev->nas)
- break;
- mutex_lock(&dev->domain_lock);
- asid = array_index_nospec(umem.asid, dev->nas);
- ret = vduse_dev_dereg_umem(dev, asid, umem.iova,
- umem.size);
- mutex_unlock(&dev->domain_lock);
- break;
- }
- case VDUSE_IOTLB_GET_INFO: {
- struct vduse_iova_info info;
- struct vduse_iotlb_entry_v2 entry;
- ret = -EFAULT;
- if (copy_from_user(&info, argp, sizeof(info)))
- break;
- if (!is_mem_zero((const char *)info.reserved,
- sizeof(info.reserved)))
- break;
- if (dev->api_version < VDUSE_API_VERSION_1) {
- if (info.asid)
- break;
- } else if (info.asid >= dev->nas)
- break;
- entry.start = info.start;
- entry.last = info.last;
- entry.asid = info.asid;
- ret = vduse_dev_iotlb_entry(dev, &entry, NULL,
- &info.capability);
- if (ret < 0)
- break;
- info.start = entry.start;
- info.last = entry.last;
- info.asid = entry.asid;
- ret = -EFAULT;
- if (copy_to_user(argp, &info, sizeof(info)))
- break;
- ret = 0;
- break;
- }
- default:
- ret = -ENOIOCTLCMD;
- break;
- }
- return ret;
- }
- static int vduse_dev_release(struct inode *inode, struct file *file)
- {
- struct vduse_dev *dev = file->private_data;
- mutex_lock(&dev->domain_lock);
- for (int i = 0; i < dev->nas; i++)
- if (dev->as[i].domain)
- vduse_dev_dereg_umem(dev, i, 0,
- dev->as[i].domain->bounce_size);
- mutex_unlock(&dev->domain_lock);
- spin_lock(&dev->msg_lock);
- /* Make sure the inflight messages can processed after reconncection */
- list_splice_init(&dev->recv_list, &dev->send_list);
- spin_unlock(&dev->msg_lock);
- dev->connected = false;
- return 0;
- }
- static struct vduse_dev *vduse_dev_get_from_minor(int minor)
- {
- struct vduse_dev *dev;
- mutex_lock(&vduse_lock);
- dev = idr_find(&vduse_idr, minor);
- mutex_unlock(&vduse_lock);
- return dev;
- }
- static int vduse_dev_open(struct inode *inode, struct file *file)
- {
- int ret;
- struct vduse_dev *dev = vduse_dev_get_from_minor(iminor(inode));
- if (!dev)
- return -ENODEV;
- ret = -EBUSY;
- mutex_lock(&dev->lock);
- if (dev->connected)
- goto unlock;
- ret = 0;
- dev->connected = true;
- file->private_data = dev;
- unlock:
- mutex_unlock(&dev->lock);
- return ret;
- }
- static const struct file_operations vduse_dev_fops = {
- .owner = THIS_MODULE,
- .open = vduse_dev_open,
- .release = vduse_dev_release,
- .read_iter = vduse_dev_read_iter,
- .write_iter = vduse_dev_write_iter,
- .poll = vduse_dev_poll,
- .unlocked_ioctl = vduse_dev_ioctl,
- .compat_ioctl = compat_ptr_ioctl,
- .llseek = noop_llseek,
- };
- static ssize_t irq_cb_affinity_show(struct vduse_virtqueue *vq, char *buf)
- {
- return sprintf(buf, "%*pb\n", cpumask_pr_args(&vq->irq_affinity));
- }
- static ssize_t irq_cb_affinity_store(struct vduse_virtqueue *vq,
- const char *buf, size_t count)
- {
- cpumask_var_t new_value;
- int ret;
- if (!zalloc_cpumask_var(&new_value, GFP_KERNEL))
- return -ENOMEM;
- ret = cpumask_parse(buf, new_value);
- if (ret)
- goto free_mask;
- ret = -EINVAL;
- if (!cpumask_intersects(new_value, cpu_online_mask))
- goto free_mask;
- cpumask_copy(&vq->irq_affinity, new_value);
- ret = count;
- free_mask:
- free_cpumask_var(new_value);
- return ret;
- }
- struct vq_sysfs_entry {
- struct attribute attr;
- ssize_t (*show)(struct vduse_virtqueue *vq, char *buf);
- ssize_t (*store)(struct vduse_virtqueue *vq, const char *buf,
- size_t count);
- };
- static struct vq_sysfs_entry irq_cb_affinity_attr = __ATTR_RW(irq_cb_affinity);
- static struct attribute *vq_attrs[] = {
- &irq_cb_affinity_attr.attr,
- NULL,
- };
- ATTRIBUTE_GROUPS(vq);
- static ssize_t vq_attr_show(struct kobject *kobj, struct attribute *attr,
- char *buf)
- {
- struct vduse_virtqueue *vq = container_of(kobj,
- struct vduse_virtqueue, kobj);
- struct vq_sysfs_entry *entry = container_of(attr,
- struct vq_sysfs_entry, attr);
- if (!entry->show)
- return -EIO;
- return entry->show(vq, buf);
- }
- static ssize_t vq_attr_store(struct kobject *kobj, struct attribute *attr,
- const char *buf, size_t count)
- {
- struct vduse_virtqueue *vq = container_of(kobj,
- struct vduse_virtqueue, kobj);
- struct vq_sysfs_entry *entry = container_of(attr,
- struct vq_sysfs_entry, attr);
- if (!entry->store)
- return -EIO;
- return entry->store(vq, buf, count);
- }
- static const struct sysfs_ops vq_sysfs_ops = {
- .show = vq_attr_show,
- .store = vq_attr_store,
- };
- static void vq_release(struct kobject *kobj)
- {
- struct vduse_virtqueue *vq = container_of(kobj,
- struct vduse_virtqueue, kobj);
- kfree(vq);
- }
- static const struct kobj_type vq_type = {
- .release = vq_release,
- .sysfs_ops = &vq_sysfs_ops,
- .default_groups = vq_groups,
- };
- static char *vduse_devnode(const struct device *dev, umode_t *mode)
- {
- return kasprintf(GFP_KERNEL, "vduse/%s", dev_name(dev));
- }
- static const struct class vduse_class = {
- .name = "vduse",
- .devnode = vduse_devnode,
- };
- static void vduse_dev_deinit_vqs(struct vduse_dev *dev)
- {
- int i;
- if (!dev->vqs)
- return;
- for (i = 0; i < dev->vq_num; i++)
- kobject_put(&dev->vqs[i]->kobj);
- kfree(dev->vqs);
- }
- static int vduse_dev_init_vqs(struct vduse_dev *dev, u32 vq_align, u32 vq_num)
- {
- int ret, i;
- dev->vq_align = vq_align;
- dev->vq_num = vq_num;
- dev->vqs = kzalloc_objs(*dev->vqs, dev->vq_num);
- if (!dev->vqs)
- return -ENOMEM;
- for (i = 0; i < vq_num; i++) {
- dev->vqs[i] = kzalloc_obj(*dev->vqs[i]);
- if (!dev->vqs[i]) {
- ret = -ENOMEM;
- goto err;
- }
- dev->vqs[i]->index = i;
- dev->vqs[i]->irq_effective_cpu = IRQ_UNBOUND;
- INIT_WORK(&dev->vqs[i]->inject, vduse_vq_irq_inject);
- INIT_WORK(&dev->vqs[i]->kick, vduse_vq_kick_work);
- spin_lock_init(&dev->vqs[i]->kick_lock);
- spin_lock_init(&dev->vqs[i]->irq_lock);
- cpumask_setall(&dev->vqs[i]->irq_affinity);
- kobject_init(&dev->vqs[i]->kobj, &vq_type);
- ret = kobject_add(&dev->vqs[i]->kobj,
- &dev->dev->kobj, "vq%d", i);
- if (ret) {
- kfree(dev->vqs[i]);
- goto err;
- }
- }
- return 0;
- err:
- while (i--)
- kobject_put(&dev->vqs[i]->kobj);
- kfree(dev->vqs);
- dev->vqs = NULL;
- return ret;
- }
- static struct vduse_dev *vduse_dev_create(void)
- {
- struct vduse_dev *dev = kzalloc_obj(*dev);
- if (!dev)
- return NULL;
- mutex_init(&dev->lock);
- mutex_init(&dev->domain_lock);
- spin_lock_init(&dev->msg_lock);
- INIT_LIST_HEAD(&dev->send_list);
- INIT_LIST_HEAD(&dev->recv_list);
- spin_lock_init(&dev->irq_lock);
- init_rwsem(&dev->rwsem);
- INIT_WORK(&dev->inject, vduse_dev_irq_inject);
- init_waitqueue_head(&dev->waitq);
- return dev;
- }
- static void vduse_dev_destroy(struct vduse_dev *dev)
- {
- kfree(dev);
- }
- static struct vduse_dev *vduse_find_dev(const char *name)
- {
- struct vduse_dev *dev;
- int id;
- idr_for_each_entry(&vduse_idr, dev, id)
- if (!strcmp(dev->name, name))
- return dev;
- return NULL;
- }
- static int vduse_destroy_dev(char *name)
- {
- struct vduse_dev *dev = vduse_find_dev(name);
- if (!dev)
- return -EINVAL;
- mutex_lock(&dev->lock);
- if (dev->vdev || dev->connected) {
- mutex_unlock(&dev->lock);
- return -EBUSY;
- }
- dev->connected = true;
- mutex_unlock(&dev->lock);
- vduse_dev_reset(dev);
- device_destroy(&vduse_class, MKDEV(MAJOR(vduse_major), dev->minor));
- idr_remove(&vduse_idr, dev->minor);
- kvfree(dev->config);
- vduse_dev_deinit_vqs(dev);
- for (int i = 0; i < dev->nas; i++) {
- if (dev->as[i].domain)
- vduse_domain_destroy(dev->as[i].domain);
- }
- kfree(dev->as);
- kfree(dev->name);
- kfree(dev->groups);
- vduse_dev_destroy(dev);
- module_put(THIS_MODULE);
- return 0;
- }
- static bool device_is_allowed(u32 device_id)
- {
- int i;
- for (i = 0; i < ARRAY_SIZE(allowed_device_id); i++)
- if (allowed_device_id[i] == device_id)
- return true;
- return false;
- }
- static bool features_is_valid(struct vduse_dev_config *config)
- {
- if (!(config->features & BIT_ULL(VIRTIO_F_ACCESS_PLATFORM)))
- return false;
- /* Now we only support read-only configuration space */
- if ((config->device_id == VIRTIO_ID_BLOCK) &&
- (config->features & BIT_ULL(VIRTIO_BLK_F_CONFIG_WCE)))
- return false;
- else if ((config->device_id == VIRTIO_ID_NET) &&
- (config->features & BIT_ULL(VIRTIO_NET_F_CTRL_VQ)))
- return false;
- if ((config->device_id == VIRTIO_ID_NET) &&
- !(config->features & BIT_ULL(VIRTIO_F_VERSION_1)))
- return false;
- return true;
- }
- static bool vduse_validate_config(struct vduse_dev_config *config,
- u64 api_version)
- {
- if (!is_mem_zero((const char *)config->reserved,
- sizeof(config->reserved)))
- return false;
- if (api_version < VDUSE_API_VERSION_1 &&
- (config->ngroups || config->nas))
- return false;
- if (api_version >= VDUSE_API_VERSION_1) {
- if (!config->ngroups || config->ngroups > VDUSE_DEV_MAX_GROUPS)
- return false;
- if (!config->nas || config->nas > VDUSE_DEV_MAX_AS)
- return false;
- }
- if (config->vq_align > PAGE_SIZE)
- return false;
- if (config->config_size > PAGE_SIZE)
- return false;
- if (config->vq_num > 0xffff)
- return false;
- if (!config->name[0])
- return false;
- if (!device_is_allowed(config->device_id))
- return false;
- if (!features_is_valid(config))
- return false;
- return true;
- }
- static ssize_t msg_timeout_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- struct vduse_dev *dev = dev_get_drvdata(device);
- return sysfs_emit(buf, "%u\n", dev->msg_timeout);
- }
- static ssize_t msg_timeout_store(struct device *device,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct vduse_dev *dev = dev_get_drvdata(device);
- int ret;
- ret = kstrtouint(buf, 10, &dev->msg_timeout);
- if (ret < 0)
- return ret;
- return count;
- }
- static DEVICE_ATTR_RW(msg_timeout);
- static ssize_t bounce_size_show(struct device *device,
- struct device_attribute *attr, char *buf)
- {
- struct vduse_dev *dev = dev_get_drvdata(device);
- return sysfs_emit(buf, "%u\n", dev->bounce_size);
- }
- static ssize_t bounce_size_store(struct device *device,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct vduse_dev *dev = dev_get_drvdata(device);
- unsigned int bounce_size;
- int ret;
- ret = -EPERM;
- mutex_lock(&dev->domain_lock);
- /* Assuming that if the first domain is allocated, all are allocated */
- if (dev->as[0].domain)
- goto unlock;
- ret = kstrtouint(buf, 10, &bounce_size);
- if (ret < 0)
- goto unlock;
- ret = -EINVAL;
- if (bounce_size > VDUSE_MAX_BOUNCE_SIZE ||
- bounce_size < VDUSE_MIN_BOUNCE_SIZE)
- goto unlock;
- dev->bounce_size = bounce_size & PAGE_MASK;
- ret = count;
- unlock:
- mutex_unlock(&dev->domain_lock);
- return ret;
- }
- static DEVICE_ATTR_RW(bounce_size);
- static struct attribute *vduse_dev_attrs[] = {
- &dev_attr_msg_timeout.attr,
- &dev_attr_bounce_size.attr,
- NULL
- };
- ATTRIBUTE_GROUPS(vduse_dev);
- static int vduse_create_dev(struct vduse_dev_config *config,
- void *config_buf, u64 api_version)
- {
- int ret;
- struct vduse_dev *dev;
- ret = -EPERM;
- if ((config->device_id == VIRTIO_ID_NET) && !capable(CAP_NET_ADMIN))
- goto err;
- ret = -EEXIST;
- if (vduse_find_dev(config->name))
- goto err;
- ret = -ENOMEM;
- dev = vduse_dev_create();
- if (!dev)
- goto err;
- dev->api_version = api_version;
- dev->device_features = config->features;
- dev->device_id = config->device_id;
- dev->vendor_id = config->vendor_id;
- dev->nas = (dev->api_version < VDUSE_API_VERSION_1) ? 1 : config->nas;
- dev->as = kzalloc_objs(dev->as[0], dev->nas);
- if (!dev->as)
- goto err_as;
- for (int i = 0; i < dev->nas; i++)
- mutex_init(&dev->as[i].mem_lock);
- dev->ngroups = (dev->api_version < VDUSE_API_VERSION_1)
- ? 1
- : config->ngroups;
- dev->groups = kzalloc_objs(dev->groups[0], dev->ngroups);
- if (!dev->groups)
- goto err_vq_groups;
- for (u32 i = 0; i < dev->ngroups; ++i) {
- dev->groups[i].dev = dev;
- rwlock_init(&dev->groups[i].as_lock);
- dev->groups[i].as = &dev->as[0];
- }
- dev->name = kstrdup(config->name, GFP_KERNEL);
- if (!dev->name)
- goto err_str;
- dev->bounce_size = VDUSE_BOUNCE_SIZE;
- dev->config = config_buf;
- dev->config_size = config->config_size;
- ret = idr_alloc(&vduse_idr, dev, 1, VDUSE_DEV_MAX, GFP_KERNEL);
- if (ret < 0)
- goto err_idr;
- dev->minor = ret;
- dev->msg_timeout = VDUSE_MSG_DEFAULT_TIMEOUT;
- dev->dev = device_create_with_groups(&vduse_class, NULL,
- MKDEV(MAJOR(vduse_major), dev->minor),
- dev, vduse_dev_groups, "%s", config->name);
- if (IS_ERR(dev->dev)) {
- ret = PTR_ERR(dev->dev);
- goto err_dev;
- }
- ret = vduse_dev_init_vqs(dev, config->vq_align, config->vq_num);
- if (ret)
- goto err_vqs;
- __module_get(THIS_MODULE);
- return 0;
- err_vqs:
- device_destroy(&vduse_class, MKDEV(MAJOR(vduse_major), dev->minor));
- err_dev:
- idr_remove(&vduse_idr, dev->minor);
- err_idr:
- kfree(dev->name);
- err_str:
- kfree(dev->groups);
- err_vq_groups:
- kfree(dev->as);
- err_as:
- vduse_dev_destroy(dev);
- err:
- return ret;
- }
- static long vduse_ioctl(struct file *file, unsigned int cmd,
- unsigned long arg)
- {
- int ret;
- void __user *argp = (void __user *)arg;
- struct vduse_control *control = file->private_data;
- mutex_lock(&vduse_lock);
- switch (cmd) {
- case VDUSE_GET_API_VERSION:
- if (control->api_version == VDUSE_API_VERSION_NOT_ASKED)
- control->api_version = VDUSE_API_VERSION_1;
- ret = put_user(control->api_version, (u64 __user *)argp);
- break;
- case VDUSE_SET_API_VERSION: {
- u64 api_version;
- ret = -EFAULT;
- if (get_user(api_version, (u64 __user *)argp))
- break;
- ret = -EINVAL;
- if (api_version > VDUSE_API_VERSION_1)
- break;
- ret = 0;
- control->api_version = api_version;
- break;
- }
- case VDUSE_CREATE_DEV: {
- struct vduse_dev_config config;
- unsigned long size = offsetof(struct vduse_dev_config, config);
- void *buf;
- ret = -EFAULT;
- if (copy_from_user(&config, argp, size))
- break;
- ret = -EINVAL;
- if (control->api_version == VDUSE_API_VERSION_NOT_ASKED)
- control->api_version = VDUSE_API_VERSION;
- if (!vduse_validate_config(&config, control->api_version))
- break;
- buf = vmemdup_user(argp + size, config.config_size);
- if (IS_ERR(buf)) {
- ret = PTR_ERR(buf);
- break;
- }
- config.name[VDUSE_NAME_MAX - 1] = '\0';
- ret = vduse_create_dev(&config, buf, control->api_version);
- if (ret)
- kvfree(buf);
- break;
- }
- case VDUSE_DESTROY_DEV: {
- char name[VDUSE_NAME_MAX];
- ret = -EFAULT;
- if (copy_from_user(name, argp, VDUSE_NAME_MAX))
- break;
- name[VDUSE_NAME_MAX - 1] = '\0';
- ret = vduse_destroy_dev(name);
- break;
- }
- default:
- ret = -EINVAL;
- break;
- }
- mutex_unlock(&vduse_lock);
- return ret;
- }
- static int vduse_release(struct inode *inode, struct file *file)
- {
- struct vduse_control *control = file->private_data;
- kfree(control);
- return 0;
- }
- static int vduse_open(struct inode *inode, struct file *file)
- {
- struct vduse_control *control;
- control = kmalloc_obj(struct vduse_control);
- if (!control)
- return -ENOMEM;
- control->api_version = VDUSE_API_VERSION_NOT_ASKED;
- file->private_data = control;
- return 0;
- }
- static const struct file_operations vduse_ctrl_fops = {
- .owner = THIS_MODULE,
- .open = vduse_open,
- .release = vduse_release,
- .unlocked_ioctl = vduse_ioctl,
- .compat_ioctl = compat_ptr_ioctl,
- .llseek = noop_llseek,
- };
- struct vduse_mgmt_dev {
- struct vdpa_mgmt_dev mgmt_dev;
- struct device dev;
- };
- static struct vduse_mgmt_dev *vduse_mgmt;
- static int vduse_dev_init_vdpa(struct vduse_dev *dev, const char *name)
- {
- struct vduse_vdpa *vdev;
- if (dev->vdev)
- return -EEXIST;
- vdev = vdpa_alloc_device(struct vduse_vdpa, vdpa, dev->dev,
- &vduse_vdpa_config_ops, &vduse_map_ops,
- dev->ngroups, dev->nas, name, true);
- if (IS_ERR(vdev))
- return PTR_ERR(vdev);
- dev->vdev = vdev;
- vdev->dev = dev;
- vdev->vdpa.mdev = &vduse_mgmt->mgmt_dev;
- return 0;
- }
- static int vdpa_dev_add(struct vdpa_mgmt_dev *mdev, const char *name,
- const struct vdpa_dev_set_config *config)
- {
- struct vduse_dev *dev;
- size_t domain_bounce_size;
- int ret, i;
- mutex_lock(&vduse_lock);
- dev = vduse_find_dev(name);
- if (!dev || !vduse_dev_is_ready(dev)) {
- mutex_unlock(&vduse_lock);
- return -EINVAL;
- }
- ret = vduse_dev_init_vdpa(dev, name);
- mutex_unlock(&vduse_lock);
- if (ret)
- return ret;
- mutex_lock(&dev->domain_lock);
- ret = 0;
- domain_bounce_size = dev->bounce_size / dev->nas;
- for (i = 0; i < dev->nas; ++i) {
- dev->as[i].domain = vduse_domain_create(VDUSE_IOVA_SIZE - 1,
- domain_bounce_size);
- if (!dev->as[i].domain) {
- ret = -ENOMEM;
- goto err;
- }
- }
- mutex_unlock(&dev->domain_lock);
- ret = _vdpa_register_device(&dev->vdev->vdpa, dev->vq_num);
- if (ret)
- goto err_register;
- return 0;
- err_register:
- mutex_lock(&dev->domain_lock);
- err:
- for (int j = 0; j < i; j++) {
- if (dev->as[j].domain) {
- vduse_domain_destroy(dev->as[j].domain);
- dev->as[j].domain = NULL;
- }
- }
- mutex_unlock(&dev->domain_lock);
- put_device(&dev->vdev->vdpa.dev);
- return ret;
- }
- static void vdpa_dev_del(struct vdpa_mgmt_dev *mdev, struct vdpa_device *dev)
- {
- _vdpa_unregister_device(dev);
- }
- static const struct vdpa_mgmtdev_ops vdpa_dev_mgmtdev_ops = {
- .dev_add = vdpa_dev_add,
- .dev_del = vdpa_dev_del,
- };
- static struct virtio_device_id id_table[] = {
- { VIRTIO_ID_BLOCK, VIRTIO_DEV_ANY_ID },
- { VIRTIO_ID_NET, VIRTIO_DEV_ANY_ID },
- { 0 },
- };
- static void vduse_mgmtdev_release(struct device *dev)
- {
- struct vduse_mgmt_dev *mgmt_dev;
- mgmt_dev = container_of(dev, struct vduse_mgmt_dev, dev);
- kfree(mgmt_dev);
- }
- static int vduse_mgmtdev_init(void)
- {
- int ret;
- vduse_mgmt = kzalloc_obj(*vduse_mgmt);
- if (!vduse_mgmt)
- return -ENOMEM;
- ret = dev_set_name(&vduse_mgmt->dev, "vduse");
- if (ret) {
- kfree(vduse_mgmt);
- return ret;
- }
- vduse_mgmt->dev.release = vduse_mgmtdev_release;
- ret = device_register(&vduse_mgmt->dev);
- if (ret)
- goto dev_reg_err;
- vduse_mgmt->mgmt_dev.id_table = id_table;
- vduse_mgmt->mgmt_dev.ops = &vdpa_dev_mgmtdev_ops;
- vduse_mgmt->mgmt_dev.device = &vduse_mgmt->dev;
- ret = vdpa_mgmtdev_register(&vduse_mgmt->mgmt_dev);
- if (ret)
- device_unregister(&vduse_mgmt->dev);
- return ret;
- dev_reg_err:
- put_device(&vduse_mgmt->dev);
- return ret;
- }
- static void vduse_mgmtdev_exit(void)
- {
- vdpa_mgmtdev_unregister(&vduse_mgmt->mgmt_dev);
- device_unregister(&vduse_mgmt->dev);
- }
- static int vduse_init(void)
- {
- int ret;
- struct device *dev;
- ret = class_register(&vduse_class);
- if (ret)
- return ret;
- ret = alloc_chrdev_region(&vduse_major, 0, VDUSE_DEV_MAX, "vduse");
- if (ret)
- goto err_chardev_region;
- /* /dev/vduse/control */
- cdev_init(&vduse_ctrl_cdev, &vduse_ctrl_fops);
- vduse_ctrl_cdev.owner = THIS_MODULE;
- ret = cdev_add(&vduse_ctrl_cdev, vduse_major, 1);
- if (ret)
- goto err_ctrl_cdev;
- dev = device_create(&vduse_class, NULL, vduse_major, NULL, "control");
- if (IS_ERR(dev)) {
- ret = PTR_ERR(dev);
- goto err_device;
- }
- /* /dev/vduse/$DEVICE */
- cdev_init(&vduse_cdev, &vduse_dev_fops);
- vduse_cdev.owner = THIS_MODULE;
- ret = cdev_add(&vduse_cdev, MKDEV(MAJOR(vduse_major), 1),
- VDUSE_DEV_MAX - 1);
- if (ret)
- goto err_cdev;
- ret = -ENOMEM;
- vduse_irq_wq = alloc_workqueue("vduse-irq",
- WQ_HIGHPRI | WQ_SYSFS | WQ_UNBOUND, 0);
- if (!vduse_irq_wq)
- goto err_wq;
- vduse_irq_bound_wq = alloc_workqueue("vduse-irq-bound",
- WQ_HIGHPRI | WQ_PERCPU, 0);
- if (!vduse_irq_bound_wq)
- goto err_bound_wq;
- ret = vduse_domain_init();
- if (ret)
- goto err_domain;
- ret = vduse_mgmtdev_init();
- if (ret)
- goto err_mgmtdev;
- return 0;
- err_mgmtdev:
- vduse_domain_exit();
- err_domain:
- destroy_workqueue(vduse_irq_bound_wq);
- err_bound_wq:
- destroy_workqueue(vduse_irq_wq);
- err_wq:
- cdev_del(&vduse_cdev);
- err_cdev:
- device_destroy(&vduse_class, vduse_major);
- err_device:
- cdev_del(&vduse_ctrl_cdev);
- err_ctrl_cdev:
- unregister_chrdev_region(vduse_major, VDUSE_DEV_MAX);
- err_chardev_region:
- class_unregister(&vduse_class);
- return ret;
- }
- module_init(vduse_init);
- static void vduse_exit(void)
- {
- vduse_mgmtdev_exit();
- vduse_domain_exit();
- destroy_workqueue(vduse_irq_bound_wq);
- destroy_workqueue(vduse_irq_wq);
- cdev_del(&vduse_cdev);
- device_destroy(&vduse_class, vduse_major);
- cdev_del(&vduse_ctrl_cdev);
- unregister_chrdev_region(vduse_major, VDUSE_DEV_MAX);
- class_unregister(&vduse_class);
- idr_destroy(&vduse_idr);
- }
- module_exit(vduse_exit);
- MODULE_LICENSE(DRV_LICENSE);
- MODULE_AUTHOR(DRV_AUTHOR);
- MODULE_DESCRIPTION(DRV_DESC);
|