root/dev/pcmcia/cfxga.c

DEFINITIONS

1. cfxga_install_function
2. cfxga_remove_function
3. cfxga_match
4. cfxga_activate
5. cfxga_attach
6. cfxga_detach
7. cfxga_alloc_screen
8. cfxga_burner
9. cfxga_free_screen
10. cfxga_ioctl
11. cfxga_mmap
12. cfxga_show_screen
13. cfxga_reset_video
14. cfxga_reset_and_repaint
15. cfxga_wait
16. cfxga_synchronize
17. cfxga_expand_char
18. cfxga_repaint_screen
19. cfxga_solid_fill
20. cfxga_standalone_rop
21. cfxga_copycols
22. cfxga_copyrows
23. cfxga_do_cursor
24. cfxga_erasecols
25. cfxga_eraserows
26. cfxga_putchar

    1 /*      $OpenBSD: cfxga.c,v 1.14 2006/11/29 19:11:17 miod Exp $ */
    3 /*
    4  * Copyright (c) 2005, 2006, Matthieu Herrb and Miodrag Vallat
    5  *
    6  * Permission to use, copy, modify, and distribute this software for any
    7  * purpose with or without fee is hereby granted, provided that the above
    8  * copyright notice and this permission notice appear in all copies.
    9  *
   10  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHORS DISCLAIM ALL WARRANTIES
   11  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
   12  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR
   13  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
   14  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
   15  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
   16  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
   17  */
   19 /*
   20  * Display driver for the Colorgraphic CompactFlash ``VoyagerVGA'' card.
   21  * based upon the Epson S1D13806 graphics chip.
   22  *
   23  * Our goals are:
   24  * - to provide a somewhat usable emulation mode for extra text display.
   25  * - to let an application (such as an X server) map the controller registers
   26  *   in order to do its own display game.
   27  *
   28  * Driving this card is somewhat a challenge since:
   29  * - its video memory is not directly accessible.
   30  * - no operation can make use of DMA.
   31  */
   33 #include <sys/param.h>
   34 #include <sys/kernel.h>
   35 #include <sys/device.h>
   36 #include <sys/systm.h>
   37 #include <sys/malloc.h>
   38 #include <sys/conf.h>
   40 #include <dev/pcmcia/pcmciavar.h>
   41 #include <dev/pcmcia/pcmciareg.h>
   43 #include <dev/wscons/wsconsio.h>
   44 #include <dev/wscons/wsdisplayvar.h>
   45 #include <dev/rasops/rasops.h>
   47 #include <dev/pcmcia/cfxgareg.h>
   49 /*
   50 #define CFXGADEBUG
   51 #define ENABLE_8BIT_MODES
   52 */
   54 #ifdef CFXGADEBUG
   55 #define DPRINTF(arg) printf arg
   56 #else
   57 #define DPRINTF(arg)
   58 #endif
   60 struct cfxga_screen;
   62 #define CFXGA_MODE_640x480x16   0
   63 #define CFXGA_MODE_800x600x16   1
   64 #ifdef ENABLE_8BIT_MODES
   65 #define CFXGA_MODE_640x480x8    2
   66 #define CFXGA_MODE_800x600x8    3
   67 #define CFXGA_NMODES            4
   68 #else
   69 #define CFXGA_NMODES            2
   70 #endif
   72 struct cfxga_softc {
   73         struct device sc_dev;
   74         struct pcmcia_function *sc_pf;
   75         int     sc_state;
   76 #define CS_MAPPED       0x0001
   77 #define CS_RESET        0x0002
   79         struct pcmcia_mem_handle sc_pmemh;
   80         int sc_memwin;
bus_addr_t sc_offset;
   83         int sc_mode;
   85         int sc_nscreens;
LIST_HEAD(, cfxga_screen) sc_scr;
   87         struct cfxga_screen *sc_active;
   89         /* wsdisplay glue */
   90         struct wsscreen_descr sc_wsd[CFXGA_NMODES];
   91         struct wsscreen_list sc_wsl;
   92         struct wsscreen_descr *sc_scrlist[CFXGA_NMODES];
   93         struct wsdisplay_emulops sc_ops;
   94         struct device *sc_wsdisplay;
   95 };
   97 int     cfxga_match(struct device *, void *,  void *);
   98 void    cfxga_attach(struct device *, struct device *, void *);
   99 int     cfxga_detach(struct device *, int);
  100 int     cfxga_activate(struct device *, enum devact);
  102 struct cfattach cfxga_ca = {
  103         sizeof(struct cfxga_softc), cfxga_match, cfxga_attach,
cfxga_detach, cfxga_activate
  105 };
  107 struct cfdriver cfxga_cd = {
NULL, "cfxga", DV_DULL
  109 };
  111 int     cfxga_alloc_screen(void *, const struct wsscreen_descr *, void **,
  112             int *, int *, long *);
  113 void    cfxga_burner(void *, u_int, u_int);
  114 void    cfxga_free_screen(void *, void *);
  115 int     cfxga_ioctl(void *, u_long, caddr_t, int, struct proc *);
paddr_t cfxga_mmap(void *, off_t, int);
  117 int     cfxga_show_screen(void *, void *, int, void (*)(void *, int, int),
  118             void *);
  120 struct wsdisplay_accessops cfxga_accessops = {
cfxga_ioctl,
cfxga_mmap,
cfxga_alloc_screen,
cfxga_free_screen,
cfxga_show_screen,
NULL,
NULL,
NULL,
cfxga_burner
  130 };
  132 /*
  133  * Per-screen structure
  134  */
  136 struct cfxga_screen {
LIST_ENTRY(cfxga_screen) scr_link;
  138         struct cfxga_softc *scr_sc;     /* parent reference */
  139         struct rasops_info scr_ri;      /* raster op glue */
  140         struct wsdisplay_charcell *scr_mem;     /* backing memory */
  141 };
  143 void    cfxga_copycols(void *, int, int, int, int);
  144 void    cfxga_copyrows(void *, int, int, int);
  145 void    cfxga_do_cursor(struct rasops_info *);
  146 void    cfxga_erasecols(void *, int, int, int, long);
  147 void    cfxga_eraserows(void *, int, int, long);
  148 void    cfxga_putchar(void *, int, int, u_int, long);
  150 int     cfxga_install_function(struct pcmcia_function *);
  151 void    cfxga_remove_function(struct pcmcia_function *);
  153 int     cfxga_expand_char(struct cfxga_screen *, u_int, int, int, long);
  154 int     cfxga_repaint_screen(struct cfxga_screen *);
  155 void    cfxga_reset_video(struct cfxga_softc *);
  156 void    cfxga_reset_and_repaint(struct cfxga_softc *);
  157 int     cfxga_solid_fill(struct cfxga_screen *, int, int, int, int, int32_t);
  158 int     cfxga_standalone_rop(struct cfxga_screen *, u_int,
  159             int, int, int, int, int, int);
  160 int     cfxga_synchronize(struct cfxga_softc *);
