/*- * Copyright (c) 1999 Kazutaka YOKOTA * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer as * the first lines of this file unmodified. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. * * $FreeBSD$ */ #include "sc.h" #include "opt_syscons.h" #if NSC > 0 #include #include #include #include #include #include #include #ifdef __i386__ #include #include #include #include #include #include #define BIOS_CLKED (1 << 6) #define BIOS_NLKED (1 << 5) #define BIOS_SLKED (1 << 4) #define BIOS_ALKED 0 #endif /* __i386__ */ #include #include #include static devclass_t sc_devclass; static int scprobe(device_t dev); static int scattach(device_t dev); static int scresume(device_t dev); static device_method_t sc_methods[] = { DEVMETHOD(device_probe, scprobe), DEVMETHOD(device_attach, scattach), DEVMETHOD(device_resume, scresume), { 0, 0 } }; static driver_t sc_driver = { SC_DRIVER_NAME, sc_methods, sizeof(sc_softc_t), }; static sc_softc_t main_softc; static int scprobe(device_t dev) { /* No pnp support */ if (isa_get_vendorid(dev)) return (ENXIO); device_set_desc(dev, "System console"); return sc_probe_unit(device_get_unit(dev), device_get_flags(dev)); } static int scattach(device_t dev) { return sc_attach_unit(device_get_unit(dev), device_get_flags(dev)); } static int scresume(device_t dev) { return sc_resume_unit(device_get_unit(dev)); } int sc_max_unit(void) { return devclass_get_maxunit(sc_devclass); } sc_softc_t *sc_get_softc(int unit, int flags) { sc_softc_t *sc; if ((unit < 0) || (unit >= NSC)) return NULL; if (flags & SC_KERNEL_CONSOLE) { /* FIXME: clear if it is wired to another unit! */ sc = &main_softc; } else { sc = (sc_softc_t *)device_get_softc(devclass_get_device(sc_devclass, unit)); } sc->unit = unit; if (!(sc->flags & SC_INIT_DONE)) { sc->keyboard = -1; sc->adapter = -1; sc->mouse_char = SC_MOUSE_CHAR; } return sc; } sc_softc_t *sc_find_softc(struct video_adapter *adp, struct keyboard *kbd) { sc_softc_t *sc; int units; int i; sc = &main_softc; if (((adp == NULL) || (adp == sc->adp)) && ((kbd == NULL) || (kbd == sc->kbd))) return sc; units = devclass_get_maxunit(sc_devclass); for (i = 0; i < units; ++i) { sc = (sc_softc_t *)device_get_softc(devclass_get_device(sc_devclass, i)); if (sc == NULL) continue; if (((adp == NULL) || (adp == sc->adp)) && ((kbd == NULL) || (kbd == sc->kbd))) return sc; } return NULL; } int sc_get_cons_priority(int *unit, int *flags) { int disabled; int u, f; int i; *unit = -1; for (i = -1; (i = resource_locate(i, SC_DRIVER_NAME)) >= 0;) { u = resource_query_unit(i); if ((resource_int_value(SC_DRIVER_NAME, u, "disabled", &disabled) == 0) && disabled) continue; if (resource_int_value(SC_DRIVER_NAME, u, "flags", &f) != 0) f = 0; if (f & SC_KERNEL_CONSOLE) { /* the user designates this unit to be the console */ *unit = u; *flags = f; break; } if (*unit < 0) { /* ...otherwise remember the first found unit */ *unit = u; *flags = f; } } if ((i < 0) && (*unit < 0)) return CN_DEAD; #if 0 return ((*flags & SC_KERNEL_CONSOLE) ? CN_INTERNAL : CN_NORMAL); #endif return CN_INTERNAL; } void sc_get_bios_values(bios_values_t *values) { #ifdef __i386__ u_int8_t shift; values->cursor_start = *(u_int8_t *)BIOS_PADDRTOVADDR(0x461); values->cursor_end = *(u_int8_t *)BIOS_PADDRTOVADDR(0x460); shift = *(u_int8_t *)BIOS_PADDRTOVADDR(0x417); values->shift_state = ((shift & BIOS_CLKED) ? CLKED : 0) | ((shift & BIOS_NLKED) ? NLKED : 0) | ((shift & BIOS_SLKED) ? SLKED : 0) | ((shift & BIOS_ALKED) ? ALKED : 0); values->bell_pitch = BELL_PITCH; #else /* !__i386__ */ values->cursor_start = 0; values->cursor_end = 32; values->shift_state = 0; values->bell_pitch = BELL_PITCH; #endif /* __i386__ */ } int sc_tone(int herz) { #ifdef __i386__ int pitch; if (herz) { /* set command for counter 2, 2 byte write */ if (acquire_timer2(TIMER_16BIT | TIMER_SQWAVE)) return EBUSY; /* set pitch */ pitch = timer_freq/herz; outb(TIMER_CNTR2, pitch); outb(TIMER_CNTR2, pitch >> 8); /* enable counter 2 output to speaker */ outb(IO_PPI, inb(IO_PPI) | 3); } else { /* disable counter 2 output to speaker */ outb(IO_PPI, inb(IO_PPI) & 0xFC); release_timer2(); } #endif /* __i386__ */ return 0; } DRIVER_MODULE(sc, isa, sc_driver, sc_devclass, 0, 0); #endif /* NSC > 0 */