blob: 1d77ce16360a43311ddeeda3159c4aa567cf3ebb [file] [log] [blame]
Avi Kivitybfd99ff2009-08-26 14:57:50 +03001/*
2 * Kernel-based Virtual Machine - device assignment support
3 *
Avi Kivity221d0592010-05-23 18:37:00 +03004 * Copyright (C) 2010 Red Hat, Inc. and/or its affiliates.
Avi Kivitybfd99ff2009-08-26 14:57:50 +03005 *
6 * This work is licensed under the terms of the GNU GPL, version 2. See
7 * the COPYING file in the top-level directory.
8 *
9 */
10
11#include <linux/kvm_host.h>
12#include <linux/kvm.h>
13#include <linux/uaccess.h>
14#include <linux/vmalloc.h>
15#include <linux/errno.h>
16#include <linux/spinlock.h>
17#include <linux/pci.h>
18#include <linux/interrupt.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090019#include <linux/slab.h>
Avi Kivitybfd99ff2009-08-26 14:57:50 +030020#include "irq.h"
21
22static struct kvm_assigned_dev_kernel *kvm_find_assigned_dev(struct list_head *head,
23 int assigned_dev_id)
24{
25 struct list_head *ptr;
26 struct kvm_assigned_dev_kernel *match;
27
28 list_for_each(ptr, head) {
29 match = list_entry(ptr, struct kvm_assigned_dev_kernel, list);
30 if (match->assigned_dev_id == assigned_dev_id)
31 return match;
32 }
33 return NULL;
34}
35
36static int find_index_from_host_irq(struct kvm_assigned_dev_kernel
37 *assigned_dev, int irq)
38{
39 int i, index;
40 struct msix_entry *host_msix_entries;
41
42 host_msix_entries = assigned_dev->host_msix_entries;
43
44 index = -1;
45 for (i = 0; i < assigned_dev->entries_nr; i++)
46 if (irq == host_msix_entries[i].vector) {
47 index = i;
48 break;
49 }
50 if (index < 0) {
51 printk(KERN_WARNING "Fail to find correlated MSI-X entry!\n");
52 return 0;
53 }
54
55 return index;
56}
57
Jan Kiszka06452112010-11-16 22:30:03 +010058static irqreturn_t kvm_assigned_dev_thread(int irq, void *dev_id)
Avi Kivitybfd99ff2009-08-26 14:57:50 +030059{
Jan Kiszka06452112010-11-16 22:30:03 +010060 struct kvm_assigned_dev_kernel *assigned_dev = dev_id;
61 u32 vector;
62 int index;
Avi Kivitybfd99ff2009-08-26 14:57:50 +030063
Jan Kiszka06452112010-11-16 22:30:03 +010064 if (assigned_dev->irq_requested_type & KVM_DEV_IRQ_HOST_INTX) {
65 spin_lock(&assigned_dev->intx_lock);
66 disable_irq_nosync(irq);
67 assigned_dev->host_irq_disabled = true;
68 spin_unlock(&assigned_dev->intx_lock);
69 }
Avi Kivitybfd99ff2009-08-26 14:57:50 +030070
Avi Kivitybfd99ff2009-08-26 14:57:50 +030071 if (assigned_dev->irq_requested_type & KVM_DEV_IRQ_HOST_MSIX) {
Jan Kiszka06452112010-11-16 22:30:03 +010072 index = find_index_from_host_irq(assigned_dev, irq);
73 if (index >= 0) {
74 vector = assigned_dev->
75 guest_msix_entries[index].vector;
Avi Kivitybfd99ff2009-08-26 14:57:50 +030076 kvm_set_irq(assigned_dev->kvm,
Jan Kiszka06452112010-11-16 22:30:03 +010077 assigned_dev->irq_source_id, vector, 1);
Avi Kivitybfd99ff2009-08-26 14:57:50 +030078 }
79 } else
80 kvm_set_irq(assigned_dev->kvm, assigned_dev->irq_source_id,
81 assigned_dev->guest_irq, 1);
82
Avi Kivitybfd99ff2009-08-26 14:57:50 +030083 return IRQ_HANDLED;
84}
85
86/* Ack the irq line for an assigned device */
87static void kvm_assigned_dev_ack_irq(struct kvm_irq_ack_notifier *kian)
88{
89 struct kvm_assigned_dev_kernel *dev;
Avi Kivitybfd99ff2009-08-26 14:57:50 +030090
91 if (kian->gsi == -1)
92 return;
93
94 dev = container_of(kian, struct kvm_assigned_dev_kernel,
95 ack_notifier);
96
97 kvm_set_irq(dev->kvm, dev->irq_source_id, dev->guest_irq, 0);
98
99 /* The guest irq may be shared so this ack may be
100 * from another device.
101 */
Jan Kiszka06452112010-11-16 22:30:03 +0100102 spin_lock(&dev->intx_lock);
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300103 if (dev->host_irq_disabled) {
104 enable_irq(dev->host_irq);
105 dev->host_irq_disabled = false;
106 }
Jan Kiszka06452112010-11-16 22:30:03 +0100107 spin_unlock(&dev->intx_lock);
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300108}
109
110static void deassign_guest_irq(struct kvm *kvm,
111 struct kvm_assigned_dev_kernel *assigned_dev)
112{
113 kvm_unregister_irq_ack_notifier(kvm, &assigned_dev->ack_notifier);
114 assigned_dev->ack_notifier.gsi = -1;
115
Jan Kiszka0c106b52010-11-16 22:30:02 +0100116 kvm_set_irq(assigned_dev->kvm, assigned_dev->irq_source_id,
117 assigned_dev->guest_irq, 0);
118
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300119 if (assigned_dev->irq_source_id != -1)
120 kvm_free_irq_source_id(kvm, assigned_dev->irq_source_id);
121 assigned_dev->irq_source_id = -1;
122 assigned_dev->irq_requested_type &= ~(KVM_DEV_IRQ_GUEST_MASK);
123}
124
125/* The function implicit hold kvm->lock mutex due to cancel_work_sync() */
126static void deassign_host_irq(struct kvm *kvm,
127 struct kvm_assigned_dev_kernel *assigned_dev)
128{
129 /*
Jan Kiszka06452112010-11-16 22:30:03 +0100130 * We disable irq here to prevent further events.
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300131 *
132 * Notice this maybe result in nested disable if the interrupt type is
133 * INTx, but it's OK for we are going to free it.
134 *
135 * If this function is a part of VM destroy, please ensure that till
136 * now, the kvm state is still legal for probably we also have to wait
Jan Kiszka06452112010-11-16 22:30:03 +0100137 * on a currently running IRQ handler.
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300138 */
139 if (assigned_dev->irq_requested_type & KVM_DEV_IRQ_HOST_MSIX) {
140 int i;
141 for (i = 0; i < assigned_dev->entries_nr; i++)
Jan Kiszka06452112010-11-16 22:30:03 +0100142 disable_irq(assigned_dev->host_msix_entries[i].vector);
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300143
144 for (i = 0; i < assigned_dev->entries_nr; i++)
145 free_irq(assigned_dev->host_msix_entries[i].vector,
146 (void *)assigned_dev);
147
148 assigned_dev->entries_nr = 0;
149 kfree(assigned_dev->host_msix_entries);
150 kfree(assigned_dev->guest_msix_entries);
151 pci_disable_msix(assigned_dev->dev);
152 } else {
153 /* Deal with MSI and INTx */
Jan Kiszka06452112010-11-16 22:30:03 +0100154 disable_irq(assigned_dev->host_irq);
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300155
156 free_irq(assigned_dev->host_irq, (void *)assigned_dev);
157
158 if (assigned_dev->irq_requested_type & KVM_DEV_IRQ_HOST_MSI)
159 pci_disable_msi(assigned_dev->dev);
160 }
161
162 assigned_dev->irq_requested_type &= ~(KVM_DEV_IRQ_HOST_MASK);
163}
164
165static int kvm_deassign_irq(struct kvm *kvm,
166 struct kvm_assigned_dev_kernel *assigned_dev,
167 unsigned long irq_requested_type)
168{
169 unsigned long guest_irq_type, host_irq_type;
170
171 if (!irqchip_in_kernel(kvm))
172 return -EINVAL;
173 /* no irq assignment to deassign */
174 if (!assigned_dev->irq_requested_type)
175 return -ENXIO;
176
177 host_irq_type = irq_requested_type & KVM_DEV_IRQ_HOST_MASK;
178 guest_irq_type = irq_requested_type & KVM_DEV_IRQ_GUEST_MASK;
179
180 if (host_irq_type)
181 deassign_host_irq(kvm, assigned_dev);
182 if (guest_irq_type)
183 deassign_guest_irq(kvm, assigned_dev);
184
185 return 0;
186}
187
188static void kvm_free_assigned_irq(struct kvm *kvm,
189 struct kvm_assigned_dev_kernel *assigned_dev)
190{
191 kvm_deassign_irq(kvm, assigned_dev, assigned_dev->irq_requested_type);
192}
193
194static void kvm_free_assigned_device(struct kvm *kvm,
195 struct kvm_assigned_dev_kernel
196 *assigned_dev)
197{
198 kvm_free_assigned_irq(kvm, assigned_dev);
199
200 pci_reset_function(assigned_dev->dev);
201
202 pci_release_regions(assigned_dev->dev);
203 pci_disable_device(assigned_dev->dev);
204 pci_dev_put(assigned_dev->dev);
205
206 list_del(&assigned_dev->list);
207 kfree(assigned_dev);
208}
209
210void kvm_free_all_assigned_devices(struct kvm *kvm)
211{
212 struct list_head *ptr, *ptr2;
213 struct kvm_assigned_dev_kernel *assigned_dev;
214
215 list_for_each_safe(ptr, ptr2, &kvm->arch.assigned_dev_head) {
216 assigned_dev = list_entry(ptr,
217 struct kvm_assigned_dev_kernel,
218 list);
219
220 kvm_free_assigned_device(kvm, assigned_dev);
221 }
222}
223
224static int assigned_device_enable_host_intx(struct kvm *kvm,
225 struct kvm_assigned_dev_kernel *dev)
226{
227 dev->host_irq = dev->dev->irq;
228 /* Even though this is PCI, we don't want to use shared
229 * interrupts. Sharing host devices with guest-assigned devices
230 * on the same interrupt line is not a happy situation: there
231 * are going to be long delays in accepting, acking, etc.
232 */
Jan Kiszka06452112010-11-16 22:30:03 +0100233 if (request_threaded_irq(dev->host_irq, NULL, kvm_assigned_dev_thread,
234 IRQF_ONESHOT, "kvm_assigned_intx_device",
235 (void *)dev))
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300236 return -EIO;
237 return 0;
238}
239
240#ifdef __KVM_HAVE_MSI
241static int assigned_device_enable_host_msi(struct kvm *kvm,
242 struct kvm_assigned_dev_kernel *dev)
243{
244 int r;
245
246 if (!dev->dev->msi_enabled) {
247 r = pci_enable_msi(dev->dev);
248 if (r)
249 return r;
250 }
251
252 dev->host_irq = dev->dev->irq;
Jan Kiszka06452112010-11-16 22:30:03 +0100253 if (request_threaded_irq(dev->host_irq, NULL, kvm_assigned_dev_thread,
254 0, "kvm_assigned_msi_device", (void *)dev)) {
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300255 pci_disable_msi(dev->dev);
256 return -EIO;
257 }
258
259 return 0;
260}
261#endif
262
263#ifdef __KVM_HAVE_MSIX
264static int assigned_device_enable_host_msix(struct kvm *kvm,
265 struct kvm_assigned_dev_kernel *dev)
266{
267 int i, r = -EINVAL;
268
269 /* host_msix_entries and guest_msix_entries should have been
270 * initialized */
271 if (dev->entries_nr == 0)
272 return r;
273
274 r = pci_enable_msix(dev->dev, dev->host_msix_entries, dev->entries_nr);
275 if (r)
276 return r;
277
278 for (i = 0; i < dev->entries_nr; i++) {
Jan Kiszka06452112010-11-16 22:30:03 +0100279 r = request_threaded_irq(dev->host_msix_entries[i].vector,
280 NULL, kvm_assigned_dev_thread,
281 0, "kvm_assigned_msix_device",
282 (void *)dev);
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300283 if (r)
jing zhangd57e2c02010-03-13 15:00:45 +0800284 goto err;
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300285 }
286
287 return 0;
jing zhangd57e2c02010-03-13 15:00:45 +0800288err:
289 for (i -= 1; i >= 0; i--)
290 free_irq(dev->host_msix_entries[i].vector, (void *)dev);
291 pci_disable_msix(dev->dev);
292 return r;
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300293}
294
295#endif
296
297static int assigned_device_enable_guest_intx(struct kvm *kvm,
298 struct kvm_assigned_dev_kernel *dev,
299 struct kvm_assigned_irq *irq)
300{
301 dev->guest_irq = irq->guest_irq;
302 dev->ack_notifier.gsi = irq->guest_irq;
303 return 0;
304}
305
306#ifdef __KVM_HAVE_MSI
307static int assigned_device_enable_guest_msi(struct kvm *kvm,
308 struct kvm_assigned_dev_kernel *dev,
309 struct kvm_assigned_irq *irq)
310{
311 dev->guest_irq = irq->guest_irq;
312 dev->ack_notifier.gsi = -1;
313 dev->host_irq_disabled = false;
314 return 0;
315}
316#endif
317
318#ifdef __KVM_HAVE_MSIX
319static int assigned_device_enable_guest_msix(struct kvm *kvm,
320 struct kvm_assigned_dev_kernel *dev,
321 struct kvm_assigned_irq *irq)
322{
323 dev->guest_irq = irq->guest_irq;
324 dev->ack_notifier.gsi = -1;
325 dev->host_irq_disabled = false;
326 return 0;
327}
328#endif
329
330static int assign_host_irq(struct kvm *kvm,
331 struct kvm_assigned_dev_kernel *dev,
332 __u32 host_irq_type)
333{
334 int r = -EEXIST;
335
336 if (dev->irq_requested_type & KVM_DEV_IRQ_HOST_MASK)
337 return r;
338
339 switch (host_irq_type) {
340 case KVM_DEV_IRQ_HOST_INTX:
341 r = assigned_device_enable_host_intx(kvm, dev);
342 break;
343#ifdef __KVM_HAVE_MSI
344 case KVM_DEV_IRQ_HOST_MSI:
345 r = assigned_device_enable_host_msi(kvm, dev);
346 break;
347#endif
348#ifdef __KVM_HAVE_MSIX
349 case KVM_DEV_IRQ_HOST_MSIX:
350 r = assigned_device_enable_host_msix(kvm, dev);
351 break;
352#endif
353 default:
354 r = -EINVAL;
355 }
356
357 if (!r)
358 dev->irq_requested_type |= host_irq_type;
359
360 return r;
361}
362
363static int assign_guest_irq(struct kvm *kvm,
364 struct kvm_assigned_dev_kernel *dev,
365 struct kvm_assigned_irq *irq,
366 unsigned long guest_irq_type)
367{
368 int id;
369 int r = -EEXIST;
370
371 if (dev->irq_requested_type & KVM_DEV_IRQ_GUEST_MASK)
372 return r;
373
374 id = kvm_request_irq_source_id(kvm);
375 if (id < 0)
376 return id;
377
378 dev->irq_source_id = id;
379
380 switch (guest_irq_type) {
381 case KVM_DEV_IRQ_GUEST_INTX:
382 r = assigned_device_enable_guest_intx(kvm, dev, irq);
383 break;
384#ifdef __KVM_HAVE_MSI
385 case KVM_DEV_IRQ_GUEST_MSI:
386 r = assigned_device_enable_guest_msi(kvm, dev, irq);
387 break;
388#endif
389#ifdef __KVM_HAVE_MSIX
390 case KVM_DEV_IRQ_GUEST_MSIX:
391 r = assigned_device_enable_guest_msix(kvm, dev, irq);
392 break;
393#endif
394 default:
395 r = -EINVAL;
396 }
397
398 if (!r) {
399 dev->irq_requested_type |= guest_irq_type;
400 kvm_register_irq_ack_notifier(kvm, &dev->ack_notifier);
401 } else
402 kvm_free_irq_source_id(kvm, dev->irq_source_id);
403
404 return r;
405}
406
407/* TODO Deal with KVM_DEV_IRQ_ASSIGNED_MASK_MSIX */
408static int kvm_vm_ioctl_assign_irq(struct kvm *kvm,
409 struct kvm_assigned_irq *assigned_irq)
410{
411 int r = -EINVAL;
412 struct kvm_assigned_dev_kernel *match;
413 unsigned long host_irq_type, guest_irq_type;
414
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300415 if (!irqchip_in_kernel(kvm))
416 return r;
417
418 mutex_lock(&kvm->lock);
419 r = -ENODEV;
420 match = kvm_find_assigned_dev(&kvm->arch.assigned_dev_head,
421 assigned_irq->assigned_dev_id);
422 if (!match)
423 goto out;
424
425 host_irq_type = (assigned_irq->flags & KVM_DEV_IRQ_HOST_MASK);
426 guest_irq_type = (assigned_irq->flags & KVM_DEV_IRQ_GUEST_MASK);
427
428 r = -EINVAL;
429 /* can only assign one type at a time */
430 if (hweight_long(host_irq_type) > 1)
431 goto out;
432 if (hweight_long(guest_irq_type) > 1)
433 goto out;
434 if (host_irq_type == 0 && guest_irq_type == 0)
435 goto out;
436
437 r = 0;
438 if (host_irq_type)
439 r = assign_host_irq(kvm, match, host_irq_type);
440 if (r)
441 goto out;
442
443 if (guest_irq_type)
444 r = assign_guest_irq(kvm, match, assigned_irq, guest_irq_type);
445out:
446 mutex_unlock(&kvm->lock);
447 return r;
448}
449
450static int kvm_vm_ioctl_deassign_dev_irq(struct kvm *kvm,
451 struct kvm_assigned_irq
452 *assigned_irq)
453{
454 int r = -ENODEV;
455 struct kvm_assigned_dev_kernel *match;
456
457 mutex_lock(&kvm->lock);
458
459 match = kvm_find_assigned_dev(&kvm->arch.assigned_dev_head,
460 assigned_irq->assigned_dev_id);
461 if (!match)
462 goto out;
463
464 r = kvm_deassign_irq(kvm, match, assigned_irq->flags);
465out:
466 mutex_unlock(&kvm->lock);
467 return r;
468}
469
470static int kvm_vm_ioctl_assign_device(struct kvm *kvm,
471 struct kvm_assigned_pci_dev *assigned_dev)
472{
Marcelo Tosattibc6678a2009-12-23 14:35:21 -0200473 int r = 0, idx;
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300474 struct kvm_assigned_dev_kernel *match;
475 struct pci_dev *dev;
476
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300477 mutex_lock(&kvm->lock);
Marcelo Tosattibc6678a2009-12-23 14:35:21 -0200478 idx = srcu_read_lock(&kvm->srcu);
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300479
480 match = kvm_find_assigned_dev(&kvm->arch.assigned_dev_head,
481 assigned_dev->assigned_dev_id);
482 if (match) {
483 /* device already assigned */
484 r = -EEXIST;
485 goto out;
486 }
487
488 match = kzalloc(sizeof(struct kvm_assigned_dev_kernel), GFP_KERNEL);
489 if (match == NULL) {
490 printk(KERN_INFO "%s: Couldn't allocate memory\n",
491 __func__);
492 r = -ENOMEM;
493 goto out;
494 }
Zhai, Edwinab9f4ec2010-01-29 14:38:44 +0800495 dev = pci_get_domain_bus_and_slot(assigned_dev->segnr,
496 assigned_dev->busnr,
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300497 assigned_dev->devfn);
498 if (!dev) {
499 printk(KERN_INFO "%s: host device not found\n", __func__);
500 r = -EINVAL;
501 goto out_free;
502 }
503 if (pci_enable_device(dev)) {
504 printk(KERN_INFO "%s: Could not enable PCI device\n", __func__);
505 r = -EBUSY;
506 goto out_put;
507 }
508 r = pci_request_regions(dev, "kvm_assigned_device");
509 if (r) {
510 printk(KERN_INFO "%s: Could not get access to device regions\n",
511 __func__);
512 goto out_disable;
513 }
514
515 pci_reset_function(dev);
516
517 match->assigned_dev_id = assigned_dev->assigned_dev_id;
Zhai, Edwinab9f4ec2010-01-29 14:38:44 +0800518 match->host_segnr = assigned_dev->segnr;
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300519 match->host_busnr = assigned_dev->busnr;
520 match->host_devfn = assigned_dev->devfn;
521 match->flags = assigned_dev->flags;
522 match->dev = dev;
Jan Kiszka06452112010-11-16 22:30:03 +0100523 spin_lock_init(&match->intx_lock);
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300524 match->irq_source_id = -1;
525 match->kvm = kvm;
526 match->ack_notifier.irq_acked = kvm_assigned_dev_ack_irq;
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300527
528 list_add(&match->list, &kvm->arch.assigned_dev_head);
529
530 if (assigned_dev->flags & KVM_DEV_ASSIGN_ENABLE_IOMMU) {
531 if (!kvm->arch.iommu_domain) {
532 r = kvm_iommu_map_guest(kvm);
533 if (r)
534 goto out_list_del;
535 }
536 r = kvm_assign_device(kvm, match);
537 if (r)
538 goto out_list_del;
539 }
540
541out:
Marcelo Tosattibc6678a2009-12-23 14:35:21 -0200542 srcu_read_unlock(&kvm->srcu, idx);
Sheng Yangfae3a352009-12-15 10:28:07 +0800543 mutex_unlock(&kvm->lock);
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300544 return r;
545out_list_del:
546 list_del(&match->list);
547 pci_release_regions(dev);
548out_disable:
549 pci_disable_device(dev);
550out_put:
551 pci_dev_put(dev);
552out_free:
553 kfree(match);
Marcelo Tosattibc6678a2009-12-23 14:35:21 -0200554 srcu_read_unlock(&kvm->srcu, idx);
Sheng Yangfae3a352009-12-15 10:28:07 +0800555 mutex_unlock(&kvm->lock);
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300556 return r;
557}
558
559static int kvm_vm_ioctl_deassign_device(struct kvm *kvm,
560 struct kvm_assigned_pci_dev *assigned_dev)
561{
562 int r = 0;
563 struct kvm_assigned_dev_kernel *match;
564
565 mutex_lock(&kvm->lock);
566
567 match = kvm_find_assigned_dev(&kvm->arch.assigned_dev_head,
568 assigned_dev->assigned_dev_id);
569 if (!match) {
570 printk(KERN_INFO "%s: device hasn't been assigned before, "
571 "so cannot be deassigned\n", __func__);
572 r = -EINVAL;
573 goto out;
574 }
575
576 if (match->flags & KVM_DEV_ASSIGN_ENABLE_IOMMU)
577 kvm_deassign_device(kvm, match);
578
579 kvm_free_assigned_device(kvm, match);
580
581out:
582 mutex_unlock(&kvm->lock);
583 return r;
584}
585
586
587#ifdef __KVM_HAVE_MSIX
588static int kvm_vm_ioctl_set_msix_nr(struct kvm *kvm,
589 struct kvm_assigned_msix_nr *entry_nr)
590{
591 int r = 0;
592 struct kvm_assigned_dev_kernel *adev;
593
594 mutex_lock(&kvm->lock);
595
596 adev = kvm_find_assigned_dev(&kvm->arch.assigned_dev_head,
597 entry_nr->assigned_dev_id);
598 if (!adev) {
599 r = -EINVAL;
600 goto msix_nr_out;
601 }
602
603 if (adev->entries_nr == 0) {
604 adev->entries_nr = entry_nr->entry_nr;
605 if (adev->entries_nr == 0 ||
606 adev->entries_nr >= KVM_MAX_MSIX_PER_DEV) {
607 r = -EINVAL;
608 goto msix_nr_out;
609 }
610
611 adev->host_msix_entries = kzalloc(sizeof(struct msix_entry) *
612 entry_nr->entry_nr,
613 GFP_KERNEL);
614 if (!adev->host_msix_entries) {
615 r = -ENOMEM;
616 goto msix_nr_out;
617 }
Jan Kiszka06452112010-11-16 22:30:03 +0100618 adev->guest_msix_entries =
619 kzalloc(sizeof(struct msix_entry) * entry_nr->entry_nr,
620 GFP_KERNEL);
Avi Kivitybfd99ff2009-08-26 14:57:50 +0300621 if (!adev->guest_msix_entries) {
622 kfree(adev->host_msix_entries);
623 r = -ENOMEM;
624 goto msix_nr_out;
625 }
626 } else /* Not allowed set MSI-X number twice */
627 r = -EINVAL;
628msix_nr_out:
629 mutex_unlock(&kvm->lock);
630 return r;
631}
632
633static int kvm_vm_ioctl_set_msix_entry(struct kvm *kvm,
634 struct kvm_assigned_msix_entry *entry)
635{
636 int r = 0, i;
637 struct kvm_assigned_dev_kernel *adev;
638
639 mutex_lock(&kvm->lock);
640
641 adev = kvm_find_assigned_dev(&kvm->arch.assigned_dev_head,
642 entry->assigned_dev_id);
643
644 if (!adev) {
645 r = -EINVAL;
646 goto msix_entry_out;
647 }
648
649 for (i = 0; i < adev->entries_nr; i++)
650 if (adev->guest_msix_entries[i].vector == 0 ||
651 adev->guest_msix_entries[i].entry == entry->entry) {
652 adev->guest_msix_entries[i].entry = entry->entry;
653 adev->guest_msix_entries[i].vector = entry->gsi;
654 adev->host_msix_entries[i].entry = entry->entry;
655 break;
656 }
657 if (i == adev->entries_nr) {
658 r = -ENOSPC;
659 goto msix_entry_out;
660 }
661
662msix_entry_out:
663 mutex_unlock(&kvm->lock);
664
665 return r;
666}
667#endif
668
669long kvm_vm_ioctl_assigned_device(struct kvm *kvm, unsigned ioctl,
670 unsigned long arg)
671{
672 void __user *argp = (void __user *)arg;
673 int r = -ENOTTY;
674
675 switch (ioctl) {
676 case KVM_ASSIGN_PCI_DEVICE: {
677 struct kvm_assigned_pci_dev assigned_dev;
678
679 r = -EFAULT;
680 if (copy_from_user(&assigned_dev, argp, sizeof assigned_dev))
681 goto out;
682 r = kvm_vm_ioctl_assign_device(kvm, &assigned_dev);
683 if (r)
684 goto out;
685 break;
686 }
687 case KVM_ASSIGN_IRQ: {
688 r = -EOPNOTSUPP;
689 break;
690 }
691#ifdef KVM_CAP_ASSIGN_DEV_IRQ
692 case KVM_ASSIGN_DEV_IRQ: {
693 struct kvm_assigned_irq assigned_irq;
694
695 r = -EFAULT;
696 if (copy_from_user(&assigned_irq, argp, sizeof assigned_irq))
697 goto out;
698 r = kvm_vm_ioctl_assign_irq(kvm, &assigned_irq);
699 if (r)
700 goto out;
701 break;
702 }
703 case KVM_DEASSIGN_DEV_IRQ: {
704 struct kvm_assigned_irq assigned_irq;
705
706 r = -EFAULT;
707 if (copy_from_user(&assigned_irq, argp, sizeof assigned_irq))
708 goto out;
709 r = kvm_vm_ioctl_deassign_dev_irq(kvm, &assigned_irq);
710 if (r)
711 goto out;
712 break;
713 }
714#endif
715#ifdef KVM_CAP_DEVICE_DEASSIGNMENT
716 case KVM_DEASSIGN_PCI_DEVICE: {
717 struct kvm_assigned_pci_dev assigned_dev;
718
719 r = -EFAULT;
720 if (copy_from_user(&assigned_dev, argp, sizeof assigned_dev))
721 goto out;
722 r = kvm_vm_ioctl_deassign_device(kvm, &assigned_dev);
723 if (r)
724 goto out;
725 break;
726 }
727#endif
728#ifdef KVM_CAP_IRQ_ROUTING
729 case KVM_SET_GSI_ROUTING: {
730 struct kvm_irq_routing routing;
731 struct kvm_irq_routing __user *urouting;
732 struct kvm_irq_routing_entry *entries;
733
734 r = -EFAULT;
735 if (copy_from_user(&routing, argp, sizeof(routing)))
736 goto out;
737 r = -EINVAL;
738 if (routing.nr >= KVM_MAX_IRQ_ROUTES)
739 goto out;
740 if (routing.flags)
741 goto out;
742 r = -ENOMEM;
743 entries = vmalloc(routing.nr * sizeof(*entries));
744 if (!entries)
745 goto out;
746 r = -EFAULT;
747 urouting = argp;
748 if (copy_from_user(entries, urouting->entries,
749 routing.nr * sizeof(*entries)))
750 goto out_free_irq_routing;
751 r = kvm_set_irq_routing(kvm, entries, routing.nr,
752 routing.flags);
753 out_free_irq_routing:
754 vfree(entries);
755 break;
756 }
757#endif /* KVM_CAP_IRQ_ROUTING */
758#ifdef __KVM_HAVE_MSIX
759 case KVM_ASSIGN_SET_MSIX_NR: {
760 struct kvm_assigned_msix_nr entry_nr;
761 r = -EFAULT;
762 if (copy_from_user(&entry_nr, argp, sizeof entry_nr))
763 goto out;
764 r = kvm_vm_ioctl_set_msix_nr(kvm, &entry_nr);
765 if (r)
766 goto out;
767 break;
768 }
769 case KVM_ASSIGN_SET_MSIX_ENTRY: {
770 struct kvm_assigned_msix_entry entry;
771 r = -EFAULT;
772 if (copy_from_user(&entry, argp, sizeof entry))
773 goto out;
774 r = kvm_vm_ioctl_set_msix_entry(kvm, &entry);
775 if (r)
776 goto out;
777 break;
778 }
779#endif
780 }
781out:
782 return r;
783}
784