| 1 | /* $Id: bs3-cmn-Trap16Init.c 59984 2016-03-11 00:56:10Z vboxsync $ */
|
|---|
| 2 | /** @file
|
|---|
| 3 | * BS3Kit - Bs3Trap16Init
|
|---|
| 4 | */
|
|---|
| 5 |
|
|---|
| 6 | /*
|
|---|
| 7 | * Copyright (C) 2007-2016 Oracle Corporation
|
|---|
| 8 | *
|
|---|
| 9 | * This file is part of VirtualBox Open Source Edition (OSE), as
|
|---|
| 10 | * available from http://www.virtualbox.org. This file is free software;
|
|---|
| 11 | * you can redistribute it and/or modify it under the terms of the GNU
|
|---|
| 12 | * General Public License (GPL) as published by the Free Software
|
|---|
| 13 | * Foundation, in version 2 as it comes in the "COPYING" file of the
|
|---|
| 14 | * VirtualBox OSE distribution. VirtualBox OSE is distributed in the
|
|---|
| 15 | * hope that it will be useful, but WITHOUT ANY WARRANTY of any kind.
|
|---|
| 16 | *
|
|---|
| 17 | * The contents of this file may alternatively be used under the terms
|
|---|
| 18 | * of the Common Development and Distribution License Version 1.0
|
|---|
| 19 | * (CDDL) only, as it comes in the "COPYING.CDDL" file of the
|
|---|
| 20 | * VirtualBox OSE distribution, in which case the provisions of the
|
|---|
| 21 | * CDDL are applicable instead of those of the GPL.
|
|---|
| 22 | *
|
|---|
| 23 | * You may elect to license modified versions of this file under the
|
|---|
| 24 | * terms and conditions of either the GPL or the CDDL or both.
|
|---|
| 25 | */
|
|---|
| 26 |
|
|---|
| 27 | /*********************************************************************************************************************************
|
|---|
| 28 | * Header Files *
|
|---|
| 29 | *********************************************************************************************************************************/
|
|---|
| 30 | #include "bs3kit-template-header.h"
|
|---|
| 31 |
|
|---|
| 32 |
|
|---|
| 33 | /*********************************************************************************************************************************
|
|---|
| 34 | * Global Variables *
|
|---|
| 35 | *********************************************************************************************************************************/
|
|---|
| 36 | /* We ASSUME that BS3CODE16 is 64KB aligned, so the low 16-bit of the
|
|---|
| 37 | flat address matches. Also, these symbols are defined both with
|
|---|
| 38 | and without underscore prefixes. */
|
|---|
| 39 | extern BS3_DECL(void) BS3_FAR_CODE Bs3Trap16DoubleFaultHandler80386(void);
|
|---|
| 40 | extern BS3_DECL(void) BS3_FAR_CODE Bs3Trap16DoubleFaultHandler80286(void);
|
|---|
| 41 | extern BS3_DECL(void) BS3_FAR_CODE Bs3Trap16GenericEntries(void);
|
|---|
| 42 |
|
|---|
| 43 | /* These two are ugly. Need data access for patching purposes. */
|
|---|
| 44 | extern uint8_t BS3_FAR_DATA bs3Trap16GenericTrapOrInt[];
|
|---|
| 45 | extern uint8_t BS3_FAR_DATA bs3Trap16GenericTrapErrCode[];
|
|---|
| 46 |
|
|---|
| 47 |
|
|---|
| 48 | BS3_DECL(void) Bs3Trap16Init(bool f386Plus)
|
|---|
| 49 | {
|
|---|
| 50 | X86TSS16 BS3_FAR *pTss;
|
|---|
| 51 | unsigned iIdt;
|
|---|
| 52 |
|
|---|
| 53 | /*
|
|---|
| 54 | * If 386 or later, patch the trap handler code to not jump to the 80286
|
|---|
| 55 | * code but continue with the next instruction (the 386+ code).
|
|---|
| 56 | */
|
|---|
| 57 | if (f386Plus)
|
|---|
| 58 | {
|
|---|
| 59 | bs3Trap16GenericTrapErrCode[1] = 0;
|
|---|
| 60 | bs3Trap16GenericTrapErrCode[2] = 0;
|
|---|
| 61 | bs3Trap16GenericTrapOrInt[1] = 0;
|
|---|
| 62 | bs3Trap16GenericTrapOrInt[2] = 0;
|
|---|
| 63 | }
|
|---|
| 64 |
|
|---|
| 65 | /*
|
|---|
| 66 | * IDT entries, except the system call gate.
|
|---|
| 67 | */
|
|---|
| 68 | for (iIdt = 0; iIdt < BS3_TRAP_SYSCALL; iIdt++)
|
|---|
| 69 | Bs3Trap16SetGate(iIdt, X86_SEL_TYPE_SYS_286_INT_GATE, 0 /*bDpl*/,
|
|---|
| 70 | BS3_SEL_R0_CS16, (uint16_t)(uintptr_t)Bs3Trap16GenericEntries + iIdt * 8, 0 /*cParams*/);
|
|---|
| 71 | for (iIdt = BS3_TRAP_SYSCALL + 1; iIdt < 256; iIdt++)
|
|---|
| 72 | Bs3Trap16SetGate(iIdt, X86_SEL_TYPE_SYS_286_INT_GATE, 0 /*bDpl*/,
|
|---|
| 73 | BS3_SEL_R0_CS16, (uint16_t)(uintptr_t)Bs3Trap16GenericEntries + iIdt * 8, 0 /*cParams*/);
|
|---|
| 74 |
|
|---|
| 75 | /*
|
|---|
| 76 | * Initialize the normal TSS so we can do ring transitions via the IDT.
|
|---|
| 77 | */
|
|---|
| 78 | pTss = &BS3_DATA_NM(Bs3Tss16);
|
|---|
| 79 | Bs3MemZero(pTss, sizeof(*pTss));
|
|---|
| 80 | pTss->sp0 = BS3_ADDR_STACK_R0;
|
|---|
| 81 | pTss->ss0 = BS3_SEL_R0_SS16;
|
|---|
| 82 | pTss->sp1 = BS3_ADDR_STACK_R1;
|
|---|
| 83 | pTss->ss1 = BS3_SEL_R1_SS16 | 1;
|
|---|
| 84 | pTss->sp2 = BS3_ADDR_STACK_R2;
|
|---|
| 85 | pTss->ss2 = BS3_SEL_R2_SS16 | 2;
|
|---|
| 86 |
|
|---|
| 87 | /*
|
|---|
| 88 | * Initialize the double fault TSS.
|
|---|
| 89 | * cr3 is filled in by switcher code, when needed.
|
|---|
| 90 | */
|
|---|
| 91 | pTss = &BS3_DATA_NM(Bs3Tss16DoubleFault);
|
|---|
| 92 | Bs3MemZero(pTss, sizeof(*pTss));
|
|---|
| 93 | pTss->sp0 = BS3_ADDR_STACK_R0;
|
|---|
| 94 | pTss->ss0 = BS3_SEL_R0_SS16;
|
|---|
| 95 | pTss->sp1 = BS3_ADDR_STACK_R1;
|
|---|
| 96 | pTss->ss1 = BS3_SEL_R1_SS16 | 1;
|
|---|
| 97 | pTss->sp2 = BS3_ADDR_STACK_R2;
|
|---|
| 98 | pTss->ss2 = BS3_SEL_R2_SS16 | 2;
|
|---|
| 99 | pTss->ip = (uint16_t)(uintptr_t)(f386Plus ? &Bs3Trap16DoubleFaultHandler80386 : &Bs3Trap16DoubleFaultHandler80286);
|
|---|
| 100 | pTss->flags = X86_EFL_1;
|
|---|
| 101 | pTss->sp = BS3_ADDR_STACK_R0_IST1;
|
|---|
| 102 | pTss->es = BS3_SEL_R0_DS16;
|
|---|
| 103 | pTss->ds = BS3_SEL_R0_DS16;
|
|---|
| 104 | pTss->cs = BS3_SEL_R0_CS16;
|
|---|
| 105 | pTss->ss = BS3_SEL_R0_SS16;
|
|---|
| 106 | pTss->dx = f386Plus;
|
|---|
| 107 |
|
|---|
| 108 | Bs3Trap16SetGate(X86_XCPT_DF, X86_SEL_TYPE_SYS_TASK_GATE, 0 /*bDpl*/, BS3_SEL_TSS16_DF, 0, 0 /*cParams*/);
|
|---|
| 109 | }
|
|---|
| 110 |
|
|---|