u_int   cfxga_wait(struct cfxga_softc *, u_int, u_int);
  163 #define cfxga_clear_screen(scr) \
cfxga_solid_fill(scr, 0, 0, scr->scr_ri.ri_width, \
scr->scr_ri.ri_height, scr->scr_ri.ri_devcmap[WSCOL_BLACK])
  167 #define cfxga_read_1(sc, addr) \
bus_space_read_1((sc)->sc_pmemh.memt, (sc)->sc_pmemh.memh, \
  169             (sc)->sc_offset + (addr))
  170 #define cfxga_read_2(sc, addr) \
bus_space_read_2((sc)->sc_pmemh.memt, (sc)->sc_pmemh.memh, \
  172             (sc)->sc_offset + (addr))
  173 #define cfxga_write_1(sc, addr, val) \
bus_space_write_1((sc)->sc_pmemh.memt, (sc)->sc_pmemh.memh, \
  175             (sc)->sc_offset + (addr), (val))
  176 #define cfxga_write_2(sc, addr, val) \
bus_space_write_2((sc)->sc_pmemh.memt, (sc)->sc_pmemh.memh, \
  178             (sc)->sc_offset + (addr), (val))
  180 #define cfxga_stop_memory_blt(sc) \
  181         (void)cfxga_read_2(sc, CFREG_BITBLT_DATA)
  183 const char *cfxga_modenames[CFXGA_NMODES] = {
  184         "640x480x16",
  185         "800x600x16",
  186 #ifdef ENABLE_8BIT_MODES
  187         "640x480x8",
  188         "800x600x8"
  189 #endif
  190 };
  192 /*
  193  * This card is very poorly engineered, specificationwise. It does not
  194  * provide any CIS information, and has no vendor/product numbers as
  195  * well: as such, there is no easy way to differentiate it from any
  196  * other cheapo PCMCIA card.
  197  *
  198  * The best we can do is probe for a chip ID. This is not perfect but better
  199  * than matching blindly. Of course this requires us to play some nasty games
  200  * behind the PCMCIA framework to be able to do this probe, and correctly fail
  201  * if this is not the card we are looking for.
  202  *
  203  * In shorter words: some card designers ought to be shot, as a service
  204  * to the community.
  205  */
  207 /*
  208  * Create the necessary pcmcia function structures to alleviate the lack
  209  * of any CIS information on this device.
  210  * Actually, we hijack the fake function created by the pcmcia framework.
  211  */
  212 int
cfxga_install_function(struct pcmcia_function *pf)
  214 {
  215         struct pcmcia_config_entry *cfe;
  217         /* Get real. */
pf->pf_flags &= ~PFF_FAKE;
  220         /* Tell the pcmcia framework where the CCR is. */
pf->ccr_base = 0x800;
pf->ccr_mask = 0x67;
  224         /* Create a simple cfe. */
cfe = (struct pcmcia_config_entry *)malloc(sizeof *cfe,
M_DEVBUF, M_NOWAIT);
  227         if (cfe == NULL) {
DPRINTF(("%s: cfe allocation failed\n", __func__));
  229                 return (ENOMEM);
  230         }
bzero(cfe, sizeof *cfe);
cfe->number = 42;       /* have to put some value... */
cfe->flags = PCMCIA_CFE_IO16;
cfe->iftype = PCMCIA_IFTYPE_MEMORY;
SIMPLEQ_INSERT_TAIL(&pf->cfe_head, cfe, cfe_list);
pcmcia_function_init(pf, cfe);
  240         return (0);
  241 }
  243 /*
  244  * Undo the changes done above.
  245  * Such a function is necessary since we need a full-blown pcmcia world
  246  * set up in order to do the device probe, but if we don't match the card,
  247  * leaving this state will cause trouble during other probes.
  248  */
  249 void
cfxga_remove_function(struct pcmcia_function *pf)
  251 {
  252         struct pcmcia_config_entry *cfe;
  254         /* we are the first and only entry... */
cfe = SIMPLEQ_FIRST(&pf->cfe_head);
SIMPLEQ_REMOVE_HEAD(&pf->cfe_head, cfe_list);
free(cfe, M_DEVBUF);
  259         /* And we're a figment of the kernel's imagination again. */
pf->pf_flags |= PFF_FAKE;
  261 }
  263 int 
