Home | History | Annotate | Line # | Download | only in ioperm
ioperm.c revision 1.1 
      1 /*	$NetBSD: ioperm.c,v 1.1 2008/01/04 14:23:00 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: ioperm.c,v 1.1 2008/01/04 14:23:00 yamt Exp $");
     32 #endif /* not lint */
     33 
     34 #include <err.h>
     35 #include <signal.h>
     36 #include <setjmp.h>
     37 #include <stdbool.h>
     38 #include <stdint.h>
     39 #include <stdio.h>
     40 #include <stdlib.h>
     41 #include <string.h>
     42 #include <unistd.h>
     43 
     44 int i386_get_ioperm(unsigned long *);
     45 int i386_set_ioperm(unsigned long *);
     46 
     47 /* arbitrary port to test */
     48 #define	IO_TIMER1	0x40
     49 #define	TIMER_CNTR0	0
     50 #define	PORT	(IO_TIMER1+TIMER_CNTR0)
     51 
     52 static uint8_t
     53 inb(uint16_t port)
     54 {
     55 	uint8_t data;
     56 
     57 	__asm __volatile("inb %1, %0" : "=a"(data) : "id"(port));
     58 	return data;
     59 }
     60 
     61 sigjmp_buf env;
     62 int gotsig;
     63 
     64 static void
     65 sighandler(int sig)
     66 {
     67 
     68 	siglongjmp(env, sig);
     69 }
     70 
     71 static void
     72 try(const char *msg, bool success)
     73 {
     74 	int sig;
     75 
     76 	sig = sigsetjmp(env, 1);
     77 	if (sig == 0) {
     78 		inb(PORT);
     79 		if (!success) {
     80 			errx(EXIT_FAILURE, "%s: unexpected success of inb",
     81 			    msg);
     82 		}
     83 		return;
     84 	}
     85 	if (success) {
     86 		errx(EXIT_FAILURE, "%s: got signal %d\n", msg, sig);
     87 	}
     88 }
     89 
     90 int
     91 main(int argc, char *argv[])
     92 {
     93 	unsigned long buf[32];
     94 	unsigned long buf2[32];
     95 	int ret;
     96 	int i;
     97 
     98 	ret = i386_get_ioperm(buf);
     99 	if (ret == -1) {
    100 		err(EXIT_FAILURE, "get_ioperm 1");
    101 	}
    102 	for (i = 0; i < __arraycount(buf); i++) {
    103 		if (buf[i] != 0xffffffff) {
    104 			errx(EXIT_FAILURE, "buf[%d] == 0x%lx", i, buf[i]);
    105 		}
    106 	}
    107 
    108 	signal(SIGSEGV, sighandler);
    109 
    110 	try("1", false);
    111 
    112 	memset(buf2, 0x00, sizeof(buf2));
    113 	strcpy((char *)buf2, "foobarbaz");
    114 	buf2[PORT / 8 / sizeof(unsigned long)] &=
    115 	    ~(1 << (PORT % (8 * sizeof(unsigned long))));
    116 	ret = i386_set_ioperm(buf2);
    117 	if (ret == -1) {
    118 		err(EXIT_FAILURE, "set_ioperm 1");
    119 	}
    120 	ret = i386_get_ioperm(buf);
    121 	if (ret == -1) {
    122 		err(EXIT_FAILURE, "get_ioperm 2");
    123 	}
    124 	if (memcmp(buf, buf2, sizeof(buf))) {
    125 		errx(EXIT_FAILURE, "iomap mismatch");
    126 	}
    127 
    128 	try("2", true);
    129 
    130 	buf2[PORT / 8 / sizeof(unsigned long)] |=
    131 	    (1 << (PORT % (8 * sizeof(unsigned long))));
    132 	ret = i386_set_ioperm(buf2);
    133 	if (ret == -1) {
    134 		err(EXIT_FAILURE, "set_ioperm 3");
    135 	}
    136 
    137 	try("3", false);
    138 }
    139