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 bwidth, 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     bwidth = (width + start_offset) / 8;
  62     if (end_offset)
  63         bwidth++;
  64     VGLPlane[0] = VGLBuf;
  65     VGLPlane[1] = VGLPlane[0] + bwidth;
  66     VGLPlane[2] = VGLPlane[1] + bwidth;
  67     VGLPlane[3] = VGLPlane[2] + bwidth;
  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     outb(0x3ce, 0x01); outb(0x3cf, 0x00);               /* set/reset enable */
  91     outb(0x3ce, 0x08); outb(0x3cf, 0xff);               /* bit mask */
  92     for (i=0; i<4; i++) {
  93       outb(0x3c4, 0x02);
  94       outb(0x3c5, 0x01<<i);
  95       outb(0x3ce, 0x04);
  96       outb(0x3cf, i);
  97       pos = VGLAdpInfo.va_line_width*y + x/8;
  98       if (dst->Type == VIDBUF4) {
  99         if (end_offset)
 100           VGLPlane[i][planepos] |= dst->Bitmap[pos+planepos] & mask[end_offset];
 101         if (start_offset)
 102           VGLPlane[i][0] |= dst->Bitmap[pos] & ~mask[start_offset];
 103         bcopy(&VGLPlane[i][0], dst->Bitmap + pos, bwidth);
 104       } else {  /* VIDBUF4S */
 105         if (end_offset) {
 106           offset = VGLSetSegment(pos + planepos);
 107           VGLPlane[i][planepos] |= dst->Bitmap[offset] & mask[end_offset];
 108         }
 109         offset = VGLSetSegment(pos);
 110         if (start_offset)
 111           VGLPlane[i][0] |= dst->Bitmap[offset] & ~mask[start_offset];
 112         for (last = bwidth; ; ) {
 113           len = min(VGLAdpInfo.va_window_size - offset, last);
 114           bcopy(&VGLPlane[i][bwidth - last], dst->Bitmap + offset, len);
 115           pos += len;
 116           last -= len;
 117           if (last <= 0)
 118             break;
 119           offset = VGLSetSegment(pos);
 120         }
 121       }
 122     }
 123     break;
 124   case VIDBUF8X:
 125     address = dst->Bitmap + VGLAdpInfo.va_line_width * y + x/4;
 126     for (i=0; i<4; i++) {
 127       outb(0x3c4, 0x02);
 128       outb(0x3c5, 0x01 << ((x + i)%4));
 129       for (planepos=0, pos=i; pos<width; planepos++, pos+=4)
 130         address[planepos] = line[pos];
 131       if ((x + i)%4 == 3)
 132         ++address;
 133     }
 134     break;
 135   case VIDBUF8S:
 136   case VIDBUF16S:
 137   case VIDBUF24S:
 138   case VIDBUF32S:
 139     width = width * dst->PixelBytes;
 140     pos = (dst->VXsize * y + x) * dst->PixelBytes;
 141     while (width > 0) {
 142       offset = VGLSetSegment(pos);
 143       i = min(VGLAdpInfo.va_window_size - offset, width);
 144       bcopy(line, dst->Bitmap + offset, i);
 145       line += i;
 146       pos += i;
 147       width -= i;
 148     }
 149     break;
 150   case MEMBUF:
 151   case VIDBUF8:
 152   case VIDBUF16:
 153   case VIDBUF24:
 154   case VIDBUF32:
 155     address = dst->Bitmap + (dst->VXsize * y + x) * dst->PixelBytes;
 156     bcopy(line, address, width * dst->PixelBytes);
 157     break;
 158   default:
 159     ;
 160   }
 161 }
 162
 163 int
 164 __VGLBitmapCopy(VGLBitmap *src, int srcx, int srcy,
 165               VGLBitmap *dst, int dstx, int dsty, int width, int hight)
 166 {
 167   byte *buffer, *p;
 168   int mousemerge, srcline, dstline, yend, yextra, ystep;
 169
 170   mousemerge = 0;
 171   if (hight < 0) {
 172     hight = -hight;
 173     mousemerge = (dst == VGLDisplay &&
 174                   VGLMouseOverlap(dstx, dsty, width, hight));
 175     if (mousemerge)
 176       buffer = alloca(width*src->PixelBytes);
 177   }
 178   if (srcx>src->VXsize || srcy>src->VYsize
 179         || dstx>dst->VXsize || dsty>dst->VYsize)
 180     return -1;
 181   if (srcx < 0) {
 182     width=width+srcx; dstx-=srcx; srcx=0;
 183   }
 184   if (srcy < 0) {
 185     hight=hight+srcy; dsty-=srcy; srcy=0;
 186   }
 187   if (dstx < 0) {
 188     width=width+dstx; srcx-=dstx; dstx=0;
 189   }
 190   if (dsty < 0) {
 191     hight=hight+dsty; srcy-=dsty; dsty=0;
 192   }
 193   if (srcx+width > src->VXsize)
 194      width=src->VXsize-srcx;
 195   if (srcy+hight > src->VYsize)
 196      hight=src->VYsize-srcy;
 197   if (dstx+width > dst->VXsize)
 198      width=dst->VXsize-dstx;
 199   if (dsty+hight > dst->VYsize)
 200      hight=dst->VYsize-dsty;
 201   if (width < 0 || hight < 0)
 202      return -1;
 203   yend = srcy + hight;
 204   yextra = 0;
 205   ystep = 1;
 206   if (src->Bitmap == dst->Bitmap && srcy < dsty) {
 207     yend = srcy - 1;
 208     yextra = hight - 1;
 209     ystep = -1;
 210   }
 211   for (srcline = srcy + yextra, dstline = dsty + yextra; srcline != yend;
 212        srcline += ystep, dstline += ystep) {
 213     p = src->Bitmap+(srcline*src->VXsize+srcx)*dst->PixelBytes;
 214     if (mousemerge && VGLMouseOverlap(dstx, dstline, width, 1)) {
 215       bcopy(p, buffer, width*src->PixelBytes);
 216       p = buffer;
 217       VGLMouseMerge(dstx, dstline, width, p);
 218     }
 219     WriteVerticalLine(dst, dstx, dstline, width, p);
 220   }
 221   return 0;
 222 }
 223
 224 int
 225 VGLBitmapCopy(VGLBitmap *src, int srcx, int srcy,
 226               VGLBitmap *dst, int dstx, int dsty, int width, int hight)
 227 {
 228   int error;
 229
 230   if (hight < 0)
 231     return -1;
 232   if (src == VGLDisplay)
 233     src = &VGLVDisplay;
 234   if (src->Type != MEMBUF)
 235     return -1;          /* invalid */
 236   if (dst == VGLDisplay) {
 237     VGLMouseFreeze();
 238     __VGLBitmapCopy(src, srcx, srcy, &VGLVDisplay, dstx, dsty, width, hight);
 239     error = __VGLBitmapCopy(src, srcx, srcy, &VGLVDisplay, dstx, dsty,
 240                             width, hight);
 241     if (error != 0)
 242       return error;
 243     src = &VGLVDisplay;
 244     srcx = dstx;
 245     srcy = dsty;
 246   } else if (dst->Type != MEMBUF)
 247     return -1;          /* invalid */
 248   error = __VGLBitmapCopy(src, srcx, srcy, dst, dstx, dsty, width, -hight);
 249   if (dst == VGLDisplay)
 250     VGLMouseUnFreeze();
 251   return error;
 252 }
 253
 254 VGLBitmap
 255 *VGLBitmapCreate(int type, int xsize, int ysize, byte *bits)
 256 {
 257   VGLBitmap *object;
 258
 259   if (type != MEMBUF)
 260     return NULL;
 261   if (xsize < 0 || ysize < 0)
 262     return NULL;
 263   object = (VGLBitmap *)malloc(sizeof(*object));
 264   if (object == NULL)
 265     return NULL;
 266   object->Type = type;
 267   object->Xsize = xsize;
 268   object->Ysize = ysize;
 269   object->VXsize = xsize;
 270   object->VYsize = ysize;
 271   object->Xorigin = 0;
 272   object->Yorigin = 0;
 273   object->Bitmap = bits;
 274   object->PixelBytes = VGLDisplay->PixelBytes;
 275   return object;
 276 }
 277
 278 void
 279 VGLBitmapDestroy(VGLBitmap *object)
 280 {
 281   if (object->Bitmap)
 282     free(object->Bitmap);
 283   free(object);
 284 }
 285
 286 int
 287 VGLBitmapAllocateBits(VGLBitmap *object)
 288 {
 289   object->Bitmap = malloc(object->VXsize*object->VYsize*object->PixelBytes);
 290   if (object->Bitmap == NULL)
 291     return -1;
 292   return 0;
 293 }
 294
 295 void
 296 VGLBitmapCvt(VGLBitmap *src, VGLBitmap *dst)
 297 {
 298   u_long color;
 299   int dstpos, i, pb, size, srcpb, srcpos;
 300
 301   size = src->VXsize * src->VYsize;
 302   srcpb = src->PixelBytes;
 303   if (srcpb <= 0)
 304     srcpb = 1;
 305   pb = dst->PixelBytes;
 306   if (pb == srcpb) {
 307     bcopy(src->Bitmap, dst->Bitmap, size * pb);
 308     return;
 309   }
 310   if (srcpb != 1)
 311     return;             /* not supported */
 312   for (srcpos = dstpos = 0; srcpos < size; srcpos++) {
 313     color = VGLrgb332ToNative(src->Bitmap[srcpos]);
 314     for (i = 0; i < pb; i++, color >>= 8)
 315         dst->Bitmap[dstpos++] = color;
 316   }
 317 }