169901971e16092ff2f8fdd91de197b73380e6b5
[akaros.git] / tests / vmm / vmrunkernel.c
1 #include <stdio.h>
2 #include <pthread.h>
3 #include <sys/types.h>
4 #include <sys/stat.h>
5 #include <fcntl.h>
6 #include <parlib/arch/arch.h>
7 #include <parlib/ros_debug.h>
8 #include <unistd.h>
9 #include <gelf.h>
10 #include <errno.h>
11 #include <libelf.h>
12 #include <dirent.h>
13 #include <stdlib.h>
14 #include <string.h>
15 #include <ros/syscall.h>
16 #include <sys/mman.h>
17 #include <vmm/coreboot_tables.h>
18 #include <vmm/vmm.h>
19 #include <vmm/acpi/acpi.h>
20 #include <vmm/acpi/vmm_simple_dsdt.h>
21 #include <ros/arch/mmu.h>
22 #include <ros/arch/membar.h>
23 #include <ros/vmm.h>
24 #include <parlib/uthread.h>
25 #include <vmm/linux_bootparam.h>
26 #include <getopt.h>
27
28 #include <vmm/virtio.h>
29 #include <vmm/virtio_blk.h>
30 #include <vmm/virtio_mmio.h>
31 #include <vmm/virtio_ids.h>
32 #include <vmm/virtio_config.h>
33 #include <vmm/virtio_console.h>
34 #include <vmm/virtio_net.h>
35 #include <vmm/virtio_lguest_console.h>
36
37 #include <vmm/sched.h>
38 #include <sys/eventfd.h>
39 #include <sys/uio.h>
40
41 struct virtual_machine local_vm, *vm = &local_vm;
42
43 struct vmm_gpcore_init gpci;
44
45 /* By 1999, you could just scan the hardware
46  * and work it out. But 2005, that was no longer possible. How sad.
47  * so we have to fake acpi to make it all work.
48  * This will be copied to memory at 0xe0000, so the kernel can find it.
49  */
50
51 /* assume they're all 256 bytes long just to make it easy.
52  * Just have pointers that point to aligned things.
53  */
54
55 struct acpi_table_rsdp rsdp = {
56         .signature = ACPI_SIG_RSDP,
57         .oem_id = "AKAROS",
58         .revision = 2,
59         .length = 36,
60 };
61
62 struct acpi_table_xsdt xsdt = {
63         .header = {
64                 .signature = ACPI_SIG_DSDT,
65                 .revision = 2,
66                 .oem_id = "AKAROS",
67                 .oem_table_id = "ALPHABET",
68                 .oem_revision = 0,
69                 .asl_compiler_id = "RON ",
70                 .asl_compiler_revision = 0,
71         },
72 };
73 struct acpi_table_fadt fadt = {
74         .header = {
75                 .signature = ACPI_SIG_FADT,
76                 .revision = 2,
77                 .oem_id = "AKAROS",
78                 .oem_table_id = "ALPHABET",
79                 .oem_revision = 0,
80                 .asl_compiler_id = "RON ",
81                 .asl_compiler_revision = 0,
82         },
83 };
84
85
86 /* This has to be dropped into memory, then the other crap just follows it.
87  */
88 struct acpi_table_madt madt = {
89         .header = {
90                 .signature = ACPI_SIG_MADT,
91                 .revision = 2,
92                 .oem_id = "AKAROS",
93                 .oem_table_id = "ALPHABET",
94                 .oem_revision = 0,
95                 .asl_compiler_id = "RON ",
96                 .asl_compiler_revision = 0,
97         },
98
99         .address = 0xfee00000ULL,
100         .flags = 0,
101 };
102
103 struct acpi_madt_local_apic Apic0 = {.header = {.type = ACPI_MADT_TYPE_LOCAL_APIC, .length = sizeof(struct acpi_madt_local_apic)},
104                                      .processor_id = 0, .id = 0, .lapic_flags = 1};
105 struct acpi_madt_io_apic Apic1 = {.header = {.type = ACPI_MADT_TYPE_IO_APIC, .length = sizeof(struct acpi_madt_io_apic)},
106                                   .id = 0, .address = 0xfec00000, .global_irq_base = 0};
107 struct acpi_madt_local_x2apic X2Apic0 = {
108         .header = {
109                 .type = ACPI_MADT_TYPE_LOCAL_X2APIC,
110                 .length = sizeof(struct acpi_madt_local_x2apic)
111         },
112         .local_apic_id = 0,
113         .uid = 0
114 };
115
116 struct acpi_madt_interrupt_override isor[] = {
117         /* From the ACPI Specification Version 6.1:
118          * For example, if your machine has the ISA Programmable Interrupt Timer
119          * (PIT) connected to ISA IRQ 0, but in APIC mode, it is connected to I/O
120          * APIC interrupt input 2, then you would need an Interrupt Source Override
121          * where the source entry is ‘0’ and the Global System Interrupt is ‘2.’
122          */
123 };
124
125
126 /* this test will run the "kernel" in the negative address space. We hope. */
127 void *low1m;
128 volatile int shared = 0;
129 volatile int quit = 0;
130
131 /* total hack. If the vm runs away we want to get control again. */
132 unsigned int maxresume = (unsigned int) -1;
133
134 #define MiB 0x100000ull
135 #define GiB (1ull << 30)
136 #define GKERNBASE (16*MiB)
137 #define KERNSIZE (1024 * MiB + GKERNBASE)
138 uint8_t _kernel[KERNSIZE];
139
140 unsigned long long *p512, *p1, *p2m;
141
142 void **my_retvals;
143 int nr_threads = 4;
144 int debug = 0;
145 int resumeprompt = 0;
146 /* unlike Linux, this shared struct is for both host and guest. */
147 //      struct virtqueue *constoguest =
148 //              vring_new_virtqueue(0, 512, 8192, 0, inpages, NULL, NULL, "test");
149
150 void vapic_status_dump(FILE *f, void *vapic);
151
152 #if __GNUC__ < 4 || (__GNUC__ == 4 && __GNUC_MINOR__ < 1)
153 #error "Get a gcc newer than 4.4.0"
154 #else
155 #define BITOP_ADDR(x) "+m" (*(volatile long *) (x))
156 #endif
157
158 #define LOCK_PREFIX "lock "
159 #define ADDR                            BITOP_ADDR(addr)
160 static inline int test_and_set_bit(int nr, volatile unsigned long *addr);
161 static int default_nic = 1;
162
163 pthread_t timerthread_struct;
164
165 void timer_thread(void *arg)
166 {
167         uint8_t vector;
168         uint32_t initial_count;
169         while (1) {
170                 vector = ((uint32_t *)gpci.vapic_addr)[0x32] & 0xff;
171                 initial_count = ((uint32_t *)gpci.vapic_addr)[0x38];
172                 if (vector && initial_count)
173                         vmm_interrupt_guest(vm, 0, vector);
174                 uthread_usleep(100000);
175         }
176         fprintf(stderr, "SENDING TIMER\n");
177 }
178
179
180 // FIXME.
181 volatile int consdata = 0;
182
183 /* TODO: pass a core id to poke_guest */
184 static void virtio_poke_guest(uint8_t vec)
185 {
186         vmm_interrupt_guest(vm, 0, vec);
187 }
188
189 static struct virtio_mmio_dev cons_mmio_dev = {
190         .poke_guest = virtio_poke_guest,
191 };
192
193 static struct virtio_console_config cons_cfg;
194 static struct virtio_console_config cons_cfg_d;
195
196 static struct virtio_vq_dev cons_vqdev = {
197         .name = "console",
198         .dev_id = VIRTIO_ID_CONSOLE,
199         .dev_feat =
200             (1ULL << VIRTIO_F_VERSION_1) | (1 << VIRTIO_RING_F_INDIRECT_DESC),
201         .num_vqs = 2,
202         .cfg = &cons_cfg,
203         .cfg_d = &cons_cfg_d,
204         .cfg_sz = sizeof(struct virtio_console_config),
205         .transport_dev = &cons_mmio_dev,
206         .vqs = {
207                         {
208                                 .name = "cons_receiveq",
209                                 .qnum_max = 64,
210                                 .srv_fn = cons_receiveq_fn,
211                                 .vqdev = &cons_vqdev
212                         },
213                         {
214                                 .name = "cons_transmitq",
215                                 .qnum_max = 64,
216                                 .srv_fn = cons_transmitq_fn,
217                                 .vqdev = &cons_vqdev
218                         },
219                 }
220 };
221
222 static struct virtio_mmio_dev net_mmio_dev = {
223         .poke_guest = virtio_poke_guest,
224 };
225
226 static struct virtio_net_config net_cfg = {
227         .max_virtqueue_pairs = 1
228 };
229 static struct virtio_net_config net_cfg_d = {
230         .max_virtqueue_pairs = 1
231 };
232
233 static struct virtio_vq_dev net_vqdev = {
234         .name = "network",
235         .dev_id = VIRTIO_ID_NET,
236         .dev_feat = (1ULL << VIRTIO_F_VERSION_1 | 1 << VIRTIO_NET_F_MAC),
237
238         .num_vqs = 2,
239         .cfg = &net_cfg,
240         .cfg_d = &net_cfg_d,
241         .cfg_sz = sizeof(struct virtio_net_config),
242         .transport_dev = &net_mmio_dev,
243         .vqs = {
244                 {
245                         .name = "net_receiveq",
246                         .qnum_max = 64,
247                         .srv_fn = net_receiveq_fn,
248                         .vqdev = &net_vqdev
249                 },
250                 {
251                         .name = "net_transmitq",
252                         .qnum_max = 64,
253                         .srv_fn = net_transmitq_fn,
254                         .vqdev = &net_vqdev
255                 },
256         }
257 };
258
259 static struct virtio_mmio_dev blk_mmio_dev = {
260         .poke_guest = virtio_poke_guest,
261 };
262
263 static struct virtio_blk_config blk_cfg = {
264 };
265
266 static struct virtio_blk_config blk_cfg_d = {
267 };
268
269 static struct virtio_vq_dev blk_vqdev = {
270         .name = "block",
271         .dev_id = VIRTIO_ID_BLOCK,
272         .dev_feat = (1ULL << VIRTIO_F_VERSION_1),
273
274         .num_vqs = 1,
275         .cfg = &blk_cfg,
276         .cfg_d = &blk_cfg_d,
277         .cfg_sz = sizeof(struct virtio_blk_config),
278         .transport_dev = &blk_mmio_dev,
279         .vqs = {
280                 {
281                         .name = "blk_request",
282                         .qnum_max = 64,
283                         .srv_fn = blk_request,
284                         .vqdev = &blk_vqdev
285                 },
286         }
287 };
288
289 void lowmem() {
290         __asm__ __volatile__ (".section .lowmem, \"aw\"\n\tlow: \n\t.=0x1000\n\t.align 0x100000\n\t.previous\n");
291 }
292
293 static uint8_t acpi_tb_checksum(uint8_t *buffer, uint32_t length)
294 {
295         uint8_t sum = 0;
296         uint8_t *end = buffer + length;
297         fprintf(stderr, "tbchecksum %p for %d", buffer, length);
298         while (buffer < end) {
299                 if (end - buffer < 2)
300                         fprintf(stderr, "%02x\n", sum);
301                 sum = (uint8_t)(sum + *(buffer++));
302         }
303         fprintf(stderr, " is %02x\n", sum);
304         return (sum);
305 }
306
307 static void gencsum(uint8_t *target, void *data, int len)
308 {
309         uint8_t csum;
310         // blast target to zero so it does not get counted
311         // (it might be in the struct we checksum) And, yes, it is, goodness.
312         fprintf(stderr, "gencsum %p target %p source %d bytes\n", target, data, len);
313         *target = 0;
314         csum  = acpi_tb_checksum((uint8_t *)data, len);
315         *target = ~csum + 1;
316         fprintf(stderr, "Cmoputed is %02x\n", *target);
317 }
318
319 static inline int test_and_set_bit(int nr, volatile unsigned long *addr)
320 {
321         int oldbit;
322
323         asm volatile(LOCK_PREFIX "bts %2,%1\n\t"
324                      "sbb %0,%0" : "=r" (oldbit), ADDR : "Ir" (nr) : "memory");
325
326         return oldbit;
327 }
328
329 /* load_kernel loads an ELF file as a kernel. */
330 uintptr_t
331 load_kernel(char *filename, uintptr_t *kernstart, uintptr_t *kernend)
332 {
333         Elf64_Ehdr *ehdr;
334         Elf *elf;
335         size_t phnum = 0;
336         Elf64_Phdr *hdrs;
337         int fd;
338
339         elf_version(EV_CURRENT);
340         fd = open(filename, O_RDONLY);
341         if (fd < 0) {
342                 fprintf(stderr, "Can't open %s: %r\n", filename);
343                 return 0;
344         }
345
346         elf = elf_begin(fd, ELF_C_READ, NULL);
347         if (elf == NULL) {
348                 fprintf(stderr, "%s: cannot read %s ELF file.\n", __func__, filename);
349                 close(fd);
350                 return 0;
351         }
352
353         ehdr = elf64_getehdr(elf);
354         if (ehdr == NULL) {
355                 fprintf(stderr, "%s: cannot get exec header of %s.\n",
356                         __func__, filename);
357                 goto fail;
358         }
359         fprintf(stderr, "%s ELF entry point is %p\n", filename, ehdr->e_entry);
360
361         if (elf_getphdrnum(elf, &phnum) < 0) {
362                 fprintf(stderr, "%s: cannot get program header num of %s.\n",
363                         __func__, filename);
364                 goto fail;
365         }
366         fprintf(stderr, "%s has %d program headers\n", filename, phnum);
367
368         hdrs = elf64_getphdr(elf);
369         if (hdrs == NULL) {
370                 fprintf(stderr, "%s: cannot get program headers of %s.\n",
371                         __func__, filename);
372                 goto fail;
373         }
374
375         for (int i = 0; i < phnum; i++) {
376                 size_t tot;
377                 Elf64_Phdr *h = &hdrs[i];
378                 uintptr_t pa;
379
380                 fprintf(stderr,
381                         "%d: type 0x%lx flags 0x%lx  offset 0x%lx vaddr 0x%lx paddr 0x%lx size 0x%lx  memsz 0x%lx align 0x%lx\n",
382                         i,
383                         h->p_type,              /* Segment type */
384                         h->p_flags,             /* Segment flags */
385                         h->p_offset,            /* Segment file offset */
386                         h->p_vaddr,             /* Segment virtual address */
387                         h->p_paddr,             /* Segment physical address */
388                         h->p_filesz,            /* Segment size in file */
389                         h->p_memsz,             /* Segment size in memory */
390                         h->p_align              /* Segment alignment */);
391                 if (h->p_type != PT_LOAD)
392                         continue;
393                 if ((h->p_flags & (PF_R | PF_W | PF_X)) == 0)
394                         continue;
395
396                 /* we do the memset purely to ensure everything gets paged in. */
397                 /* compute the offset from the desired address. */
398                 /* this ONLY works now if kernaddr > h->p_paddr */
399                 pa = h->p_paddr;
400                 memset((void *)pa, 0, h->p_memsz);
401                 if (*kernstart > pa)
402                         *kernstart = pa;
403                 if (*kernend < pa + h->p_memsz)
404                         *kernend = pa + h->p_memsz;
405                 fprintf(stderr,
406                         "Read header %d @offset %p to %p (elf PA is %p) %d bytes:",
407                         i, h->p_offset, pa, h->p_paddr, h->p_filesz);
408                 tot = 0;
409                 while (tot < h->p_filesz) {
410                         int amt = pread(fd, (void *)(pa + tot), h->p_filesz - tot,
411                                         h->p_offset + tot);
412                         if (amt < 1)
413                                 break;
414                         tot += amt;
415                 }
416                 fprintf(stderr, "read a total of %d bytes\n", tot);
417                 if (tot < h->p_filesz) {
418                         fprintf(stderr, "%s: got %d bytes, wanted %d bytes\n",
419                                 filename, tot, h->p_filesz);
420                         goto fail;
421                 }
422         }
423
424         close(fd);
425         elf_end(elf);
426         return ehdr->e_entry;
427  fail:
428         close(fd);
429         elf_end(elf);
430         return 0;
431 }
432
433 int main(int argc, char **argv)
434 {
435         struct boot_params *bp;
436         char cmdline_default[512] = {0};
437         char *cmdline_extra = "\0";
438         char *cmdline;
439         uint64_t *p64;
440         void *a = (void *)0xe0000;
441         struct acpi_table_rsdp *r;
442         struct acpi_table_fadt *f;
443         struct acpi_table_madt *m;
444         struct acpi_table_xsdt *x;
445         int amt;
446         int vmmflags = 0; // Disabled probably forever. VMM_VMCALL_PRINTF;
447         uint64_t entry = 0;
448         int ret;
449         uintptr_t size;
450         void * xp;
451         int kfd = -1;
452         static char cmd[512];
453         int i;
454         uint8_t csum;
455         void *coreboot_tables = (void *) 0x1165000;
456         void *a_page;
457         struct vm_trapframe *vm_tf;
458         uint64_t tsc_freq_khz;
459         char *cmdlinep;
460         int cmdlinesz, len, cmdline_fd;
461         char *disk_image_file = NULL;
462         int c;
463         struct stat stat_result;
464         int num_read;
465         int option_index;
466         uintptr_t kernstart = (uintptr_t)~1, kernend = 0;
467         static struct option long_options[] = {
468                 {"debug",         no_argument,       0, 'd'},
469                 {"vmm_vmcall",    no_argument,       0, 'v'},
470                 {"maxresume",     required_argument, 0, 'm'},
471                 {"cmdline_extra", required_argument, 0, 'c'},
472                 {"greedy",        no_argument,       0, 'g'},
473                 {"scp",           no_argument,       0, 's'},
474                 {"image_file",    required_argument, 0, 'f'},
475                 {"cmdline",       required_argument, 0, 'k'},
476                 {"nic",           required_argument, 0, 'n'},
477                 {"help",          no_argument,       0, 'h'},
478                 {0, 0, 0, 0}
479         };
480
481         fprintf(stderr, "%p %p %p %p\n", PGSIZE, PGSHIFT, PML1_SHIFT,
482                         PML1_PTE_REACH);
483
484
485         // mmap is not working for us at present.
486         if ((uint64_t)_kernel > GKERNBASE) {
487                 fprintf(stderr, "kernel array @%p is above , GKERNBASE@%p sucks\n", _kernel, GKERNBASE);
488                 exit(1);
489         }
490         memset(_kernel, 0, sizeof(_kernel));
491         vm->low4k = malloc(PGSIZE);
492         memset(vm->low4k, 0xff, PGSIZE);
493         vm->low4k[0x40e] = 0;
494         vm->low4k[0x40f] = 0;
495
496         //Place mmap(Gan)
497         a_page = mmap((void *)0xfee00000, PGSIZE, PROT_READ | PROT_WRITE,
498                               MAP_POPULATE | MAP_ANONYMOUS, -1, 0);
499         fprintf(stderr, "a_page mmap pointer %p\n", a_page);
500
501         if (a_page == (void *) -1) {
502                 perror("Could not mmap APIC");
503                 exit(1);
504         }
505         if (((uint64_t)a_page & 0xfff) != 0) {
506                 perror("APIC page mapping is not page aligned");
507                 exit(1);
508         }
509
510         memset(a_page, 0, 4096);
511         ((uint32_t *)a_page)[0x30/4] = 0x01060015;
512         //((uint32_t *)a_page)[0x30/4] = 0xDEADBEEF;
513
514         while ((c = getopt_long(argc, argv, "dvm:c:gsf:k:n:h", long_options,
515                                 &option_index)) != -1) {
516                 switch (c) {
517                         case 'd':
518                                 debug++;
519                                 break;
520                         case 'v':
521                                 vmmflags |= VMM_VMCALL_PRINTF;
522                                 break;
523                         case 'm':
524                                 maxresume = strtoull(optarg, 0, 0);
525                                 break;
526                         case 'c':
527                                 cmdline_extra = optarg;
528                         case 'g':       /* greedy */
529                                 parlib_never_yield = TRUE;
530                                 break;
531                         case 's':       /* scp */
532                                 parlib_wants_to_be_mcp = FALSE;
533                                 break;
534                         case 'f':       /* file to pass to blk_init */
535                                 disk_image_file = optarg;
536                                 break;
537                         case 'k':       /* specify file to get cmdline args from */
538                                 cmdline_fd = open(optarg, O_RDONLY);
539                                 if (cmdline_fd < 0) {
540                                         fprintf(stderr, "failed to open file: %s\n", optarg);
541                                         exit(1);
542                                 }
543                                 if (stat(optarg, &stat_result) == -1) {
544                                         fprintf(stderr, "stat of %s failed\n", optarg);
545                                         exit(1);
546                                 }
547                                 len = stat_result.st_size;
548                                 if (len > 512) {
549                                         fprintf(stderr, "command line options exceed 512 bytes!");
550                                         exit(1);
551                                 }
552                                 num_read = read(cmdline_fd, cmdline_default, len);
553                                 if (num_read != len) {
554                                         fprintf(stderr, "read failed len was : %d, num_read was: %d\n",
555                                                 len, num_read);
556                                         exit(1);
557                                 }
558                                 close(cmdline_fd);
559                                 break;
560                         case 'n':
561                                 default_nic = strtoull(optarg, 0, 0);
562                                 break;
563                         case 'h':
564                         default:
565                                 fprintf(stderr, "-d or --debug              : enable debugging\n"
566                                                 "-v or --vmm_vmcall         : enable vmm_vmcall_printf\n"
567                                                 "-m or --maxresume arg0     : maxresume = arg0\n"
568                                                 "-c or --cmdline_extra arg0 : cmdline += arg0\n"
569                                                 "-g or --greedy             : run in greedy mode\n"
570                                                 "-s or --scp                : run as a scp\n"
571                                                 "-f or --image_file arg0    : pass arg0 to virtio-blk init\n"
572                                                 "-k or --cmdline arg0       : grab command line options from the file arg0\n"
573                                                 "-n or --nic arg0           : specify nic\n"
574                                                 "-h or --help               : show help info\n");
575                                 exit(0);
576                 }
577         }
578         if (strlen(cmdline_default) == 0) {
579                 fprintf(stderr, "No command line parameter file specified.\n");
580                 exit(1);
581         }
582         argc -= optind;
583         argv += optind;
584         if (argc < 1) {
585                 fprintf(stderr, "Usage: %s vmimage [-n (no vmcall printf)] [coreboot_tables [loadaddress [entrypoint]]]\n", argv[0]);
586                 exit(1);
587         }
588
589         if (argc > 1)
590                 coreboot_tables = (void *) strtoull(argv[1], 0, 0);
591
592         entry = load_kernel(argv[0], &kernstart, &kernend);
593         if (entry == 0) {
594                 fprintf(stderr, "Unable to load kernel %s\n", argv[0]);
595                 exit(1);
596         }
597
598
599         // The low 1m so we can fill in bullshit like ACPI. */
600         // And, sorry, due to the STUPID format of the RSDP for now we need the low 1M.
601         low1m = mmap((int*)4096, MiB-4096, PROT_READ | PROT_WRITE,
602                          MAP_ANONYMOUS, -1, 0);
603         if (low1m != (void *)4096) {
604                 perror("Unable to mmap low 1m");
605                 exit(1);
606         }
607         memset(low1m, 0xff, MiB-4096);
608         r = a;
609         fprintf(stderr, "install rsdp to %p\n", r);
610         *r = rsdp;
611         a += sizeof(*r);
612         r->xsdt_physical_address = (uint64_t)a;
613         gencsum(&r->checksum, r, ACPI_RSDP_CHECKSUM_LENGTH);
614         if ((csum = acpi_tb_checksum((uint8_t *) r, ACPI_RSDP_CHECKSUM_LENGTH)) != 0) {
615                 fprintf(stderr, "RSDP has bad checksum; summed to %x\n", csum);
616                 exit(1);
617         }
618
619         /* Check extended checksum if table version >= 2 */
620         gencsum(&r->extended_checksum, r, ACPI_RSDP_XCHECKSUM_LENGTH);
621         if ((rsdp.revision >= 2) &&
622             (acpi_tb_checksum((uint8_t *) r, ACPI_RSDP_XCHECKSUM_LENGTH) != 0)) {
623                 fprintf(stderr, "RSDP has bad checksum v2\n");
624                 exit(1);
625         }
626
627         /* just leave a bunch of space for the xsdt. */
628         /* we need to zero the area since it has pointers. */
629         x = a;
630         a += sizeof(*x) + 8*sizeof(void *);
631         memset(x, 0, a - (void *)x);
632         fprintf(stderr, "install xsdt to %p\n", x);
633         *x = xsdt;
634         x->table_offset_entry[0] = 0;
635         x->table_offset_entry[1] = 0;
636         x->header.length = a - (void *)x;
637
638         f = a;
639         fprintf(stderr, "install fadt to %p\n", f);
640         *f = fadt;
641         x->table_offset_entry[0] = (uint64_t)f; // fadt MUST be first in xsdt!
642         a += sizeof(*f);
643         f->header.length = a - (void *)f;
644
645         f->Xdsdt = (uint64_t) a;
646         fprintf(stderr, "install dsdt to %p\n", a);
647         memcpy(a, &DSDT_DSDTTBL_Header, 36);
648         a += 36;
649
650         gencsum(&f->header.checksum, f, f->header.length);
651         if (acpi_tb_checksum((uint8_t *)f, f->header.length) != 0) {
652                 fprintf(stderr, "fadt has bad checksum v2\n");
653                 exit(1);
654         }
655
656         m = a;
657         *m = madt;
658         x->table_offset_entry[3] = (uint64_t) m;
659         a += sizeof(*m);
660         fprintf(stderr, "install madt to %p\n", m);
661         memmove(a, &Apic0, sizeof(Apic0));
662         a += sizeof(Apic0);
663         memmove(a, &Apic1, sizeof(Apic1));
664         a += sizeof(Apic1);
665         memmove(a, &X2Apic0, sizeof(X2Apic0));
666         a += sizeof(X2Apic0);
667         memmove(a, &isor, sizeof(isor));
668         a += sizeof(isor);
669         m->header.length = a - (void *)m;
670
671         gencsum(&m->header.checksum, m, m->header.length);
672         if (acpi_tb_checksum((uint8_t *) m, m->header.length) != 0) {
673                 fprintf(stderr, "madt has bad checksum v2\n");
674                 exit(1);
675         }
676
677         gencsum(&x->header.checksum, x, x->header.length);
678         if ((csum = acpi_tb_checksum((uint8_t *) x, x->header.length)) != 0) {
679                 fprintf(stderr, "XSDT has bad checksum; summed to %x\n", csum);
680                 exit(1);
681         }
682
683         fprintf(stderr, "allchecksums ok\n");
684
685         hexdump(stdout, r, a-(void *)r);
686
687         a = (void *)(((unsigned long)a + 0xfff) & ~0xfff);
688         gpci.posted_irq_desc = a;
689         memset(a, 0, 4096);
690         a += 4096;
691         gpci.vapic_addr = a;
692         memset(a, 0, 4096);
693         ((uint32_t *)a)[0x30/4] = 0x01060014;
694         p64 = a;
695         // set up apic values? do we need to?
696         // qemu does this.
697         //((uint8_t *)a)[4] = 1;
698         a += 4096;
699         gpci.apic_addr = (void*)0xfee00000;
700
701         /* Allocate memory for, and zero the bootparams
702          * page before writing to it, or Linux thinks
703          * we're talking crazy.
704          */
705         a += 4096;
706         bp = a;
707         memset(bp, 0, 4096);
708
709         /* Put the e820 memory region information in the boot_params */
710         bp->e820_entries = 5;
711         int e820i = 0;
712
713         /* Give it just a tiny bit of memory -- 60k -- at low memory. */
714         bp->e820_map[e820i].addr = 0;
715         bp->e820_map[e820i].size = 4 * 1024;
716         bp->e820_map[e820i++].type = E820_RESERVED;
717
718         bp->e820_map[e820i].addr = 4 * 1024;
719         bp->e820_map[e820i].size = 64 * 1024 - 4 * 1024;
720         bp->e820_map[e820i++].type = E820_RAM;
721
722         bp->e820_map[e820i].addr = 64 * 1024;
723         bp->e820_map[e820i].size = 16 * 1048576 - 64 * 1024;
724         bp->e820_map[e820i++].type = E820_RESERVED;
725
726         bp->e820_map[e820i].addr = 16 * 1048576;
727         bp->e820_map[e820i].size = 1024 * 1048576;
728         bp->e820_map[e820i++].type = E820_RAM;
729
730         bp->e820_map[e820i].addr = 0xf0000000;
731         bp->e820_map[e820i].size = 0x10000000;
732         bp->e820_map[e820i++].type = E820_RESERVED;
733
734         /* The MMIO address of the console device is really the address of an
735          * unbacked EPT page: accesses to this page will cause a page fault that
736          * traps to the host, which will examine the fault, see it was for the
737          * known MMIO address, and fulfill the MMIO read or write on the guest's
738          * behalf accordingly. We place the virtio space at 512 GB higher than the
739          * guest physical memory to avoid a full page table walk. */
740         uint64_t virtio_mmio_base_addr = ROUNDUP((bp->e820_map[e820i - 1].addr +
741                                                   bp->e820_map[e820i - 1].size),
742                                                  512 * GiB);
743
744         cons_mmio_dev.addr =
745             virtio_mmio_base_addr + PGSIZE * VIRTIO_MMIO_CONSOLE_DEV;
746         cons_mmio_dev.vqdev = &cons_vqdev;
747         vm->virtio_mmio_devices[VIRTIO_MMIO_CONSOLE_DEV] = &cons_mmio_dev;
748
749         net_mmio_dev.addr =
750             virtio_mmio_base_addr + PGSIZE * VIRTIO_MMIO_NETWORK_DEV;
751         net_mmio_dev.vqdev = &net_vqdev;
752         vm->virtio_mmio_devices[VIRTIO_MMIO_NETWORK_DEV] = &net_mmio_dev;
753
754         if (disk_image_file != NULL) {
755                 blk_mmio_dev.addr =
756                     virtio_mmio_base_addr + PGSIZE * VIRTIO_MMIO_BLOCK_DEV;
757                 blk_mmio_dev.vqdev = &blk_vqdev;
758                 vm->virtio_mmio_devices[VIRTIO_MMIO_BLOCK_DEV] = &blk_mmio_dev;
759                 blk_init_fn(&blk_vqdev, disk_image_file);
760         }
761         net_init_fn(&net_vqdev, default_nic);
762
763         /* Set the kernel command line parameters */
764         a += 4096;
765         cmdline = a;
766         a += 4096;
767         bp->hdr.cmd_line_ptr = (uintptr_t) cmdline;
768
769         tsc_freq_khz = get_tsc_freq()/1000;
770         len = snprintf(cmdline, 4096, "%s tscfreq=%lld %s", cmdline_default,
771                        tsc_freq_khz, cmdline_extra);
772
773         cmdlinesz = 4096 - len;
774         cmdlinep = cmdline + len;
775
776         for (int i = 0; i < VIRTIO_MMIO_MAX_NUM_DEV; i++) {
777                 if (vm->virtio_mmio_devices[i] == NULL)
778                         continue;
779
780                 /* Append all the virtio mmio base addresses. */
781
782                         /* Since the lower number irqs are no longer being used, the irqs
783                          * can now be assigned starting from 0.
784                          */
785                         vm->virtio_mmio_devices[i]->irq = i;
786                         len = snprintf(cmdlinep, cmdlinesz,
787                                " virtio_mmio.device=1K@0x%llx:%lld",
788                                vm->virtio_mmio_devices[i]->addr,
789                                vm->virtio_mmio_devices[i]->irq);
790                 if (len >= cmdlinesz) {
791                         fprintf(stderr, "Too many arguments to the linux command line.");
792                         exit(1);
793                 }
794                 cmdlinesz -= len;
795                 cmdlinep += len;
796         }
797
798         vm->nr_gpcs = 1;
799         vm->gpcis = &gpci;
800         ret = vmm_init(vm, vmmflags);
801         assert(!ret);
802
803         /* Allocate 3 pages for page table pages: a page of 512 GiB
804          * PTEs with only one entry filled to point to a page of 1 GiB
805          * PTEs; a page of 1 GiB PTEs with only one entry filled to
806          * point to a page of 2 MiB PTEs; and a page of 2 MiB PTEs,
807          * only a subset of which will be filled. */
808         ret = posix_memalign((void **)&p512, PGSIZE, 3 * PGSIZE);
809         if (ret) {
810                 perror("ptp alloc");
811                 exit(1);
812         }
813
814         /* Set up a 1:1 ("identity") page mapping from guest virtual
815          * to guest physical using the (host virtual)
816          * `kerneladdress`. This mapping is used for only a short
817          * time, until the guest sets up its own page tables. Be aware
818          * that the values stored in the table are physical addresses.
819          * This is subtle and mistakes are easily disguised due to the
820          * identity mapping, so take care when manipulating these
821          * mappings. */
822         p1 = &p512[NPTENTRIES];
823         p2m = &p512[2 * NPTENTRIES];
824
825         size = kernend - kernstart;
826         fprintf(stderr, "Map %p for %zu bytes\n", kernstart, size);
827         p512[PML4(kernstart)] = (uint64_t)p1 | PTE_KERN_RW;
828         p1[PML3(kernstart)] = (uint64_t)p2m | PTE_KERN_RW;
829         for (uintptr_t i = 0; i < size; i += PML2_PTE_REACH) {
830                 p2m[PML2(kernstart + i)] =
831                         (uint64_t)(kernstart + i) | PTE_KERN_RW | PTE_PS;
832         }
833
834         uint8_t *kernel = (void *)GKERNBASE;
835         //write_coreboot_table(coreboot_tables, ((void *)VIRTIOBASE) /*kernel*/, KERNSIZE + 1048576);
836         hexdump(stdout, coreboot_tables, 512);
837         fprintf(stderr, "p512 %p p512[0] is 0x%lx p1 %p p1[0] is 0x%x\n", p512, p512[0], p1, p1[0]);
838
839         vmm_run_task(vm, timer_thread, 0);
840
841         vm_tf = gth_to_vmtf(vm->gths[0]);
842         vm_tf->tf_cr3 = (uint64_t) p512;
843         vm_tf->tf_rip = entry;
844         vm_tf->tf_rsp = 0;
845         vm_tf->tf_rsi = (uint64_t) bp;
846         start_guest_thread(vm->gths[0]);
847
848         uthread_sleep_forever();
849         return 0;
850 }