Signed-off-by: Sheng Yang <sh...@linux.intel.com>
---
 include/linux/kvm_host.h |    3 ++
 virt/kvm/ioapic.c        |   84 +++++++++++++++++-----------------------------
 virt/kvm/irq_comm.c      |   75 ++++++++++++++++++++++++----------------
 3 files changed, 79 insertions(+), 83 deletions(-)

diff --git a/include/linux/kvm_host.h b/include/linux/kvm_host.h
index 5b671b6..4f92317 100644
--- a/include/linux/kvm_host.h
+++ b/include/linux/kvm_host.h
@@ -330,6 +330,9 @@ struct kvm_gsi_msg {
        struct hlist_node link;
 };
 
+void kvm_get_intr_delivery_bitmask(struct kvm_ioapic *ioapic,
+                                  union kvm_ioapic_redirect_entry *entry,
+                                  u32 *deliver_bitmask);
 void kvm_set_irq(struct kvm *kvm, int irq_source_id, u32 gsi, int level);
 void kvm_notify_acked_irq(struct kvm *kvm, unsigned gsi);
 void kvm_register_irq_ack_notifier(struct kvm *kvm,
diff --git a/virt/kvm/ioapic.c b/virt/kvm/ioapic.c
index ebb2ab5..af9f5de 100644
--- a/virt/kvm/ioapic.c
+++ b/virt/kvm/ioapic.c
@@ -195,75 +195,53 @@ u32 kvm_ioapic_get_delivery_bitmask(struct kvm_ioapic 
*ioapic, u8 dest,
 
 static int ioapic_deliver(struct kvm_ioapic *ioapic, int irq)
 {
-       u8 dest = ioapic->redirtbl[irq].fields.dest_id;
-       u8 dest_mode = ioapic->redirtbl[irq].fields.dest_mode;
-       u8 delivery_mode = ioapic->redirtbl[irq].fields.delivery_mode;
-       u8 vector = ioapic->redirtbl[irq].fields.vector;
-       u8 trig_mode = ioapic->redirtbl[irq].fields.trig_mode;
+       union kvm_ioapic_redirect_entry entry = ioapic->redirtbl[irq];
        u32 deliver_bitmask;
        struct kvm_vcpu *vcpu;
        int vcpu_id, r = 0;
 
        ioapic_debug("dest=%x dest_mode=%x delivery_mode=%x "
                     "vector=%x trig_mode=%x\n",
-                    dest, dest_mode, delivery_mode, vector, trig_mode);
+                    entry.fields.dest, entry.fields.dest_mode,
+                    entry.fields.delivery_mode, entry.fields.vector,
+                    entry.fields.trig_mode);
 
-       deliver_bitmask = kvm_ioapic_get_delivery_bitmask(ioapic, dest,
-                                                         dest_mode);
+       kvm_get_intr_delivery_bitmask(ioapic, &entry, &deliver_bitmask);
        if (!deliver_bitmask) {
                ioapic_debug("no target on destination\n");
                return 0;
        }
 
-       switch (delivery_mode) {
-       case IOAPIC_LOWEST_PRIORITY:
-               vcpu = kvm_get_lowest_prio_vcpu(ioapic->kvm, vector,
-                               deliver_bitmask);
+       /* Always delivery PIT interrupt to vcpu 0 */
 #ifdef CONFIG_X86
-               if (irq == 0)
-                       vcpu = ioapic->kvm->vcpus[0];
+       if (irq == 0)
+               deliver_bitmask = 1 << 0;
 #endif
-               if (vcpu != NULL)
-                       r = ioapic_inj_irq(ioapic, vcpu, vector,
-                                      trig_mode, delivery_mode);
-               else
-                       ioapic_debug("null lowest prio vcpu: "
-                                    "mask=%x vector=%x delivery_mode=%x\n",
-                                    deliver_bitmask, vector, 
IOAPIC_LOWEST_PRIORITY);
-               break;
-       case IOAPIC_FIXED:
-#ifdef CONFIG_X86
-               if (irq == 0)
-                       deliver_bitmask = 1;
-#endif
-               for (vcpu_id = 0; deliver_bitmask != 0; vcpu_id++) {
-                       if (!(deliver_bitmask & (1 << vcpu_id)))
-                               continue;
-                       deliver_bitmask &= ~(1 << vcpu_id);
-                       vcpu = ioapic->kvm->vcpus[vcpu_id];
-                       if (vcpu) {
-                               r = ioapic_inj_irq(ioapic, vcpu, vector,
-                                              trig_mode, delivery_mode);
-                       }
-               }
-               break;
-       case IOAPIC_NMI:
-               for (vcpu_id = 0; deliver_bitmask != 0; vcpu_id++) {
-                       if (!(deliver_bitmask & (1 << vcpu_id)))
-                               continue;
-                       deliver_bitmask &= ~(1 << vcpu_id);
-                       vcpu = ioapic->kvm->vcpus[vcpu_id];
-                       if (vcpu)
+
+       for (vcpu_id = 0; deliver_bitmask != 0; vcpu_id++) {
+               if (!(deliver_bitmask & (1 << vcpu_id)))
+                       continue;
+               deliver_bitmask &= ~(1 << vcpu_id);
+               vcpu = ioapic->kvm->vcpus[vcpu_id];
+               if (vcpu) {
+                       if (entry.fields.delivery_mode ==
+                                       IOAPIC_LOWEST_PRIORITY ||
+                           entry.fields.delivery_mode == IOAPIC_FIXED)
+                               r = ioapic_inj_irq(ioapic, vcpu,
+                                                  entry.fields.vector,
+                                                  entry.fields.trig_mode,
+                                                  entry.fields.delivery_mode);
+                       else if (entry.fields.delivery_mode == IOAPIC_NMI)
                                ioapic_inj_nmi(vcpu);
                        else
-                               ioapic_debug("NMI to vcpu %d failed\n",
-                                               vcpu->vcpu_id);
-               }
-               break;
-       default:
-               printk(KERN_WARNING "Unsupported delivery mode %d\n",
-                      delivery_mode);
-               break;
+                               ioapic_debug("unsupported delivery mode %x!\n",
+                                            entry.fields.delivery_mode);
+               } else
+                       ioapic_debug("null destination vcpu: "
+                                    "mask=%x vector=%x delivery_mode=%x\n",
+                                    entry.fields.deliver_bitmask,
+                                    entry.fields.vector,
+                                    entry.fields.delivery_mode);
        }
        return r;
 }
diff --git a/virt/kvm/irq_comm.c b/virt/kvm/irq_comm.c
index 63cdf01..d89d8b2 100644
--- a/virt/kvm/irq_comm.c
+++ b/virt/kvm/irq_comm.c
@@ -29,6 +29,29 @@
 
 #include "ioapic.h"
 
+void kvm_get_intr_delivery_bitmask(struct kvm_ioapic *ioapic,
+                                  union kvm_ioapic_redirect_entry *entry,
+                                  u32 *deliver_bitmask)
+{
+       struct kvm_vcpu *vcpu;
+
+       *deliver_bitmask = kvm_ioapic_get_delivery_bitmask(ioapic,
+                               entry->fields.dest_id, entry->fields.dest_mode);
+       switch (entry->fields.delivery_mode) {
+       case IOAPIC_LOWEST_PRIORITY:
+               vcpu = kvm_get_lowest_prio_vcpu(ioapic->kvm,
+                               entry->fields.vector, *deliver_bitmask);
+               *deliver_bitmask = 1 << vcpu->vcpu_id;
+               break;
+       case IOAPIC_FIXED:
+       case IOAPIC_NMI:
+               break;
+       default:
+               printk(KERN_INFO "kvm: unsupported delivery mode\n");
+               *deliver_bitmask = 0;
+       }
+}
+
 /* This should be called with the kvm->lock mutex held */
 void kvm_set_irq(struct kvm *kvm, int irq_source_id, u32 gsi, int level)
 {
@@ -38,7 +61,7 @@ void kvm_set_irq(struct kvm *kvm, int irq_source_id, u32 gsi, 
int level)
        struct kvm_vcpu *vcpu;
        struct kvm_ioapic *ioapic = ioapic_irqchip(kvm);
        struct kvm_gsi_msg *gsi_msg;
-       int dest_id, vector, dest_mode, trig_mode, delivery_mode;
+       union kvm_ioapic_redirect_entry entry;
        u32 deliver_bitmask;
 
        BUG_ON(!ioapic);
@@ -75,40 +98,32 @@ void kvm_set_irq(struct kvm *kvm, int irq_source_id, u32 
gsi, int level)
                return;
        }
 
-       dest_id = (gsi_msg->msg.address_lo & MSI_ADDR_DEST_ID_MASK)
+       entry.bits = 0;
+       entry.fields.dest_id = (gsi_msg->msg.address_lo & MSI_ADDR_DEST_ID_MASK)
                        >> MSI_ADDR_DEST_ID_SHIFT;
-       vector = (gsi_msg->msg.data & MSI_DATA_VECTOR_MASK)
+       entry.fields.vector = (gsi_msg->msg.data & MSI_DATA_VECTOR_MASK)
                        >> MSI_DATA_VECTOR_SHIFT;
-       dest_mode = test_bit(MSI_ADDR_DEST_MODE_SHIFT,
+       entry.fields.dest_mode = test_bit(MSI_ADDR_DEST_MODE_SHIFT,
                                (unsigned long *)&gsi_msg->msg.address_lo);
-       trig_mode = test_bit(MSI_DATA_TRIGGER_SHIFT,
+       entry.fields.trig_mode = test_bit(MSI_DATA_TRIGGER_SHIFT,
                                (unsigned long *)&gsi_msg->msg.data);
-       delivery_mode = test_bit(MSI_DATA_DELIVERY_MODE_SHIFT,
+       entry.fields.delivery_mode = test_bit(MSI_DATA_DELIVERY_MODE_SHIFT,
                                (unsigned long *)&gsi_msg->msg.data);
-       deliver_bitmask = kvm_ioapic_get_delivery_bitmask(ioapic,
-                               dest_id, dest_mode);
-       /* IOAPIC delivery mode value is the same as MSI here */
-       switch (delivery_mode) {
-       case IOAPIC_LOWEST_PRIORITY:
-               vcpu = kvm_get_lowest_prio_vcpu(ioapic->kvm, vector,
-                               deliver_bitmask);
-               if (vcpu != NULL)
-                       kvm_apic_set_irq(vcpu, vector, trig_mode);
-               else
-                       printk(KERN_INFO "kvm: null lowest priority vcpu!\n");
-               break;
-       case IOAPIC_FIXED:
-               for (vcpu_id = 0; deliver_bitmask != 0; vcpu_id++) {
-                       if (!(deliver_bitmask & (1 << vcpu_id)))
-                               continue;
-                       deliver_bitmask &= ~(1 << vcpu_id);
-                       vcpu = ioapic->kvm->vcpus[vcpu_id];
-                       if (vcpu)
-                               kvm_apic_set_irq(vcpu, vector, trig_mode);
-               }
-               break;
-       default:
-               printk(KERN_INFO "kvm: unsupported MSI delivery mode\n");
+
+       kvm_get_intr_delivery_bitmask(ioapic, &entry, &deliver_bitmask);
+
+       if (!deliver_bitmask) {
+               printk(KERN_WARNING "kvm: no destination for MSI delivery!");
+               return;
+       }
+       for (vcpu_id = 0; deliver_bitmask != 0; vcpu_id++) {
+               if (!(deliver_bitmask & (1 << vcpu_id)))
+                       continue;
+               deliver_bitmask &= ~(1 << vcpu_id);
+               vcpu = ioapic->kvm->vcpus[vcpu_id];
+               if (vcpu)
+                       kvm_apic_set_irq(vcpu, entry.fields.vector,
+                                        entry.fields.trig_mode);
        }
 #endif
 }
-- 
1.5.4.5

--
To unsubscribe from this list: send the line "unsubscribe kvm" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to