cfxga_match(struct device *parent, void *match, void *aux)
  265 {
  266         struct pcmcia_attach_args *pa = aux;
  267         struct pcmcia_function *pf = pa->pf;
  268         struct pcmcia_mem_handle h;
  269         int rc;
  270         int win;
bus_addr_t ptr;
u_int8_t id = 0;
  274         if (pa->product != PCMCIA_PRODUCT_INVALID ||
pa->manufacturer != PCMCIA_VENDOR_INVALID)
  276                 return (0);
  278         /* Only a card with no CIS will have a fake function... */
  279         if ((pf->pf_flags & PFF_FAKE) == 0)
  280                 return (0);
  282         if (cfxga_install_function(pf) != 0)
  283                 return (0);
  285         if (pcmcia_function_enable(pf) != 0) {
DPRINTF(("%s: function enable failed\n"));
  287                 return (0);
  288         }
rc = pcmcia_mem_alloc(pf, CFXGA_MEM_RANGE, &h);
  291         if (rc != 0)
  292                 goto out;
rc = pcmcia_mem_map(pf, PCMCIA_MEM_ATTR, 0, CFXGA_MEM_RANGE,
  295             &h, &ptr, &win);
  296         if (rc != 0)
  297                 goto out2;
id = (bus_space_read_1(h.memt, h.memh, ptr + CFREG_REV) &
CR_PRODUCT_MASK) >> CR_PRODUCT_SHIFT;
pcmcia_mem_unmap(pa->pf, win);
out2:
pcmcia_mem_free(pa->pf, &h);
out:
pcmcia_function_disable(pf);
cfxga_remove_function(pf);
  309         /*
  310          * Be sure to return a value greater than pccom's if we match,
  311          * otherwise it can win due to the way config(8) will order devices...
  312          */
  313         return (id == PRODUCT_S1D13806 ? 10 : 0);
  314 }
  316 int
cfxga_activate(struct device *dev, enum devact act)
  318 {
  319         struct cfxga_softc *sc = (void *)dev;
  321         switch (act) {
  322         case DVACT_ACTIVATE:
  323                 if (pcmcia_function_enable(sc->sc_pf) != 0) {
printf("%s: function enable failed\n",
sc->sc_dev.dv_xname);
  326                 } else {
cfxga_reset_and_repaint(sc);
  328                 }
  329                 break;
  330         case DVACT_DEACTIVATE:
pcmcia_function_disable(sc->sc_pf);
  332                 break;
  333         }
  334         return (0);
  335 }
  337 void 
cfxga_attach(struct device *parent, struct device *self, void *aux)
  339 {
  340         struct cfxga_softc *sc = (void *)self;
  341         struct pcmcia_attach_args *pa = aux;
  342         struct pcmcia_function *pf = pa->pf;
  343         struct wsemuldisplaydev_attach_args waa;
  344         struct wsscreen_descr *wsd;
u_int i;
LIST_INIT(&sc->sc_scr);
sc->sc_nscreens = 0;
sc->sc_pf = pf;
  351         if (cfxga_install_function(pf) != 0) {
printf(": pcmcia function setup failed\n");
  353                 return;
  354         }
  356         if (pcmcia_function_enable(pf)) {
printf(": function enable failed\n");
  358                 return;
  359         }
  361         if (pcmcia_mem_alloc(pf, CFXGA_MEM_RANGE, &sc->sc_pmemh) != 0) {
printf(": can't allocate memory space\n");
  363                 return;
  364         }
  366         if (pcmcia_mem_map(pf, PCMCIA_MEM_ATTR, 0, CFXGA_MEM_RANGE,
  367             &sc->sc_pmemh, &sc->sc_offset, &sc->sc_memwin) != 0) {
printf(": can't map frame buffer registers\n");
pcmcia_mem_free(pf, &sc->sc_pmemh);
  370                 return;
  371         }
SET(sc->sc_state, CS_MAPPED);
printf("\n");
sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
  379         /*
  380          * We actually defer real initialization to the creation of the
  381          * first wsdisplay screen, since we do not know which mode to pick
  382          * yet.
  383          */
  385         for (wsd = sc->sc_wsd, i = 0; i < CFXGA_NMODES; wsd++, i++) {
strlcpy(wsd->name, cfxga_modenames[i], sizeof(wsd->name));
wsd->textops = &sc->sc_ops;
sc->sc_scrlist[i] = wsd;
  389         }
sc->sc_wsl.nscreens = CFXGA_NMODES;
sc->sc_wsl.screens = (const struct wsscreen_descr **)sc->sc_scrlist;
waa.console = 0;
waa.scrdata = &sc->sc_wsl;
waa.accessops = &cfxga_accessops;
waa.accesscookie = sc;
waa.defaultscreens = 1;
  399         if ((sc->sc_wsdisplay =
config_found(self, &waa, wsemuldisplaydevprint)) == NULL) {
  401                 /* otherwise wscons will do this */
  402                 if (sc->sc_active != NULL)
cfxga_clear_screen(sc->sc_active);
  404                 else
cfxga_burner(sc, 0, 0);
  406         }
  407 }
  409 int
cfxga_detach(struct device *dev, int flags)
  411 {
  412         struct cfxga_softc *sc = (void *)dev;
  414         /*
  415          * Detach all children, and hope wsdisplay detach code is correct...
  416          */
  417         if (sc->sc_wsdisplay != NULL) {
config_detach(sc->sc_wsdisplay, DETACH_FORCE);
  419                 /* sc->sc_wsdisplay = NULL; */
  420         }
  422         if (ISSET(sc->sc_state, CS_MAPPED)) {
pcmcia_mem_unmap(sc->sc_pf, sc->sc_memwin);
pcmcia_mem_free(sc->sc_pf, &sc->sc_pmemh);
  425                 /* CLR(sc->sc_state, CS_MAPPED); */
  426         }
  428         return (0);
  429 }
  431 /*
  432  * Wscons operations
  433  */
  435 int
