vmm/core/vt_ept.c

/*
 * Copyright (c) 2007, 2008 University of Tsukuba
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions are met:
 *
 * 1. Redistributions of source code must retain the above copyright notice,
 *    this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright notice,
 *    this list of conditions and the following disclaimer in the documentation
 *    and/or other materials provided with the distribution.
 * 3. Neither the name of the University of Tsukuba nor the names of its
 *    contributors may be used to endorse or promote products derived from
 *    this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */
/*
 * Copyright (c) 2010-2012 Yuichi Watanabe
 */

#include <core/mm.h>
#include <core/printf.h>
#include <core/thread.h>
#include "apic_pass.h"
#include "asm.h"
#include "cpu_mmu.h"
#include "mm.h"
#include "mtrr.h"
#include "vt_internal.h"
#include "constants.h"
#include "current.h"

#define EPT_MAX_LEVEL           4
#define EPT_LEVEL_STRIDE        (9)
#define EPT_LEVEL_MASK          ((1 << EPT_LEVEL_STRIDE) - 1)

#define EPT_READ                0x1
#define EPT_WRITE               0x2
#define EPT_EXECUTE             0x4
#define EPT_VAILED_MASK         0x7
#define EPT_MEMTYPE_TO_PTE(memtype)     ((memtype) << 3)

#define VMCS_EPT_POINTER_ADDR_WB                0x6
#define VMCS_EPT_POINTER_ADDR_EPT_LENGTH        ((EPT_MAX_LEVEL - 1) << 3)

#define VMCS_EXIT_QUALIFICATION_READ_BIT                0x1
#define VMCS_EXIT_QUALIFICATION_WRITE_BIT               0x2
#define VMCS_EXIT_QUALIFICATION_INST_BIT                0x4
#define VMCS_EXIT_QUALIFICATION_LINEAR_ADDR_VALID_BIT   0x80


#define ept_offset(addr, level) \
        ((addr >> (PAGE_SHIFT + (level - 1) * EPT_LEVEL_STRIDE)) \
         & EPT_LEVEL_MASK)

static void
vt_ept_invalidate_tlb(void)
{
        struct {
                u64 ept_l4tbl;
                u64 reserved;
        } desc;

        desc.ept_l4tbl = current->vm->vt.ept_l4tbl;
        desc.reserved = 0;
        asm_invept(&desc);
}

void
vt_ept_init(void)
{
        struct vt_vm_data       *vt_data = &current->vm->vt;
        u32                     ctls_or, ctls_and;
        u32                     ctls2_or, ctls2_and;
        ulong                   ctls;
        void                    *vaddr;
        vmmerr_t                err;

        asm_rdmsr32(MSR_IA32_VMX_PROCBASED_CTLS, &ctls_or, &ctls_and);
        if ((ctls_and & VMCS_PROC_BASED_VMEXEC_CTL_SEC_CTL_BIT) == 0 ||
            ctls_or & VMCS_PROC_BASED_VMEXEC_CTL_INVLPGEXIT_BIT) {
                return;
        }
        asm_rdmsr32(MSR_IA32_VMX_PROCBASED_CTLS2, &ctls2_or, &ctls2_and);
        if ((ctls2_and & VMCS_PROC_BASED_VMEXEC_CTL2_EPT_BIT) == 0) {
                return;
        }

        if (cpu_is_bsp()) {
                printf("Enabling EPT\n");
        }

        current->u.vt.ept_enabled = true;

        spinlock_lock(&vt_data->ept_lock);
        if (vt_data->ept_l4tbl == 0) {
                err = alloc_page(&vaddr, &vt_data->ept_l4tbl);
                if (err) {
                        panic("Failed to allocate a ept l4tbl.");
                }
                memset(vaddr, 0, PAGE_SIZE);
        }
        spinlock_unlock(&vt_data->ept_lock);

        ctls = ctls2_or | VMCS_PROC_BASED_VMEXEC_CTL2_EPT_BIT;
        asm_vmwrite(VMCS_PROC_BASED_VMEXEC_CTL2, ctls);

        asm_vmread(VMCS_PROC_BASED_VMEXEC_CTL, &ctls);
        ctls &= ~VMCS_PROC_BASED_VMEXEC_CTL_INVLPGEXIT_BIT;
        ctls |= VMCS_PROC_BASED_VMEXEC_CTL_SEC_CTL_BIT;
        asm_vmwrite(VMCS_PROC_BASED_VMEXEC_CTL, ctls);

        asm_vmwrite (VMCS_EXCEPTION_BMP, 0xffffbfff);
        asm_vmwrite (VMCS_PAGEFAULT_ERRCODE_MASK, 0);
        asm_vmwrite (VMCS_PAGEFAULT_ERRCODE_MATCH, 0xffffffff);

        asm_vmwrite64(VMCS_EPT_POINTER_ADDR,
                      vt_data->ept_l4tbl |
                      VMCS_EPT_POINTER_ADDR_WB |
                      VMCS_EPT_POINTER_ADDR_EPT_LENGTH);
}

