sys/dev/vt/hw/fb/vt_fb.c

   1 /*-
   2  * Copyright (c) 2013 The FreeBSD Foundation
   3  * All rights reserved.
   4  *
   5  * This software was developed by Aleksandr Rybalko under sponsorship from the
   6  * FreeBSD Foundation.
   7  *
   8  * Redistribution and use in source and binary forms, with or without
   9  * modification, are permitted provided that the following conditions
  10  * are met:
  11  * 1. Redistributions of source code must retain the above copyright
  12  *    notice, this list of conditions and the following disclaimer.
  13  * 2. Redistributions in binary form must reproduce the above copyright
  14  *    notice, this list of conditions and the following disclaimer in the
  15  *    documentation and/or other materials provided with the distribution.
  16  *
  17  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  20  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  27  * SUCH DAMAGE.
  28  *
  29  * $FreeBSD$
  30  */
  31
  32 #include <sys/cdefs.h>
  33 __FBSDID("$FreeBSD$");
  34
  35 #include <sys/param.h>
  36 #include <sys/systm.h>
  37 #include <sys/malloc.h>
  38 #include <sys/queue.h>
  39 #include <sys/fbio.h>
  40 #include <dev/vt/vt.h>
  41 #include <dev/vt/hw/fb/vt_fb.h>
  42 #include <dev/vt/colors/vt_termcolors.h>
  43
  44 static struct vt_driver vt_fb_driver = {
  45         .vd_name = "fb",
  46         .vd_init = vt_fb_init,
  47         .vd_blank = vt_fb_blank,
  48         .vd_bitblt_text = vt_fb_bitblt_text,
  49         .vd_bitblt_bmp = vt_fb_bitblt_bitmap,
  50         .vd_drawrect = vt_fb_drawrect,
  51         .vd_setpixel = vt_fb_setpixel,
  52         .vd_postswitch = vt_fb_postswitch,
  53         .vd_priority = VD_PRIORITY_GENERIC+10,
  54         .vd_fb_ioctl = vt_fb_ioctl,
  55         .vd_fb_mmap = vt_fb_mmap,
  56         .vd_suspend = vt_fb_suspend,
  57         .vd_resume = vt_fb_resume,
  58 };
  59
  60 VT_DRIVER_DECLARE(vt_fb, vt_fb_driver);
  61
  62 static void
  63 vt_fb_mem_wr1(struct fb_info *sc, uint32_t o, uint8_t v)
  64 {
  65
  66         KASSERT((o < sc->fb_size), ("Offset %#08x out of fb size", o));
  67         *(uint8_t *)(sc->fb_vbase + o) = v;
  68 }
  69
  70 static void
  71 vt_fb_mem_wr2(struct fb_info *sc, uint32_t o, uint16_t v)
  72 {
  73
  74         KASSERT((o < sc->fb_size), ("Offset %#08x out of fb size", o));
  75         *(uint16_t *)(sc->fb_vbase + o) = v;
  76 }
  77
  78 static void
  79 vt_fb_mem_wr4(struct fb_info *sc, uint32_t o, uint32_t v)
  80 {
  81
  82         KASSERT((o < sc->fb_size), ("Offset %#08x out of fb size", o));
  83         *(uint32_t *)(sc->fb_vbase + o) = v;
  84 }
  85
  86 int
  87 vt_fb_ioctl(struct vt_device *vd, u_long cmd, caddr_t data, struct thread *td)
  88 {
  89         struct fb_info *info;
  90         int error = 0;
  91
  92         info = vd->vd_softc;
  93
  94         switch (cmd) {
  95         case FBIOGTYPE:
  96                 bcopy(info, (struct fbtype *)data, sizeof(struct fbtype));
  97                 break;
  98
  99         case FBIO_GETWINORG:    /* get frame buffer window origin */
 100                 *(u_int *)data = 0;
 101                 break;
 102
 103         case FBIO_GETDISPSTART: /* get display start address */
 104                 ((video_display_start_t *)data)->x = 0;
 105                 ((video_display_start_t *)data)->y = 0;
 106                 break;
 107
 108         case FBIO_GETLINEWIDTH: /* get scan line width in bytes */
 109                 *(u_int *)data = info->fb_stride;
 110                 break;
 111
 112         case FBIO_BLANK:        /* blank display */
 113                 if (vd->vd_driver->vd_blank == NULL)
 114                         return (ENODEV);
 115                 vd->vd_driver->vd_blank(vd, TC_BLACK);
 116                 break;
 117
 118         default:
 119                 error = ENOIOCTL;
 120                 break;
 121         }
 122
 123         return (error);
 124 }
 125
 126 int
 127 vt_fb_mmap(struct vt_device *vd, vm_ooffset_t offset, vm_paddr_t *paddr,
 128     int prot, vm_memattr_t *memattr)
 129 {
 130         struct fb_info *info;
 131
 132         info = vd->vd_softc;
 133
 134         if (info->fb_flags & FB_FLAG_NOMMAP)
 135                 return (ENODEV);
 136
 137         if (offset >= 0 && offset < info->fb_size) {
 138                 *paddr = info->fb_pbase + offset;
 139         #ifdef VM_MEMATTR_WRITE_COMBINING
 140                 *memattr = VM_MEMATTR_WRITE_COMBINING;
 141         #endif
 142                 return (0);
 143         }
 144
 145         return (EINVAL);
 146 }
 147
 148 void
 149 vt_fb_setpixel(struct vt_device *vd, int x, int y, term_color_t color)
 150 {
 151         struct fb_info *info;
 152         uint32_t c;
 153         u_int o;
 154
 155         info = vd->vd_softc;
 156         c = info->fb_cmap[color];
 157         o = info->fb_stride * y + x * FBTYPE_GET_BYTESPP(info);
 158
 159         KASSERT((info->fb_vbase != 0), ("Unmapped framebuffer"));
 160
 161         switch (FBTYPE_GET_BYTESPP(info)) {
 162         case 1:
 163                 vt_fb_mem_wr1(info, o, c);
 164                 break;
 165         case 2:
 166                 vt_fb_mem_wr2(info, o, c);
 167                 break;
 168         case 3:
 169                 vt_fb_mem_wr1(info, o, (c >> 16) & 0xff);
 170                 vt_fb_mem_wr1(info, o + 1, (c >> 8) & 0xff);
 171                 vt_fb_mem_wr1(info, o + 2, c & 0xff);
 172                 break;
 173         case 4:
 174                 vt_fb_mem_wr4(info, o, c);
 175                 break;
 176         default:
 177                 /* panic? */
 178                 return;
 179         }
 180
 181 }
 182
 183 void
 184 vt_fb_drawrect(struct vt_device *vd, int x1, int y1, int x2, int y2, int fill,
 185     term_color_t color)
 186 {
 187         int x, y;
 188
 189         for (y = y1; y <= y2; y++) {
 190                 if (fill || (y == y1) || (y == y2)) {
 191                         for (x = x1; x <= x2; x++)
 192                                 vt_fb_setpixel(vd, x, y, color);
 193                 } else {
 194                         vt_fb_setpixel(vd, x1, y, color);
 195                         vt_fb_setpixel(vd, x2, y, color);
 196                 }
 197         }
 198 }
 199
 200 void
 201 vt_fb_blank(struct vt_device *vd, term_color_t color)
 202 {
 203         struct fb_info *info;
 204         uint32_t c;
 205         u_int o, h;
 206
 207         info = vd->vd_softc;
 208         c = info->fb_cmap[color];
 209
 210         KASSERT((info->fb_vbase != 0), ("Unmapped framebuffer"));
 211
 212         switch (FBTYPE_GET_BYTESPP(info)) {
 213         case 1:
 214                 for (h = 0; h < info->fb_height; h++)
 215                         for (o = 0; o < info->fb_stride; o++)
 216                                 vt_fb_mem_wr1(info, h*info->fb_stride + o, c);
 217                 break;
 218         case 2:
 219                 for (h = 0; h < info->fb_height; h++)
 220                         for (o = 0; o < info->fb_stride; o += 2)
 221                                 vt_fb_mem_wr2(info, h*info->fb_stride + o, c);
 222                 break;
 223         case 3:
 224                 for (h = 0; h < info->fb_height; h++)
 225                         for (o = 0; o < info->fb_stride; o += 3) {
 226                                 vt_fb_mem_wr1(info, h*info->fb_stride + o,
 227                                     (c >> 16) & 0xff);
 228                                 vt_fb_mem_wr1(info, h*info->fb_stride + o + 1,
 229                                     (c >> 8) & 0xff);
 230                                 vt_fb_mem_wr1(info, h*info->fb_stride + o + 2,
 231                                     c & 0xff);
 232                         }
 233                 break;
 234         case 4:
 235                 for (h = 0; h < info->fb_height; h++)
 236                         for (o = 0; o < info->fb_stride; o += 4)
 237                                 vt_fb_mem_wr4(info, h*info->fb_stride + o, c);
 238                 break;
 239         default:
 240                 /* panic? */
 241                 return;
 242         }
 243 }
 244
 245 void
 246 vt_fb_bitblt_bitmap(struct vt_device *vd, const struct vt_window *vw,
 247     const uint8_t *pattern, const uint8_t *mask,
 248     unsigned int width, unsigned int height,
 249     unsigned int x, unsigned int y, term_color_t fg, term_color_t bg)
 250 {
 251         struct fb_info *info;
 252         uint32_t fgc, bgc, cc, o;
 253         int bpp, bpl, xi, yi;
 254         int bit, byte;
 255
 256         info = vd->vd_softc;
 257         bpp = FBTYPE_GET_BYTESPP(info);
 258         fgc = info->fb_cmap[fg];
 259         bgc = info->fb_cmap[bg];
 260         bpl = (width + 7) / 8; /* Bytes per source line. */
 261
 262         KASSERT((info->fb_vbase != 0), ("Unmapped framebuffer"));
 263
 264         /* Bound by right and bottom edges. */
 265         if (y + height > vw->vw_draw_area.tr_end.tp_row) {
 266                 if (y >= vw->vw_draw_area.tr_end.tp_row)
 267                         return;
 268                 height = vw->vw_draw_area.tr_end.tp_row - y;
 269         }
 270         if (x + width > vw->vw_draw_area.tr_end.tp_col) {
 271                 if (x >= vw->vw_draw_area.tr_end.tp_col)
 272                         return;
 273                 width = vw->vw_draw_area.tr_end.tp_col - x;
 274         }
 275         for (yi = 0; yi < height; yi++) {
 276                 for (xi = 0; xi < width; xi++) {
 277                         byte = yi * bpl + xi / 8;
 278                         bit = 0x80 >> (xi % 8);
 279                         /* Skip pixel write, if mask bit not set. */
 280                         if (mask != NULL && (mask[byte] & bit) == 0)
 281                                 continue;
 282                         o = (y + yi) * info->fb_stride + (x + xi) * bpp;
 283                         cc = pattern[byte] & bit ? fgc : bgc;
 284
 285                         switch(bpp) {
 286                         case 1:
 287                                 vt_fb_mem_wr1(info, o, cc);
 288                                 break;
 289                         case 2:
 290                                 vt_fb_mem_wr2(info, o, cc);
 291                                 break;
 292                         case 3:
 293                                 /* Packed mode, so unaligned. Byte access. */
 294                                 vt_fb_mem_wr1(info, o, (cc >> 16) & 0xff);
 295                                 vt_fb_mem_wr1(info, o + 1, (cc >> 8) & 0xff);
 296                                 vt_fb_mem_wr1(info, o + 2, cc & 0xff);
 297                                 break;
 298                         case 4:
 299                                 vt_fb_mem_wr4(info, o, cc);
 300                                 break;
 301                         default:
 302                                 /* panic? */
 303                                 break;
 304                         }
 305                 }
 306         }
 307 }
 308
 309 void
 310 vt_fb_bitblt_text(struct vt_device *vd, const struct vt_window *vw,
 311     const term_rect_t *area)
 312 {
 313         unsigned int col, row, x, y;
 314         struct vt_font *vf;
 315         term_char_t c;
 316         term_color_t fg, bg;
 317         const uint8_t *pattern;
 318
 319         vf = vw->vw_font;
 320
 321         for (row = area->tr_begin.tp_row; row < area->tr_end.tp_row; ++row) {
 322                 for (col = area->tr_begin.tp_col; col < area->tr_end.tp_col;
 323                     ++col) {
 324                         x = col * vf->vf_width +
 325                             vw->vw_draw_area.tr_begin.tp_col;
 326                         y = row * vf->vf_height +
 327                             vw->vw_draw_area.tr_begin.tp_row;
 328
 329                         c = VTBUF_GET_FIELD(&vw->vw_buf, row, col);
 330                         pattern = vtfont_lookup(vf, c);
 331                         vt_determine_colors(c,
 332                             VTBUF_ISCURSOR(&vw->vw_buf, row, col), &fg, &bg);
 333
 334                         vt_fb_bitblt_bitmap(vd, vw,
 335                             pattern, NULL, vf->vf_width, vf->vf_height,
 336                             x, y, fg, bg);
 337                 }
 338         }
 339
 340 #ifndef SC_NO_CUTPASTE
 341         if (!vd->vd_mshown)
 342                 return;
 343
 344         term_rect_t drawn_area;
 345
 346         drawn_area.tr_begin.tp_col = area->tr_begin.tp_col * vf->vf_width;
 347         drawn_area.tr_begin.tp_row = area->tr_begin.tp_row * vf->vf_height;
 348         drawn_area.tr_end.tp_col = area->tr_end.tp_col * vf->vf_width;
 349         drawn_area.tr_end.tp_row = area->tr_end.tp_row * vf->vf_height;
 350
 351         if (vt_is_cursor_in_area(vd, &drawn_area)) {
 352                 vt_fb_bitblt_bitmap(vd, vw,
 353                     vd->vd_mcursor->map, vd->vd_mcursor->mask,
 354                     vd->vd_mcursor->width, vd->vd_mcursor->height,
 355                     vd->vd_mx_drawn + vw->vw_draw_area.tr_begin.tp_col,
 356                     vd->vd_my_drawn + vw->vw_draw_area.tr_begin.tp_row,
 357                     vd->vd_mcursor_fg, vd->vd_mcursor_bg);
 358         }
 359 #endif
 360 }
 361
 362 void
 363 vt_fb_postswitch(struct vt_device *vd)
 364 {
 365         struct fb_info *info;
 366
 367         info = vd->vd_softc;
 368
 369         if (info->enter != NULL)
 370                 info->enter(info->fb_priv);
 371 }
 372
 373 static int
 374 vt_fb_init_cmap(uint32_t *cmap, int depth)
 375 {
 376
 377         switch (depth) {
 378         case 8:
 379                 return (vt_generate_cons_palette(cmap, COLOR_FORMAT_RGB,
 380                     0x7, 5, 0x7, 2, 0x3, 0));
 381         case 15:
 382                 return (vt_generate_cons_palette(cmap, COLOR_FORMAT_RGB,
 383                     0x1f, 10, 0x1f, 5, 0x1f, 0));
 384         case 16:
 385                 return (vt_generate_cons_palette(cmap, COLOR_FORMAT_RGB,
 386                     0x1f, 11, 0x3f, 5, 0x1f, 0));
 387         case 24:
 388         case 32: /* Ignore alpha. */
 389                 return (vt_generate_cons_palette(cmap, COLOR_FORMAT_RGB,
 390                     0xff, 16, 0xff, 8, 0xff, 0));
 391         default:
 392                 return (1);
 393         }
 394 }
 395
 396 int
 397 vt_fb_init(struct vt_device *vd)
 398 {
 399         struct fb_info *info;
 400         int err;
 401
 402         info = vd->vd_softc;
 403         vd->vd_height = info->fb_height;
 404         vd->vd_width = info->fb_width;
 405
 406         if (info->fb_size == 0)
 407                 return (CN_DEAD);
 408
 409         if (info->fb_pbase == 0)
 410                 info->fb_flags |= FB_FLAG_NOMMAP;
 411
 412         if (info->fb_cmsize <= 0) {
 413                 err = vt_fb_init_cmap(info->fb_cmap, FBTYPE_GET_BPP(info));
 414                 if (err)
 415                         return (CN_DEAD);
 416                 info->fb_cmsize = 16;
 417         }
 418
 419         /* Clear the screen. */
 420         vd->vd_driver->vd_blank(vd, TC_BLACK);
 421
 422         /* Wakeup screen. KMS need this. */
 423         vt_fb_postswitch(vd);
 424
 425         return (CN_INTERNAL);
 426 }
 427
 428 int
 429 vt_fb_attach(struct fb_info *info)
 430 {
 431
 432         vt_allocate(&vt_fb_driver, info);
 433
 434         return (0);
 435 }
 436
 437 void
 438 vt_fb_suspend(struct vt_device *vd)
 439 {
 440
 441         vt_suspend(vd);
 442 }
 443
 444 void
 445 vt_fb_resume(struct vt_device *vd)
 446 {
 447
 448         vt_resume(vd);
 449 }