hw/ioapic.c

   1 /*
   2  *  ioapic.c IOAPIC emulation logic
   3  *
   4  *  Copyright (c) 2004-2005 Fabrice Bellard
   5  *
   6  *  Split the ioapic logic from apic.c
   7  *  Xiantao Zhang <xiantao.zhang@intel.com>
   8  *
   9  * This library is free software; you can redistribute it and/or
  10  * modify it under the terms of the GNU Lesser General Public
  11  * License as published by the Free Software Foundation; either
  12  * version 2 of the License, or (at your option) any later version.
  13  *
  14  * This library is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  17  * Lesser General Public License for more details.
  18  *
  19  * You should have received a copy of the GNU Lesser General Public
  20  * License along with this library; if not, see <http://www.gnu.org/licenses/>.
  21  */
  22
  23 #include "hw.h"
  24 #include "pc.h"
  25 #include "apic.h"
  26 #include "ioapic.h"
  27 #include "ioapic_internal.h"
  28
  29 #include "kvm.h"
  30
  31 //#define DEBUG_IOAPIC
  32
  33 #ifdef DEBUG_IOAPIC
  34 #define DPRINTF(fmt, ...)                                       \
  35     do { printf("ioapic: " fmt , ## __VA_ARGS__); } while (0)
  36 #else
  37 #define DPRINTF(fmt, ...)
  38 #endif
  39
  40 static IOAPICCommonState *ioapics[MAX_IOAPICS];
  41
  42 static void ioapic_service(IOAPICCommonState *s)
  43 {
  44     uint8_t i;
  45     uint8_t trig_mode;
  46     uint8_t vector;
  47     uint8_t delivery_mode;
  48     uint32_t mask;
  49     uint64_t entry;
  50     uint8_t dest;
  51     uint8_t dest_mode;
  52
  53     for (i = 0; i < IOAPIC_NUM_PINS; i++) {
  54         mask = 1 << i;
  55         if (s->irr & mask) {
  56             entry = s->ioredtbl[i];
  57             if (!(entry & IOAPIC_LVT_MASKED)) {
  58                 trig_mode = ((entry >> IOAPIC_LVT_TRIGGER_MODE_SHIFT) & 1);
  59                 dest = entry >> IOAPIC_LVT_DEST_SHIFT;
  60                 dest_mode = (entry >> IOAPIC_LVT_DEST_MODE_SHIFT) & 1;
  61                 delivery_mode =
  62                     (entry >> IOAPIC_LVT_DELIV_MODE_SHIFT) & IOAPIC_DM_MASK;
  63                 if (trig_mode == IOAPIC_TRIGGER_EDGE) {
  64                     s->irr &= ~mask;
  65                 } else {
  66                     s->ioredtbl[i] |= IOAPIC_LVT_REMOTE_IRR;
  67                 }
  68                 if (delivery_mode == IOAPIC_DM_EXTINT) {
  69                     vector = pic_read_irq(isa_pic);
  70                 } else {
  71                     vector = entry & IOAPIC_VECTOR_MASK;
  72                 }
  73                 apic_deliver_irq(dest, dest_mode, delivery_mode,
  74                                  vector, trig_mode);
  75             }
  76         }
  77     }
  78 }
  79
  80 static void ioapic_set_irq(void *opaque, int vector, int level)
  81 {
  82     IOAPICCommonState *s = opaque;
  83
  84     /* ISA IRQs map to GSI 1-1 except for IRQ0 which maps
  85      * to GSI 2.  GSI maps to ioapic 1-1.  This is not
  86      * the cleanest way of doing it but it should work. */
  87
  88     DPRINTF("%s: %s vec %x\n", __func__, level ? "raise" : "lower", vector);
  89     if (vector == 0) {
  90         vector = 2;
  91     }
  92     if (vector >= 0 && vector < IOAPIC_NUM_PINS) {
  93         uint32_t mask = 1 << vector;
  94         uint64_t entry = s->ioredtbl[vector];
  95
  96         if (entry & (1 << IOAPIC_LVT_POLARITY_SHIFT)) {
  97             level = !level;
  98         }
  99         if (((entry >> IOAPIC_LVT_TRIGGER_MODE_SHIFT) & 1) ==
 100             IOAPIC_TRIGGER_LEVEL) {
 101             /* level triggered */
 102             if (level) {
 103                 s->irr |= mask;
 104                 ioapic_service(s);
 105             } else {
 106                 s->irr &= ~mask;
 107             }
 108         } else {
 109             /* According to the 82093AA manual, we must ignore edge requests
 110              * if the input pin is masked. */
 111             if (level && !(entry & IOAPIC_LVT_MASKED)) {
 112                 s->irr |= mask;
 113                 ioapic_service(s);
 114             }
 115         }
 116     }
 117 }
 118
 119 void ioapic_eoi_broadcast(int vector)
 120 {
 121     IOAPICCommonState *s;
 122     uint64_t entry;
 123     int i, n;
 124
 125     for (i = 0; i < MAX_IOAPICS; i++) {
 126         s = ioapics[i];
 127         if (!s) {
 128             continue;
 129         }
 130         for (n = 0; n < IOAPIC_NUM_PINS; n++) {
 131             entry = s->ioredtbl[n];
 132             if ((entry & IOAPIC_LVT_REMOTE_IRR)
 133                 && (entry & IOAPIC_VECTOR_MASK) == vector) {
 134                 s->ioredtbl[n] = entry & ~IOAPIC_LVT_REMOTE_IRR;
 135                 if (!(entry & IOAPIC_LVT_MASKED) && (s->irr & (1 << n))) {
 136                     ioapic_service(s);
 137                 }
 138             }
 139         }
 140     }
 141 }
 142
 143 static uint64_t
 144 ioapic_mem_read(void *opaque, target_phys_addr_t addr, unsigned int size)
 145 {
 146     IOAPICCommonState *s = opaque;
 147     int index;
 148     uint32_t val = 0;
 149
 150     switch (addr & 0xff) {
 151     case IOAPIC_IOREGSEL:
 152         val = s->ioregsel;
 153         break;
 154     case IOAPIC_IOWIN:
 155         if (size != 4) {
 156             break;
 157         }
 158         switch (s->ioregsel) {
 159         case IOAPIC_REG_ID:
 160             val = s->id << IOAPIC_ID_SHIFT;
 161             break;
 162         case IOAPIC_REG_VER:
 163             val = IOAPIC_VERSION |
 164                 ((IOAPIC_NUM_PINS - 1) << IOAPIC_VER_ENTRIES_SHIFT);
 165             break;
 166         case IOAPIC_REG_ARB:
 167             val = 0;
 168             break;
 169         default:
 170             index = (s->ioregsel - IOAPIC_REG_REDTBL_BASE) >> 1;
 171             if (index >= 0 && index < IOAPIC_NUM_PINS) {
 172                 if (s->ioregsel & 1) {
 173                     val = s->ioredtbl[index] >> 32;
 174                 } else {
 175                     val = s->ioredtbl[index] & 0xffffffff;
 176                 }
 177             }
 178         }
 179         DPRINTF("read: %08x = %08x\n", s->ioregsel, val);
 180         break;
 181     }
 182     return val;
 183 }
 184
 185 static void
 186 ioapic_mem_write(void *opaque, target_phys_addr_t addr, uint64_t val,
 187                  unsigned int size)
 188 {
 189     IOAPICCommonState *s = opaque;
 190     int index;
 191
 192     switch (addr & 0xff) {
 193     case IOAPIC_IOREGSEL:
 194         s->ioregsel = val;
 195         break;
 196     case IOAPIC_IOWIN:
 197         if (size != 4) {
 198             break;
 199         }
 200         DPRINTF("write: %08x = %08x\n", s->ioregsel, val);
 201         switch (s->ioregsel) {
 202         case IOAPIC_REG_ID:
 203             s->id = (val >> IOAPIC_ID_SHIFT) & IOAPIC_ID_MASK;
 204             break;
 205         case IOAPIC_REG_VER:
 206         case IOAPIC_REG_ARB:
 207             break;
 208         default:
 209             index = (s->ioregsel - IOAPIC_REG_REDTBL_BASE) >> 1;
 210             if (index >= 0 && index < IOAPIC_NUM_PINS) {
 211                 if (s->ioregsel & 1) {
 212                     s->ioredtbl[index] &= 0xffffffff;
 213                     s->ioredtbl[index] |= (uint64_t)val << 32;
 214                 } else {
 215                     s->ioredtbl[index] &= ~0xffffffffULL;
 216                     s->ioredtbl[index] |= val;
 217                 }
 218                 ioapic_service(s);
 219             }
 220         }
 221         break;
 222     }
 223 }
 224
 225 static void kvm_kernel_ioapic_save_to_user(IOAPICCommonState *s)
 226 {
 227 #if defined(KVM_CAP_IRQCHIP) && defined(TARGET_I386)
 228     struct kvm_irqchip chip;
 229     struct kvm_ioapic_state *kioapic;
 230     int i;
 231
 232     chip.chip_id = KVM_IRQCHIP_IOAPIC;
 233     kvm_get_irqchip(kvm_state, &chip);
 234     kioapic = &chip.chip.ioapic;
 235
 236     s->id = kioapic->id;
 237     s->ioregsel = kioapic->ioregsel;
 238     s->irr = kioapic->irr;
 239     for (i = 0; i < IOAPIC_NUM_PINS; i++) {
 240         s->ioredtbl[i] = kioapic->redirtbl[i].bits;
 241     }
 242 #endif
 243 }
 244
 245 static void kvm_kernel_ioapic_load_from_user(IOAPICCommonState *s)
 246 {
 247 #if defined(KVM_CAP_IRQCHIP) && defined(TARGET_I386)
 248     struct kvm_irqchip chip;
 249     struct kvm_ioapic_state *kioapic;
 250     int i;
 251
 252     chip.chip_id = KVM_IRQCHIP_IOAPIC;
 253     kioapic = &chip.chip.ioapic;
 254
 255     kioapic->id = s->id;
 256     kioapic->ioregsel = s->ioregsel;
 257     kioapic->base_address = s->busdev.mmio[0].addr;
 258     kioapic->irr = s->irr;
 259     for (i = 0; i < IOAPIC_NUM_PINS; i++) {
 260         kioapic->redirtbl[i].bits = s->ioredtbl[i];
 261     }
 262
 263     kvm_set_irqchip(kvm_state, &chip);
 264 #endif
 265 }
 266
 267 static void kvm_ioapic_pre_save(IOAPICCommonState *s)
 268 {
 269
 270     if (kvm_enabled() && kvm_irqchip_in_kernel()) {
 271         kvm_kernel_ioapic_save_to_user(s);
 272     }
 273 }
 274
 275 static void kvm_ioapic_post_load(IOAPICCommonState *s)
 276 {
 277     if (kvm_enabled() && kvm_irqchip_in_kernel()) {
 278         kvm_kernel_ioapic_load_from_user(s);
 279     }
 280 }
 281
 282 static void ioapic_reset(DeviceState *d)
 283 {
 284     IOAPICCommonState *s = DO_UPCAST(IOAPICCommonState, busdev.qdev, d);
 285
 286     ioapic_reset_common(d);
 287 #ifdef KVM_CAP_IRQCHIP
 288     if (kvm_enabled() && kvm_irqchip_in_kernel()) {
 289         kvm_kernel_ioapic_load_from_user(s);
 290     }
 291 #endif
 292 }
 293
 294 static const MemoryRegionOps ioapic_io_ops = {
 295     .read = ioapic_mem_read,
 296     .write = ioapic_mem_write,
 297     .endianness = DEVICE_NATIVE_ENDIAN,
 298 };
 299
 300 static void ioapic_init(IOAPICCommonState *s, int instance_no)
 301 {
 302     memory_region_init_io(&s->io_memory, &ioapic_io_ops, s, "ioapic", 0x1000);
 303
 304     qdev_init_gpio_in(&s->busdev.qdev, ioapic_set_irq, IOAPIC_NUM_PINS);
 305
 306     ioapics[instance_no] = s;
 307 }
 308
 309 static void ioapic_class_init(ObjectClass *klass, void *data)
 310 {
 311     IOAPICCommonClass *k = IOAPIC_COMMON_CLASS(klass);
 312
 313     k->init = ioapic_init;
 314     k->pre_save = kvm_ioapic_pre_save;
 315     k->post_load = kvm_ioapic_post_load;
 316 }
 317
 318 static DeviceInfo ioapic_info = {
 319     .name = "ioapic",
 320     .size = sizeof(IOAPICCommonState),
 321     .reset = ioapic_reset,
 322     .class_init = ioapic_class_init,
 323 };
 324
 325 static void ioapic_register_devices(void)
 326 {
 327     ioapic_qdev_register(&ioapic_info);
 328 }
 329
 330 device_init(ioapic_register_devices)