cfxga_alloc_screen(void *v, const struct wsscreen_descr *type, void **cookiep,
  437     int *curxp, int *curyp, long *attrp)
  438 {
  439         struct cfxga_softc *sc = v;
  440         struct cfxga_screen *scr;
  441         struct rasops_info *ri;
u_int mode, width, height, depth, scrsize;
scr = malloc(sizeof *scr, M_DEVBUF, cold ? M_NOWAIT : M_WAITOK);
  445         if (scr == NULL)
  446                 return (ENOMEM);
bzero(scr, sizeof *scr);
mode = type - sc->sc_wsd;
  450 #ifdef DIAGNOSTIC
  451         if (mode >= CFXGA_NMODES)
mode = CFXGA_MODE_640x480x16;
  453 #endif
  454         switch (mode) {
  455         default:
  456         case CFXGA_MODE_640x480x16:
width = 640;
height = 480;
depth = 16;
  460                 break;
  461         case CFXGA_MODE_800x600x16:
width = 800;
height = 600;
depth = 16;
  465                 break;
  466 #ifdef ENABLE_8BIT_MODES
  467         case CFXGA_MODE_640x480x8:
width = 640;
height = 480;
depth = 8;
  471                 break;
  472         case CFXGA_MODE_800x600x8:
width = 800;
height = 600;
depth = 8;
  476                 break;
  477 #endif
  478         }
ri = &scr->scr_ri;
ri->ri_hw = (void *)scr;
ri->ri_bits = NULL;
ri->ri_depth = depth;
ri->ri_width = width;
ri->ri_height = height;
ri->ri_stride = width * depth / 8;
ri->ri_flg = 0;
  489         /* swap B and R at 16 bpp */
  490         if (depth == 16) {
ri->ri_rnum = 5;
ri->ri_rpos = 11;
ri->ri_gnum = 6;
ri->ri_gpos = 5;
ri->ri_bnum = 5;
ri->ri_bpos = 0;
  497         }
  499         if (type->nrows == 0)   /* first screen creation */
rasops_init(ri, 100, 100);
  501         else
rasops_init(ri, type->nrows, type->ncols);
  504         /*
  505          * Allocate backing store to remember non-visible screen contents in
  506          * emulation mode.
  507          */
scrsize = ri->ri_rows * ri->ri_cols * sizeof(struct wsdisplay_charcell);
scr->scr_mem = malloc(scrsize, M_DEVBUF, cold ? M_NOWAIT : M_WAITOK);
  510         if (scr->scr_mem == NULL) {
free(scr, M_DEVBUF);
  512                 return (ENOMEM);
  513         }
bzero(scr->scr_mem, scrsize);
ri->ri_ops.copycols = cfxga_copycols;
ri->ri_ops.copyrows = cfxga_copyrows;
ri->ri_ops.erasecols = cfxga_erasecols;
ri->ri_ops.eraserows = cfxga_eraserows;
ri->ri_ops.putchar = cfxga_putchar;
ri->ri_do_cursor = cfxga_do_cursor;
  523         /*
  524          * Finish initializing our screen descriptions, now that we know
  525          * the actual console emulation parameters.
  526          */
  527         if (type->nrows == 0) {
  528                 struct wsscreen_descr *wsd = (struct wsscreen_descr *)type;
wsd->nrows = ri->ri_rows;
wsd->ncols = ri->ri_cols;
bcopy(&ri->ri_ops, &sc->sc_ops, sizeof(sc->sc_ops));
wsd->fontwidth = ri->ri_font->fontwidth;
wsd->fontheight = ri->ri_font->fontheight;
wsd->capabilities = ri->ri_caps;
  536         }
scr->scr_sc = sc;
LIST_INSERT_HEAD(&sc->sc_scr, scr, scr_link);
sc->sc_nscreens++;
ri->ri_ops.alloc_attr(ri, 0, 0, 0, attrp);
  544         *cookiep = ri;
  545         *curxp = *curyp = 0;
  547         return (0);
  548 }
  550 void
cfxga_burner(void *v, u_int on, u_int flags)
  552 {
  553         struct cfxga_softc *sc = (void *)v;
u_int8_t mode;
mode = cfxga_read_1(sc, CFREG_MODE) & LCD_MODE_SWIVEL_BIT_0;
  558         if (on)
cfxga_write_1(sc, CFREG_MODE, mode | MODE_CRT);
  560         else
cfxga_write_1(sc, CFREG_MODE, mode | MODE_NO_DISPLAY);
  562 }
  564 void
cfxga_free_screen(void *v, void *cookie)
  566 {
  567         struct cfxga_softc *sc = v;
  568         struct rasops_info *ri = cookie;
  569         struct cfxga_screen *scr = ri->ri_hw;
LIST_REMOVE(scr, scr_link);
sc->sc_nscreens--;
  574         if (scr == sc->sc_active) {
sc->sc_active = NULL;
cfxga_burner(sc, 0, 0);
  577         }
free(scr->scr_mem, M_DEVBUF);
free(scr, M_DEVBUF);
  581 }
  583 int
cfxga_ioctl(void *v, u_long cmd, caddr_t data, int flag, struct proc *p)
  585 {
  586         struct cfxga_softc *sc = v;
  587         struct cfxga_screen *scr;
  588         struct wsdisplay_fbinfo *wdf;
  589         int mode;
  591         switch (cmd) {
  592         case WSDISPLAYIO_GTYPE:
  593                 *(u_int *)data = WSDISPLAY_TYPE_CFXGA;
  594                 break;
  596         case WSDISPLAYIO_GINFO:
wdf = (struct wsdisplay_fbinfo *)data;
scr = sc->sc_active;
  599                 if (scr == NULL) {
  600                         /* try later...after running wsconscfg to add screens */
wdf->height = wdf->width = wdf->depth = wdf->cmsize = 0;
  602                 } else {
wdf->height = scr->scr_ri.ri_height;
wdf->width = scr->scr_ri.ri_width;
wdf->depth = scr->scr_ri.ri_depth;
wdf->cmsize = scr->scr_ri.ri_depth <= 8 ?
  607                             (1 << scr->scr_ri.ri_depth) : 0;
  608                 }
  609                 break;
  611         case WSDISPLAYIO_SMODE:
mode = *(u_int *)data;
  613                 if (mode == sc->sc_mode)
  614                         break;
  615                 switch (mode) {
  616                 case WSDISPLAYIO_MODE_EMUL:
cfxga_reset_and_repaint(sc);
  618                         break;
  619                 case WSDISPLAYIO_MODE_MAPPED:
  620                         break;
  621                 default:
  622                         return (EINVAL);
  623                 }
sc->sc_mode = mode;
  625                 break;
  627         /* these operations are handled by the wscons code... */
  628         case WSDISPLAYIO_GVIDEO:
  629         case WSDISPLAYIO_SVIDEO:
  630                 break;
  632         /* these operations are not supported... */
  633         case WSDISPLAYIO_GETCMAP:
  634         case WSDISPLAYIO_PUTCMAP:
  635         case WSDISPLAYIO_LINEBYTES:
  636         case WSDISPLAYIO_GCURPOS:
  637         case WSDISPLAYIO_SCURPOS:
  638         case WSDISPLAYIO_GCURMAX:
  639         case WSDISPLAYIO_GCURSOR:
  640         case WSDISPLAYIO_SCURSOR:
  641         default:
  642                 return (-1);
  643         }
  645         return (0);
  646 }
