xref: /freebsd/lib/libvgl/bitmap.c (revision cddbc3b40812213ff00041f79174cac0be360a2a)
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   case VIDBUF16S:
140   case VIDBUF24S:
141   case VIDBUF32S:
142     width = width * dst->PixelBytes;
143     pos = (dst->VXsize * y + x) * dst->PixelBytes;
144     while (width > 0) {
145       offset = VGLSetSegment(pos);
146       i = min(VGLAdpInfo.va_window_size - offset, width);
147       bcopy(line, dst->Bitmap + offset, i);
148       line += i;
149       pos += i;
150       width -= i;
151     }
152     break;
153   case MEMBUF:
154   case VIDBUF8:
155   case VIDBUF16:
156   case VIDBUF24:
157   case VIDBUF32:
158     address = dst->Bitmap + (dst->VXsize * y + x) * dst->PixelBytes;
159     bcopy(line, address, width * dst->PixelBytes);
160     break;
161   default:
162     ;
163   }
164 }
165 
166 int
167 __VGLBitmapCopy(VGLBitmap *src, int srcx, int srcy,
168 	      VGLBitmap *dst, int dstx, int dsty, int width, int hight)
169 {
170   int srcline, dstline, yend, yextra, ystep;
171 
172   if (srcx>src->VXsize || srcy>src->VYsize
173 	|| dstx>dst->VXsize || dsty>dst->VYsize)
174     return -1;
175   if (srcx < 0) {
176     width=width+srcx; dstx-=srcx; srcx=0;
177   }
178   if (srcy < 0) {
179     hight=hight+srcy; dsty-=srcy; srcy=0;
180   }
181   if (dstx < 0) {
182     width=width+dstx; srcx-=dstx; dstx=0;
183   }
184   if (dsty < 0) {
185     hight=hight+dsty; srcy-=dsty; dsty=0;
186   }
187   if (srcx+width > src->VXsize)
188      width=src->VXsize-srcx;
189   if (srcy+hight > src->VYsize)
190      hight=src->VYsize-srcy;
191   if (dstx+width > dst->VXsize)
192      width=dst->VXsize-dstx;
193   if (dsty+hight > dst->VYsize)
194      hight=dst->VYsize-dsty;
195   if (width < 0 || hight < 0)
196      return -1;
197   yend = srcy + hight;
198   yextra = 0;
199   ystep = 1;
200   if (src->Bitmap == dst->Bitmap && srcy < dsty) {
201     yend = srcy;
202     yextra = hight - 1;
203     ystep = -1;
204   }
205   for (srcline = srcy + yextra, dstline = dsty + yextra; srcline != yend;
206        srcline += ystep, dstline += ystep) {
207     WriteVerticalLine(dst, dstx, dstline, width,
208       src->Bitmap+(srcline*src->VXsize+srcx)*dst->PixelBytes);
209   }
210   return 0;
211 }
212 
213 int
214 VGLBitmapCopy(VGLBitmap *src, int srcx, int srcy,
215 	      VGLBitmap *dst, int dstx, int dsty, int width, int hight)
216 {
217   int error;
218 
219   if (src == VGLDisplay)
220     src = &VGLVDisplay;
221   if (src->Type != MEMBUF)
222     return -1;		/* invalid */
223   if (dst == VGLDisplay) {
224     VGLMouseFreeze(dstx, dsty, width, hight, 0);
225     __VGLBitmapCopy(src, srcx, srcy, &VGLVDisplay, dstx, dsty, width, hight);
226     src = &VGLVDisplay;
227     srcx = dstx;
228     srcy = dsty;
229   } else if (dst->Type != MEMBUF)
230     return -1;		/* invalid */
231   error = __VGLBitmapCopy(src, srcx, srcy, dst, dstx, dsty, width, hight);
232   if (dst == VGLDisplay)
233     VGLMouseUnFreeze();
234   return error;
235 }
236 
237 VGLBitmap
238 *VGLBitmapCreate(int type, int xsize, int ysize, byte *bits)
239 {
240   VGLBitmap *object;
241 
242   if (type != MEMBUF)
243     return NULL;
244   if (xsize < 0 || ysize < 0)
245     return NULL;
246   object = (VGLBitmap *)malloc(sizeof(*object));
247   if (object == NULL)
248     return NULL;
249   object->Type = type;
250   object->Xsize = xsize;
251   object->Ysize = ysize;
252   object->VXsize = xsize;
253   object->VYsize = ysize;
254   object->Xorigin = 0;
255   object->Yorigin = 0;
256   object->Bitmap = bits;
257   object->PixelBytes = VGLDisplay->PixelBytes;
258   return object;
259 }
260 
261 void
262 VGLBitmapDestroy(VGLBitmap *object)
263 {
264   if (object->Bitmap)
265     free(object->Bitmap);
266   free(object);
267 }
268 
269 int
270 VGLBitmapAllocateBits(VGLBitmap *object)
271 {
272   object->Bitmap = malloc(object->VXsize*object->VYsize*object->PixelBytes);
273   if (object->Bitmap == NULL)
274     return -1;
275   return 0;
276 }
277