1 #include <geekos/vmm_stubs.h>
2 #include <geekos/serial.h>
3 #include <palacios/vm_guest.h>
4 #include <geekos/debug.h>
8 static inline void VM_Out_Byte(ushort_t port, uchar_t value)
10 __asm__ __volatile__ (
13 : "a" (value), "Nd" (port)
18 * Read a byte from an I/O port.
20 static inline uchar_t VM_In_Byte(ushort_t port)
24 __asm__ __volatile__ (
36 void * Identity(void *addr) { return addr; };
38 void * Allocate_VMM_Pages(int num_pages) {
39 void * start_page = Alloc_Page();
40 //SerialPrint("Starting by Allocating Page: %x (%d of %d)\n",start_page, 1, num_pages);
43 while (i < num_pages) {
44 void * tmp_page = Alloc_Page();
45 //SerialPrint("Allocating Page: %x (%d of %d)\n",tmp_page, i+1, num_pages);
47 if (tmp_page != start_page + (PAGE_SIZE * i)) {
48 //we have to start over...;
50 Free_Page(start_page + (PAGE_SIZE * i));
53 start_page = Alloc_Page();
54 //SerialPrint("Starting over by Allocating Page: %x (%d of %d)\n",start_page, 1, num_pages);
64 void Free_VMM_Page(void * page) {
69 void * VMM_Malloc(unsigned int size) {
70 return Malloc((unsigned long) size);
74 void VMM_Free(void * addr) {
80 struct guest_info * irq_map[256];
82 static void pic_intr_handler(struct Interrupt_State * state) {
84 struct guest_info * info = irq_map[state->intNum - 32];
85 SerialPrint("Interrupt %d (IRQ=%d)\n", state->intNum, state->intNum - 32);
88 info->vm_ops.raise_irq(info, state->intNum - 32);
90 SerialPrint("Interrupt handler error: NULL pointer found, no action taken\n");
99 int hook_irq_stub(struct guest_info * info, int irq) {
104 SerialPrint("Hooking IRQ: %d (vm=0x%x)\n", irq, info);
106 volatile void *foo = pic_intr_handler;
109 Install_IRQ(irq, pic_intr_handler);
115 int ack_irq(int irq) {
122 memset(irq_map, 0, sizeof(struct guest_info *) * 256);
126 unsigned int get_cpu_khz() {
127 extern uint_t cpu_khz_freq;
129 unsigned long print_khz = (unsigned long)(cpu_khz_freq & 0xffffffff);
131 PrintBoth("Detected %lu.%lu MHz CPU\n", print_khz / 1000, print_khz % 1000);
142 /* ------ Calibrate the TSC -------
143 * Return processor ticks per second / CALIBRATE_FRAC.
147 #define PIT_MODE 0x43
149 #define CLOCK_TICK_RATE 1193180 /* system crystal frequency (Hz) */
150 #define CALIBRATE_FRAC 20 /* calibrate over 50ms */
151 #define CALIBRATE_LATCH ((CLOCK_TICK_RATE+(CALIBRATE_FRAC/2))/CALIBRATE_FRAC)
154 unsigned long long get_cpu_khz() {
157 unsigned long long tmp;
158 unsigned long print_tmp;
160 /* Set the Gate high, disable speaker */
161 VM_Out_Byte((VM_In_Byte(0x61) & ~0x02) | 0x01, 0x61);
164 * Now let's take care of CTC channel 2
166 * Set the Gate high, program CTC channel 2 for mode 0, (interrupt on
167 * terminal count mode), binary count, load 5 * LATCH count, (LSB and MSB)
168 * to begin countdown.
170 VM_Out_Byte(0xb0, PIT_MODE); /* binary, mode 0, LSB/MSB, Ch 2 */
171 VM_Out_Byte(CALIBRATE_LATCH & 0xff, PIT_CH2); /* LSB of count */
172 VM_Out_Byte(CALIBRATE_LATCH >> 8, PIT_CH2); /* MSB of count */
175 for ( count = 0; (VM_In_Byte(0x61) & 0x20) == 0; count++ )
179 /* Error if the CTC doesn't behave itself. */
181 PrintBoth("CPU Frequency Calibration Error\n");
185 tmp = ((end - start) * (ullong_t)CALIBRATE_FRAC);
190 print_tmp = (unsigned long)tmp;
192 PrintBoth("Detected %lu.%lu MHz CPU\n", print_tmp / 1000, print_tmp % 1000);
198 #undef CLOCK_TICK_RATE
199 #undef CALIBRATE_FRAC
200 #undef CALIBRATE_LATCH