aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/lguest
diff options
context:
space:
mode:
authorRusty Russell <rusty@rustcorp.com.au>2007-07-19 04:49:22 -0400
committerLinus Torvalds <torvalds@woody.linux-foundation.org>2007-07-19 13:04:52 -0400
commit07ad157f6e5d228be78acd5cea0291e5d0360398 (patch)
tree87180c2d1aa53857f46d1dc293e08c0fbea0608a /drivers/lguest
parent5992b6dac0d23a2b51a1ccbaf8f1a2e62097b12b (diff)
lguest: the guest code
lguest is a simple hypervisor for Linux on Linux. Unlike kvm it doesn't need VT/SVM hardware. Unlike Xen it's simply "modprobe and go". Unlike both, it's 5000 lines and self-contained. Performance is ok, but not great (-30% on kernel compile). But given its hackability, I expect this to improve, along with the paravirt_ops code which it supplies a complete example for. There's also a 64-bit version being worked on and other craziness. But most of all, lguest is awesome fun! Too much of the kernel is a big ball of hair. lguest is simple enough to dive into and hack, plus has some warts which scream "fork me!". This patch: This is the code and headers required to make an i386 kernel an lguest guest. Signed-off-by: Rusty Russell <rusty@rustcorp.com.au> Cc: Andi Kleen <ak@suse.de> Cc: Jeremy Fitzhardinge <jeremy@goop.org> Signed-off-by: Andrew Morton <akpm@linux-foundation.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
Diffstat (limited to 'drivers/lguest')
-rw-r--r--drivers/lguest/lguest.c544
-rw-r--r--drivers/lguest/lguest_asm.S53
-rw-r--r--drivers/lguest/lguest_bus.c148
3 files changed, 745 insertions, 0 deletions
diff --git a/drivers/lguest/lguest.c b/drivers/lguest/lguest.c
new file mode 100644
index 000000000000..b3a72bd8d6f5
--- /dev/null
+++ b/drivers/lguest/lguest.c
@@ -0,0 +1,544 @@
1/*
2 * Lguest specific paravirt-ops implementation
3 *
4 * Copyright (C) 2006, Rusty Russell <rusty@rustcorp.com.au> IBM Corporation.
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful, but
12 * WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
14 * NON INFRINGEMENT. See the GNU General Public License for more
15 * details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
20 */
21#include <linux/kernel.h>
22#include <linux/start_kernel.h>
23#include <linux/string.h>
24#include <linux/console.h>
25#include <linux/screen_info.h>
26#include <linux/irq.h>
27#include <linux/interrupt.h>
28#include <linux/lguest.h>
29#include <linux/lguest_launcher.h>
30#include <linux/lguest_bus.h>
31#include <asm/paravirt.h>
32#include <asm/param.h>
33#include <asm/page.h>
34#include <asm/pgtable.h>
35#include <asm/desc.h>
36#include <asm/setup.h>
37#include <asm/e820.h>
38#include <asm/mce.h>
39#include <asm/io.h>
40
41/* Declarations for definitions in lguest_guest.S */
42extern char lguest_noirq_start[], lguest_noirq_end[];
43extern const char lgstart_cli[], lgend_cli[];
44extern const char lgstart_sti[], lgend_sti[];
45extern const char lgstart_popf[], lgend_popf[];
46extern const char lgstart_pushf[], lgend_pushf[];
47extern const char lgstart_iret[], lgend_iret[];
48extern void lguest_iret(void);
49
50struct lguest_data lguest_data = {
51 .hcall_status = { [0 ... LHCALL_RING_SIZE-1] = 0xFF },
52 .noirq_start = (u32)lguest_noirq_start,
53 .noirq_end = (u32)lguest_noirq_end,
54 .blocked_interrupts = { 1 }, /* Block timer interrupts */
55};
56struct lguest_device_desc *lguest_devices;
57static __initdata const struct lguest_boot_info *boot = __va(0);
58
59static enum paravirt_lazy_mode lazy_mode;
60static void lguest_lazy_mode(enum paravirt_lazy_mode mode)
61{
62 if (mode == PARAVIRT_LAZY_FLUSH) {
63 if (unlikely(lazy_mode != PARAVIRT_LAZY_NONE))
64 hcall(LHCALL_FLUSH_ASYNC, 0, 0, 0);
65 } else {
66 lazy_mode = mode;
67 if (mode == PARAVIRT_LAZY_NONE)
68 hcall(LHCALL_FLUSH_ASYNC, 0, 0, 0);
69 }
70}
71
72static void lazy_hcall(unsigned long call,
73 unsigned long arg1,
74 unsigned long arg2,
75 unsigned long arg3)
76{
77 if (lazy_mode == PARAVIRT_LAZY_NONE)
78 hcall(call, arg1, arg2, arg3);
79 else
80 async_hcall(call, arg1, arg2, arg3);
81}
82
83void async_hcall(unsigned long call,
84 unsigned long arg1, unsigned long arg2, unsigned long arg3)
85{
86 /* Note: This code assumes we're uniprocessor. */
87 static unsigned int next_call;
88 unsigned long flags;
89
90 local_irq_save(flags);
91 if (lguest_data.hcall_status[next_call] != 0xFF) {
92 /* Table full, so do normal hcall which will flush table. */
93 hcall(call, arg1, arg2, arg3);
94 } else {
95 lguest_data.hcalls[next_call].eax = call;
96 lguest_data.hcalls[next_call].edx = arg1;
97 lguest_data.hcalls[next_call].ebx = arg2;
98 lguest_data.hcalls[next_call].ecx = arg3;
99 /* Make sure host sees arguments before "valid" flag. */
100 wmb();
101 lguest_data.hcall_status[next_call] = 0;
102 if (++next_call == LHCALL_RING_SIZE)
103 next_call = 0;
104 }
105 local_irq_restore(flags);
106}
107
108void lguest_send_dma(unsigned long key, struct lguest_dma *dma)
109{
110 dma->used_len = 0;
111 hcall(LHCALL_SEND_DMA, key, __pa(dma), 0);
112}
113
114int lguest_bind_dma(unsigned long key, struct lguest_dma *dmas,
115 unsigned int num, u8 irq)
116{
117 if (!hcall(LHCALL_BIND_DMA, key, __pa(dmas), (num << 8) | irq))
118 return -ENOMEM;
119 return 0;
120}
121
122void lguest_unbind_dma(unsigned long key, struct lguest_dma *dmas)
123{
124 hcall(LHCALL_BIND_DMA, key, __pa(dmas), 0);
125}
126
127/* For guests, device memory can be used as normal memory, so we cast away the
128 * __iomem to quieten sparse. */
129void *lguest_map(unsigned long phys_addr, unsigned long pages)
130{
131 return (__force void *)ioremap(phys_addr, PAGE_SIZE*pages);
132}
133
134void lguest_unmap(void *addr)
135{
136 iounmap((__force void __iomem *)addr);
137}
138
139static unsigned long save_fl(void)
140{
141 return lguest_data.irq_enabled;
142}
143
144static void restore_fl(unsigned long flags)
145{
146 /* FIXME: Check if interrupt pending... */
147 lguest_data.irq_enabled = flags;
148}
149
150static void irq_disable(void)
151{
152 lguest_data.irq_enabled = 0;
153}
154
155static void irq_enable(void)
156{
157 /* FIXME: Check if interrupt pending... */
158 lguest_data.irq_enabled = X86_EFLAGS_IF;
159}
160
161static void lguest_write_idt_entry(struct desc_struct *dt,
162 int entrynum, u32 low, u32 high)
163{
164 write_dt_entry(dt, entrynum, low, high);
165 hcall(LHCALL_LOAD_IDT_ENTRY, entrynum, low, high);
166}
167
168static void lguest_load_idt(const struct Xgt_desc_struct *desc)
169{
170 unsigned int i;
171 struct desc_struct *idt = (void *)desc->address;
172
173 for (i = 0; i < (desc->size+1)/8; i++)
174 hcall(LHCALL_LOAD_IDT_ENTRY, i, idt[i].a, idt[i].b);
175}
176
177static void lguest_load_gdt(const struct Xgt_desc_struct *desc)
178{
179 BUG_ON((desc->size+1)/8 != GDT_ENTRIES);
180 hcall(LHCALL_LOAD_GDT, __pa(desc->address), GDT_ENTRIES, 0);
181}
182
183static void lguest_write_gdt_entry(struct desc_struct *dt,
184 int entrynum, u32 low, u32 high)
185{
186 write_dt_entry(dt, entrynum, low, high);
187 hcall(LHCALL_LOAD_GDT, __pa(dt), GDT_ENTRIES, 0);
188}
189
190static void lguest_load_tls(struct thread_struct *t, unsigned int cpu)
191{
192 lazy_hcall(LHCALL_LOAD_TLS, __pa(&t->tls_array), cpu, 0);
193}
194
195static void lguest_set_ldt(const void *addr, unsigned entries)
196{
197}
198
199static void lguest_load_tr_desc(void)
200{
201}
202
203static void lguest_cpuid(unsigned int *eax, unsigned int *ebx,
204 unsigned int *ecx, unsigned int *edx)
205{
206 int function = *eax;
207
208 native_cpuid(eax, ebx, ecx, edx);
209 switch (function) {
210 case 1: /* Basic feature request. */
211 /* We only allow kernel to see SSE3, CMPXCHG16B and SSSE3 */
212 *ecx &= 0x00002201;
213 /* Similarly: SSE, SSE2, FXSR, MMX, CMOV, CMPXCHG8B, FPU. */
214 *edx &= 0x07808101;
215 /* Host wants to know when we flush kernel pages: set PGE. */
216 *edx |= 0x00002000;
217 break;
218 case 0x80000000:
219 /* Futureproof this a little: if they ask how much extended
220 * processor information, limit it to known fields. */
221 if (*eax > 0x80000008)
222 *eax = 0x80000008;
223 break;
224 }
225}
226
227static unsigned long current_cr0, current_cr3;
228static void lguest_write_cr0(unsigned long val)
229{
230 lazy_hcall(LHCALL_TS, val & 8, 0, 0);
231 current_cr0 = val;
232}
233
234static unsigned long lguest_read_cr0(void)
235{
236 return current_cr0;
237}
238
239static void lguest_clts(void)
240{
241 lazy_hcall(LHCALL_TS, 0, 0, 0);
242 current_cr0 &= ~8U;
243}
244
245static unsigned long lguest_read_cr2(void)
246{
247 return lguest_data.cr2;
248}
249
250static void lguest_write_cr3(unsigned long cr3)
251{
252 lazy_hcall(LHCALL_NEW_PGTABLE, cr3, 0, 0);
253 current_cr3 = cr3;
254}
255
256static unsigned long lguest_read_cr3(void)
257{
258 return current_cr3;
259}
260
261/* Used to enable/disable PGE, but we don't care. */
262static unsigned long lguest_read_cr4(void)
263{
264 return 0;
265}
266
267static void lguest_write_cr4(unsigned long val)
268{
269}
270
271static void lguest_set_pte_at(struct mm_struct *mm, unsigned long addr,
272 pte_t *ptep, pte_t pteval)
273{
274 *ptep = pteval;
275 lazy_hcall(LHCALL_SET_PTE, __pa(mm->pgd), addr, pteval.pte_low);
276}
277
278/* We only support two-level pagetables at the moment. */
279static void lguest_set_pmd(pmd_t *pmdp, pmd_t pmdval)
280{
281 *pmdp = pmdval;
282 lazy_hcall(LHCALL_SET_PMD, __pa(pmdp)&PAGE_MASK,
283 (__pa(pmdp)&(PAGE_SIZE-1))/4, 0);
284}
285
286/* FIXME: Eliminate all callers of this. */
287static void lguest_set_pte(pte_t *ptep, pte_t pteval)
288{
289 *ptep = pteval;
290 /* Don't bother with hypercall before initial setup. */
291 if (current_cr3)
292 lazy_hcall(LHCALL_FLUSH_TLB, 1, 0, 0);
293}
294
295static void lguest_flush_tlb_single(unsigned long addr)
296{
297 /* Simply set it to zero, and it will fault back in. */
298 lazy_hcall(LHCALL_SET_PTE, current_cr3, addr, 0);
299}
300
301static void lguest_flush_tlb_user(void)
302{
303 lazy_hcall(LHCALL_FLUSH_TLB, 0, 0, 0);
304}
305
306static void lguest_flush_tlb_kernel(void)
307{
308 lazy_hcall(LHCALL_FLUSH_TLB, 1, 0, 0);
309}
310
311static void disable_lguest_irq(unsigned int irq)
312{
313 set_bit(irq, lguest_data.blocked_interrupts);
314}
315
316static void enable_lguest_irq(unsigned int irq)
317{
318 clear_bit(irq, lguest_data.blocked_interrupts);
319 /* FIXME: If it's pending? */
320}
321
322static struct irq_chip lguest_irq_controller = {
323 .name = "lguest",
324 .mask = disable_lguest_irq,
325 .mask_ack = disable_lguest_irq,
326 .unmask = enable_lguest_irq,
327};
328
329static void __init lguest_init_IRQ(void)
330{
331 unsigned int i;
332
333 for (i = 0; i < LGUEST_IRQS; i++) {
334 int vector = FIRST_EXTERNAL_VECTOR + i;
335 if (vector != SYSCALL_VECTOR) {
336 set_intr_gate(vector, interrupt[i]);
337 set_irq_chip_and_handler(i, &lguest_irq_controller,
338 handle_level_irq);
339 }
340 }
341 irq_ctx_init(smp_processor_id());
342}
343
344static unsigned long lguest_get_wallclock(void)
345{
346 return hcall(LHCALL_GET_WALLCLOCK, 0, 0, 0);
347}
348
349static void lguest_time_irq(unsigned int irq, struct irq_desc *desc)
350{
351 do_timer(hcall(LHCALL_TIMER_READ, 0, 0, 0));
352 update_process_times(user_mode_vm(get_irq_regs()));
353}
354
355static u64 sched_clock_base;
356static void lguest_time_init(void)
357{
358 set_irq_handler(0, lguest_time_irq);
359 hcall(LHCALL_TIMER_READ, 0, 0, 0);
360 sched_clock_base = jiffies_64;
361 enable_lguest_irq(0);
362}
363
364static unsigned long long lguest_sched_clock(void)
365{
366 return (jiffies_64 - sched_clock_base) * (1000000000 / HZ);
367}
368
369static void lguest_load_esp0(struct tss_struct *tss,
370 struct thread_struct *thread)
371{
372 lazy_hcall(LHCALL_SET_STACK, __KERNEL_DS|0x1, thread->esp0,
373 THREAD_SIZE/PAGE_SIZE);
374}
375
376static void lguest_set_debugreg(int regno, unsigned long value)
377{
378 /* FIXME: Implement */
379}
380
381static void lguest_wbinvd(void)
382{
383}
384
385#ifdef CONFIG_X86_LOCAL_APIC
386static void lguest_apic_write(unsigned long reg, unsigned long v)
387{
388}
389
390static unsigned long lguest_apic_read(unsigned long reg)
391{
392 return 0;
393}
394#endif
395
396static void lguest_safe_halt(void)
397{
398 hcall(LHCALL_HALT, 0, 0, 0);
399}
400
401static void lguest_power_off(void)
402{
403 hcall(LHCALL_CRASH, __pa("Power down"), 0, 0);
404}
405
406static int lguest_panic(struct notifier_block *nb, unsigned long l, void *p)
407{
408 hcall(LHCALL_CRASH, __pa(p), 0, 0);
409 return NOTIFY_DONE;
410}
411
412static struct notifier_block paniced = {
413 .notifier_call = lguest_panic
414};
415
416static __init char *lguest_memory_setup(void)
417{
418 /* We do this here because lockcheck barfs if before start_kernel */
419 atomic_notifier_chain_register(&panic_notifier_list, &paniced);
420
421 e820.nr_map = 0;
422 add_memory_region(0, PFN_PHYS(boot->max_pfn), E820_RAM);
423 return "LGUEST";
424}
425
426static const struct lguest_insns
427{
428 const char *start, *end;
429} lguest_insns[] = {
430 [PARAVIRT_PATCH(irq_disable)] = { lgstart_cli, lgend_cli },
431 [PARAVIRT_PATCH(irq_enable)] = { lgstart_sti, lgend_sti },
432 [PARAVIRT_PATCH(restore_fl)] = { lgstart_popf, lgend_popf },
433 [PARAVIRT_PATCH(save_fl)] = { lgstart_pushf, lgend_pushf },
434};
435static unsigned lguest_patch(u8 type, u16 clobber, void *insns, unsigned len)
436{
437 unsigned int insn_len;
438
439 /* Don't touch it if we don't have a replacement */
440 if (type >= ARRAY_SIZE(lguest_insns) || !lguest_insns[type].start)
441 return paravirt_patch_default(type, clobber, insns, len);
442
443 insn_len = lguest_insns[type].end - lguest_insns[type].start;
444
445 /* Similarly if we can't fit replacement. */
446 if (len < insn_len)
447 return paravirt_patch_default(type, clobber, insns, len);
448
449 memcpy(insns, lguest_insns[type].start, insn_len);
450 return insn_len;
451}
452
453__init void lguest_init(void)
454{
455 paravirt_ops.name = "lguest";
456 paravirt_ops.paravirt_enabled = 1;
457 paravirt_ops.kernel_rpl = 1;
458
459 paravirt_ops.save_fl = save_fl;
460 paravirt_ops.restore_fl = restore_fl;
461 paravirt_ops.irq_disable = irq_disable;
462 paravirt_ops.irq_enable = irq_enable;
463 paravirt_ops.load_gdt = lguest_load_gdt;
464 paravirt_ops.memory_setup = lguest_memory_setup;
465 paravirt_ops.cpuid = lguest_cpuid;
466 paravirt_ops.write_cr3 = lguest_write_cr3;
467 paravirt_ops.flush_tlb_user = lguest_flush_tlb_user;
468 paravirt_ops.flush_tlb_single = lguest_flush_tlb_single;
469 paravirt_ops.flush_tlb_kernel = lguest_flush_tlb_kernel;
470 paravirt_ops.set_pte = lguest_set_pte;
471 paravirt_ops.set_pte_at = lguest_set_pte_at;
472 paravirt_ops.set_pmd = lguest_set_pmd;
473#ifdef CONFIG_X86_LOCAL_APIC
474 paravirt_ops.apic_write = lguest_apic_write;
475 paravirt_ops.apic_write_atomic = lguest_apic_write;
476 paravirt_ops.apic_read = lguest_apic_read;
477#endif
478 paravirt_ops.load_idt = lguest_load_idt;
479 paravirt_ops.iret = lguest_iret;
480 paravirt_ops.load_esp0 = lguest_load_esp0;
481 paravirt_ops.load_tr_desc = lguest_load_tr_desc;
482 paravirt_ops.set_ldt = lguest_set_ldt;
483 paravirt_ops.load_tls = lguest_load_tls;
484 paravirt_ops.set_debugreg = lguest_set_debugreg;
485 paravirt_ops.clts = lguest_clts;
486 paravirt_ops.read_cr0 = lguest_read_cr0;
487 paravirt_ops.write_cr0 = lguest_write_cr0;
488 paravirt_ops.init_IRQ = lguest_init_IRQ;
489 paravirt_ops.read_cr2 = lguest_read_cr2;
490 paravirt_ops.read_cr3 = lguest_read_cr3;
491 paravirt_ops.read_cr4 = lguest_read_cr4;
492 paravirt_ops.write_cr4 = lguest_write_cr4;
493 paravirt_ops.write_gdt_entry = lguest_write_gdt_entry;
494 paravirt_ops.write_idt_entry = lguest_write_idt_entry;
495 paravirt_ops.patch = lguest_patch;
496 paravirt_ops.safe_halt = lguest_safe_halt;
497 paravirt_ops.get_wallclock = lguest_get_wallclock;
498 paravirt_ops.time_init = lguest_time_init;
499 paravirt_ops.set_lazy_mode = lguest_lazy_mode;
500 paravirt_ops.wbinvd = lguest_wbinvd;
501 paravirt_ops.sched_clock = lguest_sched_clock;
502
503 hcall(LHCALL_LGUEST_INIT, __pa(&lguest_data), 0, 0);
504 strncpy(boot_command_line, boot->cmdline, COMMAND_LINE_SIZE);
505
506 /* We use top of mem for initial pagetables. */
507 init_pg_tables_end = __pa(pg0);
508
509 asm volatile ("mov %0, %%fs" : : "r" (__KERNEL_DS) : "memory");
510
511 reserve_top_address(lguest_data.reserve_mem);
512
513 lockdep_init();
514
515 paravirt_disable_iospace();
516
517 cpu_detect(&new_cpu_data);
518 /* head.S usually sets up the first capability word, so do it here. */
519 new_cpu_data.x86_capability[0] = cpuid_edx(1);
520
521 /* Math is always hard! */
522 new_cpu_data.hard_math = 1;
523
524#ifdef CONFIG_X86_MCE
525 mce_disabled = 1;
526#endif
527
528#ifdef CONFIG_ACPI
529 acpi_disabled = 1;
530 acpi_ht = 0;
531#endif
532
533 add_preferred_console("hvc", 0, NULL);
534
535 if (boot->initrd_size) {
536 /* We stash this at top of memory. */
537 INITRD_START = boot->max_pfn*PAGE_SIZE - boot->initrd_size;
538 INITRD_SIZE = boot->initrd_size;
539 LOADER_TYPE = 0xFF;
540 }
541
542 pm_power_off = lguest_power_off;
543 start_kernel();
544}
diff --git a/drivers/lguest/lguest_asm.S b/drivers/lguest/lguest_asm.S
new file mode 100644
index 000000000000..5ac3d20bb184
--- /dev/null
+++ b/drivers/lguest/lguest_asm.S
@@ -0,0 +1,53 @@
1#include <linux/linkage.h>
2#include <linux/lguest.h>
3#include <asm/asm-offsets.h>
4#include <asm/thread_info.h>
5
6/* FIXME: Once asm/processor-flags.h goes in, include that */
7#define X86_EFLAGS_IF 0x00000200
8
9/*
10 * This is where we begin: we have a magic signature which the launcher looks
11 * for. The plan is that the Linux boot protocol will be extended with a
12 * "platform type" field which will guide us here from the normal entry point,
13 * but for the moment this suffices.
14 *
15 * We put it in .init.text will be discarded after boot.
16 */
17.section .init.text, "ax", @progbits
18.ascii "GenuineLguest"
19 /* Set up initial stack. */
20 movl $(init_thread_union+THREAD_SIZE),%esp
21 jmp lguest_init
22
23/* The templates for inline patching. */
24#define LGUEST_PATCH(name, insns...) \
25 lgstart_##name: insns; lgend_##name:; \
26 .globl lgstart_##name; .globl lgend_##name
27
28LGUEST_PATCH(cli, movl $0, lguest_data+LGUEST_DATA_irq_enabled)
29LGUEST_PATCH(sti, movl $X86_EFLAGS_IF, lguest_data+LGUEST_DATA_irq_enabled)
30LGUEST_PATCH(popf, movl %eax, lguest_data+LGUEST_DATA_irq_enabled)
31LGUEST_PATCH(pushf, movl lguest_data+LGUEST_DATA_irq_enabled, %eax)
32
33.text
34/* These demark the EIP range where host should never deliver interrupts. */
35.global lguest_noirq_start
36.global lguest_noirq_end
37
38/*
39 * We move eflags word to lguest_data.irq_enabled to restore interrupt state.
40 * For page faults, gpfs and virtual interrupts, the hypervisor has saved
41 * eflags manually, otherwise it was delivered directly and so eflags reflects
42 * the real machine IF state, ie. interrupts on. Since the kernel always dies
43 * if it takes such a trap with interrupts disabled anyway, turning interrupts
44 * back on unconditionally here is OK.
45 */
46ENTRY(lguest_iret)
47 pushl %eax
48 movl 12(%esp), %eax
49lguest_noirq_start:
50 movl %eax,%ss:lguest_data+LGUEST_DATA_irq_enabled
51 popl %eax
52 iret
53lguest_noirq_end:
diff --git a/drivers/lguest/lguest_bus.c b/drivers/lguest/lguest_bus.c
new file mode 100644
index 000000000000..18d6ab21a43b
--- /dev/null
+++ b/drivers/lguest/lguest_bus.c
@@ -0,0 +1,148 @@
1#include <linux/init.h>
2#include <linux/bootmem.h>
3#include <linux/lguest_bus.h>
4#include <asm/io.h>
5
6static ssize_t type_show(struct device *_dev,
7 struct device_attribute *attr, char *buf)
8{
9 struct lguest_device *dev = container_of(_dev,struct lguest_device,dev);
10 return sprintf(buf, "%hu", lguest_devices[dev->index].type);
11}
12static ssize_t features_show(struct device *_dev,
13 struct device_attribute *attr, char *buf)
14{
15 struct lguest_device *dev = container_of(_dev,struct lguest_device,dev);
16 return sprintf(buf, "%hx", lguest_devices[dev->index].features);
17}
18static ssize_t pfn_show(struct device *_dev,
19 struct device_attribute *attr, char *buf)
20{
21 struct lguest_device *dev = container_of(_dev,struct lguest_device,dev);
22 return sprintf(buf, "%u", lguest_devices[dev->index].pfn);
23}
24static ssize_t status_show(struct device *_dev,
25 struct device_attribute *attr, char *buf)
26{
27 struct lguest_device *dev = container_of(_dev,struct lguest_device,dev);
28 return sprintf(buf, "%hx", lguest_devices[dev->index].status);
29}
30static ssize_t status_store(struct device *_dev, struct device_attribute *attr,
31 const char *buf, size_t count)
32{
33 struct lguest_device *dev = container_of(_dev,struct lguest_device,dev);
34 if (sscanf(buf, "%hi", &lguest_devices[dev->index].status) != 1)
35 return -EINVAL;
36 return count;
37}
38static struct device_attribute lguest_dev_attrs[] = {
39 __ATTR_RO(type),
40 __ATTR_RO(features),
41 __ATTR_RO(pfn),
42 __ATTR(status, 0644, status_show, status_store),
43 __ATTR_NULL
44};
45
46static int lguest_dev_match(struct device *_dev, struct device_driver *_drv)
47{
48 struct lguest_device *dev = container_of(_dev,struct lguest_device,dev);
49 struct lguest_driver *drv = container_of(_drv,struct lguest_driver,drv);
50
51 return (drv->device_type == lguest_devices[dev->index].type);
52}
53
54struct lguest_bus {
55 struct bus_type bus;
56 struct device dev;
57};
58
59static struct lguest_bus lguest_bus = {
60 .bus = {
61 .name = "lguest",
62 .match = lguest_dev_match,
63 .dev_attrs = lguest_dev_attrs,
64 },
65 .dev = {
66 .parent = NULL,
67 .bus_id = "lguest",
68 }
69};
70
71static int lguest_dev_probe(struct device *_dev)
72{
73 int ret;
74 struct lguest_device *dev = container_of(_dev,struct lguest_device,dev);
75 struct lguest_driver *drv = container_of(dev->dev.driver,
76 struct lguest_driver, drv);
77
78 lguest_devices[dev->index].status |= LGUEST_DEVICE_S_DRIVER;
79 ret = drv->probe(dev);
80 if (ret == 0)
81 lguest_devices[dev->index].status |= LGUEST_DEVICE_S_DRIVER_OK;
82 return ret;
83}
84
85int register_lguest_driver(struct lguest_driver *drv)
86{
87 if (!lguest_devices)
88 return 0;
89
90 drv->drv.bus = &lguest_bus.bus;
91 drv->drv.name = drv->name;
92 drv->drv.owner = drv->owner;
93 drv->drv.probe = lguest_dev_probe;
94
95 return driver_register(&drv->drv);
96}
97EXPORT_SYMBOL_GPL(register_lguest_driver);
98
99static void add_lguest_device(unsigned int index)
100{
101 struct lguest_device *new;
102
103 lguest_devices[index].status |= LGUEST_DEVICE_S_ACKNOWLEDGE;
104 new = kmalloc(sizeof(struct lguest_device), GFP_KERNEL);
105 if (!new) {
106 printk(KERN_EMERG "Cannot allocate lguest device %u\n", index);
107 lguest_devices[index].status |= LGUEST_DEVICE_S_FAILED;
108 return;
109 }
110
111 new->index = index;
112 new->private = NULL;
113 memset(&new->dev, 0, sizeof(new->dev));
114 new->dev.parent = &lguest_bus.dev;
115 new->dev.bus = &lguest_bus.bus;
116 sprintf(new->dev.bus_id, "%u", index);
117 if (device_register(&new->dev) != 0) {
118 printk(KERN_EMERG "Cannot register lguest device %u\n", index);
119 lguest_devices[index].status |= LGUEST_DEVICE_S_FAILED;
120 kfree(new);
121 }
122}
123
124static void scan_devices(void)
125{
126 unsigned int i;
127
128 for (i = 0; i < LGUEST_MAX_DEVICES; i++)
129 if (lguest_devices[i].type)
130 add_lguest_device(i);
131}
132
133static int __init lguest_bus_init(void)
134{
135 if (strcmp(paravirt_ops.name, "lguest") != 0)
136 return 0;
137
138 /* Devices are in page above top of "normal" mem. */
139 lguest_devices = lguest_map(max_pfn<<PAGE_SHIFT, 1);
140
141 if (bus_register(&lguest_bus.bus) != 0
142 || device_register(&lguest_bus.dev) != 0)
143 panic("lguest bus registration failed");
144
145 scan_devices();
146 return 0;
147}
148postcore_initcall(lguest_bus_init);