blob: 3eed61eb48675a63dd1f31b0095217ab6bc5f646 [file] [log] [blame]
Eddie Dong1fd4f2a2007-07-18 12:03:39 +03001/*
2 * Copyright (C) 2001 MandrakeSoft S.A.
Avi Kivity221d0592010-05-23 18:37:00 +03003 * Copyright 2010 Red Hat, Inc. and/or its affiliates.
Eddie Dong1fd4f2a2007-07-18 12:03:39 +03004 *
5 * MandrakeSoft S.A.
6 * 43, rue d'Aboukir
7 * 75002 Paris - France
8 * http://www.linux-mandrake.com/
9 * http://www.mandrakesoft.com/
10 *
11 * This library is free software; you can redistribute it and/or
12 * modify it under the terms of the GNU Lesser General Public
13 * License as published by the Free Software Foundation; either
14 * version 2 of the License, or (at your option) any later version.
15 *
16 * This library is distributed in the hope that it will be useful,
17 * but WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
19 * Lesser General Public License for more details.
20 *
21 * You should have received a copy of the GNU Lesser General Public
22 * License along with this library; if not, write to the Free Software
23 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
24 *
25 * Yunhong Jiang <yunhong.jiang@intel.com>
26 * Yaozu (Eddie) Dong <eddie.dong@intel.com>
27 * Based on Xen 3.1 code.
28 */
29
Avi Kivityedf88412007-12-16 11:02:48 +020030#include <linux/kvm_host.h>
Eddie Dong1fd4f2a2007-07-18 12:03:39 +030031#include <linux/kvm.h>
32#include <linux/mm.h>
33#include <linux/highmem.h>
34#include <linux/smp.h>
35#include <linux/hrtimer.h>
36#include <linux/io.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090037#include <linux/slab.h>
Eddie Dong1fd4f2a2007-07-18 12:03:39 +030038#include <asm/processor.h>
Eddie Dong1fd4f2a2007-07-18 12:03:39 +030039#include <asm/page.h>
40#include <asm/current.h>
Gleb Natapov1000ff82009-07-07 16:00:57 +030041#include <trace/events/kvm.h>
Zhang Xiantao82470192007-12-17 13:59:56 +080042
43#include "ioapic.h"
44#include "lapic.h"
Marcelo Tosattif5244722008-07-26 17:01:00 -030045#include "irq.h"
Zhang Xiantao82470192007-12-17 13:59:56 +080046
Laurent Viviere25e3ed2007-10-12 11:01:59 +020047#if 0
48#define ioapic_debug(fmt,arg...) printk(KERN_WARNING fmt,##arg)
49#else
Eddie Dong1fd4f2a2007-07-18 12:03:39 +030050#define ioapic_debug(fmt, arg...)
Laurent Viviere25e3ed2007-10-12 11:01:59 +020051#endif
Marcelo Tosattiff4b9df2008-06-05 00:08:11 -030052static int ioapic_deliver(struct kvm_ioapic *vioapic, int irq);
Eddie Dong1fd4f2a2007-07-18 12:03:39 +030053
54static unsigned long ioapic_read_indirect(struct kvm_ioapic *ioapic,
55 unsigned long addr,
56 unsigned long length)
57{
58 unsigned long result = 0;
59
60 switch (ioapic->ioregsel) {
61 case IOAPIC_REG_VERSION:
62 result = ((((IOAPIC_NUM_PINS - 1) & 0xff) << 16)
63 | (IOAPIC_VERSION_ID & 0xff));
64 break;
65
66 case IOAPIC_REG_APIC_ID:
67 case IOAPIC_REG_ARB_ID:
68 result = ((ioapic->id & 0xf) << 24);
69 break;
70
71 default:
72 {
73 u32 redir_index = (ioapic->ioregsel - 0x10) >> 1;
74 u64 redir_content;
75
76 ASSERT(redir_index < IOAPIC_NUM_PINS);
77
78 redir_content = ioapic->redirtbl[redir_index].bits;
79 result = (ioapic->ioregsel & 0x1) ?
80 (redir_content >> 32) & 0xffffffff :
81 redir_content & 0xffffffff;
82 break;
83 }
84 }
85
86 return result;
87}
88
Gleb Natapov49256632009-02-04 17:28:14 +020089static int ioapic_service(struct kvm_ioapic *ioapic, unsigned int idx)
Eddie Dong1fd4f2a2007-07-18 12:03:39 +030090{
Sheng Yangcf9e4e12009-02-11 16:03:36 +080091 union kvm_ioapic_redirect_entry *pent;
Gleb Natapov49256632009-02-04 17:28:14 +020092 int injected = -1;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +030093
94 pent = &ioapic->redirtbl[idx];
95
96 if (!pent->fields.mask) {
Gleb Natapov49256632009-02-04 17:28:14 +020097 injected = ioapic_deliver(ioapic, idx);
Marcelo Tosattiff4b9df2008-06-05 00:08:11 -030098 if (injected && pent->fields.trig_mode == IOAPIC_LEVEL_TRIG)
Eddie Dong1fd4f2a2007-07-18 12:03:39 +030099 pent->fields.remote_irr = 1;
100 }
Gleb Natapov49256632009-02-04 17:28:14 +0200101
102 return injected;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300103}
104
Avi Kivity46a929b2009-12-28 14:08:30 +0200105static void update_handled_vectors(struct kvm_ioapic *ioapic)
106{
107 DECLARE_BITMAP(handled_vectors, 256);
108 int i;
109
110 memset(handled_vectors, 0, sizeof(handled_vectors));
111 for (i = 0; i < IOAPIC_NUM_PINS; ++i)
112 __set_bit(ioapic->redirtbl[i].fields.vector, handled_vectors);
113 memcpy(ioapic->handled_vectors, handled_vectors,
114 sizeof(handled_vectors));
115 smp_wmb();
116}
117
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300118static void ioapic_write_indirect(struct kvm_ioapic *ioapic, u32 val)
119{
120 unsigned index;
Avi Kivity75858a82009-01-04 17:10:50 +0200121 bool mask_before, mask_after;
Gleb Natapov70f93da2009-07-05 18:48:12 +0300122 union kvm_ioapic_redirect_entry *e;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300123
124 switch (ioapic->ioregsel) {
125 case IOAPIC_REG_VERSION:
126 /* Writes are ignored. */
127 break;
128
129 case IOAPIC_REG_APIC_ID:
130 ioapic->id = (val >> 24) & 0xf;
131 break;
132
133 case IOAPIC_REG_ARB_ID:
134 break;
135
136 default:
137 index = (ioapic->ioregsel - 0x10) >> 1;
138
Laurent Viviere25e3ed2007-10-12 11:01:59 +0200139 ioapic_debug("change redir index %x val %x\n", index, val);
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300140 if (index >= IOAPIC_NUM_PINS)
141 return;
Gleb Natapov70f93da2009-07-05 18:48:12 +0300142 e = &ioapic->redirtbl[index];
143 mask_before = e->fields.mask;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300144 if (ioapic->ioregsel & 1) {
Gleb Natapov70f93da2009-07-05 18:48:12 +0300145 e->bits &= 0xffffffff;
146 e->bits |= (u64) val << 32;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300147 } else {
Gleb Natapov70f93da2009-07-05 18:48:12 +0300148 e->bits &= ~0xffffffffULL;
149 e->bits |= (u32) val;
150 e->fields.remote_irr = 0;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300151 }
Avi Kivity46a929b2009-12-28 14:08:30 +0200152 update_handled_vectors(ioapic);
Gleb Natapov70f93da2009-07-05 18:48:12 +0300153 mask_after = e->fields.mask;
Avi Kivity75858a82009-01-04 17:10:50 +0200154 if (mask_before != mask_after)
Gleb Natapov4a994352010-07-11 15:32:23 +0300155 kvm_fire_mask_notifiers(ioapic->kvm, KVM_IRQCHIP_IOAPIC, index, mask_after);
Gleb Natapov70f93da2009-07-05 18:48:12 +0300156 if (e->fields.trig_mode == IOAPIC_LEVEL_TRIG
Gleb Natapovb4a2f5e2009-07-05 18:48:11 +0300157 && ioapic->irr & (1 << index))
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300158 ioapic_service(ioapic, index);
159 break;
160 }
161}
162
Marcelo Tosattiff4b9df2008-06-05 00:08:11 -0300163static int ioapic_deliver(struct kvm_ioapic *ioapic, int irq)
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300164{
Gleb Natapov58c2dde2009-03-05 16:35:04 +0200165 union kvm_ioapic_redirect_entry *entry = &ioapic->redirtbl[irq];
166 struct kvm_lapic_irq irqe;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300167
168 ioapic_debug("dest=%x dest_mode=%x delivery_mode=%x "
Laurent Viviere25e3ed2007-10-12 11:01:59 +0200169 "vector=%x trig_mode=%x\n",
Liu Yuana38f84c2011-04-21 14:53:57 +0800170 entry->fields.dest_id, entry->fields.dest_mode,
Gleb Natapov58c2dde2009-03-05 16:35:04 +0200171 entry->fields.delivery_mode, entry->fields.vector,
172 entry->fields.trig_mode);
173
174 irqe.dest_id = entry->fields.dest_id;
175 irqe.vector = entry->fields.vector;
176 irqe.dest_mode = entry->fields.dest_mode;
177 irqe.trig_mode = entry->fields.trig_mode;
178 irqe.delivery_mode = entry->fields.delivery_mode << 8;
179 irqe.level = 1;
180 irqe.shorthand = 0;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300181
Avi Kivity8c35f232008-02-25 10:28:31 +0200182#ifdef CONFIG_X86
Gleb Natapova53c17d2009-03-05 16:34:49 +0200183 /* Always delivery PIT interrupt to vcpu 0 */
Sheng Yang74a3a8f2009-03-04 13:33:02 +0800184 if (irq == 0) {
Gleb Natapov58c2dde2009-03-05 16:35:04 +0200185 irqe.dest_mode = 0; /* Physical mode. */
Gleb Natapovc5af89b2009-06-09 15:56:26 +0300186 /* need to read apic_id from apic regiest since
187 * it can be rewritten */
188 irqe.dest_id = ioapic->kvm->bsp_vcpu->vcpu_id;
Gleb Natapova53c17d2009-03-05 16:34:49 +0200189 }
Avi Kivity8c35f232008-02-25 10:28:31 +0200190#endif
Gleb Natapov58c2dde2009-03-05 16:35:04 +0200191 return kvm_irq_delivery_to_apic(ioapic->kvm, NULL, &irqe);
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300192}
193
Gleb Natapov49256632009-02-04 17:28:14 +0200194int kvm_ioapic_set_irq(struct kvm_ioapic *ioapic, int irq, int level)
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300195{
Marcelo Tosatti07dc7262010-06-02 11:26:26 -0300196 u32 old_irr;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300197 u32 mask = 1 << irq;
Sheng Yangcf9e4e12009-02-11 16:03:36 +0800198 union kvm_ioapic_redirect_entry entry;
Gleb Natapov49256632009-02-04 17:28:14 +0200199 int ret = 1;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300200
Marcelo Tosatti46a47b12010-04-23 14:03:38 -0300201 spin_lock(&ioapic->lock);
Marcelo Tosatti07dc7262010-06-02 11:26:26 -0300202 old_irr = ioapic->irr;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300203 if (irq >= 0 && irq < IOAPIC_NUM_PINS) {
204 entry = ioapic->redirtbl[irq];
205 level ^= entry.fields.polarity;
206 if (!level)
207 ioapic->irr &= ~mask;
208 else {
Gleb Natapovb4a2f5e2009-07-05 18:48:11 +0300209 int edge = (entry.fields.trig_mode == IOAPIC_EDGE_TRIG);
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300210 ioapic->irr |= mask;
Gleb Natapovb4a2f5e2009-07-05 18:48:11 +0300211 if ((edge && old_irr != ioapic->irr) ||
212 (!edge && !entry.fields.remote_irr))
Gleb Natapov49256632009-02-04 17:28:14 +0200213 ret = ioapic_service(ioapic, irq);
Gleb Natapov65a82212009-09-03 12:10:34 +0300214 else
215 ret = 0; /* report coalesced interrupt */
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300216 }
Gleb Natapov1000ff82009-07-07 16:00:57 +0300217 trace_kvm_ioapic_set_irq(entry.bits, irq, ret == 0);
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300218 }
Marcelo Tosatti46a47b12010-04-23 14:03:38 -0300219 spin_unlock(&ioapic->lock);
Gleb Natapoveba02262009-08-24 11:54:25 +0300220
Gleb Natapov49256632009-02-04 17:28:14 +0200221 return ret;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300222}
223
Gleb Natapoveba02262009-08-24 11:54:25 +0300224static void __kvm_ioapic_update_eoi(struct kvm_ioapic *ioapic, int vector,
225 int trigger_mode)
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300226{
Gleb Natapoveba02262009-08-24 11:54:25 +0300227 int i;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300228
Gleb Natapoveba02262009-08-24 11:54:25 +0300229 for (i = 0; i < IOAPIC_NUM_PINS; i++) {
230 union kvm_ioapic_redirect_entry *ent = &ioapic->redirtbl[i];
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300231
Gleb Natapoveba02262009-08-24 11:54:25 +0300232 if (ent->fields.vector != vector)
233 continue;
Marcelo Tosattif5244722008-07-26 17:01:00 -0300234
Gleb Natapoveba02262009-08-24 11:54:25 +0300235 /*
236 * We are dropping lock while calling ack notifiers because ack
237 * notifier callbacks for assigned devices call into IOAPIC
238 * recursively. Since remote_irr is cleared only after call
239 * to notifiers if the same vector will be delivered while lock
240 * is dropped it will be put into irr and will be delivered
241 * after ack notifier returns.
242 */
Marcelo Tosatti46a47b12010-04-23 14:03:38 -0300243 spin_unlock(&ioapic->lock);
Gleb Natapoveba02262009-08-24 11:54:25 +0300244 kvm_notify_acked_irq(ioapic->kvm, KVM_IRQCHIP_IOAPIC, i);
Marcelo Tosatti46a47b12010-04-23 14:03:38 -0300245 spin_lock(&ioapic->lock);
Gleb Natapoveba02262009-08-24 11:54:25 +0300246
247 if (trigger_mode != IOAPIC_LEVEL_TRIG)
248 continue;
249
Marcelo Tosattif5244722008-07-26 17:01:00 -0300250 ASSERT(ent->fields.trig_mode == IOAPIC_LEVEL_TRIG);
251 ent->fields.remote_irr = 0;
Gleb Natapoveba02262009-08-24 11:54:25 +0300252 if (!ent->fields.mask && (ioapic->irr & (1 << i)))
253 ioapic_service(ioapic, i);
Marcelo Tosattif5244722008-07-26 17:01:00 -0300254 }
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300255}
256
Marcelo Tosattif5244722008-07-26 17:01:00 -0300257void kvm_ioapic_update_eoi(struct kvm *kvm, int vector, int trigger_mode)
Avi Kivity4fa6b9c2008-06-17 15:36:36 -0700258{
259 struct kvm_ioapic *ioapic = kvm->arch.vioapic;
Avi Kivity4fa6b9c2008-06-17 15:36:36 -0700260
Avi Kivity46a929b2009-12-28 14:08:30 +0200261 smp_rmb();
262 if (!test_bit(vector, ioapic->handled_vectors))
263 return;
Marcelo Tosatti46a47b12010-04-23 14:03:38 -0300264 spin_lock(&ioapic->lock);
Gleb Natapoveba02262009-08-24 11:54:25 +0300265 __kvm_ioapic_update_eoi(ioapic, vector, trigger_mode);
Marcelo Tosatti46a47b12010-04-23 14:03:38 -0300266 spin_unlock(&ioapic->lock);
Avi Kivity4fa6b9c2008-06-17 15:36:36 -0700267}
268
Gregory Haskinsd76685c2009-06-01 12:54:50 -0400269static inline struct kvm_ioapic *to_ioapic(struct kvm_io_device *dev)
270{
271 return container_of(dev, struct kvm_ioapic, dev);
272}
273
Michael S. Tsirkinbda90202009-06-29 22:24:32 +0300274static inline int ioapic_in_range(struct kvm_ioapic *ioapic, gpa_t addr)
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300275{
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300276 return ((addr >= ioapic->base_address &&
277 (addr < ioapic->base_address + IOAPIC_MEM_LENGTH)));
278}
279
Michael S. Tsirkinbda90202009-06-29 22:24:32 +0300280static int ioapic_mmio_read(struct kvm_io_device *this, gpa_t addr, int len,
281 void *val)
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300282{
Gregory Haskinsd76685c2009-06-01 12:54:50 -0400283 struct kvm_ioapic *ioapic = to_ioapic(this);
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300284 u32 result;
Michael S. Tsirkinbda90202009-06-29 22:24:32 +0300285 if (!ioapic_in_range(ioapic, addr))
286 return -EOPNOTSUPP;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300287
Laurent Viviere25e3ed2007-10-12 11:01:59 +0200288 ioapic_debug("addr %lx\n", (unsigned long)addr);
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300289 ASSERT(!(addr & 0xf)); /* check alignment */
290
291 addr &= 0xff;
Marcelo Tosatti46a47b12010-04-23 14:03:38 -0300292 spin_lock(&ioapic->lock);
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300293 switch (addr) {
294 case IOAPIC_REG_SELECT:
295 result = ioapic->ioregsel;
296 break;
297
298 case IOAPIC_REG_WINDOW:
299 result = ioapic_read_indirect(ioapic, addr, len);
300 break;
301
302 default:
303 result = 0;
304 break;
305 }
Marcelo Tosatti46a47b12010-04-23 14:03:38 -0300306 spin_unlock(&ioapic->lock);
Gleb Natapoveba02262009-08-24 11:54:25 +0300307
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300308 switch (len) {
309 case 8:
310 *(u64 *) val = result;
311 break;
312 case 1:
313 case 2:
314 case 4:
315 memcpy(val, (char *)&result, len);
316 break;
317 default:
318 printk(KERN_WARNING "ioapic: wrong length %d\n", len);
319 }
Michael S. Tsirkinbda90202009-06-29 22:24:32 +0300320 return 0;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300321}
322
Michael S. Tsirkinbda90202009-06-29 22:24:32 +0300323static int ioapic_mmio_write(struct kvm_io_device *this, gpa_t addr, int len,
324 const void *val)
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300325{
Gregory Haskinsd76685c2009-06-01 12:54:50 -0400326 struct kvm_ioapic *ioapic = to_ioapic(this);
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300327 u32 data;
Michael S. Tsirkinbda90202009-06-29 22:24:32 +0300328 if (!ioapic_in_range(ioapic, addr))
329 return -EOPNOTSUPP;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300330
Laurent Viviere25e3ed2007-10-12 11:01:59 +0200331 ioapic_debug("ioapic_mmio_write addr=%p len=%d val=%p\n",
332 (void*)addr, len, val);
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300333 ASSERT(!(addr & 0xf)); /* check alignment */
Marcelo Tosatti60eead72009-06-04 15:08:23 -0300334
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300335 if (len == 4 || len == 8)
336 data = *(u32 *) val;
337 else {
338 printk(KERN_WARNING "ioapic: Unsupported size %d\n", len);
Gleb Natapoveba02262009-08-24 11:54:25 +0300339 return 0;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300340 }
341
342 addr &= 0xff;
Marcelo Tosatti46a47b12010-04-23 14:03:38 -0300343 spin_lock(&ioapic->lock);
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300344 switch (addr) {
345 case IOAPIC_REG_SELECT:
346 ioapic->ioregsel = data;
347 break;
348
349 case IOAPIC_REG_WINDOW:
350 ioapic_write_indirect(ioapic, data);
351 break;
Zhang Xiantaob1fd3d32007-12-02 22:53:07 +0800352#ifdef CONFIG_IA64
353 case IOAPIC_REG_EOI:
Gleb Natapoveba02262009-08-24 11:54:25 +0300354 __kvm_ioapic_update_eoi(ioapic, data, IOAPIC_LEVEL_TRIG);
Zhang Xiantaob1fd3d32007-12-02 22:53:07 +0800355 break;
356#endif
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300357
358 default:
359 break;
360 }
Marcelo Tosatti46a47b12010-04-23 14:03:38 -0300361 spin_unlock(&ioapic->lock);
Michael S. Tsirkinbda90202009-06-29 22:24:32 +0300362 return 0;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300363}
364
Eddie Dong8c392692007-10-10 12:15:54 +0200365void kvm_ioapic_reset(struct kvm_ioapic *ioapic)
366{
367 int i;
368
369 for (i = 0; i < IOAPIC_NUM_PINS; i++)
370 ioapic->redirtbl[i].fields.mask = 1;
371 ioapic->base_address = IOAPIC_DEFAULT_BASE_ADDRESS;
372 ioapic->ioregsel = 0;
373 ioapic->irr = 0;
374 ioapic->id = 0;
Avi Kivity46a929b2009-12-28 14:08:30 +0200375 update_handled_vectors(ioapic);
Eddie Dong8c392692007-10-10 12:15:54 +0200376}
377
Gregory Haskinsd76685c2009-06-01 12:54:50 -0400378static const struct kvm_io_device_ops ioapic_mmio_ops = {
379 .read = ioapic_mmio_read,
380 .write = ioapic_mmio_write,
Gregory Haskinsd76685c2009-06-01 12:54:50 -0400381};
382
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300383int kvm_ioapic_init(struct kvm *kvm)
384{
385 struct kvm_ioapic *ioapic;
Gregory Haskins090b7af2009-07-07 17:08:44 -0400386 int ret;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300387
388 ioapic = kzalloc(sizeof(struct kvm_ioapic), GFP_KERNEL);
389 if (!ioapic)
390 return -ENOMEM;
Marcelo Tosatti46a47b12010-04-23 14:03:38 -0300391 spin_lock_init(&ioapic->lock);
Zhang Xiantaod7deeeb02007-12-14 10:17:34 +0800392 kvm->arch.vioapic = ioapic;
Eddie Dong8c392692007-10-10 12:15:54 +0200393 kvm_ioapic_reset(ioapic);
Gregory Haskinsd76685c2009-06-01 12:54:50 -0400394 kvm_iodevice_init(&ioapic->dev, &ioapic_mmio_ops);
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300395 ioapic->kvm = kvm;
Marcelo Tosatti79fac952009-12-23 14:35:26 -0200396 mutex_lock(&kvm->slots_lock);
Sasha Levin743eeb02011-07-27 16:00:48 +0300397 ret = kvm_io_bus_register_dev(kvm, KVM_MMIO_BUS, ioapic->base_address,
398 IOAPIC_MEM_LENGTH, &ioapic->dev);
Marcelo Tosatti79fac952009-12-23 14:35:26 -0200399 mutex_unlock(&kvm->slots_lock);
Wei Yongjun1ae77ba2010-02-09 10:31:09 +0800400 if (ret < 0) {
401 kvm->arch.vioapic = NULL;
Gregory Haskins090b7af2009-07-07 17:08:44 -0400402 kfree(ioapic);
Wei Yongjun1ae77ba2010-02-09 10:31:09 +0800403 }
Gregory Haskins090b7af2009-07-07 17:08:44 -0400404
405 return ret;
Eddie Dong1fd4f2a2007-07-18 12:03:39 +0300406}
Avi Kivity75858a82009-01-04 17:10:50 +0200407
Wei Yongjun72bb2fc2010-02-09 10:33:03 +0800408void kvm_ioapic_destroy(struct kvm *kvm)
409{
410 struct kvm_ioapic *ioapic = kvm->arch.vioapic;
411
412 if (ioapic) {
413 kvm_io_bus_unregister_dev(kvm, KVM_MMIO_BUS, &ioapic->dev);
414 kvm->arch.vioapic = NULL;
415 kfree(ioapic);
416 }
417}
418
Gleb Natapoveba02262009-08-24 11:54:25 +0300419int kvm_get_ioapic(struct kvm *kvm, struct kvm_ioapic_state *state)
420{
421 struct kvm_ioapic *ioapic = ioapic_irqchip(kvm);
422 if (!ioapic)
423 return -EINVAL;
424
Marcelo Tosatti46a47b12010-04-23 14:03:38 -0300425 spin_lock(&ioapic->lock);
Gleb Natapoveba02262009-08-24 11:54:25 +0300426 memcpy(state, ioapic, sizeof(struct kvm_ioapic_state));
Marcelo Tosatti46a47b12010-04-23 14:03:38 -0300427 spin_unlock(&ioapic->lock);
Gleb Natapoveba02262009-08-24 11:54:25 +0300428 return 0;
429}
430
431int kvm_set_ioapic(struct kvm *kvm, struct kvm_ioapic_state *state)
432{
433 struct kvm_ioapic *ioapic = ioapic_irqchip(kvm);
434 if (!ioapic)
435 return -EINVAL;
436
Marcelo Tosatti46a47b12010-04-23 14:03:38 -0300437 spin_lock(&ioapic->lock);
Gleb Natapoveba02262009-08-24 11:54:25 +0300438 memcpy(ioapic, state, sizeof(struct kvm_ioapic_state));
Avi Kivity46a929b2009-12-28 14:08:30 +0200439 update_handled_vectors(ioapic);
Marcelo Tosatti46a47b12010-04-23 14:03:38 -0300440 spin_unlock(&ioapic->lock);
Gleb Natapoveba02262009-08-24 11:54:25 +0300441 return 0;
442}