paddr_t
cfxga_mmap(void *v, off_t off, int prot)
  650 {
  651         return (-1);
  652 }
  654 int
cfxga_show_screen(void *v, void *cookie, int waitok,
  656     void (*cb)(void *, int, int), void *cbarg)
  657 {
  658         struct cfxga_softc *sc = v;
  659         struct rasops_info *ri = cookie;
  660         struct cfxga_screen *scr = ri->ri_hw, *old;
old = sc->sc_active;
  663         if (old == scr)
  664                 return (0);
sc->sc_active = scr;
cfxga_reset_and_repaint(sc);    /* will turn video on if scr != NULL */
  669         return (0);
  670 }
  672 /*
  673  * Real frame buffer operations
  674  */
  676 void
cfxga_reset_video(struct cfxga_softc *sc)
  678 {
  679         struct cfxga_screen *scr = sc->sc_active;
  680         struct rasops_info *ri;
  681 #ifdef ENABLE_8BIT_MODES
  682         const u_int8_t *cmap;
u_int i;
  684 #endif
  686         /*
  687          * Reset controller
  688          */
  690         /* need to write to both REV and MISC at the same time */
cfxga_write_2(sc, CFREG_REV, 0x80 | (CM_REGSEL << 8));
delay(25000);   /* maintain reset for a short while */
  693         /* need to write to both REV and MISC at the same time */
cfxga_write_2(sc, CFREG_REV, 0 | (CM_MEMSEL << 8));
delay(25000);
  696         /* stop any pending blt operation */
cfxga_write_2(sc, CFREG_BITBLT_CONTROL, 0);
cfxga_stop_memory_blt(sc);
cfxga_write_1(sc, CFREG_MODE, 0);       /* disable all displays */
  701         /*
  702          * Setup common video mode parameters.
  703          */
cfxga_write_2(sc, CFREG_MEMCLK, MEMCLK_SRC_CLK3);
  706 #if 0
cfxga_write_1(sc, CFREG_LCD_PCLK, LCD_PCLK_SRC_CLKI | LCD_PCLK_DIV_1);
cfxga_write_1(sc, CFREG_MPLUG_CLK,
MPLUG_PCLK_SRC_CLKI2 | MPLUG_PCLK_DIV_1);
  710 #endif
cfxga_write_2(sc, CFREG_CRTTV_PCLK, CRT_PCLK_SRC_CLKI | CRT_PCLK_DIV_1);
cfxga_write_2(sc, CFREG_WSTATE, WSTATE_MCLK);
  714         /* MEMCNF and DRAM_RFRSH need to be programmed at the same time */
cfxga_write_2(sc, CFREG_MEMCNF,
MEMCNF_SDRAM_INIT | (DRAM_RFRSH_50MHZ << 8));
delay(250);
cfxga_write_2(sc, CFREG_DRAM_TIMING, DRAM_TIMING_50MHZ);
  720         /*
  721          * Setup mode-dependent parameters.
  722          */
  723         if (scr == NULL)
  724                 return;
ri = &scr->scr_ri;
  727         switch (scr->scr_ri.ri_width) {
  728         default:
  729         case 640:
cfxga_write_1(sc, CFREG_CRT_HWIDTH, (640 / 8) - 1);
  731                 /* HNDISP and HSTART need to be programmed at the same time */
cfxga_write_2(sc, CFREG_CRT_HNDISP, 23 | (2 << 8));
cfxga_write_1(sc, CFREG_CRT_HPULSE, 4);
cfxga_write_2(sc, CFREG_CRT_VHEIGHT, 480 - 1);
  735                 /* VNDISP and VSTART need to be programmed at the same time */
cfxga_write_2(sc, CFREG_CRT_VNDISP, 39 | (8 << 8));
cfxga_write_1(sc, CFREG_CRT_VPULSE, 2);
  738                 break;
  739         case 800:
cfxga_write_1(sc, CFREG_CRT_HWIDTH, (800 / 8) - 1);
  741                 /* HNDISP and HSTART need to be programmed at the same time */
cfxga_write_2(sc, CFREG_CRT_HNDISP, 27 | (2 << 8));
cfxga_write_1(sc, CFREG_CRT_HPULSE, 4);
cfxga_write_2(sc, CFREG_CRT_VHEIGHT, 600 - 1);
  745                 /* VNDISP and VSTART need to be programmed at the same time */
cfxga_write_2(sc, CFREG_CRT_VNDISP, 25 | (8 << 8));
cfxga_write_1(sc, CFREG_CRT_VPULSE, 2);
  748                 break;
  749         }
cfxga_write_1(sc, CFREG_CRT_MODE,
ri->ri_depth == 16 ? CRT_MODE_16BPP : CRT_MODE_8BPP);
cfxga_write_2(sc, CFREG_CRT_START_LOW, 0);
cfxga_write_1(sc, CFREG_CRT_START_HIGH, 0);
cfxga_write_2(sc, CFREG_CRT_MEMORY, ri->ri_width * ri->ri_depth / 16);
cfxga_write_1(sc, CFREG_CRT_PANNING, 0);
cfxga_write_1(sc, CFREG_CRT_FIFO_THRESHOLD_HIGH, 0);
cfxga_write_1(sc, CFREG_CRT_FIFO_THRESHOLD_LOW, 0);
cfxga_write_1(sc, CFREG_CRT_CURSOR_CONTROL, CURSOR_INACTIVE);
  760 #ifdef ENABLE_8BIT_MODES
  761         /*
  762          * On 8bpp video modes, program the LUT
  763          */
  764         if (ri->ri_depth == 8) {
  765 #if 0
  766                 /* Wait for retrace */
  767                 while ((cfxga_read_1(sc, CFREG_CRT_VNDISP) &
CRT_VNDISP_STATUS) == 0)
delay(1);
  770 #endif
cfxga_write_1(sc, CFREG_LUT_MODE, LUT_CRT);
cfxga_write_1(sc, CFREG_LUT_ADDRESS, 0); /* autoincrements */
cmap = rasops_cmap;
  774                 for (i = 256 * 3; i != 0; i--)
cfxga_write_1(sc, CFREG_LUT_DATA, *cmap++ & 0xf0);
  776         }
  777 #endif
cfxga_write_1(sc, CFREG_TV_CONTROL,
TV_LUMINANCE_FILTER | TV_SVIDEO_OUTPUT | TV_NTSC_OUTPUT);
cfxga_write_1(sc, CFREG_POWER_CONF, POWERSAVE_MBO);
cfxga_write_1(sc, CFREG_WATCHDOG, 0);
cfxga_write_1(sc, CFREG_MODE, MODE_CRT);
delay(25000);
  787 }
  789 void
