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>
41 SET_DECLARE(inout_port_set, struct inout_port);
43 #define MAX_IOPORTS (1 << 16)
45 #define VERIFY_IOPORT(port, size) \
46 assert((port) >= 0 && (size) > 0 && ((port) + (size)) <= MAX_IOPORTS)
53 } inout_handlers[MAX_IOPORTS];
56 default_inout(struct vmctx *ctx, int vcpu, int in, int port, int bytes,
57 uint32_t *eax, void *arg)
77 register_default_iohandler(int start, int size)
79 struct inout_port iop;
81 VERIFY_IOPORT(start, size);
83 bzero(&iop, sizeof(iop));
87 iop.flags = IOPORT_F_INOUT | IOPORT_F_DEFAULT;
88 iop.handler = default_inout;
94 emulate_inout(struct vmctx *ctx, int vcpu, int in, int port, int bytes,
95 uint32_t *eax, int strict)
102 assert(port < MAX_IOPORTS);
104 handler = inout_handlers[port].handler;
106 if (strict && handler == default_inout)
124 flags = inout_handlers[port].flags;
125 arg = inout_handlers[port].arg;
127 if ((in && (flags & IOPORT_F_IN)) || (!in && (flags & IOPORT_F_OUT)))
128 return ((*handler)(ctx, vcpu, in, port, bytes, eax, arg));
136 struct inout_port **iopp, *iop;
139 * Set up the default handler for all ports
141 register_default_iohandler(0, MAX_IOPORTS);
144 * Overwrite with specified handlers
146 SET_FOREACH(iopp, inout_port_set) {
148 assert(iop->port < MAX_IOPORTS);
149 inout_handlers[iop->port].name = iop->name;
150 inout_handlers[iop->port].flags = iop->flags;
151 inout_handlers[iop->port].handler = iop->handler;
152 inout_handlers[iop->port].arg = NULL;
157 register_inout(struct inout_port *iop)
161 VERIFY_IOPORT(iop->port, iop->size);
164 * Verify that the new registration is not overwriting an already
165 * allocated i/o range.
167 if ((iop->flags & IOPORT_F_DEFAULT) == 0) {
168 for (i = iop->port; i < iop->port + iop->size; i++) {
169 if ((inout_handlers[i].flags & IOPORT_F_DEFAULT) == 0)
174 for (i = iop->port; i < iop->port + iop->size; i++) {
175 inout_handlers[i].name = iop->name;
176 inout_handlers[i].flags = iop->flags;
177 inout_handlers[i].handler = iop->handler;
178 inout_handlers[i].arg = iop->arg;
185 unregister_inout(struct inout_port *iop)
188 VERIFY_IOPORT(iop->port, iop->size);
189 assert(inout_handlers[iop->port].name == iop->name);
191 register_default_iohandler(iop->port, iop->size);