1 /* $NetBSD: iopl.c,v 1.2 2008/01/04 16:18:52 yamt Exp $ */
2
3 /*-
4 * Copyright (c)2008 YAMAMOTO Takashi,
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 */
28
29 #include <sys/cdefs.h>
30 #ifndef lint
31 __RCSID("$NetBSD: iopl.c,v 1.2 2008/01/04 16:18:52 yamt Exp $");
32 #endif /* not lint */
33
34 #include <sys/types.h>
35
36 #include <machine/sysarch.h>
37
38 #include <err.h>
39 #include <signal.h>
40 #include <setjmp.h>
41 #include <stdbool.h>
42 #include <stdint.h>
43 #include <stdio.h>
44 #include <stdlib.h>
45 #include <string.h>
46 #include <unistd.h>
47
48 /* arbitrary port to test */
49 #define IO_TIMER1 0x40
50 #define TIMER_CNTR0 0
51 #define PORT (IO_TIMER1+TIMER_CNTR0)
52
53 static uint8_t
inb(uint16_t port)54 inb(uint16_t port)
55 {
56 uint8_t data;
57
58 __asm __volatile("inb %1, %0" : "=a"(data) : "id"(port));
59 return data;
60 }
61
62 sigjmp_buf env;
63 int gotsig;
64
65 static void
sighandler(int sig)66 sighandler(int sig)
67 {
68
69 siglongjmp(env, sig);
70 }
71
72 static void
try(const char * msg,bool success)73 try(const char *msg, bool success)
74 {
75 int sig;
76
77 sig = sigsetjmp(env, 1);
78 if (sig == 0) {
79 inb(PORT);
80 if (!success) {
81 errx(EXIT_FAILURE, "%s: unexpected success of inb",
82 msg);
83 }
84 return;
85 }
86 if (success) {
87 errx(EXIT_FAILURE, "%s: got signal %d\n", msg, sig);
88 }
89 }
90
91 int
main(int argc,char * argv[])92 main(int argc, char *argv[])
93 {
94 int ret;
95
96 signal(SIGSEGV, sighandler);
97
98 try("1", false);
99 sleep(1);
100
101 ret = i386_iopl(3);
102 if (ret == -1) {
103 err(EXIT_FAILURE, "iopl 1");
104 }
105
106 sleep(1);
107 try("2", true);
108 sleep(1);
109
110 ret = i386_iopl(0);
111 if (ret == -1) {
112 err(EXIT_FAILURE, "iopl 2");
113 }
114
115 sleep(1);
116 try("3", false);
117 }
118