cfxga_reset_and_repaint(struct cfxga_softc *sc)
  791 {
cfxga_reset_video(sc);
  794         if (sc->sc_active != NULL)
cfxga_repaint_screen(sc->sc_active);
  796         else
cfxga_burner(sc, 0, 0);
  798 }
  800 /*
  801  * Wait for the blitter to be in a given state.
  802  */
u_int
cfxga_wait(struct cfxga_softc *sc, u_int mask, u_int result)
  805 {
u_int tries;
  808         for (tries = 10000; tries != 0; tries--) {
  809                 if ((cfxga_read_1(sc, CFREG_BITBLT_CONTROL) & mask) == result)
  810                         break;
delay(10);
  812         }
  814         return (tries);
  815 }
  817 /*
  818  * Wait for all pending blitter operations to be complete.
  819  * Returns non-zero if the blitter got stuck.
  820  */
  821 int
cfxga_synchronize(struct cfxga_softc *sc)
  823 {
  824         /* Wait for previous operations to complete */
  825         if (cfxga_wait(sc, BITBLT_ACTIVE, 0) == 0) {
DPRINTF(("%s: not ready\n", __func__));
  827                 if (ISSET(sc->sc_state, CS_RESET))
  828                         return (EAGAIN);
  829                 else {
DPRINTF(("%s: resetting...\n", sc->sc_dev.dv_xname));
SET(sc->sc_state, CS_RESET);
cfxga_reset_and_repaint(sc);
CLR(sc->sc_state, CS_RESET);
  834                 }
  835         }
cfxga_stop_memory_blt(sc);
  837         return (0);
  838 }
  840 /*
  841  * Display a character.
  842  */
  843 int
cfxga_expand_char(struct cfxga_screen *scr, u_int uc, int x, int y, long attr)
  845 {
  846         struct cfxga_softc *sc = scr->scr_sc;
  847         struct rasops_info *ri = &scr->scr_ri;
  848         struct wsdisplay_font *font = ri->ri_font;
u_int pos, sts, fifo_avail, chunk;
u_int8_t *fontbits;
  851         int bg, fg, ul;
u_int i;
  853         int rc;
pos = (y * ri->ri_width + x) * ri->ri_depth / 8;
fontbits = (u_int8_t *)(font->data + (uc - font->firstchar) *
ri->ri_fontscale);
ri->ri_ops.unpack_attr(ri, attr, &fg, &bg, &ul);
  860         /* Wait for previous operations to complete */
  861         if ((rc = cfxga_synchronize(sc)) != 0)
  862                 return (rc);
cfxga_write_2(sc, CFREG_COLOR_EXPANSION,
  865             ((font->fontwidth - 1) & 7) | (OP_COLOR_EXPANSION << 8));
cfxga_write_2(sc, CFREG_BITBLT_SRC_LOW, font->fontwidth <= 8 ? 0 : 1);
cfxga_write_2(sc, CFREG_BITBLT_SRC_HIGH, 0);
cfxga_write_2(sc, CFREG_BITBLT_DST_LOW, pos);
cfxga_write_2(sc, CFREG_BITBLT_DST_HIGH, pos >> 16);
cfxga_write_2(sc, CFREG_BITBLT_OFFSET,
ri->ri_width * ri->ri_depth / 16);
cfxga_write_2(sc, CFREG_BITBLT_WIDTH, font->fontwidth - 1);
cfxga_write_2(sc, CFREG_BITBLT_HEIGHT, font->fontheight - 1);
cfxga_write_2(sc, CFREG_BITBLT_FG, ri->ri_devcmap[fg]);
cfxga_write_2(sc, CFREG_BITBLT_BG, ri->ri_devcmap[bg]);
cfxga_write_2(sc, CFREG_BITBLT_CONTROL, BITBLT_ACTIVE |
  877             (ri->ri_depth > 8 ? BITBLT_COLOR_16 : BITBLT_COLOR_8));
  879         if (cfxga_wait(sc, BITBLT_ACTIVE, BITBLT_ACTIVE) == 0)
  880                 goto fail;      /* unlikely */
fifo_avail = 0;
  883         for (i = font->fontheight; i != 0; i--) {
  884                 /*
  885                  * Find out how much words we can feed before
  886                  * a FIFO check is needed.
  887                  */
  888                 if (fifo_avail == 0) {
sts = cfxga_read_1(sc, CFREG_BITBLT_CONTROL);
  890                         if ((sts & BITBLT_FIFO_NOT_EMPTY) == 0)
fifo_avail = font->fontwidth <= 8 ? 2 : 1;
  892                         else if ((sts & BITBLT_FIFO_HALF_FULL) == 0)
fifo_avail = font->fontwidth <= 8 ? 1 : 0;
  894                         else {
  895                                 /*
  896                                  * Let the cheap breathe for a short while.
  897                                  * If this is not enough to free some FIFO
  898                                  * entries, abort the operation.
  899                                  */
  900                                 if (cfxga_wait(sc, BITBLT_FIFO_FULL, 0) == 0)
  901                                         goto fail;
  902                         }
  903                 }
  905                 if (font->fontwidth <= 8) {
chunk = *fontbits;
  907                         if (ul && i == 1)
chunk = 0xff;
  909                 } else {
chunk = *(u_int16_t *)fontbits;
  911                         if (ul && i == 1)
chunk = 0xffff;
  913                 }
cfxga_write_2(sc, CFREG_BITBLT_DATA, chunk);
fontbits += font->stride;
fifo_avail--;
  917         }
  919         return (0);
fail:
DPRINTF(("%s: abort\n", __func__));
cfxga_write_2(sc, CFREG_BITBLT_CONTROL, 0);
cfxga_stop_memory_blt(sc);
  925         return (EINTR);
  926 }
  928 /*
  929  * Copy a memory bitmap to the frame buffer.
  930  *
  931  * This is slow - we only use this to repaint the whole frame buffer on
  932  * screen switches.
  933  */
  934 int