static u64 *
vt_ept_walk(phys_t gphys, void *ept_l4tbl)
{
        u64             *tbl;
        int             offset;
        u64             *pte;
        int             cur_level;
        void            *vaddr;
        phys_t          phys;
        vmmerr_t        ret;

        tbl = ept_l4tbl;

        for (cur_level = EPT_MAX_LEVEL; cur_level >= 2; cur_level--) {
                offset = ept_offset(gphys, cur_level);
                pte = &tbl[offset];

                if ((*pte & EPT_VAILED_MASK) == 0) {
                        ret = alloc_page(&vaddr, &phys);
                        if (ret != VMMERR_SUCCESS) {
                                return NULL;
                        }
                        memset(vaddr, 0, PAGE_SIZE);

                        *pte = (phys & PAGE_MASK) |
                                EPT_READ | EPT_WRITE | EPT_EXECUTE;
                } else {
                        phys = *pte & PAGE_MASK;
                        vaddr = (void *)phys_to_virt(phys);
                }
                tbl = (u64 *)vaddr;
        };

        return tbl + ept_offset(gphys, cur_level);
}

static void
vt_ept_generate_pagefault(vmmerr_t vmmerr)
{
        bool wr, us;
        ulong linear_addr;
        ulong qual;

        asm_vmread(VMCS_EXIT_QUALIFICATION, &qual);
        if ((qual & VMCS_EXIT_QUALIFICATION_LINEAR_ADDR_VALID_BIT) == 0) {
                panic("EPT violation without linear address. qual 0x%lx",
                      qual);
        }
        wr = qual & VMCS_EXIT_QUALIFICATION_WRITE_BIT ? true : false;
        us = seg_user_mode();
        asm_vmread(VMCS_GUEST_LINEAR_ADDR, &linear_addr);
        printf("vt_ept_generate_pagefault 0x%lx wr %d us %d\n",
               linear_addr, wr, us);
        mmu_generate_pagefault(vmmerr, wr, us, linear_addr);
}

