rasops.c revision 1.10 1 1.10 ad /* $NetBSD: rasops.c,v 1.10 1999/06/15 21:34:05 ad Exp $ */
2 1.1 ad
3 1.9 ad /*-
4 1.9 ad * Copyright (c) 1999 The NetBSD Foundation, Inc.
5 1.1 ad * All rights reserved.
6 1.1 ad *
7 1.9 ad * This code is derived from software contributed to The NetBSD Foundation
8 1.9 ad * by Andy Doran.
9 1.9 ad *
10 1.1 ad * Redistribution and use in source and binary forms, with or without
11 1.1 ad * modification, are permitted provided that the following conditions
12 1.1 ad * are met:
13 1.1 ad * 1. Redistributions of source code must retain the above copyright
14 1.1 ad * notice, this list of conditions and the following disclaimer.
15 1.1 ad * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 ad * notice, this list of conditions and the following disclaimer in the
17 1.1 ad * documentation and/or other materials provided with the distribution.
18 1.9 ad * 3. All advertising materials mentioning features or use of this software
19 1.9 ad * must display the following acknowledgement:
20 1.9 ad * This product includes software developed by the NetBSD
21 1.9 ad * Foundation, Inc. and its contributors.
22 1.9 ad * 4. Neither the name of The NetBSD Foundation nor the names of its
23 1.9 ad * contributors may be used to endorse or promote products derived
24 1.9 ad * from this software without specific prior written permission.
25 1.1 ad *
26 1.9 ad * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
27 1.9 ad * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28 1.9 ad * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29 1.9 ad * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
30 1.9 ad * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 1.9 ad * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 1.9 ad * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 1.9 ad * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 1.9 ad * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 1.9 ad * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 1.9 ad * POSSIBILITY OF SUCH DAMAGE.
37 1.1 ad */
38 1.2 ad
39 1.1 ad #include <sys/cdefs.h>
40 1.10 ad __KERNEL_RCSID(0, "$NetBSD: rasops.c,v 1.10 1999/06/15 21:34:05 ad Exp $");
41 1.1 ad
42 1.4 ad #include "rasops_glue.h"
43 1.1 ad
44 1.1 ad #include <sys/types.h>
45 1.1 ad #include <sys/param.h>
46 1.1 ad #include <sys/systm.h>
47 1.1 ad #include <sys/time.h>
48 1.1 ad
49 1.3 ad #include <machine/bswap.h>
50 1.4 ad #include <machine/endian.h>
51 1.3 ad
52 1.1 ad #include <dev/wscons/wsdisplayvar.h>
53 1.1 ad #include <dev/wscons/wsconsio.h>
54 1.1 ad #include <dev/wsfont/wsfont.h>
55 1.1 ad #include <dev/rasops/rasops.h>
56 1.1 ad
57 1.1 ad /* ANSI colormap (R,G,B). Upper 8 are high-intensity */
58 1.1 ad u_char rasops_cmap[256*3] = {
59 1.1 ad 0x00, 0x00, 0x00, /* black */
60 1.1 ad 0x7f, 0x00, 0x00, /* red */
61 1.1 ad 0x00, 0x7f, 0x00, /* green */
62 1.1 ad 0x7f, 0x7f, 0x00, /* brown */
63 1.1 ad 0x00, 0x00, 0x7f, /* blue */
64 1.1 ad 0x7f, 0x00, 0x7f, /* magenta */
65 1.1 ad 0x00, 0x7f, 0x7f, /* cyan */
66 1.1 ad 0xc7, 0xc7, 0xc7, /* white - XXX too dim? */
67 1.1 ad
68 1.1 ad 0x7f, 0x7f, 0x7f, /* black */
69 1.1 ad 0xff, 0x00, 0x00, /* red */
70 1.1 ad 0x00, 0xff, 0x00, /* green */
71 1.1 ad 0xff, 0xff, 0x00, /* brown */
72 1.1 ad 0x00, 0x00, 0xff, /* blue */
73 1.1 ad 0xff, 0x00, 0xff, /* magenta */
74 1.1 ad 0x00, 0xff, 0xff, /* cyan */
75 1.1 ad 0xff, 0xff, 0xff, /* white */
76 1.1 ad };
77 1.1 ad
78 1.1 ad /* True if color is gray */
79 1.1 ad u_char rasops_isgray[16] = {
80 1.1 ad 1, 0, 0, 0,
81 1.1 ad 0, 0, 0, 1,
82 1.1 ad 1, 0, 0, 0,
83 1.1 ad 0, 0, 0, 1
84 1.1 ad };
85 1.1 ad
86 1.4 ad /* Generic functions */
87 1.1 ad static void rasops_copyrows __P((void *, int, int, int));
88 1.1 ad static int rasops_mapchar __P((void *, int, u_int *));
89 1.1 ad static void rasops_cursor __P((void *, int, int, int));
90 1.1 ad static int rasops_alloc_cattr __P((void *, int, int, int, long *));
91 1.1 ad static int rasops_alloc_mattr __P((void *, int, int, int, long *));
92 1.4 ad static void rasops_do_cursor __P((struct rasops_info *));
93 1.4 ad static void rasops_init_devcmap __P((struct rasops_info *));
94 1.1 ad
95 1.1 ad /* Per-depth initalization functions */
96 1.1 ad void rasops1_init __P((struct rasops_info *));
97 1.4 ad void rasops2_init __P((struct rasops_info *));
98 1.1 ad void rasops8_init __P((struct rasops_info *));
99 1.1 ad void rasops15_init __P((struct rasops_info *));
100 1.1 ad void rasops24_init __P((struct rasops_info *));
101 1.1 ad void rasops32_init __P((struct rasops_info *));
102 1.1 ad
103 1.1 ad /*
104 1.1 ad * Initalize a 'rasops_info' descriptor.
105 1.1 ad */
106 1.1 ad int
107 1.1 ad rasops_init(ri, wantrows, wantcols, clear, center)
108 1.1 ad struct rasops_info *ri;
109 1.1 ad int wantrows, wantcols, clear, center;
110 1.1 ad {
111 1.4 ad #ifdef _KERNEL
112 1.1 ad /* Select a font if the caller doesn't care */
113 1.1 ad if (ri->ri_font == NULL) {
114 1.1 ad int cookie;
115 1.1 ad
116 1.1 ad wsfont_init();
117 1.1 ad
118 1.1 ad /* Want 8 pixel wide, don't care about aestethics */
119 1.7 ad if ((cookie = wsfont_find(NULL, 8, 0, 0)) <= 0)
120 1.1 ad cookie = wsfont_find(NULL, 0, 0, 0);
121 1.1 ad
122 1.7 ad if (cookie <= 0) {
123 1.1 ad printf("rasops_init: font table is empty\n");
124 1.1 ad return (-1);
125 1.1 ad }
126 1.1 ad
127 1.1 ad if (wsfont_lock(cookie, &ri->ri_font,
128 1.8 ad WSFONT_L2R, WSFONT_L2R) <= 0) {
129 1.1 ad printf("rasops_init: couldn't lock font\n");
130 1.1 ad return (-1);
131 1.1 ad }
132 1.8 ad
133 1.8 ad #ifdef DIAGNOSTIC
134 1.8 ad if (ri->ri_font == NULL)
135 1.8 ad panic("rasops_init: locked font, but got no pointer\n");
136 1.8 ad #endif
137 1.5 ad ri->ri_wsfcookie = cookie;
138 1.1 ad }
139 1.4 ad #endif
140 1.1 ad
141 1.1 ad /* This should never happen in reality... */
142 1.1 ad #ifdef DEBUG
143 1.1 ad if ((int)ri->ri_bits & 3) {
144 1.1 ad printf("rasops_init: bits not aligned on 32-bit boundary\n");
145 1.1 ad return (-1);
146 1.1 ad }
147 1.1 ad
148 1.1 ad if ((int)ri->ri_stride & 3) {
149 1.1 ad printf("rasops_init: stride not aligned on 32-bit boundary\n");
150 1.1 ad return (-1);
151 1.1 ad }
152 1.1 ad #endif
153 1.4 ad
154 1.1 ad /* Fix color palette. We need this for the cursor to work. */
155 1.1 ad rasops_cmap[255*3+0] = 0xff;
156 1.1 ad rasops_cmap[255*3+1] = 0xff;
157 1.1 ad rasops_cmap[255*3+2] = 0xff;
158 1.1 ad
159 1.4 ad /* setfont does most of the work */
160 1.4 ad if (rasops_setfont(ri, wantrows, wantcols, clear, center))
161 1.4 ad return (-1);
162 1.4 ad
163 1.4 ad rasops_init_devcmap(ri);
164 1.4 ad ri->ri_flg = RASOPS_INITTED;
165 1.4 ad return (0);
166 1.4 ad }
167 1.4 ad
168 1.4 ad
169 1.4 ad /*
170 1.4 ad * Choose a different font. The new font will already be set in ri_font.
171 1.4 ad */
172 1.4 ad int
173 1.4 ad rasops_setfont(ri, wantrows, wantcols, clear, center)
174 1.4 ad struct rasops_info *ri;
175 1.4 ad int wantrows, wantcols, clear, center;
176 1.4 ad {
177 1.4 ad int bpp;
178 1.4 ad
179 1.4 ad if (ri->ri_font->fontwidth > 32 || ri->ri_font->fontwidth < 4)
180 1.4 ad panic("rasops_init: fontwidth assumptions botched!\n");
181 1.4 ad
182 1.4 ad /* Need this to frob the setup below */
183 1.4 ad bpp = (ri->ri_depth == 15 ? 16 : ri->ri_depth);
184 1.4 ad
185 1.4 ad if (ri->ri_flg & RASOPS_INITTED)
186 1.4 ad ri->ri_bits = ri->ri_origbits;
187 1.4 ad
188 1.1 ad /* Don't care if the caller wants a hideously small console */
189 1.1 ad if (wantrows < 10)
190 1.1 ad wantrows = 5000;
191 1.1 ad
192 1.1 ad if (wantcols < 20)
193 1.1 ad wantcols = 5000;
194 1.1 ad
195 1.1 ad /* Now constrain what they get */
196 1.1 ad ri->ri_emuwidth = ri->ri_font->fontwidth * wantcols;
197 1.1 ad ri->ri_emuheight = ri->ri_font->fontheight * wantrows;
198 1.1 ad
199 1.1 ad if (ri->ri_emuwidth > ri->ri_width)
200 1.1 ad ri->ri_emuwidth = ri->ri_width;
201 1.1 ad
202 1.1 ad if (ri->ri_emuheight > ri->ri_height)
203 1.1 ad ri->ri_emuheight = ri->ri_height;
204 1.1 ad
205 1.1 ad /* Reduce width until aligned on a 32-bit boundary */
206 1.4 ad while ((ri->ri_emuwidth*bpp & 31) != 0)
207 1.1 ad ri->ri_emuwidth--;
208 1.1 ad
209 1.1 ad ri->ri_cols = ri->ri_emuwidth / ri->ri_font->fontwidth;
210 1.1 ad ri->ri_rows = ri->ri_emuheight / ri->ri_font->fontheight;
211 1.4 ad ri->ri_emustride = ri->ri_emuwidth * bpp >> 3;
212 1.1 ad ri->ri_delta = ri->ri_stride - ri->ri_emustride;
213 1.1 ad ri->ri_ccol = 0;
214 1.1 ad ri->ri_crow = 0;
215 1.4 ad ri->ri_pelbytes = bpp >> 3;
216 1.1 ad
217 1.4 ad ri->ri_xscale = (ri->ri_font->fontwidth * bpp) >> 3;
218 1.1 ad ri->ri_yscale = ri->ri_font->fontheight * ri->ri_stride;
219 1.1 ad ri->ri_fontscale = ri->ri_font->fontheight * ri->ri_font->stride;
220 1.1 ad
221 1.1 ad #ifdef DEBUG
222 1.1 ad if (ri->ri_delta & 3)
223 1.1 ad panic("rasops_init: delta isn't aligned on 32-bit boundary!");
224 1.1 ad #endif
225 1.1 ad /* Clear the entire display */
226 1.1 ad if (clear)
227 1.1 ad bzero(ri->ri_bits, ri->ri_stride * ri->ri_height);
228 1.1 ad
229 1.1 ad /* Now centre our window if needs be */
230 1.1 ad ri->ri_origbits = ri->ri_bits;
231 1.1 ad
232 1.1 ad if (center) {
233 1.1 ad ri->ri_bits += ((ri->ri_stride - ri->ri_emustride) >> 1) & ~3;
234 1.1 ad ri->ri_bits += ((ri->ri_height - ri->ri_emuheight) >> 1) *
235 1.1 ad ri->ri_stride;
236 1.5 ad
237 1.5 ad ri->ri_yorigin = (int)(ri->ri_bits - ri->ri_origbits)
238 1.5 ad / ri->ri_stride;
239 1.5 ad ri->ri_xorigin = (((int)(ri->ri_bits - ri->ri_origbits)
240 1.5 ad % ri->ri_stride) * bpp) >> 3;
241 1.5 ad } else
242 1.5 ad ri->ri_xorigin = ri->ri_yorigin = 0;
243 1.4 ad
244 1.4 ad /*
245 1.4 ad * Fill in defaults for operations set. XXX this nukes private
246 1.4 ad * routines used by accelerated fb drivers.
247 1.4 ad */
248 1.1 ad ri->ri_ops.mapchar = rasops_mapchar;
249 1.1 ad ri->ri_ops.copyrows = rasops_copyrows;
250 1.1 ad ri->ri_ops.copycols = rasops_copycols;
251 1.4 ad ri->ri_ops.erasecols = rasops_erasecols;
252 1.4 ad ri->ri_ops.eraserows = rasops_eraserows;
253 1.1 ad ri->ri_ops.cursor = rasops_cursor;
254 1.4 ad ri->ri_do_cursor = rasops_do_cursor;
255 1.1 ad
256 1.4 ad if (ri->ri_depth < 8 || ri->ri_forcemono) {
257 1.1 ad ri->ri_ops.alloc_attr = rasops_alloc_mattr;
258 1.4 ad ri->ri_caps = WSATTR_UNDERLINE;
259 1.4 ad } else {
260 1.1 ad ri->ri_ops.alloc_attr = rasops_alloc_cattr;
261 1.4 ad ri->ri_caps = WSATTR_UNDERLINE | WSATTR_HILIT |
262 1.4 ad WSATTR_WSCOLORS;
263 1.4 ad }
264 1.4 ad
265 1.1 ad switch (ri->ri_depth) {
266 1.4 ad #if NRASOPS1
267 1.1 ad case 1:
268 1.1 ad rasops1_init(ri);
269 1.1 ad break;
270 1.1 ad #endif
271 1.1 ad
272 1.4 ad #if NRASOPS2
273 1.4 ad case 2:
274 1.4 ad rasops2_init(ri);
275 1.4 ad break;
276 1.4 ad #endif
277 1.4 ad
278 1.4 ad #if NRASOPS8
279 1.1 ad case 8:
280 1.1 ad rasops8_init(ri);
281 1.1 ad break;
282 1.1 ad #endif
283 1.1 ad
284 1.4 ad #if NRASOPS15 || NRASOPS16
285 1.1 ad case 15:
286 1.1 ad case 16:
287 1.1 ad rasops15_init(ri);
288 1.1 ad break;
289 1.1 ad #endif
290 1.1 ad
291 1.4 ad #if NRASOPS24
292 1.1 ad case 24:
293 1.1 ad rasops24_init(ri);
294 1.1 ad break;
295 1.1 ad #endif
296 1.1 ad
297 1.4 ad #if NRASOPS32
298 1.1 ad case 32:
299 1.1 ad rasops32_init(ri);
300 1.1 ad break;
301 1.1 ad #endif
302 1.1 ad default:
303 1.1 ad ri->ri_flg = 0;
304 1.1 ad return (-1);
305 1.1 ad }
306 1.1 ad
307 1.1 ad return (0);
308 1.1 ad }
309 1.1 ad
310 1.1 ad
311 1.1 ad /*
312 1.1 ad * Map a character.
313 1.1 ad */
314 1.1 ad static int
315 1.1 ad rasops_mapchar(cookie, c, cp)
316 1.1 ad void *cookie;
317 1.1 ad int c;
318 1.1 ad u_int *cp;
319 1.1 ad {
320 1.1 ad struct rasops_info *ri;
321 1.1 ad
322 1.1 ad ri = (struct rasops_info *)cookie;
323 1.8 ad
324 1.8 ad #ifdef DIAGNOSTIC
325 1.8 ad if (ri->ri_font == NULL)
326 1.8 ad panic("rasops_mapchar: no font selected\n");
327 1.8 ad #endif
328 1.1 ad
329 1.1 ad if (c < ri->ri_font->firstchar) {
330 1.1 ad *cp = ' ';
331 1.1 ad return (0);
332 1.1 ad }
333 1.1 ad
334 1.1 ad if (c - ri->ri_font->firstchar >= ri->ri_font->numchars) {
335 1.1 ad *cp = ' ';
336 1.1 ad return (0);
337 1.1 ad }
338 1.1 ad
339 1.1 ad *cp = c;
340 1.1 ad return (5);
341 1.1 ad }
342 1.1 ad
343 1.1 ad
344 1.1 ad /*
345 1.1 ad * Allocate a color attribute.
346 1.1 ad */
347 1.1 ad static int
348 1.1 ad rasops_alloc_cattr(cookie, fg, bg, flg, attr)
349 1.1 ad void *cookie;
350 1.1 ad int fg, bg, flg;
351 1.1 ad long *attr;
352 1.1 ad {
353 1.1 ad int swap;
354 1.1 ad
355 1.1 ad #ifdef RASOPS_CLIPPING
356 1.1 ad fg &= 7;
357 1.1 ad bg &= 7;
358 1.1 ad flg &= 255;
359 1.1 ad #endif
360 1.1 ad if (flg & WSATTR_BLINK)
361 1.1 ad return (EINVAL);
362 1.1 ad
363 1.1 ad if (flg & WSATTR_REVERSE) {
364 1.1 ad swap = fg;
365 1.1 ad fg = bg;
366 1.1 ad bg = swap;
367 1.1 ad }
368 1.1 ad
369 1.1 ad if (flg & WSATTR_HILIT)
370 1.1 ad fg += 8;
371 1.1 ad
372 1.1 ad flg = ((flg & WSATTR_UNDERLINE) ? 1 : 0);
373 1.1 ad
374 1.1 ad if (rasops_isgray[fg])
375 1.1 ad flg |= 2;
376 1.1 ad
377 1.1 ad if (rasops_isgray[bg])
378 1.1 ad flg |= 4;
379 1.1 ad
380 1.1 ad *attr = (bg << 16) | (fg << 24) | flg;
381 1.1 ad return 0;
382 1.1 ad }
383 1.1 ad
384 1.1 ad
385 1.1 ad /*
386 1.1 ad * Allocate a mono attribute.
387 1.1 ad */
388 1.1 ad static int
389 1.1 ad rasops_alloc_mattr(cookie, fg, bg, flg, attr)
390 1.1 ad void *cookie;
391 1.1 ad int fg, bg, flg;
392 1.1 ad long *attr;
393 1.1 ad {
394 1.1 ad int swap;
395 1.1 ad
396 1.1 ad #ifdef RASOPS_CLIPPING
397 1.1 ad flg &= 255;
398 1.1 ad #endif
399 1.1 ad fg = fg ? 1 : 0;
400 1.1 ad bg = bg ? 1 : 0;
401 1.1 ad
402 1.1 ad if (flg & WSATTR_BLINK)
403 1.1 ad return (EINVAL);
404 1.1 ad
405 1.1 ad if (!(flg & WSATTR_REVERSE) ^ !(flg & WSATTR_HILIT)) {
406 1.1 ad swap = fg;
407 1.1 ad fg = bg;
408 1.1 ad bg = swap;
409 1.1 ad }
410 1.1 ad
411 1.1 ad *attr = (bg << 16) | (fg << 24) | ((flg & WSATTR_UNDERLINE) ? 7 : 6);
412 1.1 ad return 0;
413 1.1 ad }
414 1.1 ad
415 1.1 ad
416 1.1 ad /*
417 1.1 ad * Copy rows.
418 1.1 ad */
419 1.1 ad static void
420 1.1 ad rasops_copyrows(cookie, src, dst, num)
421 1.1 ad void *cookie;
422 1.1 ad int src, dst, num;
423 1.1 ad {
424 1.1 ad struct rasops_info *ri;
425 1.1 ad int32_t *sp, *dp, *srp, *drp;
426 1.1 ad int n8, n1, cnt;
427 1.1 ad
428 1.1 ad ri = (struct rasops_info *)cookie;
429 1.1 ad
430 1.1 ad #ifdef RASOPS_CLIPPING
431 1.1 ad if (dst == src)
432 1.1 ad return;
433 1.1 ad
434 1.1 ad if (src < 0) {
435 1.1 ad num += src;
436 1.1 ad src = 0;
437 1.1 ad }
438 1.1 ad
439 1.1 ad if ((src + num) > ri->ri_rows)
440 1.1 ad num = ri->ri_rows - src;
441 1.1 ad
442 1.1 ad if (dst < 0) {
443 1.1 ad num += dst;
444 1.1 ad dst = 0;
445 1.1 ad }
446 1.1 ad
447 1.1 ad if ((dst + num) > ri->ri_rows)
448 1.1 ad num = ri->ri_rows - dst;
449 1.1 ad
450 1.1 ad if (num <= 0)
451 1.1 ad return;
452 1.1 ad #endif
453 1.1 ad
454 1.1 ad num *= ri->ri_font->fontheight;
455 1.1 ad n8 = ri->ri_emustride >> 5;
456 1.1 ad n1 = (ri->ri_emustride >> 2) & 7;
457 1.1 ad
458 1.1 ad if (dst < src) {
459 1.1 ad sp = (int32_t *)(ri->ri_bits + src * ri->ri_yscale);
460 1.1 ad dp = (int32_t *)(ri->ri_bits + dst * ri->ri_yscale);
461 1.1 ad
462 1.1 ad while (num--) {
463 1.1 ad for (cnt = n8; cnt; cnt--) {
464 1.1 ad dp[0] = sp[0];
465 1.1 ad dp[1] = sp[1];
466 1.1 ad dp[2] = sp[2];
467 1.1 ad dp[3] = sp[3];
468 1.1 ad dp[4] = sp[4];
469 1.1 ad dp[5] = sp[5];
470 1.1 ad dp[6] = sp[6];
471 1.1 ad dp[7] = sp[7];
472 1.1 ad dp += 8;
473 1.1 ad sp += 8;
474 1.1 ad }
475 1.1 ad
476 1.1 ad for (cnt = n1; cnt; cnt--)
477 1.1 ad *dp++ = *sp++;
478 1.1 ad
479 1.1 ad DELTA(dp, ri->ri_delta, int32_t *);
480 1.1 ad DELTA(sp, ri->ri_delta, int32_t *);
481 1.1 ad }
482 1.1 ad } else {
483 1.1 ad src = ri->ri_font->fontheight * src + num - 1;
484 1.1 ad dst = ri->ri_font->fontheight * dst + num - 1;
485 1.1 ad
486 1.1 ad srp = (int32_t *)(ri->ri_bits + src * ri->ri_stride);
487 1.1 ad drp = (int32_t *)(ri->ri_bits + dst * ri->ri_stride);
488 1.1 ad
489 1.1 ad while (num--) {
490 1.1 ad dp = drp;
491 1.1 ad sp = srp;
492 1.1 ad DELTA(srp, -ri->ri_stride, int32_t *);
493 1.1 ad DELTA(drp, -ri->ri_stride, int32_t *);
494 1.1 ad
495 1.1 ad for (cnt = n8; cnt; cnt--) {
496 1.1 ad dp[0] = sp[0];
497 1.1 ad dp[1] = sp[1];
498 1.1 ad dp[2] = sp[2];
499 1.1 ad dp[3] = sp[3];
500 1.1 ad dp[4] = sp[4];
501 1.1 ad dp[5] = sp[5];
502 1.1 ad dp[6] = sp[6];
503 1.1 ad dp[7] = sp[7];
504 1.1 ad dp += 8;
505 1.1 ad sp += 8;
506 1.1 ad }
507 1.1 ad
508 1.1 ad for (cnt = n1; cnt; cnt--)
509 1.1 ad *dp++ = *sp++;
510 1.1 ad }
511 1.1 ad }
512 1.1 ad }
513 1.1 ad
514 1.1 ad
515 1.1 ad /*
516 1.1 ad * Copy columns. This is slow, and hard to optimize due to alignment,
517 1.1 ad * and the fact that we have to copy both left->right and right->left.
518 1.1 ad * We simply cop-out here and use bcopy(), since it handles all of
519 1.1 ad * these cases anyway.
520 1.1 ad */
521 1.4 ad void
522 1.1 ad rasops_copycols(cookie, row, src, dst, num)
523 1.1 ad void *cookie;
524 1.1 ad int row, src, dst, num;
525 1.1 ad {
526 1.1 ad struct rasops_info *ri;
527 1.1 ad u_char *sp, *dp;
528 1.1 ad int height;
529 1.1 ad
530 1.1 ad ri = (struct rasops_info *)cookie;
531 1.1 ad
532 1.1 ad #ifdef RASOPS_CLIPPING
533 1.1 ad if (dst == src)
534 1.1 ad return;
535 1.1 ad
536 1.3 ad /* Catches < 0 case too */
537 1.3 ad if ((unsigned)row >= (unsigned)ri->ri_rows)
538 1.1 ad return;
539 1.1 ad
540 1.1 ad if (src < 0) {
541 1.1 ad num += src;
542 1.1 ad src = 0;
543 1.1 ad }
544 1.1 ad
545 1.1 ad if ((src + num) > ri->ri_cols)
546 1.1 ad num = ri->ri_cols - src;
547 1.1 ad
548 1.1 ad if (dst < 0) {
549 1.1 ad num += dst;
550 1.1 ad dst = 0;
551 1.1 ad }
552 1.1 ad
553 1.1 ad if ((dst + num) > ri->ri_cols)
554 1.1 ad num = ri->ri_cols - dst;
555 1.1 ad
556 1.1 ad if (num <= 0)
557 1.1 ad return;
558 1.1 ad #endif
559 1.1 ad
560 1.1 ad num *= ri->ri_xscale;
561 1.1 ad row *= ri->ri_yscale;
562 1.1 ad height = ri->ri_font->fontheight;
563 1.1 ad
564 1.1 ad sp = ri->ri_bits + row + src * ri->ri_xscale;
565 1.1 ad dp = ri->ri_bits + row + dst * ri->ri_xscale;
566 1.1 ad
567 1.1 ad while (height--) {
568 1.1 ad bcopy(sp, dp, num);
569 1.1 ad dp += ri->ri_stride;
570 1.1 ad sp += ri->ri_stride;
571 1.1 ad }
572 1.1 ad }
573 1.1 ad
574 1.1 ad
575 1.1 ad /*
576 1.1 ad * Turn cursor off/on.
577 1.1 ad */
578 1.1 ad static void
579 1.1 ad rasops_cursor(cookie, on, row, col)
580 1.1 ad void *cookie;
581 1.1 ad int on, row, col;
582 1.1 ad {
583 1.1 ad struct rasops_info *ri;
584 1.1 ad
585 1.1 ad ri = (struct rasops_info *)cookie;
586 1.1 ad
587 1.1 ad /* Turn old cursor off */
588 1.1 ad if (ri->ri_flg & RASOPS_CURSOR)
589 1.1 ad #ifdef RASOPS_CLIPPING
590 1.1 ad if (!(ri->ri_flg & RASOPS_CURSOR_CLIPPED))
591 1.1 ad #endif
592 1.1 ad ri->ri_do_cursor(ri);
593 1.1 ad
594 1.1 ad /* Select new cursor */
595 1.1 ad #ifdef RASOPS_CLIPPING
596 1.1 ad ri->ri_flg &= ~RASOPS_CURSOR_CLIPPED;
597 1.1 ad
598 1.1 ad if (row < 0 || row >= ri->ri_rows)
599 1.1 ad ri->ri_flg |= RASOPS_CURSOR_CLIPPED;
600 1.1 ad else if (col < 0 || col >= ri->ri_cols)
601 1.1 ad ri->ri_flg |= RASOPS_CURSOR_CLIPPED;
602 1.1 ad #endif
603 1.1 ad ri->ri_crow = row;
604 1.1 ad ri->ri_ccol = col;
605 1.1 ad
606 1.1 ad if (on) {
607 1.1 ad ri->ri_flg |= RASOPS_CURSOR;
608 1.1 ad #ifdef RASOPS_CLIPPING
609 1.1 ad if (!(ri->ri_flg & RASOPS_CURSOR_CLIPPED))
610 1.1 ad #endif
611 1.1 ad ri->ri_do_cursor(ri);
612 1.1 ad } else
613 1.1 ad ri->ri_flg &= ~RASOPS_CURSOR;
614 1.1 ad }
615 1.1 ad
616 1.1 ad
617 1.1 ad /*
618 1.1 ad * Make the device colormap
619 1.1 ad */
620 1.4 ad static void
621 1.1 ad rasops_init_devcmap(ri)
622 1.1 ad struct rasops_info *ri;
623 1.1 ad {
624 1.4 ad u_char *p;
625 1.1 ad int i, c;
626 1.1 ad
627 1.4 ad switch (ri->ri_depth) {
628 1.4 ad case 1:
629 1.4 ad ri->ri_devcmap[0] = 0;
630 1.4 ad for (i = 1; i < 16; i++)
631 1.4 ad ri->ri_devcmap[i] = -1;
632 1.4 ad return;
633 1.4 ad
634 1.4 ad case 2:
635 1.4 ad for (i = 1; i < 15; i++)
636 1.4 ad ri->ri_devcmap[i] = 0xaaaaaaaa;
637 1.4 ad
638 1.4 ad ri->ri_devcmap[0] = 0;
639 1.4 ad ri->ri_devcmap[8] = 0x55555555;
640 1.4 ad ri->ri_devcmap[15] = -1;
641 1.4 ad return;
642 1.4 ad
643 1.4 ad case 8:
644 1.4 ad for (i = 0; i < 16; i++)
645 1.4 ad ri->ri_devcmap[i] = i | (i<<8) | (i<<16) | (i<<24);
646 1.4 ad return;
647 1.4 ad }
648 1.4 ad
649 1.1 ad p = rasops_cmap;
650 1.1 ad
651 1.1 ad for (i = 0; i < 16; i++) {
652 1.1 ad if (ri->ri_rnum <= 8)
653 1.1 ad c = (*p++ >> (8 - ri->ri_rnum)) << ri->ri_rpos;
654 1.1 ad else
655 1.1 ad c = (*p++ << (ri->ri_rnum - 8)) << ri->ri_rpos;
656 1.1 ad
657 1.1 ad if (ri->ri_gnum <= 8)
658 1.4 ad c |= (*p++ >> (8 - ri->ri_gnum)) << ri->ri_gpos;
659 1.1 ad else
660 1.4 ad c |= (*p++ << (ri->ri_gnum - 8)) << ri->ri_gpos;
661 1.1 ad
662 1.1 ad if (ri->ri_bnum <= 8)
663 1.4 ad c |= (*p++ >> (8 - ri->ri_bnum)) << ri->ri_bpos;
664 1.1 ad else
665 1.4 ad c |= (*p++ << (ri->ri_bnum - 8)) << ri->ri_bpos;
666 1.4 ad
667 1.4 ad /* Fill the word for generic routines, which want this */
668 1.4 ad if (ri->ri_depth == 24)
669 1.4 ad c = c | ((c & 0xff) << 24);
670 1.4 ad else if (ri->ri_depth <= 16)
671 1.4 ad c = c | (c << 16);
672 1.1 ad
673 1.4 ad /* 24bpp does bswap on the fly. {32,16,15}bpp do it here. */
674 1.3 ad if (!ri->ri_swab)
675 1.3 ad ri->ri_devcmap[i] = c;
676 1.4 ad else if (ri->ri_depth == 32)
677 1.3 ad ri->ri_devcmap[i] = bswap32(c);
678 1.4 ad else if (ri->ri_depth == 16 || ri->ri_depth == 15)
679 1.3 ad ri->ri_devcmap[i] = bswap16(c);
680 1.4 ad else
681 1.4 ad ri->ri_devcmap[i] = c;
682 1.1 ad }
683 1.1 ad }
684 1.1 ad
685 1.1 ad
686 1.1 ad /*
687 1.1 ad * Unpack a rasops attribute
688 1.1 ad */
689 1.1 ad void
690 1.1 ad rasops_unpack_attr(attr, fg, bg, underline)
691 1.1 ad long attr;
692 1.1 ad int *fg, *bg, *underline;
693 1.1 ad {
694 1.1 ad
695 1.1 ad *fg = ((u_int)attr >> 24) & 15;
696 1.1 ad *bg = ((u_int)attr >> 16) & 15;
697 1.1 ad *underline = (u_int)attr & 1;
698 1.4 ad }
699 1.4 ad
700 1.4 ad
701 1.4 ad /*
702 1.4 ad * Erase rows. This isn't static, since 24-bpp uses it in special cases.
703 1.4 ad */
704 1.4 ad void
705 1.4 ad rasops_eraserows(cookie, row, num, attr)
706 1.4 ad void *cookie;
707 1.4 ad int row, num;
708 1.4 ad long attr;
709 1.4 ad {
710 1.4 ad struct rasops_info *ri;
711 1.4 ad int np, nw, cnt;
712 1.4 ad int32_t *dp, clr;
713 1.4 ad
714 1.4 ad ri = (struct rasops_info *)cookie;
715 1.4 ad
716 1.4 ad #ifdef RASOPS_CLIPPING
717 1.4 ad if (row < 0) {
718 1.4 ad num += row;
719 1.4 ad row = 0;
720 1.4 ad }
721 1.4 ad
722 1.4 ad if ((row + num) > ri->ri_rows)
723 1.4 ad num = ri->ri_rows - row;
724 1.4 ad
725 1.4 ad if (num <= 0)
726 1.4 ad return;
727 1.4 ad #endif
728 1.4 ad
729 1.4 ad clr = ri->ri_devcmap[(attr >> 16) & 15];
730 1.4 ad num *= ri->ri_font->fontheight;
731 1.4 ad dp = (int32_t *)(ri->ri_bits + row * ri->ri_yscale);
732 1.4 ad
733 1.4 ad np = ri->ri_emustride >> 5;
734 1.4 ad nw = (ri->ri_emustride >> 2) & 7;
735 1.4 ad
736 1.4 ad while (num--) {
737 1.4 ad for (cnt = np; cnt; cnt--) {
738 1.4 ad dp[0] = clr;
739 1.4 ad dp[1] = clr;
740 1.4 ad dp[2] = clr;
741 1.4 ad dp[3] = clr;
742 1.4 ad dp[4] = clr;
743 1.4 ad dp[5] = clr;
744 1.4 ad dp[6] = clr;
745 1.4 ad dp[7] = clr;
746 1.4 ad dp += 8;
747 1.4 ad }
748 1.4 ad
749 1.4 ad for (cnt = nw; cnt; cnt--) {
750 1.4 ad *(int32_t *)dp = clr;
751 1.4 ad DELTA(dp, 4, int32_t *);
752 1.4 ad }
753 1.4 ad
754 1.4 ad DELTA(dp, ri->ri_delta, int32_t *);
755 1.4 ad }
756 1.4 ad }
757 1.4 ad
758 1.4 ad
759 1.4 ad /*
760 1.4 ad * Actually turn the cursor on or off. This does the dirty work for
761 1.4 ad * rasops_cursor().
762 1.4 ad */
763 1.4 ad static void
764 1.4 ad rasops_do_cursor(ri)
765 1.4 ad struct rasops_info *ri;
766 1.4 ad {
767 1.4 ad int full1, height, cnt, slop1, slop2, row, col, mask;
768 1.4 ad u_char *dp, *rp;
769 1.4 ad
770 1.4 ad row = ri->ri_crow;
771 1.4 ad col = ri->ri_ccol;
772 1.4 ad
773 1.4 ad rp = ri->ri_bits + row * ri->ri_yscale + col * ri->ri_xscale;
774 1.4 ad height = ri->ri_font->fontheight;
775 1.4 ad mask = ri->ri_devcmap[15];
776 1.4 ad
777 1.10 ad slop1 = (4 - ((int)rp & 3)) & 3;
778 1.4 ad
779 1.4 ad if (slop1 > ri->ri_xscale)
780 1.4 ad slop1 = ri->ri_xscale;
781 1.4 ad
782 1.4 ad slop2 = (ri->ri_xscale - slop1) & 3;
783 1.4 ad full1 = (ri->ri_xscale - slop1 - slop2) >> 2;
784 1.4 ad
785 1.4 ad if ((slop1 | slop2) == 0) {
786 1.4 ad /* A common case */
787 1.4 ad while (height--) {
788 1.4 ad dp = rp;
789 1.4 ad rp += ri->ri_stride;
790 1.4 ad
791 1.4 ad for (cnt = full1; cnt; cnt--) {
792 1.4 ad *(int32_t *)dp ^= mask;
793 1.4 ad dp += 4;
794 1.4 ad }
795 1.4 ad }
796 1.4 ad } else {
797 1.4 ad /* XXX this is stupid.. use masks instead */
798 1.4 ad while (height--) {
799 1.4 ad dp = rp;
800 1.4 ad rp += ri->ri_stride;
801 1.4 ad
802 1.4 ad if (slop1 & 1)
803 1.4 ad *dp++ ^= mask;
804 1.4 ad
805 1.4 ad if (slop1 & 2) {
806 1.4 ad *(int16_t *)dp ^= mask;
807 1.4 ad dp += 2;
808 1.4 ad }
809 1.4 ad
810 1.4 ad for (cnt = full1; cnt; cnt--) {
811 1.4 ad *(int32_t *)dp ^= mask;
812 1.4 ad dp += 4;
813 1.4 ad }
814 1.4 ad
815 1.4 ad if (slop2 & 1)
816 1.4 ad *dp++ ^= mask;
817 1.4 ad
818 1.4 ad if (slop2 & 2)
819 1.4 ad *(int16_t *)dp ^= mask;
820 1.4 ad }
821 1.4 ad }
822 1.4 ad }
823 1.4 ad
824 1.4 ad
825 1.4 ad /*
826 1.4 ad * Erase columns.
827 1.4 ad */
828 1.4 ad void
829 1.4 ad rasops_erasecols(cookie, row, col, num, attr)
830 1.4 ad void *cookie;
831 1.4 ad int row, col, num;
832 1.4 ad long attr;
833 1.4 ad {
834 1.4 ad int n8, height, cnt, slop1, slop2, clr;
835 1.4 ad struct rasops_info *ri;
836 1.4 ad int32_t *rp, *dp;
837 1.4 ad
838 1.4 ad ri = (struct rasops_info *)cookie;
839 1.4 ad
840 1.4 ad #ifdef RASOPS_CLIPPING
841 1.4 ad if ((unsigned)row >= (unsigned)ri->ri_rows)
842 1.4 ad return;
843 1.4 ad
844 1.4 ad if (col < 0) {
845 1.4 ad num += col;
846 1.4 ad col = 0;
847 1.4 ad }
848 1.4 ad
849 1.4 ad if ((col + num) > ri->ri_cols)
850 1.4 ad num = ri->ri_cols - col;
851 1.4 ad
852 1.4 ad if (num <= 0)
853 1.4 ad return;
854 1.4 ad #endif
855 1.4 ad
856 1.4 ad num = num * ri->ri_xscale;
857 1.4 ad rp = (int32_t *)(ri->ri_bits + row*ri->ri_yscale + col*ri->ri_xscale);
858 1.4 ad height = ri->ri_font->fontheight;
859 1.4 ad clr = ri->ri_devcmap[(attr >> 16) & 15];
860 1.4 ad
861 1.4 ad /* Don't bother using the full loop for <= 32 pels */
862 1.4 ad if (num <= 32) {
863 1.6 ad if (((num | ri->ri_xscale) & 3) == 0) {
864 1.6 ad /* Word aligned blt */
865 1.6 ad num >>= 2;
866 1.6 ad
867 1.6 ad while (height--) {
868 1.6 ad dp = rp;
869 1.6 ad DELTA(rp, ri->ri_stride, int32_t *);
870 1.6 ad
871 1.6 ad for (cnt = num; cnt; cnt--)
872 1.6 ad *dp++ = clr;
873 1.6 ad }
874 1.6 ad } else if (((num | ri->ri_xscale) & 1) == 0) {
875 1.4 ad /*
876 1.4 ad * Halfword aligned blt. This is needed so the
877 1.4 ad * 15/16 bit ops can use this function.
878 1.4 ad */
879 1.4 ad num >>= 1;
880 1.4 ad
881 1.4 ad while (height--) {
882 1.4 ad dp = rp;
883 1.4 ad DELTA(rp, ri->ri_stride, int32_t *);
884 1.4 ad
885 1.4 ad for (cnt = num; cnt; cnt--) {
886 1.4 ad *(int16_t *)dp = clr;
887 1.4 ad DELTA(dp, 2, int32_t *);
888 1.4 ad }
889 1.4 ad }
890 1.4 ad } else {
891 1.4 ad while (height--) {
892 1.4 ad dp = rp;
893 1.4 ad DELTA(rp, ri->ri_stride, int32_t *);
894 1.4 ad
895 1.4 ad for (cnt = num; cnt; cnt--) {
896 1.4 ad *(u_char *)dp = clr;
897 1.4 ad DELTA(dp, 1, int32_t *);
898 1.4 ad }
899 1.4 ad }
900 1.4 ad }
901 1.4 ad
902 1.4 ad return;
903 1.4 ad }
904 1.4 ad
905 1.10 ad slop1 = (4 - ((int)rp & 3)) & 3;
906 1.4 ad slop2 = (num - slop1) & 3;
907 1.4 ad num -= slop1 + slop2;
908 1.4 ad n8 = num >> 5;
909 1.4 ad num = (num >> 2) & 7;
910 1.4 ad
911 1.4 ad while (height--) {
912 1.4 ad dp = rp;
913 1.4 ad DELTA(rp, ri->ri_stride, int32_t *);
914 1.4 ad
915 1.4 ad /* Align span to 4 bytes */
916 1.4 ad if (slop1 & 1) {
917 1.4 ad *(u_char *)dp = clr;
918 1.4 ad DELTA(dp, 1, int32_t *);
919 1.4 ad }
920 1.4 ad
921 1.4 ad if (slop1 & 2) {
922 1.4 ad *(int16_t *)dp = clr;
923 1.4 ad DELTA(dp, 2, int32_t *);
924 1.4 ad }
925 1.4 ad
926 1.4 ad /* Write 32 bytes per loop */
927 1.4 ad for (cnt = n8; cnt; cnt--) {
928 1.4 ad dp[0] = clr;
929 1.4 ad dp[1] = clr;
930 1.4 ad dp[2] = clr;
931 1.4 ad dp[3] = clr;
932 1.4 ad dp[4] = clr;
933 1.4 ad dp[5] = clr;
934 1.4 ad dp[6] = clr;
935 1.4 ad dp[7] = clr;
936 1.4 ad dp += 8;
937 1.4 ad }
938 1.4 ad
939 1.4 ad /* Write 4 bytes per loop */
940 1.4 ad for (cnt = num; cnt; cnt--)
941 1.4 ad *dp++ = clr;
942 1.4 ad
943 1.4 ad /* Write unaligned trailing slop */
944 1.4 ad if (slop2 & 1) {
945 1.4 ad *(u_char *)dp = clr;
946 1.4 ad DELTA(dp, 1, int32_t *);
947 1.4 ad }
948 1.4 ad
949 1.4 ad if (slop2 & 2)
950 1.4 ad *(int16_t *)dp = clr;
951 1.4 ad }
952 1.1 ad }
953