Commit | Line | Data |
---|---|---|
4c071ee5 | 1 | #include <xen/xen.h> |
0ec53ecf | 2 | #include <xen/events.h> |
b3b52fd8 SS |
3 | #include <xen/grant_table.h> |
4 | #include <xen/hvm.h> | |
9a9ab3cc | 5 | #include <xen/interface/vcpu.h> |
4c071ee5 SS |
6 | #include <xen/interface/xen.h> |
7 | #include <xen/interface/memory.h> | |
b3b52fd8 | 8 | #include <xen/interface/hvm/params.h> |
ef61ee0d | 9 | #include <xen/features.h> |
4c071ee5 | 10 | #include <xen/platform_pci.h> |
b3b52fd8 | 11 | #include <xen/xenbus.h> |
c61ba729 | 12 | #include <xen/page.h> |
6abb749e | 13 | #include <xen/interface/sched.h> |
f832da06 | 14 | #include <xen/xen-ops.h> |
4c071ee5 SS |
15 | #include <asm/xen/hypervisor.h> |
16 | #include <asm/xen/hypercall.h> | |
6abb749e | 17 | #include <asm/system_misc.h> |
0ec53ecf SS |
18 | #include <linux/interrupt.h> |
19 | #include <linux/irqreturn.h> | |
4c071ee5 | 20 | #include <linux/module.h> |
2e01f166 SS |
21 | #include <linux/of.h> |
22 | #include <linux/of_irq.h> | |
23 | #include <linux/of_address.h> | |
e1a9c16b JG |
24 | #include <linux/cpuidle.h> |
25 | #include <linux/cpufreq.h> | |
8b271d57 | 26 | #include <linux/cpu.h> |
4c071ee5 | 27 | |
f832da06 IC |
28 | #include <linux/mm.h> |
29 | ||
4c071ee5 SS |
30 | struct start_info _xen_start_info; |
31 | struct start_info *xen_start_info = &_xen_start_info; | |
32 | EXPORT_SYMBOL_GPL(xen_start_info); | |
33 | ||
34 | enum xen_domain_type xen_domain_type = XEN_NATIVE; | |
35 | EXPORT_SYMBOL_GPL(xen_domain_type); | |
36 | ||
37 | struct shared_info xen_dummy_shared_info; | |
38 | struct shared_info *HYPERVISOR_shared_info = (void *)&xen_dummy_shared_info; | |
39 | ||
40 | DEFINE_PER_CPU(struct vcpu_info *, xen_vcpu); | |
9a9ab3cc | 41 | static struct vcpu_info __percpu *xen_vcpu_info; |
4c071ee5 | 42 | |
c61ba729 IC |
43 | /* These are unused until we support booting "pre-ballooned" */ |
44 | unsigned long xen_released_pages; | |
45 | struct xen_memory_region xen_extra_mem[XEN_EXTRA_MEM_MAX_REGIONS] __initdata; | |
46 | ||
4c071ee5 SS |
47 | /* TODO: to be removed */ |
48 | __read_mostly int xen_have_vector_callback; | |
49 | EXPORT_SYMBOL_GPL(xen_have_vector_callback); | |
50 | ||
51 | int xen_platform_pci_unplug = XEN_UNPLUG_ALL; | |
52 | EXPORT_SYMBOL_GPL(xen_platform_pci_unplug); | |
53 | ||
0ec53ecf SS |
54 | static __read_mostly int xen_events_irq = -1; |
55 | ||
f832da06 IC |
56 | /* map fgmfn of domid to lpfn in the current domain */ |
57 | static int map_foreign_page(unsigned long lpfn, unsigned long fgmfn, | |
58 | unsigned int domid) | |
59 | { | |
60 | int rc; | |
61 | struct xen_add_to_physmap_range xatp = { | |
62 | .domid = DOMID_SELF, | |
63 | .foreign_domid = domid, | |
64 | .size = 1, | |
65 | .space = XENMAPSPACE_gmfn_foreign, | |
66 | }; | |
67 | xen_ulong_t idx = fgmfn; | |
68 | xen_pfn_t gpfn = lpfn; | |
07d0c943 | 69 | int err = 0; |
f832da06 IC |
70 | |
71 | set_xen_guest_handle(xatp.idxs, &idx); | |
72 | set_xen_guest_handle(xatp.gpfns, &gpfn); | |
07d0c943 | 73 | set_xen_guest_handle(xatp.errs, &err); |
f832da06 IC |
74 | |
75 | rc = HYPERVISOR_memory_op(XENMEM_add_to_physmap_range, &xatp); | |
07d0c943 IC |
76 | if (rc || err) { |
77 | pr_warn("Failed to map pfn to mfn rc:%d:%d pfn:%lx mfn:%lx\n", | |
78 | rc, err, lpfn, fgmfn); | |
f832da06 IC |
79 | return 1; |
80 | } | |
81 | return 0; | |
82 | } | |
83 | ||
84 | struct remap_data { | |
85 | xen_pfn_t fgmfn; /* foreign domain's gmfn */ | |
86 | pgprot_t prot; | |
87 | domid_t domid; | |
88 | struct vm_area_struct *vma; | |
89 | int index; | |
90 | struct page **pages; | |
91 | struct xen_remap_mfn_info *info; | |
92 | }; | |
93 | ||
94 | static int remap_pte_fn(pte_t *ptep, pgtable_t token, unsigned long addr, | |
95 | void *data) | |
96 | { | |
97 | struct remap_data *info = data; | |
98 | struct page *page = info->pages[info->index++]; | |
99 | unsigned long pfn = page_to_pfn(page); | |
a7892f32 | 100 | pte_t pte = pte_mkspecial(pfn_pte(pfn, info->prot)); |
f832da06 IC |
101 | |
102 | if (map_foreign_page(pfn, info->fgmfn, info->domid)) | |
103 | return -EFAULT; | |
104 | set_pte_at(info->vma->vm_mm, addr, ptep, pte); | |
105 | ||
106 | return 0; | |
107 | } | |
108 | ||
4c071ee5 SS |
109 | int xen_remap_domain_mfn_range(struct vm_area_struct *vma, |
110 | unsigned long addr, | |
f832da06 IC |
111 | xen_pfn_t mfn, int nr, |
112 | pgprot_t prot, unsigned domid, | |
113 | struct page **pages) | |
4c071ee5 | 114 | { |
f832da06 IC |
115 | int err; |
116 | struct remap_data data; | |
117 | ||
118 | /* TBD: Batching, current sole caller only does page at a time */ | |
119 | if (nr > 1) | |
120 | return -EINVAL; | |
121 | ||
122 | data.fgmfn = mfn; | |
123 | data.prot = prot; | |
124 | data.domid = domid; | |
125 | data.vma = vma; | |
126 | data.index = 0; | |
127 | data.pages = pages; | |
128 | err = apply_to_page_range(vma->vm_mm, addr, nr << PAGE_SHIFT, | |
129 | remap_pte_fn, &data); | |
130 | return err; | |
4c071ee5 SS |
131 | } |
132 | EXPORT_SYMBOL_GPL(xen_remap_domain_mfn_range); | |
2e01f166 | 133 | |
f832da06 IC |
134 | int xen_unmap_domain_mfn_range(struct vm_area_struct *vma, |
135 | int nr, struct page **pages) | |
136 | { | |
137 | int i; | |
138 | ||
139 | for (i = 0; i < nr; i++) { | |
140 | struct xen_remove_from_physmap xrp; | |
141 | unsigned long rc, pfn; | |
142 | ||
143 | pfn = page_to_pfn(pages[i]); | |
144 | ||
145 | xrp.domid = DOMID_SELF; | |
146 | xrp.gpfn = pfn; | |
147 | rc = HYPERVISOR_memory_op(XENMEM_remove_from_physmap, &xrp); | |
148 | if (rc) { | |
149 | pr_warn("Failed to unmap pfn:%lx rc:%ld\n", | |
150 | pfn, rc); | |
151 | return rc; | |
152 | } | |
153 | } | |
154 | return 0; | |
155 | } | |
156 | EXPORT_SYMBOL_GPL(xen_unmap_domain_mfn_range); | |
157 | ||
8b271d57 | 158 | static void xen_percpu_init(void) |
9a9ab3cc SS |
159 | { |
160 | struct vcpu_register_vcpu_info info; | |
161 | struct vcpu_info *vcpup; | |
162 | int err; | |
3cc8e40e | 163 | int cpu = get_cpu(); |
9a9ab3cc SS |
164 | |
165 | pr_info("Xen: initializing cpu%d\n", cpu); | |
166 | vcpup = per_cpu_ptr(xen_vcpu_info, cpu); | |
167 | ||
168 | info.mfn = __pa(vcpup) >> PAGE_SHIFT; | |
169 | info.offset = offset_in_page(vcpup); | |
170 | ||
171 | err = HYPERVISOR_vcpu_op(VCPUOP_register_vcpu_info, cpu, &info); | |
d7266d78 SS |
172 | BUG_ON(err); |
173 | per_cpu(xen_vcpu, cpu) = vcpup; | |
174 | ||
3cc8e40e | 175 | enable_percpu_irq(xen_events_irq, 0); |
0d7febe5 | 176 | put_cpu(); |
9a9ab3cc SS |
177 | } |
178 | ||
2451ade0 | 179 | static void xen_restart(enum reboot_mode reboot_mode, const char *cmd) |
6abb749e SS |
180 | { |
181 | struct sched_shutdown r = { .reason = SHUTDOWN_reboot }; | |
182 | int rc; | |
183 | rc = HYPERVISOR_sched_op(SCHEDOP_shutdown, &r); | |
184 | if (rc) | |
185 | BUG(); | |
186 | } | |
187 | ||
188 | static void xen_power_off(void) | |
189 | { | |
190 | struct sched_shutdown r = { .reason = SHUTDOWN_poweroff }; | |
191 | int rc; | |
192 | rc = HYPERVISOR_sched_op(SCHEDOP_shutdown, &r); | |
193 | if (rc) | |
194 | BUG(); | |
195 | } | |
196 | ||
8b271d57 JG |
197 | static int xen_cpu_notification(struct notifier_block *self, |
198 | unsigned long action, | |
199 | void *hcpu) | |
200 | { | |
201 | switch (action) { | |
202 | case CPU_STARTING: | |
203 | xen_percpu_init(); | |
204 | break; | |
205 | default: | |
206 | break; | |
207 | } | |
208 | ||
209 | return NOTIFY_OK; | |
210 | } | |
211 | ||
212 | static struct notifier_block xen_cpu_notifier = { | |
213 | .notifier_call = xen_cpu_notification, | |
214 | }; | |
215 | ||
216 | static irqreturn_t xen_arm_callback(int irq, void *arg) | |
217 | { | |
218 | xen_hvm_evtchn_do_upcall(); | |
219 | return IRQ_HANDLED; | |
220 | } | |
221 | ||
2e01f166 SS |
222 | /* |
223 | * see Documentation/devicetree/bindings/arm/xen.txt for the | |
224 | * documentation of the Xen Device Tree format. | |
225 | */ | |
b3b52fd8 | 226 | #define GRANT_TABLE_PHYSADDR 0 |
2e01f166 SS |
227 | static int __init xen_guest_init(void) |
228 | { | |
229 | struct xen_add_to_physmap xatp; | |
230 | static struct shared_info *shared_info_page = 0; | |
231 | struct device_node *node; | |
232 | int len; | |
233 | const char *s = NULL; | |
234 | const char *version = NULL; | |
235 | const char *xen_prefix = "xen,xen-"; | |
b3b52fd8 | 236 | struct resource res; |
47c54205 | 237 | phys_addr_t grant_frames; |
2e01f166 SS |
238 | |
239 | node = of_find_compatible_node(NULL, NULL, "xen,xen"); | |
240 | if (!node) { | |
241 | pr_debug("No Xen support\n"); | |
242 | return 0; | |
243 | } | |
244 | s = of_get_property(node, "compatible", &len); | |
245 | if (strlen(xen_prefix) + 3 < len && | |
246 | !strncmp(xen_prefix, s, strlen(xen_prefix))) | |
247 | version = s + strlen(xen_prefix); | |
248 | if (version == NULL) { | |
249 | pr_debug("Xen version not found\n"); | |
250 | return 0; | |
251 | } | |
b3b52fd8 SS |
252 | if (of_address_to_resource(node, GRANT_TABLE_PHYSADDR, &res)) |
253 | return 0; | |
efaf30a3 | 254 | grant_frames = res.start; |
0ec53ecf | 255 | xen_events_irq = irq_of_parse_and_map(node, 0); |
47c54205 JG |
256 | pr_info("Xen %s support found, events_irq=%d gnttab_frame=%pa\n", |
257 | version, xen_events_irq, &grant_frames); | |
8b271d57 JG |
258 | |
259 | if (xen_events_irq < 0) | |
260 | return -ENODEV; | |
261 | ||
2e01f166 SS |
262 | xen_domain_type = XEN_HVM_DOMAIN; |
263 | ||
ef61ee0d SS |
264 | xen_setup_features(); |
265 | if (xen_feature(XENFEAT_dom0)) | |
266 | xen_start_info->flags |= SIF_INITDOMAIN|SIF_PRIVILEGED; | |
267 | else | |
268 | xen_start_info->flags &= ~(SIF_INITDOMAIN|SIF_PRIVILEGED); | |
269 | ||
2e01f166 SS |
270 | if (!shared_info_page) |
271 | shared_info_page = (struct shared_info *) | |
272 | get_zeroed_page(GFP_KERNEL); | |
273 | if (!shared_info_page) { | |
274 | pr_err("not enough memory\n"); | |
275 | return -ENOMEM; | |
276 | } | |
277 | xatp.domid = DOMID_SELF; | |
278 | xatp.idx = 0; | |
279 | xatp.space = XENMAPSPACE_shared_info; | |
280 | xatp.gpfn = __pa(shared_info_page) >> PAGE_SHIFT; | |
281 | if (HYPERVISOR_memory_op(XENMEM_add_to_physmap, &xatp)) | |
282 | BUG(); | |
283 | ||
284 | HYPERVISOR_shared_info = (struct shared_info *)shared_info_page; | |
285 | ||
286 | /* xen_vcpu is a pointer to the vcpu_info struct in the shared_info | |
287 | * page, we use it in the event channel upcall and in some pvclock | |
9a9ab3cc | 288 | * related functions. |
2e01f166 SS |
289 | * The shared info contains exactly 1 CPU (the boot CPU). The guest |
290 | * is required to use VCPUOP_register_vcpu_info to place vcpu info | |
9a9ab3cc SS |
291 | * for secondary CPUs as they are brought up. |
292 | * For uniformity we use VCPUOP_register_vcpu_info even on cpu0. | |
293 | */ | |
294 | xen_vcpu_info = __alloc_percpu(sizeof(struct vcpu_info), | |
295 | sizeof(struct vcpu_info)); | |
296 | if (xen_vcpu_info == NULL) | |
297 | return -ENOMEM; | |
b3b52fd8 | 298 | |
efaf30a3 KRW |
299 | if (gnttab_setup_auto_xlat_frames(grant_frames)) { |
300 | free_percpu(xen_vcpu_info); | |
301 | return -ENOMEM; | |
302 | } | |
b3b52fd8 SS |
303 | gnttab_init(); |
304 | if (!xen_initial_domain()) | |
305 | xenbus_probe(NULL); | |
306 | ||
e1a9c16b JG |
307 | /* |
308 | * Making sure board specific code will not set up ops for | |
309 | * cpu idle and cpu freq. | |
310 | */ | |
311 | disable_cpuidle(); | |
312 | disable_cpufreq(); | |
313 | ||
8b271d57 JG |
314 | xen_init_IRQ(); |
315 | ||
316 | if (request_percpu_irq(xen_events_irq, xen_arm_callback, | |
317 | "events", &xen_vcpu)) { | |
318 | pr_err("Error request IRQ %d\n", xen_events_irq); | |
319 | return -EINVAL; | |
320 | } | |
321 | ||
322 | xen_percpu_init(); | |
323 | ||
324 | register_cpu_notifier(&xen_cpu_notifier); | |
325 | ||
1aa3d8d9 SS |
326 | return 0; |
327 | } | |
8b271d57 | 328 | early_initcall(xen_guest_init); |
1aa3d8d9 SS |
329 | |
330 | static int __init xen_pm_init(void) | |
331 | { | |
9dd4b294 RH |
332 | if (!xen_domain()) |
333 | return -ENODEV; | |
334 | ||
6abb749e SS |
335 | pm_power_off = xen_power_off; |
336 | arm_pm_restart = xen_restart; | |
337 | ||
2e01f166 SS |
338 | return 0; |
339 | } | |
9dd4b294 | 340 | late_initcall(xen_pm_init); |
0ec53ecf | 341 | |
911dec0d KRW |
342 | /* In the hypervisor.S file. */ |
343 | EXPORT_SYMBOL_GPL(HYPERVISOR_event_channel_op); | |
344 | EXPORT_SYMBOL_GPL(HYPERVISOR_grant_table_op); | |
ab277bbf SS |
345 | EXPORT_SYMBOL_GPL(HYPERVISOR_xen_version); |
346 | EXPORT_SYMBOL_GPL(HYPERVISOR_console_io); | |
347 | EXPORT_SYMBOL_GPL(HYPERVISOR_sched_op); | |
348 | EXPORT_SYMBOL_GPL(HYPERVISOR_hvm_op); | |
349 | EXPORT_SYMBOL_GPL(HYPERVISOR_memory_op); | |
350 | EXPORT_SYMBOL_GPL(HYPERVISOR_physdev_op); | |
ea0af613 | 351 | EXPORT_SYMBOL_GPL(HYPERVISOR_vcpu_op); |
176455e9 | 352 | EXPORT_SYMBOL_GPL(HYPERVISOR_tmem_op); |
911dec0d | 353 | EXPORT_SYMBOL_GPL(privcmd_call); |