Home | History | Annotate | Line # | Download | only in iopl 
      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
     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
     66 sighandler(int sig)
     67 {
     68 
     69 	siglongjmp(env, sig);
     70 }
     71 
     72 static void
     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
     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