1/* 	$NetBSD: rasops2.c,v 1.16 2010/05/04 12:36:37 nonaka Exp $	*/
2
3/*-
4 * Copyright (c) 1999 The NetBSD Foundation, Inc.
5 * All rights reserved.
6 *
7 * This code is derived from software contributed to The NetBSD Foundation
8 * by Andrew Doran.
9 *
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
12 * are met:
13 * 1. Redistributions of source code must retain the above copyright
14 *    notice, this list of conditions and the following disclaimer.
15 * 2. Redistributions in binary form must reproduce the above copyright
16 *    notice, this list of conditions and the following disclaimer in the
17 *    documentation and/or other materials provided with the distribution.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 * POSSIBILITY OF SUCH DAMAGE.
30 */
31
32#include <sys/cdefs.h>
33__KERNEL_RCSID(0, "$NetBSD: rasops2.c,v 1.16 2010/05/04 12:36:37 nonaka Exp $");
34
35#include "opt_rasops.h"
36
37#include <sys/param.h>
38#include <sys/systm.h>
39#include <sys/time.h>
40#include <machine/endian.h>
41
42#include <dev/wscons/wsdisplayvar.h>
43#include <dev/wscons/wsconsio.h>
44#include <dev/rasops/rasops.h>
45#include <dev/rasops/rasops_masks.h>
46
47static void	rasops2_copycols(void *, int, int, int, int);
48static void	rasops2_erasecols(void *, int, int, int, long);
49static void	rasops2_do_cursor(struct rasops_info *);
50static void	rasops2_putchar(void *, int, int col, u_int, long);
51#ifndef RASOPS_SMALL
52static void	rasops2_putchar8(void *, int, int col, u_int, long);
53static void	rasops2_putchar12(void *, int, int col, u_int, long);
54static void	rasops2_putchar16(void *, int, int col, u_int, long);
55static void	rasops2_makestamp(struct rasops_info *, long);
56
57/*
58 * 4x1 stamp for optimized character blitting
59 */
60static int8_t	stamp[16];
61static long	stamp_attr;
62static int	stamp_mutex;	/* XXX see note in README */
63#endif
64
65/*
66 * Initialize rasops_info struct for this colordepth.
67 */
68void
69rasops2_init(struct rasops_info *ri)
70{
71
72	switch (ri->ri_font->fontwidth) {
73#ifndef RASOPS_SMALL
74	case 8:
75		ri->ri_ops.putchar = rasops2_putchar8;
76		break;
77	case 12:
78		ri->ri_ops.putchar = rasops2_putchar12;
79		break;
80	case 16:
81		ri->ri_ops.putchar = rasops2_putchar16;
82		break;
83#endif	/* !RASOPS_SMALL */
84	default:
85		panic("fontwidth not 8/12/16 or RASOPS_SMALL - fixme!");
86		ri->ri_ops.putchar = rasops2_putchar;
87		break;
88	}
89
90	if ((ri->ri_font->fontwidth & 3) != 0) {
91		ri->ri_ops.erasecols = rasops2_erasecols;
92		ri->ri_ops.copycols = rasops2_copycols;
93		ri->ri_do_cursor = rasops2_do_cursor;
94	}
95}
96
97#ifdef notyet
98/*
99 * Paint a single character. This is the generic version, this is ugly.
100 */
101static void
102rasops2_putchar(void *cookie, int row, int col, u_int uc, long attr)
103{
104	int height, width, fs, rs, fb, bg, fg, lmask, rmask;
105	struct rasops_info *ri = (struct rasops_info *)cookie;
106	struct wsdisplay_font *font = PICK_FONT(ri, uc);
107	int32_t *rp;
108	u_char *fr;
109
110#ifdef RASOPS_CLIPPING
111	/* Catches 'row < 0' case too */
112	if ((unsigned)row >= (unsigned)ri->ri_rows)
113		return;
114
115	if ((unsigned)col >= (unsigned)ri->ri_cols)
116		return;
117#endif
118
119	width = font->fontwidth << 1;
120	height = font->fontheight;
121	col *= width;
122	rp = (int32_t *)(ri->ri_bits + row * ri->ri_yscale + ((col >> 3) & ~3));
123	col = col & 31;
124	rs = ri->ri_stride;
125
126	bg = ri->ri_devcmap[(attr >> 16) & 0xf];
127	fg = ri->ri_devcmap[(attr >> 24) & 0xf];
128
129	/* If fg and bg match this becomes a space character */
130	if (fg == bg || uc == ' ') {
131		uc = (u_int)-1;
132		fr = 0;		/* shutup gcc */
133		fs = 0;		/* shutup gcc */
134	} else {
135		uc -= font->firstchar;
136		fr = (u_char *)font->data + uc * ri->ri_fontscale;
137		fs = font->stride;
138	}
139
140	/* Single word, one mask */
141	if ((col + width) <= 32) {
142		rmask = rasops_pmask[col][width];
143		lmask = ~rmask;
144
145		if (uc == (u_int)-1) {
146			bg &= rmask;
147
148			while (height--) {
149				*rp = (*rp & lmask) | bg;
150				DELTA(rp, rs, int32_t *);
151			}
152		} else {
153			while (height--) {
154				/* get bits, mask */
155				/* compose sl */
156				/* mask sl */
157				/* put word */
158			}
159		}
160
161		/* Do underline */
162		if (attr & 1) {
163			DELTA(rp, -(ri->ri_stride << 1), int32_t *);
164			*rp = (*rp & lmask) | (fg & rmask);
165		}
166	} else {
167		lmask = ~rasops_lmask[col];
168		rmask = ~rasops_rmask[(col + width) & 31];
169
170		if (uc == (u_int)-1) {
171			bg = bg & ~lmask;
172			width = bg & ~rmask;
173
174			while (height--) {
175				rp[0] = (rp[0] & lmask) | bg;
176				rp[1] = (rp[1] & rmask) | width;
177				DELTA(rp, rs, int32_t *);
178			}
179		} else {
180			width = 32 - col;
181
182			/* NOT fontbits if bg is white */
183			while (height--) {
184				fb = ~(fr[3] | (fr[2] << 8) |
185				    (fr[1] << 16) | (fr[0] << 24));
186
187				rp[0] = (rp[0] & lmask)
188				    | MBE((u_int)fb >> col);
189
190				rp[1] = (rp[1] & rmask)
191				   | (MBE((u_int)fb << width) & ~rmask);
192
193				fr += fs;
194				DELTA(rp, rs, int32_t *);
195			}
196		}
197
198		/* Do underline */
199		if (attr & 1) {
200			DELTA(rp, -(ri->ri_stride << 1), int32_t *);
201			rp[0] = (rp[0] & lmask) | (fg & ~lmask);
202			rp[1] = (rp[1] & rmask) | (fg & ~rmask);
203		}
204	}
205}
206#endif
207
208/*
209 * Put a single character. This is the generic version.
210 */
211static void
212rasops2_putchar(void *cookie, int row, int col, u_int uc, long attr)
213{
214
215	/* XXX punt */
216}
217
218#ifndef RASOPS_SMALL
219/*
220 * Recompute the blitting stamp.
221 */
222static void
223rasops2_makestamp(struct rasops_info *ri, long attr)
224{
225	int i, fg, bg;
226
227	fg = ri->ri_devcmap[(attr >> 24) & 0xf] & 3;
228	bg = ri->ri_devcmap[(attr >> 16) & 0xf] & 3;
229	stamp_attr = attr;
230
231	for (i = 0; i < 16; i++) {
232		stamp[i] = (i & 1 ? fg : bg);
233		stamp[i] |= (i & 2 ? fg : bg) << 2;
234		stamp[i] |= (i & 4 ? fg : bg) << 4;
235		stamp[i] |= (i & 8 ? fg : bg) << 6;
236	}
237}
238
239/*
240 * Put a single character. This is for 8-pixel wide fonts.
241 */
242static void
243rasops2_putchar8(void *cookie, int row, int col, u_int uc, long attr)
244{
245	struct rasops_info *ri = (struct rasops_info *)cookie;
246	struct wsdisplay_font *font = PICK_FONT(ri, uc);
247	int height, fs, rs;
248	u_char *fr, *rp;
249
250	/* Can't risk remaking the stamp if it's already in use */
251	if (stamp_mutex++) {
252		stamp_mutex--;
253		rasops2_putchar(cookie, row, col, uc, attr);
254		return;
255	}
256
257#ifdef RASOPS_CLIPPING
258	/* Catches 'row < 0' case too */
259	if ((unsigned)row >= (unsigned)ri->ri_rows) {
260		stamp_mutex--;
261		return;
262	}
263
264	if ((unsigned)col >= (unsigned)ri->ri_cols) {
265		stamp_mutex--;
266		return;
267	}
268#endif
269
270	rp = ri->ri_bits + row * ri->ri_yscale + col * ri->ri_xscale;
271	height = font->fontheight;
272	rs = ri->ri_stride;
273
274	/* Recompute stamp? */
275	if (attr != stamp_attr)
276		rasops2_makestamp(ri, attr);
277
278	if (uc == ' ') {
279		int8_t c = stamp[0];
280		while (height--) {
281			*(int16_t *)rp = c;
282			rp += rs;
283		}
284	} else {
285		uc -= font->firstchar;
286		fr = (u_char *)font->data + uc * ri->ri_fontscale;
287		fs = font->stride;
288
289		while (height--) {
290			rp[0] = stamp[(*fr >> 4) & 0xf];
291			rp[1] = stamp[*fr & 0xf];
292			fr += fs;
293			rp += rs;
294		}
295	}
296
297	/* Do underline */
298	if ((attr & 1) != 0)
299		*(int16_t *)(rp - (ri->ri_stride << 1)) = stamp[15];
300
301	stamp_mutex--;
302}
303
304/*
305 * Put a single character. This is for 12-pixel wide fonts.
306 */
307static void
308rasops2_putchar12(void *cookie, int row, int col, u_int uc, long attr)
309{
310	struct rasops_info *ri = (struct rasops_info *)cookie;
311	struct wsdisplay_font *font = PICK_FONT(ri, uc);
312	int height, fs, rs;
313	u_char *fr, *rp;
314
315	/* Can't risk remaking the stamp if it's already in use */
316	if (stamp_mutex++) {
317		stamp_mutex--;
318		rasops2_putchar(cookie, row, col, uc, attr);
319		return;
320	}
321
322#ifdef RASOPS_CLIPPING
323	/* Catches 'row < 0' case too */
324	if ((unsigned)row >= (unsigned)ri->ri_rows) {
325		stamp_mutex--;
326		return;
327	}
328
329	if ((unsigned)col >= (unsigned)ri->ri_cols) {
330		stamp_mutex--;
331		return;
332	}
333#endif
334
335	rp = ri->ri_bits + row * ri->ri_yscale + col * ri->ri_xscale;
336	height = font->fontheight;
337	rs = ri->ri_stride;
338
339	/* Recompute stamp? */
340	if (attr != stamp_attr)
341		rasops2_makestamp(ri, attr);
342
343	if (uc == ' ') {
344		int8_t c = stamp[0];
345		while (height--) {
346			rp[0] = rp[1] = rp[2] = c;
347			rp += rs;
348		}
349	} else {
350		uc -= font->firstchar;
351		fr = (u_char *)font->data + uc * ri->ri_fontscale;
352		fs = font->stride;
353
354		while (height--) {
355			rp[0] = stamp[(fr[0] >> 4) & 0xf];
356			rp[1] = stamp[fr[0] & 0xf];
357			rp[2] = stamp[(fr[1] >> 4) & 0xf];
358			fr += fs;
359			rp += rs;
360		}
361	}
362
363	/* Do underline */
364	if ((attr & 1) != 0) {
365		rp -= ri->ri_stride << 1;
366		rp[0] = rp[1] = rp[2] = stamp[15];
367	}
368
369	stamp_mutex--;
370}
371
372/*
373 * Put a single character. This is for 16-pixel wide fonts.
374 */
375static void
376rasops2_putchar16(void *cookie, int row, int col, u_int uc, long attr)
377{
378	struct rasops_info *ri = (struct rasops_info *)cookie;
379	struct wsdisplay_font *font = PICK_FONT(ri, uc);
380	int height, fs, rs;
381	u_char *fr, *rp;
382
383	/* Can't risk remaking the stamp if it's already in use */
384	if (stamp_mutex++) {
385		stamp_mutex--;
386		rasops2_putchar(cookie, row, col, uc, attr);
387		return;
388	}
389
390#ifdef RASOPS_CLIPPING
391	/* Catches 'row < 0' case too */
392	if ((unsigned)row >= (unsigned)ri->ri_rows) {
393		stamp_mutex--;
394		return;
395	}
396
397	if ((unsigned)col >= (unsigned)ri->ri_cols) {
398		stamp_mutex--;
399		return;
400	}
401#endif
402
403	rp = ri->ri_bits + row * ri->ri_yscale + col * ri->ri_xscale;
404	height = font->fontheight;
405	rs = ri->ri_stride;
406
407	/* Recompute stamp? */
408	if (attr != stamp_attr)
409		rasops2_makestamp(ri, attr);
410
411	if (uc == ' ') {
412		int8_t c = stamp[0];
413		while (height--) {
414			*(int32_t *)rp = c;
415			rp += rs;
416		}
417	} else {
418		uc -= font->firstchar;
419		fr = (u_char *)font->data + uc * ri->ri_fontscale;
420		fs = font->stride;
421
422		while (height--) {
423			rp[0] = stamp[(fr[0] >> 4) & 0xf];
424			rp[1] = stamp[fr[0] & 0xf];
425			rp[2] = stamp[(fr[1] >> 4) & 0xf];
426			rp[3] = stamp[fr[1] & 0xf];
427			fr += fs;
428			rp += rs;
429		}
430	}
431
432	/* Do underline */
433	if ((attr & 1) != 0)
434		*(int32_t *)(rp - (ri->ri_stride << 1)) = stamp[15];
435
436	stamp_mutex--;
437}
438#endif	/* !RASOPS_SMALL */
439
440/*
441 * Grab routines common to depths where (bpp < 8)
442 */
443#define NAME(ident)	rasops2_##ident
444#define PIXEL_SHIFT	1
445
446#include <dev/rasops/rasops_bitops.h>
447