cfxga_repaint_screen(struct cfxga_screen *scr)
  936 {
  937         struct wsdisplay_charcell *cell = scr->scr_mem;
  938         struct rasops_info *ri = &scr->scr_ri;
  939         int x, y, cx, cy, lx, ly;
  940         int fg, bg;
  941         int rc;
cfxga_clear_screen(scr);
cx = ri->ri_font->fontwidth;
cy = ri->ri_font->fontheight;
  948         for (ly = 0, y = ri->ri_yorigin; ly < ri->ri_rows; ly++, y += cy) {
  949                 for (lx = 0, x = ri->ri_xorigin; lx < ri->ri_cols;
lx++, x += cx) {
  951                         if (cell->uc == 0 || cell->uc == ' ') {
ri->ri_ops.unpack_attr(ri, cell->attr,
  953                                     &fg, &bg, NULL);
rc = cfxga_solid_fill(scr, x, y, cx, cy,
ri->ri_devcmap[bg]);
  956                         } else {
rc = cfxga_expand_char(scr, cell->uc,
x, y, cell->attr);
  959                         }
cell++;
  961                         if (rc != 0)
  962                                 return (rc);
  963                 }
  964         }
  966         return (0);
  967 }
  969 /*
  970  * Perform a solid fill operation.
  971  */
  972 int
cfxga_solid_fill(struct cfxga_screen *scr, int x, int y, int cx, int cy,
int32_t srccolor)
  975 {
  976         struct cfxga_softc *sc = scr->scr_sc;
  977         struct rasops_info *ri = &scr->scr_ri;
u_int pos;
  979         int rc;
pos = (y * ri->ri_width + x) * ri->ri_depth / 8;
  983         /* Wait for previous operations to complete */
  984         if ((rc = cfxga_synchronize(sc)) != 0)
  985                 return (rc);
cfxga_write_2(sc, CFREG_BITBLT_ROP, 0 | (OP_SOLID_FILL << 8));
cfxga_write_2(sc, CFREG_BITBLT_SRC_LOW, pos);
cfxga_write_2(sc, CFREG_BITBLT_SRC_HIGH, pos >> 16);
cfxga_write_2(sc, CFREG_BITBLT_DST_LOW, pos);
cfxga_write_2(sc, CFREG_BITBLT_DST_HIGH, pos >> 16);
cfxga_write_2(sc, CFREG_BITBLT_OFFSET,
ri->ri_width * ri->ri_depth / 16);
cfxga_write_2(sc, CFREG_BITBLT_WIDTH, cx - 1);
cfxga_write_2(sc, CFREG_BITBLT_HEIGHT, cy - 1);
cfxga_write_2(sc, CFREG_BITBLT_FG, (u_int16_t)srccolor);
cfxga_write_2(sc, CFREG_BITBLT_CONTROL, BITBLT_ACTIVE |
  998             (ri->ri_depth > 8 ? BITBLT_COLOR_16 : BITBLT_COLOR_8));
 1000         return (0);
 1001 }
 1003 /*
 1004  * Perform an internal frame buffer operation.
 1005  */
 1006 int
cfxga_standalone_rop(struct cfxga_screen *scr, u_int rop, int sx, int sy,
 1008     int dx, int dy, int cx, int cy)
 1009 {
 1010         struct cfxga_softc *sc = scr->scr_sc;
 1011         struct rasops_info *ri = &scr->scr_ri;
u_int srcpos, dstpos;
u_int opcode;
 1014         int rc;
srcpos = (sy * ri->ri_width + sx) * ri->ri_depth / 8;
dstpos = (dy * ri->ri_width + dx) * ri->ri_depth / 8;
 1019         if (dstpos <= srcpos)
opcode = (OP_MOVE_POSITIVE_ROP << 8) | rop;
 1021         else
opcode = (OP_MOVE_NEGATIVE_ROP << 8) | rop;
 1024         /* Wait for previous operations to complete */
 1025         if ((rc = cfxga_synchronize(sc)) != 0)
 1026                 return (rc);
cfxga_write_2(sc, CFREG_BITBLT_ROP, opcode);
cfxga_write_2(sc, CFREG_BITBLT_SRC_LOW, srcpos);
cfxga_write_2(sc, CFREG_BITBLT_SRC_HIGH, srcpos >> 16);
cfxga_write_2(sc, CFREG_BITBLT_DST_LOW, dstpos);
cfxga_write_2(sc, CFREG_BITBLT_DST_HIGH, dstpos >> 16);
cfxga_write_2(sc, CFREG_BITBLT_OFFSET,
ri->ri_width * ri->ri_depth / 16);
cfxga_write_2(sc, CFREG_BITBLT_WIDTH, cx - 1);
cfxga_write_2(sc, CFREG_BITBLT_HEIGHT, cy - 1);
cfxga_write_2(sc, CFREG_BITBLT_CONTROL, BITBLT_ACTIVE |
 1038             (ri->ri_depth > 8 ? BITBLT_COLOR_16 : BITBLT_COLOR_8));
 1040         return (0);
 1041 }
 1043 /*
 1044  * Text console raster operations.
 1045  *
 1046  * We shadow all these operations on a memory copy of the frame buffer.
 1047  * Since we are running in emulation mode only, this could be optimized
 1048  * by only storing actual character cell values (a la mda).
 1049  */
 1051 void
