/* $NetBSD: wsdisplay_compat_usl.c,v 1.4 1998/06/25 22:50:31 thorpej Exp $ */ /* * Copyright (c) 1998 * Matthias Drochner. All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. All advertising materials mentioning features or use of this software * must display the following acknowledgement: * This product includes software developed for the NetBSD Project * by Matthias Drochner. * 4. The name of the author may not be used to endorse or promote products * derived from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. * */ #include "opt_compat_freebsd.h" #include #include #include #include #include #include #include #include #include #include #include #include #include "opt_wsdisplay_compat.h" struct usl_syncdata { struct wsscreen *s_scr; struct proc *s_proc; pid_t s_pid; int s_flags; #define SF_DETACHPENDING 1 #define SF_ATTACHPENDING 2 int s_acqsig, s_relsig; int s_frsig; /* unused */ void (*s_callback) __P((void *, int)); void *s_cbarg; }; static int usl_sync_init __P((struct wsscreen *, struct usl_syncdata **, struct proc *, int, int, int)); static void usl_sync_done __P((struct usl_syncdata *)); static int usl_sync_check __P((struct usl_syncdata *)); static struct usl_syncdata *usl_sync_get __P((struct wsscreen *)); static int usl_detachproc __P((void *, int, void (*)(void *, int), void *)); static int usl_detachack __P((struct usl_syncdata *, int)); static void usl_detachtimeout __P((void *)); static int usl_attachproc __P((void *, int)); static int usl_attachack __P((struct usl_syncdata *, int)); static void usl_attachtimeout __P((void *)); static const struct wscons_syncops usl_syncops = { usl_detachproc, usl_attachproc, #define _usl_sync_check ((int (*) __P((void *)))usl_sync_check) _usl_sync_check, #define _usl_sync_destroy ((void (*) __P((void *)))usl_sync_done) _usl_sync_destroy }; static int usl_sync_init(scr, sdp, p, acqsig, relsig, frsig) struct wsscreen *scr; struct usl_syncdata **sdp; struct proc *p; int acqsig, relsig, frsig; { struct usl_syncdata *sd; int res; sd = malloc(sizeof(struct usl_syncdata), M_DEVBUF, M_WAITOK); if (!sd) return (ENOMEM); sd->s_scr = scr; sd->s_proc = p; sd->s_pid = p->p_pid; sd->s_flags = 0; sd->s_acqsig = acqsig; sd->s_relsig = relsig; sd->s_frsig = frsig; res = wsscreen_attach_sync(scr, &usl_syncops, sd); if (res) { free(sd, M_DEVBUF); return (res); } *sdp = sd; return (0); } static void usl_sync_done(sd) struct usl_syncdata *sd; { if (sd->s_flags & SF_DETACHPENDING) { untimeout(usl_detachtimeout, sd); (*sd->s_callback)(sd->s_cbarg, 0); } if (sd->s_flags & SF_ATTACHPENDING) untimeout(usl_attachtimeout, sd); wsscreen_detach_sync(sd->s_scr); free(sd, M_DEVBUF); } static int usl_sync_check(sd) struct usl_syncdata *sd; { if (sd->s_proc == pfind(sd->s_pid)) return (1); printf("usl_sync_check: process %d died\n", sd->s_pid); usl_sync_done(sd); return (0); } static struct usl_syncdata * usl_sync_get(scr) struct wsscreen *scr; { struct usl_syncdata *sd; if (wsscreen_lookup_sync(scr, &usl_syncops, (void **)&sd)) return (0); return (sd); } static int usl_detachproc(cookie, waitok, callback, cbarg) void *cookie; int waitok; void (*callback) __P((void *, int)); void *cbarg; { struct usl_syncdata *sd = cookie; if (!usl_sync_check(sd)) return (0); /* * Normally, this is called from the controlling process. * Is is supposed to reply with a VT_RELDISP ioctl(), so * it is not useful to tsleep() here. */ sd->s_callback = callback; sd->s_cbarg = cbarg; sd->s_flags |= SF_DETACHPENDING; psignal(sd->s_proc, sd->s_relsig); timeout(usl_detachtimeout, sd, 5*hz); return (EAGAIN); } static int usl_detachack(sd, ack) struct usl_syncdata *sd; int ack; { if (!(sd->s_flags & SF_DETACHPENDING)) { printf("usl_detachack: not detaching\n"); return (EINVAL); } untimeout(usl_detachtimeout, sd); sd->s_flags &= ~SF_DETACHPENDING; if (ack && sd->s_callback) (*sd->s_callback)(sd->s_cbarg, 1); return (0); } static void usl_detachtimeout(arg) void *arg; { struct usl_syncdata *sd = arg; printf("usl_detachtimeout\n"); if (!(sd->s_flags & SF_DETACHPENDING)) { printf("usl_detachtimeout: not detaching\n"); return; } sd->s_flags &= ~SF_DETACHPENDING; #if 0 psignal(sd->s_proc, SIGKILL); #endif (void) usl_sync_check(sd); } static int usl_attachproc(cookie, waitok) void *cookie; int waitok; { struct usl_syncdata *sd = cookie; if (!usl_sync_check(sd)) return (0); sd->s_flags |= SF_ATTACHPENDING; psignal(sd->s_proc, sd->s_acqsig); timeout(usl_attachtimeout, sd, 5*hz); return (EAGAIN); } static int usl_attachack(sd, ack) struct usl_syncdata *sd; int ack; { if (!(sd->s_flags & SF_ATTACHPENDING)) { printf("usl_attachack: not attaching\n"); return (EINVAL); } untimeout(usl_attachtimeout, sd); sd->s_flags &= ~SF_ATTACHPENDING; return (0); } static void usl_attachtimeout(arg) void *arg; { struct usl_syncdata *sd = arg; printf("usl_attachtimeout\n"); if (!(sd->s_flags & SF_ATTACHPENDING)) { printf("usl_attachtimeout: not attaching\n"); return; } sd->s_flags &= ~SF_ATTACHPENDING; #if 0 psignal(sd->s_proc, SIGKILL); #endif (void) usl_sync_check(sd); } int wsdisplay_usl_ioctl(sc, scr, cmd, data, flag, p) struct wsdisplay_softc *sc; struct wsscreen *scr; u_long cmd; caddr_t data; int flag; struct proc *p; { int res, idx, maxidx; struct usl_syncdata *sd; int req, intarg; struct wskbd_bell_data bd; void *arg; switch (cmd) { case VT_SETMODE: #define newmode ((struct vt_mode *)data) if (newmode->mode == VT_PROCESS) { res = usl_sync_init(scr, &sd, p, newmode->acqsig, newmode->relsig, newmode->frsig); if (res) return (res); } else { sd = usl_sync_get(scr); if (sd) usl_sync_done(sd); } #undef newmode return (0); case VT_GETMODE: #define cmode ((struct vt_mode *)data) sd = usl_sync_get(scr); if (sd) { cmode->mode = VT_PROCESS; cmode->relsig = sd->s_relsig; cmode->acqsig = sd->s_acqsig; cmode->frsig = sd->s_frsig; } else cmode->mode = VT_AUTO; #undef cmode return (0); case VT_RELDISP: #define d (*(int *)data) sd = usl_sync_get(scr); if (!sd) return (EINVAL); switch (d) { case VT_FALSE: case VT_TRUE: return (usl_detachack(sd, (d == VT_TRUE))); case VT_ACKACQ: return (usl_attachack(sd, 1)); default: return (EINVAL); } #undef d return (0); case VT_OPENQRY: maxidx = wsdisplay_maxscreenidx(sc); for (idx = 0; idx <= maxidx; idx++) { if (wsdisplay_screenstate(sc, idx) == 0) { *(int *)data = idx + 1; return (0); } } return (ENXIO); case VT_GETACTIVE: idx = wsdisplay_getactivescreen(sc); *(int *)data = idx + 1; return (0); case VT_ACTIVATE: idx = *(int *)data - 1; return (wsdisplay_switch((struct device *)sc, idx, 1)); case VT_WAITACTIVE: idx = *(int *)data - 1; return (wsscreen_switchwait(sc, idx)); case VT_GETSTATE: #define ss ((struct vt_stat *)data) idx = wsdisplay_getactivescreen(sc); ss->v_active = idx + 1; ss->v_state = 0; maxidx = wsdisplay_maxscreenidx(sc); for (idx = 0; idx <= maxidx; idx++) if (wsdisplay_screenstate(sc, idx) == EBUSY) ss->v_state |= (1 << (idx + 1)); #undef s return (0); case KDENABIO: if (suser(p->p_ucred, &p->p_acflag) || securelevel > 1) return (EPERM); /* FALLTHRU */ case KDDISABIO: #if defined(__i386__) #if defined(COMPAT_10) || defined(COMPAT_11) || defined(COMPAT_FREEBSD) { struct trapframe *fp = (struct trapframe *)p->p_md.md_regs; if (cmd == KDENABIO) fp->tf_eflags |= PSL_IOPL; else fp->tf_eflags &= ~PSL_IOPL; } #endif #endif return (0); case KDSETRAD: /* XXX ignore for now */ return (0); #ifdef WSDISPLAY_COMPAT_PCVT case VGAPCVTID: #define id ((struct pcvtid *)data) strcpy(id->name, "pcvt"); id->rmajor = 3; id->rminor = 32; #undef id return (0); #endif #ifdef WSDISPLAY_COMPAT_SYSCONS case CONS_GETVERS: *(int *)data = 0x200; /* version 2.0 */ return (0); #endif default: return (-1); /* * the following are converted to wsdisplay ioctls */ case KDSETMODE: req = WSDISPLAYIO_SMODE; #define d (*(int *)data) switch (d) { case KD_GRAPHICS: intarg = WSDISPLAYIO_MODE_MAPPED; break; case KD_TEXT: intarg = WSDISPLAYIO_MODE_EMUL; break; default: return (EINVAL); } #undef d arg = &intarg; break; case KDMKTONE: req = WSKBDIO_COMPLEXBELL; #define d (*(int *)data) if (d) { bd.which = WSKBD_BELL_DOPITCH | WSKBD_BELL_DOPERIOD; bd.pitch = d & 0xffff; /* Hz */ bd.period = d >> 16; /* ms */ } else bd.which = 0; /* default */ #undef d arg = &bd; break; case KDSETLED: req = WSKBDIO_SETLEDS; intarg = 0; #define d (*(int *)data) if (d & LED_CAP) intarg |= WSKBD_LED_CAPS; if (d & LED_NUM) intarg |= WSKBD_LED_NUM; if (d & LED_SCR) intarg |= WSKBD_LED_SCROLL; #undef d arg = &intarg; break; case KDGETLED: req = WSKBDIO_GETLEDS; arg = &intarg; break; #ifdef WSDISPLAY_COMPAT_RAWKBD case KDSKBMODE: req = WSKBDIO_SETMODE; switch (*(int *)data) { case K_RAW: intarg = WSKBD_RAW; break; case K_XLATE: intarg = WSKBD_TRANSLATED; break; default: return (EINVAL); } arg = &intarg; break; case KDGKBMODE: req = WSKBDIO_GETMODE; arg = &intarg; break; #endif } res = wsdisplay_internal_ioctl(sc, scr, req, arg, flag, p); if (res) return (res); switch (cmd) { case KDGETLED: #define d (*(int *)data) d = 0; if (intarg & WSKBD_LED_CAPS) d |= LED_CAP; if (intarg & WSKBD_LED_NUM) d |= LED_NUM; if (intarg & WSKBD_LED_SCROLL) d |= LED_SCR; #undef d break; #ifdef WSDISPLAY_COMPAT_RAWKBD case KDGKBMODE: *(int *)data = (intarg == WSKBD_RAW ? K_RAW : K_XLATE); break; #endif } return (0); }