sys/powerpc/wii/wii_fb.c

   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$");
  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 }