sys_machdep.c revision 201269 
1/*-
2 * Copyright (c) 1990 The Regents of the University of California.
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
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.
13 * 3. Neither the name of the University nor the names of its contributors
14 *    may be used to endorse or promote products derived from this software
15 *    without specific prior written permission.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
18 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20 * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
21 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27 * SUCH DAMAGE.
28 */
29
30#include <sys/cdefs.h>
31__FBSDID("$FreeBSD: head/sys/ia64/ia64/sys_machdep.c 201269 2009-12-30 18:15:25Z marcel $");
32
33#include <sys/param.h>
34#include <sys/systm.h>
35#include <sys/sysproto.h>
36#include <sys/sysent.h>
37
38#include <machine/bus.h>
39#include <machine/cpu.h>
40#include <machine/sysarch.h>
41
42#ifndef _SYS_SYSPROTO_H_
43struct sysarch_args {
44	int op;
45	char *parms;
46};
47#endif
48
49int
50sysarch(struct thread *td, struct sysarch_args *uap)
51{
52	struct ia64_iodesc iod;
53	int error;
54
55	error = 0;
56	switch(uap->op) {
57	case IA64_IORD:
58		copyin(uap->parms, &iod, sizeof(iod));
59		switch (iod.width) {
60		case 1:
61			iod.val = inb(iod.port);
62			break;
63		case 2:
64			if (iod.port & 1) {
65				iod.val = inb(iod.port);
66				iod.val |= inb(iod.port + 1) << 8;
67			} else
68				iod.val = inw(iod.port);
69			break;
70		case 4:
71			if (iod.port & 3) {
72				if (iod.port & 1) {
73					iod.val = inb(iod.port);
74					iod.val |= inw(iod.port + 1) << 8;
75					iod.val |= inb(iod.port + 3) << 24;
76				} else {
77					iod.val = inw(iod.port);
78					iod.val |= inw(iod.port + 2) << 16;
79				}
80			} else
81				iod.val = inl(iod.port);
82			break;
83		default:
84			error = EINVAL;
85		}
86		copyout(&iod, uap->parms, sizeof(iod));
87		break;
88	case IA64_IOWR:
89		copyin(uap->parms, &iod, sizeof(iod));
90		switch (iod.width) {
91		case 1:
92			outb(iod.port, iod.val);
93			break;
94		case 2:
95			if (iod.port & 1) {
96				outb(iod.port, iod.val);
97				outb(iod.port + 1, iod.val >> 8);
98			} else
99				outw(iod.port, iod.val);
100			break;
101		case 4:
102			if (iod.port & 3) {
103				if (iod.port & 1) {
104					outb(iod.port, iod.val);
105					outw(iod.port + 1, iod.val >> 8);
106					outb(iod.port + 3, iod.val >> 24);
107				} else {
108					outw(iod.port, iod.val);
109					outw(iod.port + 2, iod.val >> 16);
110				}
111			} else
112				outl(iod.port, iod.val);
113			break;
114		default:
115			error = EINVAL;
116		}
117		break;
118	default:
119		error = EINVAL;
120		break;
121	}
122	return (error);
123}
124