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)
81 assert(port < MAX_IOPORTS);
83 handler = inout_handlers[port].handler;
85 if (strict && handler == default_inout)
103 flags = inout_handlers[port].flags;
104 arg = inout_handlers[port].arg;
106 if ((in && (flags & IOPORT_F_IN)) || (!in && (flags & IOPORT_F_OUT)))
107 return ((*handler)(ctx, vcpu, in, port, bytes, eax, arg));
115 struct inout_port **iopp, *iop;
119 * Set up the default handler for all ports
121 for (i = 0; i < MAX_IOPORTS; i++) {
122 inout_handlers[i].name = "default";
123 inout_handlers[i].flags = IOPORT_F_IN | IOPORT_F_OUT;
124 inout_handlers[i].handler = default_inout;
125 inout_handlers[i].arg = NULL;
129 * Overwrite with specified handlers
131 SET_FOREACH(iopp, inout_port_set) {
133 assert(iop->port < MAX_IOPORTS);
134 inout_handlers[iop->port].name = iop->name;
135 inout_handlers[iop->port].flags = iop->flags;
136 inout_handlers[iop->port].handler = iop->handler;
137 inout_handlers[iop->port].arg = NULL;
142 register_inout(struct inout_port *iop)
144 assert(iop->port < MAX_IOPORTS);
145 inout_handlers[iop->port].name = iop->name;
146 inout_handlers[iop->port].flags = iop->flags;
147 inout_handlers[iop->port].handler = iop->handler;
148 inout_handlers[iop->port].arg = iop->arg;