2 * Copyright (c) 2011 NetApp, Inc.
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
14 * THIS SOFTWARE IS PROVIDED BY NETAPP, INC ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL NETAPP, INC OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 #include <sys/cdefs.h>
30 __FBSDID("$FreeBSD$");
32 #include <sys/param.h>
33 #include <sys/linker_set.h>
40 SET_DECLARE(inout_port_set, struct inout_port);
42 #define MAX_IOPORTS (1 << 16)
49 } inout_handlers[MAX_IOPORTS];
52 default_inout(struct vmctx *ctx, int vcpu, int in, int port, int bytes,
53 uint32_t *eax, void *arg)
73 emulate_inout(struct vmctx *ctx, int vcpu, int in, int port, int bytes,
74 uint32_t *eax, int strict)
80 assert(port < MAX_IOPORTS);
82 handler = inout_handlers[port].handler;
84 if (strict && handler == default_inout)
87 flags = inout_handlers[port].flags;
88 arg = inout_handlers[port].arg;
90 if ((in && (flags & IOPORT_F_IN)) || (!in && (flags & IOPORT_F_OUT)))
91 return ((*handler)(ctx, vcpu, in, port, bytes, eax, arg));
99 struct inout_port **iopp, *iop;
103 * Set up the default handler for all ports
105 for (i = 0; i < MAX_IOPORTS; i++) {
106 inout_handlers[i].name = "default";
107 inout_handlers[i].flags = IOPORT_F_IN | IOPORT_F_OUT;
108 inout_handlers[i].handler = default_inout;
109 inout_handlers[i].arg = NULL;
113 * Overwrite with specified handlers
115 SET_FOREACH(iopp, inout_port_set) {
117 assert(iop->port < MAX_IOPORTS);
118 inout_handlers[iop->port].name = iop->name;
119 inout_handlers[iop->port].flags = iop->flags;
120 inout_handlers[iop->port].handler = iop->handler;
121 inout_handlers[iop->port].arg = NULL;
126 register_inout(struct inout_port *iop)
128 assert(iop->port < MAX_IOPORTS);
129 inout_handlers[iop->port].name = iop->name;
130 inout_handlers[iop->port].flags = iop->flags;
131 inout_handlers[iop->port].handler = iop->handler;
132 inout_handlers[iop->port].arg = iop->arg;