+++ /dev/null
-/*
- * Acess2 VM8086 Driver
- * - By John Hodge (thePowersGang)
- */
-#define DEBUG 0
-#include <acess.h>
-#include <vm8086.h>
-#include <modules.h>
-#include <hal_proc.h>
-#include <semaphore.h>
-
-// === CONSTANTS ===
-#define VM8086_MAGIC_CS 0xFFFF
-#define VM8086_MAGIC_IP 0x0010
-#define VM8086_STACK_SEG 0x9F00
-#define VM8086_STACK_OFS 0x0AFE
-enum eVM8086_Opcodes
-{
- VM8086_OP_PUSHF = 0x9C,
- VM8086_OP_POPF = 0x9D,
- VM8086_OP_INT_I = 0xCD,
- VM8086_OP_IRET = 0xCF,
- VM8086_OP_IN_AD = 0xEC,
- VM8086_OP_IN_ADX = 0xED,
- VM8086_OP_OUT_AD = 0xEE,
- VM8086_OP_OUT_ADX = 0xEF
-};
-#define VM8086_PAGES_PER_INST 4
-
-#define VM8086_BLOCKSIZE 128
-#define VM8086_BLOCKCOUNT ((0x9F000-0x10000)/VM8086_BLOCKSIZE)
-
-// === TYPES ===
-struct sVM8086_InternalData
-{
- struct {
- Uint32 Bitmap; // 32 sections = 128 byte blocks
- tVAddr VirtBase;
- tPAddr PhysAddr;
- } AllocatedPages[VM8086_PAGES_PER_INST];
-};
-
-// === PROTOTYPES ===
- int VM8086_Install(char **Arguments);
-void VM8086_GPF(tRegs *Regs);
-//tVM8086 *VM8086_Init(void);
-
-// === GLOBALS ===
-MODULE_DEFINE(0, 0x100, VM8086, VM8086_Install, NULL, NULL);
-tMutex glVM8086_Process;
-tSemaphore gVM8086_TaskComplete;
-tSemaphore gVM8086_TasksToDo;
-tPID gVM8086_WorkerPID;
-tTID gVM8086_CallingThread;
-tVM8086 volatile * volatile gpVM8086_State = (void*)-1; // Set to -1 to avoid race conditions
-Uint32 gaVM8086_MemBitmap[VM8086_BLOCKCOUNT/32];
-
-// === FUNCTIONS ===
-int VM8086_Install(char **Arguments)
-{
- tPID pid;
-
- Semaphore_Init(&gVM8086_TasksToDo, 0, 10, "VM8086", "TasksToDo");
-
- // Lock to avoid race conditions
- Mutex_Acquire( &glVM8086_Process );
-
- // Create BIOS Call process
- pid = Proc_Clone(CLONE_VM);
- Log_Debug("VM8086", "pid = %i", pid);
- if(pid == -1)
- {
- Log_Error("VM8086", "Unable to clone kernel into VM8086 worker");
- return MODULE_ERR_MISC;
- }
- if(pid == 0)
- {
- Uint * volatile stacksetup; // Initialising Stack
- Uint16 * volatile rmstack; // Real Mode Stack
- int i;
-
- Log_Debug("VM8086", "Initialising worker");
-
- // Set Image Name
- Threads_SetName("VM8086");
-
- // Map ROM Area
- for(i=0xA0;i<0x100;i++) {
- MM_Map( i * 0x1000, i * 0x1000 );
- }
- MM_Map( 0, 0 ); // IVT / BDA
- // Map (but allow allocation) of 0x1000 - 0x9F000
- // - So much hack, it isn't funny
- for(i=1;i<0x9F;i++) {
- MM_Map( i * 0x1000, i * 0x1000 );
- MM_DerefPhys( i * 0x1000 ); // Above
- while(MM_GetRefCount(i*0x1000))
- MM_DerefPhys( i * 0x1000 ); // Phys setup
- }
- MM_Map( 0x9F000, 0x9F000 ); // Stack / EBDA
- // System Stack / Stub
- if( MM_Allocate( 0x100000 ) == 0 ) {
- Log_Error("VM8086", "Unable to allocate memory for stack/stub");
- gVM8086_WorkerPID = 0;
- Threads_Exit(0, 1);
- }
-
- *(Uint8*)(0x100000) = VM8086_OP_IRET;
- *(Uint8*)(0x100001) = 0x07; // POP ES
- *(Uint8*)(0x100002) = 0x1F; // POP DS
- *(Uint8*)(0x100003) = 0xCB; // RET FAR
-
- rmstack = (Uint16*)(VM8086_STACK_SEG*16 + VM8086_STACK_OFS);
- rmstack--; *rmstack = 0xFFFF; //CS
- rmstack--; *rmstack = 0x0010; //IP
-
- // Setup Stack
- stacksetup = (Uint*)0x101000;
- stacksetup--; *stacksetup = VM8086_STACK_SEG; // GS
- stacksetup--; *stacksetup = VM8086_STACK_SEG; // FS
- stacksetup--; *stacksetup = VM8086_STACK_SEG; // DS
- stacksetup--; *stacksetup = VM8086_STACK_SEG; // ES
- stacksetup--; *stacksetup = VM8086_STACK_SEG; // SS
- stacksetup--; *stacksetup = VM8086_STACK_OFS-2; // SP
- stacksetup--; *stacksetup = 0x20202; // FLAGS
- stacksetup--; *stacksetup = 0xFFFF; // CS
- stacksetup--; *stacksetup = 0x10; // IP
- stacksetup--; *stacksetup = 0xAAAA; // AX
- stacksetup--; *stacksetup = 0xCCCC; // CX
- stacksetup--; *stacksetup = 0xDDDD; // DX
- stacksetup--; *stacksetup = 0xBBBB; // BX
- stacksetup--; *stacksetup = 0x5454; // SP
- stacksetup--; *stacksetup = 0xB4B4; // BP
- stacksetup--; *stacksetup = 0x5151; // SI
- stacksetup--; *stacksetup = 0xD1D1; // DI
- stacksetup--; *stacksetup = 0x20|3; // DS - Kernel
- stacksetup--; *stacksetup = 0x20|3; // ES - Kernel
- stacksetup--; *stacksetup = 0x20|3; // FS
- stacksetup--; *stacksetup = 0x20|3; // GS
- __asm__ __volatile__ (
- "mov %%eax,%%esp;\n\t" // Set stack pointer
- "pop %%gs;\n\t"
- "pop %%fs;\n\t"
- "pop %%es;\n\t"
- "pop %%ds;\n\t"
- "popa;\n\t"
- "iret;\n\t" : : "a" (stacksetup));
- for(;;); // Shouldn't be reached
- }
-
- gVM8086_WorkerPID = pid;
-
- // It's released when the GPF fires
- Mutex_Acquire( &glVM8086_Process );
- Mutex_Release( &glVM8086_Process );
-
- // Worker killed itself
- if( gVM8086_WorkerPID != pid ) {
- return MODULE_ERR_MISC;
- }
-
- return MODULE_ERR_OK;
-}
-
-void VM8086_GPF(tRegs *Regs)
-{
- Uint8 opcode;
-
-// Log_Log("VM8086", "GPF - %04x:%04x", Regs->cs, Regs->eip);
-
- if(Regs->eip == VM8086_MAGIC_IP && Regs->cs == VM8086_MAGIC_CS
- && Threads_GetPID() == gVM8086_WorkerPID)
- {
- if( gpVM8086_State == (void*)-1 ) {
- Log_Log("VM8086", "Worker thread ready and waiting");
- gpVM8086_State = NULL;
- Mutex_Release( &glVM8086_Process ); // Release lock obtained in VM8086_Install
- }
-// Log_Log("VM8086", "gpVM8086_State = %p, gVM8086_CallingThread = %i",
-// gpVM8086_State, gVM8086_CallingThread);
- if( gpVM8086_State ) {
- gpVM8086_State->AX = Regs->eax; gpVM8086_State->CX = Regs->ecx;
- gpVM8086_State->DX = Regs->edx; gpVM8086_State->BX = Regs->ebx;
- gpVM8086_State->BP = Regs->ebp;
- gpVM8086_State->SI = Regs->esi; gpVM8086_State->DI = Regs->edi;
- gpVM8086_State->DS = Regs->ds; gpVM8086_State->ES = Regs->es;
- gpVM8086_State = NULL;
- // Wake the caller
- Semaphore_Signal(&gVM8086_TaskComplete, 1);
- }
-
- //Log_Log("VM8086", "Waiting for something to do");
- __asm__ __volatile__ ("sti");
- Semaphore_Wait(&gVM8086_TasksToDo, 1);
-
- //Log_Log("VM8086", "We have a task (%p)", gpVM8086_State);
- Regs->esp -= 2; *(Uint16*)( (Regs->ss<<4) + (Regs->esp&0xFFFF) ) = VM8086_MAGIC_CS;
- Regs->esp -= 2; *(Uint16*)( (Regs->ss<<4) + (Regs->esp&0xFFFF) ) = VM8086_MAGIC_IP;
- Regs->esp -= 2; *(Uint16*)( (Regs->ss<<4) + (Regs->esp&0xFFFF) ) = gpVM8086_State->CS;
- Regs->esp -= 2; *(Uint16*)( (Regs->ss<<4) + (Regs->esp&0xFFFF) ) = gpVM8086_State->IP;
- Regs->esp -= 2; *(Uint16*)( (Regs->ss<<4) + (Regs->esp&0xFFFF) ) = gpVM8086_State->DS;
- Regs->esp -= 2; *(Uint16*)( (Regs->ss<<4) + (Regs->esp&0xFFFF) ) = gpVM8086_State->ES;
-
- // Set Registers
- Regs->eip = 0x11; Regs->cs = 0xFFFF;
- Regs->eax = gpVM8086_State->AX; Regs->ecx = gpVM8086_State->CX;
- Regs->edx = gpVM8086_State->DX; Regs->ebx = gpVM8086_State->BX;
- Regs->esi = gpVM8086_State->SI; Regs->edi = gpVM8086_State->DI;
- Regs->ebp = gpVM8086_State->BP;
- Regs->ds = 0x23; Regs->es = 0x23;
- Regs->fs = 0x23; Regs->gs = 0x23;
- return ;
- }
-
- opcode = *(Uint8*)( (Regs->cs*16) + (Regs->eip) );
- Regs->eip ++;
- switch(opcode)
- {
- case VM8086_OP_PUSHF: //PUSHF
- Regs->esp -= 2;
- *(Uint16*)( Regs->ss*16 + (Regs->esp&0xFFFF) ) = Regs->eflags & 0xFFFF;
- #if TRACE_EMU
- Log_Debug("VM8086", "Emulated PUSHF");
- #endif
- break;
- case VM8086_OP_POPF: //POPF
- // Changing IF is not allowed
- Regs->eflags &= 0xFFFF0202;
- Regs->eflags |= *(Uint16*)( Regs->ss*16 + (Regs->esp&0xFFFF) );
- Regs->esp += 2;
- #if TRACE_EMU
- Log_Debug("VM8086", "Emulated POPF");
- #endif
- break;
-
- case VM8086_OP_INT_I: //INT imm8
- {
- int id;
- id = *(Uint8*)( Regs->cs*16 +(Regs->eip&0xFFFF));
- Regs->eip ++;
-
- Regs->esp -= 2; *(Uint16*)( Regs->ss*16 + (Regs->esp&0xFFFF) ) = Regs->cs;
- Regs->esp -= 2; *(Uint16*)( Regs->ss*16 + (Regs->esp&0xFFFF) ) = Regs->eip;
-
- Regs->cs = *(Uint16*)(4*id + 2);
- Regs->eip = *(Uint16*)(4*id);
- #if TRACE_EMU
- Log_Debug("VM8086", "Emulated INT 0x%x", id);
- #endif
- }
- break;
-
- case VM8086_OP_IRET: //IRET
- Regs->eip = *(Uint16*)( Regs->ss*16 + (Regs->esp&0xFFFF) ); Regs->esp += 2;
- Regs->cs = *(Uint16*)( Regs->ss*16 + (Regs->esp&0xFFFF) ); Regs->esp += 2;
- #if TRACE_EMU
- Log_Debug("VM8086", "IRET to %04x:%04x", Regs->cs, Regs->eip);
- #endif
- break;
-
-
- case VM8086_OP_IN_AD: //IN AL, DX
- Regs->eax &= 0xFFFFFF00;
- Regs->eax |= inb(Regs->edx&0xFFFF);
- #if TRACE_EMU
- Log_Debug("VM8086", "Emulated IN AL, DX (Port 0x%x)\n", Regs->edx&0xFFFF);
- #endif
- break;
- case VM8086_OP_IN_ADX: //IN AX, DX
- Regs->eax &= 0xFFFF0000;
- Regs->eax |= inw(Regs->edx&0xFFFF);
- #if TRACE_EMU
- Log_Debug("VM8086", "Emulated IN AX, DX (Port 0x%x)\n", Regs->edx&0xFFFF);
- #endif
- break;
-
- case VM8086_OP_OUT_AD: //OUT DX, AL
- outb(Regs->edx&0xFFFF, Regs->eax&0xFF);
- #if TRACE_EMU
- Log_Debug("VM8086", "Emulated OUT DX, AL (*0x%04x = 0x%02x)\n", Regs->edx&0xFFFF, Regs->eax&0xFF);
- #endif
- break;
- case VM8086_OP_OUT_ADX: //OUT DX, AX
- outw(Regs->edx&0xFFFF, Regs->eax&0xFFFF);
- #if TRACE_EMU
- Log_Debug("VM8086", "Emulated OUT DX, AX (*0x%04x = 0x%04x)\n", Regs->edx&0xFFFF, Regs->eax&0xFFFF);
- #endif
- break;
-
- // TODO: Decide on allowing VM8086 Apps to enable/disable interrupts
- case 0xFA: //CLI
- break;
- case 0xFB: //STI
- break;
-
- case 0x66:
- opcode = *(Uint8*)( (Regs->cs*16) + (Regs->eip&0xFFFF));
- switch( opcode )
- {
- case VM8086_OP_IN_ADX: //IN AX, DX
- Regs->eax = ind(Regs->edx&0xFFFF);
- #if TRACE_EMU
- Log_Debug("VM8086", "Emulated IN EAX, DX (Port 0x%x)\n", Regs->edx&0xFFFF);
- #endif
- break;
- case VM8086_OP_OUT_ADX: //OUT DX, AX
- outd(Regs->edx&0xFFFF, Regs->eax);
- #if TRACE_EMU
- Log_Debug("VM8086", "Emulated OUT DX, EAX (*0x%04x = 0x%08x)\n", Regs->edx&0xFFFF, Regs->eax);
- #endif
- break;
- default:
- Log_Error("VM8086", "Error - Unknown opcode 66 %02x caused a GPF at %04x:%04x",
- Regs->cs, Regs->eip,
- opcode
- );
- // Force an end to the call
- Regs->cs = VM8086_MAGIC_CS;
- Regs->eip = VM8086_MAGIC_IP;
- break;
- }
- break;
-
- default:
- Log_Error("VM8086", "Error - Unknown opcode %02x caused a GPF at %04x:%04x",
- opcode, Regs->cs, Regs->eip);
- // Force an end to the call
- Regs->cs = VM8086_MAGIC_CS;
- Regs->eip = VM8086_MAGIC_IP;
- break;
- }
-}
-
-/**
- * \brief Create an instance of the VM8086 Emulator
- */
-tVM8086 *VM8086_Init(void)
-{
- tVM8086 *ret;
- ret = calloc( 1, sizeof(tVM8086) + sizeof(struct sVM8086_InternalData) );
- ret->Internal = (void*)((tVAddr)ret + sizeof(tVM8086));
- return ret;
-}
-
-void VM8086_Free(tVM8086 *State)
-{
- int i;
- for( i = VM8086_PAGES_PER_INST; i --; )
- MM_UnmapHWPages( State->Internal->AllocatedPages[i].VirtBase, 1);
- free(State);
-}
-
-void *VM8086_Allocate(tVM8086 *State, int Size, Uint16 *Segment, Uint16 *Offset)
-{
- int i, j, base = 0;
- int nBlocks, rem;
-
- Size = (Size + 127) & ~127;
- nBlocks = Size / 128;
-
- if(Size > 4096) return NULL;
-
- for( i = 0; i < VM8086_PAGES_PER_INST; i++ )
- {
- if( State->Internal->AllocatedPages[i].VirtBase == 0 ) continue;
-
-
- //Log_Debug("VM8086", "AllocatedPages[%i].Bitmap = 0b%b", i, State->Internal->AllocatedPages[i].Bitmap);
-
- rem = nBlocks;
- base = 0;
- // Scan the bitmap for a free block
- for( j = 0; j < 32; j++ ) {
- if( State->Internal->AllocatedPages[i].Bitmap & (1 << j) ) {
- base = j+1;
- rem = nBlocks;
- }
-
- rem --;
- if(rem == 0) // Goodie, there's a gap
- {
- for( j = 0; j < nBlocks; j++ )
- State->Internal->AllocatedPages[i].Bitmap |= 1 << (base + j);
- *Segment = State->Internal->AllocatedPages[i].PhysAddr / 16 + base * 8;
- *Offset = 0;
- LOG("Allocated at #%i,%04x", i, base*128);
- LOG(" - %x:%x", *Segment, *Offset);
- return (void*)( State->Internal->AllocatedPages[i].VirtBase + base * 128 );
- }
- }
- }
-
- // No pages with free space?, allocate a new one
- for( i = 0; i < VM8086_PAGES_PER_INST; i++ )
- {
- if( State->Internal->AllocatedPages[i].VirtBase == 0 ) break;
- }
- // Darn, we can't allocate any more
- if( i == VM8086_PAGES_PER_INST ) {
- Log_Warning("VM8086", "Out of pages in %p", State);
- return NULL;
- }
-
- State->Internal->AllocatedPages[i].VirtBase = MM_AllocDMA(
- 1, 20, &State->Internal->AllocatedPages[i].PhysAddr);
- State->Internal->AllocatedPages[i].Bitmap = 0;
-
- for( j = 0; j < nBlocks; j++ )
- State->Internal->AllocatedPages[i].Bitmap |= 1 << j;
- LOG("AllocatedPages[%i].Bitmap = 0b%b", i, State->Internal->AllocatedPages[i].Bitmap);
- *Segment = State->Internal->AllocatedPages[i].PhysAddr / 16;
- *Offset = 0;
- LOG(" - %x:%x", *Segment, *Offset);
- return (void*) State->Internal->AllocatedPages[i].VirtBase;
-}
-
-void *VM8086_GetPointer(tVM8086 *State, Uint16 Segment, Uint16 Offset)
-{
- return (void*)( KERNEL_BASE + Segment*16 + Offset );
-}
-
-void VM8086_Int(tVM8086 *State, Uint8 Interrupt)
-{
- State->IP = *(Uint16*)(KERNEL_BASE+4*Interrupt);
- State->CS = *(Uint16*)(KERNEL_BASE+4*Interrupt+2);
-
-// Log_Debug("VM8086", "Software interrupt %i to %04x:%04x", Interrupt, State->CS, State->IP);
-
- Mutex_Acquire( &glVM8086_Process );
-
- gpVM8086_State = State;
- gVM8086_CallingThread = Threads_GetTID();
- Semaphore_Signal(&gVM8086_TasksToDo, 1);
-
- Semaphore_Wait(&gVM8086_TaskComplete, 1);
-
- Mutex_Release( &glVM8086_Process );
-}
git.ucc.asn.au / tpg / acess2.git / blobdiff
UCC git Repository :: git.ucc.asn.au