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/powerpc/wii/wii_fb.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 /*-
    2  * Copyright (C) 2012 Margarida Gouveia
    3  * Copyright (c) 2003 Peter Grehan
    4  * All rights reserved.
    5  *
    6  * Redistribution and use in source and binary forms, with or without
    7  * modification, are permitted provided that the following conditions
    8  * are met:
    9  * 1. Redistributions of source code must retain the above copyright
   10  *    notice, this list of conditions and the following disclaimer,
   11  *    without modification, immediately at the beginning of the file.
   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 #include <sys/cdefs.h>
   28 __FBSDID("$FreeBSD: releng/10.1/sys/powerpc/wii/wii_fb.c 249965 2013-04-27 01:57:45Z rpaulo $");
   29 
   30 #include <sys/param.h>
   31 #include <sys/systm.h>
   32 #include <sys/module.h>
   33 #include <sys/bus.h>
   34 #include <sys/kernel.h>
   35 #include <sys/sysctl.h>
   36 #include <sys/limits.h>
   37 #include <sys/conf.h>
   38 #include <sys/cons.h>
   39 #include <sys/proc.h>
   40 #include <sys/fcntl.h>
   41 #include <sys/malloc.h>
   42 #include <sys/fbio.h>
   43 #include <sys/consio.h>
   44 
   45 #include <vm/vm.h>
   46 #include <vm/pmap.h>
   47 
   48 #include <machine/bus.h>
   49 #include <machine/sc_machdep.h>
   50 #include <machine/platform.h>
   51 #include <machine/pmap.h>
   52 
   53 #include <sys/rman.h>
   54 
   55 #include <dev/fb/fbreg.h>
   56 #include <dev/syscons/syscons.h>
   57 
   58 #include <powerpc/wii/wii_fbreg.h>
   59 #include <powerpc/wii/wii_fbvar.h>
   60 
   61 /*
   62  * Driver for the Nintendo Wii's framebuffer. Based on Linux's gcnfb.c.
   63  */
   64 
   65 /*
   66  * Syscons glue.
   67  */
   68 static int      wiifb_scprobe(device_t);
   69 static int      wiifb_scattach(device_t);
   70 
   71 static device_method_t wiifb_sc_methods[] = {
   72         DEVMETHOD(device_probe,         wiifb_scprobe),
   73         DEVMETHOD(device_attach,        wiifb_scattach),
   74 
   75         DEVMETHOD_END
   76 };
   77 
   78 static driver_t wiifb_sc_driver = {
   79         "wiifb",
   80         wiifb_sc_methods,
   81         sizeof(sc_softc_t),
   82 };
   83 
   84 static devclass_t sc_devclass;
   85 
   86 DRIVER_MODULE(sc, wiibus, wiifb_sc_driver, sc_devclass, 0, 0);
   87 
   88 static int
   89 wiifb_scprobe(device_t dev)
   90 {
   91         int error;
   92 
   93         device_set_desc(dev, "Nintendo Wii frambuffer");
   94 
   95         error = sc_probe_unit(device_get_unit(dev),
   96             device_get_flags(dev) | SC_AUTODETECT_KBD);
   97         if (error != 0)
   98                 return (error);
   99 
  100         /* This is a fake device, so make sure we added it ourselves */
  101         return (BUS_PROBE_NOWILDCARD);
  102 }
  103 
  104 static int
  105 wiifb_scattach(device_t dev)
  106 {
  107 
  108         return (sc_attach_unit(device_get_unit(dev),
  109             device_get_flags(dev) | SC_AUTODETECT_KBD));
  110 }
  111 
  112 /*
  113  * Video driver routines and glue.
  114  */
  115 static void                     wiifb_reset_video(struct wiifb_softc *);
  116 static void                     wiifb_enable_interrupts(struct wiifb_softc *);
  117 static void                     wiifb_configure_tv_mode(struct wiifb_softc *);
  118 static void                     wiifb_setup_framebuffer(struct wiifb_softc *);
  119 static int                      wiifb_configure(int);
  120 static vi_probe_t               wiifb_probe;
  121 static vi_init_t                wiifb_init;
  122 static vi_get_info_t            wiifb_get_info;
  123 static vi_query_mode_t          wiifb_query_mode;
  124 static vi_set_mode_t            wiifb_set_mode;
  125 static vi_save_font_t           wiifb_save_font;
  126 static vi_load_font_t           wiifb_load_font;
  127 static vi_show_font_t           wiifb_show_font;
  128 static vi_save_palette_t        wiifb_save_palette;
  129 static vi_load_palette_t        wiifb_load_palette;
  130 static vi_set_border_t          wiifb_set_border;
  131 static vi_save_state_t          wiifb_save_state;
  132 static vi_load_state_t          wiifb_load_state;
  133 static vi_set_win_org_t         wiifb_set_win_org;
  134 static vi_read_hw_cursor_t      wiifb_read_hw_cursor;
  135 static vi_set_hw_cursor_t       wiifb_set_hw_cursor;
  136 static vi_set_hw_cursor_shape_t wiifb_set_hw_cursor_shape;
  137 static vi_blank_display_t       wiifb_blank_display;
  138 static vi_mmap_t                wiifb_mmap;
  139 static vi_ioctl_t               wiifb_ioctl;
  140 static vi_clear_t               wiifb_clear;
  141 static vi_fill_rect_t           wiifb_fill_rect;
  142 static vi_bitblt_t              wiifb_bitblt;
  143 static vi_diag_t                wiifb_diag;
  144 static vi_save_cursor_palette_t wiifb_save_cursor_palette;
  145 static vi_load_cursor_palette_t wiifb_load_cursor_palette;
  146 static vi_copy_t                wiifb_copy;
  147 static vi_putp_t                wiifb_putp;
  148 static vi_putc_t                wiifb_putc;
  149 static vi_puts_t                wiifb_puts;
  150 static vi_putm_t                wiifb_putm;
  151 
  152 static video_switch_t wiifbvidsw = {
  153         .probe                  = wiifb_probe,
  154         .init                   = wiifb_init,
  155         .get_info               = wiifb_get_info,
  156         .query_mode             = wiifb_query_mode,
  157         .set_mode               = wiifb_set_mode,
  158         .save_font              = wiifb_save_font,
  159         .load_font              = wiifb_load_font,
  160         .show_font              = wiifb_show_font,
  161         .save_palette           = wiifb_save_palette,
  162         .load_palette           = wiifb_load_palette,
  163         .set_border             = wiifb_set_border,
  164         .save_state             = wiifb_save_state,
  165         .load_state             = wiifb_load_state,
  166         .set_win_org            = wiifb_set_win_org,
  167         .read_hw_cursor         = wiifb_read_hw_cursor,
  168         .set_hw_cursor          = wiifb_set_hw_cursor,
  169         .set_hw_cursor_shape    = wiifb_set_hw_cursor_shape,
  170         .blank_display          = wiifb_blank_display,
  171         .mmap                   = wiifb_mmap,
  172         .ioctl                  = wiifb_ioctl,
  173         .clear                  = wiifb_clear,
  174         .fill_rect              = wiifb_fill_rect,
  175         .bitblt                 = wiifb_bitblt,
  176         .diag                   = wiifb_diag,
  177         .save_cursor_palette    = wiifb_save_cursor_palette,
  178         .load_cursor_palette    = wiifb_load_cursor_palette,
  179         .copy                   = wiifb_copy,
  180         .putp                   = wiifb_putp,
  181         .putc                   = wiifb_putc,
  182         .puts                   = wiifb_puts,
  183         .putm                   = wiifb_putm,
  184 };
  185 
  186 VIDEO_DRIVER(wiifb, wiifbvidsw, wiifb_configure);
  187 
  188 extern sc_rndr_sw_t txtrndrsw;
  189 RENDERER(wiifb, 0, txtrndrsw, gfb_set);
  190 RENDERER_MODULE(wiifb, gfb_set);
  191 
  192 static struct wiifb_softc wiifb_softc;
  193 static uint16_t wiifb_static_window[ROW*COL];
  194 extern u_char dflt_font_8[];
  195 
  196 /*
  197  * Map the syscons colors to YUY2 (Y'UV422).
  198  * Some colours are an approximation.
  199  *
  200  * The Wii has a 16 bit pixel, so each 32 bit DWORD encodes
  201  * two pixels.  The upper 16 bits is for pixel 0 (left hand pixel
  202  * in a pair), the lower 16 bits is for pixel 1. 
  203  *
  204  * For now, we're going to ignore that entirely and just use the
  205  * lower 16 bits for each pixel. We'll take the upper value into
  206  * account later.
  207  */
  208 static uint32_t wiifb_cmap[16] = {
  209         0x00800080,     /* Black */
  210         0x1dff1d6b,     /* Blue */
  211         0x4b554b4a,     /* Green */
  212         0x80808080,     /* Cyan */
  213         0x4c544cff,     /* Red */
  214         0x3aaa34b5,     /* Magenta */
  215         0x7140718a,     /* Brown */
  216         0xff80ff80,     /* White */
  217         0x80808080,     /* Gray */
  218         0xc399c36a,     /* Bright Blue */
  219         0xd076d074,     /* Bright Green */
  220         0x80808080,     /* Bright Cyan */
  221         0x4c544cff,     /* Bright Red */
  222         0x3aaa34b5,     /* Bright Magenta */
  223         0xe100e194,     /* Bright Yellow */
  224         0xff80ff80      /* Bright White */
  225 };
  226 
  227 static struct wiifb_mode_desc wiifb_modes[] = {
  228         [WIIFB_MODE_NTSC_480i] = {
  229                 "NTSC 480i",
  230                 640, 480,
  231                 525,
  232                 WIIFB_MODE_FLAG_INTERLACED,
  233         },
  234         [WIIFB_MODE_NTSC_480p] = {
  235                 "NTSC 480p",
  236                 640, 480,
  237                 525,
  238                 WIIFB_MODE_FLAG_PROGRESSIVE,
  239         },
  240         [WIIFB_MODE_PAL_576i] = {
  241                 "PAL 576i (50Hz)",
  242                 640, 574,
  243                 625,
  244                 WIIFB_MODE_FLAG_INTERLACED,
  245         },
  246         [WIIFB_MODE_PAL_480i] = {
  247                 "PAL 480i (60Hz)",
  248                 640, 480,
  249                 525,
  250                 WIIFB_MODE_FLAG_INTERLACED,
  251         },
  252         [WIIFB_MODE_PAL_480p] = {
  253                 "PAL 480p",
  254                 640, 480,
  255                 525,
  256                 WIIFB_MODE_FLAG_PROGRESSIVE,
  257         },
  258 };
  259 
  260 static const uint32_t wiifb_filter_coeft[] = {
  261         0x1ae771f0, 0x0db4a574, 0x00c1188e, 0xc4c0cbe2, 0xfcecdecf,
  262         0x13130f08, 0x00080c0f
  263 };
  264 
  265 static __inline int
  266 wiifb_background(uint8_t attr)
  267 {
  268 
  269         return (attr >> 4);
  270 }
  271 
  272 static __inline int
  273 wiifb_foreground(uint8_t attr)
  274 {
  275 
  276         return (attr & 0x0f);
  277 }
  278 
  279 static void
  280 wiifb_reset_video(struct wiifb_softc *sc)
  281 {
  282         struct wiifb_dispcfg dc;
  283 
  284         wiifb_dispcfg_read(sc, &dc);
  285         dc.dc_reset = 1;
  286         wiifb_dispcfg_write(sc, &dc);
  287         dc.dc_reset = 0;
  288         wiifb_dispcfg_write(sc, &dc);
  289 }
  290 
  291 static void
  292 wiifb_enable_interrupts(struct wiifb_softc *sc)
  293 {
  294         struct wiifb_dispint di;
  295 
  296 #ifdef notyet
  297         /*
  298          * Display Interrupt 0
  299          */
  300         di.di_htiming = 1;
  301         di.di_vtiming = 1;
  302         di.di_enable = 1;
  303         di.di_irq    = 1;
  304         wiifb_dispint_write(sc, 0, &di);
  305 
  306         /*
  307          * Display Interrupt 1
  308          */
  309         di.di_htiming = sc->sc_format == WIIFB_FORMAT_PAL ? 433 : 430;
  310         di.di_vtiming = sc->sc_mode->fd_lines;
  311         di.di_enable = 1;
  312         di.di_irq    = 1;
  313         if (sc->sc_mode->fd_flags & WIIFB_MODE_FLAG_INTERLACED)
  314                 di.di_vtiming /= 2;
  315         wiifb_dispint_write(sc, 1, &di);
  316 
  317         /*
  318          * Display Interrupts 2 and 3 are not used.
  319          */
  320         memset(&di, 0, sizeof(di));
  321         wiifb_dispint_write(sc, 2, &di);
  322         wiifb_dispint_write(sc, 3, &di);
  323 #else
  324         memset(&di, 0, sizeof(di));
  325         wiifb_dispint_write(sc, 0, &di);
  326         wiifb_dispint_write(sc, 1, &di);
  327         wiifb_dispint_write(sc, 2, &di);
  328         wiifb_dispint_write(sc, 3, &di);
  329 #endif
  330 }
  331 
  332 /*
  333  * Reference gcnfb.c for an in depth explanation.
  334  * XXX only works with NTSC.
  335  */
  336 static void
  337 wiifb_configure_tv_mode(struct wiifb_softc *sc)
  338 {
  339         struct wiifb_vtiming vt;
  340         struct wiifb_hscaling hs;
  341         struct wiifb_htiming0 ht0;
  342         struct wiifb_htiming1 ht1;
  343         struct wiifb_vtimingodd vto;
  344         struct wiifb_vtimingeven vte;
  345         struct wiifb_burstblankodd bbo;
  346         struct wiifb_burstblankeven bbe;
  347         struct wiifb_picconf pc;
  348         struct wiifb_mode_desc *mode = sc->sc_mode;
  349         unsigned int height = mode->fd_height;
  350         unsigned int width = mode->fd_width;
  351         unsigned int eqpulse, interlacebias, shift;
  352         const unsigned int maxwidth = 714;
  353         unsigned int hblanking = maxwidth - width;
  354         unsigned int hmargin = hblanking / 2;
  355         unsigned int A = 20 + hmargin, C = 60 + hblanking - hmargin;
  356         unsigned int maxheight = 484;
  357         unsigned int P = 2 * (20 - 10 + 1);
  358         unsigned int Q = 1;
  359         unsigned int vblanking = maxheight - height;
  360         unsigned int vmargin = vblanking / 2;
  361         unsigned int prb = vmargin;
  362         unsigned int psb = vblanking - vmargin;
  363         int i;
  364 
  365         /*
  366          * Vertical timing.
  367          */
  368         if (mode->fd_flags & WIIFB_MODE_FLAG_INTERLACED) {
  369                 vt.vt_actvideo = height / 2;
  370                 interlacebias = 1;
  371                 shift = 0;
  372         } else {
  373                 vt.vt_actvideo = height;
  374                 interlacebias = 0;
  375                 shift = 1;
  376         }
  377         /* Lines of equalization */
  378         if (mode->fd_lines == 625)
  379                 eqpulse = 2 * 2.5;
  380         else
  381                 eqpulse = 2 * 3;
  382         vt.vt_eqpulse = eqpulse << shift;
  383         wiifb_vtiming_write(sc, &vt);
  384 
  385         /*
  386          * Horizontal timings.
  387          */
  388         ht0.ht0_hlinew = 858 / 2;
  389         ht1.ht1_hsyncw = 64;
  390         ht0.ht0_hcolourstart = 71;
  391         ht0.ht0_hcolourend = 71 + 34;
  392         ht1.ht1_hblankstart = (858 / 2) - A;
  393         ht1.ht1_hblankend = 64 + C;
  394         wiifb_htiming0_write(sc, &ht0);
  395         wiifb_htiming1_write(sc, &ht1);
  396 
  397         /*
  398          * Vertical timing odd/even.
  399          */
  400         if (vmargin & 1) {
  401                 vto.vto_preb = (P + interlacebias + prb) << shift;
  402                 vto.vto_postb = (Q - interlacebias + psb) << shift;
  403                 vte.vte_preb = (P + prb) << shift;
  404                 vte.vte_postb = (Q - psb) << shift;
  405         } else {
  406                 /* XXX if this isn't 0, it doesn't work? */
  407                 prb = 0;
  408                 psb = 0;
  409                 vte.vte_preb = (P + interlacebias + prb) << shift;
  410                 vte.vte_postb = (Q - interlacebias + psb) << shift;
  411                 vto.vto_preb = (P + prb) << shift;
  412                 vto.vto_postb = (Q - psb) << shift;
  413         }
  414         wiifb_vtimingodd_write(sc, &vto);
  415         wiifb_vtimingeven_write(sc, &vte);
  416 
  417         /*
  418          * Burst blanking odd/even interval.
  419          */
  420         bbo.bbo_bs1 = 2 * (18 - 7 + 1);
  421         bbe.bbe_bs2 = bbo.bbo_bs3 = bbe.bbe_bs4 = bbo.bbo_bs1;
  422         bbo.bbo_be1 = 2 * (525 - 7 + 1);
  423         bbe.bbe_be2 = bbo.bbo_be3 = bbe.bbe_be4 = bbo.bbo_be1;
  424         wiifb_burstblankodd_write(sc, &bbo);
  425         wiifb_burstblankeven_write(sc, &bbe);
  426 
  427         /*
  428          * Picture configuration.
  429          */ 
  430         pc.pc_strides = (mode->fd_width * 2) / 32;
  431         if (mode->fd_flags & WIIFB_MODE_FLAG_INTERLACED)
  432                 pc.pc_strides *= 2;
  433         pc.pc_reads = (mode->fd_width * 2) / 32;
  434         wiifb_picconf_write(sc, &pc);
  435 
  436         /*
  437          * Horizontal scaling disabled.
  438          */
  439         hs.hs_enable = 0;
  440         hs.hs_step = 256;
  441         wiifb_hscaling_write(sc, &hs);
  442 
  443         /*
  444          * Filter coeficient table.
  445          */
  446         for (i = 0; i < 7; i++)
  447                 wiifb_filtcoeft_write(sc, i, wiifb_filter_coeft[i]);
  448 
  449         /*
  450          * Anti alias.
  451          */
  452         wiifb_antialias_write(sc, 0x00ff0000);
  453 
  454         /*
  455          * Video clock.
  456          */
  457         wiifb_videoclk_write(sc, 
  458             mode->fd_flags & WIIFB_MODE_FLAG_INTERLACED ? 0 : 1);
  459 
  460         /*
  461          * Disable horizontal scaling width.
  462          */
  463         wiifb_hscalingw_write(sc, mode->fd_width);
  464 
  465         /*
  466          * DEBUG mode borders. Not used.
  467          */
  468         wiifb_hborderend_write(sc, 0);
  469         wiifb_hborderstart_write(sc, 0);
  470 
  471         /*
  472          * XXX unknown registers.
  473          */
  474         wiifb_unknown1_write(sc, 0x00ff);
  475         wiifb_unknown2_write(sc, 0x00ff00ff);
  476         wiifb_unknown3_write(sc, 0x00ff00ff);
  477 }
  478 
  479 static void
  480 wiifb_setup_framebuffer(struct wiifb_softc *sc)
  481 {
  482         intptr_t addr = sc->sc_fb_addr;
  483         struct wiifb_topfieldbasel tfbl;
  484         struct wiifb_bottomfieldbasel bfbl;
  485         struct wiifb_topfieldbaser tfbr;
  486         struct wiifb_bottomfieldbaser bfbr;
  487 
  488         tfbl.tfbl_fbaddr     = addr >> 5;
  489         tfbl.tfbl_xoffset    = (addr / 2) & 0xf;
  490         tfbl.tfbl_pageoffbit = 1;
  491         wiifb_topfieldbasel_write(sc, &tfbl);
  492 
  493         if (sc->sc_mode->fd_flags & WIIFB_MODE_FLAG_INTERLACED)
  494                 addr += sc->sc_mode->fd_width * 2;
  495         bfbl.bfbl_fbaddr     = addr >> 5;
  496         bfbl.bfbl_xoffset    = (addr / 2) & 0xf;
  497         bfbl.bfbl_pageoffbit = 1;
  498         wiifb_bottomfieldbasel_write(sc, &bfbl);
  499 
  500         /*
  501          * Only used used for 3D.
  502          */
  503         memset(&tfbr, 0, sizeof(tfbr));
  504         memset(&bfbr, 0, sizeof(bfbr));
  505         wiifb_topfieldbaser_write(sc, &tfbr);
  506         wiifb_bottomfieldbaser_write(sc, &bfbr);
  507 }
  508 
  509 static int
  510 wiifb_configure(int flags)
  511 {
  512         struct wiifb_softc *sc;
  513         struct wiifb_dispcfg dc;
  514         int progressive;
  515 
  516         sc = &wiifb_softc;
  517         if (sc->sc_initialized) {
  518                 /* XXX We should instead use bus_space */
  519                 sc->sc_fb_addr = (intptr_t)pmap_mapdev(WIIFB_FB_ADDR, WIIFB_FB_LEN);
  520                 sc->sc_reg_addr = (intptr_t)pmap_mapdev(WIIFB_REG_ADDR, WIIFB_REG_LEN);
  521                 return 0;
  522         }
  523 
  524         sc->sc_console = 1;
  525 
  526         sc->sc_fb_addr = WIIFB_FB_ADDR;
  527         sc->sc_fb_size = WIIFB_FB_LEN;
  528 
  529         sc->sc_reg_addr = WIIFB_REG_ADDR;
  530         sc->sc_reg_size = WIIFB_REG_LEN;
  531 
  532         wiifb_reset_video(sc);
  533         wiifb_dispcfg_read(sc, &dc);
  534         sc->sc_format = dc.dc_format;
  535         sc->sc_component = wiifb_component_enabled(sc);
  536         progressive = dc.dc_noninterlaced;
  537         switch (sc->sc_format) {
  538         case WIIFB_FORMAT_MPAL:
  539         case WIIFB_FORMAT_DEBUG:
  540         case WIIFB_FORMAT_NTSC:
  541                 sc->sc_mode = progressive ?
  542                     &wiifb_modes[WIIFB_MODE_NTSC_480p] :
  543                     &wiifb_modes[WIIFB_MODE_NTSC_480i];
  544                 break;
  545         case WIIFB_FORMAT_PAL:
  546                 sc->sc_mode = progressive ?
  547                     &wiifb_modes[WIIFB_MODE_PAL_480p] :
  548                     &wiifb_modes[WIIFB_MODE_PAL_480i];
  549                 break;
  550         }
  551         sc->sc_height = sc->sc_mode->fd_height;
  552         sc->sc_width = sc->sc_mode->fd_width;
  553         /* Usually we multiply by 4, but I think this looks better. */
  554         sc->sc_stride = sc->sc_width * 2;
  555 
  556         wiifb_init(0, &sc->sc_va, 0);
  557 
  558         sc->sc_initialized = 1;
  559 
  560         return (0);
  561 }
  562 
  563 static int
  564 wiifb_probe(int unit, video_adapter_t **adp, void *arg, int flags)
  565 {
  566 
  567         return (0);
  568 }
  569 
  570 static int
  571 wiifb_init(int unit, video_adapter_t *adp, int flags)
  572 {
  573         struct wiifb_softc *sc;
  574         video_info_t *vi;
  575 
  576         sc = (struct wiifb_softc *)adp;
  577         vi = &adp->va_info;
  578 
  579         vid_init_struct(adp, "wiifb", -1, unit);
  580 
  581         sc->sc_font = dflt_font_8;
  582         vi->vi_cheight = WIIFB_FONT_HEIGHT;
  583         vi->vi_width = sc->sc_width/8;
  584         vi->vi_height = sc->sc_height/vi->vi_cheight;
  585         vi->vi_cwidth = 8;
  586 
  587         /*
  588          * Clamp width/height to syscons maximums
  589          */
  590         if (vi->vi_width > COL)
  591                 vi->vi_width = COL;
  592         if (vi->vi_height > ROW)
  593                 vi->vi_height = ROW;
  594 
  595         sc->sc_xmargin = (sc->sc_width - (vi->vi_width * vi->vi_cwidth)) / 2;
  596         sc->sc_ymargin = (sc->sc_height - (vi->vi_height * vi->vi_cheight))/2;
  597 
  598         adp->va_window = (vm_offset_t) wiifb_static_window;
  599         /* XXX no colour support */
  600         adp->va_flags |= V_ADP_FONT | /*V_ADP_COLOR |*/ V_ADP_MODECHANGE;
  601 
  602         vid_register(&sc->sc_va);
  603 
  604         wiifb_configure_tv_mode(sc);
  605         wiifb_setup_framebuffer(sc);
  606         wiifb_enable_interrupts(sc);
  607         wiifb_clear(adp);
  608 
  609         return (0);
  610 }
  611 
  612 static int
  613 wiifb_get_info(video_adapter_t *adp, int mode, video_info_t *info)
  614 {
  615 
  616         bcopy(&adp->va_info, info, sizeof(*info));
  617         return (0);
  618 }
  619 
  620 static int
  621 wiifb_query_mode(video_adapter_t *adp, video_info_t *info)
  622 {
  623 
  624         return (0);
  625 }
  626 
  627 static int
  628 wiifb_set_mode(video_adapter_t *adp, int mode)
  629 {
  630 
  631         return (0);
  632 }
  633 
  634 static int
  635 wiifb_save_font(video_adapter_t *adp, int page, int size, int width,
  636     u_char *data, int c, int count)
  637 {
  638 
  639         return (0);
  640 }
  641 
  642 static int
  643 wiifb_load_font(video_adapter_t *adp, int page, int size, int width,
  644     u_char *data, int c, int count)
  645 {
  646         struct wiifb_softc *sc = (struct wiifb_softc *)adp;
  647 
  648         sc->sc_font = data;
  649 
  650         return (0);
  651 }
  652 
  653 static int
  654 wiifb_show_font(video_adapter_t *adp, int page)
  655 {
  656 
  657         return (0);
  658 }
  659 
  660 static int
  661 wiifb_save_palette(video_adapter_t *adp, u_char *palette)
  662 {
  663 
  664         return (0);
  665 }
  666 
  667 static int
  668 wiifb_load_palette(video_adapter_t *adp, u_char *palette)
  669 {
  670 
  671         return (0);
  672 }
  673 
  674 static int
  675 wiifb_set_border(video_adapter_t *adp, int border)
  676 {
  677 
  678         return (wiifb_blank_display(adp, border));
  679 }
  680 
  681 static int
  682 wiifb_save_state(video_adapter_t *adp, void *p, size_t size)
  683 {
  684 
  685         return (0);
  686 }
  687 
  688 static int
  689 wiifb_load_state(video_adapter_t *adp, void *p)
  690 {
  691 
  692         return (0);
  693 }
  694 
  695 static int
  696 wiifb_set_win_org(video_adapter_t *adp, off_t offset)
  697 {
  698 
  699         return (0);
  700 }
  701 
  702 static int
  703 wiifb_read_hw_cursor(video_adapter_t *adp, int *col, int *row)
  704 {
  705 
  706         *col = *row = 0;
  707 
  708         return (0);
  709 }
  710 
  711 static int
  712 wiifb_set_hw_cursor(video_adapter_t *adp, int col, int row)
  713 {
  714 
  715         return (0);
  716 }
  717 
  718 static int
  719 wiifb_set_hw_cursor_shape(video_adapter_t *adp, int base, int height,
  720     int celsize, int blink)
  721 {
  722 
  723         return (0);
  724 }
  725 
  726 static int
  727 wiifb_blank_display(video_adapter_t *adp, int mode)
  728 {
  729         struct wiifb_softc *sc = (struct wiifb_softc *)adp;
  730         uint32_t *p;
  731 
  732         for (p = (uint32_t *)sc->sc_fb_addr;
  733             p < (uint32_t *)(sc->sc_fb_addr + sc->sc_fb_size);
  734             p++)
  735                 *p = wiifb_cmap[wiifb_background(SC_NORM_ATTR)];
  736 
  737         return (0);
  738 }
  739 
  740 static int
  741 wiifb_mmap(video_adapter_t *adp, vm_ooffset_t offset, vm_paddr_t *paddr,
  742     int prot, vm_memattr_t *memattr)
  743 {
  744         struct wiifb_softc *sc;
  745 
  746         sc = (struct wiifb_softc *)adp;
  747 
  748         /*
  749          * This might be a legacy VGA mem request: if so, just point it at the
  750          * framebuffer, since it shouldn't be touched
  751          */
  752         if (offset < sc->sc_stride*sc->sc_height) {
  753                 *paddr = sc->sc_fb_addr + offset;
  754                 return (0);
  755         }
  756 
  757         return (EINVAL);
  758 }
  759 
  760 static int
  761 wiifb_ioctl(video_adapter_t *adp, u_long cmd, caddr_t data)
  762 {
  763 
  764         return (0);
  765 }
  766 
  767 static int
  768 wiifb_clear(video_adapter_t *adp)
  769 {
  770 
  771         return (wiifb_blank_display(adp, 0));
  772 }
  773 
  774 static int
  775 wiifb_fill_rect(video_adapter_t *adp, int val, int x, int y, int cx, int cy)
  776 {
  777 
  778         return (0);
  779 }
  780 
  781 static int
  782 wiifb_bitblt(video_adapter_t *adp, ...)
  783 {
  784 
  785         return (0);
  786 }
  787 
  788 static int
  789 wiifb_diag(video_adapter_t *adp, int level)
  790 {
  791 
  792         return (0);
  793 }
  794 
  795 static int
  796 wiifb_save_cursor_palette(video_adapter_t *adp, u_char *palette)
  797 {
  798 
  799         return (0);
  800 }
  801 
  802 static int
  803 wiifb_load_cursor_palette(video_adapter_t *adp, u_char *palette)
  804 {
  805 
  806         return (0);
  807 }
  808 
  809 static int
  810 wiifb_copy(video_adapter_t *adp, vm_offset_t src, vm_offset_t dst, int n)
  811 {
  812 
  813         return (0);
  814 }
  815 
  816 static int
  817 wiifb_putp(video_adapter_t *adp, vm_offset_t off, uint32_t p, uint32_t a,
  818     int size, int bpp, int bit_ltor, int byte_ltor)
  819 {
  820 
  821         return (0);
  822 }
  823 
  824 static int
  825 wiifb_putc(video_adapter_t *adp, vm_offset_t off, uint8_t c, uint8_t a)
  826 {
  827         struct wiifb_softc *sc;
  828         int row;
  829         int col;
  830         int i, j, k;
  831         uint32_t *addr;
  832         u_char *p;
  833         uint32_t fg, bg;
  834         unsigned long pixel[2];
  835 
  836         sc = (struct wiifb_softc *)adp;
  837         row = (off / adp->va_info.vi_width) * adp->va_info.vi_cheight;
  838         col = (off % adp->va_info.vi_width) * adp->va_info.vi_cwidth / 2;
  839         p = sc->sc_font + c*WIIFB_FONT_HEIGHT;
  840         addr = (uint32_t *)sc->sc_fb_addr
  841             + (row + sc->sc_ymargin)*(sc->sc_stride/4)
  842             + col + sc->sc_xmargin;
  843 
  844         bg = wiifb_cmap[wiifb_background(a)];
  845         fg = wiifb_cmap[wiifb_foreground(a)];
  846 
  847         for (i = 0; i < WIIFB_FONT_HEIGHT; i++) {
  848                 for (j = 0, k = 7; j < 4; j++, k--) {
  849                         if ((p[i] & (1 << k)) == 0)
  850                                 pixel[0] = bg;
  851                         else
  852                                 pixel[0] = fg;
  853                         k--;    
  854                         if ((p[i] & (1 << k)) == 0)
  855                                 pixel[1] = bg;
  856                         else
  857                                 pixel[1] = fg;
  858 
  859                         addr[j] = (pixel[0] & 0xffff00ff) |
  860                                   (pixel[1] & 0x0000ff00);
  861                 }
  862                 addr += (sc->sc_stride/4);
  863         }
  864 
  865         return (0);
  866 }
  867 
  868 static int
  869 wiifb_puts(video_adapter_t *adp, vm_offset_t off, u_int16_t *s, int len)
  870 {
  871         int i;
  872 
  873         for (i = 0; i < len; i++) 
  874                 wiifb_putc(adp, off + i, s[i] & 0xff, (s[i] & 0xff00) >> 8);
  875 
  876         return (0);
  877 }
  878 
  879 static int
  880 wiifb_putm(video_adapter_t *adp, int x, int y, uint8_t *pixel_image,
  881     uint32_t pixel_mask, int size, int width)
  882 {
  883         
  884         return (0);
  885 }

Cache object: 45ea3422e921ec776c6303a9ef8a28e0


[ 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.