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