rasops_bitops.h revision 1.24 1 1.24 rin /* $NetBSD: rasops_bitops.h,v 1.24 2019/08/07 12:36:36 rin Exp $ */
2 1.1 ad
3 1.3 ad /*-
4 1.3 ad * Copyright (c) 1999 The NetBSD Foundation, Inc.
5 1.1 ad * All rights reserved.
6 1.1 ad *
7 1.3 ad * This code is derived from software contributed to The NetBSD Foundation
8 1.7 ad * by Andrew Doran.
9 1.3 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.1 ad *
19 1.3 ad * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.3 ad * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.3 ad * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.3 ad * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.3 ad * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.3 ad * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.3 ad * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.3 ad * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.3 ad * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.3 ad * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.3 ad * POSSIBILITY OF SUCH DAMAGE.
30 1.1 ad */
31 1.1 ad
32 1.1 ad #ifndef _RASOPS_BITOPS_H_
33 1.1 ad #define _RASOPS_BITOPS_H_ 1
34 1.1 ad
35 1.23 rin #if RASOPS_DEPTH == 1
36 1.23 rin #define PIXEL_SHIFT 0
37 1.23 rin #elif RASOPS_DEPTH == 2
38 1.23 rin #define PIXEL_SHIFT 1
39 1.23 rin #elif RASOPS_DEPTH == 4
40 1.23 rin #define PIXEL_SHIFT 2
41 1.23 rin #else
42 1.23 rin #error "Depth not supported"
43 1.23 rin #endif
44 1.23 rin
45 1.24 rin #define NAME(name) NAME1(RASOPS_DEPTH, name)
46 1.24 rin #define NAME1(depth, name) NAME2(depth, name)
47 1.24 rin #define NAME2(depth, name) rasops ## depth ## _ ## name
48 1.23 rin
49 1.1 ad /*
50 1.1 ad * Erase columns.
51 1.1 ad */
52 1.1 ad static void
53 1.11 cegger NAME(erasecols)(void *cookie, int row, int col, int num, long attr)
54 1.1 ad {
55 1.19 rin struct rasops_info *ri = (struct rasops_info *)cookie;
56 1.19 rin uint32_t lclr, rclr, clr;
57 1.18 rin uint32_t *dp, *rp, *hp, tmp, lmask, rmask;
58 1.1 ad int height, cnt;
59 1.6 pk
60 1.18 rin hp = NULL; /* XXX GCC */
61 1.18 rin
62 1.6 pk #ifdef RASOPS_CLIPPING
63 1.1 ad if ((unsigned)row >= (unsigned)ri->ri_rows)
64 1.1 ad return;
65 1.1 ad
66 1.1 ad if (col < 0) {
67 1.1 ad num += col;
68 1.1 ad col = 0;
69 1.1 ad }
70 1.1 ad
71 1.19 rin if (col + num > ri->ri_cols)
72 1.1 ad num = ri->ri_cols - col;
73 1.6 pk
74 1.1 ad if (num <= 0)
75 1.1 ad return;
76 1.1 ad #endif
77 1.20 rin
78 1.1 ad col *= ri->ri_font->fontwidth << PIXEL_SHIFT;
79 1.1 ad num *= ri->ri_font->fontwidth << PIXEL_SHIFT;
80 1.1 ad height = ri->ri_font->fontheight;
81 1.17 rin clr = ri->ri_devcmap[((uint32_t)attr >> 16) & 0xf];
82 1.15 tsutsui rp = (uint32_t *)(ri->ri_bits + row*ri->ri_yscale + ((col >> 3) & ~3));
83 1.12 macallan if (ri->ri_hwbits)
84 1.18 rin hp = (uint32_t *)(ri->ri_hwbits + row*ri->ri_yscale +
85 1.12 macallan ((col >> 3) & ~3));
86 1.19 rin col &= 31;
87 1.19 rin
88 1.19 rin if (col + num <= 32) {
89 1.19 rin lmask = ~rasops_pmask[col][num & 31];
90 1.1 ad lclr = clr & ~lmask;
91 1.1 ad
92 1.1 ad while (height--) {
93 1.1 ad dp = rp;
94 1.15 tsutsui DELTA(rp, ri->ri_stride, uint32_t *);
95 1.1 ad
96 1.12 macallan tmp = (*dp & lmask) | lclr;
97 1.12 macallan *dp = tmp;
98 1.12 macallan if (ri->ri_hwbits) {
99 1.18 rin *hp = tmp;
100 1.18 rin DELTA(hp, ri->ri_stride, uint32_t *);
101 1.12 macallan }
102 1.1 ad }
103 1.1 ad } else {
104 1.19 rin lmask = rasops_rmask[col];
105 1.1 ad rmask = rasops_lmask[(col + num) & 31];
106 1.6 pk
107 1.1 ad if (lmask)
108 1.19 rin num = (num - (32 - col)) >> 5;
109 1.1 ad else
110 1.1 ad num = num >> 5;
111 1.6 pk
112 1.1 ad lclr = clr & ~lmask;
113 1.1 ad rclr = clr & ~rmask;
114 1.1 ad
115 1.1 ad while (height--) {
116 1.1 ad dp = rp;
117 1.1 ad
118 1.8 thorpej if (lmask) {
119 1.18 rin *dp = (*dp & lmask) | lclr;
120 1.8 thorpej dp++;
121 1.8 thorpej }
122 1.1 ad
123 1.1 ad for (cnt = num; cnt > 0; cnt--)
124 1.1 ad *dp++ = clr;
125 1.18 rin
126 1.18 rin if (rmask)
127 1.18 rin *dp = (*dp & rmask) | rclr;
128 1.18 rin
129 1.12 macallan if (ri->ri_hwbits) {
130 1.18 rin memcpy(hp, rp, ((lmask != 0) + num +
131 1.18 rin (rmask != 0)) << 2);
132 1.18 rin DELTA(hp, ri->ri_stride, uint32_t *);
133 1.12 macallan }
134 1.18 rin DELTA(rp, ri->ri_stride, uint32_t *);
135 1.1 ad }
136 1.1 ad }
137 1.1 ad }
138 1.1 ad
139 1.1 ad /*
140 1.1 ad * Actually paint the cursor.
141 1.1 ad */
142 1.1 ad static void
143 1.11 cegger NAME(do_cursor)(struct rasops_info *ri)
144 1.1 ad {
145 1.19 rin int height, row, col, num, cnt;
146 1.19 rin uint32_t *dp, *rp, *hp, tmp, lmask, rmask;
147 1.18 rin
148 1.19 rin hp = NULL; /* XXX GCC */
149 1.6 pk
150 1.1 ad row = ri->ri_crow;
151 1.1 ad col = ri->ri_ccol * ri->ri_font->fontwidth << PIXEL_SHIFT;
152 1.1 ad height = ri->ri_font->fontheight;
153 1.1 ad num = ri->ri_font->fontwidth << PIXEL_SHIFT;
154 1.16 rin rp = (uint32_t *)(ri->ri_bits + row * ri->ri_yscale +
155 1.16 rin ((col >> 3) & ~3));
156 1.12 macallan if (ri->ri_hwbits)
157 1.19 rin hp = (uint32_t *)(ri->ri_hwbits + row * ri->ri_yscale +
158 1.12 macallan ((col >> 3) & ~3));
159 1.19 rin col &= 31;
160 1.6 pk
161 1.19 rin if (col + num <= 32) {
162 1.19 rin lmask = rasops_pmask[col][num & 31];
163 1.1 ad
164 1.1 ad while (height--) {
165 1.18 rin tmp = *rp ^ lmask;
166 1.18 rin *rp = tmp;
167 1.18 rin if (ri->ri_hwbits) {
168 1.19 rin *hp = tmp;
169 1.19 rin DELTA(hp, ri->ri_stride, uint32_t *);
170 1.12 macallan }
171 1.18 rin DELTA(rp, ri->ri_stride, uint32_t *);
172 1.12 macallan }
173 1.1 ad } else {
174 1.19 rin lmask = ~rasops_rmask[col];
175 1.1 ad rmask = ~rasops_lmask[(col + num) & 31];
176 1.1 ad
177 1.19 rin if (lmask != -1)
178 1.19 rin num = (num - (32 - col)) >> 5;
179 1.19 rin else
180 1.19 rin num = num >> 5;
181 1.19 rin
182 1.1 ad while (height--) {
183 1.1 ad dp = rp;
184 1.19 rin
185 1.19 rin if (lmask != -1) {
186 1.19 rin *dp = *dp ^ lmask;
187 1.19 rin dp++;
188 1.12 macallan }
189 1.18 rin
190 1.19 rin for (cnt = num; cnt; cnt--) {
191 1.19 rin *dp = ~*dp;
192 1.12 macallan dp++;
193 1.12 macallan }
194 1.1 ad
195 1.19 rin if (rmask != -1)
196 1.19 rin *dp = *dp ^ rmask;
197 1.19 rin
198 1.19 rin if (ri->ri_hwbits) {
199 1.19 rin memcpy(hp, rp, ((lmask != -1) + num +
200 1.19 rin (rmask != -1)) << 2);
201 1.19 rin DELTA(hp, ri->ri_stride, uint32_t *);
202 1.12 macallan }
203 1.20 rin
204 1.19 rin DELTA(rp, ri->ri_stride, uint32_t *);
205 1.1 ad }
206 1.1 ad }
207 1.1 ad }
208 1.1 ad
209 1.1 ad /*
210 1.4 ad * Copy columns. Ick!
211 1.1 ad */
212 1.1 ad static void
213 1.11 cegger NAME(copycols)(void *cookie, int row, int src, int dst, int num)
214 1.1 ad {
215 1.18 rin struct rasops_info *ri = (struct rasops_info *)cookie;
216 1.15 tsutsui int height, lnum, rnum, sb, db, cnt, full;
217 1.15 tsutsui uint32_t tmp, lmask, rmask;
218 1.18 rin uint32_t *sp, *dp, *srp, *drp, *dhp, *hp;
219 1.6 pk
220 1.18 rin dhp = hp = NULL; /* XXX GCC */
221 1.1 ad
222 1.1 ad #ifdef RASOPS_CLIPPING
223 1.1 ad if (dst == src)
224 1.1 ad return;
225 1.6 pk
226 1.1 ad /* Catches < 0 case too */
227 1.1 ad if ((unsigned)row >= (unsigned)ri->ri_rows)
228 1.1 ad return;
229 1.6 pk
230 1.1 ad if (src < 0) {
231 1.1 ad num += src;
232 1.1 ad src = 0;
233 1.1 ad }
234 1.1 ad
235 1.18 rin if (src + num > ri->ri_cols)
236 1.1 ad num = ri->ri_cols - src;
237 1.1 ad
238 1.1 ad if (dst < 0) {
239 1.1 ad num += dst;
240 1.1 ad dst = 0;
241 1.1 ad }
242 1.1 ad
243 1.18 rin if (dst + num > ri->ri_cols)
244 1.1 ad num = ri->ri_cols - dst;
245 1.6 pk
246 1.1 ad if (num <= 0)
247 1.1 ad return;
248 1.1 ad #endif
249 1.6 pk
250 1.1 ad cnt = ri->ri_font->fontwidth << PIXEL_SHIFT;
251 1.1 ad src *= cnt;
252 1.1 ad dst *= cnt;
253 1.1 ad num *= cnt;
254 1.1 ad row *= ri->ri_yscale;
255 1.1 ad height = ri->ri_font->fontheight;
256 1.4 ad db = dst & 31;
257 1.1 ad
258 1.6 pk if (db + num <= 32) {
259 1.4 ad /* Destination is contained within a single word */
260 1.15 tsutsui srp = (uint32_t *)(ri->ri_bits + row + ((src >> 3) & ~3));
261 1.15 tsutsui drp = (uint32_t *)(ri->ri_bits + row + ((dst >> 3) & ~3));
262 1.12 macallan if (ri->ri_hwbits)
263 1.15 tsutsui dhp = (uint32_t *)(ri->ri_hwbits + row +
264 1.12 macallan ((dst >> 3) & ~3));
265 1.1 ad sb = src & 31;
266 1.1 ad
267 1.1 ad while (height--) {
268 1.1 ad GETBITS(srp, sb, num, tmp);
269 1.1 ad PUTBITS(tmp, db, num, drp);
270 1.12 macallan if (ri->ri_hwbits) {
271 1.12 macallan PUTBITS(tmp, db, num, dhp);
272 1.15 tsutsui DELTA(dhp, ri->ri_stride, uint32_t *);
273 1.12 macallan }
274 1.15 tsutsui DELTA(srp, ri->ri_stride, uint32_t *);
275 1.15 tsutsui DELTA(drp, ri->ri_stride, uint32_t *);
276 1.1 ad }
277 1.6 pk
278 1.1 ad return;
279 1.1 ad }
280 1.1 ad
281 1.4 ad lmask = rasops_rmask[db];
282 1.1 ad rmask = rasops_lmask[(dst + num) & 31];
283 1.4 ad lnum = (32 - db) & 31;
284 1.6 pk rnum = (dst + num) & 31;
285 1.6 pk
286 1.1 ad if (lmask)
287 1.21 rin full = (num - lnum) >> 5;
288 1.1 ad else
289 1.1 ad full = num >> 5;
290 1.1 ad
291 1.4 ad if (src < dst && src + num > dst) {
292 1.4 ad /* Copy right-to-left */
293 1.15 tsutsui bool sbover;
294 1.15 tsutsui int sboff;
295 1.15 tsutsui
296 1.15 tsutsui srp = (uint32_t *)(ri->ri_bits + row +
297 1.15 tsutsui (((src + num) >> 3) & ~3));
298 1.15 tsutsui drp = (uint32_t *)(ri->ri_bits + row +
299 1.15 tsutsui (((dst + num) >> 3) & ~3));
300 1.12 macallan if (ri->ri_hwbits)
301 1.15 tsutsui dhp = (uint32_t *)(ri->ri_hwbits + row +
302 1.15 tsutsui (((dst + num) >> 3) & ~3));
303 1.1 ad
304 1.15 tsutsui sb = src & 31;
305 1.15 tsutsui sbover = (sb + lnum) >= 32;
306 1.15 tsutsui sboff = (src + num) & 31;
307 1.15 tsutsui if ((sboff -= rnum) < 0) {
308 1.14 tsutsui srp--;
309 1.15 tsutsui sboff += 32;
310 1.4 ad }
311 1.6 pk
312 1.1 ad while (height--) {
313 1.1 ad sp = srp;
314 1.1 ad dp = drp;
315 1.6 pk
316 1.15 tsutsui if (rnum) {
317 1.15 tsutsui GETBITS(sp, sboff, rnum, tmp);
318 1.15 tsutsui PUTBITS(tmp, 0, rnum, dp);
319 1.1 ad }
320 1.1 ad
321 1.4 ad /* Now aligned to 32-bits wrt dp */
322 1.15 tsutsui for (cnt = full; cnt; cnt--) {
323 1.15 tsutsui --dp;
324 1.15 tsutsui --sp;
325 1.15 tsutsui GETBITS(sp, sboff, 32, tmp);
326 1.15 tsutsui *dp = tmp;
327 1.1 ad }
328 1.1 ad
329 1.1 ad if (lmask) {
330 1.15 tsutsui if (sbover)
331 1.15 tsutsui --sp;
332 1.15 tsutsui --dp;
333 1.4 ad GETBITS(sp, sb, lnum, tmp);
334 1.15 tsutsui PUTBITS(tmp, db, lnum, dp);
335 1.1 ad }
336 1.18 rin
337 1.18 rin if (ri->ri_hwbits) {
338 1.18 rin hp = dhp;
339 1.22 rin hp -= (lmask != 0) + full;
340 1.22 rin memcpy(hp, dp, ((lmask != 0) + full +
341 1.22 rin (rnum != 0)) << 2);
342 1.18 rin DELTA(dhp, ri->ri_stride, uint32_t *);
343 1.18 rin }
344 1.22 rin
345 1.22 rin DELTA(srp, ri->ri_stride, uint32_t *);
346 1.22 rin DELTA(drp, ri->ri_stride, uint32_t *);
347 1.1 ad }
348 1.1 ad } else {
349 1.4 ad /* Copy left-to-right */
350 1.15 tsutsui srp = (uint32_t *)(ri->ri_bits + row + ((src >> 3) & ~3));
351 1.15 tsutsui drp = (uint32_t *)(ri->ri_bits + row + ((dst >> 3) & ~3));
352 1.12 macallan if (ri->ri_hwbits)
353 1.15 tsutsui dhp = (uint32_t *)(ri->ri_hwbits + row +
354 1.12 macallan ((dst >> 3) & ~3));
355 1.1 ad
356 1.1 ad while (height--) {
357 1.1 ad sb = src & 31;
358 1.1 ad sp = srp;
359 1.1 ad dp = drp;
360 1.6 pk
361 1.1 ad if (lmask) {
362 1.1 ad GETBITS(sp, sb, lnum, tmp);
363 1.1 ad PUTBITS(tmp, db, lnum, dp);
364 1.1 ad dp++;
365 1.6 pk
366 1.20 rin sb += lnum;
367 1.20 rin if (sb > 31) {
368 1.1 ad sp++;
369 1.1 ad sb -= 32;
370 1.1 ad }
371 1.1 ad }
372 1.6 pk
373 1.4 ad /* Now aligned to 32-bits wrt dp */
374 1.4 ad for (cnt = full; cnt; cnt--, sp++) {
375 1.1 ad GETBITS(sp, sb, 32, tmp);
376 1.1 ad *dp++ = tmp;
377 1.1 ad }
378 1.1 ad
379 1.1 ad if (rmask) {
380 1.1 ad GETBITS(sp, sb, rnum, tmp);
381 1.1 ad PUTBITS(tmp, 0, rnum, dp);
382 1.1 ad }
383 1.18 rin
384 1.18 rin if (ri->ri_hwbits) {
385 1.18 rin memcpy(dhp, drp, ((lmask != 0) + full +
386 1.18 rin (rmask != 0)) << 2);
387 1.18 rin DELTA(dhp, ri->ri_stride, uint32_t *);
388 1.18 rin }
389 1.18 rin
390 1.18 rin DELTA(srp, ri->ri_stride, uint32_t *);
391 1.18 rin DELTA(drp, ri->ri_stride, uint32_t *);
392 1.1 ad }
393 1.1 ad }
394 1.1 ad }
395 1.5 ad
396 1.23 rin #undef PIXEL_SHIFT
397 1.24 rin
398 1.24 rin #undef NAME
399 1.24 rin #undef NAME1
400 1.24 rin #undef NAME2
401 1.23 rin
402 1.1 ad #endif /* _RASOPS_BITOPS_H_ */
403