vmm_ioport.c revision 268891
1263035Stychon/*- 2263035Stychon * Copyright (c) 2014 Tycho Nightingale <tycho.nightingale@pluribusnetworks.com> 3263035Stychon * All rights reserved. 4263035Stychon * 5263035Stychon * Redistribution and use in source and binary forms, with or without 6263035Stychon * modification, are permitted provided that the following conditions 7263035Stychon * are met: 8263035Stychon * 1. Redistributions of source code must retain the above copyright 9263035Stychon * notice, this list of conditions and the following disclaimer. 10263035Stychon * 2. Redistributions in binary form must reproduce the above copyright 11263035Stychon * notice, this list of conditions and the following disclaimer in the 12263035Stychon * documentation and/or other materials provided with the distribution. 13263035Stychon * 14263035Stychon * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND 15263035Stychon * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16263035Stychon * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17263035Stychon * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18263035Stychon * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19263035Stychon * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20263035Stychon * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21263035Stychon * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22263035Stychon * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23263035Stychon * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24263035Stychon * SUCH DAMAGE. 25263035Stychon */ 26263035Stychon 27263035Stychon#include <sys/cdefs.h> 28263035Stychon__FBSDID("$FreeBSD: stable/10/sys/amd64/vmm/vmm_ioport.c 268891 2014-07-19 22:06:46Z jhb $"); 29263035Stychon 30263035Stychon#include <sys/param.h> 31263035Stychon#include <sys/types.h> 32263035Stychon#include <sys/queue.h> 33263035Stychon#include <sys/cpuset.h> 34263035Stychon#include <sys/systm.h> 35263035Stychon 36263035Stychon#include <machine/vmm.h> 37263035Stychon 38263035Stychon#include "vatpic.h" 39268891Sjhb#include "vatpit.h" 40263035Stychon#include "vmm_ioport.h" 41263035Stychon 42263035Stychon#define MAX_IOPORTS 1280 43263035Stychon 44263035Stychonioport_handler_func_t ioport_handler[MAX_IOPORTS] = { 45268891Sjhb [TIMER_MODE] = vatpit_handler, 46268891Sjhb [TIMER_CNTR0] = vatpit_handler, 47268891Sjhb [TIMER_CNTR1] = vatpit_handler, 48268891Sjhb [TIMER_CNTR2] = vatpit_handler, 49268891Sjhb [NMISC_PORT] = vatpit_nmisc_handler, 50263035Stychon [IO_ICU1] = vatpic_master_handler, 51263035Stychon [IO_ICU1 + ICU_IMR_OFFSET] = vatpic_master_handler, 52263035Stychon [IO_ICU2] = vatpic_slave_handler, 53263035Stychon [IO_ICU2 + ICU_IMR_OFFSET] = vatpic_slave_handler, 54263035Stychon [IO_ELCR1] = vatpic_elc_handler, 55263035Stychon [IO_ELCR2] = vatpic_elc_handler, 56263035Stychon}; 57263035Stychon 58263035Stychonint 59263035Stychonemulate_ioport(struct vm *vm, int vcpuid, struct vm_exit *vmexit) 60263035Stychon{ 61263035Stychon ioport_handler_func_t handler; 62268891Sjhb uint32_t mask, val; 63268891Sjhb int error; 64263035Stychon 65263035Stychon if (vmexit->u.inout.port >= MAX_IOPORTS) 66263035Stychon return (-1); 67263035Stychon 68263035Stychon handler = ioport_handler[vmexit->u.inout.port]; 69263035Stychon if (handler == NULL) 70263035Stychon return (-1); 71263035Stychon 72268891Sjhb if (!vmexit->u.inout.in) { 73268891Sjhb switch (vmexit->u.inout.bytes) { 74268891Sjhb case 1: 75268891Sjhb mask = 0xff; 76268891Sjhb break; 77268891Sjhb case 2: 78268891Sjhb mask = 0xffff; 79268891Sjhb break; 80268891Sjhb default: 81268891Sjhb mask = 0xffffffff; 82268891Sjhb break; 83268891Sjhb } 84268891Sjhb val = vmexit->u.inout.eax & mask; 85268891Sjhb } 86268891Sjhb 87268891Sjhb error = (*handler)(vm, vcpuid, vmexit->u.inout.in, 88268891Sjhb vmexit->u.inout.port, vmexit->u.inout.bytes, &val); 89268891Sjhb 90268891Sjhb if (!error && vmexit->u.inout.in) { 91268891Sjhb switch (vmexit->u.inout.bytes) { 92268891Sjhb case 1: 93268891Sjhb mask = 0xff; 94268891Sjhb break; 95268891Sjhb case 2: 96268891Sjhb mask = 0xffff; 97268891Sjhb break; 98268891Sjhb default: 99268891Sjhb mask = 0xffffffff; 100268891Sjhb break; 101268891Sjhb } 102268891Sjhb vmexit->u.inout.eax &= ~mask; 103268891Sjhb vmexit->u.inout.eax |= val & mask; 104268891Sjhb } 105268891Sjhb 106268891Sjhb return (error); 107263035Stychon} 108