1 /*- 2 * Copyright (c) 2009, 2013 The FreeBSD Foundation 3 * All rights reserved. 4 * 5 * This software was developed by Ed Schouten under sponsorship from the 6 * FreeBSD Foundation. 7 * 8 * Portions of this software were developed by Oleksandr Rybalko 9 * under sponsorship from the FreeBSD Foundation. 10 * 11 * Redistribution and use in source and binary forms, with or without 12 * modification, are permitted provided that the following conditions 13 * are met: 14 * 1. Redistributions of source code must retain the above copyright 15 * notice, this list of conditions and the following disclaimer. 16 * 2. Redistributions in binary form must reproduce the above copyright 17 * notice, this list of conditions and the following disclaimer in the 18 * documentation and/or other materials provided with the distribution. 19 * 20 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 21 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 22 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 23 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 24 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 25 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 26 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 27 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 28 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 29 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 30 * SUCH DAMAGE. 31 */ 32 33 #include <sys/cdefs.h> 34 __FBSDID("$FreeBSD$"); 35 36 #include "opt_compat.h" 37 38 #include <sys/param.h> 39 #include <sys/consio.h> 40 #include <sys/eventhandler.h> 41 #include <sys/fbio.h> 42 #include <sys/kbio.h> 43 #include <sys/kdb.h> 44 #include <sys/kernel.h> 45 #include <sys/lock.h> 46 #include <sys/malloc.h> 47 #include <sys/mutex.h> 48 #include <sys/power.h> 49 #include <sys/priv.h> 50 #include <sys/proc.h> 51 #include <sys/reboot.h> 52 #include <sys/systm.h> 53 #include <sys/terminal.h> 54 55 #include <dev/kbd/kbdreg.h> 56 #include <dev/vt/vt.h> 57 58 #if defined(__i386__) || defined(__amd64__) 59 #include <machine/psl.h> 60 #include <machine/frame.h> 61 #endif 62 63 static tc_bell_t vtterm_bell; 64 static tc_cursor_t vtterm_cursor; 65 static tc_putchar_t vtterm_putchar; 66 static tc_fill_t vtterm_fill; 67 static tc_copy_t vtterm_copy; 68 static tc_param_t vtterm_param; 69 static tc_done_t vtterm_done; 70 71 static tc_cnprobe_t vtterm_cnprobe; 72 static tc_cngetc_t vtterm_cngetc; 73 74 static tc_cngrab_t vtterm_cngrab; 75 static tc_cnungrab_t vtterm_cnungrab; 76 77 static tc_opened_t vtterm_opened; 78 static tc_ioctl_t vtterm_ioctl; 79 static tc_mmap_t vtterm_mmap; 80 81 const struct terminal_class vt_termclass = { 82 .tc_bell = vtterm_bell, 83 .tc_cursor = vtterm_cursor, 84 .tc_putchar = vtterm_putchar, 85 .tc_fill = vtterm_fill, 86 .tc_copy = vtterm_copy, 87 .tc_param = vtterm_param, 88 .tc_done = vtterm_done, 89 90 .tc_cnprobe = vtterm_cnprobe, 91 .tc_cngetc = vtterm_cngetc, 92 93 .tc_cngrab = vtterm_cngrab, 94 .tc_cnungrab = vtterm_cnungrab, 95 96 .tc_opened = vtterm_opened, 97 .tc_ioctl = vtterm_ioctl, 98 .tc_mmap = vtterm_mmap, 99 }; 100 101 /* 102 * Use a constant timer of 25 Hz to redraw the screen. 103 * 104 * XXX: In theory we should only fire up the timer when there is really 105 * activity. Unfortunately we cannot always start timers. We really 106 * don't want to process kernel messages synchronously, because it 107 * really slows down the system. 108 */ 109 #define VT_TIMERFREQ 25 110 111 /* Bell pitch/duration. */ 112 #define VT_BELLDURATION ((5 * hz + 99) / 100) 113 #define VT_BELLPITCH 800 114 115 #define VT_LOCK(vd) mtx_lock(&(vd)->vd_lock) 116 #define VT_UNLOCK(vd) mtx_unlock(&(vd)->vd_lock) 117 #define VT_LOCK_ASSERT(vd, what) mtx_assert(&(vd)->vd_lock, what) 118 119 #define VT_UNIT(vw) ((vw)->vw_device->vd_unit * VT_MAXWINDOWS + \ 120 (vw)->vw_number) 121 122 static SYSCTL_NODE(_kern, OID_AUTO, vt, CTLFLAG_RD, 0, "vt(9) parameters"); 123 VT_SYSCTL_INT(enable_altgr, 1, "Enable AltGr key (Do not assume R.Alt as Alt)"); 124 VT_SYSCTL_INT(enable_bell, 1, "Enable bell"); 125 VT_SYSCTL_INT(debug, 0, "vt(9) debug level"); 126 VT_SYSCTL_INT(deadtimer, 15, "Time to wait busy process in VT_PROCESS mode"); 127 VT_SYSCTL_INT(suspendswitch, 1, "Switch to VT0 before suspend"); 128 129 /* Allow to disable some keyboard combinations. */ 130 VT_SYSCTL_INT(kbd_halt, 1, "Enable halt keyboard combination. " 131 "See kbdmap(5) to configure."); 132 VT_SYSCTL_INT(kbd_poweroff, 1, "Enable Power Off keyboard combination. " 133 "See kbdmap(5) to configure."); 134 VT_SYSCTL_INT(kbd_reboot, 1, "Enable reboot keyboard combination. " 135 "See kbdmap(5) to configure (typically Ctrl-Alt-Delete)."); 136 VT_SYSCTL_INT(kbd_debug, 1, "Enable key combination to enter debugger. " 137 "See kbdmap(5) to configure (typically Ctrl-Alt-Esc)."); 138 VT_SYSCTL_INT(kbd_panic, 0, "Enable request to panic. " 139 "See kbdmap(5) to configure."); 140 141 static struct vt_device vt_consdev; 142 static unsigned int vt_unit = 0; 143 static MALLOC_DEFINE(M_VT, "vt", "vt device"); 144 struct vt_device *main_vd = &vt_consdev; 145 146 /* Boot logo. */ 147 extern unsigned int vt_logo_width; 148 extern unsigned int vt_logo_height; 149 extern unsigned int vt_logo_depth; 150 extern unsigned char vt_logo_image[]; 151 152 /* Font. */ 153 extern struct vt_font vt_font_default; 154 #ifndef SC_NO_CUTPASTE 155 extern struct vt_mouse_cursor vt_default_mouse_pointer; 156 #endif 157 158 static int signal_vt_rel(struct vt_window *); 159 static int signal_vt_acq(struct vt_window *); 160 static int finish_vt_rel(struct vt_window *, int, int *); 161 static int finish_vt_acq(struct vt_window *); 162 static int vt_window_switch(struct vt_window *); 163 static int vt_late_window_switch(struct vt_window *); 164 static int vt_proc_alive(struct vt_window *); 165 static void vt_resize(struct vt_device *); 166 static void vt_update_static(void *); 167 #ifndef SC_NO_CUTPASTE 168 static void vt_mouse_paste(void); 169 #endif 170 static void vt_suspend_handler(void *priv); 171 static void vt_resume_handler(void *priv); 172 173 SET_DECLARE(vt_drv_set, struct vt_driver); 174 175 #define _VTDEFH MAX(100, PIXEL_HEIGHT(VT_FB_DEFAULT_HEIGHT)) 176 #define _VTDEFW MAX(200, PIXEL_WIDTH(VT_FB_DEFAULT_WIDTH)) 177 178 static struct terminal vt_consterm; 179 static struct vt_window vt_conswindow; 180 static struct vt_device vt_consdev = { 181 .vd_driver = NULL, 182 .vd_softc = NULL, 183 .vd_prev_driver = NULL, 184 .vd_prev_softc = NULL, 185 .vd_flags = VDF_INVALID, 186 .vd_windows = { [VT_CONSWINDOW] = &vt_conswindow, }, 187 .vd_curwindow = &vt_conswindow, 188 .vd_kbstate = 0, 189 190 #ifndef SC_NO_CUTPASTE 191 .vd_pastebuf = { 192 .vpb_buf = NULL, 193 .vpb_bufsz = 0, 194 .vpb_len = 0 195 }, 196 .vd_mcursor = &vt_default_mouse_pointer, 197 .vd_mcursor_fg = TC_WHITE, 198 .vd_mcursor_bg = TC_BLACK, 199 #endif 200 }; 201 static term_char_t vt_constextbuf[(_VTDEFW) * (VBF_DEFAULT_HISTORY_SIZE)]; 202 static term_char_t *vt_constextbufrows[VBF_DEFAULT_HISTORY_SIZE]; 203 static struct vt_window vt_conswindow = { 204 .vw_number = VT_CONSWINDOW, 205 .vw_flags = VWF_CONSOLE, 206 .vw_buf = { 207 .vb_buffer = &vt_constextbuf[0], 208 .vb_rows = &vt_constextbufrows[0], 209 .vb_history_size = VBF_DEFAULT_HISTORY_SIZE, 210 .vb_curroffset = 0, 211 .vb_roffset = 0, 212 .vb_flags = VBF_STATIC, 213 .vb_mark_start = {.tp_row = 0, .tp_col = 0,}, 214 .vb_mark_end = {.tp_row = 0, .tp_col = 0,}, 215 .vb_scr_size = { 216 .tp_row = _VTDEFH, 217 .tp_col = _VTDEFW, 218 }, 219 }, 220 .vw_device = &vt_consdev, 221 .vw_terminal = &vt_consterm, 222 .vw_kbdmode = K_XLATE, 223 .vw_grabbed = 0, 224 }; 225 static struct terminal vt_consterm = { 226 .tm_class = &vt_termclass, 227 .tm_softc = &vt_conswindow, 228 .tm_flags = TF_CONS, 229 }; 230 static struct consdev vt_consterm_consdev = { 231 .cn_ops = &termcn_cnops, 232 .cn_arg = &vt_consterm, 233 .cn_name = "ttyv0", 234 }; 235 236 /* Add to set of consoles. */ 237 DATA_SET(cons_set, vt_consterm_consdev); 238 239 /* 240 * Right after kmem is done to allow early drivers to use locking and allocate 241 * memory. 242 */ 243 SYSINIT(vt_update_static, SI_SUB_KMEM, SI_ORDER_ANY, vt_update_static, 244 &vt_consdev); 245 /* Delay until all devices attached, to not waste time. */ 246 SYSINIT(vt_early_cons, SI_SUB_INT_CONFIG_HOOKS, SI_ORDER_ANY, vt_upgrade, 247 &vt_consdev); 248 249 /* Initialize locks/mem depended members. */ 250 static void 251 vt_update_static(void *dummy) 252 { 253 254 if (!vty_enabled(VTY_VT)) 255 return; 256 if (main_vd->vd_driver != NULL) 257 printf("VT: running with driver \"%s\".\n", 258 main_vd->vd_driver->vd_name); 259 else 260 printf("VT: init without driver.\n"); 261 262 mtx_init(&main_vd->vd_lock, "vtdev", NULL, MTX_DEF); 263 cv_init(&main_vd->vd_winswitch, "vtwswt"); 264 } 265 266 static void 267 vt_schedule_flush(struct vt_device *vd, int ms) 268 { 269 270 if (ms <= 0) 271 /* Default to initial value. */ 272 ms = 1000 / VT_TIMERFREQ; 273 274 callout_schedule(&vd->vd_timer, hz / (1000 / ms)); 275 } 276 277 static void 278 vt_resume_flush_timer(struct vt_device *vd, int ms) 279 { 280 281 if (!(vd->vd_flags & VDF_ASYNC) || 282 !atomic_cmpset_int(&vd->vd_timer_armed, 0, 1)) 283 return; 284 285 vt_schedule_flush(vd, ms); 286 } 287 288 static void 289 vt_suspend_flush_timer(struct vt_device *vd) 290 { 291 /* 292 * As long as this function is called locked, callout_stop() 293 * has the same effect like callout_drain() with regard to 294 * preventing the callback function from executing. 295 */ 296 VT_LOCK_ASSERT(vd, MA_OWNED); 297 298 if (!(vd->vd_flags & VDF_ASYNC) || 299 !atomic_cmpset_int(&vd->vd_timer_armed, 1, 0)) 300 return; 301 302 callout_stop(&vd->vd_timer); 303 } 304 305 static void 306 vt_switch_timer(void *arg) 307 { 308 309 vt_late_window_switch((struct vt_window *)arg); 310 } 311 312 static int 313 vt_save_kbd_mode(struct vt_window *vw, keyboard_t *kbd) 314 { 315 int mode, ret; 316 317 mode = 0; 318 ret = kbdd_ioctl(kbd, KDGKBMODE, (caddr_t)&mode); 319 if (ret == ENOIOCTL) 320 ret = ENODEV; 321 if (ret != 0) 322 return (ret); 323 324 vw->vw_kbdmode = mode; 325 326 return (0); 327 } 328 329 static int 330 vt_update_kbd_mode(struct vt_window *vw, keyboard_t *kbd) 331 { 332 int ret; 333 334 ret = kbdd_ioctl(kbd, KDSKBMODE, (caddr_t)&vw->vw_kbdmode); 335 if (ret == ENOIOCTL) 336 ret = ENODEV; 337 338 return (ret); 339 } 340 341 static int 342 vt_save_kbd_state(struct vt_window *vw, keyboard_t *kbd) 343 { 344 int state, ret; 345 346 state = 0; 347 ret = kbdd_ioctl(kbd, KDGKBSTATE, (caddr_t)&state); 348 if (ret == ENOIOCTL) 349 ret = ENODEV; 350 if (ret != 0) 351 return (ret); 352 353 vw->vw_kbdstate &= ~LOCK_MASK; 354 vw->vw_kbdstate |= state & LOCK_MASK; 355 356 return (0); 357 } 358 359 static int 360 vt_update_kbd_state(struct vt_window *vw, keyboard_t *kbd) 361 { 362 int state, ret; 363 364 state = vw->vw_kbdstate & LOCK_MASK; 365 ret = kbdd_ioctl(kbd, KDSKBSTATE, (caddr_t)&state); 366 if (ret == ENOIOCTL) 367 ret = ENODEV; 368 369 return (ret); 370 } 371 372 static int 373 vt_save_kbd_leds(struct vt_window *vw, keyboard_t *kbd) 374 { 375 int leds, ret; 376 377 leds = 0; 378 ret = kbdd_ioctl(kbd, KDGETLED, (caddr_t)&leds); 379 if (ret == ENOIOCTL) 380 ret = ENODEV; 381 if (ret != 0) 382 return (ret); 383 384 vw->vw_kbdstate &= ~LED_MASK; 385 vw->vw_kbdstate |= leds & LED_MASK; 386 387 return (0); 388 } 389 390 static int 391 vt_update_kbd_leds(struct vt_window *vw, keyboard_t *kbd) 392 { 393 int leds, ret; 394 395 leds = vw->vw_kbdstate & LED_MASK; 396 ret = kbdd_ioctl(kbd, KDSETLED, (caddr_t)&leds); 397 if (ret == ENOIOCTL) 398 ret = ENODEV; 399 400 return (ret); 401 } 402 403 static int 404 vt_window_preswitch(struct vt_window *vw, struct vt_window *curvw) 405 { 406 407 DPRINTF(40, "%s\n", __func__); 408 curvw->vw_switch_to = vw; 409 /* Set timer to allow switch in case when process hang. */ 410 callout_reset(&vw->vw_proc_dead_timer, hz * vt_deadtimer, 411 vt_switch_timer, (void *)vw); 412 /* Notify process about vt switch attempt. */ 413 DPRINTF(30, "%s: Notify process.\n", __func__); 414 signal_vt_rel(curvw); 415 416 return (0); 417 } 418 419 static int 420 vt_window_postswitch(struct vt_window *vw) 421 { 422 423 signal_vt_acq(vw); 424 return (0); 425 } 426 427 /* vt_late_window_switch will done VT switching for regular case. */ 428 static int 429 vt_late_window_switch(struct vt_window *vw) 430 { 431 int ret; 432 433 callout_stop(&vw->vw_proc_dead_timer); 434 435 ret = vt_window_switch(vw); 436 if (ret) 437 return (ret); 438 439 /* Notify owner process about terminal availability. */ 440 if (vw->vw_smode.mode == VT_PROCESS) { 441 ret = vt_window_postswitch(vw); 442 } 443 return (ret); 444 } 445 446 /* Switch window. */ 447 static int 448 vt_proc_window_switch(struct vt_window *vw) 449 { 450 struct vt_window *curvw; 451 struct vt_device *vd; 452 int ret; 453 454 vd = vw->vw_device; 455 curvw = vd->vd_curwindow; 456 457 if (curvw->vw_flags & VWF_VTYLOCK) 458 return (EBUSY); 459 460 /* Ask current process permission to switch away. */ 461 if (curvw->vw_smode.mode == VT_PROCESS) { 462 DPRINTF(30, "%s: VT_PROCESS ", __func__); 463 if (vt_proc_alive(curvw) == FALSE) { 464 DPRINTF(30, "Dead. Cleaning."); 465 /* Dead */ 466 } else { 467 DPRINTF(30, "%s: Signaling process.\n", __func__); 468 /* Alive, try to ask him. */ 469 ret = vt_window_preswitch(vw, curvw); 470 /* Wait for process answer or timeout. */ 471 return (ret); 472 } 473 DPRINTF(30, "\n"); 474 } 475 476 ret = vt_late_window_switch(vw); 477 return (ret); 478 } 479 480 /* Switch window ignoring process locking. */ 481 static int 482 vt_window_switch(struct vt_window *vw) 483 { 484 struct vt_device *vd = vw->vw_device; 485 struct vt_window *curvw = vd->vd_curwindow; 486 keyboard_t *kbd; 487 488 VT_LOCK(vd); 489 if (curvw == vw) { 490 /* Nothing to do. */ 491 VT_UNLOCK(vd); 492 return (0); 493 } 494 if (!(vw->vw_flags & (VWF_OPENED|VWF_CONSOLE))) { 495 VT_UNLOCK(vd); 496 return (EINVAL); 497 } 498 499 vt_suspend_flush_timer(vd); 500 501 vd->vd_curwindow = vw; 502 vd->vd_flags |= VDF_INVALID; 503 cv_broadcast(&vd->vd_winswitch); 504 VT_UNLOCK(vd); 505 506 if (vd->vd_driver->vd_postswitch) 507 vd->vd_driver->vd_postswitch(vd); 508 509 vt_resume_flush_timer(vd, 0); 510 511 /* Restore per-window keyboard mode. */ 512 mtx_lock(&Giant); 513 kbd = kbd_get_keyboard(vd->vd_keyboard); 514 if (kbd != NULL) { 515 if (curvw->vw_kbdmode == K_XLATE) 516 vt_save_kbd_state(curvw, kbd); 517 518 vt_update_kbd_mode(vw, kbd); 519 vt_update_kbd_state(vw, kbd); 520 } 521 mtx_unlock(&Giant); 522 DPRINTF(10, "%s(ttyv%d) done\n", __func__, vw->vw_number); 523 524 return (0); 525 } 526 527 static inline void 528 vt_termsize(struct vt_device *vd, struct vt_font *vf, term_pos_t *size) 529 { 530 531 size->tp_row = vd->vd_height; 532 size->tp_col = vd->vd_width; 533 if (vf != NULL) { 534 size->tp_row /= vf->vf_height; 535 size->tp_col /= vf->vf_width; 536 } 537 } 538 539 static inline void 540 vt_winsize(struct vt_device *vd, struct vt_font *vf, struct winsize *size) 541 { 542 543 size->ws_row = size->ws_ypixel = vd->vd_height; 544 size->ws_col = size->ws_xpixel = vd->vd_width; 545 if (vf != NULL) { 546 size->ws_row /= vf->vf_height; 547 size->ws_col /= vf->vf_width; 548 } 549 } 550 551 static inline void 552 vt_compute_drawable_area(struct vt_window *vw) 553 { 554 struct vt_device *vd; 555 struct vt_font *vf; 556 557 vd = vw->vw_device; 558 559 if (vw->vw_font == NULL) { 560 vw->vw_draw_area.tr_begin.tp_col = 0; 561 vw->vw_draw_area.tr_begin.tp_row = 0; 562 vw->vw_draw_area.tr_end.tp_col = vd->vd_width; 563 vw->vw_draw_area.tr_end.tp_row = vd->vd_height; 564 return; 565 } 566 567 vf = vw->vw_font; 568 569 /* 570 * Compute the drawable area, so that the text is centered on 571 * the screen. 572 */ 573 574 vw->vw_draw_area.tr_begin.tp_col = (vd->vd_width % vf->vf_width) / 2; 575 vw->vw_draw_area.tr_begin.tp_row = (vd->vd_height % vf->vf_height) / 2; 576 vw->vw_draw_area.tr_end.tp_col = vw->vw_draw_area.tr_begin.tp_col + 577 vd->vd_width / vf->vf_width * vf->vf_width; 578 vw->vw_draw_area.tr_end.tp_row = vw->vw_draw_area.tr_begin.tp_row + 579 vd->vd_height / vf->vf_height * vf->vf_height; 580 } 581 582 static void 583 vt_scroll(struct vt_window *vw, int offset, int whence) 584 { 585 int diff; 586 term_pos_t size; 587 588 if ((vw->vw_flags & VWF_SCROLL) == 0) 589 return; 590 591 vt_termsize(vw->vw_device, vw->vw_font, &size); 592 593 diff = vthistory_seek(&vw->vw_buf, offset, whence); 594 if (diff) 595 vw->vw_device->vd_flags |= VDF_INVALID; 596 vt_resume_flush_timer(vw->vw_device, 0); 597 } 598 599 static int 600 vt_machine_kbdevent(int c) 601 { 602 603 switch (c) { 604 case SPCLKEY | DBG: /* kbdmap(5) keyword `debug`. */ 605 if (vt_kbd_debug) 606 kdb_enter(KDB_WHY_BREAK, "manual escape to debugger"); 607 return (1); 608 case SPCLKEY | HALT: /* kbdmap(5) keyword `halt`. */ 609 if (vt_kbd_halt) 610 shutdown_nice(RB_HALT); 611 return (1); 612 case SPCLKEY | PASTE: /* kbdmap(5) keyword `paste`. */ 613 #ifndef SC_NO_CUTPASTE 614 /* Insert text from cut-paste buffer. */ 615 vt_mouse_paste(); 616 #endif 617 break; 618 case SPCLKEY | PDWN: /* kbdmap(5) keyword `pdwn`. */ 619 if (vt_kbd_poweroff) 620 shutdown_nice(RB_HALT|RB_POWEROFF); 621 return (1); 622 case SPCLKEY | PNC: /* kbdmap(5) keyword `panic`. */ 623 /* 624 * Request to immediate panic if sysctl 625 * kern.vt.enable_panic_key allow it. 626 */ 627 if (vt_kbd_panic) 628 panic("Forced by the panic key"); 629 return (1); 630 case SPCLKEY | RBT: /* kbdmap(5) keyword `boot`. */ 631 if (vt_kbd_reboot) 632 shutdown_nice(RB_AUTOBOOT); 633 return (1); 634 case SPCLKEY | SPSC: /* kbdmap(5) keyword `spsc`. */ 635 /* Force activatation/deactivation of the screen saver. */ 636 /* TODO */ 637 return (1); 638 case SPCLKEY | STBY: /* XXX Not present in kbdcontrol parser. */ 639 /* Put machine into Stand-By mode. */ 640 power_pm_suspend(POWER_SLEEP_STATE_STANDBY); 641 return (1); 642 case SPCLKEY | SUSP: /* kbdmap(5) keyword `susp`. */ 643 /* Suspend machine. */ 644 power_pm_suspend(POWER_SLEEP_STATE_SUSPEND); 645 return (1); 646 }; 647 648 return (0); 649 } 650 651 static void 652 vt_scrollmode_kbdevent(struct vt_window *vw, int c, int console) 653 { 654 struct vt_device *vd; 655 term_pos_t size; 656 657 vd = vw->vw_device; 658 /* Only special keys handled in ScrollLock mode */ 659 if ((c & SPCLKEY) == 0) 660 return; 661 662 c &= ~SPCLKEY; 663 664 if (console == 0) { 665 if (c >= F_SCR && c <= MIN(L_SCR, F_SCR + VT_MAXWINDOWS - 1)) { 666 vw = vd->vd_windows[c - F_SCR]; 667 if (vw != NULL) 668 vt_proc_window_switch(vw); 669 return; 670 } 671 VT_LOCK(vd); 672 } 673 674 switch (c) { 675 case SLK: { 676 /* Turn scrolling off. */ 677 vt_scroll(vw, 0, VHS_END); 678 VTBUF_SLCK_DISABLE(&vw->vw_buf); 679 vw->vw_flags &= ~VWF_SCROLL; 680 break; 681 } 682 case FKEY | F(49): /* Home key. */ 683 vt_scroll(vw, 0, VHS_SET); 684 break; 685 case FKEY | F(50): /* Arrow up. */ 686 vt_scroll(vw, -1, VHS_CUR); 687 break; 688 case FKEY | F(51): /* Page up. */ 689 vt_termsize(vd, vw->vw_font, &size); 690 vt_scroll(vw, -size.tp_row, VHS_CUR); 691 break; 692 case FKEY | F(57): /* End key. */ 693 vt_scroll(vw, 0, VHS_END); 694 break; 695 case FKEY | F(58): /* Arrow down. */ 696 vt_scroll(vw, 1, VHS_CUR); 697 break; 698 case FKEY | F(59): /* Page down. */ 699 vt_termsize(vd, vw->vw_font, &size); 700 vt_scroll(vw, size.tp_row, VHS_CUR); 701 break; 702 } 703 704 if (console == 0) 705 VT_UNLOCK(vd); 706 } 707 708 static int 709 vt_processkey(keyboard_t *kbd, struct vt_device *vd, int c) 710 { 711 struct vt_window *vw = vd->vd_curwindow; 712 713 #if VT_ALT_TO_ESC_HACK 714 if (c & RELKEY) { 715 switch (c & ~RELKEY) { 716 case (SPCLKEY | RALT): 717 if (vt_enable_altgr != 0) 718 break; 719 case (SPCLKEY | LALT): 720 vd->vd_kbstate &= ~ALKED; 721 } 722 /* Other keys ignored for RELKEY event. */ 723 return (0); 724 } else { 725 switch (c & ~RELKEY) { 726 case (SPCLKEY | RALT): 727 if (vt_enable_altgr != 0) 728 break; 729 case (SPCLKEY | LALT): 730 vd->vd_kbstate |= ALKED; 731 } 732 } 733 #else 734 if (c & RELKEY) 735 /* Other keys ignored for RELKEY event. */ 736 return (0); 737 #endif 738 739 if (vt_machine_kbdevent(c)) 740 return (0); 741 742 if (vw->vw_flags & VWF_SCROLL) { 743 vt_scrollmode_kbdevent(vw, c, 0/* Not a console */); 744 /* Scroll mode keys handled, nothing to do more. */ 745 return (0); 746 } 747 748 if (c & SPCLKEY) { 749 c &= ~SPCLKEY; 750 751 if (c >= F_SCR && c <= MIN(L_SCR, F_SCR + VT_MAXWINDOWS - 1)) { 752 vw = vd->vd_windows[c - F_SCR]; 753 if (vw != NULL) 754 vt_proc_window_switch(vw); 755 return (0); 756 } 757 758 switch (c) { 759 case NEXT: 760 /* Switch to next VT. */ 761 c = (vw->vw_number + 1) % VT_MAXWINDOWS; 762 vw = vd->vd_windows[c]; 763 if (vw != NULL) 764 vt_proc_window_switch(vw); 765 return (0); 766 case PREV: 767 /* Switch to previous VT. */ 768 c = (vw->vw_number - 1) % VT_MAXWINDOWS; 769 vw = vd->vd_windows[c]; 770 if (vw != NULL) 771 vt_proc_window_switch(vw); 772 return (0); 773 case SLK: { 774 vt_save_kbd_state(vw, kbd); 775 VT_LOCK(vd); 776 if (vw->vw_kbdstate & SLKED) { 777 /* Turn scrolling on. */ 778 vw->vw_flags |= VWF_SCROLL; 779 VTBUF_SLCK_ENABLE(&vw->vw_buf); 780 } else { 781 /* Turn scrolling off. */ 782 vw->vw_flags &= ~VWF_SCROLL; 783 VTBUF_SLCK_DISABLE(&vw->vw_buf); 784 vt_scroll(vw, 0, VHS_END); 785 } 786 VT_UNLOCK(vd); 787 break; 788 } 789 case FKEY | F(1): case FKEY | F(2): case FKEY | F(3): 790 case FKEY | F(4): case FKEY | F(5): case FKEY | F(6): 791 case FKEY | F(7): case FKEY | F(8): case FKEY | F(9): 792 case FKEY | F(10): case FKEY | F(11): case FKEY | F(12): 793 /* F1 through F12 keys. */ 794 terminal_input_special(vw->vw_terminal, 795 TKEY_F1 + c - (FKEY | F(1))); 796 break; 797 case FKEY | F(49): /* Home key. */ 798 terminal_input_special(vw->vw_terminal, TKEY_HOME); 799 break; 800 case FKEY | F(50): /* Arrow up. */ 801 terminal_input_special(vw->vw_terminal, TKEY_UP); 802 break; 803 case FKEY | F(51): /* Page up. */ 804 terminal_input_special(vw->vw_terminal, TKEY_PAGE_UP); 805 break; 806 case FKEY | F(53): /* Arrow left. */ 807 terminal_input_special(vw->vw_terminal, TKEY_LEFT); 808 break; 809 case FKEY | F(55): /* Arrow right. */ 810 terminal_input_special(vw->vw_terminal, TKEY_RIGHT); 811 break; 812 case FKEY | F(57): /* End key. */ 813 terminal_input_special(vw->vw_terminal, TKEY_END); 814 break; 815 case FKEY | F(58): /* Arrow down. */ 816 terminal_input_special(vw->vw_terminal, TKEY_DOWN); 817 break; 818 case FKEY | F(59): /* Page down. */ 819 terminal_input_special(vw->vw_terminal, TKEY_PAGE_DOWN); 820 break; 821 case FKEY | F(60): /* Insert key. */ 822 terminal_input_special(vw->vw_terminal, TKEY_INSERT); 823 break; 824 case FKEY | F(61): /* Delete key. */ 825 terminal_input_special(vw->vw_terminal, TKEY_DELETE); 826 break; 827 } 828 } else if (KEYFLAGS(c) == 0) { 829 /* Don't do UTF-8 conversion when doing raw mode. */ 830 if (vw->vw_kbdmode == K_XLATE) { 831 #if VT_ALT_TO_ESC_HACK 832 if (vd->vd_kbstate & ALKED) { 833 /* 834 * Prepend ESC sequence if one of ALT keys down. 835 */ 836 terminal_input_char(vw->vw_terminal, 0x1b); 837 } 838 #endif 839 #if defined(KDB) 840 kdb_alt_break(c, &vd->vd_altbrk); 841 #endif 842 terminal_input_char(vw->vw_terminal, KEYCHAR(c)); 843 } else 844 terminal_input_raw(vw->vw_terminal, c); 845 } 846 return (0); 847 } 848 849 static int 850 vt_kbdevent(keyboard_t *kbd, int event, void *arg) 851 { 852 struct vt_device *vd = arg; 853 int c; 854 855 switch (event) { 856 case KBDIO_KEYINPUT: 857 break; 858 case KBDIO_UNLOADING: 859 mtx_lock(&Giant); 860 vd->vd_keyboard = -1; 861 kbd_release(kbd, (void *)vd); 862 mtx_unlock(&Giant); 863 return (0); 864 default: 865 return (EINVAL); 866 } 867 868 while ((c = kbdd_read_char(kbd, 0)) != NOKEY) 869 vt_processkey(kbd, vd, c); 870 871 return (0); 872 } 873 874 static int 875 vt_allocate_keyboard(struct vt_device *vd) 876 { 877 int idx0, idx; 878 keyboard_t *k0, *k; 879 keyboard_info_t ki; 880 881 idx0 = kbd_allocate("kbdmux", -1, vd, vt_kbdevent, vd); 882 if (idx0 >= 0) { 883 DPRINTF(20, "%s: kbdmux allocated, idx = %d\n", __func__, idx0); 884 k0 = kbd_get_keyboard(idx0); 885 886 for (idx = kbd_find_keyboard2("*", -1, 0); 887 idx != -1; 888 idx = kbd_find_keyboard2("*", -1, idx + 1)) { 889 k = kbd_get_keyboard(idx); 890 891 if (idx == idx0 || KBD_IS_BUSY(k)) 892 continue; 893 894 bzero(&ki, sizeof(ki)); 895 strncpy(ki.kb_name, k->kb_name, sizeof(ki.kb_name)); 896 ki.kb_name[sizeof(ki.kb_name) - 1] = '\0'; 897 ki.kb_unit = k->kb_unit; 898 899 kbdd_ioctl(k0, KBADDKBD, (caddr_t) &ki); 900 } 901 } else { 902 DPRINTF(20, "%s: no kbdmux allocated\n", __func__); 903 idx0 = kbd_allocate("*", -1, vd, vt_kbdevent, vd); 904 if (idx0 < 0) { 905 DPRINTF(10, "%s: No keyboard found.\n", __func__); 906 return (-1); 907 } 908 } 909 vd->vd_keyboard = idx0; 910 DPRINTF(20, "%s: vd_keyboard = %d\n", __func__, vd->vd_keyboard); 911 912 return (idx0); 913 } 914 915 static void 916 vtterm_bell(struct terminal *tm) 917 { 918 struct vt_window *vw = tm->tm_softc; 919 struct vt_device *vd = vw->vw_device; 920 921 if (!vt_enable_bell) 922 return; 923 924 if (vd->vd_flags & VDF_QUIET_BELL) 925 return; 926 927 sysbeep(1193182 / VT_BELLPITCH, VT_BELLDURATION); 928 } 929 930 static void 931 vtterm_beep(struct terminal *tm, u_int param) 932 { 933 u_int freq, period; 934 935 if (!vt_enable_bell) 936 return; 937 938 if ((param == 0) || ((param & 0xffff) == 0)) { 939 vtterm_bell(tm); 940 return; 941 } 942 943 period = ((param >> 16) & 0xffff) * hz / 1000; 944 freq = 1193182 / (param & 0xffff); 945 946 sysbeep(freq, period); 947 } 948 949 static void 950 vtterm_cursor(struct terminal *tm, const term_pos_t *p) 951 { 952 struct vt_window *vw = tm->tm_softc; 953 954 vtbuf_cursor_position(&vw->vw_buf, p); 955 vt_resume_flush_timer(vw->vw_device, 0); 956 } 957 958 static void 959 vtterm_putchar(struct terminal *tm, const term_pos_t *p, term_char_t c) 960 { 961 struct vt_window *vw = tm->tm_softc; 962 963 vtbuf_putchar(&vw->vw_buf, p, c); 964 vt_resume_flush_timer(vw->vw_device, 0); 965 } 966 967 static void 968 vtterm_fill(struct terminal *tm, const term_rect_t *r, term_char_t c) 969 { 970 struct vt_window *vw = tm->tm_softc; 971 972 vtbuf_fill_locked(&vw->vw_buf, r, c); 973 vt_resume_flush_timer(vw->vw_device, 0); 974 } 975 976 static void 977 vtterm_copy(struct terminal *tm, const term_rect_t *r, 978 const term_pos_t *p) 979 { 980 struct vt_window *vw = tm->tm_softc; 981 982 vtbuf_copy(&vw->vw_buf, r, p); 983 vt_resume_flush_timer(vw->vw_device, 0); 984 } 985 986 static void 987 vtterm_param(struct terminal *tm, int cmd, unsigned int arg) 988 { 989 struct vt_window *vw = tm->tm_softc; 990 991 switch (cmd) { 992 case TP_SHOWCURSOR: 993 vtbuf_cursor_visibility(&vw->vw_buf, arg); 994 vt_resume_flush_timer(vw->vw_device, 0); 995 break; 996 case TP_MOUSE: 997 vw->vw_mouse_level = arg; 998 break; 999 } 1000 } 1001 1002 void 1003 vt_determine_colors(term_char_t c, int cursor, 1004 term_color_t *fg, term_color_t *bg) 1005 { 1006 term_color_t tmp; 1007 int invert; 1008 1009 invert = 0; 1010 1011 *fg = TCHAR_FGCOLOR(c); 1012 if (TCHAR_FORMAT(c) & TF_BOLD) 1013 *fg = TCOLOR_LIGHT(*fg); 1014 *bg = TCHAR_BGCOLOR(c); 1015 1016 if (TCHAR_FORMAT(c) & TF_REVERSE) 1017 invert ^= 1; 1018 if (cursor) 1019 invert ^= 1; 1020 1021 if (invert) { 1022 tmp = *fg; 1023 *fg = *bg; 1024 *bg = tmp; 1025 } 1026 } 1027 1028 #ifndef SC_NO_CUTPASTE 1029 int 1030 vt_is_cursor_in_area(const struct vt_device *vd, const term_rect_t *area) 1031 { 1032 unsigned int mx, my, x1, y1, x2, y2; 1033 1034 /* 1035 * We use the cursor position saved during the current refresh, 1036 * in case the cursor moved since. 1037 */ 1038 mx = vd->vd_mx_drawn + vd->vd_curwindow->vw_draw_area.tr_begin.tp_col; 1039 my = vd->vd_my_drawn + vd->vd_curwindow->vw_draw_area.tr_begin.tp_row; 1040 1041 x1 = area->tr_begin.tp_col; 1042 y1 = area->tr_begin.tp_row; 1043 x2 = area->tr_end.tp_col; 1044 y2 = area->tr_end.tp_row; 1045 1046 if (((mx >= x1 && x2 - 1 >= mx) || 1047 (mx < x1 && mx + vd->vd_mcursor->width >= x1)) && 1048 ((my >= y1 && y2 - 1 >= my) || 1049 (my < y1 && my + vd->vd_mcursor->height >= y1))) 1050 return (1); 1051 1052 return (0); 1053 } 1054 1055 static void 1056 vt_mark_mouse_position_as_dirty(struct vt_device *vd) 1057 { 1058 term_rect_t area; 1059 struct vt_window *vw; 1060 struct vt_font *vf; 1061 int x, y; 1062 1063 vw = vd->vd_curwindow; 1064 vf = vw->vw_font; 1065 1066 x = vd->vd_mx_drawn; 1067 y = vd->vd_my_drawn; 1068 1069 if (vf != NULL) { 1070 area.tr_begin.tp_col = x / vf->vf_width; 1071 area.tr_begin.tp_row = y / vf->vf_height; 1072 area.tr_end.tp_col = 1073 ((x + vd->vd_mcursor->width) / vf->vf_width) + 1; 1074 area.tr_end.tp_row = 1075 ((y + vd->vd_mcursor->height) / vf->vf_height) + 1; 1076 } else { 1077 /* 1078 * No font loaded (ie. vt_vga operating in textmode). 1079 * 1080 * FIXME: This fake area needs to be revisited once the 1081 * mouse cursor is supported in vt_vga's textmode. 1082 */ 1083 area.tr_begin.tp_col = x; 1084 area.tr_begin.tp_row = y; 1085 area.tr_end.tp_col = x + 2; 1086 area.tr_end.tp_row = y + 2; 1087 } 1088 1089 vtbuf_dirty(&vw->vw_buf, &area); 1090 } 1091 #endif 1092 1093 static int 1094 vt_flush(struct vt_device *vd) 1095 { 1096 struct vt_window *vw; 1097 struct vt_font *vf; 1098 term_rect_t tarea; 1099 term_pos_t size; 1100 #ifndef SC_NO_CUTPASTE 1101 int cursor_was_shown, cursor_moved; 1102 #endif 1103 1104 vw = vd->vd_curwindow; 1105 if (vw == NULL) 1106 return (0); 1107 1108 if (vd->vd_flags & VDF_SPLASH || vw->vw_flags & VWF_BUSY) 1109 return (0); 1110 1111 vf = vw->vw_font; 1112 if (((vd->vd_flags & VDF_TEXTMODE) == 0) && (vf == NULL)) 1113 return (0); 1114 1115 #ifndef SC_NO_CUTPASTE 1116 cursor_was_shown = vd->vd_mshown; 1117 cursor_moved = (vd->vd_mx != vd->vd_mx_drawn || 1118 vd->vd_my != vd->vd_my_drawn); 1119 1120 /* Check if the cursor should be displayed or not. */ 1121 if ((vd->vd_flags & VDF_MOUSECURSOR) && /* Mouse support enabled. */ 1122 !(vw->vw_flags & VWF_MOUSE_HIDE) && /* Cursor displayed. */ 1123 !kdb_active && panicstr == NULL) { /* DDB inactive. */ 1124 vd->vd_mshown = 1; 1125 } else { 1126 vd->vd_mshown = 0; 1127 } 1128 1129 /* 1130 * If the cursor changed display state or moved, we must mark 1131 * the old position as dirty, so that it's erased. 1132 */ 1133 if (cursor_was_shown != vd->vd_mshown || 1134 (vd->vd_mshown && cursor_moved)) 1135 vt_mark_mouse_position_as_dirty(vd); 1136 1137 /* 1138 * Save position of the mouse cursor. It's used by backends to 1139 * know where to draw the cursor and during the next refresh to 1140 * erase the previous position. 1141 */ 1142 vd->vd_mx_drawn = vd->vd_mx; 1143 vd->vd_my_drawn = vd->vd_my; 1144 1145 /* 1146 * If the cursor is displayed and has moved since last refresh, 1147 * mark the new position as dirty. 1148 */ 1149 if (vd->vd_mshown && cursor_moved) 1150 vt_mark_mouse_position_as_dirty(vd); 1151 #endif 1152 1153 vtbuf_undirty(&vw->vw_buf, &tarea); 1154 vt_termsize(vd, vf, &size); 1155 1156 /* Force a full redraw when the screen contents are invalid. */ 1157 if (vd->vd_flags & VDF_INVALID) { 1158 tarea.tr_begin.tp_row = tarea.tr_begin.tp_col = 0; 1159 tarea.tr_end = size; 1160 1161 vd->vd_flags &= ~VDF_INVALID; 1162 } 1163 1164 if (tarea.tr_begin.tp_col < tarea.tr_end.tp_col) { 1165 vd->vd_driver->vd_bitblt_text(vd, vw, &tarea); 1166 return (1); 1167 } 1168 1169 return (0); 1170 } 1171 1172 static void 1173 vt_timer(void *arg) 1174 { 1175 struct vt_device *vd; 1176 int changed; 1177 1178 vd = arg; 1179 /* Update screen if required. */ 1180 changed = vt_flush(vd); 1181 1182 /* Schedule for next update. */ 1183 if (changed) 1184 vt_schedule_flush(vd, 0); 1185 else 1186 vd->vd_timer_armed = 0; 1187 } 1188 1189 static void 1190 vtterm_done(struct terminal *tm) 1191 { 1192 struct vt_window *vw = tm->tm_softc; 1193 struct vt_device *vd = vw->vw_device; 1194 1195 if (kdb_active || panicstr != NULL) { 1196 /* Switch to the debugger. */ 1197 if (vd->vd_curwindow != vw) { 1198 vd->vd_curwindow = vw; 1199 vd->vd_flags |= VDF_INVALID; 1200 if (vd->vd_driver->vd_postswitch) 1201 vd->vd_driver->vd_postswitch(vd); 1202 } 1203 vd->vd_flags &= ~VDF_SPLASH; 1204 vt_flush(vd); 1205 } else if (!(vd->vd_flags & VDF_ASYNC)) { 1206 vt_flush(vd); 1207 } 1208 } 1209 1210 #ifdef DEV_SPLASH 1211 static void 1212 vtterm_splash(struct vt_device *vd) 1213 { 1214 vt_axis_t top, left; 1215 1216 /* Display a nice boot splash. */ 1217 if (!(vd->vd_flags & VDF_TEXTMODE) && (boothowto & RB_MUTE)) { 1218 1219 top = (vd->vd_height - vt_logo_height) / 2; 1220 left = (vd->vd_width - vt_logo_width) / 2; 1221 switch (vt_logo_depth) { 1222 case 1: 1223 /* XXX: Unhardcode colors! */ 1224 vd->vd_driver->vd_bitblt_bmp(vd, vd->vd_curwindow, 1225 vt_logo_image, NULL, vt_logo_width, vt_logo_height, 1226 left, top, TC_WHITE, TC_BLACK); 1227 } 1228 vd->vd_flags |= VDF_SPLASH; 1229 } 1230 } 1231 #endif 1232 1233 1234 static void 1235 vtterm_cnprobe(struct terminal *tm, struct consdev *cp) 1236 { 1237 struct vt_driver *vtd, **vtdlist, *vtdbest = NULL; 1238 struct vt_window *vw = tm->tm_softc; 1239 struct vt_device *vd = vw->vw_device; 1240 struct winsize wsz; 1241 term_attr_t attr; 1242 term_char_t c; 1243 1244 if (!vty_enabled(VTY_VT)) 1245 return; 1246 1247 if (vd->vd_flags & VDF_INITIALIZED) 1248 /* Initialization already done. */ 1249 return; 1250 1251 SET_FOREACH(vtdlist, vt_drv_set) { 1252 vtd = *vtdlist; 1253 if (vtd->vd_probe == NULL) 1254 continue; 1255 if (vtd->vd_probe(vd) == CN_DEAD) 1256 continue; 1257 if ((vtdbest == NULL) || 1258 (vtd->vd_priority > vtdbest->vd_priority)) 1259 vtdbest = vtd; 1260 } 1261 if (vtdbest == NULL) { 1262 cp->cn_pri = CN_DEAD; 1263 vd->vd_flags |= VDF_DEAD; 1264 } else { 1265 vd->vd_driver = vtdbest; 1266 cp->cn_pri = vd->vd_driver->vd_init(vd); 1267 } 1268 1269 /* Check if driver's vt_init return CN_DEAD. */ 1270 if (cp->cn_pri == CN_DEAD) { 1271 vd->vd_flags |= VDF_DEAD; 1272 } 1273 1274 /* Initialize any early-boot keyboard drivers */ 1275 kbd_configure(KB_CONF_PROBE_ONLY); 1276 1277 vd->vd_unit = atomic_fetchadd_int(&vt_unit, 1); 1278 vd->vd_windows[VT_CONSWINDOW] = vw; 1279 sprintf(cp->cn_name, "ttyv%r", VT_UNIT(vw)); 1280 1281 /* Attach default font if not in TEXTMODE. */ 1282 if ((vd->vd_flags & VDF_TEXTMODE) == 0) { 1283 vw->vw_font = vtfont_ref(&vt_font_default); 1284 vt_compute_drawable_area(vw); 1285 } 1286 1287 /* 1288 * The original screen size was faked (_VTDEFW x _VTDEFH). Now 1289 * that we have the real viewable size, fix it in the static 1290 * buffer. 1291 */ 1292 if (vd->vd_width != 0 && vd->vd_height != 0) 1293 vt_termsize(vd, vw->vw_font, &vw->vw_buf.vb_scr_size); 1294 1295 vtbuf_init_early(&vw->vw_buf); 1296 vt_winsize(vd, vw->vw_font, &wsz); 1297 c = (boothowto & RB_MUTE) == 0 ? TERMINAL_KERN_ATTR : 1298 TERMINAL_NORM_ATTR; 1299 attr.ta_format = TCHAR_FORMAT(c); 1300 attr.ta_fgcolor = TCHAR_FGCOLOR(c); 1301 attr.ta_bgcolor = TCHAR_BGCOLOR(c); 1302 terminal_set_winsize_blank(tm, &wsz, 1, &attr); 1303 1304 if (vtdbest != NULL) { 1305 #ifdef DEV_SPLASH 1306 vtterm_splash(vd); 1307 #endif 1308 vd->vd_flags |= VDF_INITIALIZED; 1309 } 1310 } 1311 1312 static int 1313 vtterm_cngetc(struct terminal *tm) 1314 { 1315 struct vt_window *vw = tm->tm_softc; 1316 struct vt_device *vd = vw->vw_device; 1317 keyboard_t *kbd; 1318 u_int c; 1319 1320 if (vw->vw_kbdsq && *vw->vw_kbdsq) 1321 return (*vw->vw_kbdsq++); 1322 1323 /* Make sure the splash screen is not there. */ 1324 if (vd->vd_flags & VDF_SPLASH) { 1325 /* Remove splash */ 1326 vd->vd_flags &= ~VDF_SPLASH; 1327 /* Mark screen as invalid to force update */ 1328 vd->vd_flags |= VDF_INVALID; 1329 vt_flush(vd); 1330 } 1331 1332 /* Stripped down keyboard handler. */ 1333 kbd = kbd_get_keyboard(vd->vd_keyboard); 1334 if (kbd == NULL) 1335 return (-1); 1336 1337 /* Force keyboard input mode to K_XLATE */ 1338 vw->vw_kbdmode = K_XLATE; 1339 vt_update_kbd_mode(vw, kbd); 1340 1341 /* Switch the keyboard to polling to make it work here. */ 1342 kbdd_poll(kbd, TRUE); 1343 c = kbdd_read_char(kbd, 0); 1344 kbdd_poll(kbd, FALSE); 1345 if (c & RELKEY) 1346 return (-1); 1347 1348 if (vw->vw_flags & VWF_SCROLL) { 1349 vt_scrollmode_kbdevent(vw, c, 1/* Console mode */); 1350 vt_flush(vd); 1351 return (-1); 1352 } 1353 1354 /* Stripped down handling of vt_kbdevent(), without locking, etc. */ 1355 if (c & SPCLKEY) { 1356 switch (c) { 1357 case SPCLKEY | SLK: 1358 vt_save_kbd_state(vw, kbd); 1359 if (vw->vw_kbdstate & SLKED) { 1360 /* Turn scrolling on. */ 1361 vw->vw_flags |= VWF_SCROLL; 1362 VTBUF_SLCK_ENABLE(&vw->vw_buf); 1363 } else { 1364 /* Turn scrolling off. */ 1365 vt_scroll(vw, 0, VHS_END); 1366 vw->vw_flags &= ~VWF_SCROLL; 1367 VTBUF_SLCK_DISABLE(&vw->vw_buf); 1368 } 1369 break; 1370 /* XXX: KDB can handle history. */ 1371 case SPCLKEY | FKEY | F(50): /* Arrow up. */ 1372 vw->vw_kbdsq = "\x1b[A"; 1373 break; 1374 case SPCLKEY | FKEY | F(58): /* Arrow down. */ 1375 vw->vw_kbdsq = "\x1b[B"; 1376 break; 1377 case SPCLKEY | FKEY | F(55): /* Arrow right. */ 1378 vw->vw_kbdsq = "\x1b[C"; 1379 break; 1380 case SPCLKEY | FKEY | F(53): /* Arrow left. */ 1381 vw->vw_kbdsq = "\x1b[D"; 1382 break; 1383 } 1384 1385 /* Force refresh to make scrollback work. */ 1386 vt_flush(vd); 1387 } else if (KEYFLAGS(c) == 0) { 1388 return (KEYCHAR(c)); 1389 } 1390 1391 if (vw->vw_kbdsq && *vw->vw_kbdsq) 1392 return (*vw->vw_kbdsq++); 1393 1394 return (-1); 1395 } 1396 1397 static void 1398 vtterm_cngrab(struct terminal *tm) 1399 { 1400 struct vt_device *vd; 1401 struct vt_window *vw; 1402 keyboard_t *kbd; 1403 1404 vw = tm->tm_softc; 1405 vd = vw->vw_device; 1406 1407 if (!cold) 1408 vt_window_switch(vw); 1409 1410 kbd = kbd_get_keyboard(vd->vd_keyboard); 1411 if (kbd == NULL) 1412 return; 1413 1414 if (vw->vw_grabbed++ > 0) 1415 return; 1416 1417 /* 1418 * Make sure the keyboard is accessible even when the kbd device 1419 * driver is disabled. 1420 */ 1421 kbdd_enable(kbd); 1422 1423 /* We shall always use the keyboard in the XLATE mode here. */ 1424 vw->vw_prev_kbdmode = vw->vw_kbdmode; 1425 vw->vw_kbdmode = K_XLATE; 1426 vt_update_kbd_mode(vw, kbd); 1427 1428 kbdd_poll(kbd, TRUE); 1429 } 1430 1431 static void 1432 vtterm_cnungrab(struct terminal *tm) 1433 { 1434 struct vt_device *vd; 1435 struct vt_window *vw; 1436 keyboard_t *kbd; 1437 1438 vw = tm->tm_softc; 1439 vd = vw->vw_device; 1440 1441 kbd = kbd_get_keyboard(vd->vd_keyboard); 1442 if (kbd == NULL) 1443 return; 1444 1445 if (--vw->vw_grabbed > 0) 1446 return; 1447 1448 kbdd_poll(kbd, FALSE); 1449 1450 vw->vw_kbdmode = vw->vw_prev_kbdmode; 1451 vt_update_kbd_mode(vw, kbd); 1452 kbdd_disable(kbd); 1453 } 1454 1455 static void 1456 vtterm_opened(struct terminal *tm, int opened) 1457 { 1458 struct vt_window *vw = tm->tm_softc; 1459 struct vt_device *vd = vw->vw_device; 1460 1461 VT_LOCK(vd); 1462 vd->vd_flags &= ~VDF_SPLASH; 1463 if (opened) 1464 vw->vw_flags |= VWF_OPENED; 1465 else { 1466 vw->vw_flags &= ~VWF_OPENED; 1467 /* TODO: finish ACQ/REL */ 1468 } 1469 VT_UNLOCK(vd); 1470 } 1471 1472 static int 1473 vt_set_border(struct vt_window *vw, term_color_t c) 1474 { 1475 struct vt_device *vd = vw->vw_device; 1476 1477 if (vd->vd_driver->vd_drawrect == NULL) 1478 return (ENOTSUP); 1479 1480 /* Top bar. */ 1481 if (vw->vw_draw_area.tr_begin.tp_row > 0) 1482 vd->vd_driver->vd_drawrect(vd, 1483 0, 0, 1484 vd->vd_width - 1, vw->vw_draw_area.tr_begin.tp_row - 1, 1485 1, c); 1486 1487 /* Left bar. */ 1488 if (vw->vw_draw_area.tr_begin.tp_col > 0) 1489 vd->vd_driver->vd_drawrect(vd, 1490 0, 0, 1491 vw->vw_draw_area.tr_begin.tp_col - 1, vd->vd_height - 1, 1492 1, c); 1493 1494 /* Right bar. */ 1495 if (vw->vw_draw_area.tr_end.tp_col < vd->vd_width) 1496 vd->vd_driver->vd_drawrect(vd, 1497 vw->vw_draw_area.tr_end.tp_col - 1, 0, 1498 vd->vd_width - 1, vd->vd_height - 1, 1499 1, c); 1500 1501 /* Bottom bar. */ 1502 if (vw->vw_draw_area.tr_end.tp_row < vd->vd_height) 1503 vd->vd_driver->vd_drawrect(vd, 1504 0, vw->vw_draw_area.tr_end.tp_row - 1, 1505 vd->vd_width - 1, vd->vd_height - 1, 1506 1, c); 1507 1508 return (0); 1509 } 1510 1511 static int 1512 vt_change_font(struct vt_window *vw, struct vt_font *vf) 1513 { 1514 struct vt_device *vd = vw->vw_device; 1515 struct terminal *tm = vw->vw_terminal; 1516 term_pos_t size; 1517 struct winsize wsz; 1518 1519 /* 1520 * Changing fonts. 1521 * 1522 * Changing fonts is a little tricky. We must prevent 1523 * simultaneous access to the device, so we must stop 1524 * the display timer and the terminal from accessing. 1525 * We need to switch fonts and grow our screen buffer. 1526 * 1527 * XXX: Right now the code uses terminal_mute() to 1528 * prevent data from reaching the console driver while 1529 * resizing the screen buffer. This isn't elegant... 1530 */ 1531 1532 VT_LOCK(vd); 1533 if (vw->vw_flags & VWF_BUSY) { 1534 /* Another process is changing the font. */ 1535 VT_UNLOCK(vd); 1536 return (EBUSY); 1537 } 1538 vw->vw_flags |= VWF_BUSY; 1539 VT_UNLOCK(vd); 1540 1541 vt_termsize(vd, vf, &size); 1542 vt_winsize(vd, vf, &wsz); 1543 1544 /* Grow the screen buffer and terminal. */ 1545 terminal_mute(tm, 1); 1546 vtbuf_grow(&vw->vw_buf, &size, vw->vw_buf.vb_history_size); 1547 terminal_set_winsize_blank(tm, &wsz, 0, NULL); 1548 terminal_set_cursor(tm, &vw->vw_buf.vb_cursor); 1549 terminal_mute(tm, 0); 1550 1551 /* Actually apply the font to the current window. */ 1552 VT_LOCK(vd); 1553 if (vw->vw_font != vf && vw->vw_font != NULL && vf != NULL) { 1554 /* 1555 * In case vt_change_font called to update size we don't need 1556 * to update font link. 1557 */ 1558 vtfont_unref(vw->vw_font); 1559 vw->vw_font = vtfont_ref(vf); 1560 } 1561 1562 /* 1563 * Compute the drawable area and move the mouse cursor inside 1564 * it, in case the new area is smaller than the previous one. 1565 */ 1566 vt_compute_drawable_area(vw); 1567 vd->vd_mx = min(vd->vd_mx, 1568 vw->vw_draw_area.tr_end.tp_col - 1569 vw->vw_draw_area.tr_begin.tp_col - 1); 1570 vd->vd_my = min(vd->vd_my, 1571 vw->vw_draw_area.tr_end.tp_row - 1572 vw->vw_draw_area.tr_begin.tp_row - 1); 1573 1574 /* Force a full redraw the next timer tick. */ 1575 if (vd->vd_curwindow == vw) { 1576 vt_set_border(vw, TC_BLACK); 1577 vd->vd_flags |= VDF_INVALID; 1578 vt_resume_flush_timer(vw->vw_device, 0); 1579 } 1580 vw->vw_flags &= ~VWF_BUSY; 1581 VT_UNLOCK(vd); 1582 return (0); 1583 } 1584 1585 static int 1586 vt_proc_alive(struct vt_window *vw) 1587 { 1588 struct proc *p; 1589 1590 if (vw->vw_smode.mode != VT_PROCESS) 1591 return (FALSE); 1592 1593 if (vw->vw_proc) { 1594 if ((p = pfind(vw->vw_pid)) != NULL) 1595 PROC_UNLOCK(p); 1596 if (vw->vw_proc == p) 1597 return (TRUE); 1598 vw->vw_proc = NULL; 1599 vw->vw_smode.mode = VT_AUTO; 1600 DPRINTF(1, "vt controlling process %d died\n", vw->vw_pid); 1601 vw->vw_pid = 0; 1602 } 1603 return (FALSE); 1604 } 1605 1606 static int 1607 signal_vt_rel(struct vt_window *vw) 1608 { 1609 1610 if (vw->vw_smode.mode != VT_PROCESS) 1611 return (FALSE); 1612 if (vw->vw_proc == NULL || vt_proc_alive(vw) == FALSE) { 1613 vw->vw_proc = NULL; 1614 vw->vw_pid = 0; 1615 return (TRUE); 1616 } 1617 vw->vw_flags |= VWF_SWWAIT_REL; 1618 PROC_LOCK(vw->vw_proc); 1619 kern_psignal(vw->vw_proc, vw->vw_smode.relsig); 1620 PROC_UNLOCK(vw->vw_proc); 1621 DPRINTF(1, "sending relsig to %d\n", vw->vw_pid); 1622 return (TRUE); 1623 } 1624 1625 static int 1626 signal_vt_acq(struct vt_window *vw) 1627 { 1628 1629 if (vw->vw_smode.mode != VT_PROCESS) 1630 return (FALSE); 1631 if (vw == vw->vw_device->vd_windows[VT_CONSWINDOW]) 1632 cnavailable(vw->vw_terminal->consdev, FALSE); 1633 if (vw->vw_proc == NULL || vt_proc_alive(vw) == FALSE) { 1634 vw->vw_proc = NULL; 1635 vw->vw_pid = 0; 1636 return (TRUE); 1637 } 1638 vw->vw_flags |= VWF_SWWAIT_ACQ; 1639 PROC_LOCK(vw->vw_proc); 1640 kern_psignal(vw->vw_proc, vw->vw_smode.acqsig); 1641 PROC_UNLOCK(vw->vw_proc); 1642 DPRINTF(1, "sending acqsig to %d\n", vw->vw_pid); 1643 return (TRUE); 1644 } 1645 1646 static int 1647 finish_vt_rel(struct vt_window *vw, int release, int *s) 1648 { 1649 1650 if (vw->vw_flags & VWF_SWWAIT_REL) { 1651 vw->vw_flags &= ~VWF_SWWAIT_REL; 1652 if (release) { 1653 callout_drain(&vw->vw_proc_dead_timer); 1654 vt_late_window_switch(vw->vw_switch_to); 1655 } 1656 return (0); 1657 } 1658 return (EINVAL); 1659 } 1660 1661 static int 1662 finish_vt_acq(struct vt_window *vw) 1663 { 1664 1665 if (vw->vw_flags & VWF_SWWAIT_ACQ) { 1666 vw->vw_flags &= ~VWF_SWWAIT_ACQ; 1667 return (0); 1668 } 1669 return (EINVAL); 1670 } 1671 1672 #ifndef SC_NO_CUTPASTE 1673 static void 1674 vt_mouse_terminput_button(struct vt_device *vd, int button) 1675 { 1676 struct vt_window *vw; 1677 struct vt_font *vf; 1678 char mouseb[6] = "\x1B[M"; 1679 int i, x, y; 1680 1681 vw = vd->vd_curwindow; 1682 vf = vw->vw_font; 1683 1684 /* Translate to char position. */ 1685 x = vd->vd_mx / vf->vf_width; 1686 y = vd->vd_my / vf->vf_height; 1687 /* Avoid overflow. */ 1688 x = MIN(x, 255 - '!'); 1689 y = MIN(y, 255 - '!'); 1690 1691 mouseb[3] = ' ' + button; 1692 mouseb[4] = '!' + x; 1693 mouseb[5] = '!' + y; 1694 1695 for (i = 0; i < sizeof(mouseb); i++) 1696 terminal_input_char(vw->vw_terminal, mouseb[i]); 1697 } 1698 1699 static void 1700 vt_mouse_terminput(struct vt_device *vd, int type, int x, int y, int event, 1701 int cnt) 1702 { 1703 1704 switch (type) { 1705 case MOUSE_BUTTON_EVENT: 1706 if (cnt > 0) { 1707 /* Mouse button pressed. */ 1708 if (event & MOUSE_BUTTON1DOWN) 1709 vt_mouse_terminput_button(vd, 0); 1710 if (event & MOUSE_BUTTON2DOWN) 1711 vt_mouse_terminput_button(vd, 1); 1712 if (event & MOUSE_BUTTON3DOWN) 1713 vt_mouse_terminput_button(vd, 2); 1714 } else { 1715 /* Mouse button released. */ 1716 vt_mouse_terminput_button(vd, 3); 1717 } 1718 break; 1719 #ifdef notyet 1720 case MOUSE_MOTION_EVENT: 1721 if (mouse->u.data.z < 0) { 1722 /* Scroll up. */ 1723 sc_mouse_input_button(vd, 64); 1724 } else if (mouse->u.data.z > 0) { 1725 /* Scroll down. */ 1726 sc_mouse_input_button(vd, 65); 1727 } 1728 break; 1729 #endif 1730 } 1731 } 1732 1733 static void 1734 vt_mouse_paste() 1735 { 1736 term_char_t *buf; 1737 int i, len; 1738 1739 len = VD_PASTEBUFLEN(main_vd); 1740 buf = VD_PASTEBUF(main_vd); 1741 len /= sizeof(term_char_t); 1742 for (i = 0; i < len; i++) { 1743 if (buf[i] == '\0') 1744 continue; 1745 terminal_input_char(main_vd->vd_curwindow->vw_terminal, 1746 buf[i]); 1747 } 1748 } 1749 1750 void 1751 vt_mouse_event(int type, int x, int y, int event, int cnt, int mlevel) 1752 { 1753 struct vt_device *vd; 1754 struct vt_window *vw; 1755 struct vt_font *vf; 1756 term_pos_t size; 1757 int len, mark; 1758 1759 vd = main_vd; 1760 vw = vd->vd_curwindow; 1761 vf = vw->vw_font; 1762 mark = 0; 1763 1764 if (vw->vw_flags & (VWF_MOUSE_HIDE | VWF_GRAPHICS)) 1765 /* 1766 * Either the mouse is disabled, or the window is in 1767 * "graphics mode". The graphics mode is usually set by 1768 * an X server, using the KDSETMODE ioctl. 1769 */ 1770 return; 1771 1772 if (vf == NULL) /* Text mode. */ 1773 return; 1774 1775 /* 1776 * TODO: add flag about pointer position changed, to not redraw chars 1777 * under mouse pointer when nothing changed. 1778 */ 1779 1780 if (vw->vw_mouse_level > 0) 1781 vt_mouse_terminput(vd, type, x, y, event, cnt); 1782 1783 switch (type) { 1784 case MOUSE_ACTION: 1785 case MOUSE_MOTION_EVENT: 1786 /* Movement */ 1787 x += vd->vd_mx; 1788 y += vd->vd_my; 1789 1790 vt_termsize(vd, vf, &size); 1791 1792 /* Apply limits. */ 1793 x = MAX(x, 0); 1794 y = MAX(y, 0); 1795 x = MIN(x, (size.tp_col * vf->vf_width) - 1); 1796 y = MIN(y, (size.tp_row * vf->vf_height) - 1); 1797 1798 vd->vd_mx = x; 1799 vd->vd_my = y; 1800 if (vd->vd_mstate & MOUSE_BUTTON1DOWN) 1801 vtbuf_set_mark(&vw->vw_buf, VTB_MARK_MOVE, 1802 vd->vd_mx / vf->vf_width, 1803 vd->vd_my / vf->vf_height); 1804 1805 vt_resume_flush_timer(vw->vw_device, 0); 1806 return; /* Done */ 1807 case MOUSE_BUTTON_EVENT: 1808 /* Buttons */ 1809 break; 1810 default: 1811 return; /* Done */ 1812 } 1813 1814 switch (event) { 1815 case MOUSE_BUTTON1DOWN: 1816 switch (cnt % 4) { 1817 case 0: /* up */ 1818 mark = VTB_MARK_END; 1819 break; 1820 case 1: /* single click: start cut operation */ 1821 mark = VTB_MARK_START; 1822 break; 1823 case 2: /* double click: cut a word */ 1824 mark = VTB_MARK_WORD; 1825 break; 1826 case 3: /* triple click: cut a line */ 1827 mark = VTB_MARK_ROW; 1828 break; 1829 } 1830 break; 1831 case VT_MOUSE_PASTEBUTTON: 1832 switch (cnt) { 1833 case 0: /* up */ 1834 break; 1835 default: 1836 vt_mouse_paste(); 1837 break; 1838 } 1839 return; /* Done */ 1840 case VT_MOUSE_EXTENDBUTTON: 1841 switch (cnt) { 1842 case 0: /* up */ 1843 if (!(vd->vd_mstate & MOUSE_BUTTON1DOWN)) 1844 mark = VTB_MARK_EXTEND; 1845 else 1846 mark = 0; 1847 break; 1848 default: 1849 mark = VTB_MARK_EXTEND; 1850 break; 1851 } 1852 break; 1853 default: 1854 return; /* Done */ 1855 } 1856 1857 /* Save buttons state. */ 1858 if (cnt > 0) 1859 vd->vd_mstate |= event; 1860 else 1861 vd->vd_mstate &= ~event; 1862 1863 if (vtbuf_set_mark(&vw->vw_buf, mark, vd->vd_mx / vf->vf_width, 1864 vd->vd_my / vf->vf_height) == 1) { 1865 /* 1866 * We have something marked to copy, so update pointer to 1867 * window with selection. 1868 */ 1869 vt_resume_flush_timer(vw->vw_device, 0); 1870 1871 switch (mark) { 1872 case VTB_MARK_END: 1873 case VTB_MARK_WORD: 1874 case VTB_MARK_ROW: 1875 case VTB_MARK_EXTEND: 1876 break; 1877 default: 1878 /* Other types of mark do not require to copy data. */ 1879 return; 1880 } 1881 1882 /* Get current selection size in bytes. */ 1883 len = vtbuf_get_marked_len(&vw->vw_buf); 1884 if (len <= 0) 1885 return; 1886 1887 /* Reallocate buffer only if old one is too small. */ 1888 if (len > VD_PASTEBUFSZ(vd)) { 1889 VD_PASTEBUF(vd) = realloc(VD_PASTEBUF(vd), len, M_VT, 1890 M_WAITOK | M_ZERO); 1891 /* Update buffer size. */ 1892 VD_PASTEBUFSZ(vd) = len; 1893 } 1894 /* Request copy/paste buffer data, no more than `len' */ 1895 vtbuf_extract_marked(&vw->vw_buf, VD_PASTEBUF(vd), 1896 VD_PASTEBUFSZ(vd)); 1897 1898 VD_PASTEBUFLEN(vd) = len; 1899 1900 /* XXX VD_PASTEBUF(vd) have to be freed on shutdown/unload. */ 1901 } 1902 } 1903 1904 void 1905 vt_mouse_state(int show) 1906 { 1907 struct vt_device *vd; 1908 struct vt_window *vw; 1909 1910 vd = main_vd; 1911 vw = vd->vd_curwindow; 1912 1913 switch (show) { 1914 case VT_MOUSE_HIDE: 1915 vw->vw_flags |= VWF_MOUSE_HIDE; 1916 break; 1917 case VT_MOUSE_SHOW: 1918 vw->vw_flags &= ~VWF_MOUSE_HIDE; 1919 break; 1920 } 1921 1922 /* Mark mouse position as dirty. */ 1923 vt_mark_mouse_position_as_dirty(vd); 1924 vt_resume_flush_timer(vw->vw_device, 0); 1925 } 1926 #endif 1927 1928 static int 1929 vtterm_mmap(struct terminal *tm, vm_ooffset_t offset, vm_paddr_t * paddr, 1930 int nprot, vm_memattr_t *memattr) 1931 { 1932 struct vt_window *vw = tm->tm_softc; 1933 struct vt_device *vd = vw->vw_device; 1934 1935 if (vd->vd_driver->vd_fb_mmap) 1936 return (vd->vd_driver->vd_fb_mmap(vd, offset, paddr, nprot, 1937 memattr)); 1938 1939 return (ENXIO); 1940 } 1941 1942 static int 1943 vtterm_ioctl(struct terminal *tm, u_long cmd, caddr_t data, 1944 struct thread *td) 1945 { 1946 struct vt_window *vw = tm->tm_softc; 1947 struct vt_device *vd = vw->vw_device; 1948 keyboard_t *kbd; 1949 int error, i, s; 1950 #if defined(COMPAT_FREEBSD6) || defined(COMPAT_FREEBSD5) || \ 1951 defined(COMPAT_FREEBSD4) || defined(COMPAT_43) 1952 int ival; 1953 1954 switch (cmd) { 1955 case _IO('v', 4): 1956 cmd = VT_RELDISP; 1957 break; 1958 case _IO('v', 5): 1959 cmd = VT_ACTIVATE; 1960 break; 1961 case _IO('v', 6): 1962 cmd = VT_WAITACTIVE; 1963 break; 1964 case _IO('K', 20): 1965 cmd = KDSKBSTATE; 1966 break; 1967 case _IO('K', 67): 1968 cmd = KDSETRAD; 1969 break; 1970 case _IO('K', 7): 1971 cmd = KDSKBMODE; 1972 break; 1973 case _IO('K', 8): 1974 cmd = KDMKTONE; 1975 break; 1976 case _IO('K', 63): 1977 cmd = KIOCSOUND; 1978 break; 1979 case _IO('K', 66): 1980 cmd = KDSETLED; 1981 break; 1982 case _IO('c', 110): 1983 cmd = CONS_SETKBD; 1984 break; 1985 default: 1986 goto skip_thunk; 1987 } 1988 ival = IOCPARM_IVAL(data); 1989 data = (caddr_t)&ival; 1990 skip_thunk: 1991 #endif 1992 1993 switch (cmd) { 1994 case KDSETRAD: /* set keyboard repeat & delay rates (old) */ 1995 if (*(int *)data & ~0x7f) 1996 return (EINVAL); 1997 /* FALLTHROUGH */ 1998 case GIO_KEYMAP: 1999 case PIO_KEYMAP: 2000 case GIO_DEADKEYMAP: 2001 case PIO_DEADKEYMAP: 2002 case GETFKEY: 2003 case SETFKEY: 2004 case KDGKBINFO: 2005 case KDGKBTYPE: 2006 case KDGETREPEAT: /* get keyboard repeat & delay rates */ 2007 case KDSETREPEAT: /* set keyboard repeat & delay rates (new) */ 2008 case KBADDKBD: /* add/remove keyboard to/from mux */ 2009 case KBRELKBD: { 2010 error = 0; 2011 2012 mtx_lock(&Giant); 2013 kbd = kbd_get_keyboard(vd->vd_keyboard); 2014 if (kbd != NULL) 2015 error = kbdd_ioctl(kbd, cmd, data); 2016 mtx_unlock(&Giant); 2017 if (error == ENOIOCTL) { 2018 if (cmd == KDGKBTYPE) { 2019 /* always return something? XXX */ 2020 *(int *)data = 0; 2021 } else { 2022 return (ENODEV); 2023 } 2024 } 2025 return (error); 2026 } 2027 case KDGKBSTATE: { /* get keyboard state (locks) */ 2028 error = 0; 2029 2030 if (vw == vd->vd_curwindow) { 2031 mtx_lock(&Giant); 2032 kbd = kbd_get_keyboard(vd->vd_keyboard); 2033 if (kbd != NULL) 2034 error = vt_save_kbd_state(vw, kbd); 2035 mtx_unlock(&Giant); 2036 2037 if (error != 0) 2038 return (error); 2039 } 2040 2041 *(int *)data = vw->vw_kbdstate & LOCK_MASK; 2042 2043 return (error); 2044 } 2045 case KDSKBSTATE: { /* set keyboard state (locks) */ 2046 int state; 2047 2048 state = *(int *)data; 2049 if (state & ~LOCK_MASK) 2050 return (EINVAL); 2051 2052 vw->vw_kbdstate &= ~LOCK_MASK; 2053 vw->vw_kbdstate |= state; 2054 2055 error = 0; 2056 if (vw == vd->vd_curwindow) { 2057 mtx_lock(&Giant); 2058 kbd = kbd_get_keyboard(vd->vd_keyboard); 2059 if (kbd != NULL) 2060 error = vt_update_kbd_state(vw, kbd); 2061 mtx_unlock(&Giant); 2062 } 2063 2064 return (error); 2065 } 2066 case KDGETLED: { /* get keyboard LED status */ 2067 error = 0; 2068 2069 if (vw == vd->vd_curwindow) { 2070 mtx_lock(&Giant); 2071 kbd = kbd_get_keyboard(vd->vd_keyboard); 2072 if (kbd != NULL) 2073 error = vt_save_kbd_leds(vw, kbd); 2074 mtx_unlock(&Giant); 2075 2076 if (error != 0) 2077 return (error); 2078 } 2079 2080 *(int *)data = vw->vw_kbdstate & LED_MASK; 2081 2082 return (error); 2083 } 2084 case KDSETLED: { /* set keyboard LED status */ 2085 int leds; 2086 2087 leds = *(int *)data; 2088 if (leds & ~LED_MASK) 2089 return (EINVAL); 2090 2091 vw->vw_kbdstate &= ~LED_MASK; 2092 vw->vw_kbdstate |= leds; 2093 2094 error = 0; 2095 if (vw == vd->vd_curwindow) { 2096 mtx_lock(&Giant); 2097 kbd = kbd_get_keyboard(vd->vd_keyboard); 2098 if (kbd != NULL) 2099 error = vt_update_kbd_leds(vw, kbd); 2100 mtx_unlock(&Giant); 2101 } 2102 2103 return (error); 2104 } 2105 case KDGKBMODE: { 2106 error = 0; 2107 2108 if (vw == vd->vd_curwindow) { 2109 mtx_lock(&Giant); 2110 kbd = kbd_get_keyboard(vd->vd_keyboard); 2111 if (kbd != NULL) 2112 error = vt_save_kbd_mode(vw, kbd); 2113 mtx_unlock(&Giant); 2114 2115 if (error != 0) 2116 return (error); 2117 } 2118 2119 *(int *)data = vw->vw_kbdmode; 2120 2121 return (error); 2122 } 2123 case KDSKBMODE: { 2124 int mode; 2125 2126 mode = *(int *)data; 2127 switch (mode) { 2128 case K_XLATE: 2129 case K_RAW: 2130 case K_CODE: 2131 vw->vw_kbdmode = mode; 2132 2133 error = 0; 2134 if (vw == vd->vd_curwindow) { 2135 mtx_lock(&Giant); 2136 kbd = kbd_get_keyboard(vd->vd_keyboard); 2137 if (kbd != NULL) 2138 error = vt_update_kbd_mode(vw, kbd); 2139 mtx_unlock(&Giant); 2140 } 2141 2142 return (error); 2143 default: 2144 return (EINVAL); 2145 } 2146 } 2147 case FBIOGTYPE: 2148 case FBIO_GETWINORG: /* get frame buffer window origin */ 2149 case FBIO_GETDISPSTART: /* get display start address */ 2150 case FBIO_GETLINEWIDTH: /* get scan line width in bytes */ 2151 case FBIO_BLANK: /* blank display */ 2152 if (vd->vd_driver->vd_fb_ioctl) 2153 return (vd->vd_driver->vd_fb_ioctl(vd, cmd, data, td)); 2154 break; 2155 case CONS_BLANKTIME: 2156 /* XXX */ 2157 return (0); 2158 case CONS_GET: 2159 /* XXX */ 2160 *(int *)data = M_CG640x480; 2161 return (0); 2162 case CONS_BELLTYPE: /* set bell type sound */ 2163 if ((*(int *)data) & CONS_QUIET_BELL) 2164 vd->vd_flags |= VDF_QUIET_BELL; 2165 else 2166 vd->vd_flags &= ~VDF_QUIET_BELL; 2167 return (0); 2168 case CONS_GETINFO: { 2169 vid_info_t *vi = (vid_info_t *)data; 2170 if (vi->size != sizeof(struct vid_info)) 2171 return (EINVAL); 2172 2173 if (vw == vd->vd_curwindow) { 2174 kbd = kbd_get_keyboard(vd->vd_keyboard); 2175 if (kbd != NULL) 2176 vt_save_kbd_state(vw, kbd); 2177 } 2178 2179 vi->m_num = vd->vd_curwindow->vw_number + 1; 2180 vi->mk_keylock = vw->vw_kbdstate & LOCK_MASK; 2181 /* XXX: other fields! */ 2182 return (0); 2183 } 2184 case CONS_GETVERS: 2185 *(int *)data = 0x200; 2186 return (0); 2187 case CONS_MODEINFO: 2188 /* XXX */ 2189 return (0); 2190 case CONS_MOUSECTL: { 2191 mouse_info_t *mouse = (mouse_info_t*)data; 2192 2193 /* 2194 * All the commands except MOUSE_SHOW nd MOUSE_HIDE 2195 * should not be applied to individual TTYs, but only to 2196 * consolectl. 2197 */ 2198 switch (mouse->operation) { 2199 case MOUSE_HIDE: 2200 if (vd->vd_flags & VDF_MOUSECURSOR) { 2201 vd->vd_flags &= ~VDF_MOUSECURSOR; 2202 #ifndef SC_NO_CUTPASTE 2203 vt_mouse_state(VT_MOUSE_HIDE); 2204 #endif 2205 } 2206 return (0); 2207 case MOUSE_SHOW: 2208 if (!(vd->vd_flags & VDF_MOUSECURSOR)) { 2209 vd->vd_flags |= VDF_MOUSECURSOR; 2210 vd->vd_mx = vd->vd_width / 2; 2211 vd->vd_my = vd->vd_height / 2; 2212 #ifndef SC_NO_CUTPASTE 2213 vt_mouse_state(VT_MOUSE_SHOW); 2214 #endif 2215 } 2216 return (0); 2217 default: 2218 return (EINVAL); 2219 } 2220 } 2221 case PIO_VFONT: { 2222 struct vt_font *vf; 2223 2224 if (vd->vd_flags & VDF_TEXTMODE) 2225 return (ENOTSUP); 2226 2227 error = vtfont_load((void *)data, &vf); 2228 if (error != 0) 2229 return (error); 2230 2231 error = vt_change_font(vw, vf); 2232 vtfont_unref(vf); 2233 return (error); 2234 } 2235 case PIO_VFONT_DEFAULT: { 2236 /* Reset to default font. */ 2237 error = vt_change_font(vw, &vt_font_default); 2238 return (error); 2239 } 2240 case GIO_SCRNMAP: { 2241 scrmap_t *sm = (scrmap_t *)data; 2242 2243 /* We don't have screen maps, so return a handcrafted one. */ 2244 for (i = 0; i < 256; i++) 2245 sm->scrmap[i] = i; 2246 return (0); 2247 } 2248 case KDSETMODE: 2249 /* 2250 * FIXME: This implementation is incomplete compared to 2251 * syscons. 2252 */ 2253 switch (*(int *)data) { 2254 case KD_TEXT: 2255 case KD_TEXT1: 2256 case KD_PIXEL: 2257 vw->vw_flags &= ~VWF_GRAPHICS; 2258 break; 2259 case KD_GRAPHICS: 2260 vw->vw_flags |= VWF_GRAPHICS; 2261 break; 2262 } 2263 return (0); 2264 case KDENABIO: /* allow io operations */ 2265 error = priv_check(td, PRIV_IO); 2266 if (error != 0) 2267 return (error); 2268 error = securelevel_gt(td->td_ucred, 0); 2269 if (error != 0) 2270 return (error); 2271 #if defined(__i386__) 2272 td->td_frame->tf_eflags |= PSL_IOPL; 2273 #elif defined(__amd64__) 2274 td->td_frame->tf_rflags |= PSL_IOPL; 2275 #endif 2276 return (0); 2277 case KDDISABIO: /* disallow io operations (default) */ 2278 #if defined(__i386__) 2279 td->td_frame->tf_eflags &= ~PSL_IOPL; 2280 #elif defined(__amd64__) 2281 td->td_frame->tf_rflags &= ~PSL_IOPL; 2282 #endif 2283 return (0); 2284 case KDMKTONE: /* sound the bell */ 2285 vtterm_beep(tm, *(u_int *)data); 2286 return (0); 2287 case KIOCSOUND: /* make tone (*data) hz */ 2288 /* TODO */ 2289 return (0); 2290 case CONS_SETKBD: /* set the new keyboard */ 2291 mtx_lock(&Giant); 2292 error = 0; 2293 if (vd->vd_keyboard != *(int *)data) { 2294 kbd = kbd_get_keyboard(*(int *)data); 2295 if (kbd == NULL) { 2296 mtx_unlock(&Giant); 2297 return (EINVAL); 2298 } 2299 i = kbd_allocate(kbd->kb_name, kbd->kb_unit, 2300 (void *)vd, vt_kbdevent, vd); 2301 if (i >= 0) { 2302 if (vd->vd_keyboard != -1) { 2303 vt_save_kbd_state(vd->vd_curwindow, kbd); 2304 kbd_release(kbd, (void *)vd); 2305 } 2306 kbd = kbd_get_keyboard(i); 2307 vd->vd_keyboard = i; 2308 2309 vt_update_kbd_mode(vd->vd_curwindow, kbd); 2310 vt_update_kbd_state(vd->vd_curwindow, kbd); 2311 } else { 2312 error = EPERM; /* XXX */ 2313 } 2314 } 2315 mtx_unlock(&Giant); 2316 return (error); 2317 case CONS_RELKBD: /* release the current keyboard */ 2318 mtx_lock(&Giant); 2319 error = 0; 2320 if (vd->vd_keyboard != -1) { 2321 kbd = kbd_get_keyboard(vd->vd_keyboard); 2322 if (kbd == NULL) { 2323 mtx_unlock(&Giant); 2324 return (EINVAL); 2325 } 2326 vt_save_kbd_state(vd->vd_curwindow, kbd); 2327 error = kbd_release(kbd, (void *)vd); 2328 if (error == 0) { 2329 vd->vd_keyboard = -1; 2330 } 2331 } 2332 mtx_unlock(&Giant); 2333 return (error); 2334 case VT_ACTIVATE: { 2335 int win; 2336 win = *(int *)data - 1; 2337 DPRINTF(5, "%s%d: VT_ACTIVATE ttyv%d ", SC_DRIVER_NAME, 2338 VT_UNIT(vw), win); 2339 if ((win >= VT_MAXWINDOWS) || (win < 0)) 2340 return (EINVAL); 2341 return (vt_proc_window_switch(vd->vd_windows[win])); 2342 } 2343 case VT_GETACTIVE: 2344 *(int *)data = vd->vd_curwindow->vw_number + 1; 2345 return (0); 2346 case VT_GETINDEX: 2347 *(int *)data = vw->vw_number + 1; 2348 return (0); 2349 case VT_LOCKSWITCH: 2350 /* TODO: Check current state, switching can be in progress. */ 2351 if ((*(int *)data) == 0x01) 2352 vw->vw_flags |= VWF_VTYLOCK; 2353 else if ((*(int *)data) == 0x02) 2354 vw->vw_flags &= ~VWF_VTYLOCK; 2355 else 2356 return (EINVAL); 2357 return (0); 2358 case VT_OPENQRY: 2359 VT_LOCK(vd); 2360 for (i = 0; i < VT_MAXWINDOWS; i++) { 2361 vw = vd->vd_windows[i]; 2362 if (vw == NULL) 2363 continue; 2364 if (!(vw->vw_flags & VWF_OPENED)) { 2365 *(int *)data = vw->vw_number + 1; 2366 VT_UNLOCK(vd); 2367 return (0); 2368 } 2369 } 2370 VT_UNLOCK(vd); 2371 return (EINVAL); 2372 case VT_WAITACTIVE: { 2373 unsigned int idx; 2374 2375 error = 0; 2376 2377 idx = *(unsigned int *)data; 2378 if (idx > VT_MAXWINDOWS) 2379 return (EINVAL); 2380 if (idx > 0) 2381 vw = vd->vd_windows[idx - 1]; 2382 2383 VT_LOCK(vd); 2384 while (vd->vd_curwindow != vw && error == 0) 2385 error = cv_wait_sig(&vd->vd_winswitch, &vd->vd_lock); 2386 VT_UNLOCK(vd); 2387 return (error); 2388 } 2389 case VT_SETMODE: { /* set screen switcher mode */ 2390 struct vt_mode *mode; 2391 struct proc *p1; 2392 2393 mode = (struct vt_mode *)data; 2394 DPRINTF(5, "%s%d: VT_SETMODE ", SC_DRIVER_NAME, VT_UNIT(vw)); 2395 if (vw->vw_smode.mode == VT_PROCESS) { 2396 p1 = pfind(vw->vw_pid); 2397 if (vw->vw_proc == p1 && vw->vw_proc != td->td_proc) { 2398 if (p1) 2399 PROC_UNLOCK(p1); 2400 DPRINTF(5, "error EPERM\n"); 2401 return (EPERM); 2402 } 2403 if (p1) 2404 PROC_UNLOCK(p1); 2405 } 2406 if (mode->mode == VT_AUTO) { 2407 vw->vw_smode.mode = VT_AUTO; 2408 vw->vw_proc = NULL; 2409 vw->vw_pid = 0; 2410 DPRINTF(5, "VT_AUTO, "); 2411 if (vw == vw->vw_device->vd_windows[VT_CONSWINDOW]) 2412 cnavailable(vw->vw_terminal->consdev, TRUE); 2413 /* were we in the middle of the vty switching process? */ 2414 if (finish_vt_rel(vw, TRUE, &s) == 0) 2415 DPRINTF(5, "reset WAIT_REL, "); 2416 if (finish_vt_acq(vw) == 0) 2417 DPRINTF(5, "reset WAIT_ACQ, "); 2418 return (0); 2419 } else if (mode->mode == VT_PROCESS) { 2420 if (!ISSIGVALID(mode->relsig) || 2421 !ISSIGVALID(mode->acqsig) || 2422 !ISSIGVALID(mode->frsig)) { 2423 DPRINTF(5, "error EINVAL\n"); 2424 return (EINVAL); 2425 } 2426 DPRINTF(5, "VT_PROCESS %d, ", td->td_proc->p_pid); 2427 bcopy(data, &vw->vw_smode, sizeof(struct vt_mode)); 2428 vw->vw_proc = td->td_proc; 2429 vw->vw_pid = vw->vw_proc->p_pid; 2430 if (vw == vw->vw_device->vd_windows[VT_CONSWINDOW]) 2431 cnavailable(vw->vw_terminal->consdev, FALSE); 2432 } else { 2433 DPRINTF(5, "VT_SETMODE failed, unknown mode %d\n", 2434 mode->mode); 2435 return (EINVAL); 2436 } 2437 DPRINTF(5, "\n"); 2438 return (0); 2439 } 2440 case VT_GETMODE: /* get screen switcher mode */ 2441 bcopy(&vw->vw_smode, data, sizeof(struct vt_mode)); 2442 return (0); 2443 2444 case VT_RELDISP: /* screen switcher ioctl */ 2445 /* 2446 * This must be the current vty which is in the VT_PROCESS 2447 * switching mode... 2448 */ 2449 if ((vw != vd->vd_curwindow) || (vw->vw_smode.mode != 2450 VT_PROCESS)) { 2451 return (EINVAL); 2452 } 2453 /* ...and this process is controlling it. */ 2454 if (vw->vw_proc != td->td_proc) { 2455 return (EPERM); 2456 } 2457 error = EINVAL; 2458 switch(*(int *)data) { 2459 case VT_FALSE: /* user refuses to release screen, abort */ 2460 if ((error = finish_vt_rel(vw, FALSE, &s)) == 0) 2461 DPRINTF(5, "%s%d: VT_RELDISP: VT_FALSE\n", 2462 SC_DRIVER_NAME, VT_UNIT(vw)); 2463 break; 2464 case VT_TRUE: /* user has released screen, go on */ 2465 /* finish_vt_rel(..., TRUE, ...) should not be locked */ 2466 if (vw->vw_flags & VWF_SWWAIT_REL) { 2467 if ((error = finish_vt_rel(vw, TRUE, &s)) == 0) 2468 DPRINTF(5, "%s%d: VT_RELDISP: VT_TRUE\n", 2469 SC_DRIVER_NAME, VT_UNIT(vw)); 2470 } else { 2471 error = EINVAL; 2472 } 2473 return (error); 2474 case VT_ACKACQ: /* acquire acknowledged, switch completed */ 2475 if ((error = finish_vt_acq(vw)) == 0) 2476 DPRINTF(5, "%s%d: VT_RELDISP: VT_ACKACQ\n", 2477 SC_DRIVER_NAME, VT_UNIT(vw)); 2478 break; 2479 default: 2480 break; 2481 } 2482 return (error); 2483 } 2484 2485 return (ENOIOCTL); 2486 } 2487 2488 static struct vt_window * 2489 vt_allocate_window(struct vt_device *vd, unsigned int window) 2490 { 2491 struct vt_window *vw; 2492 struct terminal *tm; 2493 term_pos_t size; 2494 struct winsize wsz; 2495 2496 vw = malloc(sizeof *vw, M_VT, M_WAITOK|M_ZERO); 2497 vw->vw_device = vd; 2498 vw->vw_number = window; 2499 vw->vw_kbdmode = K_XLATE; 2500 2501 if ((vd->vd_flags & VDF_TEXTMODE) == 0) { 2502 vw->vw_font = vtfont_ref(&vt_font_default); 2503 vt_compute_drawable_area(vw); 2504 } 2505 2506 vt_termsize(vd, vw->vw_font, &size); 2507 vt_winsize(vd, vw->vw_font, &wsz); 2508 vtbuf_init(&vw->vw_buf, &size); 2509 2510 tm = vw->vw_terminal = terminal_alloc(&vt_termclass, vw); 2511 terminal_set_winsize(tm, &wsz); 2512 vd->vd_windows[window] = vw; 2513 callout_init(&vw->vw_proc_dead_timer, 0); 2514 2515 return (vw); 2516 } 2517 2518 void 2519 vt_upgrade(struct vt_device *vd) 2520 { 2521 struct vt_window *vw; 2522 unsigned int i; 2523 int register_handlers; 2524 2525 if (!vty_enabled(VTY_VT)) 2526 return; 2527 if (main_vd->vd_driver == NULL) 2528 return; 2529 2530 for (i = 0; i < VT_MAXWINDOWS; i++) { 2531 vw = vd->vd_windows[i]; 2532 if (vw == NULL) { 2533 /* New window. */ 2534 vw = vt_allocate_window(vd, i); 2535 } 2536 if (!(vw->vw_flags & VWF_READY)) { 2537 callout_init(&vw->vw_proc_dead_timer, 0); 2538 terminal_maketty(vw->vw_terminal, "v%r", VT_UNIT(vw)); 2539 vw->vw_flags |= VWF_READY; 2540 if (vw->vw_flags & VWF_CONSOLE) { 2541 /* For existing console window. */ 2542 EVENTHANDLER_REGISTER(shutdown_pre_sync, 2543 vt_window_switch, vw, SHUTDOWN_PRI_DEFAULT); 2544 } 2545 } 2546 2547 } 2548 VT_LOCK(vd); 2549 if (vd->vd_curwindow == NULL) 2550 vd->vd_curwindow = vd->vd_windows[VT_CONSWINDOW]; 2551 2552 register_handlers = 0; 2553 if (!(vd->vd_flags & VDF_ASYNC)) { 2554 /* Attach keyboard. */ 2555 vt_allocate_keyboard(vd); 2556 2557 /* Init 25 Hz timer. */ 2558 callout_init_mtx(&vd->vd_timer, &vd->vd_lock, 0); 2559 2560 /* Start timer when everything ready. */ 2561 vd->vd_flags |= VDF_ASYNC; 2562 callout_reset(&vd->vd_timer, hz / VT_TIMERFREQ, vt_timer, vd); 2563 vd->vd_timer_armed = 1; 2564 register_handlers = 1; 2565 } 2566 2567 VT_UNLOCK(vd); 2568 2569 /* Refill settings with new sizes. */ 2570 vt_resize(vd); 2571 2572 if (register_handlers) { 2573 /* Register suspend/resume handlers. */ 2574 EVENTHANDLER_REGISTER(power_suspend_early, vt_suspend_handler, 2575 vd, EVENTHANDLER_PRI_ANY); 2576 EVENTHANDLER_REGISTER(power_resume, vt_resume_handler, vd, 2577 EVENTHANDLER_PRI_ANY); 2578 } 2579 } 2580 2581 static void 2582 vt_resize(struct vt_device *vd) 2583 { 2584 struct vt_window *vw; 2585 int i; 2586 2587 for (i = 0; i < VT_MAXWINDOWS; i++) { 2588 vw = vd->vd_windows[i]; 2589 VT_LOCK(vd); 2590 /* Assign default font to window, if not textmode. */ 2591 if (!(vd->vd_flags & VDF_TEXTMODE) && vw->vw_font == NULL) 2592 vw->vw_font = vtfont_ref(&vt_font_default); 2593 VT_UNLOCK(vd); 2594 2595 /* Resize terminal windows */ 2596 while (vt_change_font(vw, vw->vw_font) == EBUSY) { 2597 DPRINTF(100, "%s: vt_change_font() is busy, " 2598 "window %d\n", __func__, i); 2599 } 2600 } 2601 } 2602 2603 static void 2604 vt_replace_backend(const struct vt_driver *drv, void *softc) 2605 { 2606 struct vt_device *vd; 2607 2608 vd = main_vd; 2609 2610 if (vd->vd_flags & VDF_ASYNC) { 2611 /* Stop vt_flush periodic task. */ 2612 VT_LOCK(vd); 2613 vt_suspend_flush_timer(vd); 2614 VT_UNLOCK(vd); 2615 /* 2616 * Mute current terminal until we done. vt_change_font (called 2617 * from vt_resize) will unmute it. 2618 */ 2619 terminal_mute(vd->vd_curwindow->vw_terminal, 1); 2620 } 2621 2622 /* 2623 * Reset VDF_TEXTMODE flag, driver who require that flag (vt_vga) will 2624 * set it. 2625 */ 2626 VT_LOCK(vd); 2627 vd->vd_flags &= ~VDF_TEXTMODE; 2628 2629 if (drv != NULL) { 2630 /* 2631 * We want to upgrade from the current driver to the 2632 * given driver. 2633 */ 2634 2635 vd->vd_prev_driver = vd->vd_driver; 2636 vd->vd_prev_softc = vd->vd_softc; 2637 vd->vd_driver = drv; 2638 vd->vd_softc = softc; 2639 2640 vd->vd_driver->vd_init(vd); 2641 } else if (vd->vd_prev_driver != NULL && vd->vd_prev_softc != NULL) { 2642 /* 2643 * No driver given: we want to downgrade to the previous 2644 * driver. 2645 */ 2646 const struct vt_driver *old_drv; 2647 void *old_softc; 2648 2649 old_drv = vd->vd_driver; 2650 old_softc = vd->vd_softc; 2651 2652 vd->vd_driver = vd->vd_prev_driver; 2653 vd->vd_softc = vd->vd_prev_softc; 2654 vd->vd_prev_driver = NULL; 2655 vd->vd_prev_softc = NULL; 2656 2657 vd->vd_flags |= VDF_DOWNGRADE; 2658 2659 vd->vd_driver->vd_init(vd); 2660 2661 if (old_drv->vd_fini) 2662 old_drv->vd_fini(vd, old_softc); 2663 2664 vd->vd_flags &= ~VDF_DOWNGRADE; 2665 } 2666 2667 VT_UNLOCK(vd); 2668 2669 /* Update windows sizes and initialize last items. */ 2670 vt_upgrade(vd); 2671 2672 #ifdef DEV_SPLASH 2673 if (vd->vd_flags & VDF_SPLASH) 2674 vtterm_splash(vd); 2675 #endif 2676 2677 if (vd->vd_flags & VDF_ASYNC) { 2678 /* Allow to put chars now. */ 2679 terminal_mute(vd->vd_curwindow->vw_terminal, 0); 2680 /* Rerun timer for screen updates. */ 2681 vt_resume_flush_timer(vd, 0); 2682 } 2683 2684 /* 2685 * Register as console. If it already registered, cnadd() will ignore 2686 * it. 2687 */ 2688 termcn_cnregister(vd->vd_windows[VT_CONSWINDOW]->vw_terminal); 2689 } 2690 2691 static void 2692 vt_suspend_handler(void *priv) 2693 { 2694 struct vt_device *vd; 2695 2696 vd = priv; 2697 if (vd->vd_driver != NULL && vd->vd_driver->vd_suspend != NULL) 2698 vd->vd_driver->vd_suspend(vd); 2699 } 2700 2701 static void 2702 vt_resume_handler(void *priv) 2703 { 2704 struct vt_device *vd; 2705 2706 vd = priv; 2707 if (vd->vd_driver != NULL && vd->vd_driver->vd_resume != NULL) 2708 vd->vd_driver->vd_resume(vd); 2709 } 2710 2711 void 2712 vt_allocate(const struct vt_driver *drv, void *softc) 2713 { 2714 2715 if (!vty_enabled(VTY_VT)) 2716 return; 2717 2718 if (main_vd->vd_driver == NULL) { 2719 main_vd->vd_driver = drv; 2720 printf("VT: initialize with new VT driver \"%s\".\n", 2721 drv->vd_name); 2722 } else { 2723 /* 2724 * Check if have rights to replace current driver. For example: 2725 * it is bad idea to replace KMS driver with generic VGA one. 2726 */ 2727 if (drv->vd_priority <= main_vd->vd_driver->vd_priority) { 2728 printf("VT: Driver priority %d too low. Current %d\n ", 2729 drv->vd_priority, main_vd->vd_driver->vd_priority); 2730 return; 2731 } 2732 printf("VT: Replacing driver \"%s\" with new \"%s\".\n", 2733 main_vd->vd_driver->vd_name, drv->vd_name); 2734 } 2735 2736 vt_replace_backend(drv, softc); 2737 } 2738 2739 void 2740 vt_deallocate(const struct vt_driver *drv, void *softc) 2741 { 2742 2743 if (!vty_enabled(VTY_VT)) 2744 return; 2745 2746 if (main_vd->vd_prev_driver == NULL || 2747 main_vd->vd_driver != drv || 2748 main_vd->vd_softc != softc) 2749 return; 2750 2751 printf("VT: Switching back from \"%s\" to \"%s\".\n", 2752 main_vd->vd_driver->vd_name, main_vd->vd_prev_driver->vd_name); 2753 2754 vt_replace_backend(NULL, NULL); 2755 } 2756 2757 void 2758 vt_suspend(struct vt_device *vd) 2759 { 2760 int error; 2761 2762 if (vt_suspendswitch == 0) 2763 return; 2764 /* Save current window. */ 2765 vd->vd_savedwindow = vd->vd_curwindow; 2766 /* Ask holding process to free window and switch to console window */ 2767 vt_proc_window_switch(vd->vd_windows[VT_CONSWINDOW]); 2768 2769 /* Wait for the window switch to complete. */ 2770 error = 0; 2771 VT_LOCK(vd); 2772 while (vd->vd_curwindow != vd->vd_windows[VT_CONSWINDOW] && error == 0) 2773 error = cv_wait_sig(&vd->vd_winswitch, &vd->vd_lock); 2774 VT_UNLOCK(vd); 2775 } 2776 2777 void 2778 vt_resume(struct vt_device *vd) 2779 { 2780 2781 if (vt_suspendswitch == 0) 2782 return; 2783 /* Switch back to saved window */ 2784 if (vd->vd_savedwindow != NULL) 2785 vt_proc_window_switch(vd->vd_savedwindow); 2786 vd->vd_savedwindow = NULL; 2787 } 2788