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$");
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/cpu.h>
39 #include <machine/sysarch.h>
40
41 #ifndef _SYS_SYSPROTO_H_
42 struct sysarch_args {
43 int op;
44 char *parms;
45 };
46 #endif
47
48 int
49 sysarch(struct thread *td, struct sysarch_args *uap)
50 {
51 struct ia64_iodesc iod;
52 int error;
53
54 error = 0;
55 switch(uap->op) {
56 case IA64_IORD:
57 copyin(uap->parms, &iod, sizeof(iod));
58 switch (iod.width) {
59 case 1:
60 iod.val = inb(iod.port);
61 break;
62 case 2:
63 if (iod.port & 1) {
64 iod.val = inb(iod.port);
65 iod.val |= inb(iod.port + 1) << 8;
66 } else
67 iod.val = inw(iod.port);
68 break;
69 case 4:
70 if (iod.port & 3) {
71 if (iod.port & 1) {
72 iod.val = inb(iod.port);
73 iod.val |= inw(iod.port + 1) << 8;
74 iod.val |= inb(iod.port + 3) << 24;
75 } else {
76 iod.val = inw(iod.port);
77 iod.val |= inw(iod.port + 2) << 16;
78 }
79 } else
80 iod.val = inl(iod.port);
81 break;
82 default:
83 error = EINVAL;
84 }
85 copyout(&iod, uap->parms, sizeof(iod));
86 break;
87 case IA64_IOWR:
88 copyin(uap->parms, &iod, sizeof(iod));
89 switch (iod.width) {
90 case 1:
91 outb(iod.port, iod.val);
92 break;
93 case 2:
94 if (iod.port & 1) {
95 outb(iod.port, iod.val);
96 outb(iod.port + 1, iod.val >> 8);
97 } else
98 outw(iod.port, iod.val);
99 break;
100 case 4:
101 if (iod.port & 3) {
102 if (iod.port & 1) {
103 outb(iod.port, iod.val);
104 outw(iod.port + 1, iod.val >> 8);
105 outb(iod.port + 3, iod.val >> 24);
106 } else {
107 outw(iod.port, iod.val);
108 outw(iod.port + 2, iod.val >> 16);
109 }
110 } else
111 outl(iod.port, iod.val);
112 break;
113 default:
114 error = EINVAL;
115 }
116 break;
117 default:
118 error = EINVAL;
119 break;
120 }
121 return (error);
122 }
Cache object: f8cbe07f4890ff4eea3c73620bb3c819
|