lib/libvgl/bitmap.c

   1 /*-
   2  * SPDX-License-Identifier: BSD-3-Clause
   3  *
   4  * Copyright (c) 1991-1997 Søren Schmidt
   5  * All rights reserved.
   6  *
   7  * Redistribution and use in source and binary forms, with or without
   8  * modification, are permitted provided that the following conditions
   9  * are met:
  10  * 1. Redistributions of source code must retain the above copyright
  11  *    notice, this list of conditions and the following disclaimer,
  12  *    in this position and unchanged.
  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  * 3. The name of the author may not be used to endorse or promote products
  17  *    derived from this software without specific prior written permission.
  18  *
  19  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  20  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  21  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  22  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  23  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  24  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  25  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  26  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  27  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  28  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  29  */
  30
  31 #include <sys/cdefs.h>
  32 __FBSDID("$FreeBSD$");
  33
  34 #include <sys/types.h>
  35 #include <signal.h>
  36 #include <sys/fbio.h>
  37 #include "vgl.h"
  38
  39 #define min(x, y)       (((x) < (y)) ? (x) : (y))
  40
  41 static byte mask[8] = {0xff, 0x7f, 0x3f, 0x1f, 0x0f, 0x07, 0x03, 0x01};
  42 static int color2bit[16] = {0x00000000, 0x00000001, 0x00000100, 0x00000101,
  43                             0x00010000, 0x00010001, 0x00010100, 0x00010101,
  44                             0x01000000, 0x01000001, 0x01000100, 0x01000101,
  45                             0x01010000, 0x01010001, 0x01010100, 0x01010101};
  46
  47 static void
  48 WriteVerticalLine(VGLBitmap *dst, int x, int y, int width, byte *line)
  49 {
  50   int i, pos, last, planepos, start_offset, end_offset, offset;
  51   int len;
  52   unsigned int word = 0;
  53   byte *address;
  54   byte *VGLPlane[4];
  55
  56   switch (dst->Type) {
  57   case VIDBUF4:
  58   case VIDBUF4S:
  59     start_offset = (x & 0x07);
  60     end_offset = (x + width) & 0x07;
  61     i = (width + start_offset) / 8;
  62     if (end_offset)
  63         i++;
  64     VGLPlane[0] = VGLBuf;
  65     VGLPlane[1] = VGLPlane[0] + i;
  66     VGLPlane[2] = VGLPlane[1] + i;
  67     VGLPlane[3] = VGLPlane[2] + i;
  68     pos = 0;
  69     planepos = 0;
  70     last = 8 - start_offset;
  71     while (pos < width) {
  72       word = 0;
  73       while (pos < last && pos < width)
  74         word = (word<<1) | color2bit[line[pos++]&0x0f];
  75       VGLPlane[0][planepos] = word;
  76       VGLPlane[1][planepos] = word>>8;
  77       VGLPlane[2][planepos] = word>>16;
  78       VGLPlane[3][planepos] = word>>24;
  79       planepos++;
  80       last += 8;
  81     }
  82     planepos--;
  83     if (end_offset) {
  84       word <<= (8 - end_offset);
  85       VGLPlane[0][planepos] = word;
  86       VGLPlane[1][planepos] = word>>8;
  87       VGLPlane[2][planepos] = word>>16;
  88       VGLPlane[3][planepos] = word>>24;
  89     }
  90     if (start_offset || end_offset)
  91       width+=8;
  92     width /= 8;
  93     outb(0x3ce, 0x01); outb(0x3cf, 0x00);               /* set/reset enable */
  94     outb(0x3ce, 0x08); outb(0x3cf, 0xff);               /* bit mask */
  95     for (i=0; i<4; i++) {
  96       outb(0x3c4, 0x02);
  97       outb(0x3c5, 0x01<<i);
  98       outb(0x3ce, 0x04);
  99       outb(0x3cf, i);
 100       pos = VGLAdpInfo.va_line_width*y + x/8;
 101       if (dst->Type == VIDBUF4) {
 102         if (end_offset)
 103           VGLPlane[i][planepos] |= dst->Bitmap[pos+planepos] & mask[end_offset];
 104         if (start_offset)
 105           VGLPlane[i][0] |= dst->Bitmap[pos] & ~mask[start_offset];
 106         bcopy(&VGLPlane[i][0], dst->Bitmap + pos, width);
 107       } else {  /* VIDBUF4S */
 108         if (end_offset) {
 109           offset = VGLSetSegment(pos + planepos);
 110           VGLPlane[i][planepos] |= dst->Bitmap[offset] & mask[end_offset];
 111         }
 112         offset = VGLSetSegment(pos);
 113         if (start_offset)
 114           VGLPlane[i][0] |= dst->Bitmap[offset] & ~mask[start_offset];
 115         for (last = width; ; ) {
 116           len = min(VGLAdpInfo.va_window_size - offset, last);
 117           bcopy(&VGLPlane[i][width - last], dst->Bitmap + offset, len);
 118           pos += len;
 119           last -= len;
 120           if (last <= 0)
 121             break;
 122           offset = VGLSetSegment(pos);
 123         }
 124       }
 125     }
 126     break;
 127   case VIDBUF8X:
 128     address = dst->Bitmap + VGLAdpInfo.va_line_width * y + x/4;
 129     for (i=0; i<4; i++) {
 130       outb(0x3c4, 0x02);
 131       outb(0x3c5, 0x01 << ((x + i)%4));
 132       for (planepos=0, pos=i; pos<width; planepos++, pos+=4)
 133         address[planepos] = line[pos];
 134       if ((x + i)%4 == 3)
 135         ++address;
 136     }
 137     break;
 138   case VIDBUF8S:
 139     pos = dst->VXsize * y + x;
 140     while (width > 0) {
 141       offset = VGLSetSegment(pos);
 142       i = min(VGLAdpInfo.va_window_size - offset, width);
 143       bcopy(line, dst->Bitmap + offset, i);
 144       line += i;
 145       pos += i;
 146       width -= i;
 147     }
 148     break;
 149   case VIDBUF16S:
 150   case VIDBUF24S:
 151   case VIDBUF32S:
 152     width = width * dst->PixelBytes;
 153     pos = (dst->VXsize * y + x) * dst->PixelBytes;
 154     while (width > 0) {
 155       offset = VGLSetSegment(pos);
 156       i = min(VGLAdpInfo.va_window_size - offset, width);
 157       bcopy(line, dst->Bitmap + offset, i);
 158       line += i;
 159       pos += i;
 160       width -= i;
 161     }
 162     break;
 163   case VIDBUF8:
 164   case MEMBUF:
 165     address = dst->Bitmap + dst->VXsize * y + x;
 166     bcopy(line, address, width);
 167     break;
 168   case VIDBUF16:
 169   case VIDBUF24:
 170   case VIDBUF32:
 171     address = dst->Bitmap + (dst->VXsize * y + x) * dst->PixelBytes;
 172     bcopy(line, address, width * dst->PixelBytes);
 173     break;
 174   default:
 175     ;
 176   }
 177 }
 178
 179 static void
 180 ReadVerticalLine(VGLBitmap *src, int x, int y, int width, byte *line)
 181 {
 182   int i, bit, pos, count, planepos, start_offset, end_offset, offset;
 183   int width2, len;
 184   byte *address;
 185   byte *VGLPlane[4];
 186
 187   switch (src->Type) {
 188   case VIDBUF4S:
 189     start_offset = (x & 0x07);
 190     end_offset = (x + width) & 0x07;
 191     count = (width + start_offset) / 8;
 192     if (end_offset)
 193       count++;
 194     VGLPlane[0] = VGLBuf;
 195     VGLPlane[1] = VGLPlane[0] + count;
 196     VGLPlane[2] = VGLPlane[1] + count;
 197     VGLPlane[3] = VGLPlane[2] + count;
 198     for (i=0; i<4; i++) {
 199       outb(0x3ce, 0x04);
 200       outb(0x3cf, i);
 201       pos = VGLAdpInfo.va_line_width*y + x/8;
 202       for (width2 = count; width2 > 0; ) {
 203         offset = VGLSetSegment(pos);
 204         len = min(VGLAdpInfo.va_window_size - offset, width2);
 205         bcopy(src->Bitmap + offset, &VGLPlane[i][count - width2], len);
 206         pos += len;
 207         width2 -= len;
 208       }
 209     }
 210     goto read_planar;
 211   case VIDBUF4:
 212     address = src->Bitmap + VGLAdpInfo.va_line_width * y + x/8;
 213     start_offset = (x & 0x07);
 214     end_offset = (x + width) & 0x07;
 215     count = (width + start_offset) / 8;
 216     if (end_offset)
 217       count++;
 218     VGLPlane[0] = VGLBuf;
 219     VGLPlane[1] = VGLPlane[0] + count;
 220     VGLPlane[2] = VGLPlane[1] + count;
 221     VGLPlane[3] = VGLPlane[2] + count;
 222     for (i=0; i<4; i++) {
 223       outb(0x3ce, 0x04);
 224       outb(0x3cf, i);
 225       bcopy(address, &VGLPlane[i][0], count);
 226     }
 227 read_planar:
 228     pos = 0;
 229     planepos = 0;
 230     bit = 7 - start_offset;
 231     while (pos < width) {
 232       for (; bit >= 0 && pos < width; bit--, pos++) {
 233         line[pos] = (VGLPlane[0][planepos] & (1<<bit) ? 1 : 0) |
 234                     ((VGLPlane[1][planepos] & (1<<bit) ? 1 : 0) << 1) |
 235                     ((VGLPlane[2][planepos] & (1<<bit) ? 1 : 0) << 2) |
 236                     ((VGLPlane[3][planepos] & (1<<bit) ? 1 : 0) << 3);
 237       }
 238       planepos++;
 239       bit = 7;
 240     }
 241     break;
 242   case VIDBUF8X:
 243     address = src->Bitmap + VGLAdpInfo.va_line_width * y + x/4;
 244     for (i=0; i<4; i++) {
 245       outb(0x3ce, 0x04);
 246       outb(0x3cf, (x + i)%4);
 247       for (planepos=0, pos=i; pos<width; planepos++, pos+=4)
 248         line[pos] = address[planepos];
 249       if ((x + i)%4 == 3)
 250         ++address;
 251     }
 252     break;
 253   case VIDBUF8S:
 254     pos = src->VXsize * y + x;
 255     while (width > 0) {
 256       offset = VGLSetSegment(pos);
 257       i = min(VGLAdpInfo.va_window_size - offset, width);
 258       bcopy(src->Bitmap + offset, line, i);
 259       line += i;
 260       pos += i;
 261       width -= i;
 262     }
 263     break;
 264   case VIDBUF16S:
 265   case VIDBUF24S:
 266   case VIDBUF32S:
 267     width = width * src->PixelBytes;
 268     pos = (src->VXsize * y + x) * src->PixelBytes;
 269     while (width > 0) {
 270       offset = VGLSetSegment(pos);
 271       i = min(VGLAdpInfo.va_window_size - offset, width);
 272       bcopy(src->Bitmap + offset, line, i);
 273       line += i;
 274       pos += i;
 275       width -= i;
 276     }
 277     break;
 278   case VIDBUF8:
 279   case MEMBUF:
 280     address = src->Bitmap + src->VXsize * y + x;
 281     bcopy(address, line, width);
 282     break;
 283   case VIDBUF16:
 284   case VIDBUF24:
 285   case VIDBUF32:
 286     address = src->Bitmap + (src->VXsize * y + x) * src->PixelBytes;
 287     bcopy(address, line, width * src->PixelBytes);
 288     break;
 289   default:
 290     ;
 291   }
 292 }
 293
 294 int
 295 __VGLBitmapCopy(VGLBitmap *src, int srcx, int srcy,
 296               VGLBitmap *dst, int dstx, int dsty, int width, int hight)
 297 {
 298   int srcline, dstline;
 299
 300   if (srcx>src->VXsize || srcy>src->VYsize
 301         || dstx>dst->VXsize || dsty>dst->VYsize)
 302     return -1;
 303   if (srcx < 0) {
 304     width=width+srcx; dstx-=srcx; srcx=0;
 305   }
 306   if (srcy < 0) {
 307     hight=hight+srcy; dsty-=srcy; srcy=0;
 308   }
 309   if (dstx < 0) {
 310     width=width+dstx; srcx-=dstx; dstx=0;
 311   }
 312   if (dsty < 0) {
 313     hight=hight+dsty; srcy-=dsty; dsty=0;
 314   }
 315   if (srcx+width > src->VXsize)
 316      width=src->VXsize-srcx;
 317   if (srcy+hight > src->VYsize)
 318      hight=src->VYsize-srcy;
 319   if (dstx+width > dst->VXsize)
 320      width=dst->VXsize-dstx;
 321   if (dsty+hight > dst->VYsize)
 322      hight=dst->VYsize-dsty;
 323   if (width < 0 || hight < 0)
 324      return -1;
 325   if (src->Type == MEMBUF) {
 326     for (srcline=srcy, dstline=dsty; srcline<srcy+hight; srcline++, dstline++) {
 327       WriteVerticalLine(dst, dstx, dstline, width,
 328         (src->Bitmap+(srcline*src->VXsize)+srcx));
 329     }
 330   }
 331   else if (dst->Type == MEMBUF) {
 332     for (srcline=srcy, dstline=dsty; srcline<srcy+hight; srcline++, dstline++) {
 333       ReadVerticalLine(src, srcx, srcline, width,
 334          (dst->Bitmap+(dstline*dst->VXsize)+dstx));
 335     }
 336   }
 337   else {
 338     byte buffer[2048];  /* XXX */
 339     byte *p;
 340
 341     if (width > sizeof(buffer)) {
 342       p = malloc(width);
 343       if (p == NULL)
 344         return 1;
 345     } else {
 346       p = buffer;
 347     }
 348     for (srcline=srcy, dstline=dsty; srcline<srcy+hight; srcline++, dstline++) {
 349       ReadVerticalLine(src, srcx, srcline, width, p);
 350       WriteVerticalLine(dst, dstx, dstline, width, p);
 351     }
 352     if (width > sizeof(buffer))
 353       free(p);
 354   }
 355   return 0;
 356 }
 357
 358 int
 359 VGLBitmapCopy(VGLBitmap *src, int srcx, int srcy,
 360               VGLBitmap *dst, int dstx, int dsty, int width, int hight)
 361 {
 362   int error;
 363
 364   VGLMouseFreeze(dstx, dsty, width, hight, 0);
 365   error = __VGLBitmapCopy(src, srcx, srcy, dst, dstx, dsty, width, hight);
 366   VGLMouseUnFreeze();
 367   return error;
 368 }
 369
 370 VGLBitmap
 371 *VGLBitmapCreate(int type, int xsize, int ysize, byte *bits)
 372 {
 373   VGLBitmap *object;
 374
 375   if (type != MEMBUF)
 376     return NULL;
 377   if (xsize < 0 || ysize < 0)
 378     return NULL;
 379   object = (VGLBitmap *)malloc(sizeof(*object));
 380   if (object == NULL)
 381     return NULL;
 382   object->Type = type;
 383   object->Xsize = xsize;
 384   object->Ysize = ysize;
 385   object->VXsize = xsize;
 386   object->VYsize = ysize;
 387   object->Xorigin = 0;
 388   object->Yorigin = 0;
 389   object->Bitmap = bits;
 390   return object;
 391 }
 392
 393 void
 394 VGLBitmapDestroy(VGLBitmap *object)
 395 {
 396   if (object->Bitmap)
 397     free(object->Bitmap);
 398   free(object);
 399 }
 400
 401 int
 402 VGLBitmapAllocateBits(VGLBitmap *object)
 403 {
 404   object->Bitmap = (byte *)malloc(object->VXsize*object->VYsize);
 405   if (object->Bitmap == NULL)
 406     return -1;
 407   return 0;
 408 }