The Design and Implementation of the FreeBSD Operating System, Second Edition
Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

FreeBSD/Linux Kernel Cross Reference
sys/dev/isa/pcdisplay.c

Version: -  FREEBSD  -  FREEBSD-13-STABLE  -  FREEBSD-13-0  -  FREEBSD-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  l41  -  OPENBSD  -  linux-2.6  -  MK84  -  PLAN9  -  xnu-8792 
SearchContext: -  none  -  3  -  10 

    1 /* $NetBSD: pcdisplay.c,v 1.25 2004/03/24 17:26:53 drochner 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: pcdisplay.c,v 1.25 2004/03/24 17:26:53 drochner Exp $");
   31 
   32 #include <sys/param.h>
   33 #include <sys/systm.h>
   34 #include <sys/kernel.h>
   35 #include <sys/device.h>
   36 #include <sys/malloc.h>
   37 #include <machine/bus.h>
   38 
   39 #include <dev/isa/isavar.h>
   40 
   41 #include <dev/ic/mc6845reg.h>
   42 #include <dev/ic/pcdisplayvar.h>
   43 #include <dev/isa/pcdisplayvar.h>
   44 
   45 #include <dev/ic/pcdisplay.h>
   46 
   47 #include <dev/wscons/wsconsio.h>
   48 #include <dev/wscons/wsdisplayvar.h>
   49 
   50 #include "pcweasel.h"
   51 #if NPCWEASEL > 0
   52 #include <dev/isa/weaselreg.h>
   53 #include <dev/isa/weaselvar.h>
   54 #endif
   55 
   56 struct pcdisplay_config {
   57         struct pcdisplayscreen pcs;
   58         struct pcdisplay_handle dc_ph;
   59         int mono;
   60 };
   61 
   62 struct pcdisplay_softc {
   63         struct device sc_dev;
   64         struct pcdisplay_config *sc_dc;
   65         int nscreens;
   66 #if NPCWEASEL > 0
   67         struct weasel_handle sc_weasel;
   68 #endif
   69 };
   70 
   71 static int pcdisplayconsole, pcdisplay_console_attached;
   72 static struct pcdisplay_config pcdisplay_console_dc;
   73 
   74 int     pcdisplay_match __P((struct device *, struct cfdata *, void *));
   75 void    pcdisplay_attach __P((struct device *, struct device *, void *));
   76 
   77 static int pcdisplay_is_console __P((bus_space_tag_t));
   78 static int pcdisplay_probe_col __P((bus_space_tag_t, bus_space_tag_t));
   79 static int pcdisplay_probe_mono __P((bus_space_tag_t, bus_space_tag_t));
   80 static void pcdisplay_init __P((struct pcdisplay_config *,
   81                              bus_space_tag_t, bus_space_tag_t,
   82                              int));
   83 static int pcdisplay_allocattr __P((void *, int, int, int, long *));
   84 
   85 CFATTACH_DECL(pcdisplay, sizeof(struct pcdisplay_softc),
   86     pcdisplay_match, pcdisplay_attach, NULL, NULL);
   87 
   88 const struct wsdisplay_emulops pcdisplay_emulops = {
   89         pcdisplay_cursor,
   90         pcdisplay_mapchar,
   91         pcdisplay_putchar,
   92         pcdisplay_copycols,
   93         pcdisplay_erasecols,
   94         pcdisplay_copyrows,
   95         pcdisplay_eraserows,
   96         pcdisplay_allocattr
   97 };
   98 
   99 const struct wsscreen_descr pcdisplay_scr = {
  100         "80x25", 80, 25,
  101         &pcdisplay_emulops,
  102         0, 0, /* no font support */
  103         WSSCREEN_REVERSE /* that's minimal... */
  104 };
  105 
  106 const struct wsscreen_descr *_pcdisplay_scrlist[] = {
  107         &pcdisplay_scr,
  108 };
  109 
  110 const struct wsscreen_list pcdisplay_screenlist = {
  111         sizeof(_pcdisplay_scrlist) / sizeof(struct wsscreen_descr *),
  112         _pcdisplay_scrlist
  113 };
  114 
  115 static int pcdisplay_ioctl __P((void *, u_long, caddr_t, int, struct proc *));
  116 static paddr_t pcdisplay_mmap __P((void *, off_t, int));
  117 static int pcdisplay_alloc_screen __P((void *, const struct wsscreen_descr *,
  118                                        void **, int *, int *, long *));
  119 static void pcdisplay_free_screen __P((void *, void *));
  120 static int pcdisplay_show_screen __P((void *, void *, int,
  121                                       void (*) (void *, int, int), void *));
  122 
  123 const struct wsdisplay_accessops pcdisplay_accessops = {
  124         pcdisplay_ioctl,
  125         pcdisplay_mmap,
  126         pcdisplay_alloc_screen,
  127         pcdisplay_free_screen,
  128         pcdisplay_show_screen,
  129         0 /* load_font */
  130 };
  131 
  132 static int
  133 pcdisplay_probe_col(iot, memt)
  134         bus_space_tag_t iot, memt;
  135 {
  136         bus_space_handle_t memh, ioh_6845;
  137         u_int16_t oldval, val;
  138 
  139         if (bus_space_map(memt, 0xb8000, 0x8000, 0, &memh))
  140                 return (0);
  141         oldval = bus_space_read_2(memt, memh, 0);
  142         bus_space_write_2(memt, memh, 0, 0xa55a);
  143         val = bus_space_read_2(memt, memh, 0);
  144         bus_space_write_2(memt, memh, 0, oldval);
  145         bus_space_unmap(memt, memh, 0x8000);
  146         if (val != 0xa55a)
  147                 return (0);
  148 
  149         if (bus_space_map(iot, 0x3d0, 0x10, 0, &ioh_6845))
  150                 return (0);
  151         bus_space_unmap(iot, ioh_6845, 0x10);
  152 
  153         return (1);
  154 }
  155 
  156 static int
  157 pcdisplay_probe_mono(iot, memt)
  158         bus_space_tag_t iot, memt;
  159 {
  160         bus_space_handle_t memh, ioh_6845;
  161         u_int16_t oldval, val;
  162 
  163         if (bus_space_map(memt, 0xb0000, 0x8000, 0, &memh))
  164                 return (0);
  165         oldval = bus_space_read_2(memt, memh, 0);
  166         bus_space_write_2(memt, memh, 0, 0xa55a);
  167         val = bus_space_read_2(memt, memh, 0);
  168         bus_space_write_2(memt, memh, 0, oldval);
  169         bus_space_unmap(memt, memh, 0x8000);
  170         if (val != 0xa55a)
  171                 return (0);
  172 
  173         if (bus_space_map(iot, 0x3b0, 0x10, 0, &ioh_6845))
  174                 return (0);
  175         bus_space_unmap(iot, ioh_6845, 0x10);
  176 
  177         return (1);
  178 }
  179 
  180 static void
  181 pcdisplay_init(dc, iot, memt, mono)
  182         struct pcdisplay_config *dc;
  183         bus_space_tag_t iot, memt;
  184         int mono;
  185 {
  186         struct pcdisplay_handle *ph = &dc->dc_ph;
  187         int cpos;
  188 
  189         ph->ph_iot = iot;
  190         ph->ph_memt = memt;
  191         dc->mono = mono;
  192 
  193         if (bus_space_map(memt, mono ? 0xb0000 : 0xb8000, 0x8000,
  194                           0, &ph->ph_memh))
  195                 panic("pcdisplay_init: cannot map memory");
  196         if (bus_space_map(iot, mono ? 0x3b0 : 0x3d0, 0x10,
  197                           0, &ph->ph_ioh_6845))
  198                 panic("pcdisplay_init: cannot map io");
  199 
  200         /*
  201          * initialize the only screen
  202          */
  203         dc->pcs.hdl = ph;
  204         dc->pcs.type = &pcdisplay_scr;
  205         dc->pcs.active = 1;
  206         dc->pcs.mem = NULL;
  207 
  208         cpos = pcdisplay_6845_read(ph, cursorh) << 8;
  209         cpos |= pcdisplay_6845_read(ph, cursorl);
  210 
  211         /* make sure we have a valid cursor position */
  212         if (cpos < 0 || cpos >= pcdisplay_scr.nrows * pcdisplay_scr.ncols)
  213                 cpos = 0;
  214 
  215         dc->pcs.dispoffset = 0;
  216 
  217         dc->pcs.cursorrow = cpos / pcdisplay_scr.ncols;
  218         dc->pcs.cursorcol = cpos % pcdisplay_scr.ncols;
  219         pcdisplay_cursor_init(&dc->pcs, 1);
  220 }
  221 
  222 int
  223 pcdisplay_match(parent, match, aux)
  224         struct device *parent;
  225         struct cfdata *match;
  226         void *aux;
  227 {
  228         struct isa_attach_args *ia = aux;
  229         int mono;
  230 
  231         if (ISA_DIRECT_CONFIG(ia))
  232                 return (0);
  233 
  234         /* If values are hardwired to something that they can't be, punt. */
  235         if (ia->ia_nio < 1 ||
  236             (ia->ia_io[0].ir_addr != ISACF_PORT_DEFAULT &&
  237              ia->ia_io[0].ir_addr != 0x3d0 &&
  238              ia->ia_io[0].ir_addr != 0x3b0))
  239                 return (0);
  240 
  241         if (ia->ia_niomem < 1 ||
  242             (ia->ia_iomem[0].ir_addr != ISACF_IOMEM_DEFAULT &&
  243              ia->ia_iomem[0].ir_addr != 0xb8000 &&
  244              ia->ia_iomem[0].ir_addr != 0xb0000))
  245                 return (0);
  246         if (ia->ia_iomem[0].ir_size != 0 &&
  247             ia->ia_iomem[0].ir_size != 0x8000)
  248                 return (0);
  249 
  250         if (ia->ia_nirq > 0 &&
  251             ia->ia_irq[0].ir_irq != ISACF_IRQ_DEFAULT)
  252                 return (0);
  253 
  254         if (ia->ia_ndrq > 0 &&
  255             ia->ia_drq[0].ir_drq != ISACF_DRQ_DEFAULT)
  256                 return (0);
  257 
  258         if (pcdisplay_is_console(ia->ia_iot))
  259                 mono = pcdisplay_console_dc.mono;
  260         else if (ia->ia_io[0].ir_addr != 0x3b0 &&
  261                  ia->ia_iomem[0].ir_addr != 0xb0000 &&
  262                  pcdisplay_probe_col(ia->ia_iot, ia->ia_memt))
  263                 mono = 0;
  264         else if (ia->ia_io[0].ir_addr != 0x3d0 &&
  265                  ia->ia_iomem[0].ir_addr != 0xb8000 &&
  266                  pcdisplay_probe_mono(ia->ia_iot, ia->ia_memt))
  267                 mono = 1;
  268         else
  269                 return (0);
  270 
  271         ia->ia_nio = 1;
  272         ia->ia_io[0].ir_addr = mono ? 0x3b0 : 0x3d0;
  273         ia->ia_io[0].ir_size = 0x10;
  274 
  275         ia->ia_niomem = 1;
  276         ia->ia_iomem[0].ir_size = mono ? 0xb0000 : 0xb8000;
  277         ia->ia_iomem[0].ir_size = 0x8000;
  278 
  279         ia->ia_nirq = 0;
  280         ia->ia_ndrq = 0;
  281 
  282         return (1);
  283 }
  284 
  285 void
  286 pcdisplay_attach(parent, self, aux)
  287         struct device *parent, *self;
  288         void *aux;
  289 {
  290         struct isa_attach_args *ia = aux;
  291         struct pcdisplay_softc *sc = (struct pcdisplay_softc *)self;
  292         int console;
  293         struct pcdisplay_config *dc;
  294         struct wsemuldisplaydev_attach_args aa;
  295 
  296         printf("\n");
  297 
  298         console = pcdisplay_is_console(ia->ia_iot);
  299 
  300         if (console) {
  301                 dc = &pcdisplay_console_dc;
  302                 sc->nscreens = 1;
  303                 pcdisplay_console_attached = 1;
  304         } else {
  305                 dc = malloc(sizeof(struct pcdisplay_config),
  306                             M_DEVBUF, M_WAITOK);
  307                 if (ia->ia_io[0].ir_addr != 0x3b0 &&
  308                     ia->ia_iomem[0].ir_addr != 0xb0000 &&
  309                     pcdisplay_probe_col(ia->ia_iot, ia->ia_memt))
  310                         pcdisplay_init(dc, ia->ia_iot, ia->ia_memt, 0);
  311                 else if (ia->ia_io[0].ir_addr != 0x3d0 &&
  312                          ia->ia_iomem[0].ir_addr != 0xb8000 &&
  313                          pcdisplay_probe_mono(ia->ia_iot, ia->ia_memt))
  314                         pcdisplay_init(dc, ia->ia_iot, ia->ia_memt, 1);
  315                 else
  316                         panic("pcdisplay_attach: display disappeared");
  317         }
  318         sc->sc_dc = dc;
  319 
  320 #if NPCWEASEL > 0
  321         /*
  322          * If the display is monochrome, check to see if we have
  323          * a PC-Weasel, and initialize its special features.
  324          */
  325         if (dc->mono) {
  326                 sc->sc_weasel.wh_st = dc->dc_ph.ph_memt;
  327                 sc->sc_weasel.wh_sh = dc->dc_ph.ph_memh;
  328                 sc->sc_weasel.wh_parent = &sc->sc_dev;
  329                 weasel_isa_init(&sc->sc_weasel);
  330         }
  331 #endif /* NPCWEASEL > 0 */
  332 
  333         aa.console = console;
  334         aa.scrdata = &pcdisplay_screenlist;
  335         aa.accessops = &pcdisplay_accessops;
  336         aa.accesscookie = sc;
  337 
  338         config_found(self, &aa, wsemuldisplaydevprint);
  339 }
  340 
  341 
  342 int
  343 pcdisplay_cnattach(iot, memt)
  344         bus_space_tag_t iot, memt;
  345 {
  346         int mono;
  347 
  348         if (pcdisplay_probe_col(iot, memt))
  349                 mono = 0;
  350         else if (pcdisplay_probe_mono(iot, memt))
  351                 mono = 1;
  352         else
  353                 return (ENXIO);
  354 
  355         pcdisplay_init(&pcdisplay_console_dc, iot, memt, mono);
  356 
  357         wsdisplay_cnattach(&pcdisplay_scr, &pcdisplay_console_dc,
  358                            pcdisplay_console_dc.pcs.cursorcol,
  359                            pcdisplay_console_dc.pcs.cursorrow,
  360                            FG_LIGHTGREY | BG_BLACK);
  361 
  362         pcdisplayconsole = 1;
  363         return (0);
  364 }
  365 
  366 static int
  367 pcdisplay_is_console(iot)
  368         bus_space_tag_t iot;
  369 {
  370         if (pcdisplayconsole &&
  371             !pcdisplay_console_attached &&
  372             iot == pcdisplay_console_dc.dc_ph.ph_iot)
  373                 return (1);
  374         return (0);
  375 }
  376 
  377 static int
  378 pcdisplay_ioctl(v, cmd, data, flag, p)
  379         void *v;
  380         u_long cmd;
  381         caddr_t data;
  382         int flag;
  383         struct proc *p;
  384 {
  385         /*
  386          * XXX "do something!"
  387          */
  388         return (EPASSTHROUGH);
  389 }
  390 
  391 static paddr_t
  392 pcdisplay_mmap(v, offset, prot)
  393         void *v;
  394         off_t offset;
  395         int prot;
  396 {
  397         return (-1);
  398 }
  399 
  400 static int
  401 pcdisplay_alloc_screen(v, type, cookiep, curxp, curyp, defattrp)
  402         void *v;
  403         const struct wsscreen_descr *type;
  404         void **cookiep;
  405         int *curxp, *curyp;
  406         long *defattrp;
  407 {
  408         struct pcdisplay_softc *sc = v;
  409 
  410         if (sc->nscreens > 0)
  411                 return (ENOMEM);
  412 
  413         *cookiep = sc->sc_dc;
  414         *curxp = 0;
  415         *curyp = 0;
  416         *defattrp = FG_LIGHTGREY | BG_BLACK;
  417         sc->nscreens++;
  418         return (0);
  419 }
  420 
  421 static void
  422 pcdisplay_free_screen(v, cookie)
  423         void *v;
  424         void *cookie;
  425 {
  426         struct pcdisplay_softc *sc = v;
  427 
  428         if (sc->sc_dc == &pcdisplay_console_dc)
  429                 panic("pcdisplay_free_screen: console");
  430 
  431         sc->nscreens--;
  432 }
  433 
  434 static int
  435 pcdisplay_show_screen(v, cookie, waitok, cb, cbarg)
  436         void *v;
  437         void *cookie;
  438         int waitok;
  439         void (*cb) __P((void *, int, int));
  440         void *cbarg;
  441 {
  442 #ifdef DIAGNOSTIC
  443         struct pcdisplay_softc *sc = v;
  444 
  445         if (cookie != sc->sc_dc)
  446                 panic("pcdisplay_show_screen: bad screen");
  447 #endif
  448         return (0);
  449 }
  450 
  451 static int
  452 pcdisplay_allocattr(id, fg, bg, flags, attrp)
  453         void *id;
  454         int fg, bg;
  455         int flags;
  456         long *attrp;
  457 {
  458         if (flags & WSATTR_REVERSE)
  459                 *attrp = FG_BLACK | BG_LIGHTGREY;
  460         else
  461                 *attrp = FG_LIGHTGREY | BG_BLACK;
  462         return (0);
  463 }

Cache object: 5c68f4e5d118d7272009492506e6c836


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.