root / xen-all.c @ 250b086e
History | View | Annotate | Download (29.9 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 | 6b620ca3 | Paolo Bonzini | * Contributions after 2012-01-13 are licensed under the terms of the
|
8 | 6b620ca3 | Paolo Bonzini | * GNU GPL, version 2 or (at your option) any later version.
|
9 | 3285cf4f | Anthony PERARD | */
|
10 | 3285cf4f | Anthony PERARD | |
11 | 9ce94e7c | Arun Sharma | #include <sys/mman.h> |
12 | 9ce94e7c | Arun Sharma | |
13 | 41445300 | Anthony PERARD | #include "hw/pci.h" |
14 | c9622478 | Anthony PERARD | #include "hw/pc.h" |
15 | 3285cf4f | Anthony PERARD | #include "hw/xen_common.h" |
16 | 3285cf4f | Anthony PERARD | #include "hw/xen_backend.h" |
17 | 3285cf4f | Anthony PERARD | |
18 | b4dd7802 | Anthony PERARD | #include "range.h" |
19 | 432d268c | Jun Nakajima | #include "xen-mapcache.h" |
20 | 432d268c | Jun Nakajima | #include "trace.h" |
21 | ce76b8a8 | Avi Kivity | #include "exec-memory.h" |
22 | 432d268c | Jun Nakajima | |
23 | 9ce94e7c | Arun Sharma | #include <xen/hvm/ioreq.h> |
24 | 9ce94e7c | Arun Sharma | #include <xen/hvm/params.h> |
25 | 8a369e20 | Anthony PERARD | #include <xen/hvm/e820.h> |
26 | 9ce94e7c | Arun Sharma | |
27 | 9ce94e7c | Arun Sharma | //#define DEBUG_XEN
|
28 | 9ce94e7c | Arun Sharma | |
29 | 9ce94e7c | Arun Sharma | #ifdef DEBUG_XEN
|
30 | 9ce94e7c | Arun Sharma | #define DPRINTF(fmt, ...) \
|
31 | 9ce94e7c | Arun Sharma | do { fprintf(stderr, "xen: " fmt, ## __VA_ARGS__); } while (0) |
32 | 9ce94e7c | Arun Sharma | #else
|
33 | 9ce94e7c | Arun Sharma | #define DPRINTF(fmt, ...) \
|
34 | 9ce94e7c | Arun Sharma | do { } while (0) |
35 | 9ce94e7c | Arun Sharma | #endif
|
36 | 9ce94e7c | Arun Sharma | |
37 | ce76b8a8 | Avi Kivity | static MemoryRegion ram_memory, ram_640k, ram_lo, ram_hi;
|
38 | c65adf9b | Avi Kivity | static MemoryRegion *framebuffer;
|
39 | ce76b8a8 | Avi Kivity | |
40 | 9ce94e7c | Arun Sharma | /* Compatibility with older version */
|
41 | 9ce94e7c | Arun Sharma | #if __XEN_LATEST_INTERFACE_VERSION__ < 0x0003020a |
42 | 9ce94e7c | Arun Sharma | static inline uint32_t xen_vcpu_eport(shared_iopage_t *shared_page, int i) |
43 | 9ce94e7c | Arun Sharma | { |
44 | 9ce94e7c | Arun Sharma | return shared_page->vcpu_iodata[i].vp_eport;
|
45 | 9ce94e7c | Arun Sharma | } |
46 | 9ce94e7c | Arun Sharma | static inline ioreq_t *xen_vcpu_ioreq(shared_iopage_t *shared_page, int vcpu) |
47 | 9ce94e7c | Arun Sharma | { |
48 | 9ce94e7c | Arun Sharma | return &shared_page->vcpu_iodata[vcpu].vp_ioreq;
|
49 | 9ce94e7c | Arun Sharma | } |
50 | 9ce94e7c | Arun Sharma | # define FMT_ioreq_size PRIx64
|
51 | 9ce94e7c | Arun Sharma | #else
|
52 | 9ce94e7c | Arun Sharma | static inline uint32_t xen_vcpu_eport(shared_iopage_t *shared_page, int i) |
53 | 9ce94e7c | Arun Sharma | { |
54 | 9ce94e7c | Arun Sharma | return shared_page->vcpu_ioreq[i].vp_eport;
|
55 | 9ce94e7c | Arun Sharma | } |
56 | 9ce94e7c | Arun Sharma | static inline ioreq_t *xen_vcpu_ioreq(shared_iopage_t *shared_page, int vcpu) |
57 | 9ce94e7c | Arun Sharma | { |
58 | 9ce94e7c | Arun Sharma | return &shared_page->vcpu_ioreq[vcpu];
|
59 | 9ce94e7c | Arun Sharma | } |
60 | 9ce94e7c | Arun Sharma | # define FMT_ioreq_size "u" |
61 | 9ce94e7c | Arun Sharma | #endif
|
62 | 9ce94e7c | Arun Sharma | |
63 | 9ce94e7c | Arun Sharma | #define BUFFER_IO_MAX_DELAY 100 |
64 | 9ce94e7c | Arun Sharma | |
65 | b4dd7802 | Anthony PERARD | typedef struct XenPhysmap { |
66 | b4dd7802 | Anthony PERARD | target_phys_addr_t start_addr; |
67 | b4dd7802 | Anthony PERARD | ram_addr_t size; |
68 | 20581d20 | Avi Kivity | MemoryRegion *mr; |
69 | b4dd7802 | Anthony PERARD | target_phys_addr_t phys_offset; |
70 | b4dd7802 | Anthony PERARD | |
71 | b4dd7802 | Anthony PERARD | QLIST_ENTRY(XenPhysmap) list; |
72 | b4dd7802 | Anthony PERARD | } XenPhysmap; |
73 | b4dd7802 | Anthony PERARD | |
74 | 9ce94e7c | Arun Sharma | typedef struct XenIOState { |
75 | 9ce94e7c | Arun Sharma | shared_iopage_t *shared_page; |
76 | 9ce94e7c | Arun Sharma | buffered_iopage_t *buffered_io_page; |
77 | 9ce94e7c | Arun Sharma | QEMUTimer *buffered_io_timer; |
78 | 9ce94e7c | Arun Sharma | /* the evtchn port for polling the notification, */
|
79 | 9ce94e7c | Arun Sharma | evtchn_port_t *ioreq_local_port; |
80 | 9ce94e7c | Arun Sharma | /* the evtchn fd for polling */
|
81 | 9ce94e7c | Arun Sharma | XenEvtchn xce_handle; |
82 | 9ce94e7c | Arun Sharma | /* which vcpu we are serving */
|
83 | 9ce94e7c | Arun Sharma | int send_vcpu;
|
84 | 9ce94e7c | Arun Sharma | |
85 | 29321335 | Anthony PERARD | struct xs_handle *xenstore;
|
86 | 20581d20 | Avi Kivity | MemoryListener memory_listener; |
87 | b4dd7802 | Anthony PERARD | QLIST_HEAD(, XenPhysmap) physmap; |
88 | 20581d20 | Avi Kivity | target_phys_addr_t free_phys_offset; |
89 | b4dd7802 | Anthony PERARD | const XenPhysmap *log_for_dirtybit;
|
90 | 29321335 | Anthony PERARD | |
91 | 9ce94e7c | Arun Sharma | Notifier exit; |
92 | da98c8eb | Gerd Hoffmann | Notifier suspend; |
93 | 9ce94e7c | Arun Sharma | } XenIOState; |
94 | 9ce94e7c | Arun Sharma | |
95 | 41445300 | Anthony PERARD | /* Xen specific function for piix pci */
|
96 | 41445300 | Anthony PERARD | |
97 | 41445300 | Anthony PERARD | int xen_pci_slot_get_pirq(PCIDevice *pci_dev, int irq_num) |
98 | 41445300 | Anthony PERARD | { |
99 | 41445300 | Anthony PERARD | return irq_num + ((pci_dev->devfn >> 3) << 2); |
100 | 41445300 | Anthony PERARD | } |
101 | 41445300 | Anthony PERARD | |
102 | 41445300 | Anthony PERARD | void xen_piix3_set_irq(void *opaque, int irq_num, int level) |
103 | 41445300 | Anthony PERARD | { |
104 | 41445300 | Anthony PERARD | xc_hvm_set_pci_intx_level(xen_xc, xen_domid, 0, 0, irq_num >> 2, |
105 | 41445300 | Anthony PERARD | irq_num & 3, level);
|
106 | 41445300 | Anthony PERARD | } |
107 | 41445300 | Anthony PERARD | |
108 | 41445300 | Anthony PERARD | void xen_piix_pci_write_config_client(uint32_t address, uint32_t val, int len) |
109 | 41445300 | Anthony PERARD | { |
110 | 41445300 | Anthony PERARD | int i;
|
111 | 41445300 | Anthony PERARD | |
112 | 41445300 | Anthony PERARD | /* Scan for updates to PCI link routes (0x60-0x63). */
|
113 | 41445300 | Anthony PERARD | for (i = 0; i < len; i++) { |
114 | 41445300 | Anthony PERARD | uint8_t v = (val >> (8 * i)) & 0xff; |
115 | 41445300 | Anthony PERARD | if (v & 0x80) { |
116 | 41445300 | Anthony PERARD | v = 0;
|
117 | 41445300 | Anthony PERARD | } |
118 | 41445300 | Anthony PERARD | v &= 0xf;
|
119 | 41445300 | Anthony PERARD | if (((address + i) >= 0x60) && ((address + i) <= 0x63)) { |
120 | 41445300 | Anthony PERARD | xc_hvm_set_pci_link_route(xen_xc, xen_domid, address + i - 0x60, v);
|
121 | 41445300 | Anthony PERARD | } |
122 | 41445300 | Anthony PERARD | } |
123 | 41445300 | Anthony PERARD | } |
124 | 41445300 | Anthony PERARD | |
125 | da98c8eb | Gerd Hoffmann | static void xen_suspend_notifier(Notifier *notifier, void *data) |
126 | c9622478 | Anthony PERARD | { |
127 | da98c8eb | Gerd Hoffmann | xc_set_hvm_param(xen_xc, xen_domid, HVM_PARAM_ACPI_S_STATE, 3);
|
128 | c9622478 | Anthony PERARD | } |
129 | c9622478 | Anthony PERARD | |
130 | 9c11a8ac | Anthony PERARD | /* Xen Interrupt Controller */
|
131 | 9c11a8ac | Anthony PERARD | |
132 | 9c11a8ac | Anthony PERARD | static void xen_set_irq(void *opaque, int irq, int level) |
133 | 9c11a8ac | Anthony PERARD | { |
134 | 9c11a8ac | Anthony PERARD | xc_hvm_set_isa_irq_level(xen_xc, xen_domid, irq, level); |
135 | 9c11a8ac | Anthony PERARD | } |
136 | 9c11a8ac | Anthony PERARD | |
137 | 9c11a8ac | Anthony PERARD | qemu_irq *xen_interrupt_controller_init(void)
|
138 | 9c11a8ac | Anthony PERARD | { |
139 | 9c11a8ac | Anthony PERARD | return qemu_allocate_irqs(xen_set_irq, NULL, 16); |
140 | 9c11a8ac | Anthony PERARD | } |
141 | 9c11a8ac | Anthony PERARD | |
142 | 432d268c | Jun Nakajima | /* Memory Ops */
|
143 | 432d268c | Jun Nakajima | |
144 | 432d268c | Jun Nakajima | static void xen_ram_init(ram_addr_t ram_size) |
145 | 432d268c | Jun Nakajima | { |
146 | ce76b8a8 | Avi Kivity | MemoryRegion *sysmem = get_system_memory(); |
147 | 432d268c | Jun Nakajima | ram_addr_t below_4g_mem_size, above_4g_mem_size = 0;
|
148 | ce76b8a8 | Avi Kivity | ram_addr_t block_len; |
149 | 432d268c | Jun Nakajima | |
150 | ce76b8a8 | Avi Kivity | block_len = ram_size; |
151 | 8a369e20 | Anthony PERARD | if (ram_size >= HVM_BELOW_4G_RAM_END) {
|
152 | 8a369e20 | Anthony PERARD | /* Xen does not allocate the memory continuously, and keep a hole at
|
153 | 8a369e20 | Anthony PERARD | * HVM_BELOW_4G_MMIO_START of HVM_BELOW_4G_MMIO_LENGTH
|
154 | 8a369e20 | Anthony PERARD | */
|
155 | ce76b8a8 | Avi Kivity | block_len += HVM_BELOW_4G_MMIO_LENGTH; |
156 | 8a369e20 | Anthony PERARD | } |
157 | c5705a77 | Avi Kivity | memory_region_init_ram(&ram_memory, "xen.ram", block_len);
|
158 | c5705a77 | Avi Kivity | vmstate_register_ram_global(&ram_memory); |
159 | 432d268c | Jun Nakajima | |
160 | 8a369e20 | Anthony PERARD | if (ram_size >= HVM_BELOW_4G_RAM_END) {
|
161 | 8a369e20 | Anthony PERARD | above_4g_mem_size = ram_size - HVM_BELOW_4G_RAM_END; |
162 | 8a369e20 | Anthony PERARD | below_4g_mem_size = HVM_BELOW_4G_RAM_END; |
163 | 432d268c | Jun Nakajima | } else {
|
164 | 432d268c | Jun Nakajima | below_4g_mem_size = ram_size; |
165 | 432d268c | Jun Nakajima | } |
166 | 432d268c | Jun Nakajima | |
167 | ce76b8a8 | Avi Kivity | memory_region_init_alias(&ram_640k, "xen.ram.640k",
|
168 | ce76b8a8 | Avi Kivity | &ram_memory, 0, 0xa0000); |
169 | ce76b8a8 | Avi Kivity | memory_region_add_subregion(sysmem, 0, &ram_640k);
|
170 | 8a369e20 | Anthony PERARD | /* Skip of the VGA IO memory space, it will be registered later by the VGA
|
171 | 8a369e20 | Anthony PERARD | * emulated device.
|
172 | 8a369e20 | Anthony PERARD | *
|
173 | 8a369e20 | Anthony PERARD | * The area between 0xc0000 and 0x100000 will be used by SeaBIOS to load
|
174 | 8a369e20 | Anthony PERARD | * the Options ROM, so it is registered here as RAM.
|
175 | 8a369e20 | Anthony PERARD | */
|
176 | ce76b8a8 | Avi Kivity | memory_region_init_alias(&ram_lo, "xen.ram.lo",
|
177 | ce76b8a8 | Avi Kivity | &ram_memory, 0xc0000, below_4g_mem_size - 0xc0000); |
178 | ce76b8a8 | Avi Kivity | memory_region_add_subregion(sysmem, 0xc0000, &ram_lo);
|
179 | 432d268c | Jun Nakajima | if (above_4g_mem_size > 0) { |
180 | ce76b8a8 | Avi Kivity | memory_region_init_alias(&ram_hi, "xen.ram.hi",
|
181 | ce76b8a8 | Avi Kivity | &ram_memory, 0x100000000ULL,
|
182 | ce76b8a8 | Avi Kivity | above_4g_mem_size); |
183 | ce76b8a8 | Avi Kivity | memory_region_add_subregion(sysmem, 0x100000000ULL, &ram_hi);
|
184 | 432d268c | Jun Nakajima | } |
185 | 432d268c | Jun Nakajima | } |
186 | 432d268c | Jun Nakajima | |
187 | fce537d4 | Avi Kivity | void xen_ram_alloc(ram_addr_t ram_addr, ram_addr_t size, MemoryRegion *mr)
|
188 | 432d268c | Jun Nakajima | { |
189 | 432d268c | Jun Nakajima | unsigned long nr_pfn; |
190 | 432d268c | Jun Nakajima | xen_pfn_t *pfn_list; |
191 | 432d268c | Jun Nakajima | int i;
|
192 | 432d268c | Jun Nakajima | |
193 | ce76b8a8 | Avi Kivity | if (mr == &ram_memory) {
|
194 | ce76b8a8 | Avi Kivity | return;
|
195 | ce76b8a8 | Avi Kivity | } |
196 | ce76b8a8 | Avi Kivity | |
197 | 432d268c | Jun Nakajima | trace_xen_ram_alloc(ram_addr, size); |
198 | 432d268c | Jun Nakajima | |
199 | 432d268c | Jun Nakajima | nr_pfn = size >> TARGET_PAGE_BITS; |
200 | 7267c094 | Anthony Liguori | pfn_list = g_malloc(sizeof (*pfn_list) * nr_pfn);
|
201 | 432d268c | Jun Nakajima | |
202 | 432d268c | Jun Nakajima | for (i = 0; i < nr_pfn; i++) { |
203 | 432d268c | Jun Nakajima | pfn_list[i] = (ram_addr >> TARGET_PAGE_BITS) + i; |
204 | 432d268c | Jun Nakajima | } |
205 | 432d268c | Jun Nakajima | |
206 | 432d268c | Jun Nakajima | if (xc_domain_populate_physmap_exact(xen_xc, xen_domid, nr_pfn, 0, 0, pfn_list)) { |
207 | f15fbc4b | Anthony PERARD | hw_error("xen: failed to populate ram at " RAM_ADDR_FMT, ram_addr);
|
208 | 432d268c | Jun Nakajima | } |
209 | 432d268c | Jun Nakajima | |
210 | 7267c094 | Anthony Liguori | g_free(pfn_list); |
211 | 432d268c | Jun Nakajima | } |
212 | 432d268c | Jun Nakajima | |
213 | b4dd7802 | Anthony PERARD | static XenPhysmap *get_physmapping(XenIOState *state,
|
214 | b4dd7802 | Anthony PERARD | target_phys_addr_t start_addr, ram_addr_t size) |
215 | b4dd7802 | Anthony PERARD | { |
216 | b4dd7802 | Anthony PERARD | XenPhysmap *physmap = NULL;
|
217 | b4dd7802 | Anthony PERARD | |
218 | b4dd7802 | Anthony PERARD | start_addr &= TARGET_PAGE_MASK; |
219 | b4dd7802 | Anthony PERARD | |
220 | b4dd7802 | Anthony PERARD | QLIST_FOREACH(physmap, &state->physmap, list) { |
221 | b4dd7802 | Anthony PERARD | if (range_covers_byte(physmap->start_addr, physmap->size, start_addr)) {
|
222 | b4dd7802 | Anthony PERARD | return physmap;
|
223 | b4dd7802 | Anthony PERARD | } |
224 | b4dd7802 | Anthony PERARD | } |
225 | b4dd7802 | Anthony PERARD | return NULL; |
226 | b4dd7802 | Anthony PERARD | } |
227 | b4dd7802 | Anthony PERARD | |
228 | b4dd7802 | Anthony PERARD | #if CONFIG_XEN_CTRL_INTERFACE_VERSION >= 340 |
229 | b4dd7802 | Anthony PERARD | static int xen_add_to_physmap(XenIOState *state, |
230 | b4dd7802 | Anthony PERARD | target_phys_addr_t start_addr, |
231 | b4dd7802 | Anthony PERARD | ram_addr_t size, |
232 | 20581d20 | Avi Kivity | MemoryRegion *mr, |
233 | 20581d20 | Avi Kivity | target_phys_addr_t offset_within_region) |
234 | b4dd7802 | Anthony PERARD | { |
235 | b4dd7802 | Anthony PERARD | unsigned long i = 0; |
236 | b4dd7802 | Anthony PERARD | int rc = 0; |
237 | b4dd7802 | Anthony PERARD | XenPhysmap *physmap = NULL;
|
238 | b4dd7802 | Anthony PERARD | target_phys_addr_t pfn, start_gpfn; |
239 | 20581d20 | Avi Kivity | target_phys_addr_t phys_offset = memory_region_get_ram_addr(mr); |
240 | b4dd7802 | Anthony PERARD | |
241 | b4dd7802 | Anthony PERARD | if (get_physmapping(state, start_addr, size)) {
|
242 | b4dd7802 | Anthony PERARD | return 0; |
243 | b4dd7802 | Anthony PERARD | } |
244 | b4dd7802 | Anthony PERARD | if (size <= 0) { |
245 | b4dd7802 | Anthony PERARD | return -1; |
246 | b4dd7802 | Anthony PERARD | } |
247 | b4dd7802 | Anthony PERARD | |
248 | ebed8505 | Stefano Stabellini | /* Xen can only handle a single dirty log region for now and we want
|
249 | ebed8505 | Stefano Stabellini | * the linear framebuffer to be that region.
|
250 | ebed8505 | Stefano Stabellini | * Avoid tracking any regions that is not videoram and avoid tracking
|
251 | ebed8505 | Stefano Stabellini | * the legacy vga region. */
|
252 | 20581d20 | Avi Kivity | if (mr == framebuffer && start_addr > 0xbffff) { |
253 | 20581d20 | Avi Kivity | goto go_physmap;
|
254 | ebed8505 | Stefano Stabellini | } |
255 | ebed8505 | Stefano Stabellini | return -1; |
256 | ebed8505 | Stefano Stabellini | |
257 | ebed8505 | Stefano Stabellini | go_physmap:
|
258 | 20581d20 | Avi Kivity | DPRINTF("mapping vram to %llx - %llx\n", start_addr, start_addr + size);
|
259 | b4dd7802 | Anthony PERARD | |
260 | b4dd7802 | Anthony PERARD | pfn = phys_offset >> TARGET_PAGE_BITS; |
261 | b4dd7802 | Anthony PERARD | start_gpfn = start_addr >> TARGET_PAGE_BITS; |
262 | b4dd7802 | Anthony PERARD | for (i = 0; i < size >> TARGET_PAGE_BITS; i++) { |
263 | b4dd7802 | Anthony PERARD | unsigned long idx = pfn + i; |
264 | b4dd7802 | Anthony PERARD | xen_pfn_t gpfn = start_gpfn + i; |
265 | b4dd7802 | Anthony PERARD | |
266 | b4dd7802 | Anthony PERARD | rc = xc_domain_add_to_physmap(xen_xc, xen_domid, XENMAPSPACE_gmfn, idx, gpfn); |
267 | b4dd7802 | Anthony PERARD | if (rc) {
|
268 | b4dd7802 | Anthony PERARD | DPRINTF("add_to_physmap MFN %"PRI_xen_pfn" to PFN %" |
269 | b4dd7802 | Anthony PERARD | PRI_xen_pfn" failed: %d\n", idx, gpfn, rc);
|
270 | b4dd7802 | Anthony PERARD | return -rc;
|
271 | b4dd7802 | Anthony PERARD | } |
272 | b4dd7802 | Anthony PERARD | } |
273 | b4dd7802 | Anthony PERARD | |
274 | 7267c094 | Anthony Liguori | physmap = g_malloc(sizeof (XenPhysmap));
|
275 | b4dd7802 | Anthony PERARD | |
276 | b4dd7802 | Anthony PERARD | physmap->start_addr = start_addr; |
277 | b4dd7802 | Anthony PERARD | physmap->size = size; |
278 | b4dd7802 | Anthony PERARD | physmap->phys_offset = phys_offset; |
279 | b4dd7802 | Anthony PERARD | |
280 | b4dd7802 | Anthony PERARD | QLIST_INSERT_HEAD(&state->physmap, physmap, list); |
281 | b4dd7802 | Anthony PERARD | |
282 | b4dd7802 | Anthony PERARD | xc_domain_pin_memory_cacheattr(xen_xc, xen_domid, |
283 | b4dd7802 | Anthony PERARD | start_addr >> TARGET_PAGE_BITS, |
284 | b4dd7802 | Anthony PERARD | (start_addr + size) >> TARGET_PAGE_BITS, |
285 | b4dd7802 | Anthony PERARD | XEN_DOMCTL_MEM_CACHEATTR_WB); |
286 | b4dd7802 | Anthony PERARD | return 0; |
287 | b4dd7802 | Anthony PERARD | } |
288 | b4dd7802 | Anthony PERARD | |
289 | b4dd7802 | Anthony PERARD | static int xen_remove_from_physmap(XenIOState *state, |
290 | b4dd7802 | Anthony PERARD | target_phys_addr_t start_addr, |
291 | b4dd7802 | Anthony PERARD | ram_addr_t size) |
292 | b4dd7802 | Anthony PERARD | { |
293 | b4dd7802 | Anthony PERARD | unsigned long i = 0; |
294 | b4dd7802 | Anthony PERARD | int rc = 0; |
295 | b4dd7802 | Anthony PERARD | XenPhysmap *physmap = NULL;
|
296 | b4dd7802 | Anthony PERARD | target_phys_addr_t phys_offset = 0;
|
297 | b4dd7802 | Anthony PERARD | |
298 | b4dd7802 | Anthony PERARD | physmap = get_physmapping(state, start_addr, size); |
299 | b4dd7802 | Anthony PERARD | if (physmap == NULL) { |
300 | b4dd7802 | Anthony PERARD | return -1; |
301 | b4dd7802 | Anthony PERARD | } |
302 | b4dd7802 | Anthony PERARD | |
303 | b4dd7802 | Anthony PERARD | phys_offset = physmap->phys_offset; |
304 | b4dd7802 | Anthony PERARD | size = physmap->size; |
305 | b4dd7802 | Anthony PERARD | |
306 | b4dd7802 | Anthony PERARD | DPRINTF("unmapping vram to %llx - %llx, from %llx\n",
|
307 | b4dd7802 | Anthony PERARD | phys_offset, phys_offset + size, start_addr); |
308 | b4dd7802 | Anthony PERARD | |
309 | b4dd7802 | Anthony PERARD | size >>= TARGET_PAGE_BITS; |
310 | b4dd7802 | Anthony PERARD | start_addr >>= TARGET_PAGE_BITS; |
311 | b4dd7802 | Anthony PERARD | phys_offset >>= TARGET_PAGE_BITS; |
312 | b4dd7802 | Anthony PERARD | for (i = 0; i < size; i++) { |
313 | b4dd7802 | Anthony PERARD | unsigned long idx = start_addr + i; |
314 | b4dd7802 | Anthony PERARD | xen_pfn_t gpfn = phys_offset + i; |
315 | b4dd7802 | Anthony PERARD | |
316 | b4dd7802 | Anthony PERARD | rc = xc_domain_add_to_physmap(xen_xc, xen_domid, XENMAPSPACE_gmfn, idx, gpfn); |
317 | b4dd7802 | Anthony PERARD | if (rc) {
|
318 | b4dd7802 | Anthony PERARD | fprintf(stderr, "add_to_physmap MFN %"PRI_xen_pfn" to PFN %" |
319 | b4dd7802 | Anthony PERARD | PRI_xen_pfn" failed: %d\n", idx, gpfn, rc);
|
320 | b4dd7802 | Anthony PERARD | return -rc;
|
321 | b4dd7802 | Anthony PERARD | } |
322 | b4dd7802 | Anthony PERARD | } |
323 | b4dd7802 | Anthony PERARD | |
324 | b4dd7802 | Anthony PERARD | QLIST_REMOVE(physmap, list); |
325 | b4dd7802 | Anthony PERARD | if (state->log_for_dirtybit == physmap) {
|
326 | b4dd7802 | Anthony PERARD | state->log_for_dirtybit = NULL;
|
327 | b4dd7802 | Anthony PERARD | } |
328 | b4dd7802 | Anthony PERARD | free(physmap); |
329 | b4dd7802 | Anthony PERARD | |
330 | b4dd7802 | Anthony PERARD | return 0; |
331 | b4dd7802 | Anthony PERARD | } |
332 | b4dd7802 | Anthony PERARD | |
333 | b4dd7802 | Anthony PERARD | #else
|
334 | b4dd7802 | Anthony PERARD | static int xen_add_to_physmap(XenIOState *state, |
335 | b4dd7802 | Anthony PERARD | target_phys_addr_t start_addr, |
336 | b4dd7802 | Anthony PERARD | ram_addr_t size, |
337 | 20581d20 | Avi Kivity | MemoryRegion *mr, |
338 | 20581d20 | Avi Kivity | target_phys_addr_t offset_within_region) |
339 | b4dd7802 | Anthony PERARD | { |
340 | b4dd7802 | Anthony PERARD | return -ENOSYS;
|
341 | b4dd7802 | Anthony PERARD | } |
342 | b4dd7802 | Anthony PERARD | |
343 | b4dd7802 | Anthony PERARD | static int xen_remove_from_physmap(XenIOState *state, |
344 | b4dd7802 | Anthony PERARD | target_phys_addr_t start_addr, |
345 | b4dd7802 | Anthony PERARD | ram_addr_t size) |
346 | b4dd7802 | Anthony PERARD | { |
347 | b4dd7802 | Anthony PERARD | return -ENOSYS;
|
348 | b4dd7802 | Anthony PERARD | } |
349 | b4dd7802 | Anthony PERARD | #endif
|
350 | b4dd7802 | Anthony PERARD | |
351 | 20581d20 | Avi Kivity | static void xen_set_memory(struct MemoryListener *listener, |
352 | 20581d20 | Avi Kivity | MemoryRegionSection *section, |
353 | 20581d20 | Avi Kivity | bool add)
|
354 | b4dd7802 | Anthony PERARD | { |
355 | 20581d20 | Avi Kivity | XenIOState *state = container_of(listener, XenIOState, memory_listener); |
356 | 20581d20 | Avi Kivity | target_phys_addr_t start_addr = section->offset_within_address_space; |
357 | 20581d20 | Avi Kivity | ram_addr_t size = section->size; |
358 | 20581d20 | Avi Kivity | bool log_dirty = memory_region_is_logging(section->mr);
|
359 | b4dd7802 | Anthony PERARD | hvmmem_type_t mem_type; |
360 | b4dd7802 | Anthony PERARD | |
361 | 20581d20 | Avi Kivity | if (!memory_region_is_ram(section->mr)) {
|
362 | b4dd7802 | Anthony PERARD | return;
|
363 | b4dd7802 | Anthony PERARD | } |
364 | b4dd7802 | Anthony PERARD | |
365 | 20581d20 | Avi Kivity | if (!(section->mr != &ram_memory
|
366 | 20581d20 | Avi Kivity | && ( (log_dirty && add) || (!log_dirty && !add)))) { |
367 | 20581d20 | Avi Kivity | return;
|
368 | 20581d20 | Avi Kivity | } |
369 | 20581d20 | Avi Kivity | |
370 | 20581d20 | Avi Kivity | trace_xen_client_set_memory(start_addr, size, log_dirty); |
371 | b4dd7802 | Anthony PERARD | |
372 | b4dd7802 | Anthony PERARD | start_addr &= TARGET_PAGE_MASK; |
373 | b4dd7802 | Anthony PERARD | size = TARGET_PAGE_ALIGN(size); |
374 | 20581d20 | Avi Kivity | |
375 | 20581d20 | Avi Kivity | if (add) {
|
376 | 20581d20 | Avi Kivity | if (!memory_region_is_rom(section->mr)) {
|
377 | 20581d20 | Avi Kivity | xen_add_to_physmap(state, start_addr, size, |
378 | 20581d20 | Avi Kivity | section->mr, section->offset_within_region); |
379 | 20581d20 | Avi Kivity | } else {
|
380 | 20581d20 | Avi Kivity | mem_type = HVMMEM_ram_ro; |
381 | 20581d20 | Avi Kivity | if (xc_hvm_set_mem_type(xen_xc, xen_domid, mem_type,
|
382 | 20581d20 | Avi Kivity | start_addr >> TARGET_PAGE_BITS, |
383 | 20581d20 | Avi Kivity | size >> TARGET_PAGE_BITS)) { |
384 | 20581d20 | Avi Kivity | DPRINTF("xc_hvm_set_mem_type error, addr: "TARGET_FMT_plx"\n", |
385 | 20581d20 | Avi Kivity | start_addr); |
386 | 20581d20 | Avi Kivity | } |
387 | b4dd7802 | Anthony PERARD | } |
388 | 20581d20 | Avi Kivity | } else {
|
389 | b4dd7802 | Anthony PERARD | if (xen_remove_from_physmap(state, start_addr, size) < 0) { |
390 | b4dd7802 | Anthony PERARD | DPRINTF("physmapping does not exist at "TARGET_FMT_plx"\n", start_addr); |
391 | b4dd7802 | Anthony PERARD | } |
392 | b4dd7802 | Anthony PERARD | } |
393 | b4dd7802 | Anthony PERARD | } |
394 | b4dd7802 | Anthony PERARD | |
395 | 50c1e149 | Avi Kivity | static void xen_begin(MemoryListener *listener) |
396 | 50c1e149 | Avi Kivity | { |
397 | 50c1e149 | Avi Kivity | } |
398 | 50c1e149 | Avi Kivity | |
399 | 50c1e149 | Avi Kivity | static void xen_commit(MemoryListener *listener) |
400 | 50c1e149 | Avi Kivity | { |
401 | 50c1e149 | Avi Kivity | } |
402 | 50c1e149 | Avi Kivity | |
403 | 20581d20 | Avi Kivity | static void xen_region_add(MemoryListener *listener, |
404 | 20581d20 | Avi Kivity | MemoryRegionSection *section) |
405 | 20581d20 | Avi Kivity | { |
406 | 20581d20 | Avi Kivity | xen_set_memory(listener, section, true);
|
407 | 20581d20 | Avi Kivity | } |
408 | 20581d20 | Avi Kivity | |
409 | 20581d20 | Avi Kivity | static void xen_region_del(MemoryListener *listener, |
410 | 20581d20 | Avi Kivity | MemoryRegionSection *section) |
411 | 20581d20 | Avi Kivity | { |
412 | 20581d20 | Avi Kivity | xen_set_memory(listener, section, false);
|
413 | 20581d20 | Avi Kivity | } |
414 | 20581d20 | Avi Kivity | |
415 | 50c1e149 | Avi Kivity | static void xen_region_nop(MemoryListener *listener, |
416 | 50c1e149 | Avi Kivity | MemoryRegionSection *section) |
417 | 50c1e149 | Avi Kivity | { |
418 | 50c1e149 | Avi Kivity | } |
419 | 50c1e149 | Avi Kivity | |
420 | b18620cf | Anthony PERARD | static void xen_sync_dirty_bitmap(XenIOState *state, |
421 | b18620cf | Anthony PERARD | target_phys_addr_t start_addr, |
422 | b18620cf | Anthony PERARD | ram_addr_t size) |
423 | b4dd7802 | Anthony PERARD | { |
424 | b4dd7802 | Anthony PERARD | target_phys_addr_t npages = size >> TARGET_PAGE_BITS; |
425 | b4dd7802 | Anthony PERARD | const int width = sizeof(unsigned long) * 8; |
426 | b4dd7802 | Anthony PERARD | unsigned long bitmap[(npages + width - 1) / width]; |
427 | b4dd7802 | Anthony PERARD | int rc, i, j;
|
428 | b4dd7802 | Anthony PERARD | const XenPhysmap *physmap = NULL; |
429 | b4dd7802 | Anthony PERARD | |
430 | b4dd7802 | Anthony PERARD | physmap = get_physmapping(state, start_addr, size); |
431 | b4dd7802 | Anthony PERARD | if (physmap == NULL) { |
432 | b4dd7802 | Anthony PERARD | /* not handled */
|
433 | b18620cf | Anthony PERARD | return;
|
434 | b4dd7802 | Anthony PERARD | } |
435 | b4dd7802 | Anthony PERARD | |
436 | b4dd7802 | Anthony PERARD | if (state->log_for_dirtybit == NULL) { |
437 | b4dd7802 | Anthony PERARD | state->log_for_dirtybit = physmap; |
438 | b4dd7802 | Anthony PERARD | } else if (state->log_for_dirtybit != physmap) { |
439 | b18620cf | Anthony PERARD | /* Only one range for dirty bitmap can be tracked. */
|
440 | b18620cf | Anthony PERARD | return;
|
441 | b4dd7802 | Anthony PERARD | } |
442 | b4dd7802 | Anthony PERARD | |
443 | b4dd7802 | Anthony PERARD | rc = xc_hvm_track_dirty_vram(xen_xc, xen_domid, |
444 | b4dd7802 | Anthony PERARD | start_addr >> TARGET_PAGE_BITS, npages, |
445 | b4dd7802 | Anthony PERARD | bitmap); |
446 | b18620cf | Anthony PERARD | if (rc < 0) { |
447 | b18620cf | Anthony PERARD | if (rc != -ENODATA) {
|
448 | b18620cf | Anthony PERARD | fprintf(stderr, "xen: track_dirty_vram failed (0x" TARGET_FMT_plx
|
449 | b18620cf | Anthony PERARD | ", 0x" TARGET_FMT_plx "): %s\n", |
450 | b18620cf | Anthony PERARD | start_addr, start_addr + size, strerror(-rc)); |
451 | b18620cf | Anthony PERARD | } |
452 | b18620cf | Anthony PERARD | return;
|
453 | b4dd7802 | Anthony PERARD | } |
454 | b4dd7802 | Anthony PERARD | |
455 | b4dd7802 | Anthony PERARD | for (i = 0; i < ARRAY_SIZE(bitmap); i++) { |
456 | b4dd7802 | Anthony PERARD | unsigned long map = bitmap[i]; |
457 | b4dd7802 | Anthony PERARD | while (map != 0) { |
458 | b4dd7802 | Anthony PERARD | j = ffsl(map) - 1;
|
459 | b4dd7802 | Anthony PERARD | map &= ~(1ul << j);
|
460 | 5a97065b | Avi Kivity | memory_region_set_dirty(framebuffer, |
461 | fd4aa979 | Blue Swirl | (i * width + j) * TARGET_PAGE_SIZE, |
462 | fd4aa979 | Blue Swirl | TARGET_PAGE_SIZE); |
463 | b4dd7802 | Anthony PERARD | }; |
464 | b4dd7802 | Anthony PERARD | } |
465 | b4dd7802 | Anthony PERARD | } |
466 | b4dd7802 | Anthony PERARD | |
467 | 20581d20 | Avi Kivity | static void xen_log_start(MemoryListener *listener, |
468 | 20581d20 | Avi Kivity | MemoryRegionSection *section) |
469 | b4dd7802 | Anthony PERARD | { |
470 | 20581d20 | Avi Kivity | XenIOState *state = container_of(listener, XenIOState, memory_listener); |
471 | b4dd7802 | Anthony PERARD | |
472 | b18620cf | Anthony PERARD | xen_sync_dirty_bitmap(state, section->offset_within_address_space, |
473 | b18620cf | Anthony PERARD | section->size); |
474 | b4dd7802 | Anthony PERARD | } |
475 | b4dd7802 | Anthony PERARD | |
476 | 20581d20 | Avi Kivity | static void xen_log_stop(MemoryListener *listener, MemoryRegionSection *section) |
477 | b4dd7802 | Anthony PERARD | { |
478 | 20581d20 | Avi Kivity | XenIOState *state = container_of(listener, XenIOState, memory_listener); |
479 | b4dd7802 | Anthony PERARD | |
480 | b4dd7802 | Anthony PERARD | state->log_for_dirtybit = NULL;
|
481 | b4dd7802 | Anthony PERARD | /* Disable dirty bit tracking */
|
482 | b18620cf | Anthony PERARD | xc_hvm_track_dirty_vram(xen_xc, xen_domid, 0, 0, NULL); |
483 | b4dd7802 | Anthony PERARD | } |
484 | b4dd7802 | Anthony PERARD | |
485 | 20581d20 | Avi Kivity | static void xen_log_sync(MemoryListener *listener, MemoryRegionSection *section) |
486 | b4dd7802 | Anthony PERARD | { |
487 | 20581d20 | Avi Kivity | XenIOState *state = container_of(listener, XenIOState, memory_listener); |
488 | b4dd7802 | Anthony PERARD | |
489 | b18620cf | Anthony PERARD | xen_sync_dirty_bitmap(state, section->offset_within_address_space, |
490 | b18620cf | Anthony PERARD | section->size); |
491 | b4dd7802 | Anthony PERARD | } |
492 | b4dd7802 | Anthony PERARD | |
493 | 20581d20 | Avi Kivity | static void xen_log_global_start(MemoryListener *listener) |
494 | 20581d20 | Avi Kivity | { |
495 | 20581d20 | Avi Kivity | } |
496 | 20581d20 | Avi Kivity | |
497 | 20581d20 | Avi Kivity | static void xen_log_global_stop(MemoryListener *listener) |
498 | b4dd7802 | Anthony PERARD | { |
499 | b4dd7802 | Anthony PERARD | } |
500 | b4dd7802 | Anthony PERARD | |
501 | 80a1ea37 | Avi Kivity | static void xen_eventfd_add(MemoryListener *listener, |
502 | 80a1ea37 | Avi Kivity | MemoryRegionSection *section, |
503 | 80a1ea37 | Avi Kivity | bool match_data, uint64_t data, int fd) |
504 | 80a1ea37 | Avi Kivity | { |
505 | 80a1ea37 | Avi Kivity | } |
506 | 80a1ea37 | Avi Kivity | |
507 | 80a1ea37 | Avi Kivity | static void xen_eventfd_del(MemoryListener *listener, |
508 | 80a1ea37 | Avi Kivity | MemoryRegionSection *section, |
509 | 80a1ea37 | Avi Kivity | bool match_data, uint64_t data, int fd) |
510 | 80a1ea37 | Avi Kivity | { |
511 | 80a1ea37 | Avi Kivity | } |
512 | 80a1ea37 | Avi Kivity | |
513 | 20581d20 | Avi Kivity | static MemoryListener xen_memory_listener = {
|
514 | 50c1e149 | Avi Kivity | .begin = xen_begin, |
515 | 50c1e149 | Avi Kivity | .commit = xen_commit, |
516 | 20581d20 | Avi Kivity | .region_add = xen_region_add, |
517 | 20581d20 | Avi Kivity | .region_del = xen_region_del, |
518 | 50c1e149 | Avi Kivity | .region_nop = xen_region_nop, |
519 | b4dd7802 | Anthony PERARD | .log_start = xen_log_start, |
520 | b4dd7802 | Anthony PERARD | .log_stop = xen_log_stop, |
521 | 20581d20 | Avi Kivity | .log_sync = xen_log_sync, |
522 | 20581d20 | Avi Kivity | .log_global_start = xen_log_global_start, |
523 | 20581d20 | Avi Kivity | .log_global_stop = xen_log_global_stop, |
524 | 80a1ea37 | Avi Kivity | .eventfd_add = xen_eventfd_add, |
525 | 80a1ea37 | Avi Kivity | .eventfd_del = xen_eventfd_del, |
526 | 72e22d2f | Avi Kivity | .priority = 10,
|
527 | b4dd7802 | Anthony PERARD | }; |
528 | 432d268c | Jun Nakajima | |
529 | 29d3ccde | Anthony PERARD | /* VCPU Operations, MMIO, IO ring ... */
|
530 | 29d3ccde | Anthony PERARD | |
531 | 29d3ccde | Anthony PERARD | static void xen_reset_vcpu(void *opaque) |
532 | 29d3ccde | Anthony PERARD | { |
533 | 29d3ccde | Anthony PERARD | CPUState *env = opaque; |
534 | 29d3ccde | Anthony PERARD | |
535 | 29d3ccde | Anthony PERARD | env->halted = 1;
|
536 | 29d3ccde | Anthony PERARD | } |
537 | 29d3ccde | Anthony PERARD | |
538 | 29d3ccde | Anthony PERARD | void xen_vcpu_init(void) |
539 | 29d3ccde | Anthony PERARD | { |
540 | 29d3ccde | Anthony PERARD | CPUState *first_cpu; |
541 | 29d3ccde | Anthony PERARD | |
542 | 29d3ccde | Anthony PERARD | if ((first_cpu = qemu_get_cpu(0))) { |
543 | 29d3ccde | Anthony PERARD | qemu_register_reset(xen_reset_vcpu, first_cpu); |
544 | 29d3ccde | Anthony PERARD | xen_reset_vcpu(first_cpu); |
545 | 29d3ccde | Anthony PERARD | } |
546 | 29d3ccde | Anthony PERARD | } |
547 | 29d3ccde | Anthony PERARD | |
548 | 9ce94e7c | Arun Sharma | /* get the ioreq packets from share mem */
|
549 | 9ce94e7c | Arun Sharma | static ioreq_t *cpu_get_ioreq_from_shared_memory(XenIOState *state, int vcpu) |
550 | 9ce94e7c | Arun Sharma | { |
551 | 9ce94e7c | Arun Sharma | ioreq_t *req = xen_vcpu_ioreq(state->shared_page, vcpu); |
552 | 9ce94e7c | Arun Sharma | |
553 | 9ce94e7c | Arun Sharma | if (req->state != STATE_IOREQ_READY) {
|
554 | 9ce94e7c | Arun Sharma | DPRINTF("I/O request not ready: "
|
555 | 9ce94e7c | Arun Sharma | "%x, ptr: %x, port: %"PRIx64", " |
556 | 9ce94e7c | Arun Sharma | "data: %"PRIx64", count: %" FMT_ioreq_size ", size: %" FMT_ioreq_size "\n", |
557 | 9ce94e7c | Arun Sharma | req->state, req->data_is_ptr, req->addr, |
558 | 9ce94e7c | Arun Sharma | req->data, req->count, req->size); |
559 | 9ce94e7c | Arun Sharma | return NULL; |
560 | 9ce94e7c | Arun Sharma | } |
561 | 9ce94e7c | Arun Sharma | |
562 | 9ce94e7c | Arun Sharma | xen_rmb(); /* see IOREQ_READY /then/ read contents of ioreq */
|
563 | 9ce94e7c | Arun Sharma | |
564 | 9ce94e7c | Arun Sharma | req->state = STATE_IOREQ_INPROCESS; |
565 | 9ce94e7c | Arun Sharma | return req;
|
566 | 9ce94e7c | Arun Sharma | } |
567 | 9ce94e7c | Arun Sharma | |
568 | 9ce94e7c | Arun Sharma | /* use poll to get the port notification */
|
569 | 9ce94e7c | Arun Sharma | /* ioreq_vec--out,the */
|
570 | 9ce94e7c | Arun Sharma | /* retval--the number of ioreq packet */
|
571 | 9ce94e7c | Arun Sharma | static ioreq_t *cpu_get_ioreq(XenIOState *state)
|
572 | 9ce94e7c | Arun Sharma | { |
573 | 9ce94e7c | Arun Sharma | int i;
|
574 | 9ce94e7c | Arun Sharma | evtchn_port_t port; |
575 | 9ce94e7c | Arun Sharma | |
576 | 9ce94e7c | Arun Sharma | port = xc_evtchn_pending(state->xce_handle); |
577 | 9ce94e7c | Arun Sharma | if (port != -1) { |
578 | 9ce94e7c | Arun Sharma | for (i = 0; i < smp_cpus; i++) { |
579 | 9ce94e7c | Arun Sharma | if (state->ioreq_local_port[i] == port) {
|
580 | 9ce94e7c | Arun Sharma | break;
|
581 | 9ce94e7c | Arun Sharma | } |
582 | 9ce94e7c | Arun Sharma | } |
583 | 9ce94e7c | Arun Sharma | |
584 | 9ce94e7c | Arun Sharma | if (i == smp_cpus) {
|
585 | 9ce94e7c | Arun Sharma | hw_error("Fatal error while trying to get io event!\n");
|
586 | 9ce94e7c | Arun Sharma | } |
587 | 9ce94e7c | Arun Sharma | |
588 | 9ce94e7c | Arun Sharma | /* unmask the wanted port again */
|
589 | 9ce94e7c | Arun Sharma | xc_evtchn_unmask(state->xce_handle, port); |
590 | 9ce94e7c | Arun Sharma | |
591 | 9ce94e7c | Arun Sharma | /* get the io packet from shared memory */
|
592 | 9ce94e7c | Arun Sharma | state->send_vcpu = i; |
593 | 9ce94e7c | Arun Sharma | return cpu_get_ioreq_from_shared_memory(state, i);
|
594 | 9ce94e7c | Arun Sharma | } |
595 | 9ce94e7c | Arun Sharma | |
596 | 9ce94e7c | Arun Sharma | /* read error or read nothing */
|
597 | 9ce94e7c | Arun Sharma | return NULL; |
598 | 9ce94e7c | Arun Sharma | } |
599 | 9ce94e7c | Arun Sharma | |
600 | 9ce94e7c | Arun Sharma | static uint32_t do_inp(pio_addr_t addr, unsigned long size) |
601 | 9ce94e7c | Arun Sharma | { |
602 | 9ce94e7c | Arun Sharma | switch (size) {
|
603 | 9ce94e7c | Arun Sharma | case 1: |
604 | 9ce94e7c | Arun Sharma | return cpu_inb(addr);
|
605 | 9ce94e7c | Arun Sharma | case 2: |
606 | 9ce94e7c | Arun Sharma | return cpu_inw(addr);
|
607 | 9ce94e7c | Arun Sharma | case 4: |
608 | 9ce94e7c | Arun Sharma | return cpu_inl(addr);
|
609 | 9ce94e7c | Arun Sharma | default:
|
610 | 9ce94e7c | Arun Sharma | hw_error("inp: bad size: %04"FMT_pioaddr" %lx", addr, size); |
611 | 9ce94e7c | Arun Sharma | } |
612 | 9ce94e7c | Arun Sharma | } |
613 | 9ce94e7c | Arun Sharma | |
614 | 9ce94e7c | Arun Sharma | static void do_outp(pio_addr_t addr, |
615 | 9ce94e7c | Arun Sharma | unsigned long size, uint32_t val) |
616 | 9ce94e7c | Arun Sharma | { |
617 | 9ce94e7c | Arun Sharma | switch (size) {
|
618 | 9ce94e7c | Arun Sharma | case 1: |
619 | 9ce94e7c | Arun Sharma | return cpu_outb(addr, val);
|
620 | 9ce94e7c | Arun Sharma | case 2: |
621 | 9ce94e7c | Arun Sharma | return cpu_outw(addr, val);
|
622 | 9ce94e7c | Arun Sharma | case 4: |
623 | 9ce94e7c | Arun Sharma | return cpu_outl(addr, val);
|
624 | 9ce94e7c | Arun Sharma | default:
|
625 | 9ce94e7c | Arun Sharma | hw_error("outp: bad size: %04"FMT_pioaddr" %lx", addr, size); |
626 | 9ce94e7c | Arun Sharma | } |
627 | 9ce94e7c | Arun Sharma | } |
628 | 9ce94e7c | Arun Sharma | |
629 | 9ce94e7c | Arun Sharma | static void cpu_ioreq_pio(ioreq_t *req) |
630 | 9ce94e7c | Arun Sharma | { |
631 | 9ce94e7c | Arun Sharma | int i, sign;
|
632 | 9ce94e7c | Arun Sharma | |
633 | 9ce94e7c | Arun Sharma | sign = req->df ? -1 : 1; |
634 | 9ce94e7c | Arun Sharma | |
635 | 9ce94e7c | Arun Sharma | if (req->dir == IOREQ_READ) {
|
636 | 9ce94e7c | Arun Sharma | if (!req->data_is_ptr) {
|
637 | 9ce94e7c | Arun Sharma | req->data = do_inp(req->addr, req->size); |
638 | 9ce94e7c | Arun Sharma | } else {
|
639 | 9ce94e7c | Arun Sharma | uint32_t tmp; |
640 | 9ce94e7c | Arun Sharma | |
641 | 9ce94e7c | Arun Sharma | for (i = 0; i < req->count; i++) { |
642 | 9ce94e7c | Arun Sharma | tmp = do_inp(req->addr, req->size); |
643 | 9ce94e7c | Arun Sharma | cpu_physical_memory_write(req->data + (sign * i * req->size), |
644 | 9ce94e7c | Arun Sharma | (uint8_t *) &tmp, req->size); |
645 | 9ce94e7c | Arun Sharma | } |
646 | 9ce94e7c | Arun Sharma | } |
647 | 9ce94e7c | Arun Sharma | } else if (req->dir == IOREQ_WRITE) { |
648 | 9ce94e7c | Arun Sharma | if (!req->data_is_ptr) {
|
649 | 9ce94e7c | Arun Sharma | do_outp(req->addr, req->size, req->data); |
650 | 9ce94e7c | Arun Sharma | } else {
|
651 | 9ce94e7c | Arun Sharma | for (i = 0; i < req->count; i++) { |
652 | 9ce94e7c | Arun Sharma | uint32_t tmp = 0;
|
653 | 9ce94e7c | Arun Sharma | |
654 | 9ce94e7c | Arun Sharma | cpu_physical_memory_read(req->data + (sign * i * req->size), |
655 | 9ce94e7c | Arun Sharma | (uint8_t*) &tmp, req->size); |
656 | 9ce94e7c | Arun Sharma | do_outp(req->addr, req->size, tmp); |
657 | 9ce94e7c | Arun Sharma | } |
658 | 9ce94e7c | Arun Sharma | } |
659 | 9ce94e7c | Arun Sharma | } |
660 | 9ce94e7c | Arun Sharma | } |
661 | 9ce94e7c | Arun Sharma | |
662 | 9ce94e7c | Arun Sharma | static void cpu_ioreq_move(ioreq_t *req) |
663 | 9ce94e7c | Arun Sharma | { |
664 | 9ce94e7c | Arun Sharma | int i, sign;
|
665 | 9ce94e7c | Arun Sharma | |
666 | 9ce94e7c | Arun Sharma | sign = req->df ? -1 : 1; |
667 | 9ce94e7c | Arun Sharma | |
668 | 9ce94e7c | Arun Sharma | if (!req->data_is_ptr) {
|
669 | 9ce94e7c | Arun Sharma | if (req->dir == IOREQ_READ) {
|
670 | 9ce94e7c | Arun Sharma | for (i = 0; i < req->count; i++) { |
671 | 9ce94e7c | Arun Sharma | cpu_physical_memory_read(req->addr + (sign * i * req->size), |
672 | 9ce94e7c | Arun Sharma | (uint8_t *) &req->data, req->size); |
673 | 9ce94e7c | Arun Sharma | } |
674 | 9ce94e7c | Arun Sharma | } else if (req->dir == IOREQ_WRITE) { |
675 | 9ce94e7c | Arun Sharma | for (i = 0; i < req->count; i++) { |
676 | 9ce94e7c | Arun Sharma | cpu_physical_memory_write(req->addr + (sign * i * req->size), |
677 | 9ce94e7c | Arun Sharma | (uint8_t *) &req->data, req->size); |
678 | 9ce94e7c | Arun Sharma | } |
679 | 9ce94e7c | Arun Sharma | } |
680 | 9ce94e7c | Arun Sharma | } else {
|
681 | 2b734340 | Stefano Stabellini | uint64_t tmp; |
682 | 9ce94e7c | Arun Sharma | |
683 | 9ce94e7c | Arun Sharma | if (req->dir == IOREQ_READ) {
|
684 | 9ce94e7c | Arun Sharma | for (i = 0; i < req->count; i++) { |
685 | 9ce94e7c | Arun Sharma | cpu_physical_memory_read(req->addr + (sign * i * req->size), |
686 | 9ce94e7c | Arun Sharma | (uint8_t*) &tmp, req->size); |
687 | 9ce94e7c | Arun Sharma | cpu_physical_memory_write(req->data + (sign * i * req->size), |
688 | 9ce94e7c | Arun Sharma | (uint8_t*) &tmp, req->size); |
689 | 9ce94e7c | Arun Sharma | } |
690 | 9ce94e7c | Arun Sharma | } else if (req->dir == IOREQ_WRITE) { |
691 | 9ce94e7c | Arun Sharma | for (i = 0; i < req->count; i++) { |
692 | 9ce94e7c | Arun Sharma | cpu_physical_memory_read(req->data + (sign * i * req->size), |
693 | 9ce94e7c | Arun Sharma | (uint8_t*) &tmp, req->size); |
694 | 9ce94e7c | Arun Sharma | cpu_physical_memory_write(req->addr + (sign * i * req->size), |
695 | 9ce94e7c | Arun Sharma | (uint8_t*) &tmp, req->size); |
696 | 9ce94e7c | Arun Sharma | } |
697 | 9ce94e7c | Arun Sharma | } |
698 | 9ce94e7c | Arun Sharma | } |
699 | 9ce94e7c | Arun Sharma | } |
700 | 9ce94e7c | Arun Sharma | |
701 | 9ce94e7c | Arun Sharma | static void handle_ioreq(ioreq_t *req) |
702 | 9ce94e7c | Arun Sharma | { |
703 | 9ce94e7c | Arun Sharma | if (!req->data_is_ptr && (req->dir == IOREQ_WRITE) &&
|
704 | 9ce94e7c | Arun Sharma | (req->size < sizeof (target_ulong))) {
|
705 | 9ce94e7c | Arun Sharma | req->data &= ((target_ulong) 1 << (8 * req->size)) - 1; |
706 | 9ce94e7c | Arun Sharma | } |
707 | 9ce94e7c | Arun Sharma | |
708 | 9ce94e7c | Arun Sharma | switch (req->type) {
|
709 | 9ce94e7c | Arun Sharma | case IOREQ_TYPE_PIO:
|
710 | 9ce94e7c | Arun Sharma | cpu_ioreq_pio(req); |
711 | 9ce94e7c | Arun Sharma | break;
|
712 | 9ce94e7c | Arun Sharma | case IOREQ_TYPE_COPY:
|
713 | 9ce94e7c | Arun Sharma | cpu_ioreq_move(req); |
714 | 9ce94e7c | Arun Sharma | break;
|
715 | 9ce94e7c | Arun Sharma | case IOREQ_TYPE_TIMEOFFSET:
|
716 | 9ce94e7c | Arun Sharma | break;
|
717 | 9ce94e7c | Arun Sharma | case IOREQ_TYPE_INVALIDATE:
|
718 | e41d7c69 | Jan Kiszka | xen_invalidate_map_cache(); |
719 | 9ce94e7c | Arun Sharma | break;
|
720 | 9ce94e7c | Arun Sharma | default:
|
721 | 9ce94e7c | Arun Sharma | hw_error("Invalid ioreq type 0x%x\n", req->type);
|
722 | 9ce94e7c | Arun Sharma | } |
723 | 9ce94e7c | Arun Sharma | } |
724 | 9ce94e7c | Arun Sharma | |
725 | 9ce94e7c | Arun Sharma | static void handle_buffered_iopage(XenIOState *state) |
726 | 9ce94e7c | Arun Sharma | { |
727 | 9ce94e7c | Arun Sharma | buf_ioreq_t *buf_req = NULL;
|
728 | 9ce94e7c | Arun Sharma | ioreq_t req; |
729 | 9ce94e7c | Arun Sharma | int qw;
|
730 | 9ce94e7c | Arun Sharma | |
731 | 9ce94e7c | Arun Sharma | if (!state->buffered_io_page) {
|
732 | 9ce94e7c | Arun Sharma | return;
|
733 | 9ce94e7c | Arun Sharma | } |
734 | 9ce94e7c | Arun Sharma | |
735 | 9ce94e7c | Arun Sharma | while (state->buffered_io_page->read_pointer != state->buffered_io_page->write_pointer) {
|
736 | 9ce94e7c | Arun Sharma | buf_req = &state->buffered_io_page->buf_ioreq[ |
737 | 9ce94e7c | Arun Sharma | state->buffered_io_page->read_pointer % IOREQ_BUFFER_SLOT_NUM]; |
738 | 9ce94e7c | Arun Sharma | req.size = 1UL << buf_req->size;
|
739 | 9ce94e7c | Arun Sharma | req.count = 1;
|
740 | 9ce94e7c | Arun Sharma | req.addr = buf_req->addr; |
741 | 9ce94e7c | Arun Sharma | req.data = buf_req->data; |
742 | 9ce94e7c | Arun Sharma | req.state = STATE_IOREQ_READY; |
743 | 9ce94e7c | Arun Sharma | req.dir = buf_req->dir; |
744 | 9ce94e7c | Arun Sharma | req.df = 1;
|
745 | 9ce94e7c | Arun Sharma | req.type = buf_req->type; |
746 | 9ce94e7c | Arun Sharma | req.data_is_ptr = 0;
|
747 | 9ce94e7c | Arun Sharma | qw = (req.size == 8);
|
748 | 9ce94e7c | Arun Sharma | if (qw) {
|
749 | 9ce94e7c | Arun Sharma | buf_req = &state->buffered_io_page->buf_ioreq[ |
750 | 9ce94e7c | Arun Sharma | (state->buffered_io_page->read_pointer + 1) % IOREQ_BUFFER_SLOT_NUM];
|
751 | 9ce94e7c | Arun Sharma | req.data |= ((uint64_t)buf_req->data) << 32;
|
752 | 9ce94e7c | Arun Sharma | } |
753 | 9ce94e7c | Arun Sharma | |
754 | 9ce94e7c | Arun Sharma | handle_ioreq(&req); |
755 | 9ce94e7c | Arun Sharma | |
756 | 9ce94e7c | Arun Sharma | xen_mb(); |
757 | 9ce94e7c | Arun Sharma | state->buffered_io_page->read_pointer += qw ? 2 : 1; |
758 | 9ce94e7c | Arun Sharma | } |
759 | 9ce94e7c | Arun Sharma | } |
760 | 9ce94e7c | Arun Sharma | |
761 | 9ce94e7c | Arun Sharma | static void handle_buffered_io(void *opaque) |
762 | 9ce94e7c | Arun Sharma | { |
763 | 9ce94e7c | Arun Sharma | XenIOState *state = opaque; |
764 | 9ce94e7c | Arun Sharma | |
765 | 9ce94e7c | Arun Sharma | handle_buffered_iopage(state); |
766 | 9ce94e7c | Arun Sharma | qemu_mod_timer(state->buffered_io_timer, |
767 | 9ce94e7c | Arun Sharma | BUFFER_IO_MAX_DELAY + qemu_get_clock_ms(rt_clock)); |
768 | 9ce94e7c | Arun Sharma | } |
769 | 9ce94e7c | Arun Sharma | |
770 | 9ce94e7c | Arun Sharma | static void cpu_handle_ioreq(void *opaque) |
771 | 9ce94e7c | Arun Sharma | { |
772 | 9ce94e7c | Arun Sharma | XenIOState *state = opaque; |
773 | 9ce94e7c | Arun Sharma | ioreq_t *req = cpu_get_ioreq(state); |
774 | 9ce94e7c | Arun Sharma | |
775 | 9ce94e7c | Arun Sharma | handle_buffered_iopage(state); |
776 | 9ce94e7c | Arun Sharma | if (req) {
|
777 | 9ce94e7c | Arun Sharma | handle_ioreq(req); |
778 | 9ce94e7c | Arun Sharma | |
779 | 9ce94e7c | Arun Sharma | if (req->state != STATE_IOREQ_INPROCESS) {
|
780 | 9ce94e7c | Arun Sharma | fprintf(stderr, "Badness in I/O request ... not in service?!: "
|
781 | 9ce94e7c | Arun Sharma | "%x, ptr: %x, port: %"PRIx64", " |
782 | 9ce94e7c | Arun Sharma | "data: %"PRIx64", count: %" FMT_ioreq_size ", size: %" FMT_ioreq_size "\n", |
783 | 9ce94e7c | Arun Sharma | req->state, req->data_is_ptr, req->addr, |
784 | 9ce94e7c | Arun Sharma | req->data, req->count, req->size); |
785 | 9ce94e7c | Arun Sharma | destroy_hvm_domain(); |
786 | 9ce94e7c | Arun Sharma | return;
|
787 | 9ce94e7c | Arun Sharma | } |
788 | 9ce94e7c | Arun Sharma | |
789 | 9ce94e7c | Arun Sharma | xen_wmb(); /* Update ioreq contents /then/ update state. */
|
790 | 9ce94e7c | Arun Sharma | |
791 | 9ce94e7c | Arun Sharma | /*
|
792 | 9ce94e7c | Arun Sharma | * We do this before we send the response so that the tools
|
793 | 9ce94e7c | Arun Sharma | * have the opportunity to pick up on the reset before the
|
794 | 9ce94e7c | Arun Sharma | * guest resumes and does a hlt with interrupts disabled which
|
795 | 9ce94e7c | Arun Sharma | * causes Xen to powerdown the domain.
|
796 | 9ce94e7c | Arun Sharma | */
|
797 | 1354869c | Luiz Capitulino | if (runstate_is_running()) {
|
798 | 9ce94e7c | Arun Sharma | if (qemu_shutdown_requested_get()) {
|
799 | 9ce94e7c | Arun Sharma | destroy_hvm_domain(); |
800 | 9ce94e7c | Arun Sharma | } |
801 | 9ce94e7c | Arun Sharma | if (qemu_reset_requested_get()) {
|
802 | e063eb1f | Jan Kiszka | qemu_system_reset(VMRESET_REPORT); |
803 | 9ce94e7c | Arun Sharma | } |
804 | 9ce94e7c | Arun Sharma | } |
805 | 9ce94e7c | Arun Sharma | |
806 | 9ce94e7c | Arun Sharma | req->state = STATE_IORESP_READY; |
807 | 9ce94e7c | Arun Sharma | xc_evtchn_notify(state->xce_handle, state->ioreq_local_port[state->send_vcpu]); |
808 | 9ce94e7c | Arun Sharma | } |
809 | 9ce94e7c | Arun Sharma | } |
810 | 9ce94e7c | Arun Sharma | |
811 | 0f51726a | Stefano Stabellini | static int store_dev_info(int domid, CharDriverState *cs, const char *string) |
812 | 0f51726a | Stefano Stabellini | { |
813 | 0f51726a | Stefano Stabellini | struct xs_handle *xs = NULL; |
814 | 0f51726a | Stefano Stabellini | char *path = NULL; |
815 | 0f51726a | Stefano Stabellini | char *newpath = NULL; |
816 | 0f51726a | Stefano Stabellini | char *pts = NULL; |
817 | 0f51726a | Stefano Stabellini | int ret = -1; |
818 | 0f51726a | Stefano Stabellini | |
819 | 0f51726a | Stefano Stabellini | /* Only continue if we're talking to a pty. */
|
820 | 0f51726a | Stefano Stabellini | if (strncmp(cs->filename, "pty:", 4)) { |
821 | 0f51726a | Stefano Stabellini | return 0; |
822 | 0f51726a | Stefano Stabellini | } |
823 | 0f51726a | Stefano Stabellini | pts = cs->filename + 4;
|
824 | 0f51726a | Stefano Stabellini | |
825 | 0f51726a | Stefano Stabellini | /* We now have everything we need to set the xenstore entry. */
|
826 | 0f51726a | Stefano Stabellini | xs = xs_open(0);
|
827 | 0f51726a | Stefano Stabellini | if (xs == NULL) { |
828 | 0f51726a | Stefano Stabellini | fprintf(stderr, "Could not contact XenStore\n");
|
829 | 0f51726a | Stefano Stabellini | goto out;
|
830 | 0f51726a | Stefano Stabellini | } |
831 | 0f51726a | Stefano Stabellini | |
832 | 0f51726a | Stefano Stabellini | path = xs_get_domain_path(xs, domid); |
833 | 0f51726a | Stefano Stabellini | if (path == NULL) { |
834 | 0f51726a | Stefano Stabellini | fprintf(stderr, "xs_get_domain_path() error\n");
|
835 | 0f51726a | Stefano Stabellini | goto out;
|
836 | 0f51726a | Stefano Stabellini | } |
837 | 0f51726a | Stefano Stabellini | newpath = realloc(path, (strlen(path) + strlen(string) + |
838 | 0f51726a | Stefano Stabellini | strlen("/tty") + 1)); |
839 | 0f51726a | Stefano Stabellini | if (newpath == NULL) { |
840 | 0f51726a | Stefano Stabellini | fprintf(stderr, "realloc error\n");
|
841 | 0f51726a | Stefano Stabellini | goto out;
|
842 | 0f51726a | Stefano Stabellini | } |
843 | 0f51726a | Stefano Stabellini | path = newpath; |
844 | 0f51726a | Stefano Stabellini | |
845 | 0f51726a | Stefano Stabellini | strcat(path, string); |
846 | 0f51726a | Stefano Stabellini | strcat(path, "/tty");
|
847 | 0f51726a | Stefano Stabellini | if (!xs_write(xs, XBT_NULL, path, pts, strlen(pts))) {
|
848 | 0f51726a | Stefano Stabellini | fprintf(stderr, "xs_write for '%s' fail", string);
|
849 | 0f51726a | Stefano Stabellini | goto out;
|
850 | 0f51726a | Stefano Stabellini | } |
851 | 0f51726a | Stefano Stabellini | ret = 0;
|
852 | 0f51726a | Stefano Stabellini | |
853 | 0f51726a | Stefano Stabellini | out:
|
854 | 0f51726a | Stefano Stabellini | free(path); |
855 | 0f51726a | Stefano Stabellini | xs_close(xs); |
856 | 0f51726a | Stefano Stabellini | |
857 | 0f51726a | Stefano Stabellini | return ret;
|
858 | 0f51726a | Stefano Stabellini | } |
859 | 0f51726a | Stefano Stabellini | |
860 | 0f51726a | Stefano Stabellini | void xenstore_store_pv_console_info(int i, CharDriverState *chr) |
861 | 0f51726a | Stefano Stabellini | { |
862 | 0f51726a | Stefano Stabellini | if (i == 0) { |
863 | 0f51726a | Stefano Stabellini | store_dev_info(xen_domid, chr, "/console");
|
864 | 0f51726a | Stefano Stabellini | } else {
|
865 | 0f51726a | Stefano Stabellini | char buf[32]; |
866 | 0f51726a | Stefano Stabellini | snprintf(buf, sizeof(buf), "/device/console/%d", i); |
867 | 0f51726a | Stefano Stabellini | store_dev_info(xen_domid, chr, buf); |
868 | 0f51726a | Stefano Stabellini | } |
869 | 0f51726a | Stefano Stabellini | } |
870 | 0f51726a | Stefano Stabellini | |
871 | fb4bb2b5 | Anthony PERARD | static void xenstore_record_dm_state(struct xs_handle *xs, const char *state) |
872 | 29321335 | Anthony PERARD | { |
873 | 29321335 | Anthony PERARD | char path[50]; |
874 | 29321335 | Anthony PERARD | |
875 | fb4bb2b5 | Anthony PERARD | if (xs == NULL) { |
876 | fb4bb2b5 | Anthony PERARD | fprintf(stderr, "xenstore connection not initialized\n");
|
877 | fb4bb2b5 | Anthony PERARD | exit(1);
|
878 | fb4bb2b5 | Anthony PERARD | } |
879 | fb4bb2b5 | Anthony PERARD | |
880 | 29321335 | Anthony PERARD | snprintf(path, sizeof (path), "/local/domain/0/device-model/%u/state", xen_domid); |
881 | fb4bb2b5 | Anthony PERARD | if (!xs_write(xs, XBT_NULL, path, state, strlen(state))) {
|
882 | 29321335 | Anthony PERARD | fprintf(stderr, "error recording dm state\n");
|
883 | 29321335 | Anthony PERARD | exit(1);
|
884 | 29321335 | Anthony PERARD | } |
885 | 29321335 | Anthony PERARD | } |
886 | 29321335 | Anthony PERARD | |
887 | 9ce94e7c | Arun Sharma | static void xen_main_loop_prepare(XenIOState *state) |
888 | 9ce94e7c | Arun Sharma | { |
889 | 9ce94e7c | Arun Sharma | int evtchn_fd = -1; |
890 | 9ce94e7c | Arun Sharma | |
891 | 9ce94e7c | Arun Sharma | if (state->xce_handle != XC_HANDLER_INITIAL_VALUE) {
|
892 | 9ce94e7c | Arun Sharma | evtchn_fd = xc_evtchn_fd(state->xce_handle); |
893 | 9ce94e7c | Arun Sharma | } |
894 | 9ce94e7c | Arun Sharma | |
895 | 9ce94e7c | Arun Sharma | state->buffered_io_timer = qemu_new_timer_ms(rt_clock, handle_buffered_io, |
896 | 9ce94e7c | Arun Sharma | state); |
897 | 9ce94e7c | Arun Sharma | qemu_mod_timer(state->buffered_io_timer, qemu_get_clock_ms(rt_clock)); |
898 | 9ce94e7c | Arun Sharma | |
899 | 9ce94e7c | Arun Sharma | if (evtchn_fd != -1) { |
900 | 9ce94e7c | Arun Sharma | qemu_set_fd_handler(evtchn_fd, cpu_handle_ioreq, NULL, state);
|
901 | 9ce94e7c | Arun Sharma | } |
902 | 9ce94e7c | Arun Sharma | } |
903 | 9ce94e7c | Arun Sharma | |
904 | 9ce94e7c | Arun Sharma | |
905 | 3285cf4f | Anthony PERARD | /* Initialise Xen */
|
906 | 3285cf4f | Anthony PERARD | |
907 | 1dfb4dd9 | Luiz Capitulino | static void xen_change_state_handler(void *opaque, int running, |
908 | 1dfb4dd9 | Luiz Capitulino | RunState state) |
909 | fb4bb2b5 | Anthony PERARD | { |
910 | fb4bb2b5 | Anthony PERARD | if (running) {
|
911 | fb4bb2b5 | Anthony PERARD | /* record state running */
|
912 | fb4bb2b5 | Anthony PERARD | xenstore_record_dm_state(xenstore, "running");
|
913 | fb4bb2b5 | Anthony PERARD | } |
914 | fb4bb2b5 | Anthony PERARD | } |
915 | fb4bb2b5 | Anthony PERARD | |
916 | 1dfb4dd9 | Luiz Capitulino | static void xen_hvm_change_state_handler(void *opaque, int running, |
917 | 1dfb4dd9 | Luiz Capitulino | RunState rstate) |
918 | 9ce94e7c | Arun Sharma | { |
919 | 1dfb4dd9 | Luiz Capitulino | XenIOState *xstate = opaque; |
920 | 9ce94e7c | Arun Sharma | if (running) {
|
921 | 1dfb4dd9 | Luiz Capitulino | xen_main_loop_prepare(xstate); |
922 | 9ce94e7c | Arun Sharma | } |
923 | 9ce94e7c | Arun Sharma | } |
924 | 9ce94e7c | Arun Sharma | |
925 | 9e8dd451 | Jan Kiszka | static void xen_exit_notifier(Notifier *n, void *data) |
926 | 9ce94e7c | Arun Sharma | { |
927 | 9ce94e7c | Arun Sharma | XenIOState *state = container_of(n, XenIOState, exit); |
928 | 9ce94e7c | Arun Sharma | |
929 | 9ce94e7c | Arun Sharma | xc_evtchn_close(state->xce_handle); |
930 | 29321335 | Anthony PERARD | xs_daemon_close(state->xenstore); |
931 | 9ce94e7c | Arun Sharma | } |
932 | 9ce94e7c | Arun Sharma | |
933 | 3285cf4f | Anthony PERARD | int xen_init(void) |
934 | 3285cf4f | Anthony PERARD | { |
935 | 3285cf4f | Anthony PERARD | xen_xc = xen_xc_interface_open(0, 0, 0); |
936 | 3285cf4f | Anthony PERARD | if (xen_xc == XC_HANDLER_INITIAL_VALUE) {
|
937 | 3285cf4f | Anthony PERARD | xen_be_printf(NULL, 0, "can't open xen interface\n"); |
938 | 3285cf4f | Anthony PERARD | return -1; |
939 | 3285cf4f | Anthony PERARD | } |
940 | fb4bb2b5 | Anthony PERARD | qemu_add_vm_change_state_handler(xen_change_state_handler, NULL);
|
941 | 3285cf4f | Anthony PERARD | |
942 | 3285cf4f | Anthony PERARD | return 0; |
943 | 3285cf4f | Anthony PERARD | } |
944 | 29d3ccde | Anthony PERARD | |
945 | 29d3ccde | Anthony PERARD | int xen_hvm_init(void) |
946 | 29d3ccde | Anthony PERARD | { |
947 | 9ce94e7c | Arun Sharma | int i, rc;
|
948 | 9ce94e7c | Arun Sharma | unsigned long ioreq_pfn; |
949 | 9ce94e7c | Arun Sharma | XenIOState *state; |
950 | 9ce94e7c | Arun Sharma | |
951 | 7267c094 | Anthony Liguori | state = g_malloc0(sizeof (XenIOState));
|
952 | 9ce94e7c | Arun Sharma | |
953 | 9ce94e7c | Arun Sharma | state->xce_handle = xen_xc_evtchn_open(NULL, 0); |
954 | 9ce94e7c | Arun Sharma | if (state->xce_handle == XC_HANDLER_INITIAL_VALUE) {
|
955 | 9ce94e7c | Arun Sharma | perror("xen: event channel open");
|
956 | 9ce94e7c | Arun Sharma | return -errno;
|
957 | 9ce94e7c | Arun Sharma | } |
958 | 9ce94e7c | Arun Sharma | |
959 | 29321335 | Anthony PERARD | state->xenstore = xs_daemon_open(); |
960 | 29321335 | Anthony PERARD | if (state->xenstore == NULL) { |
961 | 29321335 | Anthony PERARD | perror("xen: xenstore open");
|
962 | 29321335 | Anthony PERARD | return -errno;
|
963 | 29321335 | Anthony PERARD | } |
964 | 29321335 | Anthony PERARD | |
965 | 9ce94e7c | Arun Sharma | state->exit.notify = xen_exit_notifier; |
966 | 9ce94e7c | Arun Sharma | qemu_add_exit_notifier(&state->exit); |
967 | 9ce94e7c | Arun Sharma | |
968 | da98c8eb | Gerd Hoffmann | state->suspend.notify = xen_suspend_notifier; |
969 | da98c8eb | Gerd Hoffmann | qemu_register_suspend_notifier(&state->suspend); |
970 | da98c8eb | Gerd Hoffmann | |
971 | 9ce94e7c | Arun Sharma | xc_get_hvm_param(xen_xc, xen_domid, HVM_PARAM_IOREQ_PFN, &ioreq_pfn); |
972 | 9ce94e7c | Arun Sharma | DPRINTF("shared page at pfn %lx\n", ioreq_pfn);
|
973 | 9ce94e7c | Arun Sharma | state->shared_page = xc_map_foreign_range(xen_xc, xen_domid, XC_PAGE_SIZE, |
974 | 9ce94e7c | Arun Sharma | PROT_READ|PROT_WRITE, ioreq_pfn); |
975 | 9ce94e7c | Arun Sharma | if (state->shared_page == NULL) { |
976 | 9ce94e7c | Arun Sharma | hw_error("map shared IO page returned error %d handle=" XC_INTERFACE_FMT,
|
977 | 9ce94e7c | Arun Sharma | errno, xen_xc); |
978 | 9ce94e7c | Arun Sharma | } |
979 | 9ce94e7c | Arun Sharma | |
980 | 9ce94e7c | Arun Sharma | xc_get_hvm_param(xen_xc, xen_domid, HVM_PARAM_BUFIOREQ_PFN, &ioreq_pfn); |
981 | 9ce94e7c | Arun Sharma | DPRINTF("buffered io page at pfn %lx\n", ioreq_pfn);
|
982 | 9ce94e7c | Arun Sharma | state->buffered_io_page = xc_map_foreign_range(xen_xc, xen_domid, XC_PAGE_SIZE, |
983 | 9ce94e7c | Arun Sharma | PROT_READ|PROT_WRITE, ioreq_pfn); |
984 | 9ce94e7c | Arun Sharma | if (state->buffered_io_page == NULL) { |
985 | 9ce94e7c | Arun Sharma | hw_error("map buffered IO page returned error %d", errno);
|
986 | 9ce94e7c | Arun Sharma | } |
987 | 9ce94e7c | Arun Sharma | |
988 | 7267c094 | Anthony Liguori | state->ioreq_local_port = g_malloc0(smp_cpus * sizeof (evtchn_port_t));
|
989 | 9ce94e7c | Arun Sharma | |
990 | 9ce94e7c | Arun Sharma | /* FIXME: how about if we overflow the page here? */
|
991 | 9ce94e7c | Arun Sharma | for (i = 0; i < smp_cpus; i++) { |
992 | 9ce94e7c | Arun Sharma | rc = xc_evtchn_bind_interdomain(state->xce_handle, xen_domid, |
993 | 9ce94e7c | Arun Sharma | xen_vcpu_eport(state->shared_page, i)); |
994 | 9ce94e7c | Arun Sharma | if (rc == -1) { |
995 | 9ce94e7c | Arun Sharma | fprintf(stderr, "bind interdomain ioctl error %d\n", errno);
|
996 | 9ce94e7c | Arun Sharma | return -1; |
997 | 9ce94e7c | Arun Sharma | } |
998 | 9ce94e7c | Arun Sharma | state->ioreq_local_port[i] = rc; |
999 | 9ce94e7c | Arun Sharma | } |
1000 | 9ce94e7c | Arun Sharma | |
1001 | 432d268c | Jun Nakajima | /* Init RAM management */
|
1002 | e41d7c69 | Jan Kiszka | xen_map_cache_init(); |
1003 | 432d268c | Jun Nakajima | xen_ram_init(ram_size); |
1004 | 432d268c | Jun Nakajima | |
1005 | fb4bb2b5 | Anthony PERARD | qemu_add_vm_change_state_handler(xen_hvm_change_state_handler, state); |
1006 | 9ce94e7c | Arun Sharma | |
1007 | 20581d20 | Avi Kivity | state->memory_listener = xen_memory_listener; |
1008 | b4dd7802 | Anthony PERARD | QLIST_INIT(&state->physmap); |
1009 | 947f562c | Avi Kivity | memory_listener_register(&state->memory_listener, get_system_memory()); |
1010 | b4dd7802 | Anthony PERARD | state->log_for_dirtybit = NULL;
|
1011 | b4dd7802 | Anthony PERARD | |
1012 | ad35a7da | Stefano Stabellini | /* Initialize backend core & drivers */
|
1013 | ad35a7da | Stefano Stabellini | if (xen_be_init() != 0) { |
1014 | ad35a7da | Stefano Stabellini | fprintf(stderr, "%s: xen backend core setup failed\n", __FUNCTION__);
|
1015 | ad35a7da | Stefano Stabellini | exit(1);
|
1016 | ad35a7da | Stefano Stabellini | } |
1017 | ad35a7da | Stefano Stabellini | xen_be_register("console", &xen_console_ops);
|
1018 | 37cdfcf1 | Stefano Stabellini | xen_be_register("vkbd", &xen_kbdmouse_ops);
|
1019 | ad35a7da | Stefano Stabellini | xen_be_register("qdisk", &xen_blkdev_ops);
|
1020 | ad35a7da | Stefano Stabellini | |
1021 | 29d3ccde | Anthony PERARD | return 0; |
1022 | 29d3ccde | Anthony PERARD | } |
1023 | 9ce94e7c | Arun Sharma | |
1024 | 9ce94e7c | Arun Sharma | void destroy_hvm_domain(void) |
1025 | 9ce94e7c | Arun Sharma | { |
1026 | 9ce94e7c | Arun Sharma | XenXC xc_handle; |
1027 | 9ce94e7c | Arun Sharma | int sts;
|
1028 | 9ce94e7c | Arun Sharma | |
1029 | 9ce94e7c | Arun Sharma | xc_handle = xen_xc_interface_open(0, 0, 0); |
1030 | 9ce94e7c | Arun Sharma | if (xc_handle == XC_HANDLER_INITIAL_VALUE) {
|
1031 | 9ce94e7c | Arun Sharma | fprintf(stderr, "Cannot acquire xenctrl handle\n");
|
1032 | 9ce94e7c | Arun Sharma | } else {
|
1033 | 9ce94e7c | Arun Sharma | sts = xc_domain_shutdown(xc_handle, xen_domid, SHUTDOWN_poweroff); |
1034 | 9ce94e7c | Arun Sharma | if (sts != 0) { |
1035 | 9ce94e7c | Arun Sharma | fprintf(stderr, "? xc_domain_shutdown failed to issue poweroff, "
|
1036 | 9ce94e7c | Arun Sharma | "sts %d, %s\n", sts, strerror(errno));
|
1037 | 9ce94e7c | Arun Sharma | } else {
|
1038 | 9ce94e7c | Arun Sharma | fprintf(stderr, "Issued domain %d poweroff\n", xen_domid);
|
1039 | 9ce94e7c | Arun Sharma | } |
1040 | 9ce94e7c | Arun Sharma | xc_interface_close(xc_handle); |
1041 | 9ce94e7c | Arun Sharma | } |
1042 | 9ce94e7c | Arun Sharma | } |
1043 | c65adf9b | Avi Kivity | |
1044 | c65adf9b | Avi Kivity | void xen_register_framebuffer(MemoryRegion *mr)
|
1045 | c65adf9b | Avi Kivity | { |
1046 | c65adf9b | Avi Kivity | framebuffer = mr; |
1047 | c65adf9b | Avi Kivity | } |