aseg-paging/pagingstub.c

   1 #include <io.h>
   2 #include <smram.h>
   3 #include <video_defines.h>
   4 #include <minilib.h>
   5 #include <smi.h>
   6 #include <pci-bother.h>
   7 #include <serial.h>
   8 #include <output.h>
   9 #include "traps.h"
  10 #include "../net/net.h"
  11 #include "vga-overlay.h"
  12
  13 extern void smi_init();
  14 #include "vm_flags.h"
  15
  16 extern void smi_entry();
  17 void set_cr0(unsigned int);
  18 void ps_switch_stack (void (*call)(), int stack);
  19
  20 #define get_cr0() \
  21     ({ \
  22         register unsigned int _temp__; \
  23         asm volatile("mov %%cr0, %0" : "=r" (_temp__)); \
  24         _temp__; \
  25     })
  26
  27
  28 #define set_cr3(value) \
  29     { \
  30         register unsigned int _temp__ = (value); \
  31         asm volatile("mov %0, %%cr3" : : "r" (_temp__)); \
  32      }
  33 #define CR0_PG  0x80000000
  34
  35 #define MAP_FLAGS       (PTE_PRESENT | PTE_READ_WRITE)
  36
  37 static int initialized = 0;
  38 static int paging_enb = 0;
  39 static unsigned long *pd;
  40
  41 extern int _bss, _bssend, _end;
  42
  43 unsigned long v2p(void *virt)
  44 {
  45         unsigned long _virt = (unsigned long)virt;
  46
  47         if (!paging_enb)
  48                 return _virt;
  49
  50         if (_virt >= 0xA0000 && _virt < 0xC0000)
  51                 return _virt;
  52         if (_virt >= 0x200000 && _virt < 0x300000)
  53                 return _virt - 0x200000 + /* XXX */ 0x1FF82000;
  54         outputf("WARNING: v2p(%08x)", _virt);
  55         return 0xFFFFFFFF;
  56 }
  57
  58 void *p2v(unsigned long phys)
  59 {
  60         if (!paging_enb)
  61                 return (void*)phys;
  62
  63         if (phys >= 0xA0000 && phys < 0xC0000)
  64                 return (void*)phys;
  65         if (phys >= 0x1FF80000 && phys < 0x20000000)
  66                 return (void*)(phys - 0x1FF82000 + 0x200000);
  67         outputf("WARNING: p2v(%08x)", phys);
  68         return (void *)0xFFFFFFFF;
  69 }
  70
  71
  72 inline int pt_addmap(unsigned long *pd, unsigned long vaddr, unsigned long paddr)
  73 {
  74         unsigned long pde = ((unsigned long *)p2v((unsigned long)pd))[PDE_FOR(vaddr)];
  75         unsigned long *pt;
  76
  77         if (!(pde & PTE_PRESENT))
  78                 return -1;
  79
  80         pt = (unsigned long *)p2v(ADDR_12_MASK(pde));
  81         pt[PTE_FOR(vaddr)] = paddr | PTE_PRESENT | PTE_READ_WRITE;
  82
  83         return 0;
  84 }
  85
  86 static void * pt_setup(int tseg_start, int tseg_size) {
  87         int i;
  88
  89         /* The page directory and page table live at TSEG and TSEG + 0x1000,
  90          * respectively. */
  91         unsigned long *pagedirectory = (unsigned long *) tseg_start;
  92         unsigned long *pagetable = (unsigned long *) (tseg_start + 0x1000);
  93
  94         /* Clear out the page directory except for one entry pointing to the
  95          * page table, and clear the page table entirely. */
  96         pagedirectory[0] = (tseg_start + 0x1000) | PTE_PRESENT | PTE_READ_WRITE;
  97         for (i = 1; i < 1024; i++)
  98                 pagedirectory[i] = 0;
  99
 100         for (i = 0; i < 1024; i++)
 101                 pagetable[i] = 0;
 102
 103         /* Map 0x0A0000:0x0BFFFF to itself. */
 104         for (i = 0; i < 32; i++)
 105                 pt_addmap(pagedirectory, 0xA0000 + i * 0x1000, 0xA0000 + i * 0x1000);
 106
 107         /* Map 0x200000:0x300000 to TSEG */
 108         for (i = 0; i < 256; i++)
 109                 pt_addmap(pagedirectory, 0x200000 + i * 0x1000, tseg_start + 0x2000 + i * 0x1000);
 110
 111         /* Map 0x300000:0x400000 to 0x200000, so we can copy our code out of
 112          * RAM the first time around */
 113         for (i = 0; i < 256; i++)
 114                 pt_addmap(pagedirectory, 0x300000 + i * 0x1000, 0x200000 + i * 0x1000);
 115
 116         return pagedirectory;
 117 }
 118
 119 void c_entry(void)
 120 {
 121         paging_enb = 0;
 122
 123         outb(0x80, 0x01);
 124         if (!initialized)
 125                 pd = pt_setup(0x1FF80000, 0x80000);
 126         outb(0x80, 0x02);
 127
 128         /* Enable paging. */
 129         set_cr3((unsigned long)pd);
 130         set_cr0(get_cr0() | CR0_PG);
 131         outb(0x80, 0x03);
 132         paging_enb = 1;
 133
 134         /* If this is the first goround, copy in data. */
 135         if (!initialized)
 136         {
 137                 unsigned char *p;
 138
 139                 outb(0x80, 0x04);
 140                 for (p = (void *)0x200000; (void *)p < (void *)&_bss; p++)
 141                         *p = *(p + 0x100000);
 142                 for (p = (void *)&_bss; (void *)p < (void *)&_bssend; p++)
 143                         *p = 0;
 144                 outb(0x80, 0x05);
 145
 146                 /* Only now is it safe to call other functions. */
 147                 serial_init();
 148                 dolog("Evacuation to TSEG complete.");
 149         }
 150
 151         outb(0x80, 0x06);
 152
 153         traps_install();
 154
 155         outb(0x80, 0x07);
 156
 157         if (!initialized)
 158         {
 159                 smi_init();     /* Run the firstrun. */
 160                 outb(0x80, 0x08);
 161
 162                 initialized = 1;
 163         }
 164
 165         outb(0x80, 0x09);
 166         ps_switch_stack(smi_entry, 0x270000);
 167         outb(0x80, 0xFA);
 168 }