cfxga_copycols(void *cookie, int row, int src, int dst, int num)
 1053 {
 1054         struct rasops_info *ri = cookie;
 1055         struct cfxga_screen *scr = ri->ri_hw;
 1056         int sx, dx, y, cx, cy;
 1058         /* Copy columns in backing store. */
ovbcopy(scr->scr_mem + row * ri->ri_cols + src,
scr->scr_mem + row * ri->ri_cols + dst,
num * sizeof(struct wsdisplay_charcell));
 1063         if (scr != scr->scr_sc->sc_active)
 1064                 return;
sx = src * ri->ri_font->fontwidth + ri->ri_xorigin;
dx = dst * ri->ri_font->fontwidth + ri->ri_xorigin;
y = row * ri->ri_font->fontheight + ri->ri_yorigin;
cx = num * ri->ri_font->fontwidth;
cy = ri->ri_font->fontheight;
cfxga_standalone_rop(scr, ROP_SRC, sx, y, dx, y, cx, cy);
 1072 }
 1074 void
cfxga_copyrows(void *cookie, int src, int dst, int num)
 1076 {
 1077         struct rasops_info *ri = cookie;
 1078         struct cfxga_screen *scr = ri->ri_hw;
 1079         int x, sy, dy, cx, cy;
 1081         /* Copy rows in backing store. */
ovbcopy(scr->scr_mem + src * ri->ri_cols,
scr->scr_mem + dst * ri->ri_cols,
num * ri->ri_cols * sizeof(struct wsdisplay_charcell));
 1086         if (scr != scr->scr_sc->sc_active)
 1087                 return;
x = ri->ri_xorigin;
sy = src * ri->ri_font->fontheight + ri->ri_yorigin;
dy = dst * ri->ri_font->fontheight + ri->ri_yorigin;
cx = ri->ri_emuwidth;
cy = num * ri->ri_font->fontheight;
cfxga_standalone_rop(scr, ROP_SRC, x, sy, x, dy, cx, cy);
 1095 }
 1097 void
cfxga_do_cursor(struct rasops_info *ri)
 1099 {
 1100         struct cfxga_screen *scr = ri->ri_hw;
 1101         int x, y, cx, cy;
 1103         if (scr != scr->scr_sc->sc_active)
 1104                 return;
x = ri->ri_ccol * ri->ri_font->fontwidth + ri->ri_xorigin;
y = ri->ri_crow * ri->ri_font->fontheight + ri->ri_yorigin;
cx = ri->ri_font->fontwidth;
cy = ri->ri_font->fontheight;
cfxga_standalone_rop(scr, ROP_ONES ^ ROP_SRC /* i.e. not SRC */,
x, y, x, y, cx, cy);
 1112 }
 1114 void
cfxga_erasecols(void *cookie, int row, int col, int num, long attr)
 1116 {
 1117         struct rasops_info *ri = cookie;
 1118         struct cfxga_screen *scr = ri->ri_hw;
 1119         int fg, bg;
 1120         int x, y, cx, cy;
 1122         /* Erase columns in backing store. */
 1123         for (x = col; x < col + num; x++) {
scr->scr_mem[row * ri->ri_cols + x].uc = 0;
scr->scr_mem[row * ri->ri_cols + x].attr = attr;
 1126         }
 1128         if (scr != scr->scr_sc->sc_active)
 1129                 return;
ri->ri_ops.unpack_attr(cookie, attr, &fg, &bg, NULL);
x = col * ri->ri_font->fontwidth + ri->ri_xorigin;
y = row * ri->ri_font->fontheight + ri->ri_yorigin;
cx = num * ri->ri_font->fontwidth;
cy = ri->ri_font->fontheight;
cfxga_solid_fill(scr, x, y, cx, cy, ri->ri_devcmap[bg]);
 1137 }
 1139 void
cfxga_eraserows(void *cookie, int row, int num, long attr)
 1141 {
 1142         struct rasops_info *ri = cookie;
 1143         struct cfxga_screen *scr = ri->ri_hw;
 1144         int fg, bg;
 1145         int x, y, cx, cy;
 1147         /* Erase rows in backing store. */
 1148         for (x = 0; x < ri->ri_cols; x++) {
scr->scr_mem[row * ri->ri_cols + x].uc = 0;
scr->scr_mem[row * ri->ri_cols + x].attr = attr;
 1151         }
 1152         for (y = 1; y < num; y++)
ovbcopy(scr->scr_mem + row * ri->ri_cols,
scr->scr_mem + (row + y) * ri->ri_cols,
ri->ri_cols * sizeof(struct wsdisplay_charcell));
 1157         if (scr != scr->scr_sc->sc_active)
 1158                 return;
ri->ri_ops.unpack_attr(cookie, attr, &fg, &bg, NULL);
x = ri->ri_xorigin;
y = row * ri->ri_font->fontheight + ri->ri_yorigin;
cx = ri->ri_emuwidth;
cy = num * ri->ri_font->fontheight;
cfxga_solid_fill(scr, x, y, cx, cy, ri->ri_devcmap[bg]);
 1166 }
 1168 void
cfxga_putchar(void *cookie, int row, int col, u_int uc, long attr)
 1170 {
 1171         struct rasops_info *ri = cookie;
 1172         struct cfxga_screen *scr = ri->ri_hw;
 1173         int x, y;
scr->scr_mem[row * ri->ri_cols + col].uc = uc;
scr->scr_mem[row * ri->ri_cols + col].attr = attr;
 1178         if (scr != scr->scr_sc->sc_active)
 1179                 return;
x = col * ri->ri_font->fontwidth + ri->ri_xorigin;
y = row * ri->ri_font->fontheight + ri->ri_yorigin;
 1184         if (uc == ' ') {
 1185                 int cx, cy, fg, bg;
ri->ri_ops.unpack_attr(cookie, attr, &fg, &bg, NULL);
cx = ri->ri_font->fontwidth;
cy = ri->ri_font->fontheight;
cfxga_solid_fill(scr, x, y, cx, cy, ri->ri_devcmap[bg]);
 1191         } else {
cfxga_expand_char(scr, uc, x, y, attr);
 1193         }
 1194 }