root / xen-all.c @ defb0e31
History | View | Annotate | Download (16.8 kB)
1 | 3285cf4f | Anthony PERARD | /*
|
---|---|---|---|
2 | 3285cf4f | Anthony PERARD | * Copyright (C) 2010 Citrix Ltd.
|
3 | 3285cf4f | Anthony PERARD | *
|
4 | 3285cf4f | Anthony PERARD | * This work is licensed under the terms of the GNU GPL, version 2. See
|
5 | 3285cf4f | Anthony PERARD | * the COPYING file in the top-level directory.
|
6 | 3285cf4f | Anthony PERARD | *
|
7 | 3285cf4f | Anthony PERARD | */
|
8 | 3285cf4f | Anthony PERARD | |
9 | 9ce94e7c | Arun Sharma | #include <sys/mman.h> |
10 | 9ce94e7c | Arun Sharma | |
11 | 41445300 | Anthony PERARD | #include "hw/pci.h" |
12 | c9622478 | Anthony PERARD | #include "hw/pc.h" |
13 | 3285cf4f | Anthony PERARD | #include "hw/xen_common.h" |
14 | 3285cf4f | Anthony PERARD | #include "hw/xen_backend.h" |
15 | 3285cf4f | Anthony PERARD | |
16 | 432d268c | Jun Nakajima | #include "xen-mapcache.h" |
17 | 432d268c | Jun Nakajima | #include "trace.h" |
18 | 432d268c | Jun Nakajima | |
19 | 9ce94e7c | Arun Sharma | #include <xen/hvm/ioreq.h> |
20 | 9ce94e7c | Arun Sharma | #include <xen/hvm/params.h> |
21 | 9ce94e7c | Arun Sharma | |
22 | 9ce94e7c | Arun Sharma | //#define DEBUG_XEN
|
23 | 9ce94e7c | Arun Sharma | |
24 | 9ce94e7c | Arun Sharma | #ifdef DEBUG_XEN
|
25 | 9ce94e7c | Arun Sharma | #define DPRINTF(fmt, ...) \
|
26 | 9ce94e7c | Arun Sharma | do { fprintf(stderr, "xen: " fmt, ## __VA_ARGS__); } while (0) |
27 | 9ce94e7c | Arun Sharma | #else
|
28 | 9ce94e7c | Arun Sharma | #define DPRINTF(fmt, ...) \
|
29 | 9ce94e7c | Arun Sharma | do { } while (0) |
30 | 9ce94e7c | Arun Sharma | #endif
|
31 | 9ce94e7c | Arun Sharma | |
32 | 9ce94e7c | Arun Sharma | /* Compatibility with older version */
|
33 | 9ce94e7c | Arun Sharma | #if __XEN_LATEST_INTERFACE_VERSION__ < 0x0003020a |
34 | 9ce94e7c | Arun Sharma | static inline uint32_t xen_vcpu_eport(shared_iopage_t *shared_page, int i) |
35 | 9ce94e7c | Arun Sharma | { |
36 | 9ce94e7c | Arun Sharma | return shared_page->vcpu_iodata[i].vp_eport;
|
37 | 9ce94e7c | Arun Sharma | } |
38 | 9ce94e7c | Arun Sharma | static inline ioreq_t *xen_vcpu_ioreq(shared_iopage_t *shared_page, int vcpu) |
39 | 9ce94e7c | Arun Sharma | { |
40 | 9ce94e7c | Arun Sharma | return &shared_page->vcpu_iodata[vcpu].vp_ioreq;
|
41 | 9ce94e7c | Arun Sharma | } |
42 | 9ce94e7c | Arun Sharma | # define FMT_ioreq_size PRIx64
|
43 | 9ce94e7c | Arun Sharma | #else
|
44 | 9ce94e7c | Arun Sharma | static inline uint32_t xen_vcpu_eport(shared_iopage_t *shared_page, int i) |
45 | 9ce94e7c | Arun Sharma | { |
46 | 9ce94e7c | Arun Sharma | return shared_page->vcpu_ioreq[i].vp_eport;
|
47 | 9ce94e7c | Arun Sharma | } |
48 | 9ce94e7c | Arun Sharma | static inline ioreq_t *xen_vcpu_ioreq(shared_iopage_t *shared_page, int vcpu) |
49 | 9ce94e7c | Arun Sharma | { |
50 | 9ce94e7c | Arun Sharma | return &shared_page->vcpu_ioreq[vcpu];
|
51 | 9ce94e7c | Arun Sharma | } |
52 | 9ce94e7c | Arun Sharma | # define FMT_ioreq_size "u" |
53 | 9ce94e7c | Arun Sharma | #endif
|
54 | 9ce94e7c | Arun Sharma | |
55 | 9ce94e7c | Arun Sharma | #define BUFFER_IO_MAX_DELAY 100 |
56 | 9ce94e7c | Arun Sharma | |
57 | 9ce94e7c | Arun Sharma | typedef struct XenIOState { |
58 | 9ce94e7c | Arun Sharma | shared_iopage_t *shared_page; |
59 | 9ce94e7c | Arun Sharma | buffered_iopage_t *buffered_io_page; |
60 | 9ce94e7c | Arun Sharma | QEMUTimer *buffered_io_timer; |
61 | 9ce94e7c | Arun Sharma | /* the evtchn port for polling the notification, */
|
62 | 9ce94e7c | Arun Sharma | evtchn_port_t *ioreq_local_port; |
63 | 9ce94e7c | Arun Sharma | /* the evtchn fd for polling */
|
64 | 9ce94e7c | Arun Sharma | XenEvtchn xce_handle; |
65 | 9ce94e7c | Arun Sharma | /* which vcpu we are serving */
|
66 | 9ce94e7c | Arun Sharma | int send_vcpu;
|
67 | 9ce94e7c | Arun Sharma | |
68 | 29321335 | Anthony PERARD | struct xs_handle *xenstore;
|
69 | 29321335 | Anthony PERARD | |
70 | 9ce94e7c | Arun Sharma | Notifier exit; |
71 | 9ce94e7c | Arun Sharma | } XenIOState; |
72 | 9ce94e7c | Arun Sharma | |
73 | 41445300 | Anthony PERARD | /* Xen specific function for piix pci */
|
74 | 41445300 | Anthony PERARD | |
75 | 41445300 | Anthony PERARD | int xen_pci_slot_get_pirq(PCIDevice *pci_dev, int irq_num) |
76 | 41445300 | Anthony PERARD | { |
77 | 41445300 | Anthony PERARD | return irq_num + ((pci_dev->devfn >> 3) << 2); |
78 | 41445300 | Anthony PERARD | } |
79 | 41445300 | Anthony PERARD | |
80 | 41445300 | Anthony PERARD | void xen_piix3_set_irq(void *opaque, int irq_num, int level) |
81 | 41445300 | Anthony PERARD | { |
82 | 41445300 | Anthony PERARD | xc_hvm_set_pci_intx_level(xen_xc, xen_domid, 0, 0, irq_num >> 2, |
83 | 41445300 | Anthony PERARD | irq_num & 3, level);
|
84 | 41445300 | Anthony PERARD | } |
85 | 41445300 | Anthony PERARD | |
86 | 41445300 | Anthony PERARD | void xen_piix_pci_write_config_client(uint32_t address, uint32_t val, int len) |
87 | 41445300 | Anthony PERARD | { |
88 | 41445300 | Anthony PERARD | int i;
|
89 | 41445300 | Anthony PERARD | |
90 | 41445300 | Anthony PERARD | /* Scan for updates to PCI link routes (0x60-0x63). */
|
91 | 41445300 | Anthony PERARD | for (i = 0; i < len; i++) { |
92 | 41445300 | Anthony PERARD | uint8_t v = (val >> (8 * i)) & 0xff; |
93 | 41445300 | Anthony PERARD | if (v & 0x80) { |
94 | 41445300 | Anthony PERARD | v = 0;
|
95 | 41445300 | Anthony PERARD | } |
96 | 41445300 | Anthony PERARD | v &= 0xf;
|
97 | 41445300 | Anthony PERARD | if (((address + i) >= 0x60) && ((address + i) <= 0x63)) { |
98 | 41445300 | Anthony PERARD | xc_hvm_set_pci_link_route(xen_xc, xen_domid, address + i - 0x60, v);
|
99 | 41445300 | Anthony PERARD | } |
100 | 41445300 | Anthony PERARD | } |
101 | 41445300 | Anthony PERARD | } |
102 | 41445300 | Anthony PERARD | |
103 | c9622478 | Anthony PERARD | void xen_cmos_set_s3_resume(void *opaque, int irq, int level) |
104 | c9622478 | Anthony PERARD | { |
105 | c9622478 | Anthony PERARD | pc_cmos_set_s3_resume(opaque, irq, level); |
106 | c9622478 | Anthony PERARD | if (level) {
|
107 | c9622478 | Anthony PERARD | xc_set_hvm_param(xen_xc, xen_domid, HVM_PARAM_ACPI_S_STATE, 3);
|
108 | c9622478 | Anthony PERARD | } |
109 | c9622478 | Anthony PERARD | } |
110 | c9622478 | Anthony PERARD | |
111 | 9c11a8ac | Anthony PERARD | /* Xen Interrupt Controller */
|
112 | 9c11a8ac | Anthony PERARD | |
113 | 9c11a8ac | Anthony PERARD | static void xen_set_irq(void *opaque, int irq, int level) |
114 | 9c11a8ac | Anthony PERARD | { |
115 | 9c11a8ac | Anthony PERARD | xc_hvm_set_isa_irq_level(xen_xc, xen_domid, irq, level); |
116 | 9c11a8ac | Anthony PERARD | } |
117 | 9c11a8ac | Anthony PERARD | |
118 | 9c11a8ac | Anthony PERARD | qemu_irq *xen_interrupt_controller_init(void)
|
119 | 9c11a8ac | Anthony PERARD | { |
120 | 9c11a8ac | Anthony PERARD | return qemu_allocate_irqs(xen_set_irq, NULL, 16); |
121 | 9c11a8ac | Anthony PERARD | } |
122 | 9c11a8ac | Anthony PERARD | |
123 | 432d268c | Jun Nakajima | /* Memory Ops */
|
124 | 432d268c | Jun Nakajima | |
125 | 432d268c | Jun Nakajima | static void xen_ram_init(ram_addr_t ram_size) |
126 | 432d268c | Jun Nakajima | { |
127 | 432d268c | Jun Nakajima | RAMBlock *new_block; |
128 | 432d268c | Jun Nakajima | ram_addr_t below_4g_mem_size, above_4g_mem_size = 0;
|
129 | 432d268c | Jun Nakajima | |
130 | 432d268c | Jun Nakajima | new_block = qemu_mallocz(sizeof (*new_block));
|
131 | 432d268c | Jun Nakajima | pstrcpy(new_block->idstr, sizeof (new_block->idstr), "xen.ram"); |
132 | 432d268c | Jun Nakajima | new_block->host = NULL;
|
133 | 432d268c | Jun Nakajima | new_block->offset = 0;
|
134 | 432d268c | Jun Nakajima | new_block->length = ram_size; |
135 | 432d268c | Jun Nakajima | |
136 | 432d268c | Jun Nakajima | QLIST_INSERT_HEAD(&ram_list.blocks, new_block, next); |
137 | 432d268c | Jun Nakajima | |
138 | 432d268c | Jun Nakajima | ram_list.phys_dirty = qemu_realloc(ram_list.phys_dirty, |
139 | 432d268c | Jun Nakajima | new_block->length >> TARGET_PAGE_BITS); |
140 | 432d268c | Jun Nakajima | memset(ram_list.phys_dirty + (new_block->offset >> TARGET_PAGE_BITS), |
141 | 432d268c | Jun Nakajima | 0xff, new_block->length >> TARGET_PAGE_BITS);
|
142 | 432d268c | Jun Nakajima | |
143 | 432d268c | Jun Nakajima | if (ram_size >= 0xe0000000 ) { |
144 | 432d268c | Jun Nakajima | above_4g_mem_size = ram_size - 0xe0000000;
|
145 | 432d268c | Jun Nakajima | below_4g_mem_size = 0xe0000000;
|
146 | 432d268c | Jun Nakajima | } else {
|
147 | 432d268c | Jun Nakajima | below_4g_mem_size = ram_size; |
148 | 432d268c | Jun Nakajima | } |
149 | 432d268c | Jun Nakajima | |
150 | 432d268c | Jun Nakajima | cpu_register_physical_memory(0, below_4g_mem_size, new_block->offset);
|
151 | 432d268c | Jun Nakajima | #if TARGET_PHYS_ADDR_BITS > 32 |
152 | 432d268c | Jun Nakajima | if (above_4g_mem_size > 0) { |
153 | 432d268c | Jun Nakajima | cpu_register_physical_memory(0x100000000ULL, above_4g_mem_size,
|
154 | 432d268c | Jun Nakajima | new_block->offset + below_4g_mem_size); |
155 | 432d268c | Jun Nakajima | } |
156 | 432d268c | Jun Nakajima | #endif
|
157 | 432d268c | Jun Nakajima | } |
158 | 432d268c | Jun Nakajima | |
159 | 432d268c | Jun Nakajima | void xen_ram_alloc(ram_addr_t ram_addr, ram_addr_t size)
|
160 | 432d268c | Jun Nakajima | { |
161 | 432d268c | Jun Nakajima | unsigned long nr_pfn; |
162 | 432d268c | Jun Nakajima | xen_pfn_t *pfn_list; |
163 | 432d268c | Jun Nakajima | int i;
|
164 | 432d268c | Jun Nakajima | |
165 | 432d268c | Jun Nakajima | trace_xen_ram_alloc(ram_addr, size); |
166 | 432d268c | Jun Nakajima | |
167 | 432d268c | Jun Nakajima | nr_pfn = size >> TARGET_PAGE_BITS; |
168 | 432d268c | Jun Nakajima | pfn_list = qemu_malloc(sizeof (*pfn_list) * nr_pfn);
|
169 | 432d268c | Jun Nakajima | |
170 | 432d268c | Jun Nakajima | for (i = 0; i < nr_pfn; i++) { |
171 | 432d268c | Jun Nakajima | pfn_list[i] = (ram_addr >> TARGET_PAGE_BITS) + i; |
172 | 432d268c | Jun Nakajima | } |
173 | 432d268c | Jun Nakajima | |
174 | 432d268c | Jun Nakajima | if (xc_domain_populate_physmap_exact(xen_xc, xen_domid, nr_pfn, 0, 0, pfn_list)) { |
175 | 432d268c | Jun Nakajima | hw_error("xen: failed to populate ram at %lx", ram_addr);
|
176 | 432d268c | Jun Nakajima | } |
177 | 432d268c | Jun Nakajima | |
178 | 432d268c | Jun Nakajima | qemu_free(pfn_list); |
179 | 432d268c | Jun Nakajima | } |
180 | 432d268c | Jun Nakajima | |
181 | 432d268c | Jun Nakajima | |
182 | 29d3ccde | Anthony PERARD | /* VCPU Operations, MMIO, IO ring ... */
|
183 | 29d3ccde | Anthony PERARD | |
184 | 29d3ccde | Anthony PERARD | static void xen_reset_vcpu(void *opaque) |
185 | 29d3ccde | Anthony PERARD | { |
186 | 29d3ccde | Anthony PERARD | CPUState *env = opaque; |
187 | 29d3ccde | Anthony PERARD | |
188 | 29d3ccde | Anthony PERARD | env->halted = 1;
|
189 | 29d3ccde | Anthony PERARD | } |
190 | 29d3ccde | Anthony PERARD | |
191 | 29d3ccde | Anthony PERARD | void xen_vcpu_init(void) |
192 | 29d3ccde | Anthony PERARD | { |
193 | 29d3ccde | Anthony PERARD | CPUState *first_cpu; |
194 | 29d3ccde | Anthony PERARD | |
195 | 29d3ccde | Anthony PERARD | if ((first_cpu = qemu_get_cpu(0))) { |
196 | 29d3ccde | Anthony PERARD | qemu_register_reset(xen_reset_vcpu, first_cpu); |
197 | 29d3ccde | Anthony PERARD | xen_reset_vcpu(first_cpu); |
198 | 29d3ccde | Anthony PERARD | } |
199 | 29d3ccde | Anthony PERARD | } |
200 | 29d3ccde | Anthony PERARD | |
201 | 9ce94e7c | Arun Sharma | /* get the ioreq packets from share mem */
|
202 | 9ce94e7c | Arun Sharma | static ioreq_t *cpu_get_ioreq_from_shared_memory(XenIOState *state, int vcpu) |
203 | 9ce94e7c | Arun Sharma | { |
204 | 9ce94e7c | Arun Sharma | ioreq_t *req = xen_vcpu_ioreq(state->shared_page, vcpu); |
205 | 9ce94e7c | Arun Sharma | |
206 | 9ce94e7c | Arun Sharma | if (req->state != STATE_IOREQ_READY) {
|
207 | 9ce94e7c | Arun Sharma | DPRINTF("I/O request not ready: "
|
208 | 9ce94e7c | Arun Sharma | "%x, ptr: %x, port: %"PRIx64", " |
209 | 9ce94e7c | Arun Sharma | "data: %"PRIx64", count: %" FMT_ioreq_size ", size: %" FMT_ioreq_size "\n", |
210 | 9ce94e7c | Arun Sharma | req->state, req->data_is_ptr, req->addr, |
211 | 9ce94e7c | Arun Sharma | req->data, req->count, req->size); |
212 | 9ce94e7c | Arun Sharma | return NULL; |
213 | 9ce94e7c | Arun Sharma | } |
214 | 9ce94e7c | Arun Sharma | |
215 | 9ce94e7c | Arun Sharma | xen_rmb(); /* see IOREQ_READY /then/ read contents of ioreq */
|
216 | 9ce94e7c | Arun Sharma | |
217 | 9ce94e7c | Arun Sharma | req->state = STATE_IOREQ_INPROCESS; |
218 | 9ce94e7c | Arun Sharma | return req;
|
219 | 9ce94e7c | Arun Sharma | } |
220 | 9ce94e7c | Arun Sharma | |
221 | 9ce94e7c | Arun Sharma | /* use poll to get the port notification */
|
222 | 9ce94e7c | Arun Sharma | /* ioreq_vec--out,the */
|
223 | 9ce94e7c | Arun Sharma | /* retval--the number of ioreq packet */
|
224 | 9ce94e7c | Arun Sharma | static ioreq_t *cpu_get_ioreq(XenIOState *state)
|
225 | 9ce94e7c | Arun Sharma | { |
226 | 9ce94e7c | Arun Sharma | int i;
|
227 | 9ce94e7c | Arun Sharma | evtchn_port_t port; |
228 | 9ce94e7c | Arun Sharma | |
229 | 9ce94e7c | Arun Sharma | port = xc_evtchn_pending(state->xce_handle); |
230 | 9ce94e7c | Arun Sharma | if (port != -1) { |
231 | 9ce94e7c | Arun Sharma | for (i = 0; i < smp_cpus; i++) { |
232 | 9ce94e7c | Arun Sharma | if (state->ioreq_local_port[i] == port) {
|
233 | 9ce94e7c | Arun Sharma | break;
|
234 | 9ce94e7c | Arun Sharma | } |
235 | 9ce94e7c | Arun Sharma | } |
236 | 9ce94e7c | Arun Sharma | |
237 | 9ce94e7c | Arun Sharma | if (i == smp_cpus) {
|
238 | 9ce94e7c | Arun Sharma | hw_error("Fatal error while trying to get io event!\n");
|
239 | 9ce94e7c | Arun Sharma | } |
240 | 9ce94e7c | Arun Sharma | |
241 | 9ce94e7c | Arun Sharma | /* unmask the wanted port again */
|
242 | 9ce94e7c | Arun Sharma | xc_evtchn_unmask(state->xce_handle, port); |
243 | 9ce94e7c | Arun Sharma | |
244 | 9ce94e7c | Arun Sharma | /* get the io packet from shared memory */
|
245 | 9ce94e7c | Arun Sharma | state->send_vcpu = i; |
246 | 9ce94e7c | Arun Sharma | return cpu_get_ioreq_from_shared_memory(state, i);
|
247 | 9ce94e7c | Arun Sharma | } |
248 | 9ce94e7c | Arun Sharma | |
249 | 9ce94e7c | Arun Sharma | /* read error or read nothing */
|
250 | 9ce94e7c | Arun Sharma | return NULL; |
251 | 9ce94e7c | Arun Sharma | } |
252 | 9ce94e7c | Arun Sharma | |
253 | 9ce94e7c | Arun Sharma | static uint32_t do_inp(pio_addr_t addr, unsigned long size) |
254 | 9ce94e7c | Arun Sharma | { |
255 | 9ce94e7c | Arun Sharma | switch (size) {
|
256 | 9ce94e7c | Arun Sharma | case 1: |
257 | 9ce94e7c | Arun Sharma | return cpu_inb(addr);
|
258 | 9ce94e7c | Arun Sharma | case 2: |
259 | 9ce94e7c | Arun Sharma | return cpu_inw(addr);
|
260 | 9ce94e7c | Arun Sharma | case 4: |
261 | 9ce94e7c | Arun Sharma | return cpu_inl(addr);
|
262 | 9ce94e7c | Arun Sharma | default:
|
263 | 9ce94e7c | Arun Sharma | hw_error("inp: bad size: %04"FMT_pioaddr" %lx", addr, size); |
264 | 9ce94e7c | Arun Sharma | } |
265 | 9ce94e7c | Arun Sharma | } |
266 | 9ce94e7c | Arun Sharma | |
267 | 9ce94e7c | Arun Sharma | static void do_outp(pio_addr_t addr, |
268 | 9ce94e7c | Arun Sharma | unsigned long size, uint32_t val) |
269 | 9ce94e7c | Arun Sharma | { |
270 | 9ce94e7c | Arun Sharma | switch (size) {
|
271 | 9ce94e7c | Arun Sharma | case 1: |
272 | 9ce94e7c | Arun Sharma | return cpu_outb(addr, val);
|
273 | 9ce94e7c | Arun Sharma | case 2: |
274 | 9ce94e7c | Arun Sharma | return cpu_outw(addr, val);
|
275 | 9ce94e7c | Arun Sharma | case 4: |
276 | 9ce94e7c | Arun Sharma | return cpu_outl(addr, val);
|
277 | 9ce94e7c | Arun Sharma | default:
|
278 | 9ce94e7c | Arun Sharma | hw_error("outp: bad size: %04"FMT_pioaddr" %lx", addr, size); |
279 | 9ce94e7c | Arun Sharma | } |
280 | 9ce94e7c | Arun Sharma | } |
281 | 9ce94e7c | Arun Sharma | |
282 | 9ce94e7c | Arun Sharma | static void cpu_ioreq_pio(ioreq_t *req) |
283 | 9ce94e7c | Arun Sharma | { |
284 | 9ce94e7c | Arun Sharma | int i, sign;
|
285 | 9ce94e7c | Arun Sharma | |
286 | 9ce94e7c | Arun Sharma | sign = req->df ? -1 : 1; |
287 | 9ce94e7c | Arun Sharma | |
288 | 9ce94e7c | Arun Sharma | if (req->dir == IOREQ_READ) {
|
289 | 9ce94e7c | Arun Sharma | if (!req->data_is_ptr) {
|
290 | 9ce94e7c | Arun Sharma | req->data = do_inp(req->addr, req->size); |
291 | 9ce94e7c | Arun Sharma | } else {
|
292 | 9ce94e7c | Arun Sharma | uint32_t tmp; |
293 | 9ce94e7c | Arun Sharma | |
294 | 9ce94e7c | Arun Sharma | for (i = 0; i < req->count; i++) { |
295 | 9ce94e7c | Arun Sharma | tmp = do_inp(req->addr, req->size); |
296 | 9ce94e7c | Arun Sharma | cpu_physical_memory_write(req->data + (sign * i * req->size), |
297 | 9ce94e7c | Arun Sharma | (uint8_t *) &tmp, req->size); |
298 | 9ce94e7c | Arun Sharma | } |
299 | 9ce94e7c | Arun Sharma | } |
300 | 9ce94e7c | Arun Sharma | } else if (req->dir == IOREQ_WRITE) { |
301 | 9ce94e7c | Arun Sharma | if (!req->data_is_ptr) {
|
302 | 9ce94e7c | Arun Sharma | do_outp(req->addr, req->size, req->data); |
303 | 9ce94e7c | Arun Sharma | } else {
|
304 | 9ce94e7c | Arun Sharma | for (i = 0; i < req->count; i++) { |
305 | 9ce94e7c | Arun Sharma | uint32_t tmp = 0;
|
306 | 9ce94e7c | Arun Sharma | |
307 | 9ce94e7c | Arun Sharma | cpu_physical_memory_read(req->data + (sign * i * req->size), |
308 | 9ce94e7c | Arun Sharma | (uint8_t*) &tmp, req->size); |
309 | 9ce94e7c | Arun Sharma | do_outp(req->addr, req->size, tmp); |
310 | 9ce94e7c | Arun Sharma | } |
311 | 9ce94e7c | Arun Sharma | } |
312 | 9ce94e7c | Arun Sharma | } |
313 | 9ce94e7c | Arun Sharma | } |
314 | 9ce94e7c | Arun Sharma | |
315 | 9ce94e7c | Arun Sharma | static void cpu_ioreq_move(ioreq_t *req) |
316 | 9ce94e7c | Arun Sharma | { |
317 | 9ce94e7c | Arun Sharma | int i, sign;
|
318 | 9ce94e7c | Arun Sharma | |
319 | 9ce94e7c | Arun Sharma | sign = req->df ? -1 : 1; |
320 | 9ce94e7c | Arun Sharma | |
321 | 9ce94e7c | Arun Sharma | if (!req->data_is_ptr) {
|
322 | 9ce94e7c | Arun Sharma | if (req->dir == IOREQ_READ) {
|
323 | 9ce94e7c | Arun Sharma | for (i = 0; i < req->count; i++) { |
324 | 9ce94e7c | Arun Sharma | cpu_physical_memory_read(req->addr + (sign * i * req->size), |
325 | 9ce94e7c | Arun Sharma | (uint8_t *) &req->data, req->size); |
326 | 9ce94e7c | Arun Sharma | } |
327 | 9ce94e7c | Arun Sharma | } else if (req->dir == IOREQ_WRITE) { |
328 | 9ce94e7c | Arun Sharma | for (i = 0; i < req->count; i++) { |
329 | 9ce94e7c | Arun Sharma | cpu_physical_memory_write(req->addr + (sign * i * req->size), |
330 | 9ce94e7c | Arun Sharma | (uint8_t *) &req->data, req->size); |
331 | 9ce94e7c | Arun Sharma | } |
332 | 9ce94e7c | Arun Sharma | } |
333 | 9ce94e7c | Arun Sharma | } else {
|
334 | 9ce94e7c | Arun Sharma | target_ulong tmp; |
335 | 9ce94e7c | Arun Sharma | |
336 | 9ce94e7c | Arun Sharma | if (req->dir == IOREQ_READ) {
|
337 | 9ce94e7c | Arun Sharma | for (i = 0; i < req->count; i++) { |
338 | 9ce94e7c | Arun Sharma | cpu_physical_memory_read(req->addr + (sign * i * req->size), |
339 | 9ce94e7c | Arun Sharma | (uint8_t*) &tmp, req->size); |
340 | 9ce94e7c | Arun Sharma | cpu_physical_memory_write(req->data + (sign * i * req->size), |
341 | 9ce94e7c | Arun Sharma | (uint8_t*) &tmp, req->size); |
342 | 9ce94e7c | Arun Sharma | } |
343 | 9ce94e7c | Arun Sharma | } else if (req->dir == IOREQ_WRITE) { |
344 | 9ce94e7c | Arun Sharma | for (i = 0; i < req->count; i++) { |
345 | 9ce94e7c | Arun Sharma | cpu_physical_memory_read(req->data + (sign * i * req->size), |
346 | 9ce94e7c | Arun Sharma | (uint8_t*) &tmp, req->size); |
347 | 9ce94e7c | Arun Sharma | cpu_physical_memory_write(req->addr + (sign * i * req->size), |
348 | 9ce94e7c | Arun Sharma | (uint8_t*) &tmp, req->size); |
349 | 9ce94e7c | Arun Sharma | } |
350 | 9ce94e7c | Arun Sharma | } |
351 | 9ce94e7c | Arun Sharma | } |
352 | 9ce94e7c | Arun Sharma | } |
353 | 9ce94e7c | Arun Sharma | |
354 | 9ce94e7c | Arun Sharma | static void handle_ioreq(ioreq_t *req) |
355 | 9ce94e7c | Arun Sharma | { |
356 | 9ce94e7c | Arun Sharma | if (!req->data_is_ptr && (req->dir == IOREQ_WRITE) &&
|
357 | 9ce94e7c | Arun Sharma | (req->size < sizeof (target_ulong))) {
|
358 | 9ce94e7c | Arun Sharma | req->data &= ((target_ulong) 1 << (8 * req->size)) - 1; |
359 | 9ce94e7c | Arun Sharma | } |
360 | 9ce94e7c | Arun Sharma | |
361 | 9ce94e7c | Arun Sharma | switch (req->type) {
|
362 | 9ce94e7c | Arun Sharma | case IOREQ_TYPE_PIO:
|
363 | 9ce94e7c | Arun Sharma | cpu_ioreq_pio(req); |
364 | 9ce94e7c | Arun Sharma | break;
|
365 | 9ce94e7c | Arun Sharma | case IOREQ_TYPE_COPY:
|
366 | 9ce94e7c | Arun Sharma | cpu_ioreq_move(req); |
367 | 9ce94e7c | Arun Sharma | break;
|
368 | 9ce94e7c | Arun Sharma | case IOREQ_TYPE_TIMEOFFSET:
|
369 | 9ce94e7c | Arun Sharma | break;
|
370 | 9ce94e7c | Arun Sharma | case IOREQ_TYPE_INVALIDATE:
|
371 | 9ce94e7c | Arun Sharma | qemu_invalidate_map_cache(); |
372 | 9ce94e7c | Arun Sharma | break;
|
373 | 9ce94e7c | Arun Sharma | default:
|
374 | 9ce94e7c | Arun Sharma | hw_error("Invalid ioreq type 0x%x\n", req->type);
|
375 | 9ce94e7c | Arun Sharma | } |
376 | 9ce94e7c | Arun Sharma | } |
377 | 9ce94e7c | Arun Sharma | |
378 | 9ce94e7c | Arun Sharma | static void handle_buffered_iopage(XenIOState *state) |
379 | 9ce94e7c | Arun Sharma | { |
380 | 9ce94e7c | Arun Sharma | buf_ioreq_t *buf_req = NULL;
|
381 | 9ce94e7c | Arun Sharma | ioreq_t req; |
382 | 9ce94e7c | Arun Sharma | int qw;
|
383 | 9ce94e7c | Arun Sharma | |
384 | 9ce94e7c | Arun Sharma | if (!state->buffered_io_page) {
|
385 | 9ce94e7c | Arun Sharma | return;
|
386 | 9ce94e7c | Arun Sharma | } |
387 | 9ce94e7c | Arun Sharma | |
388 | 9ce94e7c | Arun Sharma | while (state->buffered_io_page->read_pointer != state->buffered_io_page->write_pointer) {
|
389 | 9ce94e7c | Arun Sharma | buf_req = &state->buffered_io_page->buf_ioreq[ |
390 | 9ce94e7c | Arun Sharma | state->buffered_io_page->read_pointer % IOREQ_BUFFER_SLOT_NUM]; |
391 | 9ce94e7c | Arun Sharma | req.size = 1UL << buf_req->size;
|
392 | 9ce94e7c | Arun Sharma | req.count = 1;
|
393 | 9ce94e7c | Arun Sharma | req.addr = buf_req->addr; |
394 | 9ce94e7c | Arun Sharma | req.data = buf_req->data; |
395 | 9ce94e7c | Arun Sharma | req.state = STATE_IOREQ_READY; |
396 | 9ce94e7c | Arun Sharma | req.dir = buf_req->dir; |
397 | 9ce94e7c | Arun Sharma | req.df = 1;
|
398 | 9ce94e7c | Arun Sharma | req.type = buf_req->type; |
399 | 9ce94e7c | Arun Sharma | req.data_is_ptr = 0;
|
400 | 9ce94e7c | Arun Sharma | qw = (req.size == 8);
|
401 | 9ce94e7c | Arun Sharma | if (qw) {
|
402 | 9ce94e7c | Arun Sharma | buf_req = &state->buffered_io_page->buf_ioreq[ |
403 | 9ce94e7c | Arun Sharma | (state->buffered_io_page->read_pointer + 1) % IOREQ_BUFFER_SLOT_NUM];
|
404 | 9ce94e7c | Arun Sharma | req.data |= ((uint64_t)buf_req->data) << 32;
|
405 | 9ce94e7c | Arun Sharma | } |
406 | 9ce94e7c | Arun Sharma | |
407 | 9ce94e7c | Arun Sharma | handle_ioreq(&req); |
408 | 9ce94e7c | Arun Sharma | |
409 | 9ce94e7c | Arun Sharma | xen_mb(); |
410 | 9ce94e7c | Arun Sharma | state->buffered_io_page->read_pointer += qw ? 2 : 1; |
411 | 9ce94e7c | Arun Sharma | } |
412 | 9ce94e7c | Arun Sharma | } |
413 | 9ce94e7c | Arun Sharma | |
414 | 9ce94e7c | Arun Sharma | static void handle_buffered_io(void *opaque) |
415 | 9ce94e7c | Arun Sharma | { |
416 | 9ce94e7c | Arun Sharma | XenIOState *state = opaque; |
417 | 9ce94e7c | Arun Sharma | |
418 | 9ce94e7c | Arun Sharma | handle_buffered_iopage(state); |
419 | 9ce94e7c | Arun Sharma | qemu_mod_timer(state->buffered_io_timer, |
420 | 9ce94e7c | Arun Sharma | BUFFER_IO_MAX_DELAY + qemu_get_clock_ms(rt_clock)); |
421 | 9ce94e7c | Arun Sharma | } |
422 | 9ce94e7c | Arun Sharma | |
423 | 9ce94e7c | Arun Sharma | static void cpu_handle_ioreq(void *opaque) |
424 | 9ce94e7c | Arun Sharma | { |
425 | 9ce94e7c | Arun Sharma | XenIOState *state = opaque; |
426 | 9ce94e7c | Arun Sharma | ioreq_t *req = cpu_get_ioreq(state); |
427 | 9ce94e7c | Arun Sharma | |
428 | 9ce94e7c | Arun Sharma | handle_buffered_iopage(state); |
429 | 9ce94e7c | Arun Sharma | if (req) {
|
430 | 9ce94e7c | Arun Sharma | handle_ioreq(req); |
431 | 9ce94e7c | Arun Sharma | |
432 | 9ce94e7c | Arun Sharma | if (req->state != STATE_IOREQ_INPROCESS) {
|
433 | 9ce94e7c | Arun Sharma | fprintf(stderr, "Badness in I/O request ... not in service?!: "
|
434 | 9ce94e7c | Arun Sharma | "%x, ptr: %x, port: %"PRIx64", " |
435 | 9ce94e7c | Arun Sharma | "data: %"PRIx64", count: %" FMT_ioreq_size ", size: %" FMT_ioreq_size "\n", |
436 | 9ce94e7c | Arun Sharma | req->state, req->data_is_ptr, req->addr, |
437 | 9ce94e7c | Arun Sharma | req->data, req->count, req->size); |
438 | 9ce94e7c | Arun Sharma | destroy_hvm_domain(); |
439 | 9ce94e7c | Arun Sharma | return;
|
440 | 9ce94e7c | Arun Sharma | } |
441 | 9ce94e7c | Arun Sharma | |
442 | 9ce94e7c | Arun Sharma | xen_wmb(); /* Update ioreq contents /then/ update state. */
|
443 | 9ce94e7c | Arun Sharma | |
444 | 9ce94e7c | Arun Sharma | /*
|
445 | 9ce94e7c | Arun Sharma | * We do this before we send the response so that the tools
|
446 | 9ce94e7c | Arun Sharma | * have the opportunity to pick up on the reset before the
|
447 | 9ce94e7c | Arun Sharma | * guest resumes and does a hlt with interrupts disabled which
|
448 | 9ce94e7c | Arun Sharma | * causes Xen to powerdown the domain.
|
449 | 9ce94e7c | Arun Sharma | */
|
450 | 9ce94e7c | Arun Sharma | if (vm_running) {
|
451 | 9ce94e7c | Arun Sharma | if (qemu_shutdown_requested_get()) {
|
452 | 9ce94e7c | Arun Sharma | destroy_hvm_domain(); |
453 | 9ce94e7c | Arun Sharma | } |
454 | 9ce94e7c | Arun Sharma | if (qemu_reset_requested_get()) {
|
455 | 9ce94e7c | Arun Sharma | qemu_system_reset(); |
456 | 9ce94e7c | Arun Sharma | } |
457 | 9ce94e7c | Arun Sharma | } |
458 | 9ce94e7c | Arun Sharma | |
459 | 9ce94e7c | Arun Sharma | req->state = STATE_IORESP_READY; |
460 | 9ce94e7c | Arun Sharma | xc_evtchn_notify(state->xce_handle, state->ioreq_local_port[state->send_vcpu]); |
461 | 9ce94e7c | Arun Sharma | } |
462 | 9ce94e7c | Arun Sharma | } |
463 | 9ce94e7c | Arun Sharma | |
464 | 29321335 | Anthony PERARD | static void xenstore_record_dm_state(XenIOState *s, const char *state) |
465 | 29321335 | Anthony PERARD | { |
466 | 29321335 | Anthony PERARD | char path[50]; |
467 | 29321335 | Anthony PERARD | |
468 | 29321335 | Anthony PERARD | snprintf(path, sizeof (path), "/local/domain/0/device-model/%u/state", xen_domid); |
469 | 29321335 | Anthony PERARD | if (!xs_write(s->xenstore, XBT_NULL, path, state, strlen(state))) {
|
470 | 29321335 | Anthony PERARD | fprintf(stderr, "error recording dm state\n");
|
471 | 29321335 | Anthony PERARD | exit(1);
|
472 | 29321335 | Anthony PERARD | } |
473 | 29321335 | Anthony PERARD | } |
474 | 29321335 | Anthony PERARD | |
475 | 9ce94e7c | Arun Sharma | static void xen_main_loop_prepare(XenIOState *state) |
476 | 9ce94e7c | Arun Sharma | { |
477 | 9ce94e7c | Arun Sharma | int evtchn_fd = -1; |
478 | 9ce94e7c | Arun Sharma | |
479 | 9ce94e7c | Arun Sharma | if (state->xce_handle != XC_HANDLER_INITIAL_VALUE) {
|
480 | 9ce94e7c | Arun Sharma | evtchn_fd = xc_evtchn_fd(state->xce_handle); |
481 | 9ce94e7c | Arun Sharma | } |
482 | 9ce94e7c | Arun Sharma | |
483 | 9ce94e7c | Arun Sharma | state->buffered_io_timer = qemu_new_timer_ms(rt_clock, handle_buffered_io, |
484 | 9ce94e7c | Arun Sharma | state); |
485 | 9ce94e7c | Arun Sharma | qemu_mod_timer(state->buffered_io_timer, qemu_get_clock_ms(rt_clock)); |
486 | 9ce94e7c | Arun Sharma | |
487 | 9ce94e7c | Arun Sharma | if (evtchn_fd != -1) { |
488 | 9ce94e7c | Arun Sharma | qemu_set_fd_handler(evtchn_fd, cpu_handle_ioreq, NULL, state);
|
489 | 9ce94e7c | Arun Sharma | } |
490 | 29321335 | Anthony PERARD | |
491 | 29321335 | Anthony PERARD | /* record state running */
|
492 | 29321335 | Anthony PERARD | xenstore_record_dm_state(state, "running");
|
493 | 9ce94e7c | Arun Sharma | } |
494 | 9ce94e7c | Arun Sharma | |
495 | 9ce94e7c | Arun Sharma | |
496 | 3285cf4f | Anthony PERARD | /* Initialise Xen */
|
497 | 3285cf4f | Anthony PERARD | |
498 | 9ce94e7c | Arun Sharma | static void xen_vm_change_state_handler(void *opaque, int running, int reason) |
499 | 9ce94e7c | Arun Sharma | { |
500 | 9ce94e7c | Arun Sharma | XenIOState *state = opaque; |
501 | 9ce94e7c | Arun Sharma | if (running) {
|
502 | 9ce94e7c | Arun Sharma | xen_main_loop_prepare(state); |
503 | 9ce94e7c | Arun Sharma | } |
504 | 9ce94e7c | Arun Sharma | } |
505 | 9ce94e7c | Arun Sharma | |
506 | 9ce94e7c | Arun Sharma | static void xen_exit_notifier(Notifier *n) |
507 | 9ce94e7c | Arun Sharma | { |
508 | 9ce94e7c | Arun Sharma | XenIOState *state = container_of(n, XenIOState, exit); |
509 | 9ce94e7c | Arun Sharma | |
510 | 9ce94e7c | Arun Sharma | xc_evtchn_close(state->xce_handle); |
511 | 29321335 | Anthony PERARD | xs_daemon_close(state->xenstore); |
512 | 9ce94e7c | Arun Sharma | } |
513 | 9ce94e7c | Arun Sharma | |
514 | 3285cf4f | Anthony PERARD | int xen_init(void) |
515 | 3285cf4f | Anthony PERARD | { |
516 | 3285cf4f | Anthony PERARD | xen_xc = xen_xc_interface_open(0, 0, 0); |
517 | 3285cf4f | Anthony PERARD | if (xen_xc == XC_HANDLER_INITIAL_VALUE) {
|
518 | 3285cf4f | Anthony PERARD | xen_be_printf(NULL, 0, "can't open xen interface\n"); |
519 | 3285cf4f | Anthony PERARD | return -1; |
520 | 3285cf4f | Anthony PERARD | } |
521 | 3285cf4f | Anthony PERARD | |
522 | 3285cf4f | Anthony PERARD | return 0; |
523 | 3285cf4f | Anthony PERARD | } |
524 | 29d3ccde | Anthony PERARD | |
525 | 29d3ccde | Anthony PERARD | int xen_hvm_init(void) |
526 | 29d3ccde | Anthony PERARD | { |
527 | 9ce94e7c | Arun Sharma | int i, rc;
|
528 | 9ce94e7c | Arun Sharma | unsigned long ioreq_pfn; |
529 | 9ce94e7c | Arun Sharma | XenIOState *state; |
530 | 9ce94e7c | Arun Sharma | |
531 | 9ce94e7c | Arun Sharma | state = qemu_mallocz(sizeof (XenIOState));
|
532 | 9ce94e7c | Arun Sharma | |
533 | 9ce94e7c | Arun Sharma | state->xce_handle = xen_xc_evtchn_open(NULL, 0); |
534 | 9ce94e7c | Arun Sharma | if (state->xce_handle == XC_HANDLER_INITIAL_VALUE) {
|
535 | 9ce94e7c | Arun Sharma | perror("xen: event channel open");
|
536 | 9ce94e7c | Arun Sharma | return -errno;
|
537 | 9ce94e7c | Arun Sharma | } |
538 | 9ce94e7c | Arun Sharma | |
539 | 29321335 | Anthony PERARD | state->xenstore = xs_daemon_open(); |
540 | 29321335 | Anthony PERARD | if (state->xenstore == NULL) { |
541 | 29321335 | Anthony PERARD | perror("xen: xenstore open");
|
542 | 29321335 | Anthony PERARD | return -errno;
|
543 | 29321335 | Anthony PERARD | } |
544 | 29321335 | Anthony PERARD | |
545 | 9ce94e7c | Arun Sharma | state->exit.notify = xen_exit_notifier; |
546 | 9ce94e7c | Arun Sharma | qemu_add_exit_notifier(&state->exit); |
547 | 9ce94e7c | Arun Sharma | |
548 | 9ce94e7c | Arun Sharma | xc_get_hvm_param(xen_xc, xen_domid, HVM_PARAM_IOREQ_PFN, &ioreq_pfn); |
549 | 9ce94e7c | Arun Sharma | DPRINTF("shared page at pfn %lx\n", ioreq_pfn);
|
550 | 9ce94e7c | Arun Sharma | state->shared_page = xc_map_foreign_range(xen_xc, xen_domid, XC_PAGE_SIZE, |
551 | 9ce94e7c | Arun Sharma | PROT_READ|PROT_WRITE, ioreq_pfn); |
552 | 9ce94e7c | Arun Sharma | if (state->shared_page == NULL) { |
553 | 9ce94e7c | Arun Sharma | hw_error("map shared IO page returned error %d handle=" XC_INTERFACE_FMT,
|
554 | 9ce94e7c | Arun Sharma | errno, xen_xc); |
555 | 9ce94e7c | Arun Sharma | } |
556 | 9ce94e7c | Arun Sharma | |
557 | 9ce94e7c | Arun Sharma | xc_get_hvm_param(xen_xc, xen_domid, HVM_PARAM_BUFIOREQ_PFN, &ioreq_pfn); |
558 | 9ce94e7c | Arun Sharma | DPRINTF("buffered io page at pfn %lx\n", ioreq_pfn);
|
559 | 9ce94e7c | Arun Sharma | state->buffered_io_page = xc_map_foreign_range(xen_xc, xen_domid, XC_PAGE_SIZE, |
560 | 9ce94e7c | Arun Sharma | PROT_READ|PROT_WRITE, ioreq_pfn); |
561 | 9ce94e7c | Arun Sharma | if (state->buffered_io_page == NULL) { |
562 | 9ce94e7c | Arun Sharma | hw_error("map buffered IO page returned error %d", errno);
|
563 | 9ce94e7c | Arun Sharma | } |
564 | 9ce94e7c | Arun Sharma | |
565 | 9ce94e7c | Arun Sharma | state->ioreq_local_port = qemu_mallocz(smp_cpus * sizeof (evtchn_port_t));
|
566 | 9ce94e7c | Arun Sharma | |
567 | 9ce94e7c | Arun Sharma | /* FIXME: how about if we overflow the page here? */
|
568 | 9ce94e7c | Arun Sharma | for (i = 0; i < smp_cpus; i++) { |
569 | 9ce94e7c | Arun Sharma | rc = xc_evtchn_bind_interdomain(state->xce_handle, xen_domid, |
570 | 9ce94e7c | Arun Sharma | xen_vcpu_eport(state->shared_page, i)); |
571 | 9ce94e7c | Arun Sharma | if (rc == -1) { |
572 | 9ce94e7c | Arun Sharma | fprintf(stderr, "bind interdomain ioctl error %d\n", errno);
|
573 | 9ce94e7c | Arun Sharma | return -1; |
574 | 9ce94e7c | Arun Sharma | } |
575 | 9ce94e7c | Arun Sharma | state->ioreq_local_port[i] = rc; |
576 | 9ce94e7c | Arun Sharma | } |
577 | 9ce94e7c | Arun Sharma | |
578 | 432d268c | Jun Nakajima | /* Init RAM management */
|
579 | 432d268c | Jun Nakajima | qemu_map_cache_init(); |
580 | 432d268c | Jun Nakajima | xen_ram_init(ram_size); |
581 | 432d268c | Jun Nakajima | |
582 | 9ce94e7c | Arun Sharma | qemu_add_vm_change_state_handler(xen_vm_change_state_handler, state); |
583 | 9ce94e7c | Arun Sharma | |
584 | 29d3ccde | Anthony PERARD | return 0; |
585 | 29d3ccde | Anthony PERARD | } |
586 | 9ce94e7c | Arun Sharma | |
587 | 9ce94e7c | Arun Sharma | void destroy_hvm_domain(void) |
588 | 9ce94e7c | Arun Sharma | { |
589 | 9ce94e7c | Arun Sharma | XenXC xc_handle; |
590 | 9ce94e7c | Arun Sharma | int sts;
|
591 | 9ce94e7c | Arun Sharma | |
592 | 9ce94e7c | Arun Sharma | xc_handle = xen_xc_interface_open(0, 0, 0); |
593 | 9ce94e7c | Arun Sharma | if (xc_handle == XC_HANDLER_INITIAL_VALUE) {
|
594 | 9ce94e7c | Arun Sharma | fprintf(stderr, "Cannot acquire xenctrl handle\n");
|
595 | 9ce94e7c | Arun Sharma | } else {
|
596 | 9ce94e7c | Arun Sharma | sts = xc_domain_shutdown(xc_handle, xen_domid, SHUTDOWN_poweroff); |
597 | 9ce94e7c | Arun Sharma | if (sts != 0) { |
598 | 9ce94e7c | Arun Sharma | fprintf(stderr, "? xc_domain_shutdown failed to issue poweroff, "
|
599 | 9ce94e7c | Arun Sharma | "sts %d, %s\n", sts, strerror(errno));
|
600 | 9ce94e7c | Arun Sharma | } else {
|
601 | 9ce94e7c | Arun Sharma | fprintf(stderr, "Issued domain %d poweroff\n", xen_domid);
|
602 | 9ce94e7c | Arun Sharma | } |
603 | 9ce94e7c | Arun Sharma | xc_interface_close(xc_handle); |
604 | 9ce94e7c | Arun Sharma | } |
605 | 9ce94e7c | Arun Sharma | } |