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