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