415 lines
		
	
	
		
			12 KiB
		
	
	
	
		
			C++
		
	
	
			
		
		
	
	
			415 lines
		
	
	
		
			12 KiB
		
	
	
	
		
			C++
		
	
	
| #include "master.hpp"
 | |
| 
 | |
| namespace factor {
 | |
| 
 | |
| HMODULE hFactorDll;
 | |
| 
 | |
| bool set_memory_locked(cell base, cell size, bool locked) {
 | |
|   int prot = locked ? PAGE_NOACCESS : PAGE_READWRITE;
 | |
|   DWORD ignore;
 | |
|   int status = VirtualProtect((char*)base, size, prot, &ignore);
 | |
|   return status != 0;
 | |
| }
 | |
| 
 | |
| void factor_vm::init_ffi() {
 | |
|   hFactorDll = GetModuleHandle(NULL);
 | |
|   if (!hFactorDll)
 | |
|     fatal_error("GetModuleHandle() failed", 0);
 | |
| }
 | |
| 
 | |
| void factor_vm::ffi_dlopen(dll* dll) {
 | |
|   dll->handle = LoadLibraryEx((WCHAR*)alien_offset(dll->path), NULL, 0);
 | |
| }
 | |
| 
 | |
| cell factor_vm::ffi_dlsym(dll* dll, symbol_char* symbol) {
 | |
|   return (cell)GetProcAddress(dll ? (HMODULE) dll->handle : hFactorDll,
 | |
|                               symbol);
 | |
| }
 | |
| 
 | |
| cell factor_vm::ffi_dlsym_raw(dll* dll, symbol_char* symbol) {
 | |
|   return ffi_dlsym(dll, symbol);
 | |
| }
 | |
| 
 | |
| void factor_vm::ffi_dlclose(dll* dll) {
 | |
|   FreeLibrary((HMODULE) dll->handle);
 | |
|   dll->handle = NULL;
 | |
| }
 | |
| 
 | |
| BOOL factor_vm::windows_stat(vm_char* path) {
 | |
|   BY_HANDLE_FILE_INFORMATION bhfi;
 | |
|   HANDLE h = CreateFileW(path, GENERIC_READ, FILE_SHARE_READ | FILE_SHARE_WRITE | FILE_SHARE_DELETE, NULL,
 | |
|                          OPEN_EXISTING, FILE_FLAG_BACKUP_SEMANTICS, NULL);
 | |
| 
 | |
|   if (h == INVALID_HANDLE_VALUE) {
 | |
|     // FindFirstFile is the only call that can stat c:\pagefile.sys
 | |
|     WIN32_FIND_DATA st;
 | |
|     HANDLE h;
 | |
| 
 | |
|     if (INVALID_HANDLE_VALUE == (h = FindFirstFile(path, &st)))
 | |
|       return false;
 | |
|     FindClose(h);
 | |
|     return true;
 | |
|   }
 | |
|   BOOL ret = GetFileInformationByHandle(h, &bhfi);
 | |
|   CloseHandle(h);
 | |
|   return ret;
 | |
| }
 | |
| 
 | |
| // You must free() this yourself.
 | |
| const vm_char* factor_vm::default_image_path() {
 | |
|   vm_char full_path[MAX_UNICODE_PATH];
 | |
|   vm_char* ptr;
 | |
|   vm_char temp_path[MAX_UNICODE_PATH];
 | |
| 
 | |
|   if (!GetModuleFileName(NULL, full_path, MAX_UNICODE_PATH))
 | |
|     fatal_error("GetModuleFileName() failed", 0);
 | |
| 
 | |
|   if ((ptr = wcsrchr(full_path, '.')))
 | |
|     *ptr = 0;
 | |
| 
 | |
|   wcsncpy(temp_path, full_path, MAX_UNICODE_PATH - 1);
 | |
|   size_t full_path_len = wcslen(full_path);
 | |
|   if (full_path_len < MAX_UNICODE_PATH - 1)
 | |
|     wcsncat(temp_path, L".image", MAX_UNICODE_PATH - full_path_len - 1);
 | |
|   temp_path[MAX_UNICODE_PATH - 1] = 0;
 | |
| 
 | |
|   return safe_strdup(temp_path);
 | |
| }
 | |
| 
 | |
| // You must free() this yourself.
 | |
| const vm_char* factor_vm::vm_executable_path() {
 | |
|   vm_char full_path[MAX_UNICODE_PATH];
 | |
|   if (!GetModuleFileName(NULL, full_path, MAX_UNICODE_PATH))
 | |
|     fatal_error("GetModuleFileName() failed", 0);
 | |
|   return safe_strdup(full_path);
 | |
| }
 | |
| 
 | |
| void factor_vm::primitive_existsp() {
 | |
|   vm_char* path = untag_check<byte_array>(ctx->pop())->data<vm_char>();
 | |
|   ctx->push(tag_boolean(windows_stat(path)));
 | |
| }
 | |
| 
 | |
| segment::segment(cell size_, bool executable_p) {
 | |
|   size = size_;
 | |
| 
 | |
|   char* mem;
 | |
|   cell alloc_size = getpagesize() * 2 + size;
 | |
|   if ((mem = (char*)VirtualAlloc(
 | |
|            NULL, alloc_size, MEM_COMMIT,
 | |
|            executable_p ? PAGE_EXECUTE_READWRITE : PAGE_READWRITE)) ==
 | |
|       0) {
 | |
|     fatal_error("Out of memory in VirtualAlloc", alloc_size);
 | |
|   }
 | |
| 
 | |
|   start = (cell)mem + getpagesize();
 | |
|   end = start + size;
 | |
| 
 | |
|   set_border_locked(true);
 | |
| }
 | |
| 
 | |
| segment::~segment() {
 | |
|   SYSTEM_INFO si;
 | |
|   GetSystemInfo(&si);
 | |
|   if (!VirtualFree((void*)(start - si.dwPageSize), 0, MEM_RELEASE))
 | |
|     fatal_error("Segment deallocation failed", 0);
 | |
| }
 | |
| 
 | |
| long getpagesize() {
 | |
|   static long g_pagesize = 0;
 | |
|   if (!g_pagesize) {
 | |
|     SYSTEM_INFO system_info;
 | |
|     GetSystemInfo(&system_info);
 | |
|     g_pagesize = system_info.dwPageSize;
 | |
|   }
 | |
|   return g_pagesize;
 | |
| }
 | |
| 
 | |
| 
 | |
| bool move_file(const vm_char* path1, const vm_char* path2) {
 | |
|   // MoveFileEx returns FALSE on fail.
 | |
|   BOOL val = MoveFileEx((path1), (path2), MOVEFILE_REPLACE_EXISTING);
 | |
|   if (val == FALSE) {
 | |
|     // MoveFileEx doesn't set errno, which primitive_save_image()
 | |
|     // reads the error code from. Instead of converting from
 | |
|     // GetLastError() to errno values, we ust set it to the generic
 | |
|     // EIO value.
 | |
|     errno = EIO;
 | |
|   }
 | |
|   return val == TRUE;
 | |
| }
 | |
| 
 | |
| void factor_vm::init_signals() {}
 | |
| 
 | |
| THREADHANDLE start_thread(void* (*start_routine)(void*), void* args) {
 | |
|   return (void*)CreateThread(NULL, 0, (LPTHREAD_START_ROUTINE) start_routine,
 | |
|                              args, 0, 0);
 | |
| }
 | |
| 
 | |
| uint64_t nano_count() {
 | |
|   static double scale_factor;
 | |
| 
 | |
|   static uint32_t hi = 0;
 | |
|   static uint32_t lo = 0;
 | |
| 
 | |
|   // Note: on older systems QueryPerformanceCounter may be unreliable
 | |
|   // until you add /usepmtimer to Boot.ini. I had an issue where two
 | |
|   // nano_count calls would show a difference of about 1 second,
 | |
|   // while actually about 80 seconds have passed. The /usepmtimer
 | |
|   // switch cured the issue on that PC (WinXP Pro SP3 32-bit).
 | |
|   // See also http://www.virtualdub.org/blog/pivot/entry.php?id=106
 | |
|   LARGE_INTEGER count;
 | |
|   BOOL ret = QueryPerformanceCounter(&count);
 | |
|   if (ret == 0)
 | |
|     fatal_error("QueryPerformanceCounter", 0);
 | |
| 
 | |
|   if (scale_factor == 0.0) {
 | |
|     LARGE_INTEGER frequency;
 | |
|     BOOL ret = QueryPerformanceFrequency(&frequency);
 | |
|     if (ret == 0)
 | |
|       fatal_error("QueryPerformanceFrequency", 0);
 | |
|     scale_factor = (1000000000.0 / frequency.QuadPart);
 | |
|   }
 | |
| 
 | |
| #ifdef FACTOR_64
 | |
|   hi = count.HighPart;
 | |
| #else
 | |
|   // On VirtualBox, QueryPerformanceCounter does not increment
 | |
|   // the high part every time the low part overflows.  Workaround.
 | |
|   if (lo > count.LowPart)
 | |
|     hi++;
 | |
| #endif
 | |
|   lo = count.LowPart;
 | |
| 
 | |
|   return (uint64_t)((((uint64_t)hi << 32) | (uint64_t)lo) * scale_factor);
 | |
| }
 | |
| 
 | |
| void sleep_nanos(uint64_t nsec) { Sleep((DWORD)(nsec / 1000000)); }
 | |
| 
 | |
| typedef enum _EXCEPTION_DISPOSITION {
 | |
|   ExceptionContinueExecution = 0,
 | |
|   ExceptionContinueSearch = 1,
 | |
|   ExceptionNestedException = 2,
 | |
|   ExceptionCollidedUnwind = 3
 | |
| } EXCEPTION_DISPOSITION;
 | |
| 
 | |
| LONG factor_vm::exception_handler(PEXCEPTION_RECORD e, void* frame, PCONTEXT c,
 | |
|                                   void* dispatch) {
 | |
|   switch (e->ExceptionCode) {
 | |
|     case EXCEPTION_ACCESS_VIOLATION:
 | |
|       set_memory_protection_error(e->ExceptionInformation[1], c->EIP);
 | |
|       dispatch_signal_handler((cell*)&c->ESP, (cell*)&c->EIP,
 | |
|                               (cell)factor::memory_signal_handler_impl);
 | |
|       break;
 | |
| 
 | |
|     case STATUS_FLOAT_DENORMAL_OPERAND:
 | |
|     case STATUS_FLOAT_DIVIDE_BY_ZERO:
 | |
|     case STATUS_FLOAT_INEXACT_RESULT:
 | |
|     case STATUS_FLOAT_INVALID_OPERATION:
 | |
|     case STATUS_FLOAT_OVERFLOW:
 | |
|     case STATUS_FLOAT_STACK_CHECK:
 | |
|     case STATUS_FLOAT_UNDERFLOW:
 | |
|     case STATUS_FLOAT_MULTIPLE_FAULTS:
 | |
|     case STATUS_FLOAT_MULTIPLE_TRAPS:
 | |
| #ifdef FACTOR_64
 | |
|       signal_fpu_status = fpu_status(MXCSR(c));
 | |
| #else
 | |
|       signal_fpu_status = fpu_status(X87SW(c) | MXCSR(c));
 | |
| 
 | |
|       // This seems to have no effect
 | |
|       X87SW(c) = 0;
 | |
| #endif
 | |
|       MXCSR(c) &= 0xffffffc0;
 | |
|       dispatch_signal_handler((cell*)&c->ESP, (cell*)&c->EIP,
 | |
|                               (cell)factor::fp_signal_handler_impl);
 | |
|       break;
 | |
|     default:
 | |
|       signal_number = e->ExceptionCode;
 | |
|       dispatch_signal_handler((cell*)&c->ESP, (cell*)&c->EIP,
 | |
|                               (cell)factor::synchronous_signal_handler_impl);
 | |
|       break;
 | |
|   }
 | |
|   return ExceptionContinueExecution;
 | |
| }
 | |
| 
 | |
| VM_C_API LONG exception_handler(PEXCEPTION_RECORD e, void* frame, PCONTEXT c,
 | |
|                                 void* dispatch) {
 | |
|   factor_vm* vm = current_vm_p();
 | |
|   if (factor_vm::fatal_erroring_p || !vm)
 | |
|     return ExceptionContinueSearch;
 | |
|   return vm->exception_handler(e, frame, c, dispatch);
 | |
| }
 | |
| 
 | |
| // On Unix SIGINT (ctrl-c) automatically interrupts blocking io system
 | |
| // calls. It doesn't on Windows, so we need to manually send some
 | |
| // cancellation requests to unblock the thread.
 | |
| VOID CALLBACK dummy_cb (ULONG_PTR dwParam) { }
 | |
| 
 | |
| // CancelSynchronousIo is not in Windows XP
 | |
| #if _WIN32_WINNT >= 0x0600
 | |
| static void wake_up_thread(HANDLE thread) {
 | |
|   if (!CancelSynchronousIo(thread)) {
 | |
|     DWORD err = GetLastError();
 | |
|     // CancelSynchronousIo() didn't find anything to cancel, let's try
 | |
|     // with QueueUserAPC() instead.
 | |
|     if (err == ERROR_NOT_FOUND) {
 | |
|       if (!QueueUserAPC(&dummy_cb, thread, NULL)) {
 | |
|         fatal_error("QueueUserAPC() failed", GetLastError());
 | |
|       }
 | |
|     } else {
 | |
|       fatal_error("CancelSynchronousIo() failed", err);
 | |
|     }
 | |
|   }
 | |
| }
 | |
| #else
 | |
| static void wake_up_thread(HANDLE thread) {}
 | |
| #endif
 | |
| 
 | |
| static BOOL WINAPI ctrl_handler(DWORD dwCtrlType) {
 | |
|   switch (dwCtrlType) {
 | |
|     case CTRL_C_EVENT: {
 | |
|       // The CtrlHandler runs in its own thread without stopping the main
 | |
|       // thread. Since in practice nobody uses the multi-VM stuff yet, we just
 | |
|       // grab the first VM we can get. This will not be a good idea when we
 | |
|       // actually support native threads.
 | |
|       FACTOR_ASSERT(thread_vms.size() == 1);
 | |
|       factor_vm* vm = thread_vms.begin()->second;
 | |
|       vm->enqueue_fep();
 | |
| 
 | |
|       // Before leaving the ctrl_handler, try and wake up the main thread.
 | |
|       wake_up_thread(factor::boot_thread);
 | |
|       return TRUE;
 | |
|     }
 | |
|     default:
 | |
|       return FALSE;
 | |
|   }
 | |
| }
 | |
| 
 | |
| void open_console() { handle_ctrl_c(); }
 | |
| 
 | |
| void ignore_ctrl_c() {
 | |
|   SetConsoleCtrlHandler(factor::ctrl_handler, FALSE);
 | |
| }
 | |
| 
 | |
| void handle_ctrl_c() {
 | |
|   SetConsoleCtrlHandler(factor::ctrl_handler, TRUE);
 | |
| }
 | |
| 
 | |
| const int ctrl_break_sleep = 10; /* msec */
 | |
| 
 | |
| static DWORD WINAPI ctrl_break_thread_proc(LPVOID parent_vm) {
 | |
|   bool ctrl_break_handled = false;
 | |
|   factor_vm* vm = static_cast<factor_vm*>(parent_vm);
 | |
|   while (vm->stop_on_ctrl_break) {
 | |
|     if (GetAsyncKeyState(VK_CANCEL) >= 0) { /* Ctrl-Break is released. */
 | |
|       ctrl_break_handled = false;  /* Wait for the next press. */
 | |
|     } else if (!ctrl_break_handled) {
 | |
|       /* Check if the VM thread has the same Id as the thread Id of the
 | |
|          currently active window. Note that thread Id is not a handle. */
 | |
|       DWORD fg_thd_id = GetWindowThreadProcessId(GetForegroundWindow(), NULL);
 | |
|       if ((fg_thd_id == vm->thread_id) && !vm->fep_p) {
 | |
|         vm->enqueue_fep();
 | |
|         ctrl_break_handled = true;
 | |
|       }
 | |
|     }
 | |
|     Sleep(ctrl_break_sleep);
 | |
|   }
 | |
|   return 0;
 | |
| }
 | |
| 
 | |
| void factor_vm::primitive_disable_ctrl_break() {
 | |
|   stop_on_ctrl_break = false;
 | |
|   if (ctrl_break_thread != NULL) {
 | |
|     DWORD wait_result = WaitForSingleObject(ctrl_break_thread,
 | |
|                                             2 * ctrl_break_sleep);
 | |
|     if (wait_result != WAIT_OBJECT_0)
 | |
|       TerminateThread(ctrl_break_thread, 0);
 | |
|     CloseHandle(ctrl_break_thread);
 | |
|     ctrl_break_thread = NULL;
 | |
|   }
 | |
| }
 | |
| 
 | |
| void factor_vm::primitive_enable_ctrl_break() {
 | |
|   stop_on_ctrl_break = true;
 | |
|   if (ctrl_break_thread == NULL) {
 | |
|     DisableProcessWindowsGhosting();
 | |
|     ctrl_break_thread = CreateThread(NULL, 0, factor::ctrl_break_thread_proc,
 | |
|                                      static_cast<LPVOID>(this), 0, NULL);
 | |
|     SetThreadPriority(ctrl_break_thread, THREAD_PRIORITY_ABOVE_NORMAL);
 | |
|   }
 | |
| }
 | |
| 
 | |
| void lock_console() {}
 | |
| 
 | |
| void unlock_console() {}
 | |
| 
 | |
| void close_console() {}
 | |
| 
 | |
| cell get_thread_pc(THREADHANDLE th) {
 | |
|   DWORD suscount = SuspendThread(th);
 | |
|   FACTOR_ASSERT(suscount == 0);
 | |
| 
 | |
|   CONTEXT context;
 | |
|   memset((void*)&context, 0, sizeof(CONTEXT));
 | |
|   context.ContextFlags = CONTEXT_CONTROL;
 | |
|   BOOL context_ok = GetThreadContext(th, &context);
 | |
|   FACTOR_ASSERT(context_ok);
 | |
| 
 | |
|   suscount = ResumeThread(th);
 | |
|   FACTOR_ASSERT(suscount == 1);
 | |
|   return context.EIP;
 | |
| }
 | |
| 
 | |
| void factor_vm::sampler_thread_loop() {
 | |
|   LARGE_INTEGER counter, new_counter, units_per_second;
 | |
|   DWORD ok;
 | |
| 
 | |
|   ok = QueryPerformanceFrequency(&units_per_second);
 | |
|   FACTOR_ASSERT(ok);
 | |
| 
 | |
|   ok = QueryPerformanceCounter(&counter);
 | |
|   FACTOR_ASSERT(ok);
 | |
| 
 | |
|   counter.QuadPart *= samples_per_second;
 | |
|   while (atomic::load(&sampling_profiler_p)) {
 | |
|     SwitchToThread();
 | |
|     ok = QueryPerformanceCounter(&new_counter);
 | |
|     FACTOR_ASSERT(ok);
 | |
|     new_counter.QuadPart *= samples_per_second;
 | |
|     cell samples = 0;
 | |
|     while (new_counter.QuadPart - counter.QuadPart >
 | |
|            units_per_second.QuadPart) {
 | |
|       ++samples;
 | |
|       counter.QuadPart += units_per_second.QuadPart;
 | |
|     }
 | |
|     if (samples == 0)
 | |
|       continue;
 | |
| 
 | |
|     cell pc = get_thread_pc(thread);
 | |
|     enqueue_samples(samples, pc, false);
 | |
|   }
 | |
| }
 | |
| 
 | |
| static DWORD WINAPI sampler_thread_entry(LPVOID parent_vm) {
 | |
|   static_cast<factor_vm*>(parent_vm)->sampler_thread_loop();
 | |
|   return 0;
 | |
| }
 | |
| 
 | |
| void factor_vm::start_sampling_profiler_timer() {
 | |
|   sampler_thread = CreateThread(NULL, 0, &sampler_thread_entry,
 | |
|                                 static_cast<LPVOID>(this), 0, NULL);
 | |
| }
 | |
| 
 | |
| void factor_vm::end_sampling_profiler_timer() {
 | |
|   atomic::store(&sampling_profiler_p, false);
 | |
|   DWORD wait_result =
 | |
|       WaitForSingleObject(sampler_thread, 3000 * (DWORD) samples_per_second);
 | |
|   if (wait_result != WAIT_OBJECT_0)
 | |
|     TerminateThread(sampler_thread, 0);
 | |
|   CloseHandle(sampler_thread);
 | |
|   sampler_thread = NULL;
 | |
| }
 | |
| 
 | |
| void abort() { ::abort(); }
 | |
| 
 | |
| }
 |