diff --git a/sys/ia64/ia64/sys_machdep.c b/sys/ia64/ia64/sys_machdep.c index aecae85bd55e..c032a8cea993 100644 --- a/sys/ia64/ia64/sys_machdep.c +++ b/sys/ia64/ia64/sys_machdep.c @@ -1,79 +1,121 @@ -/*- +/* + * Copyright (c) 2003 Marcel Moolenaar * Copyright (c) 1990 The Regents of the University of California. * 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. All advertising materials mentioning features or use of this software - * must display the following acknowledgement: - * This product includes software developed by the University of - * California, Berkeley and its contributors. - * 4. Neither the name of the University 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 REGENTS 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 REGENTS 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. - * - * from: @(#)sys_machdep.c 5.5 (Berkeley) 1/19/91 - * $FreeBSD$ - * */ +#include +__FBSDID("$FreeBSD$"); + #include #include #include #include -#include - -#include -#include -#include -#include -#include - -#include #include #include -#include /* for kernel_map */ - -#include - #ifndef _SYS_SYSPROTO_H_ struct sysarch_args { int op; char *parms; }; #endif int -sysarch(td, uap) - struct thread *td; - register struct sysarch_args *uap; +sysarch(struct thread *td, struct sysarch_args *uap) { + struct ia64_iodesc iod; int error; + error = 0; switch(uap->op) { + case IA64_IORD: + copyin(uap->parms, &iod, sizeof(iod)); + switch (iod.width) { + case 1: + iod.val = inb(iod.port); + break; + case 2: + if (iod.port & 1) { + iod.val = inb(iod.port); + iod.val |= inb(iod.port + 1) << 8; + } else + iod.val = inw(iod.port); + break; + case 4: + if (iod.port & 3) { + if (iod.port & 1) { + iod.val = inb(iod.port); + iod.val |= inw(iod.port + 1) << 8; + iod.val |= inb(iod.port + 3) << 24; + } else { + iod.val = inw(iod.port); + iod.val |= inw(iod.port + 2) << 16; + } + } else + iod.val = inl(iod.port); + break; + default: + error = EINVAL; + } + copyout(&iod, uap->parms, sizeof(iod)); + break; + case IA64_IOWR: + copyin(uap->parms, &iod, sizeof(iod)); + switch (iod.width) { + case 1: + outb(iod.port, iod.val); + break; + case 2: + if (iod.port & 1) { + outb(iod.port, iod.val); + outb(iod.port + 1, iod.val >> 8); + } else + outw(iod.port, iod.val); + break; + case 4: + if (iod.port & 3) { + if (iod.port & 1) { + outb(iod.port, iod.val); + outw(iod.port + 1, iod.val >> 8); + outb(iod.port + 3, iod.val >> 24); + } else { + outw(iod.port, iod.val); + outw(iod.port + 2, iod.val >> 16); + } + } else + outl(iod.port, iod.val); + break; + default: + error = EINVAL; + } + break; default: error = EINVAL; break; } return (error); } diff --git a/sys/ia64/include/sysarch.h b/sys/ia64/include/sysarch.h index b990bcd7b128..d4a0b01428c9 100644 --- a/sys/ia64/include/sysarch.h +++ b/sys/ia64/include/sysarch.h @@ -1,49 +1,50 @@ -/*- +/* + * Copyright (c) 2003 Marcel Moolenaar * Copyright (c) 1993 The Regents of the University of California. * 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. All advertising materials mentioning features or use of this software - * must display the following acknowledgement: - * This product includes software developed by the University of - * California, Berkeley and its contributors. - * 4. Neither the name of the University 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 REGENTS 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 REGENTS 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. * * $FreeBSD$ */ -/* - * Architecture specific syscalls (alpha) - */ #ifndef _MACHINE_SYSARCH_H_ -#define _MACHINE_SYSARCH_H_ +#define _MACHINE_SYSARCH_H_ + +#define IA64_IORD 0 +#define IA64_IOWR 1 + +struct ia64_iodesc { + int port; + int width; + unsigned long val; +}; #ifndef _KERNEL #include __BEGIN_DECLS __END_DECLS #endif #endif /* !_MACHINE_SYSARCH_H_ */