void
vt_ept_violation(void)
{
        struct vt_vm_data       *vt_data = &current->vm->vt;
        void                    *ept_l4tbl;
        u64                     *pte;
        u8                      memtype;
        phys_t                  gphys;
        phys_t                  hphys;
        vmmerr_t                ret;

        asm_vmread64(VMCS_GUEST_PHYS_ADDR, &gphys);

        mmio_lock();
        ret = mmio_pagefault(gphys);
        mmio_unlock();
        if (ret != VMMERR_NODEV) {
                if (ret == VMMERR_SUCCESS) {
                        return;
                }
                if (ret < VMMERR_PAGE_NOT_PRESENT ||
                    ret > VMMERR_PAGE_BAD_RESERVED_BIT) {
                        panic("Failed to emulate accessing to MMIO area. ret 0x%x",
                              ret);
                } 
                vt_ept_generate_pagefault(ret);
                return;
        }

        hphys = current->vm->gmm.gp2hp(gphys);
        if (hphys == GMM_NO_MAPPING) {
                ret = cpu_interpreter();
                if (ret == VMMERR_SUCCESS) {
                        return;
                }
                if (ret < VMMERR_PAGE_NOT_PRESENT ||
                    ret > VMMERR_PAGE_BAD_RESERVED_BIT) {
                        panic("Failed to emulate accessing to no mapping area. ret 0x%x",
                              ret);
                }
                vt_ept_generate_pagefault(ret);
                return;
        }

        memtype = mtrr_get_mem_type(hphys);

        spinlock_lock(&vt_data->ept_lock);
        ept_l4tbl = (void *)phys_to_virt(vt_data->ept_l4tbl);
        pte = vt_ept_walk(gphys, ept_l4tbl);

        if (*pte & EPT_VAILED_MASK) {
                if ((*pte & PAGE_MASK) != (hphys & PAGE_MASK)) {
                        panic("EPT PTE is already set. "
                              "gphys 0x%llx, hphys 0x%llx, pte 0x%llx",
                              gphys, hphys, *pte);
                }
        } else {
                *pte = (hphys & PAGE_MASK) |
                        EPT_READ | EPT_WRITE | EPT_EXECUTE |
                        EPT_MEMTYPE_TO_PTE(memtype) |
                        0x40; /* Force ept mem type for now */
        }

        spinlock_unlock(&vt_data->ept_lock);

}

void
vt_ept_pg_change(bool pg)
{
        ulong                   cr4;
        ulong                   ctls;

        if (!current->u.vt.ept_enabled) {
                return;
        }

        if (pg) {
                asm_vmread(VMCS_PROC_BASED_VMEXEC_CTL2, &ctls);
                ctls |= VMCS_PROC_BASED_VMEXEC_CTL2_EPT_BIT;
                asm_vmwrite(VMCS_PROC_BASED_VMEXEC_CTL2, ctls);

                asm_vmread(VMCS_PROC_BASED_VMEXEC_CTL, &ctls);
                ctls &= ~VMCS_PROC_BASED_VMEXEC_CTL_INVLPGEXIT_BIT;
                asm_vmwrite(VMCS_PROC_BASED_VMEXEC_CTL, ctls);

                asm_vmwrite(VMCS_EXCEPTION_BMP, 0xffffbfff);
                asm_vmwrite(VMCS_PAGEFAULT_ERRCODE_MASK, 0);
                asm_vmwrite(VMCS_PAGEFAULT_ERRCODE_MATCH, 0xffffffff);

                asm_vmwrite(VMCS_GUEST_CR3, current->u.vt.vr.cr3);
        } else {
                asm_vmread(VMCS_PROC_BASED_VMEXEC_CTL2, &ctls);
                ctls &= ~VMCS_PROC_BASED_VMEXEC_CTL2_EPT_BIT;
                asm_vmwrite(VMCS_PROC_BASED_VMEXEC_CTL2, ctls);

                asm_vmread(VMCS_PROC_BASED_VMEXEC_CTL, &ctls);
                ctls |= VMCS_PROC_BASED_VMEXEC_CTL_INVLPGEXIT_BIT;
                asm_vmwrite(VMCS_PROC_BASED_VMEXEC_CTL, ctls);

                asm_vmwrite(VMCS_EXCEPTION_BMP, 0xffffffff);
                asm_vmwrite(VMCS_PAGEFAULT_ERRCODE_MASK, 0);
                asm_vmwrite(VMCS_PAGEFAULT_ERRCODE_MATCH, 0);

                /*
                 * Guest CR3 will be updated by cpu_mmu_spt_updatecr3,
                 * so that we don't need to set guest CR3 here.
                 */
        }
        vt_read_control_reg(CONTROL_REG_CR4, &cr4);
        vt_write_control_reg(CONTROL_REG_CR4, cr4);

        vt_ept_invalidate_tlb();
}