Home | History | Annotate | Line # | Download | only in wscons
wsdisplay_compat_usl.c revision 1.15.2.1
      1 /* $NetBSD: wsdisplay_compat_usl.c,v 1.15.2.1 2001/03/05 22:49:37 nathanw Exp $ */
      2 
      3 /*
      4  * Copyright (c) 1998
      5  *	Matthias Drochner.  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  * 3. All advertising materials mentioning features or use of this software
     16  *    must display the following acknowledgement:
     17  *	This product includes software developed for the NetBSD Project
     18  *	by Matthias Drochner.
     19  * 4. The name of the author may not be used to endorse or promote products
     20  *    derived from this software without specific prior written permission.
     21  *
     22  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     23  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     24  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     25  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     26  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     27  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     28  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     29  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     30  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     31  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     32  *
     33  */
     34 
     35 #include "opt_compat_freebsd.h"
     36 #include "opt_compat_netbsd.h"
     37 
     38 #include <sys/param.h>
     39 #include <sys/systm.h>
     40 #include <sys/callout.h>
     41 #include <sys/ioctl.h>
     42 #include <sys/kernel.h>
     43 #include <sys/lwp.h>
     44 #include <sys/proc.h>
     45 #include <sys/signalvar.h>
     46 #include <sys/malloc.h>
     47 #include <sys/errno.h>
     48 
     49 #include <dev/wscons/wsconsio.h>
     50 #include <dev/wscons/wsdisplayvar.h>
     51 #include <dev/wscons/wscons_callbacks.h>
     52 #include <dev/wscons/wsdisplay_usl_io.h>
     53 
     54 #include "opt_wsdisplay_compat.h"
     55 
     56 struct usl_syncdata {
     57 	struct wsscreen *s_scr;
     58 	struct proc *s_proc;
     59 	pid_t s_pid;
     60 	int s_flags;
     61 #define SF_DETACHPENDING 1
     62 #define SF_ATTACHPENDING 2
     63 	int s_acqsig, s_relsig;
     64 	int s_frsig; /* unused */
     65 	void (*s_callback) __P((void *, int, int));
     66 	void *s_cbarg;
     67 	struct callout s_attach_ch;
     68 	struct callout s_detach_ch;
     69 };
     70 
     71 static int usl_sync_init __P((struct wsscreen *, struct usl_syncdata **,
     72 			      struct proc *, int, int, int));
     73 static void usl_sync_done __P((struct usl_syncdata *));
     74 static int usl_sync_check __P((struct usl_syncdata *));
     75 static struct usl_syncdata *usl_sync_get __P((struct wsscreen *));
     76 
     77 static int usl_detachproc __P((void *, int,
     78 			       void (*)(void *, int, int), void *));
     79 static int usl_detachack __P((struct usl_syncdata *, int));
     80 static void usl_detachtimeout __P((void *));
     81 static int usl_attachproc __P((void *, int,
     82 			       void (*)(void *, int, int), void *));
     83 static int usl_attachack __P((struct usl_syncdata *, int));
     84 static void usl_attachtimeout __P((void *));
     85 
     86 static const struct wscons_syncops usl_syncops = {
     87 	usl_detachproc,
     88 	usl_attachproc,
     89 #define _usl_sync_check ((int (*) __P((void *)))usl_sync_check)
     90 	_usl_sync_check,
     91 #define _usl_sync_destroy ((void (*) __P((void *)))usl_sync_done)
     92 	_usl_sync_destroy
     93 };
     94 
     95 #ifndef WSCOMPAT_USL_SYNCTIMEOUT
     96 #define WSCOMPAT_USL_SYNCTIMEOUT 5 /* seconds */
     97 #endif
     98 static int wscompat_usl_synctimeout = WSCOMPAT_USL_SYNCTIMEOUT;
     99 
    100 static int
    101 usl_sync_init(scr, sdp, p, acqsig, relsig, frsig)
    102 	struct wsscreen *scr;
    103 	struct usl_syncdata **sdp;
    104 	struct proc *p;
    105 	int acqsig, relsig, frsig;
    106 {
    107 	struct usl_syncdata *sd;
    108 	int res;
    109 
    110 	sd = malloc(sizeof(struct usl_syncdata), M_DEVBUF, M_WAITOK);
    111 	if (!sd)
    112 		return (ENOMEM);
    113 	sd->s_scr = scr;
    114 	sd->s_proc = p;
    115 	sd->s_pid = p->p_pid;
    116 	sd->s_flags = 0;
    117 	sd->s_acqsig = acqsig;
    118 	sd->s_relsig = relsig;
    119 	sd->s_frsig = frsig;
    120 	callout_init(&sd->s_attach_ch);
    121 	callout_init(&sd->s_detach_ch);
    122 	res = wsscreen_attach_sync(scr, &usl_syncops, sd);
    123 	if (res) {
    124 		free(sd, M_DEVBUF);
    125 		return (res);
    126 	}
    127 	*sdp = sd;
    128 	return (0);
    129 }
    130 
    131 static void
    132 usl_sync_done(sd)
    133 	struct usl_syncdata *sd;
    134 {
    135 	if (sd->s_flags & SF_DETACHPENDING) {
    136 		callout_stop(&sd->s_detach_ch);
    137 		(*sd->s_callback)(sd->s_cbarg, 0, 0);
    138 	}
    139 	if (sd->s_flags & SF_ATTACHPENDING) {
    140 		callout_stop(&sd->s_attach_ch);
    141 		(*sd->s_callback)(sd->s_cbarg, ENXIO, 0);
    142 	}
    143 	wsscreen_detach_sync(sd->s_scr);
    144 	free(sd, M_DEVBUF);
    145 }
    146 
    147 static int
    148 usl_sync_check(sd)
    149 	struct usl_syncdata *sd;
    150 {
    151 	if (sd->s_proc == pfind(sd->s_pid))
    152 		return (1);
    153 	printf("usl_sync_check: process %d died\n", sd->s_pid);
    154 	usl_sync_done(sd);
    155 	return (0);
    156 }
    157 
    158 static struct usl_syncdata *
    159 usl_sync_get(scr)
    160 	struct wsscreen *scr;
    161 {
    162 	struct usl_syncdata *sd;
    163 
    164 	if (wsscreen_lookup_sync(scr, &usl_syncops, (void **)&sd))
    165 		return (0);
    166 	return (sd);
    167 }
    168 
    169 static int
    170 usl_detachproc(cookie, waitok, callback, cbarg)
    171 	void *cookie;
    172 	int waitok;
    173 	void (*callback) __P((void *, int, int));
    174 	void *cbarg;
    175 {
    176 	struct usl_syncdata *sd = cookie;
    177 
    178 	if (!usl_sync_check(sd))
    179 		return (0);
    180 
    181 	/* we really need a callback */
    182 	if (!callback)
    183 		return (EINVAL);
    184 
    185 	/*
    186 	 * Normally, this is called from the controlling process.
    187 	 * Is is supposed to reply with a VT_RELDISP ioctl(), so
    188 	 * it is not useful to tsleep() here.
    189 	 */
    190 	sd->s_callback = callback;
    191 	sd->s_cbarg = cbarg;
    192 	sd->s_flags |= SF_DETACHPENDING;
    193 	psignal(sd->s_proc, sd->s_relsig);
    194 	callout_reset(&sd->s_detach_ch, wscompat_usl_synctimeout * hz,
    195 	    usl_detachtimeout, sd);
    196 
    197 	return (EAGAIN);
    198 }
    199 
    200 static int
    201 usl_detachack(sd, ack)
    202 	struct usl_syncdata *sd;
    203 	int ack;
    204 {
    205 	if (!(sd->s_flags & SF_DETACHPENDING)) {
    206 		printf("usl_detachack: not detaching\n");
    207 		return (EINVAL);
    208 	}
    209 
    210 	callout_stop(&sd->s_detach_ch);
    211 	sd->s_flags &= ~SF_DETACHPENDING;
    212 
    213 	if (sd->s_callback)
    214 		(*sd->s_callback)(sd->s_cbarg, (ack ? 0 : EIO), 1);
    215 
    216 	return (0);
    217 }
    218 
    219 static void
    220 usl_detachtimeout(arg)
    221 	void *arg;
    222 {
    223 	struct usl_syncdata *sd = arg;
    224 
    225 	printf("usl_detachtimeout\n");
    226 
    227 	if (!(sd->s_flags & SF_DETACHPENDING)) {
    228 		printf("usl_detachtimeout: not detaching\n");
    229 		return;
    230 	}
    231 
    232 	sd->s_flags &= ~SF_DETACHPENDING;
    233 
    234 	if (sd->s_callback)
    235 		(*sd->s_callback)(sd->s_cbarg, EIO, 0);
    236 
    237 	(void) usl_sync_check(sd);
    238 }
    239 
    240 static int
    241 usl_attachproc(cookie, waitok, callback, cbarg)
    242 	void *cookie;
    243 	int waitok;
    244 	void (*callback) __P((void *, int, int));
    245 	void *cbarg;
    246 {
    247 	struct usl_syncdata *sd = cookie;
    248 
    249 	if (!usl_sync_check(sd))
    250 		return (0);
    251 
    252 	/* we really need a callback */
    253 	if (!callback)
    254 		return (EINVAL);
    255 
    256 	sd->s_callback = callback;
    257 	sd->s_cbarg = cbarg;
    258 	sd->s_flags |= SF_ATTACHPENDING;
    259 	psignal(sd->s_proc, sd->s_acqsig);
    260 	callout_reset(&sd->s_attach_ch, wscompat_usl_synctimeout * hz,
    261 	    usl_attachtimeout, sd);
    262 
    263 	return (EAGAIN);
    264 }
    265 
    266 static int
    267 usl_attachack(sd, ack)
    268 	struct usl_syncdata *sd;
    269 	int ack;
    270 {
    271 	if (!(sd->s_flags & SF_ATTACHPENDING)) {
    272 		printf("usl_attachack: not attaching\n");
    273 		return (EINVAL);
    274 	}
    275 
    276 	callout_stop(&sd->s_attach_ch);
    277 	sd->s_flags &= ~SF_ATTACHPENDING;
    278 
    279 	if (sd->s_callback)
    280 		(*sd->s_callback)(sd->s_cbarg, (ack ? 0 : EIO), 1);
    281 
    282 	return (0);
    283 }
    284 
    285 static void
    286 usl_attachtimeout(arg)
    287 	void *arg;
    288 {
    289 	struct usl_syncdata *sd = arg;
    290 
    291 	printf("usl_attachtimeout\n");
    292 
    293 	if (!(sd->s_flags & SF_ATTACHPENDING)) {
    294 		printf("usl_attachtimeout: not attaching\n");
    295 		return;
    296 	}
    297 
    298 	sd->s_flags &= ~SF_ATTACHPENDING;
    299 
    300 	if (sd->s_callback)
    301 		(*sd->s_callback)(sd->s_cbarg, EIO, 0);
    302 
    303 	(void) usl_sync_check(sd);
    304 }
    305 
    306 int
    307 wsdisplay_usl_ioctl1(sc, cmd, data, flag, p)
    308 	struct wsdisplay_softc *sc;
    309 	u_long cmd;
    310 	caddr_t data;
    311 	int flag;
    312 	struct proc *p;
    313 {
    314 	int idx, maxidx;
    315 
    316 	switch (cmd) {
    317 	    case VT_OPENQRY:
    318 		maxidx = wsdisplay_maxscreenidx(sc);
    319 		for (idx = 0; idx <= maxidx; idx++) {
    320 			if (wsdisplay_screenstate(sc, idx) == 0) {
    321 				*(int *)data = idx + 1;
    322 				return (0);
    323 			}
    324 		}
    325 		return (ENXIO);
    326 	    case VT_GETACTIVE:
    327 		idx = wsdisplay_getactivescreen(sc);
    328 		*(int *)data = idx + 1;
    329 		return (0);
    330 	    case VT_ACTIVATE:
    331 		idx = *(int *)data - 1;
    332 		if (idx < 0)
    333 			return (EINVAL);
    334 		return (wsdisplay_switch((struct device *)sc, idx, 1));
    335 	    case VT_WAITACTIVE:
    336 		idx = *(int *)data - 1;
    337 		if (idx < 0)
    338 			return (EINVAL);
    339 		return (wsscreen_switchwait(sc, idx));
    340 	    case VT_GETSTATE:
    341 #define ss ((struct vt_stat *)data)
    342 		idx = wsdisplay_getactivescreen(sc);
    343 		ss->v_active = idx + 1;
    344 		ss->v_state = 0;
    345 		maxidx = wsdisplay_maxscreenidx(sc);
    346 		for (idx = 0; idx <= maxidx; idx++)
    347 			if (wsdisplay_screenstate(sc, idx) == EBUSY)
    348 				ss->v_state |= (1 << (idx + 1));
    349 #undef s
    350 		return (0);
    351 
    352 #ifdef WSDISPLAY_COMPAT_PCVT
    353 	    case VGAPCVTID:
    354 #define id ((struct pcvtid *)data)
    355 		strcpy(id->name, "pcvt");
    356 		id->rmajor = 3;
    357 		id->rminor = 32;
    358 #undef id
    359 		return (0);
    360 #endif
    361 #ifdef WSDISPLAY_COMPAT_SYSCONS
    362 	    case CONS_GETVERS:
    363 		*(int *)data = 0x200;    /* version 2.0 */
    364 		return (0);
    365 #endif
    366 
    367 	    default:
    368 		return (-1);
    369 	}
    370 
    371 	return (0);
    372 }
    373 
    374 int
    375 wsdisplay_usl_ioctl2(sc, scr, cmd, data, flag, p)
    376 	struct wsdisplay_softc *sc;
    377 	struct wsscreen *scr;
    378 	u_long cmd;
    379 	caddr_t data;
    380 	int flag;
    381 	struct proc *p;
    382 {
    383 	int intarg, res;
    384 	u_long req;
    385 	void *arg;
    386 	struct usl_syncdata *sd;
    387 	struct wskbd_bell_data bd;
    388 
    389 	switch (cmd) {
    390 	    case VT_SETMODE:
    391 #define newmode ((struct vt_mode *)data)
    392 		if (newmode->mode == VT_PROCESS) {
    393 			res = usl_sync_init(scr, &sd, p, newmode->acqsig,
    394 					    newmode->relsig, newmode->frsig);
    395 			if (res)
    396 				return (res);
    397 		} else {
    398 			sd = usl_sync_get(scr);
    399 			if (sd)
    400 				usl_sync_done(sd);
    401 		}
    402 #undef newmode
    403 		return (0);
    404 	    case VT_GETMODE:
    405 #define cmode ((struct vt_mode *)data)
    406 		sd = usl_sync_get(scr);
    407 		if (sd) {
    408 			cmode->mode = VT_PROCESS;
    409 			cmode->relsig = sd->s_relsig;
    410 			cmode->acqsig = sd->s_acqsig;
    411 			cmode->frsig = sd->s_frsig;
    412 		} else
    413 			cmode->mode = VT_AUTO;
    414 #undef cmode
    415 		return (0);
    416 	    case VT_RELDISP:
    417 #define d (*(int *)data)
    418 		sd = usl_sync_get(scr);
    419 		if (!sd)
    420 			return (EINVAL);
    421 		switch (d) {
    422 		    case VT_FALSE:
    423 		    case VT_TRUE:
    424 			return (usl_detachack(sd, (d == VT_TRUE)));
    425 		    case VT_ACKACQ:
    426 			return (usl_attachack(sd, 1));
    427 		    default:
    428 			return (EINVAL);
    429 		}
    430 #undef d
    431 		return (0);
    432 
    433 	    case KDENABIO:
    434 		if (suser(p->p_ucred, &p->p_acflag) || securelevel > 1)
    435 			return (EPERM);
    436 		/* FALLTHRU */
    437 	    case KDDISABIO:
    438 #if defined(__i386__)
    439 #if defined(COMPAT_10) || defined(COMPAT_11) || defined(COMPAT_FREEBSD)
    440 		{
    441 			/* XXX NJWLWP */
    442 		struct trapframe *fp = (struct trapframe *)curproc->l_md.md_regs;
    443 		if (cmd == KDENABIO)
    444 			fp->tf_eflags |= PSL_IOPL;
    445 		else
    446 			fp->tf_eflags &= ~PSL_IOPL;
    447 		}
    448 #endif
    449 #endif
    450 		return (0);
    451 	    case KDSETRAD:
    452 		/* XXX ignore for now */
    453 		return (0);
    454 
    455 	    default:
    456 		return (-1);
    457 
    458 	    /*
    459 	     * the following are converted to wsdisplay ioctls
    460 	     */
    461 	    case KDSETMODE:
    462 		req = WSDISPLAYIO_SMODE;
    463 #define d (*(int *)data)
    464 		switch (d) {
    465 		    case KD_GRAPHICS:
    466 			intarg = WSDISPLAYIO_MODE_MAPPED;
    467 			break;
    468 		    case KD_TEXT:
    469 			intarg = WSDISPLAYIO_MODE_EMUL;
    470 			break;
    471 		    default:
    472 			return (EINVAL);
    473 		}
    474 #undef d
    475 		arg = &intarg;
    476 		break;
    477 	    case KDMKTONE:
    478 		req = WSKBDIO_COMPLEXBELL;
    479 #define d (*(int *)data)
    480 		if (d) {
    481 #define PCVT_SYSBEEPF	1193182
    482 			if (d >> 16) {
    483 				bd.which = WSKBD_BELL_DOPERIOD;
    484 				bd.period = d >> 16; /* ms */
    485 			}
    486 			else
    487 				bd.which = 0;
    488 			if (d & 0xffff) {
    489 				bd.which |= WSKBD_BELL_DOPITCH;
    490 				bd.pitch = PCVT_SYSBEEPF/(d & 0xffff); /* Hz */
    491 			}
    492 		} else
    493 			bd.which = 0; /* default */
    494 #undef d
    495 		arg = &bd;
    496 		break;
    497 	    case KDSETLED:
    498 		req = WSKBDIO_SETLEDS;
    499 		intarg = 0;
    500 #define d (*(int *)data)
    501 		if (d & LED_CAP)
    502 			intarg |= WSKBD_LED_CAPS;
    503 		if (d & LED_NUM)
    504 			intarg |= WSKBD_LED_NUM;
    505 		if (d & LED_SCR)
    506 			intarg |= WSKBD_LED_SCROLL;
    507 #undef d
    508 		arg = &intarg;
    509 		break;
    510 	    case KDGETLED:
    511 		req = WSKBDIO_GETLEDS;
    512 		arg = &intarg;
    513 		break;
    514 #ifdef WSDISPLAY_COMPAT_RAWKBD
    515 	    case KDSKBMODE:
    516 		req = WSKBDIO_SETMODE;
    517 		switch (*(int *)data) {
    518 		    case K_RAW:
    519 			intarg = WSKBD_RAW;
    520 			break;
    521 		    case K_XLATE:
    522 			intarg = WSKBD_TRANSLATED;
    523 			break;
    524 		    default:
    525 			return (EINVAL);
    526 		}
    527 		arg = &intarg;
    528 		break;
    529 	    case KDGKBMODE:
    530 		req = WSKBDIO_GETMODE;
    531 		arg = &intarg;
    532 		break;
    533 #endif
    534 	}
    535 
    536 	res = wsdisplay_internal_ioctl(sc, scr, req, arg, flag, p);
    537 	if (res)
    538 		return (res);
    539 
    540 	switch (cmd) {
    541 	    case KDGETLED:
    542 #define d (*(int *)data)
    543 		d = 0;
    544 		if (intarg & WSKBD_LED_CAPS)
    545 			d |= LED_CAP;
    546 		if (intarg & WSKBD_LED_NUM)
    547 			d |= LED_NUM;
    548 		if (intarg & WSKBD_LED_SCROLL)
    549 			d |= LED_SCR;
    550 #undef d
    551 		break;
    552 #ifdef WSDISPLAY_COMPAT_RAWKBD
    553 	    case KDGKBMODE:
    554 		*(int *)data = (intarg == WSKBD_RAW ? K_RAW : K_XLATE);
    555 		break;
    556 #endif
    557 	}
    558 
    559 	return (0);
    560 }
    561