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
41static byte mask[8] = {0xff, 0x7f, 0x3f, 0x1f, 0x0f, 0x07, 0x03, 0x01};
42static int color2bit[16] = {0x00000000, 0x00000001, 0x00000100, 0x00000101,
43			    0x00010000, 0x00010001, 0x00010100, 0x00010101,
44			    0x01000000, 0x01000001, 0x01000100, 0x01000101,
45			    0x01010000, 0x01010001, 0x01010100, 0x01010101};
46
47static void
48WriteVerticalLine(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
163int
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
224int
225VGLBitmapCopy(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
254VGLBitmap
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
278void
279VGLBitmapDestroy(VGLBitmap *object)
280{
281  if (object->Bitmap)
282    free(object->Bitmap);
283  free(object);
284}
285
286int
287VGLBitmapAllocateBits(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
295void
296VGLBitmapCvt(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}
318